Hi,
Start a post in Programming Questions.
You will be better off starting from scratch with your own code.
Do the servo library examples first, they will give you about 80% of what you need.
Post a circuit diagram as well, showing how you power everything, especially your servos.
Tom.... 