Filipe-Moleiro:
I tried the code, connected the 3 servos to the pin9, and they are working exatcly the same, but only in the yaw axis. Is the code supposed to do with only 1 servo, or do I have to put the other servos in different pins so that each one work in their respective axis?
So you are saying that if you connect up 1 servo to pin 9 that it works exactly the way you want it to for the yaw axis?
Now copy what I did for the yaw to the pitch and roll and assign them to other pins that you wish to use