本文整理汇总了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)