Cannot control cluster orientation

[alvgaona]

The task allocation controller controls every state variable from the cluster state-space vector but the yaw angle. After introducing the yaw angle as a variable to control, the controller cannot stabilize the cluster position and orientation.