Adds GoalTransform class to be used for constrained teleop
teleop.py: No need for _status_display to be a global
Move files around, move teleop.py into scripts

Adhere to ROS recommendations for rospy package
fix imports
Move classes out of teleop.py