Correct deg to rad conversion on offset correction
Change motor sign to adapt to mechanical set up