Reference in acceleration
Adapted for using motor power instead of torque.
Controller can drive drone to desired attitude and desired linear
acceleration (by modifying attitude to get the rigt linear acceleration
vector). Setting attitude for linear acceleration is the priority rather
than setting the required attitude.
Will be modified to set linear velocity by modifying linear acceleration
rather that setting linear acceleration