Well that code doesn't even compile. Do you have a version that does at least compile and do something?
If you do get it working you will need to provide more detail than just "doesn't work". What does it do? What should it be doing differently? Most of us won't have access to that particular servo so we can't really do the testing for you.
Steve