Switched to constant pointers callback messages and unified style.  Converted controller to work in the quadrotor's body frame.  Fixed channel feedback sign and minor updated for control system.