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实现统计给定字符串中重复模式最高子串功能示例

本文实例讲述了Python实现统计给定字符串中重复模式最高子串功能。分享给大家供大家参考,具体如下: 给定一个字符串,如何得到其中重复模式最高的子字符串,我采用的方法是使用滑窗机制,对给...

关于Python中的向量相加和numpy中的向量相加效率对比

直接使用Python来实现向量的相加 # -*-coding:utf-8-*- #向量相加 def pythonsum(n): a = range(n) b = range(n)...

python多线程并发实例及其优化

单线程执行 python的内置模块提供了两个内置模块:thread和threading,thread是源生模块,threading是扩展模块,在thread的基础上进行了封装及改进。所...

浅谈pyqt5在QMainWindow中布局的问题

引言: 在pyqt5中使用了父类为QMainWindow的话,在里面使用布局类,QGridLayout, QHBoxLayout ,QVBoxLayout 时,发现不好用。 解决: 如果...

python正则表达式匹配IP代码实例

这篇文章主要介绍了python正则表达式匹配IP代码实例,文中通过示例代码介绍的非常详细,对大家的学习或者工作具有一定的参考学习价值,需要的朋友可以参考下 import re re...