Switched entire pipeline to new Shape message

In tandem with pull request for object_manipulation