00001
00002
00003
00004
00005
00006
00007
00008
00009
00010
00011
00012
00013
00014
00015
00016
00017
00018
00019
00020
00021
00022
00023
00024
00025
00026
00027
00028
00029
00030
00031
00032
00033
00034
00035
00036
00037
00038
00039
00040
00041 #include <stdio.h>
00042 #include "mensagem.h"
00043 #include "memvirtu.h"
00044 #include "lowparam.h"
00045 #include "lowmacro.h"
00046 #include "lowsolid.h"
00047 #include "genfunc_.h"
00048 #include "vectorop.h"
00049 #include "eulerops.h"
00050 #include "mancommd.h"
00051 #include "analise_.h"
00052
00053 void MSD_execNameCentroDeGravidade(void)
00054 {
00055 char name[12];
00056 vector centro;
00057
00058 while (1 != sscanf(restbuf, "%s", name))
00059 {
00060 printf("CentroG: Nome");
00061 if (!lineins("? "))
00062 {
00063 return;
00064 }
00065 }
00066 MSD_highNameCentroDeGravidade(name, centro);
00067 printf("Solido tem centro de gravidade %f %f %f\n", centro[0],
00068 centro[1],
00069 centro[2]);
00070 }
00071
00072 int MSD_highNameCentroDeGravidade(char *name, vector vec)
00073 {
00074 int sn;
00075
00076 if ((sn = MSD_getSolidIdFromName(name)) == -1)
00077 {
00078 fprintf(stderr, MEN_NaoEncontrouSolidNome, NAM_CentroGravidade, name);
00079 return(ERROR);
00080 }
00081 return(MSD_highCentroCarena(sn, vec));
00082 }
00083
00084 int MSD_highCentroDeGravidade(Id sn, vector vec)
00085 {
00086 SPTYPE s;
00087
00088 if ((s = MSD_getSolid(sn)) == SNIL)
00089 {
00090 fprintf(stderr, MEN_NaoEncontrouSolido, NAM_CentroGravidade, sn);
00091 return(ERROR);
00092 }
00093 return(MSD_lowCentroDeGravidade(s, vec));
00094 }
00095
00096
00097 int MSD_lowCentroDeGravidade(SPTYPE s, vector centg)
00098 {
00099 DPTYPE dg;
00100 FPTYPE f;
00101 LPTYPE l;
00102 HPTYPE he1;
00103 HPTYPE he2;
00104 vector a, b, c, d, cen;
00105 real volume;
00106
00107 veczer(centg);
00108 veczer(cen);
00109 veczer(a);
00110 veczer(b);
00111 veczer(c);
00112
00113 for (AllShellsSolid(s, dg))
00114 {
00115 for (AllFacesShell(dg, f))
00116 {
00117 for (AllLoopsFace(f, l))
00118 {
00119 he1 = LooLEdg(l);
00120 he2 = HalNxt(he1);
00121 do
00122 {
00123 vecminus(a, VerVCoord(HalVtx(he2)), cen);
00124 vecminus(b, VerVCoord(HalVtx(he1)), cen);
00125 cross(c, a, b);
00126 vecminus(d, VerVCoord(HalVtx(HalNxt(he2))), cen);
00127 centg[0] += dot(d, c) * (a[0] + b[0] + d[0]);
00128 centg[1] += dot(d, c) * (a[1] + b[1] + d[1]);
00129 centg[2] += dot(d, c) * (a[2] + b[2] + d[2]);
00130 } while ((he2 = HalNxt(he2)) != he1);
00131 }
00132 }
00133 }
00134
00135 volume = MSD_lowVolume(s) * 24.0;
00136 centg[0] = -centg[0] / volume;
00137 centg[1] = -centg[1] / volume;
00138 centg[2] = -centg[2] / volume;
00139 return(SUCCESS);
00140 }