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 #ifndef __UNIX_
00043 #include <stdlib.h>
00044 #endif
00045 #include "mensagem.h"
00046 #include "memvirtu.h"
00047 #include "lowparam.h"
00048 #include "lowmacro.h"
00049 #include "lowsolid.h"
00050 #include "eulerops.h"
00051 #include "mancommd.h"
00052
00053 #ifdef __Extended_Version
00054 void MSD_execKSFMR(void)
00055 {
00056 int sn, fn1, fn2, op;
00057
00058 while (4 != sscanf(restbuf, "%d %d %d %d", &sn, &op, &fn1, &fn2))
00059 {
00060 printf("Sid f1 f2\n");
00061 if (!lineins("? "))
00062 {
00063 return;
00064 }
00065 }
00066 MSD_highKSFMR(sn, fn1, fn2);
00067 }
00068
00069 #endif
00070
00071 int MSD_highKSFMR(Id sn, Id fn1, Id fn2)
00072 {
00073 SPTYPE s;
00074 FPTYPE f1;
00075 FPTYPE f2;
00076
00077 if ((s = MSD_getSolid(sn)) == SNIL)
00078 {
00079 fprintf(stderr, MEN_NaoEncontrouSolido, NAM_KSFMR, sn);
00080 return(ERROR);
00081 }
00082 if ((f1 = MSD_getFace(s, fn1)) == FNIL)
00083 {
00084 fprintf(stderr, MEN_NaoEncontrouFace, NAM_KSFMR, fn1, sn);
00085 return(ERROR);
00086 }
00087 if ((f2 = MSD_getFace(s, fn2)) == FNIL)
00088 {
00089 fprintf(stderr, MEN_NaoEncontrouFace, NAM_KSFMR, fn2, sn);
00090 return(ERROR);
00091 }
00092 if (LooNextL(FacFLoops(f2)) != LNIL)
00093 {
00094 fprintf(stderr, MEN_FaceSemLoop, NAM_KSFMR, fn2, sn);
00095 return(ERROR);
00096 }
00097 MSD_lowKSFMR(f1, f2);
00098 return(SUCCESS);
00099 }
00100
00101 void MSD_lowKSFMR(FPTYPE f1, FPTYPE f2)
00102 {
00103 SPTYPE s;
00104 DPTYPE d1;
00105 DPTYPE d2;
00106 FPTYPE f;
00107 LPTYPE newloop;
00108 EPTYPE e;
00109 VPTYPE v;
00110 Id fa, fb, db, v1, v2;
00111
00112 assert1(FacFShell(f1) != FacFShell(f2));
00113 assert1(LooNextL(FacFLoops(f2)) == LNIL);
00114 assert1(SheSSolids(FacFShell(f1)) == SheSSolids(FacFShell(f2)));
00115
00116 d1 = FacFShell(f1);
00117 d2 = FacFShell(f2);
00118 s = SheSSolids(d1);
00119 if (Gdoinversion)
00120 {
00121 fa = FacFaceNo(f1);
00122 fb = FacFaceNo(f2);
00123 db = SheShellNo(d2);
00124 v1 = VerVertexNo(HalVtx(LooLEdg(FacFLoops(f2))));
00125 v2 = VerVertexNo(HalVtx(HalNxt(LooLEdg(FacFLoops(f2)))));
00126 MSD_lowAddEulerOp(s, MSFKR, fa, fb, db, v1, v2, 0, 0, 0, 0.0, 0.0, 0.0, 0.0);
00127 }
00128 if (Gdodirect)
00129 {
00130 fa = FacFaceNo(f1);
00131 fb = FacFaceNo(f2);
00132 MSD_lowAddEulerOpRedo(s, KSFMR, fa, fb, 0, 0, 0, 0, 0, 0, 0.0, 0.0, 0.0, 0.0);
00133 }
00134
00135 while ((v = SheSVerts(d2)) != VNIL)
00136 {
00137 MSD_lowDelList(VERTEX, (NPTYPE)v, (NPTYPE)d2);
00138 MSD_lowAddList(VERTEX, (NPTYPE)v, (NPTYPE)d1);
00139 }
00140 while ((e = SheSEdges(d2)) != ENIL)
00141 {
00142 MSD_lowDelList(EDGE, (NPTYPE)e, (NPTYPE)d2);
00143 MSD_lowAddList(EDGE, (NPTYPE)e, (NPTYPE)d1);
00144 }
00145 while ((f = SheSFaces(d2)) != FNIL)
00146 {
00147 MSD_lowDelList(FACE, (NPTYPE)f, (NPTYPE)d2);
00148 MSD_lowAddList(FACE, (NPTYPE)f, (NPTYPE)d1);
00149 }
00150
00151 newloop = FacFLoops(f2);
00152 MSD_lowDelList(LOOP, (NPTYPE)newloop, (NPTYPE)f2);
00153 MSD_lowAddList(LOOP, (NPTYPE)newloop, (NPTYPE)f1);
00154 MSD_lowDelElement(FACE, (NPTYPE)f2, (NPTYPE)d1);
00155 MSD_lowDelElement(SHELL, (NPTYPE)d2, (NPTYPE)s);
00156
00157 MSD_addEulCoef(s, -1, -1, 1, 0, 0, 0);
00158
00159 if (SetTrace)
00160 {
00161 if (TraceSolid(s))
00162 {
00163 fprintf(stderr, MEN_MSDAbortou, NAM_KSFMR);
00164 exit(1);
00165 }
00166 }
00167 }
00168
00169 int MSD_execStructKSFMR(EulerOp *op)
00170 {
00171 Id sid, id1, id2;
00172
00173 sid = op->solidno;
00174 id1 = op->ip1;
00175 id2 = op->ip2;
00176 return(MSD_highKSFMR(sid, id1, id2));
00177 }
00178
00179 void MSD_printStructKSFMR(FILE *f, EulerOp *op)
00180 {
00181 Id sid, id1, id2;
00182 int com;
00183
00184 sid = op->solidno;
00185 id1 = op->ip1;
00186 id2 = op->ip2;
00187 com = op->CommandCount;
00188 fprintf(f, "ksfmr %d %d %d %d \n", sid, com, id1, id2);
00189 }
00190
00191 int MSD_readStructKSFMR(FILE *f, EulerOp *op)
00192 {
00193 int solidno, ip1, ip2, com;
00194
00195 if (fscanf(f, "%d %d %d %d\n", &solidno, &com, &ip1, &ip2) != 4)
00196 {
00197 return(ERROR);
00198 }
00199 op->solidno = solidno;
00200 op->CommandCount = com;
00201 op->ip1 = ip1;
00202 op->ip2 = ip2;
00203 op->ip3 = 0;
00204 op->ip4 = 0;
00205 op->ip5 = 0;
00206 op->ip6 = 0;
00207 op->ip7 = 0;
00208 op->ip8 = 0;
00209 op->fp1 = 0.0;
00210 op->fp2 = 0.0;
00211 op->fp3 = 0.0;
00212 op->fp4 = 0.0;
00213 return(SUCCESS);
00214 }
00215
00216 int MSD_modifyStructKSFMR(EulerOp *op)
00217 {
00218 int solidno;
00219
00220 solidno = MSD_lowCheckTranslatorTable(op->solidno, SOLID);
00221 op->solidno = solidno;
00222 return(SUCCESS);
00223 }