Second encoder framework implemented. Original controller using ADC and Pendulum encoder works with framework.
Kalman Filter with readADC not workign yet. Pendulum zero position is offset.