pylabrobot.formulatrix.mantis.driver.arm_kinematics.compute_head_position#

pylabrobot.formulatrix.mantis.driver.arm_kinematics.compute_head_position(*, theta_1: float, theta_2: float) → MantisArmCoordinate#

Where the head is in the arm frame for two link angles, z None: forward kinematics.

Of the two solutions, the head’s is the one left of the line from motor 0’s elbow to motor 1’s: the recorded recoveries route from it in every zone recorded, the back zones included.

Parameters:
  • theta_1 (float) – motor 0’s link angle, in degrees, the geometry’s own.

  • theta_2 (float) – motor 1’s link angle, in degrees, the geometry’s own.

Raises:

MantisKinematicsError – if the long links cannot meet at these angles.

Return type:

MantisArmCoordinate