further implement the state machine of quad_swarm and GCS to SWARM_REPORT_STATE

TODO:
1.test the state machine.
2.find a way to alter the position the quadcopter should be sticking to.