File: SVDraw3dImpl.mesa
Last edited by Bier on December 18, 1982 1:19 am
Author: Eric Bier on May 28, 1987 10:56:24 am PDT
Reconstructed from memory on July 18, 1985 1:02:55 pm PDT
Contents: Some useful combinations of Imager operations
DIRECTORY
CoordSys, SVGraphics, Imager, ImagerPath, ImagerTransformation, Matrix3d, SV2d, SV3d, SVBoundBox, SVBoundSphere, SVDraw3d, SVMatrix2d, SVModelTypes, SVRayTypes, SVVector2d, SVVector3d;
SVDraw3dImpl:
CEDAR PROGRAM
IMPORTS CoordSys, SVGraphics, Imager, ImagerPath, ImagerTransformation, SVBoundBox, SVBoundSphere, Matrix3d, SVVector2d, SVVector3d
EXPORTS SVDraw3d =
BEGIN
Camera: TYPE = SVModelTypes.Camera;
Composite: TYPE = SVRayTypes.Composite;
CoordSystem: TYPE = SVModelTypes.CoordSystem;
CSGTree: TYPE = SVRayTypes.CSGTree;
Matrix4by4: TYPE = SV3d.Matrix4by4;
Point2d: TYPE = SV2d.Point2d;
Point3d: TYPE = SV3d.Point3d;
Primitive: TYPE = SVRayTypes.Primitive;
Vector3d: TYPE = SV3d.Vector3d;
Vector2d: TYPE = SV2d.Vector2d;
DrawCoordSys:
PUBLIC
PROC [dc: Imager.Context, cs
CAMERA: Matrix4by4, camera: Camera] = {
origin: Point3d;
xAxis, yAxis, zAxis: Vector3d;
length: REAL = 50.0;
origin ← Matrix3d.OriginOfMatrix[csCAMERA];
xAxis ← SVVector3d.Normalize[Matrix3d.XAxisOfMatrix[csCAMERA]];
yAxis ← SVVector3d.Normalize[Matrix3d.YAxisOfMatrix[csCAMERA]];
zAxis ← SVVector3d.Normalize[Matrix3d.ZAxisOfMatrix[csCAMERA]];
xAxis ← SVVector3d.Scale[xAxis, length];
yAxis ← SVVector3d.Scale[yAxis, length];
zAxis ← SVVector3d.Scale[zAxis, length];
DrawVector[dc, xAxis, origin, camera];
SVGraphics.DrawChar[dc, 'x, camera];
DrawVector[dc, yAxis, origin, camera];
SVGraphics.DrawChar[dc, 'y, camera];
DrawVector[dc, zAxis, origin, camera];
SVGraphics.DrawChar[dc, 'z, camera];
};
alpha: REAL ← 0.25;
DrawSkitter:
PUBLIC
PROC [dc: Imager.Context, cs
CAMERA: Matrix4by4, camera: Camera] = {
OPEN SVVector3d;
origin: Point3d;
xAxis, yAxis, zAxis: Vector3d;
a, b: Point3d
c, d: Point3d;
length: REAL = 50.0;
origin ← Matrix3d.OriginOfMatrix[csCAMERA];
xAxis ← Normalize[Matrix3d.XAxisOfMatrix[csCAMERA]];
yAxis ← Normalize[Matrix3d.YAxisOfMatrix[csCAMERA]];
zAxis ← Normalize[Matrix3d.ZAxisOfMatrix[csCAMERA]];
xAxis ← Scale[xAxis, length];
yAxis ← Scale[yAxis, length];
zAxis ← Scale[zAxis, length];
DrawVector[dc, xAxis, origin, camera];
SVGraphics.DrawChar[dc, 'x, camera];
DrawVector[dc, yAxis, origin, camera];
SVGraphics.DrawChar[dc, 'y, camera];
DrawVector[dc, zAxis, origin, camera];
SVGraphics.DrawChar[dc, 'z, camera];
a ← Add[origin, Add[zAxis, Scale[xAxis, alpha]]];
b ← Add[origin, Add[zAxis, Scale[xAxis, -alpha]]];
c ← Add[origin, Add[zAxis, Scale[yAxis, alpha]]];
d ← Add[origin, Add[zAxis, Scale[yAxis, -alpha]]];
SVGraphics.SetCPAbsolute[dc, origin, camera];
SVGraphics.DrawToAbsolute[dc, a, camera];
SVGraphics.DrawToAbsolute[dc, b, camera];
SVGraphics.DrawToAbsolute[dc, origin, camera];
SVGraphics.DrawToAbsolute[dc, c, camera];
SVGraphics.DrawToAbsolute[dc, d, camera];
SVGraphics.DrawToAbsolute[dc, origin, camera];
};
DrawTargetCoordSys:
PUBLIC
PROC [dc: Imager.Context, cs
CAMERA: Matrix4by4, camera: Camera] = {
origin: Point3d;
xAxis, yAxis, zAxis: Vector3d;
upLeftVector, upRightVector, downRightVector, downLeftVector: Vector3d;
length: REAL = 50.0;
scalar: REAL = 0.8;
origin ← Matrix3d.OriginOfMatrix[csCAMERA];
xAxis ← SVVector3d.Normalize[Matrix3d.XAxisOfMatrix[csCAMERA]];
yAxis ← SVVector3d.Normalize[Matrix3d.YAxisOfMatrix[csCAMERA]];
zAxis ← SVVector3d.Normalize[Matrix3d.ZAxisOfMatrix[csCAMERA]];
xAxis ← SVVector3d.Scale[xAxis, length];
yAxis ← SVVector3d.Scale[yAxis, length];
zAxis ← SVVector3d.Scale[zAxis, length];
DrawVector[dc, xAxis, origin, camera];
SVGraphics.DrawChar[dc, 'x, camera];
DrawVector[dc, yAxis, origin, camera];
SVGraphics.DrawChar[dc, 'y, camera];
DrawVector[dc, zAxis, origin, camera];
SVGraphics.DrawChar[dc, 'z, camera];
Now draw the landing pad (in the z = 0 plane).
upLeftVector ← SVVector3d.Sub[yAxis, xAxis];
upRightVector ← SVVector3d.Add[yAxis, xAxis];
downRightVector ← SVVector3d.Negate[upLeftVector];
downLeftVector ← SVVector3d.Negate[upRightVector];
upLeftVector ← SVVector3d.Scale[upLeftVector, scalar];
upRightVector ← SVVector3d.Scale[upRightVector, scalar];
downRightVector ← SVVector3d.Scale[downRightVector, scalar];
downLeftVector ← SVVector3d.Scale[downLeftVector, scalar];
SVGraphics.SetCPAbsolute[dc, SVVector3d.Add[origin, upLeftVector], camera];
SVGraphics.DrawToAbsolute[dc, SVVector3d.Add[origin, upRightVector], camera];
SVGraphics.DrawToAbsolute[dc, SVVector3d.Add[origin, downRightVector], camera];
SVGraphics.DrawToAbsolute[dc, SVVector3d.Add[origin, downLeftVector], camera];
SVGraphics.DrawToAbsolute[dc, SVVector3d.Add[origin, upLeftVector], camera];
};
DrawJack:
PUBLIC
PROC [dc: Imager.Context, cs: CoordSystem, camera: Camera] = {
csCAMERA: Matrix4by4 ← CoordSys.WRTCamera[cs, camera.coordSys];
DrawCoordSys[dc, csCAMERA, camera];
};
DrawMovee:
PUBLIC
PROC [dc: Imager.Context, cs: CoordSystem, camera: Camera] = {
origin: Point3d;
xAxis, yAxis, zAxis: Vector3d;
csCAMERA: Matrix4by4 ← CoordSys.WRTCamera[cs, camera.coordSys];
upLeftVector, upRightVector, downRightVector, downLeftVector: Vector3d;
length: REAL = 50.0;
scalar: REAL = 0.2;
origin ← Matrix3d.OriginOfMatrix[csCAMERA];
xAxis ← SVVector3d.Normalize[Matrix3d.XAxisOfMatrix[csCAMERA]];
yAxis ← SVVector3d.Normalize[Matrix3d.YAxisOfMatrix[csCAMERA]];
zAxis ← SVVector3d.Normalize[Matrix3d.ZAxisOfMatrix[csCAMERA]];
xAxis ← SVVector3d.Scale[xAxis, length];
yAxis ← SVVector3d.Scale[yAxis, length];
zAxis ← SVVector3d.Scale[zAxis, length];
DrawVector[dc, xAxis, origin, camera];
SVGraphics.DrawChar[dc, 'x, camera];
DrawVector[dc, yAxis, origin, camera];
SVGraphics.DrawChar[dc, 'y, camera];
DrawVector[dc, zAxis, origin, camera];
SVGraphics.DrawChar[dc, 'z, camera];
Now draw the landing pad (in the z = 0 plane).
upLeftVector ← SVVector3d.Sub[yAxis, xAxis];
upRightVector ← SVVector3d.Add[yAxis, xAxis];
downRightVector ← SVVector3d.Negate[upLeftVector];
downLeftVector ← SVVector3d.Negate[upRightVector];
upLeftVector ← SVVector3d.Scale[upLeftVector, scalar];
upRightVector ← SVVector3d.Scale[upRightVector, scalar];
downRightVector ← SVVector3d.Scale[downRightVector, scalar];
downLeftVector ← SVVector3d.Scale[downLeftVector, scalar];
SVGraphics.SetCPAbsolute[dc, SVVector3d.Add[origin, upLeftVector], camera];
SVGraphics.DrawToAbsolute[dc, SVVector3d.Add[origin, upRightVector], camera];
SVGraphics.DrawToAbsolute[dc, SVVector3d.Add[origin, downRightVector], camera];
SVGraphics.DrawToAbsolute[dc, SVVector3d.Add[origin, downLeftVector], camera];
SVGraphics.DrawToAbsolute[dc, SVVector3d.Add[origin, upLeftVector], camera];
};
DrawPlaneSelection:
PUBLIC
PROC [dc: Imager.Context, cs: CoordSystem, planeNum:
NAT, camera: Camera] = {
origin: Point3d;
csCAMERA: Matrix4by4 ← CoordSys.WRTCamera[cs, camera.coordSys];
xAxis, yAxis, zAxis: Vector3d;
tightRopeStart, tightRopeEnd: Point3d;
upLeftVector, upRightVector, downRightVector, downLeftVector: Vector3d;
length: REAL = 50.0;
SELECT planeNum FROM
1 => {
-- x = 0 plane
csCAMERA ← Matrix3d.LocalRotateY[csCAMERA, -90];
};
2 => {
-- y = 0 plane
csCAMERA ← Matrix3d.LocalRotateX[csCAMERA, 90];
};
ENDCASE => ERROR;
origin ← Matrix3d.OriginOfMatrix[csCAMERA];
xAxis ← SVVector3d.Normalize[Matrix3d.XAxisOfMatrix[csCAMERA]];
yAxis ← SVVector3d.Normalize[Matrix3d.YAxisOfMatrix[csCAMERA]];
zAxis ← SVVector3d.Normalize[Matrix3d.ZAxisOfMatrix[csCAMERA]];
xAxis ← SVVector3d.Scale[xAxis, length];
yAxis ← SVVector3d.Scale[yAxis, length];
zAxis ← SVVector3d.Scale[zAxis, length];
Now draw the landing pad (in the z = 0 plane).
upLeftVector ← SVVector3d.Sub[yAxis, xAxis];
upRightVector ← SVVector3d.Add[yAxis, xAxis];
downRightVector ← SVVector3d.Negate[upLeftVector];
downLeftVector ← SVVector3d.Negate[upRightVector];
SVGraphics.SetCPAbsolute[dc, SVVector3d.Add[origin, upLeftVector], camera];
SVGraphics.DrawToAbsolute[dc, SVVector3d.Add[origin, upRightVector], camera];
SVGraphics.DrawToAbsolute[dc, SVVector3d.Add[origin, downRightVector], camera];
SVGraphics.DrawToAbsolute[dc, SVVector3d.Add[origin, downLeftVector], camera];
SVGraphics.DrawToAbsolute[dc, SVVector3d.Add[origin, upLeftVector], camera];
Now draw the tightrope (along the z axis).
tightRopeStart ← SVVector3d.Sub[origin, zAxis];
tightRopeEnd ← SVVector3d.Add[origin, zAxis];
SVGraphics.SetCPAbsolute[dc, tightRopeStart, camera];
SVGraphics.DrawToAbsolute[dc, tightRopeEnd, camera];
};
DrawXPlane:
PUBLIC
PROC [dc: Imager.Context, left, right, down, up:
REAL, cs: CoordSystem, camera: Camera] = {
Draw the square bounded by left, right, down, and up (left-right = z, down-up = y) in the x = 0 plane of cs. In other words, draw the square [left, up], [right, up], [right, down], [left, down] defined in the coordinates of cs.
localCamera: Matrix4by4 ← CoordSys.WRTCamera[cs, camera.coordSys];
SVGraphics.SetCP[dc, [0, up, left], camera, localCamera];
SVGraphics.DrawTo[dc, [0, up, right], camera, localCamera];
SVGraphics.DrawTo[dc, [0, down, right], camera, localCamera];
SVGraphics.DrawTo[dc, [0, down, left], camera, localCamera];
SVGraphics.DrawTo[dc, [0, up, left], camera, localCamera];
};
DrawYPlane: PUBLIC PROC [dc: Imager.Context, left, right, down, up: REAL, cs: CoordSystem, camera: Camera];
Draw the square bounded by left, right, down, and up (left-right = x, down-up = z) in the y = 0 plane of cs.
DrawZPlane: PUBLIC PROC [dc: Imager.Context, left, right, down, up: REAL, cs: CoordSystem, camera: Camera];
Draw the square bounded by left, right, down, and up (left-right = x, down-up = y) in the z = 0 plane of cs.
DrawVector:
PUBLIC
PROC [dc: Imager.Context, v: Vector3d, origin: Point3d, camera: Camera] = {
Assumes v and origin are in camera coords.
tip: Point3d;
originOnScreen, tipOnScreen, textOnScreen: Point2d;
vProjected: Vector2d;
mag: REAL;
epsilon: REAL = 1.0e-3;
tip ← SVVector3d.Add[origin, v];
SVGraphics.SetCPAbsolute[dc, origin, camera];
SVGraphics.DrawToAbsolute[dc, tip, camera];
Now set current position in case the caller wants to draw a character after this vector.
originOnScreen ← SVGraphics.DoProjection[origin, camera];
tipOnScreen ← SVGraphics.DoProjection[tip, camera];
vProjected ← SVVector2d.Sub[tipOnScreen, originOnScreen];
mag ← SVVector2d.Magnitude[vProjected];
IF mag < epsilon THEN vProjected ← [-7.0, 0.0]
ELSE vProjected ← SVVector2d.Scale[vProjected, 7.0/mag];
textOnScreen ← SVVector2d.Add[tipOnScreen, vProjected];
SVGraphics.SetCPAbsolute[dc, [textOnScreen[1], textOnScreen[2], 0.0], camera];
};
DrawLocalVector:
PUBLIC
PROC [dc: Imager.Context, v: Vector3d, origin: Point3d, camera: Camera, localCS: CoordSystem] = {
Assumes v and origin are in localCS coords.
tip: Point3d;
localCamera: Matrix4by4 ← CoordSys.WRTCamera[localCS, camera.coordSys];
tip ← SVVector3d.Add[origin, v];
SVGraphics.SetCP[dc, origin, camera, localCamera];
SVGraphics.DrawTo[dc, tip, camera, localCamera];
};
Draw2dCoordSys:
PUBLIC
PROC [dc: Imager.Context, origin: Point2d, camera: Camera] = {
Poorly named. This function draws cross hairs. origin is in camera coordinates.
originScreen: Point2d;
big: REAL = 9999.0;
originScreen ← CoordSys.CameraToScreen[origin, camera.screenCS];
Imager.MaskVector[dc, [originScreen[1]-big, originScreen[2]],
[originScreen[1]+big, originScreen[2]]];
Imager.MaskVector[dc, [originScreen[1], originScreen[2] + big], [originScreen[1], originScreen[2] - big]];
};
DrawX:
PUBLIC
PROC [dc: Imager.Context, point: Point2d, camera: Camera] = {
Used by Draw Point to indicate a point of interest. Would be in SVDraw, except that the point is in camera coordinates.
origin: Point2d;
side: REAL ← 7.0;
origin ← CoordSys.CameraToScreen[point, camera.screenCS];
Imager.MaskVector[dc, [origin[1]-side, origin[2] + side], [origin[1]+side, origin[2] - side]];
Imager.MaskVector[dc, [origin[1] + side, origin[2] + side], [origin[1]-side, origin[2] - side]];
};
DrawSelectedJoint:
PUBLIC
PROC [dc: Imager.Context, worldPt: Point3d, camera: Camera] = {
DoDrawFilledSquare:
PROC = {
Imager.SetXY[dc, [screenPt[1], screenPt[2]]]; -- set the current position
Imager.Trans[dc];
Imager.Move[dc]; -- move the origin to the current position
Imager.SetColor[dc, Imager.black];
Imager.MaskRectangle[dc, [-halfJointSize, -halfJointSize, jointSize, jointSize]];
};
worldCamera: Matrix4by4 ← CoordSys.FindWorldInTermsOf[camera.coordSys];
cameraPt: Point3d ← Matrix3d.Update[worldPt, worldCamera];
screenPt: Point2d;
halfJointSize: REAL = 3.0;
jointSize: REAL = 6.0;
halfHotJointSize: REAL = 5.0;
screenPt ← SVGraphics.DoProjection[cameraPt, camera];
screenPt ← CoordSys.CameraToScreen[screenPt, camera.screenCS];
Imager.DoSaveAll[dc, DoDrawFilledSquare];
};
DrawBoundBoxes:
PUBLIC
PROC [dc: Imager.Context, tree: CSGTree, camera: Camera] = {
DrawBoundBoxNode[dc, tree.son, camera];
};
DrawBoundBoxNode:
PROC [dc: Imager.Context, node:
REF
ANY, camera: Camera] = {
IF node = NIL THEN RETURN;
WITH node SELECT FROM
composite: Composite => {
SVBoundBox.DrawBoundBox[dc, composite.boundBox, camera.screenCS];
DrawBoundBoxNode[dc, composite.leftSolid, camera];
DrawBoundBoxNode[dc, composite.rightSolid, camera];
};
prim: Primitive => {
SVBoundBox.DrawBoundBox[dc, prim.boundBox, camera.screenCS];
};
ENDCASE => ERROR;
DrawBoundBox: PUBLIC PROC [dc: Imager.Context, node: REF ANY, camera: Camera, xor: BOOL] = {};
DrawBoundSpheres:
PUBLIC
PROC [dc: Imager.Context, tree: CSGTree, camera: Camera] = {
DrawBoundSphereNode[dc, tree.son, camera];
};
DrawBoundSphereNode:
PROC [dc: Imager.Context, node:
REF
ANY, camera: Camera] = {
IF node = NIL THEN RETURN;
WITH node SELECT FROM
composite: Composite => {
SVBoundSphere.DrawBoundSphere[dc, composite.boundSphere, camera];
DrawBoundSphereNode[dc, composite.leftSolid, camera];
DrawBoundSphereNode[dc, composite.rightSolid, camera];
};
prim: Primitive => {
SVBoundSphere.DrawBoundSphere[dc, prim.boundSphere, camera];
};
ENDCASE => ERROR;
DrawTransformedShape:
PUBLIC
PROC [dc: Imager.Context, cs
CAMERA: Matrix4by4, camera: Camera, path: Imager.PathProc] = {
Any two dimensional shape that can be drawn with the Imager, can be drawn as though its sheet of paper has been embedded in 3-space, rotated, scaled, and translated by csCAMERA. This procedure only works for the orthogonal projection.
DrawIt:
PROC = {
DrawPath: Imager.PathProc = {
ImagerPath.Transform[path, projection, moveTo, lineTo, curveTo, conicTo, arcTo];
};
Imager.SetStrokeWidth[dc, 3.0];
Imager.MaskStroke[context: dc, path: DrawPath, closed: TRUE];
};
xAxis, yAxis: Vector3d;
origin: Point3d;
projection, localCamera, cameraScreen: ImagerTransformation.Transformation;
xAxis ← Matrix3d.XAxisOfMatrix[csCAMERA];
yAxis ← Matrix3d.YAxisOfMatrix[csCAMERA];
origin ← Matrix3d.OriginOfMatrix[csCAMERA];
localCamera ← ImagerTransformation.Create[xAxis[1], yAxis[1], origin[1], xAxis[2], yAxis[2], origin[2]];
cameraScreen ← CameraWRTScreen[camera];
projection ← ImagerTransformation.Concat[localCamera, cameraScreen];
Imager.DoSaveAll[dc, DrawIt];
};
CameraWRTScreen:
PROC [camera: Camera]
RETURNS [camera
Screen: ImagerTransformation.Transformation] = {
screenCoordSys: CoordSystem ← camera.screenCS;
screenMat: Matrix4by4 ← CoordSys.GetMat[screenCoordSys];
camera
Screen ← ImagerTransformation.Translate[t:
[- screenMat[1][4], - screenMat[2][4]]
];
};
END.