smaccmpilot: motor mixer implemented, smaccmpilot flies again!

* probably need to turn down the control loops a bit to compensate for
  higher mixing on the pitch and roll