Attempt at a stabilized body frame acro controller.  Functions are not actually called yet.  Do not use.