Made gain values dynamic and switched PID to targeting rather than speed based