def setCommand(self,command):
self.ros_msg_command.command = self.convertCommand(command['command'])
if (command.has_key("order")):
self.ros_msg_command.order.order_id = command['order']['order_id']
legos = command['order']['bricks']
self.ros_msg_command.order.bricks = []
for i in range(len(legos)):
self.ros_msg_command.order.bricks.append(lego_brick())
self.ros_msg_command.order.bricks[i].color = self.convertColor(legos[i]['color'])
self.ros_msg_command.order.bricks[i].size = legos[i]['size']
self.ros_msg_command.order.bricks[i].count = legos[i]['count']
else:
self.ros_msg_command.order.order_id = 0
self.ros_msg_command.order.bricks = []
return
def fillDummyData(self):
self.ros_msg_command.command = self.ros_msg_command.COMMAND_SORTBRICKS
self.ros_msg_command.order.order_id = 1
self.ros_msg_command.order.bricks.append(lego_brick(color=lego_brick.COLOR_RED, size=4, count=2))
self.ros_msg_command.order.bricks.append(lego_brick(color=lego_brick.COLOR_BLUE, size=6, count=5))
