APM_Control: Modify D and I gain scaling