FUNCTION myCalculateAngle : LREAL (* takes 3 sides of a triangle, returns angle *)
VAR_INPUT
a : LREAL;
b : LREAL;
c : LREAL;
END_VAR
VAR
num : LREAL;
den : LREAL;
angle : LREAL;
END_VAR
num := (a*a + b*b - c*c);
den := (2*a*b);
IF b = 0 OR a = 0 THEN
RETURN; (*Da funker det ikke*)
ELSE
angle := num/den; // Tester nå med å bare returnere vinkelen.
IF angle > 1 THEN
angle := 1;
END_IF
IF angle < -1 THEN
angle := -1;
END_IF
angle := ACOS(angle);
END_IF
myCalculateAngle := angle;//*(180/3.141595);