1. please don't use init_nav_quadcopters(AC_ID)
2. add init_quadcopters() in Ground_Station class
3. add some functions for convienent usage of Swarm
4. implements something in quad_swarm.c