Up for 1/2 second, down for 1/2 second.
The program is pretty large, this will be a fix.
Preflight changes.
No sensors, removed debugging code.
Final motor pins.
Working on it... qq
Testing code, got stuff working.
Accel raw and filtered values work.
Both pitch and roll work! I can't actually believe it!
Improved offset and calculations.
Motor testing code. It works!
Lots of changes. This better work soon. Going to merge into master cuz yolo.