PD regulation and speed controls added