python实现nao机器人身体躯干和腿部动作操作
本文实例为大家分享了python实现nao机器人身体躯干和腿部动作的具体代码,供大家参考,具体内容如下
跟上一篇类似,代码没什么难度,可以进行扩展。
#-*-encoding:UTF-8-*-
'''controlnao'sleftfoot,
cartesiancontrol:torsoandfoottrajectories
'''
importsys
importmotion
fromnaoqiimportALProxy
defStiffnessOn(proxy):
pNmaes="Body"
pStiffnessLists=1.0
pTimeLists=1.0
proxy.stiffnessInterpolation(pName,pStiffnessLists,pTimeLists)
defmain(robotIP):
'''exampleofcartesianfoottrajectory
'''
try:
motionProxy=ALProxy("ALMotion",robotIP,9559)
exceptException,e:
print"couldnotcreateaproxy"
print"erroris",e
try:
postureProxy=ALProxy("ALRobotPosture",robotIP,9559)
exceptException,e:
print"couldnotcreateaproxy"
print"erroris",e
StiffnessOn(motionProxy)
#sendnaotoposeinit
postureProxy.goToPosture("StandInit",0.5)
space=motion.FRAME_ROBOT
AxisMask=almath.AXIS_MASK_VEL
isAbsolute=False
path=[0.0,-0.07,-0.03,0.0,0.0,0.0]
#lowerthetorsoandmovethesize
effector="Torso"
time=2.0
motionProxy.positionInterpolation(effector,space,path,axisMask,time,isAbsolute)
#llegmotion
effector="LLeg"
path=[0.0,0.06,0.00,0.0,0.0,0.0]
times=2.0
motionProxy.positionInterpolation(effector,space,axisMask,time,isAbsolute)
if__name__=="__main__":
robotIP="127.0.0.1"
iflen(sys.argv)<=1:
print"usagepythonrobotIP"
else:
robotIP=sys.argv[1]
main(robotIP)
以上就是本文的全部内容,希望对大家的学习有所帮助,也希望大家多多支持毛票票。
热门推荐
1 训练狗狗搜寻
2 如何训练狗狗装死
3 狗狗训练书
6 怎么训练狗狗拜年
8 狗狗训练游戏
10 狗狗嗅觉训练
11 怎么训练狗狗在笼子里不叫
12 怎么训练狗狗站立走路
13 怎么训练狗狗在马桶上
14 狗狗尿尿怎么训练
15 训练狗狗用品
16 泰迪狗狗的训练方法大小便
17 训练狗狗可以打吗
18 王曼丽的狗狗训练