Function pfield::franka_ik_q7

Function Documentation

unsigned int pfield::franka_ik_q7(const array<double, 3> &r, const array<double, 9> &ROE, const double q7, array<array<double, 7>, 8> &qsols, const double q1_sing = M_PI_2)

IK with q7 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).

  • q7 – joint angle of joint 7 (radians)

  • qsols – array to store 8 solutions

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

Returns:

number of solutions found.