Move files around, move teleop.py into scripts

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