最近重新学习nao的官方文档,写点简单的程序回顾一下。主要是用python调用api,写下来保存着。
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
|
'''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) |
以上就是本文的全部内容,希望对大家的学习有所帮助,也希望大家多多支持服务器之家。
原文链接:https://blog.csdn.net/u011181878/article/details/21048959