pylabrobot.formulatrix.mantis.driver.arm_kinematics#
The arm’s kinematics and units: pure maths, nothing sent.
The arm is a five-bar linkage: two motors on fixed bases, each turning a short link, whose two long
links meet at the head. The arm frame has the base of motor 0’s link at its origin and the other
base ARM_DISTANCE along x; it is in mm, and the head at idle sits at about (15.0, 31.2).
Motors 0 and 1 turn the links in degrees; motor 2, Z, travels in mm, down from its home flag. The wire carries device units: 200 per revolution of a motor.
Functions
|
An arm motor's position, in device units, from its absolute encoder's raw reading. |
An absolute encoder reading made linear by its one-revolution table. |
|
|
A position in device units. |
|
A speed or an acceleration in device units, rounded up half a step as on the wire. |
|
Where each short link ends in the arm frame, motor 0's first; z None. |
|
Where the head is in the arm frame for two link angles, z None: forward kinematics. |
|
The two links' angles that put the head at a location's x and y: inverse kinematics. |
|
A position from device units, in degrees (arms) or mm (Z). |
|
An angle moved by whole turns into |
Classes
|
A position in the arm frame, mm: the unit's files' frame, not PLR's deck frame. |