Added TRI(N) and TOTAL_POLYLINE_LENGTH(P) code macros (#997)

Author: melund

Body/AAUHuman/BodyModels/GenericBodyModel/Helper.ClassTemplates.any

@@ -28,6 +28,12 @@
 // Pairwise distances between observations in n-dimensional space.
 #define PDIST(X) sum(vnorm(DIFFMAT(SizesOf(X)[0])*(X)))
 
+//Total length of a polyline defined by a set of points.
+#define TOTAL_POLYLINE_LENGTH(P) sum(vnorm((arrcat(zeros(1,SizesOf(P)[0]-1), eye(SizesOf(P)[0]-1)')' - arrcat(eye(SizesOf(P)[0]-1)', zeros(1,SizesOf(P)[0]-1))')*P))
+ 
+//An array with ones at and below the given diagonal and zeros elsewhere.
+#define TRI(N) lteqfun(transpose(repmat(1,N ,iarr(1,N))), repmat(1,N,iarr(1,N)))
+
 // Upper triangle of the array. Return a copy of an array with elements below the diagonal zeroed out 
 #define TRIU(IN) mult(IN, gteqfun(transpose(repmat(1,SizesOf(IN)[0] ,iarr(1,SizesOf(IN)[1]))), repmat(1,SizesOf(IN)[1],iarr(1,SizesOf(IN)[0]))))
 
@@ -36,8 +42,6 @@
 
 
 
-
-
 // Projection of P onto the line BA
 #define VECTOR_PROJECTION(P, A, B) (A) + ( ((P)-(A))*((B)-(A))' / ( ((B)-(A))*((B)-(A))') )*((B)-(A))
 // Normal vector for the non-coliniar points A,B,C 

CHANGELOG.md

@@ -10,6 +10,8 @@
 * Added a small class template, [`CreateCoMRefNode`](#Utilities.center-of-mass.createcomrefnode.createcomrefnode),
   that can be used to create a reference node at the center of mass of a segment with its axes aligned with
   the principal axes of inertia of the segment.
+* Added a `TRI(N)` helper code macros which creates a lower triangular (NxN) matrix.
+* Added a `TOTAL_POLYLINE_LENGTH(P)` helper code macro which calculates the total length of a polyline defined by a set of points.
 
 ### 🩹 Fixed:
 * Fixed an issue that prevented switching off drawing of marker arrows in CreateMarkerDriverClass in MoCap models. Updated the search string

Tests/test_helper_templates.any

@@ -62,7 +62,28 @@ Main =
     AnyFloat length = PDIST(Mat);
     AnyInt test = assert(eqfun(PDIST(Mat), 2*sqrt(3)));
   };
-  AnyFolder Test_TRIU_TRIL = {
+
+  AnyFolder Test_TOTAL_POLYLINE_LENGTH ={
+     AnyFloat P = {
+      {0,0,0},
+      {1,0,0},
+      {1,1,0},
+      {1,1,1}
+     };
+    AnyFloat length = TOTAL_POLYLINE_LENGTH(P);
+    AnyInt test = assert(eqfun(length, 3)); 
+  };
+
+  AnyFolder Test_TRIU_TRIL_TRI = {
+
+   AnyFloat test_TRI = assert(
+                  eqfun(TRI(4),
+                  {{1.0, 0.0, 0.0, 0.0},
+                   {1.0, 1.0, 0.0, 0.0},
+                   {1.0, 1.0, 1.0, 0.0},
+                   {1.0, 1.0, 1.0, 1.0}}
+                  )
+              );
 
    AnyFloat M_wide = ones(3,5);
    AnyFloat M_tall = ones(6,3);