Added EKF for trajectory error estimation
Added line follower motion planner
added control matrix computation, TODO: finish the measurement matrix computation
completed and bug removal on the EKF
typo