control_system: adding a custom printf function for debug
control system: adding quadramp
cli: new command to set internal values