major refactoring of control_algo, something is broken now ^^ #48
Merge branch 'develop' of https://github.com/TheGreenBox/sattelite_step_drive into develop