Merge branch 'forrest' into HEAD
Merge sub:~/catkin_ws/src/uf-mil/software-common into HEAD
legacy_vision: fixed comment
Merge sub:~/catkin_ws/src/uf-mil/software-common
legacy_vision: got manipulation finding pegs and shooter finding orientation error