Revert "Start of plane flight system. Currently yaw gets locked to latlng. Need to refresh my linear algebra."

This reverts commit 44b00e7d843a591c238306e597acb2f75855594d.

I need to study some more before i start this.
Fixed issue which caused "<=" and ">=" not to work as intended. Ordering of array was a bit out of whack.