* ROTA_IMP PROCEDUR PV090527 23/10/10 21:15:04 11748 * * impose une condition de rotation d'un angle angle autour d'un axe poin1 poin2 * * Attention la raideur fabriquee depend de l'angle * Attention ne fonctionne pas si il y a des points sur l'axe de rotation * * * vecteur radial apres rotation coorx = coorx - poin1x; coory = coory - poin1y; coorz = coorz - poin1z; * normale au vecteur radial et a l'axe de rotation norm1x = (axey * coorz) - (axez * coory); norm1y = (axez * coorx) - (axex * coorz); norm1z = (axex * coory) - (axey * coorx); * matrice de blocage dans la direction normale *rrota = 'BLOQ' monmail 'DIRE' normch; * coordonnees initiales coorx = coorx - poin1x; coory = coory - poin1y; coorz = coorz - poin1z; * second membre lrota = rrota * (coorch * -1); 'FINP' rrota lrota;
© Cast3M 2003 - Tous droits réservés.
Mentions légales