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 <math.h>
00043 #include "memvirtu.h"
00044 #include "lowparam.h"
00045 #include "lowmacro.h"
00046 #include "lowsolid.h"
00047 #include "vectorop.h"
00048 #include "gphgraph.h"
00049 #include "disdispl.h"
00050
00051 void MSD_lowEdgeEdgeIntersection(SPTYPE optr, EPTYPE eptr, FPTYPE f1ptr, FPTYPE f2ptr)
00052 {
00053 real sbox[2][2], t0, t1, d1, d2;
00054 vector sv2, ev2;
00055 vector sv3, ev3;
00056 vector vsv, esv, xpos, vs0, ve0, pos;
00057 vect2 s0, e0;
00058 SPTYPE xoptr;
00059 DPTYPE xdptr;
00060 EPTYPE xeptr;
00061 int i;
00062
00063 MSD_lowExecDisplayTransformation(desvtx, deevtx, s0, e0);
00064 for (i = 0; i < 2; ++i)
00065 {
00066 if (s0[i] < e0[i])
00067 {
00068 sbox[0][i] = s0[i] - releps;
00069 sbox[1][i] = e0[i] + releps;
00070 }
00071 else
00072 {
00073 sbox[0][i] = e0[i] - releps;
00074 sbox[1][i] = s0[i] + releps;
00075 }
00076 }
00077 MSD_lowExecInverseDisplayTransformation(s0, e0, vs0, ve0);
00078 for (AllSolids(xoptr))
00079 {
00080 if (SolDsp(xoptr) != TRUE)
00081 {
00082 continue;
00083 }
00084 for (AllShellsSolid(xoptr, xdptr))
00085 {
00086 for (AllEdgesShell(xdptr, xeptr))
00087 {
00088 if (EdgEVis(xeptr) != _VISIBLE)
00089 {
00090 continue;
00091 }
00092 if (!MSD_lowEdgeEdgeCheck(xoptr, optr, xeptr, eptr,
00093 sbox, f1ptr, f2ptr))
00094 {
00095 continue;
00096 }
00097 veccopy(sv2, EdgSVClp2(xeptr));
00098 veccopy(ev2, EdgEVClp2(xeptr));
00099 if (MSD_lowEdgeEdgeCheckStep2(s0, e0, sv2, ev2, &t0, &t1) == TRUE)
00100 {
00101 if (MSD_lowEdgeEdgeCheckStep3(vs0, ve0, desvtx, deevtx, t0, pos))
00102 {
00103 MSD_lowExecInverseDisplayTransformation(sv2, ev2, vsv, esv);
00104 veccopy(sv3, EdgSVClp3(xeptr));
00105 veccopy(ev3, EdgEVClp3(xeptr));
00106 if (MSD_lowEdgeEdgeCheckStep3(vsv, esv, sv3, ev3, t1, xpos))
00107 {
00108 d1 = vecd(pos, camptr->eye);
00109 d2 = vecd(xpos, camptr->eye);
00110 if (!(d1 < d2 - abseps))
00111 {
00112 MSD_lowAddEdgeDivision(pos);
00113 }
00114 }
00115 veccopy(EdgSVClp3(xeptr), sv3);
00116 veccopy(EdgEVClp3(xeptr), ev3);
00117 }
00118 }
00119 vec2cp(EdgSVClp2(xeptr), sv2);
00120 vec2cp(EdgEVClp2(xeptr), ev2);
00121 }
00122 }
00123 }
00124 }
00125
00126 int MSD_lowEdgeEdgeCheck(SPTYPE xoptr, SPTYPE optr, EPTYPE xeptr, EPTYPE eptr, \
00127 real sbox[][2], FPTYPE f1ptr, FPTYPE f2ptr)
00128 {
00129 real a0, a1;
00130 FPTYPE fptr;
00131
00132 if (FacFVisi(LooLFace(HalWLoop(EdgHe1(xeptr)))) ==
00133 FacFVisi(LooLFace(HalWLoop(EdgHe2(xeptr)))))
00134 {
00135 return(FALSE);
00136 }
00137 if (optr == xoptr)
00138 {
00139 if (eptr == xeptr)
00140 {
00141 return(FALSE);
00142 }
00143 if (HalVtx(EdgHe1(eptr)) == HalVtx(EdgHe1(xeptr)))
00144 {
00145 return(FALSE);
00146 }
00147 if (HalVtx(EdgHe1(eptr)) == HalVtx(EdgHe2(xeptr)))
00148 {
00149 return(FALSE);
00150 }
00151 if (HalVtx(EdgHe2(eptr)) == HalVtx(EdgHe1(xeptr)))
00152 {
00153 return(FALSE);
00154 }
00155 if (HalVtx(EdgHe2(eptr)) == HalVtx(EdgHe2(xeptr)))
00156 {
00157 return(FALSE);
00158 }
00159 }
00160 fptr = LooLFace(HalWLoop(EdgHe1(xeptr)));
00161 if ((f1ptr == fptr) || (f2ptr == fptr))
00162 {
00163 return(FALSE);
00164 }
00165 fptr = LooLFace(HalWLoop(EdgHe2(xeptr)));
00166 if ((f1ptr == fptr) || (f2ptr == fptr))
00167 {
00168 return(FALSE);
00169 }
00170 if (EdgEClp(xeptr) == FALSE)
00171 {
00172 return(FALSE);
00173 }
00174 a1 = EdgSVClp2(xeptr)[0];
00175 a0 = EdgEVClp2(xeptr)[0];
00176 if (a1 > a0)
00177 {
00178 if (a1 < sbox[0][0])
00179 {
00180 return(FALSE);
00181 }
00182 if (a0 > sbox[1][0])
00183 {
00184 return(FALSE);
00185 }
00186 }
00187 else
00188 {
00189 if (a0 < sbox[0][0])
00190 {
00191 return(FALSE);
00192 }
00193 if (a1 > sbox[1][0])
00194 {
00195 return(FALSE);
00196 }
00197 }
00198 a1 = EdgSVClp2(xeptr)[1];
00199 a0 = EdgEVClp2(xeptr)[1];
00200 if (a1 > a0)
00201 {
00202 if (a1 < sbox[0][1])
00203 {
00204 return(FALSE);
00205 }
00206 if (a0 > sbox[1][1])
00207 {
00208 return(FALSE);
00209 }
00210 }
00211 else
00212 {
00213 if (a0 < sbox[0][1])
00214 {
00215 return(FALSE);
00216 }
00217 if (a1 > sbox[1][1])
00218 {
00219 return(FALSE);
00220 }
00221 }
00222 return(TRUE);
00223 }
00224
00225 int MSD_lowEdgeEdgeCheckStep2(vector a1, vector a2, vector b1, vector b2, real *u, real *v)
00226 {
00227 vect2 a, b, ab;
00228 real cz, tmp;
00229 int i;
00230
00231 for (i = 0; i < 2; ++i)
00232 {
00233 a[i] = a2[i] - a1[i];
00234 b[i] = b2[i] - b1[i];
00235 ab[i] = b1[i] - a1[i];
00236 }
00237 if (!(fabs(cz = a[0] * b[1] - a[1] * b[0]) < releps))
00238 {
00239 *u = tmp = (ab[0] * b[1] - ab[1] * b[0]) / cz;
00240 if (!((tmp < -releps) || (1.0 + releps < tmp)))
00241 {
00242 *v = tmp = (ab[0] * a[1] - ab[1] * a[0]) / cz;
00243 if ((tmp < -releps) || (1.0 + releps < tmp))
00244 {
00245 return(FALSE);
00246 }
00247 return(TRUE);
00248 }
00249 }
00250 return(FALSE);
00251 }
00252
00253 int MSD_lowEdgeEdgeCheckStep3(vector s0, vector s1, vector v0, vector v1, real u, vector p)
00254 {
00255 vector v01, es, ev0, n;
00256 real cz, n0, n1, n2, t;
00257 int idx1, idx2;
00258
00259 if (camptr->mode == 1)
00260 {
00261 vecminus(v01, v1, v0);
00262 vecminus(ev0, camptr->eye, v0);
00263 calc_p(s1, s0, u, es);
00264 vecminus(es, es, camptr->eye);
00265 cross(n, v01, es);
00266 n0 = fabs(n[0]);
00267 n1 = fabs(n[1]);
00268 n2 = fabs(n[2]);
00269 idx1 = (n0 >= n1 && n0 >= n2) ? 1 : 0;
00270 idx2 = ((n0 >= n1 && n0 >= n2) || n1 >= n2) ? 2 : 1;
00271 cz = v01[idx1] * es[idx2] - v01[idx2] * es[idx1];
00272 if (fabs(cz) < releps)
00273 {
00274 return(FALSE);
00275 }
00276 t = (ev0[idx1] * es[idx2] - ev0[idx2] * es[idx1]) / cz;
00277 calc_p(v1, v0, t, p);
00278 }
00279 else
00280 {
00281 calc_p(v1, v0, u, p);
00282 }
00283 return(TRUE);
00284 }
00285
00286 void MSD_lowEdgeFaceIntersection(SPTYPE o1ptr, SPTYPE o2ptr, FPTYPE f1ptr, FPTYPE f2ptr)
00287 {
00288 SPTYPE xop;
00289 DPTYPE xdp;
00290 FPTYPE xfp;
00291 HPTYPE dummy;
00292 real ps, pe;
00293 vector pos;
00294
00295 for (AllSolids(xop))
00296 {
00297 if ((SolDsp(xop) != TRUE) || (xop == o1ptr) || (xop == o2ptr))
00298 {
00299 continue;
00300 }
00301 if (!MSD_lowBoxBoxIntersection(&SolBox(xop), &debox))
00302 {
00303 continue;
00304 }
00305 for (AllShellsSolid(xop, xdp))
00306 {
00307 for (AllFacesShell(xdp, xfp))
00308 {
00309 if ((FacFVisi(xfp) == DONTSHOW) || (xfp == f1ptr) || (xfp == f2ptr))
00310 {
00311 continue;
00312 }
00313 if (!MSD_lowBoxBoxIntersection(&FacBox(xfp), &debox))
00314 {
00315 continue;
00316 }
00317 ps = dot(desvtx, FacFeq(xfp)) + FacFeq(xfp)[3];
00318 pe = dot(deevtx, FacFeq(xfp)) + FacFeq(xfp)[3];
00319 if ((ps > -abseps) && (pe > -abseps))
00320 {
00321 continue;
00322 }
00323 if ((ps < abseps) && (pe < abseps))
00324 {
00325 continue;
00326 }
00327 calc_p(deevtx, desvtx, -ps / (pe - ps), pos);
00328 if (MSD_lowIsInsideFace(pos, xfp, &dummy) != DONTSHOW)
00329 {
00330 MSD_lowAddEdgeDivision(pos);
00331 }
00332 }
00333 }
00334 }
00335 }
00336
00337 void MSD_lowAddEdgeDivision(vector pos)
00338 {
00339 divedptr->devis = 2;
00340 veccopy((divedptr++)->devtx, pos);
00341 ++divednum;
00342 }