Verified proper operation, fixed two bugs with new encoders.