MADE:
--> Change class point to template<type_>Point2 and typedef por int double and uint
--> First approach to StereoEKF

TODO:
--> Test EKF