Much less buggy flight code. Still solving gimbal lock problem and debugging.