Made PID gains independent of the control rate to fix #2.