Added angular motion

Added code to generate a target rotation matrix within the max tilt
limit based on the direction to the goal. From this it generates the
target angular velocity using quaternions that steers the quadcopter to
the goal.