Function pfield::franka_ik_q4

Function Documentation

unsigned int pfield::franka_ik_q4(const array<double, 3> &r, const array<double, 9> &ROE, const double q4, array<array<double, 7>, 8> &qsols, const double q1_sing = M_PI_2, const double q7_sing = 0)

IK with q4 as free variable.

Parameters:

  • r – position of frame E with respect to frame O.

  • ROE – rotation matrix of frame E with respect to frame O (row-first format).

  • q4 – joint angle of joint 4 (radians)

  • qsols – array to store 8 solutions

  • q1_sing – [optional] emergency value of q1 in case of singularity at shoulder joints (type-1 singularity).

  • q7_sing – [optional] emergency value of q7 in case of singularity of S7 intersecting S (type-2 singularity).

Returns:

number of solutions found.