Would it be possible to get the code in the Teensy 4.1 sketch rewrote to use the PWMServo library for teensy?
I have a 6DOF arm that uses rc Servos. I would very much link to use the AR5 Control Software to control it and I think the if the Teensy 4.1 sketch was rewrote to use the PWMServo library that i would be able to do this.
I don't see why you couldn't do that. I'm not familiar with the PWMServo library but the AR4 motor control algorithm is designed for stepper motors so if the library is configured for step and direction pulses it should be possible.