- Added code fix to scheduler for proper timing. fixed == 0 and changed it to <= 1. I believe this also fixed a locking issue where the system became unresponsive if there was a buffer overrun

- Added code on AHRS to only run if new gyroscope data was received (if its' different than the last received data).