A control system for a power steering system includes a motor; a control module in communication with the motor, the control module providing a compensated velocity loop command to the motor. The control module includes a stability compensation filter module that receives a vehicle speed and a velocity loop command, the stability compensation filter applies a second order filter on the velocity loop command to generate the compensated velocity loop command used by the motor.