RobotState class added, untested.
Added test class.
Added PI to constants.
Merge branch 'master' of https://github.com/sid24ss/particle_filter