sign macro added
jumped to one phase algo for debug purposes #53
position must be signed #53
corrected state init a bit #53
added simple calibration proses for debug, will be removed #53
feedback control redone a lot, optimisations included #53
Merge branch 'develop' of https://github.com/TheGreenBox/sattelite_step_drive into develop