Function pfield::franka_J_ik_q4

Function Documentation

unsigned int pfield::franka_J_ik_q4(const array<double, 3> &r, const array<double, 9> &ROE, const double q4, array<array<array<double, 6>, 7>, 8> &Jsols, array<array<double, 7>, 8> &qsols, const bool joint_angles = false, const char Jacobian_ee = 'E', const double q1_sing = M_PI_2, const double q7_sing = 0)

IK to calculate Jacobian and joint angles 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).

  • Jsols – array to store 8 solutions for the Jacobians.

  • qsols – array to store 8 solutions for the joint angles.

  • joint_angles – [optional] if false only Jacobians are returned.

  • Jacobian_ee – [optional] ee frame of the Jacobian, not the IK (‘E’, ‘F’, ‘8’ or ‘6’).

  • 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.