def main(argv):
arguments = len(argv) - 1
if arguments <= 0:
pose_type_string = prompt_pose_type_string()
# pose_type_string=""
else:
if arguments >= 1:
pose_type_string = sys.argv[1]
sensor_names = get_sensor_names()
target_names = get_target_names()
log = logger(sensor_names, target_names, pose_type_string)
filename = 'track_log_data'
filepath = "/home/tianpeng/{}.pkl".format(filename)
log.start(filepath=filepath)
for i in range(self.n_robots):
out = Float32MultiArray()
out.data = self.waypoints[:, i, :].ravel()
self.waypoint_pub[self.robot_names[i]].publish(out)
sim_time += 1 / self.awake_freq
if __name__ == '__main__':
print(sys.argv)
arguments = len(sys.argv) - 1
if arguments <= 0:
pose_type_string = prompt_pose_type_string()
else:
if arguments >= 1:
pose_type_string = sys.argv[1]
robot_names = get_sensor_names()
n_robots = len(robot_names)
mlt_controller=multi_robot_controller(robot_names,\
pose_type_string,\
awake_freq= 10,\
initial_movement_radius=0.8,
initial_movement_time=120,
# xlim=(0,2.4),\
# ylim=(0,4.5),\
