working PID + Kinematics + Motorcontrol

Dependencies:   HIDScope MODSERIAL QEI biquadFilter mbed

Revision:
9:59dc4c12e4ee
Parent:
0:a6f2b6cc83ca