Added odometry to support global pose (x, ,y theta). Still needs to output vectors for visual spelndor.