Function pfield::franka_swivel

Function Documentation

double pfield::franka_swivel(const array<double, 7> &q)

Calculates the swivel angle given the joint angles q.

Parameters:

q – joint angles.

Returns:

swivel angle theta (see paper for geometric defninition).