PD heading control