Skip to content

Kinematics Verification

This tutorial demonstrates how to verify the forward and inverse kinematics of the Agilebot robot.

Overview

Kinematics verification is used to check the relationship between the robot's joint configuration and end-effector position. This includes:

  • Forward Kinematics: Calculate end-effector position from joint angles
  • Inverse Kinematics: Calculate joint angles from end-effector position

Prerequisites

Forward Kinematics Verification

Using Project Demo Script

bash
cd agilebot_isaac_sim
python agilebot_integration/demos/fk_verification.py

Forward Kinematics Description

Forward kinematics is used to verify if the robot's joint configuration is correct and if the end-effector position meets expectations.

Inverse Kinematics Verification

Using Project Demo Script

bash
cd agilebot_isaac_sim
python agilebot_integration/demos/ik_verification.py

Inverse Kinematics Description

Inverse kinematics is used to verify if the robot can reach specified end-effector positions.

IK Solvers

Agilebot robots support various IK solvers:

SolverDescriptionUse Case
Jacobian Pseudo-inverseJacobian pseudo-inverse methodGeneral cases
Damped Least SquaresDamped least squares methodNear singularities
Jacobian TransposeJacobian transpose methodSimple cases

Configuration Parameters

Kinematics Parameters

ParameterDescriptionDefault Value
ik_solverIK solver typeJacobian Pseudo-inverse
ik_toleranceIK solving tolerance0.001 m
ik_max_iterationsIK maximum iterations100
joint_limitsJoint limitsBased on robot model

Customizing Kinematics Verification

Modify Joint Positions

Modify Target Positions

Modify IK Solver

Common Issues

Q: IK solving fails

A: Check if the target position is within the robot's workspace. Try different IK solvers or adjust the ik_tolerance parameter.

Q: Robot motion is discontinuous

A: Check if joint limits are correctly set. Ensure joint positions are within valid ranges.

Q: Forward kinematics results are incorrect

A: Check if the robot model is loaded correctly. Verify that joint configurations meet expectations.

Next Steps