Some updates to car slam, using plot_point_slam as a hack to display
Arm state changes
Merge branch 'master' of https://github.com/gkahn13/bsp
updating beliefDynamics in slam.h