Variables
int	damp = 1e-12

	data = model.createData()

int	DT = 1e-1

int	eps = 1e-4

	err = iMd.translation

	iMd = data.oMi[JOINT_ID].actInv(oMdes)

int	it = 0

int	IT_MAX = 1000

	J = pinocchio.computeJointJacobian(model, data, q, JOINT_ID)

int	JOINT_ID = 6

	model = pinocchio.buildSampleModelManipulator()

	oMdes = pinocchio.SE3(np.eye(3), np.array([1.0, 0.0, 1.0]))

	q = pinocchio.neutral(model)

bool	success = True

	v = -J.T.dot(solve(J.dot(J.T) + damp * np.eye(3), err))

Variable Documentation

◆ damp

int inverse-kinematics-3d.damp = 1e-12

Definition at line 15 of file inverse-kinematics-3d.py.

◆ data

inverse-kinematics-3d.data = model.createData()

Definition at line 6 of file inverse-kinematics-3d.py.

◆ DT

int inverse-kinematics-3d.DT = 1e-1

Definition at line 14 of file inverse-kinematics-3d.py.

◆ eps

int inverse-kinematics-3d.eps = 1e-4

Definition at line 12 of file inverse-kinematics-3d.py.

◆ err

inverse-kinematics-3d.err = iMd.translation

Definition at line 21 of file inverse-kinematics-3d.py.

◆ iMd

inverse-kinematics-3d.iMd = data.oMi[JOINT_ID].actInv(oMdes)

Definition at line 20 of file inverse-kinematics-3d.py.

◆ it

int inverse-kinematics-3d.it = 0

Definition at line 17 of file inverse-kinematics-3d.py.

◆ IT_MAX

int inverse-kinematics-3d.IT_MAX = 1000

Definition at line 13 of file inverse-kinematics-3d.py.

◆ J

inverse-kinematics-3d.J = pinocchio.computeJointJacobian(model, data, q, JOINT_ID)

Definition at line 28 of file inverse-kinematics-3d.py.

◆ JOINT_ID

int inverse-kinematics-3d.JOINT_ID = 6

Definition at line 8 of file inverse-kinematics-3d.py.

◆ model

inverse-kinematics-3d.model = pinocchio.buildSampleModelManipulator()

Definition at line 5 of file inverse-kinematics-3d.py.

◆ oMdes

inverse-kinematics-3d.oMdes = pinocchio.SE3(np.eye(3), np.array([1.0, 0.0, 1.0]))

Definition at line 9 of file inverse-kinematics-3d.py.

◆ q

inverse-kinematics-3d.q = pinocchio.neutral(model)

Definition at line 11 of file inverse-kinematics-3d.py.

◆ success

bool inverse-kinematics-3d.success = True

Definition at line 23 of file inverse-kinematics-3d.py.

◆ v

inverse-kinematics-3d.v = -J.T.dot(solve(J.dot(J.T) + damp * np.eye(3), err))

Definition at line 30 of file inverse-kinematics-3d.py.

Variables