Simple Proportional Control Algorithm
changed parameters