init current angle formula updated
Merge branch 'master' of https://github.com/ras14-group2/robo_ctrl