本文整理汇总了Python中PyPR2.moveArWithJointPos方法的典型用法代码示例。如果您正苦于以下问题:Python PyPR2.moveArWithJointPos方法的具体用法?Python PyPR2.moveArWithJointPos怎么用?Python PyPR2.moveArWithJointPos使用的例子?那么恭喜您, 这里精选的方法代码示例或许可以为您提供帮助。您也可以进一步了解该方法所在类PyPR2
的用法示例。
在下文中一共展示了PyPR2.moveArWithJointPos方法的1个代码示例,这些例子默认根据受欢迎程度排序。您可以为喜欢或者感觉有用的代码点赞,您的评价将有助于系统推荐出更棒的Python代码示例。
示例1: timerActions
# 需要导入模块: import PyPR2 [as 别名]
# 或者: from PyPR2 import moveArWithJointPos [as 别名]
def timerActions( id ):
global msgTryTimer,busy_moving,track_d,last_action_counter,d,start_time,x,y,elapsed_time,focus_obj,a
if msgTryTimer == id :
#PyPR2.removeTimer( msgTryTimer )
#msgTryTimer += 1
#while True:
#time.sleep(1)
if abs(a-focus_obj['est_pos'][0]) < 0.04:
a = focus_obj['est_pos'][0]
PyPR2.moveBodyTo(0.1,0.0,0.0,1)
else:
a = focus_obj['est_pos'][0]
d = math.sqrt(math.pow(x,2)+math.pow(y,2))
adjust_to_shooting()
'''
with open(csvfile, "w") as output:
writer = csv.writer(output, lineterminator='\n')
writer.writerows(track_d)
'''
#PyPR2.moveTorsoBy(0.03,5)
#if abs(previous_pos - focus_obj['est_pos'][0])< 0.1:
# PyPR2.moveHeadTo(0.2,1.0)
#adjust_to_shooting()
#if busymoving>0: busymoving-=1
if d>=3.5:
if last_action_counter <4 and last_action_counter!=0:
#obj.larm_reference = True
#obj.arm_down()
PyPR2.moveArmWithJointPos(**right_high_five)
PyPR.moveArmWithJointPos(**shooting_back_down)
last_action_counter=4
#busymoving=3
elif last_action_counter == 4:
PyPR2.moveTorsoBy(0.1,2)
PyPR2.say("Move Back")
#busymoving=5
else:
PyPR2.moveArmWithJointPos(**left_shooting)
last_action_counter=4
#busymoving=5
elif d<=3.5 and d>3:
if last_action_counter <3 and last_action_counter!=0:
PyPR2.moveArmWithJointPos(**shooting_down)
#obj.larm_reference = False
#obj.arm_right()
#PyPR2.moveBodyTo(0.01,0.0,0.0,1)
last_action_counter=3
elif last_action_counter ==3:
PyPR2.moveBodyTo(0.07,0.0,0.0,0.51)
#busymoving=10
elif last_action_counter ==0:
PyPR2.moveArmWithJointPos(**left_shooting)
PyPR2.moveArWithJointPos(**alt_right_shooting)
#busymoving=10
PyPR2.say("Move Back")
else:
PyPR2.moveArmWithJointPos(**alt_right_shooting)
PyPR2.moveArmWithJointPos(**left_shooting)
last_action_counter=3
elif d<=3 and d >2:
if last_action_counter <2 and last_action_counter!=0:
#obj.larm_reference = False
#obj.arm_right()
PyPR2.moveArmWithJointPos(**left_relax1)
last_action_counter=2
#elif last_action_counter==0:
else:
PyPR2.moveArmWithJointPos(**alt_right_shooting)
PyPR2.moveArmWithJointPos(**left_shooting)
PyPR2.closeGripper(2)
#PyPR2.closeGripper(2)
last_action_counter =2
#previous_pos = focus_obj['est_pos'][0]
#movement_tracker.append(str(CONDITION_TAG)+":"+str(focus_obj['est_pos']))
#.........这里部分代码省略.........