PD Controller Modification for line following maths example