comments and first approach to define EKF for motor - not working though