robot_storage.addRobot(binbot1, "robot_4")
robot_storage.addRobot(binbot2, "robot_5")
robot_storage.addRobot(binbot3, "robot_6")
robot_storage.addRobot(binbot4, "robot_7")
robot_storage.addRobot(picker1, "robot_8")
robot_storage.addRobot(picker2, "robot_9")
robot_storage.addRobot(picker3, "robot_10")
robot_storage.addRobot(carrier1, "robot_11")
robot_storage.addRobot(carrier2, "robot_12")
rate = rospy.Rate(10)
# Continually execute robots in execution loop.
while not rospy.is_shutdown():
animal.execute()
tractor.execute()
person1.execute()
person2.execute()
picker1.execute()
picker2.execute()
picker3.execute()
carrier1.execute()
carrier2.execute()
binbot1.execute()
binbot2.execute()
binbot3.execute()
binbot4.execute()
rate.sleep()
robot_storage.addRobot(binbot1, "robot_4")
robot_storage.addRobot(binbot2, "robot_5")
robot_storage.addRobot(binbot3, "robot_6")
robot_storage.addRobot(binbot4, "robot_7")
robot_storage.addRobot(picker1, "robot_8")
robot_storage.addRobot(picker2, "robot_9")
robot_storage.addRobot(picker3, "robot_10")
robot_storage.addRobot(carrier1, "robot_11")
robot_storage.addRobot(carrier2, "robot_12")
rate = rospy.Rate(10)
# Continually execute robots in execution loop.
while not rospy.is_shutdown():
animal.execute()
tractor.execute()
person1.execute()
person2.execute()
picker1.execute()
picker2.execute()
picker3.execute()
carrier1.execute()
carrier2.execute()
binbot1.execute()
binbot2.execute()
binbot3.execute()
binbot4.execute()
rate.sleep()
