From 1abc1e4b559fc86f1bd783a887b9da0c9b963842 Mon Sep 17 00:00:00 2001
From: Cyrille Henry <nusmuk@users.sourceforge.net>
Date: Mon, 25 Aug 2014 13:09:20 +0000
Subject: linkLength new message

svn path=/trunk/externals/pmpd/; revision=17342
---
 pmpd3d_get.c | 65 ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
 1 file changed, 65 insertions(+)

(limited to 'pmpd3d_get.c')

diff --git a/pmpd3d_get.c b/pmpd3d_get.c
index c23b594..c832aba 100644
--- a/pmpd3d_get.c
+++ b/pmpd3d_get.c
@@ -599,3 +599,68 @@ void pmpd3d_linkPos(t_pmpd3d *x, t_symbol *s, int argc, t_atom *argv)
         } 
     }
 }
+void pmpd3d_linkLength(t_pmpd3d *x, t_symbol *s, int argc, t_atom *argv)
+{
+	int i;
+    t_atom  toout[6];    
+    t_float tmp1, tmp2, tmp3;
+
+    if ((argc>0)&&(argv[0].a_type == A_FLOAT)) 
+    {
+        i = atom_getfloatarg(0, argc, argv);
+        if ( (i>=0) && (i<x->nb_link) )
+        {
+            tmp1=x->link[i].mass1->posX-x->link[i].mass2->posX;
+            tmp2=x->link[i].mass1->posY-x->link[i].mass2->posY;
+            tmp3=x->link[i].mass1->posZ-x->link[i].mass3->posZ;
+
+            SETSYMBOL(&(toout[0]), x->link[i].Id);
+            SETFLOAT(&(toout[1]), i);
+            SETFLOAT(&(toout[2]), tmp1);
+            SETFLOAT(&(toout[3]), tmp2);
+            SETFLOAT(&(toout[4]), tmp3);
+            SETFLOAT(&(toout[5]), sqrt(tmp1*tmp1 + tmp2*tmp2 + tmp3*tmp3));
+            outlet_anything(x->main_outlet, gensym("linkLength"), 6, toout);
+        }
+    }
+    else
+    if ((argc>0)&&(argv[0].a_type == A_SYMBOL))
+    {
+        SETSYMBOL(&(toout[0]), atom_getsymbolarg(0,argc,argv));
+        for (i=0; i< x->nb_link; i++)
+        {
+            if ( atom_getsymbolarg(0,argc,argv) == x->link[i].Id)
+            {
+	            tmp1=x->link[i].mass1->posX-x->link[i].mass2->posX;
+	            tmp2=x->link[i].mass1->posY-x->link[i].mass2->posY;
+	            tmp3=x->link[i].mass1->posZ-x->link[i].mass3->posZ;
+	
+	            SETSYMBOL(&(toout[0]), x->link[i].Id);
+	            SETFLOAT(&(toout[1]), i);
+	            SETFLOAT(&(toout[2]), tmp1);
+	            SETFLOAT(&(toout[3]), tmp2);
+	            SETFLOAT(&(toout[4]), tmp3);
+	            SETFLOAT(&(toout[5]), sqrt(tmp1*tmp1 + tmp2*tmp2 + tmp3*tmp3));
+	            outlet_anything(x->main_outlet, gensym("linkLength"), 6, toout);
+            }
+        } 
+    }
+    else
+    if (argc == 0) 
+    {
+        for (i=0; i< x->nb_link; i++)
+        {
+            tmp1=x->link[i].mass1->posX-x->link[i].mass2->posX;
+            tmp2=x->link[i].mass1->posY-x->link[i].mass2->posY;
+            tmp3=x->link[i].mass1->posZ-x->link[i].mass3->posZ;
+
+            SETSYMBOL(&(toout[0]), x->link[i].Id);
+            SETFLOAT(&(toout[1]), i);
+            SETFLOAT(&(toout[2]), tmp1);
+            SETFLOAT(&(toout[3]), tmp2);
+            SETFLOAT(&(toout[4]), tmp3);
+            SETFLOAT(&(toout[5]), sqrt(tmp1*tmp1 + tmp2*tmp2 + tmp3*tmp3));
+            outlet_anything(x->main_outlet, gensym("linkLength"), 6, toout);
+        } 
+    }
+}
-- 
cgit v1.2.1