Reintroduce wind. Increase rate to 500Hz (50% of the 1khz timer_handler)
Prune dead code.
Fix the stability path boolean value.
Restored the batt voltage after testing failsafe.
Super simple will fly in loiter mode.
Fixed stability patch defect I introduced where I am not restoring the motor power to full.
Minor changes to group take-offs sequences to the test that is currently being executed.
Reordered the boot order to follow the thread spin-up.  Added some pretty arbitrary sleep at the moment to wait for the threads to come online.  Should use a notification socket to signal synchronization is complete.
Reordered the cleanup command.
Temporarily disable batt decay (doesn't seem to change anything since I still get flight battery warnings)
Slight modification to log to renamed to flight_XX.log AFTER test is complete so I can tail a single log throughout a test iteration.