modified P control calculations
Disabling P control