#队形位置 geometry_msgs/Point[] formation_poses #位置点是否选取 bool[] assigned