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

yipeiwu_com6年前Python基础

本文实例为大家分享了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)

以上就是本文的全部内容,希望对大家的学习有所帮助,也希望大家多多支持【听图阁-专注于Python设计】。

相关文章

Python Scapy随心所欲研究TCP协议栈

1. 前言 如果只需要研究Linux的tcp协议栈行为,只需要使用packetdrill就能够满足我的所有需求。packetdrill才是让我随心所欲地撩tcp协议栈。packetdri...

Python unittest模块用法实例分析

本文实例讲述了Python unittest模块用法。分享给大家供大家参考,具体如下: python的unittest模块提供了一个测试框架,只要我们写一个继承unittest.Test...

python 函数的缺省参数使用注意事项分析

本文实例讲述了python 函数的缺省参数使用注意事项。分享给大家供大家参考,具体如下: python的函数支持4种形式的参数:分别是必选参数、 缺省参数、 可变长参数、关键字参数;而且...

Python实现设置windows桌面壁纸代码分享

每天换一个壁纸,每天好心情。 # -*- coding: UTF-8 -*- from __future__ import unicode_literals import Ima...

Python3中urlencode和urldecode的用法详解

在Python3中,将中文进行urlencode编码使用函数 urllib.parse.quote(string, safe='/', encoding=None, errors=N...