Actuator Limit Constraints

Here, we assume that all articulations are revolute and therefore all actuation limits are torque limits, however, expression of force limits for prismatic joints would be another possibility. Writing these limits as an inequality provides an upper and lower bound on the amount of torque which can be exerted to accomplish the tasks.

(1)\torque_{\text{min}} \leq \torque \leq \torque_{\text{max}} \tp

Expressing torque_limits in terms of \optvar creates the following linear inequality,

(2)\underbrace{\bmat{ \0 & S^{\top} & \0 \\ \bs{0} & -S^{\top} & \0 }}_{G^{\torque}}\optvar \leq \underbrace{\bmat{ \torque_{\text{max}} \\ -\torque_{\text{min}} }}_{\bs{h}^{\torque}} \tp

Important

To put this into ORCA standard form we have,

\torque_{\text{min}} \leq \bmat{ \0 & S^{\top} & \0}\optvar \leq \torque_{\text{max}}