Kalman filter implemented with pendulum encoder and ADC input for servo. Pendulum works as expected. Unable to read from second encoder still.