Untested attempt at implementing both encoders.
Fixed gyro issues: increased gyroDataHolder size to fit all the samples and made sumOfGyroData 32 bits in case the average gets too large.