本文整理汇总了Python中PyPR2.addTimer方法的典型用法代码示例。如果您正苦于以下问题:Python PyPR2.addTimer方法的具体用法?Python PyPR2.addTimer怎么用?Python PyPR2.addTimer使用的例子?那么恭喜您, 这里精选的方法代码示例或许可以为您提供帮助。您也可以进一步了解该方法所在类PyPR2
的用法示例。
在下文中一共展示了PyPR2.addTimer方法的4个代码示例,这些例子默认根据受欢迎程度排序。您可以为喜欢或者感觉有用的代码点赞,您的评价将有助于系统推荐出更棒的Python代码示例。
示例1: onHumanTracking
# 需要导入模块: import PyPR2 [as 别名]
# 或者: from PyPR2 import addTimer [as 别名]
def onHumanTracking(tracking_objs):
#global busymoving
#SHOOTING_TAG = 0
#global start_time,last_action_counter,movement_tracker,msgTryTimer,d,x,y,track_x,track_y,track_d,elapsed_time,focus_obj,HUMAN_DETECTION_COUNTER
global a2,b2,NEW_INTERACTION_INITIALISER, NumPeople, HumanPresence, x, y, msgTryTimer
NumPeople = len(tracking_objs)
a2 +=1
if len(tracking_objs)==0:
NEW_INTERACTION_INITIALISER += 1
if HumanPresence == True:
PyPR2.removeTimer(msgTryTimer)
if NEW_INTERACTION_INITIALISER > 500:
restoreInitialState()
HumanPresence = False
elif len(tracking_objs) > 0:
if HumanPresence== False:
PyPR2.onTimer = timerActions
msgTryTimer = PyPR2.addTimer(1,-1,0.5)
b2+=1
#st_time = time.time()
#no_objTracker.append(elapsed_time)
HumanPresence = True
object_index = closest_obj_index(tracking_objs)
focus_obj = tracking_objs[object_index]
x = focus_obj['est_pos'][0]
y = focus_obj['est_pos'][1]
mid_x = focus_obj['bound'][0] + focus_obj['bound'][2] / 2
mid_y = focus_obj['bound'][1] + focus_obj['bound'][3] / 2
ofs_x = mid_x - 320
ofs_y = mid_y - 240
chx = chy = 0.0
if math.fabs(ofs_x) > 10:
chx = -ofs_x * 90.0 / 640 * 0.01745329252
#head_yaw_list.append(chx)
if math.fabs(ofs_y) > 10:
chy = ofs_y * 90.0 / 640 * 0.01745329252
PyPR2.updateHeadPos( chx, chy )
示例2: onHumanTracking
# 需要导入模块: import PyPR2 [as 别名]
# 或者: from PyPR2 import addTimer [as 别名]
def onHumanTracking(tracking_objs):
global HUMAN_COUNTER,track_data,msgTryTimer,x,y,d,st_time
if len(tracking_objs) !=0:
if HUMAN_COUNTER ==0:
PyPR2.onTimer = timerActions
msgTryTimer = PyPR2.addTimer(1,-1,2)
elapsed_time = time.time() - st_time
no_objTracker.append((elapsed_time,time.time()))
HUMAN_COUNTER= len(tracking_objs)
object_index = closest_obj_index(tracking_objs)
focus_obj = tracking_objs[object_index]
x = focus_obj['est_pos'][0]
y = focus_obj['est_pos'][1]
d = math.sqrt((math.pow(x,2))+(math.pow(y,2)))
# track_y.append(y)
mid_x = focus_obj['bound'][0] + focus_obj['bound'][2] / 2
mid_y = focus_obj['bound'][1] + focus_obj['bound'][3] / 2
#print "track obj {} mid pt ({}.{})".format(focus_obj['track_id'],mid_x,mid_y)
ofs_x = mid_x - 320
ofs_y = mid_y - 240
chx = chy = 0.0
if math.fabs(ofs_x) > 10:
chx = -ofs_x * 90.0 / 640 * 0.01745329252
#head_yaw_list.append(chx)
if math.fabs(ofs_y) > 10:
chy = ofs_y * 90.0 / 640 * 0.01745329252
PyPR2.updateHeadPos( chx, chy )
else:
if HUMAN_COUNTER !=0:
PyPR2.removeTimer(msgTryTimer)
#msgTryTimer = -1
st_time = time.time()
HUMAN_COUNTER =0
示例3: onHumanTracking
# 需要导入模块: import PyPR2 [as 别名]
# 或者: from PyPR2 import addTimer [as 别名]
def onHumanTracking(tracking_objs):
global start_time,last_action_counter,movement_tracker,msgTryTimer,d,x,y,track_x,track_y,track_d,elapsed_time,focus_obj,HUMAN_DETECTION_COUNTER
if len(tracking_objs)==0:
PyPR2.removeTimer(msgTryTimer)
HUMAN_DETECTION_COUNTER=0
elapsed_time = time.time() - start_time
object_index = closest_obj_index(tracking_objs)
focus_obj = tracking_objs[object_index]
x = focus_obj['est_pos'][0]
y = focus_obj['est_pos'][1]
track_x.append(x)
track_y.append(y)
#track_d.append((elapsed_time,x,y))
mid_x = focus_obj['bound'][0] + focus_obj['bound'][2] / 2
mid_y = focus_obj['bound'][1] + focus_obj['bound'][3] / 2
#print "track obj {} mid pt ({}.{})".format(focus_obj['track_id'],mid_x,mid_y)
ofs_x = mid_x - 320
ofs_y = mid_y - 240
chx = chy = 0.0
if math.fabs(ofs_x) > 10:
chx = -ofs_x * 90.0 / 640 * 0.01745329252
#head_yaw_list.append(chx)
if math.fabs(ofs_y) > 10:
chy = ofs_y * 90.0 / 640 * 0.01745329252
PyPR2.updateHeadPos( chx, chy )
PyPR2.onTimer = timerActions
if msgTryTimer==-1:
#PyPR2.tuckBothArms()
msgTryTimer = PyPR2.addTimer( 1, -1, 2 ) #changed just for testing the isStationeryCase()
'''
示例4: onHumanTracking
# 需要导入模块: import PyPR2 [as 别名]
# 或者: from PyPR2 import addTimer [as 别名]
def onHumanTracking(tracking_objs):
global HUMAN_COUNTER, st_time,msgTryTimer,x,y,Numpeople,avg_y,avg_x,actionIdentifier,isNearest
#focus_obj = tracking_objs[object_inde x]
Numpeople = len(tracking_objs)
avgPos(tracking_objs)
if len(tracking_objs) == 0:
#PyPR2.cancelMoveBodyAction()
if HUMAN_COUNTER !=0:
PyPR2.removeTimer(msgTryTimer)
PyPR2.moveArmWithJointPos(**initial_left)
PyPR2.moveArmWithJointPos(**initial_right)
#msgTryTimer = -1
#elapsed_time = time.time()-st_time
HUMAN_COUNTER =0
elif len(tracking_objs) > 0:
if HUMAN_COUNTER ==0:
PyPR2.onTimer = timerActions
msgTryTimer = PyPR2.addTimer(1,-1,0.5)
#a +=1
#st_time = time.time()
#no_objTracker.append(elapsed_time)
HUMAN_COUNTER= Numpeople
object_index = closest_obj_index(tracking_objs)
focus_obj = tracking_objs[object_index]
x = focus_obj['est_pos'][0]
y = focus_obj['est_pos'][1]
d = math.sqrt((math.pow(x,2))+(math.pow(y,2)))
if d<0.1:
PyPR2.cancelMoveBodyAction()
PyPR2.cancelMoveArmAction(True)
PyPR2.cancelMoveArmAction(False)
#c+=1
# track_y.append(y)
mid_x = focus_obj['bound'][0] + focus_obj['bound'][2] / 2
mid_y = focus_obj['bound'][1] + focus_obj['bound'][3] / 2
#print "track obj {} mid pt ({}.{})".format(focus_obj['track_id'],mid_x,mid_y)
ofs_x = mid_x - 320
ofs_y = mid_y - 240
chx = chy = 0.0
if math.fabs(ofs_x) > 10:
chx = -ofs_x * 90.0 / 640 * 0.01745329252
#head_yaw_list.append(chx)
if math.fabs(ofs_y) > 10:
chy = ofs_y * 90.0 / 640 * 0.01745329252
PyPR2.updateHeadPos( chx, chy )
if Numpeople ==1:
if x>3.5:
if isNearest == False:
if y>0:
PyPR2.moveArmWithJointPos(**initial_left)
actionIdentifier= "initial_left"
else:
PyPR2.moveArmWithJointPos(**initial_right)
actionIdentifier= "initial_right"
elif 2.5<x<3.5:
PyPR2.moveTorsoBy(0.1,2)
if y>0:
PyPR2.moveArmWithJointPos(**second_left)
actionIdentifier = "second_left"
else:
PyPR2.moveArmWithJointPos(**second_right)
actionIdentifier = "second_right"
elif 1.5<x<2.5:
PyPR2.moveTorsoBy(0.1,2)
isNearest = True
if y>0:
PyPR2.moveArmWithJointPos(**third_left)
actionIdentifier = "third_left"
else:
PyPR2.moveArmWithJointPos(**third_right)
actionIdentifier = "third_right"
else:
isNearest = True
PyPR2.moveArmWithJointPos(**full_stretch_left)
PyPR2.moveArmWithJointPos(**full_stretch_right)
actionIdentifier = "full_stretch"
if 1<Numpeople<3:
#.........这里部分代码省略.........