System and Method for Controlling Redundant Actuators with Different Dynamics

A method for controlling a joint motion of redundant actuators including a first actuator and a second actuator to position a controlled parameter according to a reference trajectory including a sequence of points defining positions of the controlled parameter of the system as a function of time, wherein steps of the method are performed by a processor connected to a memory storing the reference trajectory and coupled with stored instructions implementing the method, wherein the instructions, when executed by the processor carry out at least some steps of the method comprising:

• determining, for an axis of control, an envelope bounding a first trajectory of the first actuator with respect to the reference trajectory in at least the axis of control and time domains, wherein the envelope is centered on the reference trajectory with a width not greater than a range of the second actuator;
• determining the shortest trajectory traversing the envelope along the time domain to produce the first trajectory of the first actuator;
• determining a second trajectory of the second actuator based on a difference between the reference trajectory and the positions the second actuator with respect to the reference trajectory governed by the first trajectory enabling the joint motions of the first actuator and the second actuator to position the controlled parameter of the system along the reference trajectory;
• and
• causing the first actuator to move according to the first trajectory and causing the second actuator to move according to the second trajectory.

A non-transitory computer readable storage medium embodied thereon a program executable by a processor for performing a method for controlling a joint motion of redundant actuators including a first actuator and a second actuator to position a controlled parameter according to a reference trajectory including a sequence of points defining positions of the controlled parameter of the system as a function of time, the method comprising:

• determining, for an axis of control, an envelope bounding a first trajectory of the first actuator with respect to the reference trajectory in at least the axis of control and time domains, wherein the envelope is centered on the reference trajectory with a width not greater than a range of the second actuator;
• determining the shortest trajectory traversing the envelope along the time domain to produce the first trajectory of the first actuator;
• determining a second trajectory of the second actuator based on a difference between the reference trajectory and the positions the second actuator with respect to the reference trajectory governed by the first trajectory enabling the joint motions of the first actuator and the second actuator to position the controlled parameter of the system along the reference trajectory;
• and
• causing the first actuator to move according to the first trajectory and causing the second actuator to move according to the second trajectory.