Reimplemented DARE.
WIP: yaw rate controller working, need to simulate and output gains.