Industrielle styresystemer - Wiki
You are viewing an old version of this page. View the current version.
Compare with Current View Page History
« Previous Version 2 Next »
v1 : ARRAY [0..2] OF LREAL;v1 : ARRAY [0..2] OF LREAL;
Output:
dot_func : LREAL;
Type: Function
Responsible: Magnus
Simple helper function for 24_7 Forward Kinematics. Concept taken from wikipedia. Simply multiplies x1 * x2 + y1 * y2 + z1 * z2 = dot product.
FUNCTION dot_func : LREAL VAR_INPUT v1 : ARRAY [0..2] OF LREAL; v2 : ARRAY [0..2] OF LREAL; END_VAR VAR result : LREAL := 0; i : INT; END_VAR