Do not make motor control an own thread

Motorcontrol is member of kalman filter and will run in it's periodic
thread.
Also updated the pins associated with the directions