First complete version (untested) of the EKF SLAM desktop version. Implemented the predict() methods of breadcrumb and vins controllers.