Tidied up ptam class code
Added function to receive teleop reference positions
Changed velocity estimation to only activate after enough frames have been received
Created subscription to the teleopRef topic