2. Switched to level 5 IMU filter
3. logging setpoints
4. Logging for up to 5 minutes
5. Also accounting for time spent during logging when calculating LOOP_TIME
6. Logging during manual mode now, too.

bbartels authored 8 years ago and dawehr committed 8 years ago

Using the original Xilinx polling I2C send functions, if a slaved
NACKed, then the polling function would poll forever (infinite
loop). Copied the Xilinx function into our src and added a check
for NACK.

This resolves #1

Fixed issue with printf() hanging. Removed all printfs(). Don't use them!
Fixed issue with mismatched checksums not getting consumed