ok so i have 2 servos working, but when i try to add a 3rd, all the servos stop working completely, but i can still drive the robot. When i push the buttons for the servos, the drive terrain starts moving. I have posted the code and could really use some help with getting all the servos to work.
3rd servo4.zip (598 KB)
3rd servo4.zip (598 KB)
I believe you have a problem with your motor and servo configurations. Both your motor controller and servo controller seem to be configured to be the first in the daisy chain.
It would be really helpful if you could post your motor configuration and servo configuration files. And the program with 2 servos working.
I would also recommend not using two joystick reads for the same controller. Though I haven’t seen it ruin a program, I have seen it increase the possibility of logic problems.
Also, when teleop is offline or the main loop is “False” you are using the template motor configurations to stop the robot. What would be more common to do is use the configuration file you are using to actually move the robot and also use it to stop the robot.
Other than those details, which shouldn’t break the code, the actual code for the servo looks correct so I suspect something is wrong in either wiring or in the configurations.