C++ Code for Arduino Uno & 3 servo motors