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