Added bash command to plot pids.
Merge branch 'groovy_unstable' of github.com:uscauv/uscauv-ros-pkg into groovy_unstable
Changed rotation convention in shape matched.