
DIRECTORY  G3dBasic, G3dIO, G3dMatrix, G3dTetrahedron, IO, Rope;

G3dTetrahedronImpl: CEDAR PROGRAM
IMPORTS G3dIO, G3dMatrix, IO
EXPORTS G3dTetrahedron


~ BEGIN

Error:		PUBLIC ERROR [reason: ROPE] ~ CODE;

debug:		IO.STREAM м NIL;

ROPE:			TYPE ~ Rope.ROPE;
Tetrahedron:	TYPE ~ G3dTetrahedron.Tetrahedron;
TetrahedronRep:	TYPE ~ G3dTetrahedron.TetrahedronRep;
Create: PUBLIC PROC [p0, p1,p2,p3: G3dBasic.Triple] RETURNS [Tetrahedron] ~ {
ans: Tetrahedron м NEW[TetrahedronRep];
ans.fromBary м NEW[G3dMatrix.MatrixRep];
ans.fromBary[0] м [p0.x,p0.y,p0.z,1.0];
ans.fromBary[1] м [p1.x,p1.y,p1.z,1.0];
ans.fromBary[2] м [p2.x,p2.y,p2.z,1.0];
ans.fromBary[3] м [p3.x,p3.y,p3.z,1.0];
ans.from3d м G3dMatrix.Invert[ans.fromBary];
RETURN [ans];
};
Copy: PUBLIC PROC [t: Tetrahedron] RETURNS [Tetrahedron] ~ {
ans: Tetrahedron;
IF t = NIL THEN RETURN[NIL];
ans м NEW[TetrahedronRep];
ans.from3d м G3dMatrix.CopyMatrix[t.from3d];
ans.fromBary м G3dMatrix.CopyMatrix[t.fromBary];
RETURN [ans];
};

MapFrom3D: PUBLIC PROC [t: Tetrahedron, pt: G3dBasic.Quad] RETURNS [G3dBasic.Quad] ~ {
IF t = NIL THEN ERROR Error["null Tetrahedron"];
RETURN [G3dMatrix.TransformQuad[pt, t.from3d]];
};
MapFromBarycentric: PUBLIC PROC [t: Tetrahedron, pt: G3dBasic.Quad] RETURNS [G3dBasic.Quad] ~ {
IF t = NIL THEN ERROR Error["null Tetrahedron"];
RETURN [G3dMatrix.TransformQuad[pt, t.fromBary]];
};
IsInside: PUBLIC PROC [t: Tetrahedron, pt: G3dBasic.Quad, tol: REAL м 0.001] RETURNS [BOOL] ~ {
bary: G3dBasic.Quad м MapFrom3D[t,pt];
sum: REAL;
IF debug # NIL THEN {
IO.PutFL[debug,"Tet.IsInside: [%g,%g,%g,%g]",
LIST[IO.real[pt.x], IO.real[pt.y], IO.real[pt.z], IO.real[pt.w]]];
IO.PutFL[debug," maps to [%g,%g,%g,%g]\n",
LIST[IO.real[bary.x], IO.real[bary.y], IO.real[bary.z], IO.real[bary.w]]];
};
IF bary.x + tol < 0.0 THEN {
RETURN [FALSE];
};
IF bary.y + tol < 0.0 THEN {
RETURN [FALSE];
};
IF bary.z + tol < 0.0 THEN {
RETURN [FALSE];
};
IF bary.w + tol < 0.0 THEN {
RETURN [FALSE];
};
sum м bary.x + bary.y + bary.z + bary.w;
RETURN [IF sum < 1.0 THEN sum+tol >= 1.0 ELSE sum-tol <= 1.0]; 
};
BoundingBox: PUBLIC PROC [t: Tetrahedron] RETURNS [ans: G3dBasic.Box] ~ {
mins: ARRAY[0 .. 3) OF REAL;
maxes: ARRAY[0 .. 3) OF REAL;

FOR col: INT IN [0 .. 3) DO
mins[col] м t.fromBary[0][col];
maxes[col] м mins[col];
ENDLOOP;
FOR row: INT IN [1.. 4) DO
FOR col: INT IN [0.. 3) DO
IF t.fromBary[row][col] < mins[col] THEN mins[col] м t.fromBary[row][col];
IF t.fromBary[row][col] > maxes[col] THEN maxes[col] м t.fromBary[row][col];
ENDLOOP;
ENDLOOP;
ans.min м [mins[0], mins[1], mins[2]];
ans.max м [maxes[0], maxes[1], maxes[2]];
RETURN [ans];
};

Read: PUBLIC PROC [s: IO.STREAM] RETURNS [Tetrahedron] ~ {
ans: Tetrahedron м NEW[TetrahedronRep];
ans.from3d м G3dIO.ReadMatrix[s];
ans.fromBary м G3dIO.ReadMatrix[s];
RETURN [ans];
};
Write: PUBLIC PROC [t: Tetrahedron, s: IO.STREAM]  ~ {
G3dIO.WriteMatrix[s, t.from3d];
G3dIO.WriteMatrix[s, t.fromBary];
};

Debug: PUBLIC PROC [dbg: IO.STREAM]  ~ {
debug м dbg;
};

END.

    ╨  
G3dPlaneImpl.mesa
Copyright ╙ 1991, 1992 by Xerox Corporation.  All rights reserved.
Ken Fishkin, August 20, 1992 4:16 pm PDT
Jules Bloomenthal July 14, 1992 3:56 pm PDT
Creation
Operation


I/O
Debug
Э╩┬  Ц"cedarcode" styleХNewlineDelimiter
Щ ЩJЪЬ	╧eЬ6ЩBJЩ(JЩ+JШ JЪ╧k	Ь.ЮЬШ@JШ ЧЪ╤blnЬЮЬЮШ!JЪЮЬЮШJЪЮЬШJШ JШ ЧЪЬЮШJШ Ъ
╧nЬЮЬЮЬ
ЮЬЮЬШ+JШ ЧЪЬЮЬЮЬЮЬШJШ ЧJЪЮЬЮЬЮЬШJЪЬЮЬШ/JЪЬЮЬ!Ш5ЧheadЪ╧lЩЪаЬЮЬЮЬ!ЮЬШMJЪЬЮЬШ'JЪЬЮЬШ(JШ'JШ'JШ'JШ'JШ,JЪЮЬШJШЧcodeЪаЬЮЬЮЬЮЬШ<LШLЪ
ЮЬЮЬЮЬЮЬЮЬШLЪЬЮЬШLШ,LШ0LЪЮЬШLШЧJШ ЧЪб	Щ	Ъа	ЬЮЬЮЬ%ЮЬШVJЪЮЬЮЬЮЬЮЬШ0JЪЮЬ)Ш/JШJЩ ЧЪаЬЮЬЮЬ%ЮЬШ_JЪЮЬЮЬЮЬЮЬШ0JЪЮЬ+Ш1JШJЩ ЧЪаЬЮЬЮЬ*ЮЬ
ЮЬЮЬШ_JШ&JЪЬЮЬШ
ЪЮЬ	ЮЬЮЬШЪЮЬ+Ш-JЪ
ЮЬЮЬЮЬЮЬЮЬШBЧЪЮЬ(Ш*JЪ
ЮЬЮЬЮЬЮЬЮЬШJЧJЪЬШЧЪЮЬЮЬШJЪЮЬЮЬШJЪЬШЧЪЮЬЮЬШJЪЮЬЮЬШJЪЬШЧЪЮЬЮЬШJЪЮЬЮЬШJЪЬШЧЪЮЬЮЬШJЪЮЬЮЬШJЪЬШЧJШ(JЪЮЬЮЬЮЬЮЬШ?JШЧЪаЬЮЬЮЬЮЬШILЪЬЮЬ	ЮЬЮЬШLЪЬЮЬ	ЮЬЮЬШLШ ЪЮЬЮЬЮЬ
ЮШLШLШLЪЮЬШЧЪЮЬЮЬЮЬ	ЮШЪЮЬЮЬЮЬ	ЮШLЪЮЬ"ЮЬ"ШJLЪЮЬ#ЮЬ#ШLLЪЮЬШЧLЪЮЬШЧLШ&LШ)LЪЮЬШLШЧJШ ЧЪбЩЪаЬЮЬЮЬЮЬЮЬЮЬШ:LЪЬЮЬШ'LШ!LШ#LЪЮЬШLШЧЪ
аЬЮЬЮЬЮЬЮЬШ6LШLШ!LШЧJШ ЧЪбЩЪ
аЬЮЬЮЬЮЬЮЬШ(JШJШЧJШ ЧJЪЮЬШJШ Ч ЕЧ    ╝  N  