The PWM and servo one isn't quite clear as to the problem since the protocol for both are essentially the same. Unfortunately I don't have a servo to test with but I can't see any problems with the code.
Can you show the code that tells the servo to move and changes the PWM value?
I will update the code with the most recent changes but the only changes I made to the servo and pwm is I "or'd" the bits instead of added them and took in account for servos over pin 16
Also you no longer need to do a sendFirmareVersionRequest() if you are using my version as it handles that in the connection phase, though there is no harm in leaving that in.
