Implement angle averaging on accelerometer.
Stuff
Fix accel code
Fix accel code
Please don't remove code unless you test it. Reverts past 3 commits.
Reverts all commits back to fc413 as this branch is for accelerometer testing.
Instantiate measurements, add averaging of 100 angle readings to SmartDashboard.
Finalize accelerometer testing. Add variables to change number of measurements and update interval.
Merge debug-accel into develop