From 81d760d4bc6e1284f9bb874dcec75071b8c96b89 Mon Sep 17 00:00:00 2001 From: "N.N." Date: Thu, 21 Apr 2005 14:28:54 +0000 Subject: MSD Version 0.03 svn path=/trunk/externals/nusmuk/; revision=2799 --- msd/main.cpp | 212 +++++++++++++++++++++++++++++++++++++++-------------------- 1 file changed, 141 insertions(+), 71 deletions(-) (limited to 'msd/main.cpp') diff --git a/msd/main.cpp b/msd/main.cpp index a9aad8a..aabd8d1 100755 --- a/msd/main.cpp +++ b/msd/main.cpp @@ -30,7 +30,7 @@ License along with this library; if not, write to the Free Software Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA - Version 0.02 -- 15.04.2005 + Version 0.03 -- 21.04.2005 */ // include flext header @@ -38,7 +38,7 @@ #include // define constants -#define MSD_VERSION 0.02 +#define MSD_VERSION 0.03 #define nb_max_link 4000 #define nb_max_mass 4000 #define Id_length 20 @@ -69,7 +69,7 @@ typedef struct _link { t_mass *mass1; t_mass *mass2; t_float K1, D1, D2; - t_float longx, longueur; + t_float longx, longueur, long_min, long_max; t_float distance_old; } t_link; @@ -132,16 +132,23 @@ protected: for (i=0; imass1->posX-link[i]->mass2->posX; // L[n] = x1 - x2 - F = link[i]->K1 * (distance - link[i]->longueur) ; // F[n] = k1 (L[n] - L[0]) - F += link[i]->D1 * (distance - link[i]->distance_old) ; // F[n] = F[n] + D1 (L[n] - L[n-1]) - if (distance != 0) { - Fx = F * (link[i]->mass1->posX - link[i]->mass2->posX)/distance; // Fx = F * Lx[n]/L[n] + if (distance < 0) + distance = -distance; // |L[n]| + if (distance < link[i]->long_min || distance > link[i]->long_max) + Fx = 0; + else { // Lmin < L < Lmax + F = link[i]->K1 * (distance - link[i]->longueur) ; // F[n] = k1 (L[n] - L[0]) + F += link[i]->D1 * (distance - link[i]->distance_old) ; // F[n] = F[n] + D1 (L[n] - L[n-1]) + if (distance != 0) + Fx = F * (link[i]->mass1->posX - link[i]->mass2->posX)/distance; // Fx = F * Lx[n]/L[n] } - link[i]->mass1->forceX -= Fx; // Fx1[n] = -Fx - link[i]->mass1->forceX -= link[i]->D2*link[i]->mass1->speedX; // Fx1[n] = Fx1[n] - D2 * vx1[n-1] - link[i]->mass2->forceX += Fx; // Fx2[n] = Fx - link[i]->mass2->forceX -= link[i]->D2*link[i]->mass2->speedX; // Fx2[n] = Fx2[n] - D2 * vx2[n-1] - link[i]->distance_old = distance; // L[n-1] = L[n] + link[i]->mass1->forceX -= Fx; // Fx1[n] = -Fx + link[i]->mass1->forceX -= link[i]->D2*link[i]->mass1->speedX; // Fx1[n] = Fx1[n] - D2 * vx1[n-1] + link[i]->mass2->forceX += Fx; // Fx2[n] = Fx + link[i]->mass2->forceX -= link[i]->D2*link[i]->mass2->speedX; // Fx2[n] = Fx2[n] - D2 * vx2[n-1] + link[i]->distance_old = distance; // L[n-1] = L[n] + + } for (i=0; iId = GetSymbol(argv[0]); // ID mass[nb_mass]->mobile = GetInt(argv[1]); // mobile @@ -198,6 +208,9 @@ protected: t_int i; const t_symbol *sym = GetSymbol(argv[0]); + if (argc != 2) + error("forceX : Idmass value"); + for (i=0; iId) @@ -211,6 +224,9 @@ protected: t_int i; const t_symbol *sym = GetSymbol(argv[0]); + if (argc != 2) + error("posX : Idmass value"); + if (GetFloat(argv[1]) < Xmax && GetFloat(argv[1]) > Xmin) for (i=0; imass1->nbr == GetAInt(argv[0]) || link[i]->mass2->nbr == GetAInt(argv[0])) { - SetFloat((aux[nb_link_delete]),link[i]->nbr); - nb_link_delete++; + if (argc != 1) + error("deleteMass : Nomass"); + + // Delete all associated links + for (i=0; imass1->nbr == GetAInt(argv[0]) || link[i]->mass2->nbr == GetAInt(argv[0])) { + SetFloat((aux[nb_link_delete]),link[i]->nbr); + nb_link_delete++; + } } - } - for (i=0; inbr == GetAInt(argv[0])) { - SetFloat((sortie[0]),mass[i]->nbr); - SetSymbol((sortie[1]),mass[i]->Id); - SetFloat((sortie[2]),mass[i]->mobile); - SetFloat((sortie[3]),1/mass[i]->invM); - SetFloat((sortie[4]),mass[i]->posX); - delete mass[i]; - mass[i] = mass[nb_mass-1]; // copy last mass instead - nb_mass--; - ToOutAnything(1,S_Mass_deleted,5,sortie); - break; + // Delete mass + for (i=0; inbr == GetAInt(argv[0])) { + SetFloat((sortie[0]),mass[i]->nbr); + SetSymbol((sortie[1]),mass[i]->Id); + SetFloat((sortie[2]),mass[i]->mobile); + SetFloat((sortie[3]),1/mass[i]->invM); + SetFloat((sortie[4]),mass[i]->posX); + delete mass[i]; + mass[i] = mass[nb_mass-1]; // copy last mass instead + nb_mass--; + ToOutAnything(1,S_Mass_deleted,5,sortie); + break; } - } void m_Xmax(int argc,t_atom *argv) { // set X max - Xmax = GetFloat(argv[0]); + if (argc != 1) + error("Xmax : Value"); + Xmax = GetFloat(argv[0]); } void m_Xmin(int argc,t_atom *argv) { // set X min - Xmin = GetFloat(argv[0]); + if (argc != 1) + error("Xmin : Value"); + Xmin = GetFloat(argv[0]); } // -------------------------------------------------------------- LINKS @@ -300,11 +327,13 @@ protected: void m_link(int argc,t_atom *argv) // add a link - // Id, nbr, *mass1, *mass2, K1, D1 + // Id, *mass1, *mass2, K1, D1, D2, (Lmin,Lmax) { t_atom sortie[7], aux[2]; t_int i; + if (argc < 6 || argc > 8) + error("link : Id Nomass1 Nomass2 K D1 D2 (Lmin Lmax)"); link[nb_link] = new t_link; // New pointer link[nb_link]->Id = GetSymbol(argv[0]); // ID for (i=0; iD1 = GetFloat(argv[4]); // D1 link[nb_link]->D2 = GetFloat(argv[5]); // D2 link[nb_link]->longx = link[nb_link]->mass1->posX - link[nb_link]->mass2->posX; // Lx[0] - link[nb_link]->longueur = link[nb_link]->longx ;// L[0] + if (link[nb_link]->longx < 0) + link[nb_link]->longueur = -link[nb_link]->longx; + else + link[nb_link]->longueur = link[nb_link]->longx ;// L[0] link[nb_link]->nbr = id_link; // id number link[nb_link]->distance_old = link[nb_link]->longueur; // L[n-1] + switch (argc) { + case 6 : + link[nb_link]->long_max = 32768; + link[nb_link]->long_min = 0; + break; + case 7 : + link[nb_link]->long_min = GetFloat(argv[6]); + link[nb_link]->long_max = 32768; + break; + case 8 : + link[nb_link]->long_min = GetFloat(argv[6]); + link[nb_link]->long_max = GetFloat(argv[7]); + break; + } nb_link++; id_link++; nb_link = min ( nb_max_link -1, nb_link ); @@ -334,12 +380,15 @@ protected: void m_ilink(int argc,t_atom *argv) // add interactor link - // Id, nbr, Id masses1, Id masses2, K1, D1 + // Id, Id masses1, Id masses2, K1, D1, D2, (Lmin, Lmax) { - t_atom aux[2], arglist[6]; + t_atom aux[2], arglist[8]; t_int i,j, imass1[nb_mass], nbmass1=0, imass2[nb_mass], nbmass2=0; t_symbol *Id1, *Id2; + if (argc < 6 || argc > 8) + error("ilink : Id Idmass1 Idmass2 K D1 D2 (Lmin Lmax)"); + Id1 = GetSymbol(argv[1]); Id2 = GetSymbol(argv[2]); ToOutAnything(1,S_iLink,0,aux); @@ -364,7 +413,16 @@ protected: SetFloat((arglist[3]),GetFloat(argv[3])); SetFloat((arglist[4]),GetFloat(argv[4])); SetFloat((arglist[5]),GetFloat(argv[5])); - m_link(6,arglist); + switch (argc) { + case 7 : + SetFloat(arglist[6],GetFloat(argv[6])); + break; + case 8 : + SetFloat(arglist[6],GetFloat(argv[6])); + SetFloat(arglist[7],GetFloat(argv[7])); + break; + } + m_link(argc,arglist); } } @@ -374,6 +432,9 @@ protected: t_int i; const t_symbol *sym = GetSymbol(argv[0]); + if (argc != 2) + error("setK : IdLink Value"); + for (i=0; iId) @@ -387,6 +448,9 @@ protected: t_int i; const t_symbol *sym = GetSymbol(argv[0]); + if (argc != 2) + error("setD : IdLink Value"); + for (i=0; iId) @@ -400,6 +464,9 @@ protected: t_int i; const t_symbol *sym = GetSymbol(argv[0]); + if (argc != 2) + error("setD2 : IdLink Value"); + for (i=0; iId) @@ -410,23 +477,26 @@ protected: void m_delete_link(int argc,t_atom *argv) { // Delete link - t_int i; - t_atom sortie[7]; + t_int i; + t_atom sortie[7]; - for (i=0; inbr == GetInt(argv[0])) { - SetFloat((sortie[0]),link[i]->nbr); - SetSymbol((sortie[1]),link[i]->Id); - SetFloat((sortie[2]),link[i]->mass1->nbr); - SetFloat((sortie[3]),link[i]->mass2->nbr); - SetFloat((sortie[4]),link[i]->K1); - SetFloat((sortie[5]),link[i]->D1); - SetFloat((sortie[6]),link[i]->D2); - delete link[i]; - link[i]=link[nb_link-1]; // copy last link instead - nb_link--; - ToOutAnything(1,S_Link_deleted,7,sortie); - break; + if (argc != 1) + error("deleteLink : NoLink"); + + for (i=0; inbr == GetInt(argv[0])) { + SetFloat((sortie[0]),link[i]->nbr); + SetSymbol((sortie[1]),link[i]->Id); + SetFloat((sortie[2]),link[i]->mass1->nbr); + SetFloat((sortie[3]),link[i]->mass2->nbr); + SetFloat((sortie[4]),link[i]->K1); + SetFloat((sortie[5]),link[i]->D1); + SetFloat((sortie[6]),link[i]->D2); + delete link[i]; + link[i]=link[nb_link-1]; // copy last link instead + nb_link--; + ToOutAnything(1,S_Link_deleted,7,sortie); + break; } } @@ -441,36 +511,36 @@ protected: t_symbol *auxarg,*auxarg2, *auxtype; t_atom sortie[4]; auxtype = GetSymbol(argv[0]); - auxarg = GetASymbol(argv[1]); //auxarg : & symbol, 0 else + auxarg = GetASymbol(argv[1]); //auxarg : & symbol, 0 else if (argc == 1) { - if (auxtype == S_massesPos)// get all masses positions + if (auxtype == S_massesPos) // get all masses positions for (i=0; iposX); ToOutAnything(0,S_massesPos,1,sortie); } - else if (auxtype == S_massesForces)// get all masses forces + else if (auxtype == S_massesForces) // get all masses forces for (i=0; iout_forceX); ToOutAnything(0,S_massesForces,1,sortie); } - else if (auxtype == S_linksPos)// get all links positions + else if (auxtype == S_linksPos) // get all links positions for (i=0; imass1->posX); SetFloat(sortie[1],link[i]->mass2->posX); ToOutAnything(0,S_linksPos,2,sortie); } - else // get all masses speeds + else // get all masses speeds for (i=0; ispeedX); ToOutAnything(0,S_massesSpeeds,1,sortie); } } - else if (auxtype == S_massesPos) // get mass positions + else if (auxtype == S_massesPos) // get mass positions { if (auxarg == 0) // No { @@ -498,7 +568,7 @@ protected: } } } - else if (auxtype == S_massesForces) // get mass forces + else if (auxtype == S_massesForces) // get mass forces { if (auxarg == 0) // No { @@ -526,7 +596,7 @@ protected: } } } - else if (auxtype == S_linksPos) // get links positions + else if (auxtype == S_linksPos) // get links positions { if (auxarg == 0) // No { @@ -556,7 +626,7 @@ protected: } } } - else // get mass speeds + else // get mass speeds { if (auxarg == 0) // No { @@ -613,7 +683,7 @@ protected: } void m_info_dumpl() - // List of masses and links infos on first outlet + // List of masses and links infos on second outlet { t_atom sortie[7]; t_int i; -- cgit v1.2.1