Removed useles yarp ports, added get_duration, added exra check for synching with autopilot, changed planner to have less options to choose
after writing to radio, don't write for 50ms (hack to avoid the need for CTS line)
less logging, now using the "debug" option from the config.json
added sensorCO and sensorCam to config file