Mega and 6 Ax-12A Servos

mlerner:
How would you suggest controlling the frequency?

After you send a command, don't send another command until enough time has elapsed to be certain that the command has finished transmission. It is pointless (and actually counterproductive) to poll the state of your inputs looking for changes that need to be commanded, until you are in a position to actually send the next command.