BIG code cleanup

Also, fixed a bug where the code could disarm the copter in user mode