System design, modelling, and tracking filter for bearings only analog camera

In this paper, each subsystem of the Celestial Sensor is discussed with emphasis given to the filtering algorithms. The celestial sensor software processes sequential frame based bearing measurements on a peripheral CPY specifically designed for this application. A frame preprocessor is used to normalize each bearing measurement and apply a number of accept/reject rules. The accepted set of measurements is then passed to an Extended Kalman Filter (EKP) that is tuned to track the motion of the robot within the room.