Versions Compared

Old Version 1

changes.mady.by.user Magnus Antonsen

Saved on

compared with

New Version Current

changes.mady.by.user Magnus Antonsen

Saved on

Key

  • This line was added.
  • This line was removed.
  • Formatting was changed.
Input: 
v : ARRAY [0..2] OF LREAL;

Output:

norm : LREAL;
Info

Type: Function

Responsible: Magnus


Simple helper function for 24_7 Forward Kinematics. Concept taken from wikipedia. This function is the same as our inverse kinematic function.


Code Block
languageactionscript3
titleCode Overview
linenumberstrue
FUNCTION norm : LREAL
VAR_INPUT
	deltas : ARRAY [0..2] OF LREAL;
END_VAR
VAR
	i : INT;
	xD : LREAL := deltas[0];
	yD : LREAL := deltas[1];
	zD : LREAL := deltas[2];
END_VAR

norm := SQRT((xD*xD)+(yD+yD)+(zD+zD));