[jreneew2]

Why not include some sort of ramping? Alter the code so that the closer you are to the set point, the slower you go. We did this with our vision and rotation to angles code and it works fine.