本文整理匯總了Python中nav_msgs.msg.OccupancyGrid.data[cell]方法的典型用法代碼示例。如果您正苦於以下問題:Python OccupancyGrid.data[cell]方法的具體用法?Python OccupancyGrid.data[cell]怎麽用?Python OccupancyGrid.data[cell]使用的例子?那麽, 這裏精選的方法代碼示例或許可以為您提供幫助。您也可以進一步了解該方法所在類nav_msgs.msg.OccupancyGrid
的用法示例。
在下文中一共展示了OccupancyGrid.data[cell]方法的1個代碼示例,這些例子默認根據受歡迎程度排序。您可以為喜歡或者感覺有用的代碼點讚,您的評價將有助於係統推薦出更棒的Python代碼示例。
示例1: mapCallback
# 需要導入模塊: from nav_msgs.msg import OccupancyGrid [as 別名]
# 或者: from nav_msgs.msg.OccupancyGrid import data[cell] [as 別名]
def mapCallback(msg):
print "Got map"
global expanded_map_pub
expansion_factor = int(math.ceil(rospy.get_param('expand_by', 1)/msg.info.resolution))
print expansion_factor
height = msg.info.height
width = msg.info.width
new_map = OccupancyGrid()
new_map.info = msg.info
new_map.data = [0 for x in range(width*height)]
for cell in range(0, width*height):
new_map.data[cell] = msg.data[cell]
for n in getNeighbors(msg, cell, expansion_factor):
if n > 50:
new_map.data[cell] = 100
break
print 'Publishing new map'
expanded_map_pub.publish(new_map)