You use a discipline called inverse kinematics. You basically solve the equation given the position of the head with the constraints of the length of each section of the arm for the rotation of all the joints.
That’s the thing though, these aren’t open-loop stepper motors, these are likely AC servos with 50 to 1 strain wave gearboxes. Using gearbox input and output encoders to measure flex and lash in the system compared to input and target.
You need to develop a complex control equation to run this properly and the best equation is different for every different robot.
10
u/k1ng4400 1d ago
I am a software engineer myself and yet I have no clue how to make the firmware and software like this.