python程序控制NAO機器人行走
更新時間:2019年04月29日 09:52:03 作者:Earl_Martin
這篇文章主要為大家詳細介紹了python程序控制NAO機器人行走,具有一定的參考價值,感興趣的小伙伴們可以參考一下
最近重新學習nao的官方文檔,寫點簡單的程序回顧一下。主要是用python調用api,寫下來保存著。
'''Walk:small example to make nao walk''' import sys import motion import time from naoqi import ALProxy def StiffnessOn(proxy): #we use the 'body' to signify the collection of all joints pName="Body" pStiffnessLists=1.0 pTimeLists=1.0 proxy.stiffnessInterpolation(pName,pStiffnessLists,pTimeLists) def main(robotIP): #init proxies try: motionProxy=ALProxy("ALMotion",robotIP,9559) except Exception,e: print "could not create proxy to ALMotion" print"error was",e try: postureProxy=ALProxy("ALRobotPosture",robotIP,9559) except Exception,e: print"could not create proxy to ALRobotPosture" print "error is ",e #set nao in stiffness on StiffnessOn(motionProxy) #send nao to pose init postureProxy.goToPosture("StandInit",0.5); #eable arms control by walk algorithm motionProxy.setWalkArmsEable(True,True) #foot contact protection motionProxy.setMotionConfig([["ENABLE_FOOT_CONTACT_PROTECTION",True]]) #target velocity X=-0.5 #backward Y=0.0 Theta=0.0 Frequency=0.0#low speed motionProxy.setWalkTargetVelocity(X,Y.Theta,Frequency) time.sleep(4.0) #target velocity X=0.9 Y=0.0 Theta=0.0 Frenqency=1.0#max speed motionProxy.setWalkTargetVelocity(X,Y,Theta,Frenquency) time.sleep(2.0) #arms user motion #arms motion from user have alwalys priority than walk arms motion JoinNames=["LShouderPitch","LShouderRoll","LElbowYaw","LElbowRoll"] Arm1=[-40,25,0,-40] Arm1=[x*motion.TO_RAD for x in Aram1] Arm2=[-40,50,0,-80] Arm2=[x*motion.TO_RAD for x in Aram2] pFractionMaxSpeed=0.6 motionProxy.angleInterpolationWithSpeed(JoinNames,Arms1,pFractionMaxSpeed) motionProxy.angleInterpolationWithSpeed(JoinNames,Arms2,pFractionMaxSpeed) motionProxy.angleInterpolationWithSpeed(JoinNames,Arms1,pFractionMaxSpeed) #end walk X=0.0 Y=0.0 Theta=0.0 motionProxy.setWalkTargetVelocity(X,Y,Theta,Frequency) if __name__=="__main__": robotIP="192.168.1.155" if len(sys.argv)<=1: print "useage pyhton motion_walk.py robotIP,default is 127.0.0.1" else: robotIp=sys.argv[1] main(robotIP)
以上就是本文的全部內容,希望對大家的學習有所幫助,也希望大家多多支持腳本之家。
相關文章
Python中判斷語句入門指南(if?elif?else語句)
if elif else語句是Python中的控制語句,用于根據(jù)條件執(zhí)行不同的操作,下面這篇文章主要給大家介紹了關于Python中判斷語句入門指南(if?elif?else語句)的相關資料,文中通過實例代碼介紹的非常詳細,需要的朋友可以參考下2023-05-05Python函數(shù)之iterrows(),iteritems(),itertuples()的區(qū)別說明
這篇文章主要介紹了Python函數(shù)之iterrows(),iteritems(),itertuples()的區(qū)別說明,具有很好的參考價值,希望對大家有所幫助。如有錯誤或未考慮完全的地方,望不吝賜教2022-05-05Python中棧、隊列與優(yōu)先級隊列的實現(xiàn)方法
這篇文章主要給大家介紹了關于Python中棧、隊列與優(yōu)先級隊列的實現(xiàn)方法,文中通過示例代碼介紹的非常詳細,對大家學習或者使用python具有一定的參考學習價值,需要的朋友們下面來一起學習學習吧2019-06-06