Positive velocity and position feedback (PVPF) is a widely used control scheme in lightly damped resonant systems with collocated sensor actuator pairs. The popularity of PVPF is due to the ability to achieve a chosen damping ratio by repositioning the poles of the system. The addition of a tracking controller, to reduce the effects of inherent nonlinearities, causes the poles to deviate from the intended location and can be a detriment to the damping achieved. By designing the PVPF and tracking controllers simultaneously, the optimal damping and tracking can be achieved. Simulations show full damping of the first resonance mode and significantly higher bandwidth than that achieved using the traditional PVPF design method, allowing for high-speed scanning with accurate tracking. Experimental results are also provided to verify performance in implementation.