Initial true release

Sort of finished flying, calibrating PID, reading orientation.