Fixed double correction add
Converted to header PID