Initial version of STUFF. Basically just copied the robot_pose_ekf over.
Created the system model and measurement models
Edited copyright stuff
Currently not tested or anything!!