本文整理汇总了Python中wrapper.Wrapper.packet方法的典型用法代码示例。如果您正苦于以下问题:Python Wrapper.packet方法的具体用法?Python Wrapper.packet怎么用?Python Wrapper.packet使用的例子?那么恭喜您, 这里精选的方法代码示例或许可以为您提供帮助。您也可以进一步了解该方法所在类wrapper.Wrapper
的用法示例。
在下文中一共展示了Wrapper.packet方法的1个代码示例,这些例子默认根据受欢迎程度排序。您可以为喜欢或者感觉有用的代码点赞,您的评价将有助于系统推荐出更棒的Python代码示例。
示例1: str
# 需要导入模块: from wrapper import Wrapper [as 别名]
# 或者: from wrapper.Wrapper import packet [as 别名]
kalfilter.prediction_update(.55*vel,.45*ang_vel,time_elapsed,True)
if(marker_dist != -1): #-1 means invalid measurements
print 'Marker Dist:' + str(marker_dist)
print 'Marker Angle:' + str(marker_angle)
marker_x,marker_y = kalfilter.guess_marker(marker_dist,marker_angle)
if(not colorseg_debug):
x,y,theta = kalfilter.get_pose()
kalfilter.measurement_update(marker_x,marker_y,marker_dist,marker_angle,second_dist,second_angle)
x,y,theta = kalfilter.get_pose()
#wrapper.packet = str((x,y))
#Obstacle avoidance stuff
current_x = int(round((x-GRID_SIZE)/GRID_SIZE))
current_y = int(round((y-GRID_SIZE)/GRID_SIZE))
wrapper.packet = str((x-GRID_SIZE)/(GRID_SIZE)) + ',' + str((y - GRID_SIZE)/(GRID_SIZE))+ ',' + str(time.clock()) + ',' + str(theta*(180/math.pi))
print 'Android Coordinates:', wrapper.packet
#get distances
print wrapper.ss, '!!!!!!!'
#try:
#print processQ.get(False), "!!!!!!!!!!!!"
#except Queue.Empty, e:
#print "Empty Queue"
#pass
update = False
if(vel > 0 and False):
if(wrapper.ss[0] > 5 and wrapper.ss[0] < 500):
front_dist = (wrapper.ss[0]+17)/(GRID_SIZE*100)
update = update or grid.update_grid((current_x,current_y),front_dist,kalfilter._X[2][0]+.4)