From 7f927c2f4a64c883eaab73472291c8aed2d769a8 Mon Sep 17 00:00:00 2001 From: Cyrille Henry Date: Mon, 11 Feb 2013 16:57:35 +0000 Subject: lot's of new features... svn path=/trunk/externals/pmpd/; revision=17031 --- pmpd3d_stat.c | 564 ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ 1 file changed, 564 insertions(+) (limited to 'pmpd3d_stat.c') diff --git a/pmpd3d_stat.c b/pmpd3d_stat.c index cc8cb9c..83018dd 100644 --- a/pmpd3d_stat.c +++ b/pmpd3d_stat.c @@ -393,3 +393,567 @@ void pmpd3d_massesSpeedsStd(t_pmpd3d *x, t_symbol *s, int argc, t_atom *argv) outlet_anything(x->main_outlet, gensym("massesSpeedsStd"),4 , std_out); } + +void pmpd3d_linkPosMean(t_pmpd3d *x, t_symbol *s, int argc, t_atom *argv) +{ + t_float sommeX, sommeY, sommeZ, somme; + t_int i,j; + t_atom mean[4]; + + sommeX = 0; + sommeY = 0; + sommeZ = 0; + somme = 0; + j = 0; + + if ( (argc >= 1) && (argv[0].a_type == A_SYMBOL) ) + { + for (i=0; i< x->nb_link; i++) + { + if (atom_getsymbolarg(0,argc,argv) == x->link[i].Id) + { + sommeX += (x->link[i].mass1->posX + x->link[i].mass2->posX)/2; + sommeY += (x->link[i].mass1->posY + x->link[i].mass2->posY)/2; + sommeZ += (x->link[i].mass1->posZ + x->link[i].mass2->posZ)/2; + somme += sqrt(sqr((x->link[i].mass1->posX + x->link[i].mass2->posX)/2) + sqr((x->link[i].mass1->posX + x->link[i].mass2->posX)/2) + sqr((x->link[i].mass1->posX + x->link[i].mass1->posX)/2)); + j++; + } + } + } + else + { + for (i=0; i< x->nb_link; i++) + { + sommeX += (x->link[i].mass1->posX + x->link[i].mass2->posX)/2; + sommeY += (x->link[i].mass1->posY + x->link[i].mass2->posY)/2; + sommeZ += (x->link[i].mass1->posZ + x->link[i].mass2->posZ)/2; + somme += sqrt(sqr((x->link[i].mass1->posX + x->link[i].mass2->posX)/2) + sqr((x->link[i].mass1->posX + x->link[i].mass2->posX)/2) + sqr((x->link[i].mass1->posX + x->link[i].mass1->posX)/2)); + j++; + } + } + + sommeX /= j; + sommeY /= j; + sommeZ /= j; + somme /= j; + + SETFLOAT(&(mean[0]),sommeX); + SETFLOAT(&(mean[1]),sommeY); + SETFLOAT(&(mean[2]),sommeZ); + SETFLOAT(&(mean[3]),somme); + + outlet_anything(x->main_outlet, gensym("linkPosMean"),4 , mean); +} + +void pmpd3d_linkLengthMean(t_pmpd3d *x, t_symbol *s, int argc, t_atom *argv) +{ + t_float sommeX, sommeY, sommeZ, somme, tmp; + t_int i,j; + t_atom mean[4]; + + sommeX = 0; + sommeY = 0; + sommeZ = 0; + somme = 0; + j = 0; + + if ( (argc >= 1) && (argv[0].a_type == A_SYMBOL) ) + { + for (i=0; i< x->nb_link; i++) + { + if (atom_getsymbolarg(0,argc,argv) == x->link[i].Id) + { + sommeX += abs(x->link[i].mass1->posX - x->link[i].mass2->posX); + sommeX += abs(x->link[i].mass1->posY - x->link[i].mass2->posY); + sommeX += abs(x->link[i].mass1->posZ - x->link[i].mass2->posZ); + somme += x->link[i].distance; + j++; + } + } + } + else + { + for (i=0; i< x->nb_link; i++) + { + sommeX += abs(x->link[i].mass1->posX - x->link[i].mass2->posX); + sommeX += abs(x->link[i].mass1->posY - x->link[i].mass2->posY); + sommeX += abs(x->link[i].mass1->posZ - x->link[i].mass2->posZ); + somme += x->link[i].distance; + j++; + } + } + + sommeX /= j; + sommeY /= j; + sommeZ /= j; + somme /= j; + + SETFLOAT(&(mean[0]),sommeX); + SETFLOAT(&(mean[1]),sommeY); + SETFLOAT(&(mean[2]),sommeZ); + SETFLOAT(&(mean[3]),somme); + + outlet_anything(x->main_outlet, gensym("linkLengthMean"),4 , mean); +} + +void pmpd3d_linkPosSpeedMean(t_pmpd3d *x, t_symbol *s, int argc, t_atom *argv) +{ + t_float sommeX, sommeY, sommeZ, somme; + t_int i,j; + t_atom mean[4]; + + sommeX = 0; + sommeY = 0; + sommeZ = 0; + somme = 0; + j = 0; + + if ( (argc >= 1) && (argv[0].a_type == A_SYMBOL) ) + { + for (i=0; i< x->nb_link; i++) + { + if (atom_getsymbolarg(0,argc,argv) == x->link[i].Id) + { + sommeX += (x->link[i].mass1->speedX + x->link[i].mass2->speedX)/2; + sommeY += (x->link[i].mass1->speedY + x->link[i].mass2->speedY)/2; + sommeZ += (x->link[i].mass1->speedZ + x->link[i].mass2->speedZ)/2; + somme += sqrt(sqr((x->link[i].mass1->speedX+x->link[i].mass2->speedX)/2) + sqr((x->link[i].mass1->speedY + x->link[i].mass2->speedY)/2) + sqr((x->link[i].mass1->speedZ + x->link[i].mass2->speedZ)/2)); + j++; + } + } + } + else + { + for (i=0; i< x->nb_link; i++) + { + sommeX += (x->link[i].mass1->speedX + x->link[i].mass2->speedX)/2; + sommeY += (x->link[i].mass1->speedY + x->link[i].mass2->speedY)/2; + sommeZ += (x->link[i].mass1->speedZ + x->link[i].mass2->speedZ)/2; + somme += sqrt(sqr((x->link[i].mass1->speedX+x->link[i].mass2->speedX)/2) + sqr((x->link[i].mass1->speedY + x->link[i].mass2->speedY)/2) + sqr((x->link[i].mass1->speedZ + x->link[i].mass2->speedZ)/2)); + j++; + } + } + + sommeX /= j; + sommeY /= j; + sommeZ /= j; + somme /= j; + + SETFLOAT(&(mean[0]),sommeX); + SETFLOAT(&(mean[1]),sommeY); + SETFLOAT(&(mean[2]),sommeZ); + SETFLOAT(&(mean[3]),somme); + + outlet_anything(x->main_outlet, gensym("linkPosSpeedMean"),4 , mean); +} + +void pmpd3d_linkLengthSpeedMean(t_pmpd3d *x, t_symbol *s, int argc, t_atom *argv) +{ + t_float sommeX, sommeY, sommeZ, somme, tmp; + t_int i,j; + t_atom mean[4]; + + sommeX = 0; + sommeY = 0; + sommeZ = 0; + somme = 0; + j = 0; + + if ( (argc >= 1) && (argv[0].a_type == A_SYMBOL) ) + { + for (i=0; i< x->nb_link; i++) + { + if (atom_getsymbolarg(0,argc,argv) == x->link[i].Id) + { + sommeX += abs(x->link[i].mass1->speedX - x->link[i].mass2->speedX); + sommeX += abs(x->link[i].mass1->speedY - x->link[i].mass2->speedY); + sommeX += abs(x->link[i].mass1->speedZ - x->link[i].mass2->speedZ); + somme += sqrt(sqr(x->link[i].mass1->speedX - x->link[i].mass2->speedX) + + sqr(x->link[i].mass1->speedY - x->link[i].mass2->speedY) + + sqr(x->link[i].mass1->speedZ - x->link[i].mass2->speedZ)); + j++; + } + } + } + else + { + for (i=0; i< x->nb_link; i++) + { + sommeX += abs(x->link[i].mass1->speedX - x->link[i].mass2->speedX); + sommeX += abs(x->link[i].mass1->speedY - x->link[i].mass2->speedY); + sommeX += abs(x->link[i].mass1->speedZ - x->link[i].mass2->speedZ); + somme += sqrt(sqr(x->link[i].mass1->speedX - x->link[i].mass2->speedX) + + sqr(x->link[i].mass1->speedY - x->link[i].mass2->speedY) + + sqr(x->link[i].mass1->speedZ - x->link[i].mass2->speedZ)); + j++; + } + } + + sommeX /= j; + sommeY /= j; + sommeZ /= j; + somme /= j; + + SETFLOAT(&(mean[0]),sommeX); + SETFLOAT(&(mean[1]),sommeY); + SETFLOAT(&(mean[2]),sommeZ); + SETFLOAT(&(mean[3]),somme); + + outlet_anything(x->main_outlet, gensym("linkLengthSpeedMean"),4 , mean); +} + +void pmpd3d_linkPosStd(t_pmpd3d *x, t_symbol *s, int argc, t_atom *argv) +{ + t_float sommeX, sommeY, sommeZ, somme; + t_int i,j; + t_float stdX, stdY, stdZ, std; + t_atom std_out[4]; + + sommeX = 0; + sommeY = 0; + sommeZ = 0; + somme = 0; + stdX = 0; + stdY = 0; + stdZ = 0; + std = 0; + j = 0; + + if ( (argc >= 1) && (argv[0].a_type == A_SYMBOL) ) + { + for (i=0; i< x->nb_link; i++) + { + if (atom_getsymbolarg(0,argc,argv) == x->link[i].Id) + { + sommeX += (x->link[i].mass1->posX + x->link[i].mass2->posX)/2; + sommeY += (x->link[i].mass1->posY + x->link[i].mass2->posY)/2; + sommeZ += (x->link[i].mass1->posZ + x->link[i].mass2->posZ)/2; + somme += sqrt(sqr((x->link[i].mass1->posX + x->link[i].mass2->posX)/2) + sqr((x->link[i].mass1->posX + x->link[i].mass2->posX)/2) + sqr((x->link[i].mass1->posX + x->link[i].mass1->posX)/2)); + j++; + } + } + } + else + { + for (i=0; i< x->nb_link; i++) + { + sommeX += (x->link[i].mass1->posX + x->link[i].mass2->posX)/2; + sommeY += (x->link[i].mass1->posY + x->link[i].mass2->posY)/2; + sommeZ += (x->link[i].mass1->posZ + x->link[i].mass2->posZ)/2; + somme += sqrt(sqr((x->link[i].mass1->posX + x->link[i].mass2->posX)/2) + sqr((x->link[i].mass1->posX + x->link[i].mass2->posX)/2) + sqr((x->link[i].mass1->posX + x->link[i].mass1->posX)/2)); + j++; + } + } + + sommeX /= j; + sommeY /= j; + sommeZ /= j; + somme /= j; + + if ( (argc >= 1) && (argv[0].a_type == A_SYMBOL) ) + { + for (i=0; i< x->nb_link; i++) + { + if (atom_getsymbolarg(0,argc,argv) == x->link[i].Id) + { + stdX += sqr((x->link[i].mass1->posX + x->link[i].mass2->posX)/2 - sommeX); + stdY += sqr((x->link[i].mass1->posY + x->link[i].mass2->posY)/2 - sommeY); + stdZ += sqr((x->link[i].mass1->posZ + x->link[i].mass2->posZ)/2 - sommeZ); + std += sqr(sqrt(sqr((x->link[i].mass1->posX + x->link[i].mass2->posX)/2) + sqr((x->link[i].mass1->posX + x->link[i].mass2->posX)/2) + sqr((x->link[i].mass1->posX + x->link[i].mass1->posX)/2)) - somme); + j+=1; + } + } + } + else + { + for (i=0; i< x->nb_link; i++) + { + stdX += sqr((x->link[i].mass1->posX + x->link[i].mass2->posX)/2 - sommeX); + stdY += sqr((x->link[i].mass1->posY + x->link[i].mass2->posY)/2 - sommeY); + stdZ += sqr((x->link[i].mass1->posZ + x->link[i].mass2->posZ)/2 - sommeZ); + std += sqr(sqrt(sqr((x->link[i].mass1->posX + x->link[i].mass2->posX)/2) + sqr((x->link[i].mass1->posX + x->link[i].mass2->posX)/2) + sqr((x->link[i].mass1->posX + x->link[i].mass1->posX)/2)) - somme); + j+=1; + } + } + + stdX = sqrt(stdX/j); + stdY = sqrt(stdY/j); + stdZ = sqrt(stdZ/j); + std = sqrt(std /j); + + SETFLOAT(&(std_out[0]),stdX); + SETFLOAT(&(std_out[1]),stdY); + SETFLOAT(&(std_out[2]),stdZ); + SETFLOAT(&(std_out[3]),std); + + outlet_anything(x->main_outlet, gensym("linkPosStd"),4 , std_out); +} + +void pmpd3d_linkLengthStd(t_pmpd3d *x, t_symbol *s, int argc, t_atom *argv) +{ + t_float sommeX, sommeY, sommeZ, somme, tmp; + t_int i,j; + t_float stdX, stdY, stdZ, std; + t_atom std_out[4]; + + sommeX = 0; + sommeY = 0; + sommeZ = 0; + somme = 0; + stdX = 0; + stdY = 0; + stdZ = 0; + std = 0; + j = 0; + + if ( (argc >= 1) && (argv[0].a_type == A_SYMBOL) ) + { + for (i=0; i< x->nb_link; i++) + { + if (atom_getsymbolarg(0,argc,argv) == x->link[i].Id) + { + sommeX += abs(x->link[i].mass1->posX - x->link[i].mass2->posX); + sommeX += abs(x->link[i].mass1->posY - x->link[i].mass2->posY); + sommeX += abs(x->link[i].mass1->posZ - x->link[i].mass2->posZ); + somme += x->link[i].distance; + j+=1; + } + } + } + else + { + for (i=0; i< x->nb_link; i++) + { + sommeX += abs(x->link[i].mass1->posX - x->link[i].mass2->posX); + sommeX += abs(x->link[i].mass1->posY - x->link[i].mass2->posY); + sommeX += abs(x->link[i].mass1->posZ - x->link[i].mass2->posZ); + somme += x->link[i].distance; + j+=1; + } + } + + sommeX /= j; + sommeY /= j; + sommeZ /= j; + somme /= j; + + if ( (argc >= 1) && (argv[0].a_type == A_SYMBOL) ) + { + for (i=0; i< x->nb_link; i++) + { + if (atom_getsymbolarg(0,argc,argv) == x->link[i].Id) + { + stdX += sqr(abs(x->link[i].mass1->posX - x->link[i].mass2->posX)-sommeX); + stdX += sqr(abs(x->link[i].mass1->posY - x->link[i].mass2->posY)-sommeY); + stdX += sqr(abs(x->link[i].mass1->posZ - x->link[i].mass2->posZ)-sommeZ); + std += sqr(x->link[i].distance - somme); + j+=1; + } + } + } + else + { + for (i=0; i< x->nb_link; i++) + { + stdX += sqr(abs(x->link[i].mass1->posX - x->link[i].mass2->posX) - sommeX); + stdX += sqr(abs(x->link[i].mass1->posY - x->link[i].mass2->posY) - sommeY); + stdX += sqr(abs(x->link[i].mass1->posZ - x->link[i].mass2->posZ) - sommeZ); + std += sqr(x->link[i].distance - somme); + j+=1; + } + } + + stdX = sqrt(stdX/j); + stdY = sqrt(stdY/j); + stdZ = sqrt(stdZ/j); + std = sqrt(std /j); + + SETFLOAT(&(std_out[0]),stdX); + SETFLOAT(&(std_out[1]),stdY); + SETFLOAT(&(std_out[2]),stdZ); + SETFLOAT(&(std_out[3]),std); + + outlet_anything(x->main_outlet, gensym("linkLengthStd"),4 , std_out); +} + +void pmpd3d_linkPosSpeedStd(t_pmpd3d *x, t_symbol *s, int argc, t_atom *argv) +{ + t_float sommeX, sommeY, sommeZ, somme; + t_float stdX, stdY, stdZ, std; + t_int i,j; + t_atom std_out[4]; + + sommeX = 0; + sommeY = 0; + sommeZ = 0; + somme = 0; + stdX = 0; + stdY = 0; + stdZ = 0; + std = 0; + j = 0; + + if ( (argc >= 1) && (argv[0].a_type == A_SYMBOL) ) + { + for (i=0; i< x->nb_link; i++) + { + if (atom_getsymbolarg(0,argc,argv) == x->link[i].Id) + { + sommeX += (x->link[i].mass1->speedX + x->link[i].mass2->speedX)/2; + sommeY += (x->link[i].mass1->speedY + x->link[i].mass2->speedY)/2; + sommeZ += (x->link[i].mass1->speedZ + x->link[i].mass2->speedZ)/2; + somme += sqrt(sqr((x->link[i].mass1->speedX+x->link[i].mass2->speedX)/2) + sqr((x->link[i].mass1->speedY + x->link[i].mass2->speedY)/2) + sqr((x->link[i].mass1->speedZ + x->link[i].mass2->speedZ)/2)); + j++; + } + } + } + else + { + for (i=0; i< x->nb_link; i++) + { + sommeX += (x->link[i].mass1->speedX + x->link[i].mass2->speedX)/2; + sommeY += (x->link[i].mass1->speedY + x->link[i].mass2->speedY)/2; + sommeZ += (x->link[i].mass1->speedZ + x->link[i].mass2->speedZ)/2; + somme += sqrt(sqr((x->link[i].mass1->speedX+x->link[i].mass2->speedX)/2) + sqr((x->link[i].mass1->speedY + x->link[i].mass2->speedY)/2) + sqr((x->link[i].mass1->speedZ + x->link[i].mass2->speedZ)/2)); + j++; + } + } + + sommeX /= j; + sommeY /= j; + sommeZ /= j; + somme /= j; + + if ( (argc >= 1) && (argv[0].a_type == A_SYMBOL) ) + { + for (i=0; i< x->nb_link; i++) + { + if (atom_getsymbolarg(0,argc,argv) == x->link[i].Id) + { + stdX += sqr((x->link[i].mass1->speedX + x->link[i].mass2->speedX)/2-sommeX); + stdY += sqr((x->link[i].mass1->speedY + x->link[i].mass2->speedY)/2-sommeY); + stdZ += sqr((x->link[i].mass1->speedZ + x->link[i].mass2->speedZ)/2-sommeZ); + somme += sqr(sqrt(sqr((x->link[i].mass1->speedX+x->link[i].mass2->speedX)/2) + sqr((x->link[i].mass1->speedY + x->link[i].mass2->speedY)/2) + sqr((x->link[i].mass1->speedZ + x->link[i].mass2->speedZ)/2)) - somme); + j++; + } + } + } + else + { + for (i=0; i< x->nb_link; i++) + { + stdX += sqr((x->link[i].mass1->speedX + x->link[i].mass2->speedX)/2-sommeX); + stdY += sqr((x->link[i].mass1->speedY + x->link[i].mass2->speedY)/2-sommeY); + stdZ += sqr((x->link[i].mass1->speedZ + x->link[i].mass2->speedZ)/2-sommeZ); + somme += sqr(sqrt(sqr((x->link[i].mass1->speedX+x->link[i].mass2->speedX)/2) + sqr((x->link[i].mass1->speedY + x->link[i].mass2->speedY)/2) + sqr((x->link[i].mass1->speedZ + x->link[i].mass2->speedZ)/2)) - somme); + j++; + } + } + + stdX = sqrt(stdX/j); + stdY = sqrt(stdY/j); + stdZ = sqrt(stdZ/j); + std = sqrt(std /j); + + SETFLOAT(&(std_out[0]),stdX); + SETFLOAT(&(std_out[1]),stdY); + SETFLOAT(&(std_out[2]),stdZ); + SETFLOAT(&(std_out[3]),std); + + outlet_anything(x->main_outlet, gensym("linkPosSpeedStd"),4 , std_out); +} + +void pmpd3d_linkLengthSpeedStd(t_pmpd3d *x, t_symbol *s, int argc, t_atom *argv) +{ + t_float sommeX, sommeY, sommeZ, somme, tmp; + t_float stdX, stdY, stdZ, std; + t_int i,j; + t_atom std_out[4]; + + sommeX = 0; + sommeY = 0; + sommeZ = 0; + somme = 0; + stdX = 0; + stdY = 0; + stdZ = 0; + std = 0; + j = 0; + + if ( (argc >= 1) && (argv[0].a_type == A_SYMBOL) ) + { + for (i=0; i< x->nb_link; i++) + { + if (atom_getsymbolarg(0,argc,argv) == x->link[i].Id) + { + sommeX += abs(x->link[i].mass1->speedX - x->link[i].mass2->speedX); + sommeX += abs(x->link[i].mass1->speedY - x->link[i].mass2->speedY); + sommeX += abs(x->link[i].mass1->speedZ - x->link[i].mass2->speedZ); + somme += sqrt(sqr(x->link[i].mass1->speedX - x->link[i].mass2->speedX) + + sqr(x->link[i].mass1->speedY - x->link[i].mass2->speedY) + + sqr(x->link[i].mass1->speedZ - x->link[i].mass2->speedZ)); + j++; + } + } + } + else + { + for (i=0; i< x->nb_link; i++) + { + sommeX += abs(x->link[i].mass1->speedX - x->link[i].mass2->speedX); + sommeX += abs(x->link[i].mass1->speedY - x->link[i].mass2->speedY); + sommeX += abs(x->link[i].mass1->speedZ - x->link[i].mass2->speedZ); + somme += sqrt(sqr(x->link[i].mass1->speedX - x->link[i].mass2->speedX) + + sqr(x->link[i].mass1->speedY - x->link[i].mass2->speedY) + + sqr(x->link[i].mass1->speedZ - x->link[i].mass2->speedZ)); + j++; + } + } + + sommeX /= j; + sommeY /= j; + sommeZ /= j; + somme /= j; + + if ( (argc >= 1) && (argv[0].a_type == A_SYMBOL) ) + { + for (i=0; i< x->nb_link; i++) + { + if (atom_getsymbolarg(0,argc,argv) == x->link[i].Id) + { + stdX += sqr(abs(x->link[i].mass1->speedX - x->link[i].mass2->speedX) - sommeX); + stdX += sqr(abs(x->link[i].mass1->speedY - x->link[i].mass2->speedY) - sommeY); + stdX += sqr(abs(x->link[i].mass1->speedZ - x->link[i].mass2->speedZ) - sommeZ); + std += sqr( sqrt(sqr(x->link[i].mass1->speedX - x->link[i].mass2->speedX) + + sqr(x->link[i].mass1->speedY - x->link[i].mass2->speedY) + + sqr(x->link[i].mass1->speedZ - x->link[i].mass2->speedZ)) - somme); + j++; + } + } + } + else + { + for (i=0; i< x->nb_link; i++) + { + stdX += sqr(abs(x->link[i].mass1->speedX - x->link[i].mass2->speedX) - sommeX); + stdX += sqr(abs(x->link[i].mass1->speedY - x->link[i].mass2->speedY) - sommeY); + stdX += sqr(abs(x->link[i].mass1->speedZ - x->link[i].mass2->speedZ) - sommeZ); + std += sqr( sqrt(sqr(x->link[i].mass1->speedX - x->link[i].mass2->speedX) + + sqr(x->link[i].mass1->speedY - x->link[i].mass2->speedY) + + sqr(x->link[i].mass1->speedZ - x->link[i].mass2->speedZ)) - somme); + j++; + } + } + + stdX = sqrt(stdX/j); + stdY = sqrt(stdY/j); + stdZ = sqrt(stdZ/j); + std = sqrt(std /j); + + SETFLOAT(&(std_out[0]),stdX); + SETFLOAT(&(std_out[1]),stdY); + SETFLOAT(&(std_out[2]),stdZ); + SETFLOAT(&(std_out[3]),std); + + outlet_anything(x->main_outlet, gensym("linkLengthSpeedStd"),4 , std_out); +} -- cgit v1.2.1