the kalman filter is fully implemented and tested with the stereo setup, code for the mono camera has been implemented