kinematic model included

Dependencies:   Encoder MODSERIAL biquadFilter