compiled with no problem.
Yet to test with real quad.
changed to 10inch quad in M file.
minor bug in stateflow for heading and constraint.