Working, but not perfect simulation code of the RC Pilot Controller. Code works for the square trajectory.

Added method to change PID gains. Anne needs to finish connecting the params into the Simulink PID blocks.