BB.IK.DLS

A Damped Least Squares (Levenberg-Marquardt) inverse kinematics solver for the Beam Bots robotics framework.

DLS computes the joint angles needed to position an end-effector at a target location and orientation. The damping factor prevents instability near kinematic singularities where standard pseudoinverse methods become ill-conditioned.

Features

• Position and orientation solving - supports position-only, quaternion, and axis-direction constraints
• Numerical Jacobian - works with any kinematic chain without analytical derivation
• Adaptive damping - automatically adjusts damping factor based on error reduction
• Joint limit clamping - respects configured joint limits
• Nx tensor computation - efficient numerical operations via Nx
• Best-effort results - returns closest solution even on failure
• Continuous tracking - GenServer for real-time target following

Installation

Add bb_ik_dls to your list of dependencies in mix.exs:

def deps do
  [
    {:bb_ik_dls, "~> 0.3.2"}
  ]
end

Usage

Basic Solving

robot = MyRobot.robot()
{:ok, state} = BB.Robot.State.new(robot)

# Solve for end-effector to reach target position
target = Vec3.new(0.4, 0.2, 0.1)

case BB.IK.DLS.solve(robot, state, :end_effector, target) do
  {:ok, positions, meta} ->
    BB.Robot.State.set_positions(state, positions)
    IO.puts("Solved in #{meta.iterations} iterations")

  {:error, %BB.Error.Kinematics.NoSolution{residual: residual}} ->
    IO.puts("Failed to converge, residual: #{residual}m")
end

With Orientation

# Full 6-DOF target via Transform
target = Transform.from_position_quaternion(
  Vec3.new(0.3, 0.2, 0.1),
  Quaternion.from_axis_angle(Vec3.unit_z(), :math.pi() / 4)
)

{:ok, positions, meta} = BB.IK.DLS.solve(robot, state, :gripper, target)

# Or with axis constraint (point tool in a direction)
target = {Vec3.new(0.3, 0.2, 0.1), {:axis, Vec3.unit_z()}}

Motion Convenience API

# Move end-effector using BB.Motion integration
case BB.IK.DLS.Motion.move_to(MyRobot, :gripper, {0.3, 0.2, 0.1}) do
  {:ok, meta} -> IO.puts("Reached in #{meta.iterations} iterations")
  {:error, reason, _meta} -> IO.puts("Failed: #{reason}")
end

# Coordinated multi-limb motion
targets = %{left_foot: {0.1, 0.0, 0.0}, right_foot: {-0.1, 0.0, 0.0}}
BB.IK.DLS.Motion.move_to_multi(MyRobot, targets)

Continuous Tracking

# Start tracking a moving target
{:ok, tracker} = BB.IK.DLS.Tracker.start_link(
  robot: MyRobot,
  target_link: :gripper,
  initial_target: {0.3, 0.2, 0.1},
  update_rate: 30
)

# Update target from vision callback
BB.IK.DLS.Tracker.update_target(tracker, {0.35, 0.25, 0.15})

# Stop tracking
{:ok, final_positions} = BB.IK.DLS.Tracker.stop(tracker)

Target Formats

Options

Algorithm

DLS uses the damped pseudoinverse to compute joint updates:

Δθ = Jᵀ (J Jᵀ + λ²I)⁻¹ e

where:

• J is the Jacobian matrix relating joint velocities to end-effector velocity
• e is the pose error vector
• λ is the damping factor
• Δθ is the joint update

The damping factor prevents instability when J Jᵀ is near-singular (at kinematic singularities).

Comparison with FABRIK

Documentation

Full documentation is available at HexDocs.