00001 # bodyinfo ros supported JointAngles 00002 import math 00003 00004 def deg2radPose(pose): 00005 ret = [] 00006 for p in pose: 00007 ret += [jv*math.pi/180.0 for jv in p] 00008 return ret 00009 00010 initialPose = [ 00011 [ 0, 0, 0], 00012 [-0.6, 0, -100, 15.2, 9.4, 3.2], 00013 [ 0.6, 0, -100, -15.2, 9.4, -3.2], 00014 [], # [ 0, 0, 0, 0], 00015 [], # [ 0, 0, 0, 0], 00016 ] 00017 print deg2radPose(initialPose)
