An angle shift compensation system and method for controlling a sinusoidally driven motor to achieve efficient motion and reduced noise. The motor controller uses the angle shift compensation method to monitor the angle shift between a sinusoidal motor control signal configured to drive the motor and a feedback signal received from at least one position detector indicating the position of the motor rotor with respect to the motor stator. In response, the motor controller proportionally adjusts the amplitude of the motor control signal based on the monitored angle shift to maintain the angle shift substantially equal to an angle shift threshold.