Shape matcher now publishes MatchedShape messages.
Added external callback to teleop policy. Teleop task now has follow_pipe state set by joystick.