Update formation_drive_pose.launch