PID P gain control  implemented