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, csCAMERA: 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, csCAMERA: Matrix4by4, camera: Camera] = { OPEN SVVector3d; origin: Point3d; xAxis, yAxis, zAxis: Vector3d; 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]; c _ Add[origin, Add[zAxis, Scale[yAxis, alpha]]]; d _ Add[origin, Add[zAxis, Scale[yAxis, -alpha]]]; SVGraphics.SetCPAbsolute[dc, origin, camera]; SVGraphics.DrawToAbsolute[dc, c, camera]; SVGraphics.DrawToAbsolute[dc, d, camera]; SVGraphics.DrawToAbsolute[dc, origin, camera]; }; DrawTargetCoordSys: PUBLIC PROC [dc: Imager.Context, csCAMERA: 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]; 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]; 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]; }; 3 => { -- z = 0 plane }; 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]; 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]; 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] = { 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]; }; DrawVector: PUBLIC PROC [dc: Imager.Context, v: Vector3d, origin: Point3d, camera: Camera] = { 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]; 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] = { 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] = { 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] = { 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.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, csCAMERA: Matrix4by4, camera: Camera, path: Imager.PathProc] = { 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 [cameraScreen: ImagerTransformation.Transformation] = { screenCoordSys: CoordSystem _ camera.screenCS; screenMat: Matrix4by4 _ CoordSys.GetMat[screenCoordSys]; cameraScreen _ ImagerTransformation.Translate[t: [- screenMat[1][4], - screenMat[2][4]] ]; }; END. ΄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 a, b: Point3d a _ Add[origin, Add[zAxis, Scale[xAxis, alpha]]]; b _ Add[origin, Add[zAxis, Scale[xAxis, -alpha]]]; SVGraphics.DrawToAbsolute[dc, a, camera]; SVGraphics.DrawToAbsolute[dc, b, camera]; SVGraphics.DrawToAbsolute[dc, origin, camera]; Now draw the landing pad (in the z = 0 plane). Now draw the landing pad (in the z = 0 plane). Now draw the landing pad (in the z = 0 plane). Now draw the tightrope (along the z axis). 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. 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. Assumes v and origin are in camera coords. Now set current position in case the caller wants to draw a character after this vector. Assumes v and origin are in localCS coords. Poorly named. This function draws cross hairs. origin is in camera coordinates. Used by Draw Point to indicate a point of interest. Would be in SVDraw, except that the point is in camera coordinates. Imager.Trans[dc]; 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. Κ β˜Iheadšœ™Iprocšœ0™0Lšœ1™1L™9Lšœ7™7L˜šΟk ˜ LšœΈ˜Έ—L˜šœ ˜Lšœ|˜ƒLšœ ˜—Lš˜˜Lšœœ˜#Lšœ œ˜'Lšœ œ˜-Lšœ œ˜#Lšœ œ˜#Lšœ œ˜Lšœ œ˜Lšœ œ˜'Lšœ œ˜Lšœ œ˜L˜—šΟn œœœΟuœ!˜XL˜Lšœ˜Lšœœ˜Lšœ#Ÿœ˜+Lšœ6Ÿœ˜?Lšœ6Ÿœ˜?Lšœ6Ÿœ˜?Lšœ(˜(Lšœ(˜(Lšœ(˜(Lšœ&˜&Lšœ$˜$Lšœ&˜&Lšœ$˜$Lšœ&˜&Lšœ$˜$L˜L˜—Lšœœ˜L˜šž œœœŸœ!˜WLšœ ˜L˜Lšœ˜L™ L˜Lšœœ˜Lšœ#Ÿœ˜+Lšœ+Ÿœ˜4Lšœ+Ÿœ˜4Lšœ+Ÿœ˜4Lšœ˜Lšœ˜Lšœ˜Lšœ&˜&Lšœ$˜$Lšœ&˜&Lšœ$˜$Lšœ&˜&Lšœ$˜$Lšœ1™1Lšœ2™2Lšœ1˜1Lšœ2˜2Lšœ-˜-Lšœ)™)Lšœ)™)Lšœ.™.Lšœ)˜)Lšœ)˜)Lšœ.˜.L˜L˜—šžœœœŸœ!˜^L˜Lšœ˜L˜GLšœœ˜Lšœœ˜Lšœ#Ÿœ˜+Lšœ6Ÿœ˜?Lšœ6Ÿœ˜?Lšœ6Ÿœ˜?Lšœ(˜(Lšœ(˜(Lšœ(˜(Lšœ&˜&Lšœ$˜$Lšœ&˜&Lšœ$˜$Lšœ&˜&šœ$˜$L™.—Lšœ,˜,Lšœ-˜-Lšœ2˜2Lšœ2˜2Lšœ6˜6Lšœ8˜8Lšœ<˜˜>Mšœ)˜)L˜L˜—šžœœœ8˜SLšœ'˜'Lšœ˜L˜—šžœœœœ˜NLšœœœœ˜Lšœœ˜˜LšœA˜ALšœ2˜2Lšœ3˜3L˜—šœ˜Lšœ<˜