Hello, thanks for the fast reply. Below is the part that doesn't work. I have two FS90R servos in mirror to each other so need to drive in CW and CCW. Example, from the back of the robot the left leg is left right is right, left would have to turn CCW and the right CW for the robot to "GO FORWARD" and reverse code to "GO BACKWARD"
the servo pins left in PCA9685 are pin 4 and the right in 5
// case 22: //Fixed command "Go Forward"
//pwm.setPWM(SERVOPINLT, 0, SERVO_REVERSE);
//pwm.setPWM(SERVOPINRT, 0, SERVO_FORWARD);
//delay(1000);
//Serial.println("received 'Go Forward',command flag '22'");
//pwm.setPWM(SERVOPINLT, 0, 1500);
//pwm.setPWM(SERVOPINRT, 0, 1500);
//delay(100);
//break;
Iam not sure how to work this code format thing sorry.