pmpd code refactorisation

svn path=/trunk/externals/pmpd/; revision=17105

1 files changed, 160 insertions, 0 deletions

diff --git a/pmpd_various.c b/pmpd_various.c
new file mode 100644
index 0000000..e6b2dfc
--- /dev/null
+++ b/pmpd_various.c
@@ -0,0 +1,160 @@
+void pmpd_infosL(t_pmpd *x)
+{
+    int i;
+    post("list of mass");
+    post("number, Id, mobile, mass, Damping, position, speed, forces");
+    for(i=0; i < x->nb_mass; i++)
+    {
+        post("masse %i: %s, %d, %f, %f, %f, %f, %f",i, x->mass[i].Id->s_name, x->mass[i].mobile, 1/x->mass[i].invM, x->mass[i].D2, x->mass[i].posX, x->mass[i].speedX, x->mass[i].forceX );
+    }
+
+    post("list of link");
+    post("number, Id, mass1, mass2, K, D, Pow, L, Lmin, Lmax");
+    for(i=0; i < x->nb_link; i++)
+    {
+        switch(x->link[i].lType)
+        {
+        case 0 :
+            post("link %i: %s, %i, %i, %f, %f, %f, %f, %f, %f", i, x->link[i].Id->s_name, x->link[i].mass1->num, x->link[i].mass2->num, x->link[i].K, x->link[i].D, x->link[i].Pow, x->link[i].L, x->link[i].Lmin, x->link[i].Lmax);
+            break;
+        case 2 :
+            post("tabLink %i: %s, %i, %i, %f, %f, %s, %f, %s, %f", i, x->link[i].Id->s_name, x->link[i].mass1->num, x->link[i].mass2->num, x->link[i].K, x->link[i].D, x->link[i].arrayK->s_name, x->link[i].K_L, x->link[i].arrayD->s_name, x->link[i].D_L);
+            break;
+        }
+    }
+}
+
+void pmpd_forceX(t_pmpd *x, t_symbol *s, int argc, t_atom *argv)
+{
+// add a force to a specific mass
+    int tmp, i;
+
+    if ( ( argv[0].a_type == A_FLOAT ) && ( argv[1].a_type == A_FLOAT ) )
+    {
+        tmp = atom_getfloatarg(0, argc, argv);
+        tmp = max(0, min( x->nb_mass-1, tmp));
+        x->mass[tmp].forceX += atom_getfloatarg(1, argc, argv);
+    }
+    if ( ( argv[0].a_type == A_SYMBOL ) && ( argv[1].a_type == A_FLOAT ) )
+    {
+        for (i=0; i< x->nb_mass; i++)
+        {
+            if ( atom_getsymbolarg(0,argc,argv) == x->mass[i].Id)
+            {
+                x->mass[i].forceX += atom_getfloatarg(1, argc, argv);
+            }
+        }
+    }
+}
+
+void pmpd_minX(t_pmpd *x, t_float min)
+{
+    x->minX = min;
+}
+
+void pmpd_maxX(t_pmpd *x, t_float max)
+{
+    x->maxX = max;
+}
+
+void pmpd_addPosX(t_pmpd *x, t_symbol *s, int argc, t_atom *argv)
+{
+    int tmp, i;
+
+    if ( ( argv[0].a_type == A_FLOAT ) && ( argv[1].a_type == A_FLOAT ) )
+    {
+        tmp = atom_getfloatarg(0, argc, argv);
+        tmp = max(0, min( x->nb_mass-1, tmp));
+        x->mass[tmp].posX += atom_getfloatarg(1, argc, argv);
+    }
+    if ( ( argv[0].a_type == A_SYMBOL ) && ( argv[1].a_type == A_FLOAT ) )
+    {
+        for (i=0; i< x->nb_mass; i++)
+        {
+            if ( atom_getsymbolarg(0,argc,argv) == x->mass[i].Id)
+            {
+                x->mass[i].posX += atom_getfloatarg(1, argc, argv);
+            }
+        }
+    }
+}
+
+//----------------------------------------------
+
+void pmpd_grabMass(t_pmpd *x, t_float posX, t_float grab)
+{
+    t_float dist, tmp;
+    t_int i;
+    
+    if (grab == 0)
+        x->grab=0;
+    if ((x->grab == 0)&(grab == 1)&(x->nb_mass > 0))
+    {
+        x->grab=1;
+        x->grab_nb= 0;
+        dist = x->mass[0].posX - posX;
+        for (i=1; i<x->nb_mass; i++)
+        {
+            tmp = x->mass[i].posX - posX;
+            if (tmp < dist)
+            {
+                dist = tmp;
+                x->grab_nb= i;
+            }
+        }
+    }
+    if (x->grab == 1)
+    {
+        x->mass[x->grab_nb].posX = posX;
+    }
+}
+
+void pmpd_closestMass(t_pmpd *x, t_symbol *s, int argc, t_atom *argv)
+{
+    t_float dist, tmp;
+    t_int i;
+    t_atom std_out[2];
+    t_float posX;
+    posX = atom_getfloatarg(0, argc, argv);
+    
+    if ( (argc == 2)  && (argv[1].a_type == A_SYMBOL) )
+    {
+        //t_symbol *mass_name = atom_getsymbolarg(2, argc, argv);
+        if ((x->nb_mass > 0))
+        {
+            dist = 1000000000;//sqr(x->mass[0].posX - posX) + sqr(x->mass[0].posY - posY);
+            for (i=0; i<x->nb_mass; i++)
+            {
+                if (atom_getsymbolarg(1,argc,argv) == x->mass[i].Id)
+                {
+                    tmp = x->mass[i].posX - posX;
+                    if (tmp < dist)
+                    {
+                        dist = tmp;
+                        x->grab_nb= i;
+                    }
+                }
+            }
+        }
+    }
+    else {
+        if ((x->nb_mass > 0))
+        {
+            dist = x->mass[0].posX - posX;
+            for (i=1; i<x->nb_mass; i++)
+            {
+                tmp = x->mass[i].posX - posX;
+                if (tmp < dist)
+                {
+                    dist = tmp;
+                    x->grab_nb= i;
+                }
+            }
+        }
+    }
+
+    SETFLOAT(&(std_out[0]),x->grab_nb);
+    SETFLOAT(&(std_out[1]), x->mass[x->grab_nb].posX);
+    outlet_anything(x->main_outlet, gensym("closestMass"),2,std_out);
+}
+