pmpd3d_get.c

// --------------------------------------------------------------------------
// This file is part of the pmpd software.
//
//    pmpd software is free software: you can redistribute it and/or modify
//    it under the terms of the GNU General Public License as published by
//    the Free Software Foundation, either version 3 of the License, or
//    (at your option) any later version.
//
//    pmpd firmware is distributed in the hope that it will be useful,
//    but WITHOUT ANY WARRANTY; without even the implied warranty of
//    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
//    GNU General Public License for more details.
//
//    You should have received a copy of the GNU General Public License
//    along with pmpd software. If not, see <http://www.gnu.org/licenses/>.
// -------------------------------------------------------------------------- 
//
// pmpd = physical modeling for pure data
// ch@chnry.net


void pmpd3d_get(t_pmpd3d *x, t_symbol *s, int argc, t_atom *argv)
{
    int i;
    t_symbol *toget; 
    t_atom  toout[7];
    toget = atom_getsymbolarg(0, argc, argv);

    if ( (toget == gensym("massesPos")) && (argv[1].a_type == A_FLOAT) )
    {
        i = atom_getfloatarg(1, argc, argv);
        if ( (i>=0) && (i<x->nb_mass) )
        {
            SETFLOAT(&(toout[0]), i);
            SETFLOAT(&(toout[1]), x->mass[i].posX);
            SETFLOAT(&(toout[2]), x->mass[i].posY);
            SETFLOAT(&(toout[3]), x->mass[i].posZ);
            outlet_anything(x->main_outlet, gensym("massesPosNo"), 4, toout);
        }  
    }
    else
    if ( (toget == gensym("massesPos")) && (argv[1].a_type == A_SYMBOL) )
    {
        for (i=0; i< x->nb_mass; i++)
        {
            if ( atom_getsymbolarg(1,argc,argv) == x->mass[i].Id)
            {
                SETFLOAT(&(toout[0]), i);
                SETFLOAT(&(toout[1]), x->mass[i].posX);
                SETFLOAT(&(toout[2]), x->mass[i].posY);
                SETFLOAT(&(toout[3]), x->mass[i].posZ);
                outlet_anything(x->main_outlet, gensym("massesPosId"), 4, toout);
            }
        } 
    }
    else
    if ( (toget == gensym("massesPos")) && (argc == 1) )
    {
        for (i=0; i< x->nb_mass; i++)
        {
            SETFLOAT(&(toout[0]), i);
            SETFLOAT(&(toout[1]), x->mass[i].posX);
            SETFLOAT(&(toout[2]), x->mass[i].posY);
            SETFLOAT(&(toout[3]), x->mass[i].posZ);
            outlet_anything(x->main_outlet, gensym("massesPos"), 4, toout);
        } 
    }
    else
    if ( (toget == gensym("massesPosName")) && (argv[1].a_type == A_FLOAT) )
    {
        i = atom_getfloatarg(1, argc, argv);
        if ( (i>=0) && (i<x->nb_mass) )
        {
            SETSYMBOL(&(toout[0]), x->mass[i].Id);
            SETFLOAT(&(toout[1]), x->mass[i].posX);
            SETFLOAT(&(toout[2]), x->mass[i].posY);
            SETFLOAT(&(toout[3]), x->mass[i].posZ);
            outlet_anything(x->main_outlet, gensym("massesPosNameNo"), 4, toout);
        }  
    }
    else
    if ( (toget == gensym("massesPosName")) && (argv[1].a_type == A_SYMBOL) )
    {
        for (i=0; i< x->nb_mass; i++)
        {
            if ( atom_getsymbolarg(1,argc,argv) == x->mass[i].Id)
            {
                SETSYMBOL(&(toout[0]), x->mass[i].Id);
                SETFLOAT(&(toout[1]), x->mass[i].posX);
                SETFLOAT(&(toout[2]), x->mass[i].posY);
                SETFLOAT(&(toout[3]), x->mass[i].posZ);
                outlet_anything(x->main_outlet, gensym("massesPosNameId"), 4, toout);
            }
        } 
    }
    else
    if ( (toget == gensym("massesPosName")) && (argc == 1) )
    {
        for (i=0; i< x->nb_mass; i++)
        {
            SETSYMBOL(&(toout[0]), x->mass[i].Id);
            SETFLOAT(&(toout[1]), x->mass[i].posX);
            SETFLOAT(&(toout[2]), x->mass[i].posY);
            SETFLOAT(&(toout[3]), x->mass[i].posZ);
            outlet_anything(x->main_outlet, gensym("massesPosName"), 4, toout);
        } 
    }
    else
    if ( (toget == gensym("massesSpeeds")) && (argv[1].a_type == A_FLOAT) )
    {
        i = atom_getfloatarg(1, argc, argv);
        if ( (i>=0) && (i<x->nb_mass) )
        {
            SETFLOAT(&(toout[0]), i);
            SETFLOAT(&(toout[1]), x->mass[i].speedX);
            SETFLOAT(&(toout[2]), x->mass[i].speedY);
            SETFLOAT(&(toout[3]), x->mass[i].speedZ);
            outlet_anything(x->main_outlet, gensym("massesSpeedsNo"), 4, toout);
        }  
    }
    else
    if ( (toget == gensym("massesSpeeds")) && (argv[1].a_type == A_SYMBOL) )
    {
        for (i=0; i< x->nb_mass; i++)
        {
            if ( atom_getsymbolarg(1,argc,argv) == x->mass[i].Id)
            {
                SETFLOAT(&(toout[0]), i);
                SETFLOAT(&(toout[1]), x->mass[i].speedX);
                SETFLOAT(&(toout[2]), x->mass[i].speedY);
                SETFLOAT(&(toout[3]), x->mass[i].speedZ);
                outlet_anything(x->main_outlet, gensym("massesSpeedsId"), 4, toout);
            }
        } 
    }
    else
    if ( (toget == gensym("massesSpeeds")) && (argc == 1) )
    {
        for (i=0; i< x->nb_mass; i++)
        {
            SETFLOAT(&(toout[0]), i);
            SETFLOAT(&(toout[1]), x->mass[i].speedX);
            SETFLOAT(&(toout[2]), x->mass[i].speedY);
            SETFLOAT(&(toout[3]), x->mass[i].speedZ);
            outlet_anything(x->main_outlet, gensym("massesSpeeds"), 4, toout);
        } 
    }
    else
    if ( (toget == gensym("massesSpeedsName")) && (argv[1].a_type == A_FLOAT) )
    {
        i = atom_getfloatarg(1, argc, argv);
        if ( (i>=0) && (i<x->nb_mass) )
        {
            SETSYMBOL(&(toout[0]), x->mass[i].Id);
            SETFLOAT(&(toout[1]), x->mass[i].speedX);
            SETFLOAT(&(toout[2]), x->mass[i].speedY);
            SETFLOAT(&(toout[3]), x->mass[i].speedZ);
            outlet_anything(x->main_outlet, gensym("massesSpeedsNameNo"), 4, toout);
        }  
    }
    else
    if ( (toget == gensym("massesSpeedsName")) && (argv[1].a_type == A_SYMBOL) )
    {
        for (i=0; i< x->nb_mass; i++)
        {
            if ( atom_getsymbolarg(1,argc,argv) == x->mass[i].Id)
            {
                SETSYMBOL(&(toout[0]), x->mass[i].Id);
                SETFLOAT(&(toout[1]), x->mass[i].speedX);
                SETFLOAT(&(toout[2]), x->mass[i].speedY);
                SETFLOAT(&(toout[3]), x->mass[i].speedZ);
                outlet_anything(x->main_outlet, gensym("massesSpeedsNameId"), 4, toout);
            }
        } 
    }
    else
    if ( (toget == gensym("massesSpeedsName")) && (argc == 1) )
    {
        for (i=0; i< x->nb_mass; i++)
        {
            SETSYMBOL(&(toout[0]), x->mass[i].Id);
            SETFLOAT(&(toout[1]), x->mass[i].speedX);
            SETFLOAT(&(toout[2]), x->mass[i].speedY);
            SETFLOAT(&(toout[3]), x->mass[i].speedZ);
            outlet_anything(x->main_outlet, gensym("massesSpeedsName"), 4, toout);
        } 
    }
    else
    if ( (toget == gensym("massesForces")) && (argv[1].a_type == A_FLOAT) )
    {
        i = atom_getfloatarg(1, argc, argv);
        if ( (i>=0) && (i<x->nb_mass) )
        {
            SETFLOAT(&(toout[0]), i);
            SETFLOAT(&(toout[1]), x->mass[i].forceX);
            SETFLOAT(&(toout[2]), x->mass[i].forceY);
            SETFLOAT(&(toout[3]), x->mass[i].forceZ);
            outlet_anything(x->main_outlet, gensym("massesForcesNo"), 4, toout);
        }  
    }
    else
    if ( (toget == gensym("massesForces")) && (argv[1].a_type == A_SYMBOL) )
    {
        for (i=0; i< x->nb_mass; i++)
        {
            if ( atom_getsymbolarg(1,argc,argv) == x->mass[i].Id)
            {
                SETFLOAT(&(toout[0]), i);
                SETFLOAT(&(toout[1]), x->mass[i].forceX);
                SETFLOAT(&(toout[2]), x->mass[i].forceY);
                SETFLOAT(&(toout[3]), x->mass[i].forceZ);
                outlet_anything(x->main_outlet, gensym("massesForcesId"), 4, toout);
            }
        } 
    }
    else
    if ( (toget == gensym("massesForces")) && (argc == 1) )
    {
        for (i=0; i< x->nb_mass; i++)
        {
            SETFLOAT(&(toout[0]), i);
            SETFLOAT(&(toout[1]), x->mass[i].forceX);
            SETFLOAT(&(toout[2]), x->mass[i].forceY);
            SETFLOAT(&(toout[3]), x->mass[i].forceZ);
            outlet_anything(x->main_outlet, gensym("massesForces"), 4, toout);
        } 
    }
    else
    if ( (toget == gensym("massesForcesName")) && (argv[1].a_type == A_FLOAT) )
    {
        i = atom_getfloatarg(1, argc, argv);
        if ( (i>=0) && (i<x->nb_mass) )
        {
            SETSYMBOL(&(toout[0]), x->mass[i].Id);
            SETFLOAT(&(toout[1]), x->mass[i].forceX);
            SETFLOAT(&(toout[2]), x->mass[i].forceY);
            SETFLOAT(&(toout[3]), x->mass[i].forceZ);
            outlet_anything(x->main_outlet, gensym("massesForcesNameNo"), 4, toout);
        }
    }
    else
    if ( (toget == gensym("massesForcesName")) && (argv[1].a_type == A_SYMBOL) )
    {
        for (i=0; i< x->nb_mass; i++)
        {
            if ( atom_getsymbolarg(1,argc,argv) == x->mass[i].Id)
            {
                SETSYMBOL(&(toout[0]), x->mass[i].Id);
                SETFLOAT(&(toout[1]), x->mass[i].forceX);
                SETFLOAT(&(toout[2]), x->mass[i].forceY);
                SETFLOAT(&(toout[3]), x->mass[i].forceZ);
                outlet_anything(x->main_outlet, gensym("massesForcesNameId"), 4, toout);
            }
        } 
    }
    else
    if ( (toget == gensym("massesForcesName")) && (argc == 1) )
    {
        for (i=0; i< x->nb_mass; i++)
        {
            SETSYMBOL(&(toout[0]), x->mass[i].Id);
            SETFLOAT(&(toout[1]), x->mass[i].forceX);
            SETFLOAT(&(toout[2]), x->mass[i].forceY);
            SETFLOAT(&(toout[3]), x->mass[i].forceZ);
            outlet_anything(x->main_outlet, gensym("massesForcesName"), 4, toout);
        } 
    }
    else
    if ( (toget == gensym("linksPos")) && (argv[1].a_type == A_FLOAT) )
    {
        i = atom_getfloatarg(1, argc, argv);
        if ( (i>=0) && (i<x->nb_mass) )
        {
            SETFLOAT(&(toout[0]), i);
            SETFLOAT(&(toout[1]), x->link[i].mass1->posX);
            SETFLOAT(&(toout[2]), x->link[i].mass1->posY);
            SETFLOAT(&(toout[3]), x->link[i].mass1->posZ);
            SETFLOAT(&(toout[4]), x->link[i].mass2->posX);
            SETFLOAT(&(toout[5]), x->link[i].mass2->posY);
            SETFLOAT(&(toout[6]), x->link[i].mass2->posZ);
            outlet_anything(x->main_outlet, gensym("linksPosNo"), 7, toout);
        }
    }
    else
    if ( (toget == gensym("linksPos")) && (argv[1].a_type == A_SYMBOL) )
    {
        for (i=0; i< x->nb_link; i++)
        {
            if ( atom_getsymbolarg(1,argc,argv) == x->link[i].Id)
            {
                SETFLOAT(&(toout[0]), i);
                SETFLOAT(&(toout[1]), x->link[i].mass1->posX);
                SETFLOAT(&(toout[2]), x->link[i].mass1->posY);
                SETFLOAT(&(toout[3]), x->link[i].mass1->posZ);
                SETFLOAT(&(toout[4]), x->link[i].mass2->posX);
                SETFLOAT(&(toout[5]), x->link[i].mass2->posY);
                SETFLOAT(&(toout[6]), x->link[i].mass2->posZ);
                outlet_anything(x->main_outlet, gensym("linksPosNo"), 7, toout);
            }
        } 
    }
    else
    if ( (toget == gensym("linksPos")) && (argc == 1) )
    {
        for (i=0; i< x->nb_link; i++)
        {
            SETFLOAT(&(toout[0]), i);
            SETFLOAT(&(toout[1]), x->link[i].mass1->posX);
            SETFLOAT(&(toout[2]), x->link[i].mass1->posY);
            SETFLOAT(&(toout[3]), x->link[i].mass1->posZ);
            SETFLOAT(&(toout[4]), x->link[i].mass2->posX);
            SETFLOAT(&(toout[5]), x->link[i].mass2->posY);
            SETFLOAT(&(toout[6]), x->link[i].mass2->posZ);
            outlet_anything(x->main_outlet, gensym("linksPosNo"), 7, toout);
        } 
    }
    else
    if ( (toget == gensym("linksPosName")) && (argv[1].a_type == A_FLOAT) )
    {
        i = atom_getfloatarg(1, argc, argv);
        if ( (i>=0) && (i<x->nb_mass) )
        {
            SETFLOAT(&(toout[0]), i);
            SETFLOAT(&(toout[1]), x->link[i].mass1->posX);
            SETFLOAT(&(toout[2]), x->link[i].mass1->posY);
            SETFLOAT(&(toout[3]), x->link[i].mass1->posZ);
            SETFLOAT(&(toout[3]), x->link[i].mass2->posX);
            SETFLOAT(&(toout[5]), x->link[i].mass2->posY);
            SETFLOAT(&(toout[6]), x->link[i].mass2->posZ);
            outlet_anything(x->main_outlet, gensym("linksPosNo"), 7, toout);
        }
    }
    else
    if ( (toget == gensym("linksPosName")) && (argv[1].a_type == A_SYMBOL) )
    {
        for (i=0; i< x->nb_link; i++)
        {
            if ( atom_getsymbolarg(1,argc,argv) == x->link[i].Id)
            {
            SETFLOAT(&(toout[0]), i);
            SETFLOAT(&(toout[1]), x->link[i].mass1->posX);
            SETFLOAT(&(toout[2]), x->link[i].mass1->posY);
            SETFLOAT(&(toout[3]), x->link[i].mass1->posZ);
            SETFLOAT(&(toout[4]), x->link[i].mass2->posX);
            SETFLOAT(&(toout[5]), x->link[i].mass2->posY);
            SETFLOAT(&(toout[6]), x->link[i].mass2->posZ);
            outlet_anything(x->main_outlet, gensym("linksPosNo"), 7, toout);
            }
        } 
    }
    else
    if ( (toget == gensym("linksPosName")) && (argc == 1) )
    {
        for (i=0; i< x->nb_link; i++)
        {
            SETFLOAT(&(toout[0]), i);
            SETFLOAT(&(toout[1]), x->link[i].mass1->posX);
            SETFLOAT(&(toout[2]), x->link[i].mass1->posY);
            SETFLOAT(&(toout[3]), x->link[i].mass1->posZ);
            SETFLOAT(&(toout[4]), x->link[i].mass2->posX);
            SETFLOAT(&(toout[5]), x->link[i].mass2->posY);
            SETFLOAT(&(toout[6]), x->link[i].mass2->posZ);
            outlet_anything(x->main_outlet, gensym("linksPosNo"), 7, toout);
        } 
    }
    else
        logpost(x,1,"not get attribute");
}

void pmpd3d_massPos(t_pmpd3d *x, t_symbol *s, int argc, t_atom *argv)
{
    int i;
    t_atom  toout[5];

    if ((argc>0)&&(argv[0].a_type == A_FLOAT))
    {
        i = atom_getfloatarg(0, argc, argv);
        if ( (i>=0) && (i<x->nb_mass) )
        {
            SETSYMBOL(&(toout[0]), x->mass[i].Id);
            SETFLOAT(&(toout[1]), i);
            SETFLOAT(&(toout[2]), x->mass[i].posX);
            SETFLOAT(&(toout[3]), x->mass[i].posY);
            SETFLOAT(&(toout[4]), x->mass[i].posZ);
            outlet_anything(x->main_outlet, gensym("massPos"), 5, toout);
        }  
    }
    else
    if ((argc>0)&&(argv[0].a_type == A_SYMBOL))
    {
        for (i=0; i< x->nb_mass; i++)
        {
            SETSYMBOL(&(toout[0]), atom_getsymbolarg(0,argc,argv));
            if ( atom_getsymbolarg(0,argc,argv) == x->mass[i].Id)
            {
				SETFLOAT(&(toout[1]), i);
                SETFLOAT(&(toout[2]), x->mass[i].posX);
                SETFLOAT(&(toout[3]), x->mass[i].posY);
                SETFLOAT(&(toout[4]), x->mass[i].posZ);
                outlet_anything(x->main_outlet, gensym("massPos"), 5, toout);
            }
        } 
    }
    else
    if (argc == 0)
    {
        for (i=0; i< x->nb_mass; i++)
        {
            SETSYMBOL(&(toout[0]), x->mass[i].Id);
            SETFLOAT(&(toout[1]), i);
            SETFLOAT(&(toout[2]), x->mass[i].posX);
            SETFLOAT(&(toout[3]), x->mass[i].posY);
            SETFLOAT(&(toout[4]), x->mass[i].posZ);
            outlet_anything(x->main_outlet, gensym("massPos"), 5, toout);
        } 
    }
}
      
void pmpd3d_massSpeed(t_pmpd3d *x, t_symbol *s, int argc, t_atom *argv)
{
    int i;
    t_atom  toout[5];

    if ((argc>0)&&(argv[0].a_type == A_FLOAT)) 
    {
        i = atom_getfloatarg(0, argc, argv);
        if ( (i>=0) && (i<x->nb_mass) )
        {
            SETSYMBOL(&(toout[0]), x->mass[i].Id);
            SETFLOAT(&(toout[1]), i);
            SETFLOAT(&(toout[2]), x->mass[i].speedX);
            SETFLOAT(&(toout[3]), x->mass[i].speedY);
            SETFLOAT(&(toout[4]), x->mass[i].speedZ);
            outlet_anything(x->main_outlet, gensym("massSpeed"), 5, toout);
        }  
    }
    else
    if ((argc>0)&&(argv[0].a_type == A_SYMBOL))
    {
        for (i=0; i< x->nb_mass; i++)
        {
            SETSYMBOL(&(toout[0]), atom_getsymbolarg(0,argc,argv));
            if ( atom_getsymbolarg(0,argc,argv) == x->mass[i].Id)
            {
				SETFLOAT(&(toout[1]), i);
                SETFLOAT(&(toout[2]), x->mass[i].speedX);
                SETFLOAT(&(toout[3]), x->mass[i].speedY);
                SETFLOAT(&(toout[4]), x->mass[i].speedZ);
                outlet_anything(x->main_outlet, gensym("massSpeed"), 5, toout);
            }
        } 
    }
    else
    if (argc == 0)
    {
        for (i=0; i< x->nb_mass; i++)
        {
            SETSYMBOL(&(toout[0]), x->mass[i].Id);
            SETFLOAT(&(toout[1]), i);
            SETFLOAT(&(toout[2]), x->mass[i].speedX);
            SETFLOAT(&(toout[3]), x->mass[i].speedY);
            SETFLOAT(&(toout[4]), x->mass[i].speedZ);
            outlet_anything(x->main_outlet, gensym("massSpeed"), 5, toout);
        } 
    }
}

void pmpd3d_massForce(t_pmpd3d *x, t_symbol *s, int argc, t_atom *argv)
{	
    int i;
    t_atom  toout[5];

    if ((argc>0)&&(argv[0].a_type == A_FLOAT)) 
    {
        i = atom_getfloatarg(0, argc, argv);
        if ( (i>=0) && (i<x->nb_mass) )
        {
            SETSYMBOL(&(toout[0]), x->mass[i].Id);
            SETFLOAT(&(toout[1]), i);
            SETFLOAT(&(toout[2]), x->mass[i].forceX);
            SETFLOAT(&(toout[3]), x->mass[i].forceY);
            SETFLOAT(&(toout[4]), x->mass[i].forceZ);
            outlet_anything(x->main_outlet, gensym("massForce"), 5, toout);
        }  
    }
    else
    if ((argc>0)&&(argv[0].a_type == A_SYMBOL))
    {
        for (i=0; i< x->nb_mass; i++)
        {
            SETSYMBOL(&(toout[0]), atom_getsymbolarg(0,argc,argv));
            if ( atom_getsymbolarg(0,argc,argv) == x->mass[i].Id)
            {
				SETFLOAT(&(toout[1]), i);
                SETFLOAT(&(toout[2]), x->mass[i].forceX);
                SETFLOAT(&(toout[3]), x->mass[i].forceY);
                SETFLOAT(&(toout[4]), x->mass[i].forceZ);
                outlet_anything(x->main_outlet, gensym("massForce"), 5, toout);
            }
        } 
    }
    else
    if (argc == 0)
    {
        for (i=0; i< x->nb_mass; i++)
        {
            SETSYMBOL(&(toout[0]), x->mass[i].Id);
            SETFLOAT(&(toout[1]), i);
            SETFLOAT(&(toout[2]), x->mass[i].forceX);
            SETFLOAT(&(toout[3]), x->mass[i].forceY);
            SETFLOAT(&(toout[4]), x->mass[i].forceZ);
            outlet_anything(x->main_outlet, gensym("massForce"), 5, toout);
        } 
    }
}

void pmpd3d_linkEnd(t_pmpd3d *x, t_symbol *s, int argc, t_atom *argv)
{
	int i;
    t_atom  toout[8];
    
    if ((argc>0)&&(argv[0].a_type == A_FLOAT)) 
    {
        i = atom_getfloatarg(0, argc, argv);
        if ( (i>=0) && (i<x->nb_link) )
        {
            SETSYMBOL(&(toout[0]), x->link[i].Id);
            SETFLOAT(&(toout[1]), i);
            SETFLOAT(&(toout[2]), x->link[i].mass1->posX);
            SETFLOAT(&(toout[3]), x->link[i].mass1->posY);
            SETFLOAT(&(toout[4]), x->link[i].mass1->posZ);
            SETFLOAT(&(toout[5]), x->link[i].mass2->posX);
            SETFLOAT(&(toout[6]), x->link[i].mass2->posY);
            SETFLOAT(&(toout[7]), x->link[i].mass2->posZ);
            outlet_anything(x->main_outlet, gensym("linkEnd"), 8, 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)
            {
				SETFLOAT(&(toout[1]), i);
                SETFLOAT(&(toout[2]), x->link[i].mass1->posX);
                SETFLOAT(&(toout[3]), x->link[i].mass1->posY);
                SETFLOAT(&(toout[4]), x->link[i].mass1->posZ);
                SETFLOAT(&(toout[5]), x->link[i].mass2->posX);
                SETFLOAT(&(toout[6]), x->link[i].mass2->posY);
                SETFLOAT(&(toout[7]), x->link[i].mass2->posZ);
                outlet_anything(x->main_outlet, gensym("linkEnd"), 8, toout);
            }
        } 
    }
    else
    if (argc == 0) 
    {
        for (i=0; i< x->nb_link; i++)
        {
            SETSYMBOL(&(toout[0]), x->link[i].Id);
            SETFLOAT(&(toout[1]), i);
            SETFLOAT(&(toout[2]), x->link[i].mass1->posX);
            SETFLOAT(&(toout[3]), x->link[i].mass1->posY);
            SETFLOAT(&(toout[4]), x->link[i].mass1->posZ);
            SETFLOAT(&(toout[5]), x->link[i].mass2->posX);
            SETFLOAT(&(toout[6]), x->link[i].mass2->posY);
            SETFLOAT(&(toout[7]), x->link[i].mass2->posZ);
            outlet_anything(x->main_outlet, gensym("linkEnd"), 8, toout);
        } 
    }
}

void pmpd3d_linkPos(t_pmpd3d *x, t_symbol *s, int argc, t_atom *argv)
{
	int i;
    t_atom  toout[5];
    
    if ((argc>0)&&(argv[0].a_type == A_FLOAT)) 
    {
        i = atom_getfloatarg(0, argc, argv);
        if ( (i>=0) && (i<x->nb_link) )
        {
            SETSYMBOL(&(toout[0]), x->link[i].Id);
            SETFLOAT(&(toout[1]), i);
            SETFLOAT(&(toout[2]), (x->link[i].mass1->posX+x->link[i].mass2->posX)/2);
            SETFLOAT(&(toout[3]), (x->link[i].mass1->posY+x->link[i].mass2->posY)/2);
            SETFLOAT(&(toout[4]), (x->link[i].mass1->posZ+x->link[i].mass2->posZ)/2);
            outlet_anything(x->main_outlet, gensym("linkPos"), 5, 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)
            {
				SETFLOAT(&(toout[1]), i);
				SETFLOAT(&(toout[2]), (x->link[i].mass1->posX+x->link[i].mass2->posX)/2);
				SETFLOAT(&(toout[3]), (x->link[i].mass1->posY+x->link[i].mass2->posY)/2);
				SETFLOAT(&(toout[4]), (x->link[i].mass1->posZ+x->link[i].mass2->posZ)/2);
                outlet_anything(x->main_outlet, gensym("linkPos"), 5, toout);
            }
        } 
    }
    else
    if (argc == 0) 
    {
        for (i=0; i< x->nb_link; i++)
        {
            SETSYMBOL(&(toout[0]), x->link[i].Id);
            SETFLOAT(&(toout[1]), i);
			SETFLOAT(&(toout[2]), (x->link[i].mass1->posX+x->link[i].mass2->posX)/2);
			SETFLOAT(&(toout[3]), (x->link[i].mass1->posY+x->link[i].mass2->posY)/2);
			SETFLOAT(&(toout[4]), (x->link[i].mass1->posZ+x->link[i].mass2->posZ)/2);
            outlet_anything(x->main_outlet, gensym("linkPos"), 5, toout);
        } 
    }
}
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].mass2->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].mass2->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].mass2->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);
        } 
    }
}