Merge pull request #171 from nim65s/devel

Fix unittest on 18.04

Author: nim65s

demo/demo_quadruped.py

@@ -1,6 +1,4 @@
-import pinocchio as se3
 import pinocchio as pin
-#from pinocchio import libpinocchio_pywrap as pin
 import tsid
 import numpy as np
 from numpy import nan
@@ -43,12 +41,12 @@
 filename = str(os.path.dirname(os.path.abspath(__file__)))
 path = filename + '/../models'
 urdf = path + '/quadruped/urdf/quadruped.urdf'
-vector = se3.StdVec_StdString()
+vector = pin.StdVec_StdString()
 vector.extend(item for item in path)
-robot = tsid.RobotWrapper(urdf, vector, se3.JointModelFreeFlyer(), False)
+robot = tsid.RobotWrapper(urdf, vector, pin.JointModelFreeFlyer(), False)
 
 # for gepetto viewer
-robot_display = se3.RobotWrapper.BuildFromURDF(urdf, [path, ], se3.JointModelFreeFlyer())
+robot_display = pin.RobotWrapper.BuildFromURDF(urdf, [path, ], pin.JointModelFreeFlyer())
 l = subprocess.getstatusoutput("ps aux |grep 'gepetto-gui'|grep -v 'grep'|wc -l")
 if int(l[1]) == 0:
     os.system('gepetto-gui &')
@@ -60,7 +58,7 @@
 #model = robot.model()
 #pin.loadReferenceConfigurations(model, srdf, False)
 #q = model.referenceConfigurations["half_sitting"]
-#q = se3.getNeutralConfigurationFromSrdf(robot.model(), srdf, False)
+#q = pin.getNeutralConfigurationFromSrdf(robot.model(), srdf, False)
 #q = robot_display.model.neutralConfiguration #np.zeros(robot.nq)
 q = np.zeros(robot.nq)
 q[6] = 1.0
@@ -113,7 +111,7 @@
 q_ref = q[7:]
 trajPosture = tsid.TrajectoryEuclidianConstant("traj_joint", q_ref)
 
-print("Create QP solver with ", invdyn.nVar, " variables, ", invdyn.nEq, 
+print("Create QP solver with ", invdyn.nVar, " variables, ", invdyn.nEq,
       " equality and ", invdyn.nIn, " inequality constraints")
 solver = tsid.SolverHQuadProgFast("qp solver")
 solver.resize(invdyn.nVar, invdyn.nEq, invdyn.nIn)
@@ -176,7 +174,7 @@
 
     v_mean = v + 0.5*dt*dv
     v += dt*dv
-    q = se3.integrate(robot.model(), q, dt*v_mean)
+    q = pin.integrate(robot.model(), q, dt*v_mean)
     t += dt
 
     if i%DISPLAY_N == 0: robot_display.display(q)

models/arm/generator.py renamed to tests/python/generator.py

@@ -262,10 +262,7 @@
 print("")
 
 # Get robot model generator module
-import sys
-filepath = os.path.normpath(os.path.join(os.path.dirname(os.path.abspath(__file__)), '../../'))
-sys.path.append(str(filepath))
-from models.arm.generator import create_7dof_arm
+from generator import create_7dof_arm
 
 # Get robot model
 model, geom_model = create_7dof_arm() # A robot containing sperical joints where nq != nv