Doesn't a 500cpr encoder with a G320 need 2000 steps per revolution? What is your steps/unit set at in Mach3? Also, what voltage are you supplying. A servos top speed is related to the voltage you supply it. And lastly, the newer versions of Mach3 have a 100Khz mode, if you have a fast PC.