Fixed visualization and added velocity mode for visualization
Updated README
Merge branch 'hydro-devel' of github.com:davetcoleman/baxter_cpp into hydro-devel