Rewrote control code for rotors that are already calibrated. Is now vaguely sensible in its approach.