python简单实现nao机器人身体躯干和腿部的动作

跟上一篇类似,代码没什么难度,可以进行扩展。

#-*-encoding:UTF-8-*-
'''control nao's left foot,
    cartesian control:torso and foot trajectories
    '''

import sys
import motion
from naoqi import ALProxy

def StiffnessOn(proxy):
               pNmaes="Body"
               pStiffnessLists=1.0
               pTimeLists=1.0
               proxy.stiffnessInterpolation(pName,pStiffnessLists,pTimeLists)

def main(robotIP):
               '''example of cartesian foot trajectory
               '''
               try :
                              motionProxy=ALProxy("ALMotion",robotIP,9559)
               except Exception,e:
                              print "could not create a proxy"
                              print "error is ",e
               

               try:
                              postureProxy=ALProxy("ALRobotPosture",robotIP,9559)
               
               except  Exception ,e:
                              print "could not create a proxy"
                              print"error is",e

               StiffnessOn(motionProxy)
               #send nao to pose init
               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]
               #lower the torso and move the size
               effector="Torso"
               time=2.0
               motionProxy.positionInterpolation(effector,space,path,axisMask,time,isAbsolute)

               #lleg motion
               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"
               if len(sys.argv)<=1:
                              print "usage python robotIP"
               else:
                              robotIP=sys.argv[1]
               main(robotIP)










               


  • 3
    点赞
  • 11
    收藏
    觉得还不错? 一键收藏
  • 3
    评论
评论 3
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值