Keeps track of the robot pose