Stretch robot and mobile manipulation planning

[carlosquinterop]

• Creates a convenience class for the Stretch robot/planning and two test scripts.
• Adds functions to the robot class to enable mobile manipulation planning. This feature relies on the existence of a kinematics solver plugin called base_manipulator_kinematics_plugin. See here.