Expand description
Generalized N-joint planar arm inverse kinematics and control.
Uses the Jacobian pseudo-inverse method to solve inverse kinematics for a planar arm with an arbitrary number of revolute joints.
Reference: PythonRobotics ArmNavigation/n_joint_arm_to_point_control
Structs§
- NLink
Arm - A planar N-link arm with forward and inverse kinematics.
Functions§
- angle_
mod - Normalizes an angle to the range [-pi, pi].
- distance_
to_ goal - Computes the distance and error vector from current position to goal.
- forward_
kinematics - Computes the forward kinematics for given link lengths and joint angles.
- inverse_
kinematics - Solves inverse kinematics using the Jacobian pseudo-inverse method.
- inverse_
kinematics_ with_ params - Solves inverse kinematics with configurable iteration limit and threshold.
- move_
to_ goal - Runs the proportional-control IK loop: smoothly moves from current angles toward goal angles.