Show the proper sketch. Above code contains errors, should not compile at all.
Split your program into basic parts.
Verify that your commands are decoded properly. You can use some LEDs to show which command is active. If this does not work, fix the errors in the input part.
Verify that the servos move. Use switches for the activation of the command functions. If this doesn't work as expected, fix the errors in the output part.