Isolated proportional gain term from control output to decouple tuning parameters.

Fork of PID by Aaron Berk