Switched entire pipeline to new Shape message

Goes in tandem with pull request in pr2_object_manipulation