You are viewing an old version of this page. View the current version.

Compare with Current View Page History

Version 1 Next »

Input: 
x : LREAL;
y : LREAL;
z : LREAL;

Output:

myInverseKinematics : ARRAY [0..7] OF LREAL;

Type: Function

Responsible: Magnus, Simen


This function calculates the rope lengths for each motor. It performs the same operation as 24_7 Euclidean Distance, but is implemented to return the rope lengths for each motor. The initial positions for each cable is defined in this function and it returns the length for each motor in an array. The reason this is implemented is because it makes the code simpler in main programs. Mostly a utility function instead of running 24_7 Euclidean Distance for all motors in the main code. 

The reason our inverse kinematic is as simple as this is because of the system. When we find the rope length for each motor, we can calculate the actual position of each motor in the end position as long as its calibrated and homed. 

Concept taken from wikipedia.

  • No labels