Adjusted GUI so that all display boxes are checked, and so that the scaling is applied to a CF when it is added (push_back) into the crazyflies_vector

Demo controller back into Master (this branch was used for developing nicer GUI and YAML parameter features for giving demonstrations of the system)

See merge request D-FaLL/PandS-System/D-FaLL-System!7

Merge branch 'demo_controller' of https://gitlab.ethz.ch/D-FaLL/PandS-System/D-FaLL-System into demo_controller

Started on making the Parameter Service more generic, compiled and tested, still needs full implementaiton

System prepared to start developing MPC controller. Included estimation part and crazyflie_angle_mode part. Need to clean a bit and test it in the real system, but it should work