Now the safe controller is actually safe.
PID parameters are now based on MATLAB Simulink data.
They kinda work. Like.. smooth you know...