f02877775729f2f1a4781e78eec84ad2d9f1ef56
[ctsim.git] / libctsim / phantom.cpp
1 /*****************************************************************************
2 ** FILE IDENTIFICATION
3 **
4 **     Name:                   phm.cpp
5 **     Purpose:                Routines for phantom objects
6 **     Progammer:              Kevin Rosenberg
7 **     Date Started:           Aug 1984
8 **
9 **  This is part of the CTSim program
10 **  Copyright (c) 1983-2009 Kevin Rosenberg
11 **
12 **  This program is free software; you can redistribute it and/or modify
13 **  it under the terms of the GNU General Public License (version 2) as
14 **  published by the Free Software Foundation.
15 **
16 **  This program is distributed in the hope that it will be useful,
17 **  but WITHOUT ANY WARRANTY; without even the implied warranty of
18 **  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
19 **  GNU General Public License for more details.
20 **
21 **  You should have received a copy of the GNU General Public License
22 **  along with this program; if not, write to the Free Software
23 **  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
24 ******************************************************************************/
25
26 #include "ct.h"
27
28 const int PhantomElement::POINTS_PER_CIRCLE = 360;
29 const double PhantomElement::SCALE_PELEM_EXTENT=0.000;  // increase pelem limits by 0.5%
30 //const double PhantomElement::SCALE_PELEM_EXTENT=0.005;  // increase pelem limits by 0.5%
31
32 const int Phantom::PHM_INVALID = -1;
33 const int Phantom::PHM_HERMAN = 0;
34 const int Phantom::PHM_SHEPP_LOGAN = 1;
35 const int Phantom::PHM_UNITPULSE = 2;
36
37 const char* Phantom::s_aszPhantomName[] =
38 {
39   "herman",
40   "shepp-logan",
41   "unit-pulse",
42 };
43
44 const char* Phantom::s_aszPhantomTitle[] =
45 {
46   "Herman Head",
47   "Shepp-Logan",
48   "Unit Pulse",
49 };
50
51 const int Phantom::s_iPhantomCount = sizeof(s_aszPhantomName) / sizeof(const char*);
52
53
54 // CLASS IDENTIFICATION
55 //   Phantom
56 //
57
58 Phantom::Phantom ()
59 {
60   init ();
61 }
62
63
64 Phantom::Phantom (const char* const phmName)
65 {
66   init ();
67   createFromPhantom (phmName);
68 }
69
70 void
71 Phantom::init ()
72 {
73   m_nPElem = 0;
74   m_xmin = 1E30;
75   m_xmax = -1E30;
76   m_ymin = 1E30;
77   m_ymax = -1E30;
78   m_composition = P_PELEMS;
79   m_fail = false;
80   m_id = PHM_INVALID;
81 }
82
83 Phantom::~Phantom ()
84 {
85   for (PElemIterator i = m_listPElem.begin(); i != m_listPElem.end(); i++) {
86     delete *i;
87   }
88 }
89
90
91 const char*
92 Phantom::convertPhantomIDToName (int phmID)
93 {
94   static const char *name = "";
95
96   if (phmID >= 0 && phmID < s_iPhantomCount)
97     return (s_aszPhantomName[phmID]);
98
99   return (name);
100 }
101
102 const char*
103 Phantom::convertPhantomIDToTitle (int phmID)
104 {
105   static const char *title = "";
106
107   if (phmID >= 0 && phmID < s_iPhantomCount)
108     return (s_aszPhantomName[phmID]);
109
110   return (title);
111 }
112
113 int
114 Phantom::convertNameToPhantomID (const char* const phmName)
115 {
116   int id = PHM_INVALID;
117
118   for (int i = 0; i < s_iPhantomCount; i++) {
119     if (strcasecmp (phmName, s_aszPhantomName[i]) == 0) {
120       id = i;
121       break;
122     }
123   }
124   return (id);
125 }
126
127
128 bool
129 Phantom::createFromPhantom (const char* const phmName)
130 {
131   int phmid = convertNameToPhantomID (phmName);
132   if (phmid == PHM_INVALID) {
133     m_fail = true;
134     m_failMessage = "Invalid phantom name ";
135     m_failMessage += phmName;
136     return false;
137   }
138
139   m_name = phmName;
140   createFromPhantom (phmid);
141   return true;
142 }
143
144 bool
145 Phantom::createFromPhantom (const int phmid)
146 {
147   switch (phmid)
148   {
149   case PHM_HERMAN:
150     addStdHerman();
151     break;
152   case PHM_SHEPP_LOGAN:
153     addStdSheppLogan();
154     break;
155   case PHM_UNITPULSE:
156     m_composition = P_UNIT_PULSE;
157     addPElem ("rectangle", 0., 0., 100., 100., 0., 0.);     // outline
158     addPElem ("ellipse", 0., 0., 1., 1., 0., 1.);             // pulse
159     break;
160   default:
161     m_fail = true;
162     m_failMessage = "Illegal phantom id ";
163     m_failMessage += phmid;
164     return false;
165   }
166
167   m_id = phmid;
168
169   return true;
170 }
171
172
173 /* METHOD IDENTIFICATION
174 *   createFromFile          Add PhantomElements from file
175 *
176 * SYNOPSIS
177 *   createFromFile (filename)
178 *
179 * RETURNS
180 *   true if pelem were added
181 *   false if an pelem not added
182 */
183
184 bool
185 Phantom::createFromFile (const char* const fname)
186 {
187   bool bGoodFile = true;
188   FILE *fp;
189
190   if ((fp = fopen (fname, "r")) == NULL)
191     return (false);
192
193   m_name = fname;
194
195   while (1) {
196     double cx, cy, u, v, rot, dens;
197     char pelemtype[80];
198
199     int status = fscanf (fp, "%79s %lf %lf %lf %lf %lf %lf", pelemtype, &cx, &cy, &u, &v, &rot, &dens);
200
201     if (status == static_cast<int>(EOF))
202       break;
203     else if (status != 7) {
204       sys_error (ERR_WARNING, "Insufficient fields reading phantom file %s [Phantom::createFromFile]", fname);
205       bGoodFile = false;
206     }
207     addPElem (pelemtype, cx, cy, u, v, rot, dens);
208   }
209
210   fclose (fp);
211
212   return (bGoodFile);
213 }
214
215 bool
216 Phantom::fileWrite (const char* const fname)
217 {
218   fstream file (fname, std::ios::out);
219
220   if (! file.fail())
221     printDefinitions (file);
222   return ! file.fail();
223 }
224
225 /* NAME
226 *   addPElem            Add pelem
227 *
228 * SYNOPSIS
229 *   addPElem (type, cx, cy, u, v, rot, atten)
230 *   char *type          type of pelem (box, ellipse, etc)
231 *   double cx, cy       pelem center
232 *   double u,v          pelem size
233 *   double rot          rotation angle of pelem (in degrees)
234 *   double atten        x-ray attenuation cooefficient
235 */
236
237 void
238 Phantom::addPElem (const char *type, const double cx, const double cy, const double u, const double v, const double rot, const double atten)
239 {
240   PhmElemType pe_type = PhantomElement::convertNameToType (type);
241   if (pe_type == PELEM_INVALID) {
242     sys_error (ERR_WARNING, "Unknown PhantomElement type %s [PhantomElement::PhantomElement]", type);
243     return;
244   }
245
246   PhantomElement *pelem = new PhantomElement (type, cx, cy, u, v, rot, atten);
247   m_listPElem.push_front (pelem);
248
249   // update phantom limits
250   if (m_xmin > pelem->xmin())    m_xmin = pelem->xmin();
251   if (m_xmax < pelem->xmax())    m_xmax = pelem->xmax();
252   if (m_ymin > pelem->ymin())    m_ymin = pelem->ymin();
253   if (m_ymax < pelem->ymax())    m_ymax = pelem->ymax();
254
255   m_nPElem++;
256 }
257
258
259 /*----------------------------------------------------------------------*/
260 /*                      Input-Output Routines                           */
261 /*----------------------------------------------------------------------*/
262
263
264 /* NAME
265 *   print                               Print vertices of Phantom pelems
266 *
267 * SYNOPSIS
268 *   print (phm)
269 */
270
271 void
272 Phantom::print (std::ostream& os) const
273 {
274   os << "Number of PElements: " << m_nPElem << "\n";
275   os << "Limits: xmin=" << m_xmin << ", ymin=" << m_ymin << ", xmax=" << m_xmax << ", ymax=" << m_ymax << "\n";
276
277   for (PElemConstIterator i = m_listPElem.begin(); i != m_listPElem.end(); i++) {
278     const PhantomElement& rPE = **i;
279     os << "PhantomElement: nPoints=" << rPE.nOutlinePoints();
280     os << ", atten=" << rPE.atten() << " rot=" << convertRadiansToDegrees (rPE.rot()) << "\n";
281     os << "xmin=" << rPE.xmin() << ", ymin=" << rPE.ymin() << ", xmax=" << rPE.xmax() << ", ymax=" << rPE.ymax() << "\n";
282
283     if (false)
284       for (int i = 0; i < rPE.nOutlinePoints(); i++)
285         os << rPE.xOutline()[i] << "," << rPE.yOutline()[i] << "\n";
286   }
287 }
288 void
289 Phantom::print (std::ostringstream& os) const
290 {
291   os << "Number of PElements: " << m_nPElem << "\n";
292   os << "Limits: xmin=" << m_xmin << ", ymin=" << m_ymin << ", xmax=" << m_xmax << ", ymax=" << m_ymax << "\n";
293
294   for (PElemConstIterator i = m_listPElem.begin(); i != m_listPElem.end(); i++) {
295     const PhantomElement& rPE = **i;
296     os << "PhantomElement: nPoints=" << rPE.nOutlinePoints();
297     os << ", atten=" << rPE.atten() << " rot=" << convertRadiansToDegrees (rPE.rot()) << "\n";
298     os << "xmin=" << rPE.xmin() << ", ymin=" << rPE.ymin() << ", xmax=" << rPE.xmax() << ", ymax=" << rPE.ymax() << "\n";
299
300     if (false)
301       for (int i = 0; i < rPE.nOutlinePoints(); i++)
302         os << rPE.xOutline()[i] << "," << rPE.yOutline()[i] << "\n";
303   }
304 }
305
306 void
307 Phantom::printDefinitions (std::ostream& os) const
308 {
309   for (PElemConstIterator i = m_listPElem.begin(); i != m_listPElem.end(); i++) {
310     const PhantomElement& rPE = **i;
311     rPE.printDefinition (os);
312   }
313 }
314
315 void
316 Phantom::printDefinitions (std::ostringstream& os) const
317 {
318   for (PElemConstIterator i = m_listPElem.begin(); i != m_listPElem.end(); i++) {
319     const PhantomElement& rPE = **i;
320     rPE.printDefinition (os);
321   }
322 }
323
324
325 /* NAME
326 *   show                Show vector outline of Phantom to user
327 *
328 * SYNOPSIS
329 *   show (pic)
330 */
331
332 #ifdef HAVE_SGP
333 void
334 Phantom::show () const
335 {
336   SGPDriver driverSGP ("Phantom Show");
337   SGP sgp (driverSGP);
338
339   show (sgp);
340
341   std::cout << "Press return to continue";
342   cio_kb_getc();
343 }
344
345 void
346 Phantom::show (SGP& sgp) const
347 {
348   double wsize = m_xmax - m_xmin;
349   if ((m_ymax - m_ymin) > wsize)
350     wsize = m_ymax - m_ymin;
351   wsize *= 1.01;
352   double halfWindow = wsize / 2;
353
354   double xcent = m_xmin + (m_xmax - m_xmin) / 2;
355   double ycent = m_ymin + (m_ymax - m_ymin) / 2;
356
357   sgp.setWindow (xcent - halfWindow, ycent - halfWindow, xcent + halfWindow, ycent + halfWindow);
358
359   draw (sgp);
360 }
361 #endif
362
363
364 /* NAME
365 *   draw                Draw vector outline of Phantom
366 *
367 * SYNOPSIS
368 *   draw ()
369 */
370
371 #ifdef HAVE_SGP
372 void
373 Phantom::draw (SGP& sgp) const
374 {
375   for (PElemIterator i = m_listPElem.begin(); i != m_listPElem.end(); i++)
376     sgp.polylineAbs ((*i)->xOutline(), (*i)->yOutline(), (*i)->nOutlinePoints());
377 }
378 #endif
379
380
381 /* NAME
382 *   addStdSheppLogan    Make head phantom of Shepp-Logan
383 *
384 * REFERENCES
385 *   S. W. Rowland, "Computer Implementation of Image Reconstruction
386 *       Formulas", in "Image Reconstruction from Projections: Implementation
387 *       and Applications", edited by G. T. Herman, 1978.
388 */
389
390 void
391 Phantom::addStdSheppLogan ()
392 {
393   addPElem ("ellipse",  0.0000,  0.0000, 0.6900,  0.9200,   0.0,  1.00);
394   addPElem ("ellipse",  0.0000, -0.0184, 0.6624,  0.8740,   0.0, -0.98);
395   addPElem ("ellipse",  0.2200,  0.0000, 0.1100,  0.3100, -18.0, -0.02);
396   addPElem ("ellipse", -0.2200,  0.0000, 0.1600,  0.4100,  18.0, -0.02);
397   addPElem ("ellipse",  0.0000,  0.3500, 0.2100,  0.2500,   0.0,  0.01);
398   addPElem ("ellipse",  0.0000,  0.1000, 0.0460,  0.0460,   0.0,  0.01);
399   addPElem ("ellipse",  0.0000, -0.1000, 0.0460,  0.0460,   0.0,  0.01);
400   addPElem ("ellipse", -0.0800, -0.6050, 0.0460,  0.0230,   0.0,  0.01);
401   addPElem ("ellipse",  0.0000, -0.6050, 0.0230,  0.0230,   0.0,  0.01);
402   addPElem ("ellipse",  0.0600, -0.6050, 0.0230,  0.0230,   0.0,  0.01);
403   addPElem ("ellipse",  0.5538, -0.3858, 0.0330,  0.2060, -18.0,  0.03);
404 }
405
406
407 /* NAME
408 *   addStdHerman                        Standard head phantom of G. T. Herman
409 *
410 * REFERENCES
411 *   G. T. Herman, "Image Reconstructions from Projections:  The Fundementals
412 *       of Computed Tomography", 1979.
413 */
414
415 void
416 Phantom::addStdHerman ()
417 {
418   addPElem ("ellipse",  0.000,  1.50,  0.375, 0.3000,  90.00, -0.003);
419   addPElem ("ellipse",  0.675, -0.75,  0.225, 0.1500, 140.00,  0.010);
420   addPElem ("ellipse",  0.750,  1.50,  0.375, 0.2250,  50.00,  0.003);
421   addPElem ("segment",  1.375, -7.50,  1.100, 0.6250,  19.20, -0.204);
422   addPElem ("segment",  1.375, -7.50,  1.100, 4.3200,  19.21,  0.204);
423   addPElem ("segment",  0.000, -2.25,  1.125, 0.3750,   0.00, -0.003);
424   addPElem ("segment",  0.000, -2.25,  1.125, 3.0000,   0.00,  0.003);
425   addPElem ("segment", -1.000,  3.75,  1.000, 0.5000, 135.00, -0.003);
426   addPElem ("segment", -1.000,  3.75,  1.000, 3.0000, 135.00,  0.003);
427   addPElem ("segment",  1.000,  3.75,  1.000, 0.5000, 225.00, -0.003);
428   addPElem ("segment",  1.000,  3.75,  1.000, 3.0000, 225.00,  0.003);
429   addPElem ("triangle", 5.025,  3.75,  1.125, 0.5000, 110.75,  0.206);
430   addPElem ("triangle",-5.025,  3.75,  1.125, 0.9000,-110.75,  0.206);
431   addPElem ("ellipse",  0.000,  0.00,  8.625, 6.4687,  90.00,  0.416);
432   addPElem ("ellipse",  0.000,  0.00,  7.875, 5.7187,  90.00, -0.206);
433 }
434
435
436
437 /* NAME
438 *    convertToImagefile         Make image array from Phantom
439 *
440 * SYNOPSIS
441 *    pic_to_imagefile (pic, im, nsample)
442 *    Phantom& pic               Phantom definitions
443 *    ImageFile  *im             Computed pixel array
444 *    int nsample                Number of samples along each axis for each pixel
445 *                               (total samples per pixel = nsample * nsample)
446 */
447
448 void
449 Phantom::convertToImagefile (ImageFile& im, double dViewRatio, const int in_nsample, const int trace) const
450 {
451   convertToImagefile (im, dViewRatio, in_nsample, trace, 0, im.nx(), true);
452 }
453
454 void
455 Phantom::convertToImagefile (ImageFile& im, const double dViewRatio, const int in_nsample, const int trace,
456                              const int colStart, const int colCount, bool bStoreAtColumnPos) const
457 {
458   int iStorageOffset = (bStoreAtColumnPos ? colStart : 0);
459   convertToImagefile (im, im.nx(), dViewRatio, in_nsample, trace, colStart, colCount, iStorageOffset);
460 }
461
462 void
463 Phantom::convertToImagefile (ImageFile& im, const int iTotalRasterCols, const double dViewRatio,
464             const int in_nsample, const int trace, const int colStart, const int colCount, int iStorageOffset) const
465 {
466   const int nx = im.nx();
467   const int ny = im.ny();
468   if (nx < 2 || ny < 2)
469     return;
470
471   int nsample = in_nsample;
472   if (nsample < 1)
473     nsample = 1;
474
475   double dx = m_xmax - m_xmin;
476   double dy = m_ymax - m_ymin;
477   double xcent = m_xmin + dx / 2;
478   double ycent = m_ymin + dy / 2;
479   double dHalflen = dViewRatio * (getDiameterBoundaryCircle() / SQRT2 / 2);
480
481   double xmin = xcent - dHalflen;
482   double xmax = xcent + dHalflen;
483   double ymin = ycent - dHalflen;
484   double ymax = ycent + dHalflen;
485
486   // Each pixel holds the average of the intensity of the cell with (ix,iy) at the center of the pixel
487   // Set major increments so that the last cell v[nx-1][ny-1] will start at xmax - xinc, ymax - yinc).
488   // Set minor increments so that sample points are centered in cell
489
490   double xinc = (xmax - xmin) / (iTotalRasterCols);
491   double yinc = (ymax - ymin) / ny;
492
493   double kxinc = xinc / nsample;                /* interval between samples */
494   double kyinc = yinc / nsample;
495   double kxofs = kxinc / 2;             /* offset of 1st point */
496   double kyofs = kyinc / 2;
497
498   im.setAxisExtent (xmin, xmax, ymin, ymax);
499   im.setAxisIncrement (xinc, yinc);
500
501   ImageFileArray v = im.getArray();
502
503   for (int ix = 0; ix < colCount; ix++) {
504     int iColStore = ix + iStorageOffset;
505     ImageFileColumn vCol = v[iColStore];
506     for (int iy = 0; iy < ny; iy++)
507       *vCol++ = 0;
508   }
509
510 #if HAVE_OPENMP
511   double x_start = xmin + (colStart * xinc);
512   for (PElemConstIterator pelem = m_listPElem.begin(); pelem != m_listPElem.end(); pelem++) {
513     const PhantomElement& rPElem = **pelem;
514     #pragma omp parallel for
515     for (int ix = 0; ix < colCount; ix++) {
516       double x = x_start + ix * xinc;
517       int iColStore = ix + iStorageOffset;
518       ImageFileColumn vCol = v[iColStore];
519       for (int iy = 0; iy < ny; iy++) {
520         double y = ymin + iy * yinc;
521         double dAtten = 0;
522         for (int kx = 0; kx < nsample; kx++) {
523           double xi = x + kxofs + kxinc * kx;
524           for (int ky = 0; ky < nsample; ky++) {
525             double yi = y + kyofs + ky * kyinc;
526             if (rPElem.isPointInside (xi, yi, PHM_COORD))
527               dAtten += rPElem.atten();
528           } // ky
529         } // kx
530         *vCol++ += dAtten;
531       } /* iy */
532     }  /* ix */
533   }  /* pelem */
534   
535 #else
536   
537   double x_start = xmin + (colStart * xinc);
538   for (PElemConstIterator pelem = m_listPElem.begin(); pelem != m_listPElem.end(); pelem++) {
539     const PhantomElement& rPElem = **pelem;
540     double x, y, xi, yi;
541     int ix, iy, kx, ky;
542     for (ix = 0, x = x_start; ix < colCount; ix++, x += xinc) {
543       int iColStore = ix + iStorageOffset;
544       ImageFileColumn vCol = v[iColStore];
545       for (iy = 0, y = ymin; iy < ny; iy++, y += yinc) {
546         double dAtten = 0;
547         for (kx = 0, xi = x + kxofs; kx < nsample; kx++, xi += kxinc) {
548           for (ky = 0, yi = y + kyofs; ky < nsample; ky++, yi += kyinc)
549             if (rPElem.isPointInside (xi, yi, PHM_COORD))
550               dAtten += rPElem.atten();
551         } // for kx
552         *vCol++ += dAtten;
553       } /* for iy */
554     }  /* for ix */
555   }  /* for pelem */
556 #endif
557
558   if (nsample > 1) {
559     double factor = 1.0 / static_cast<double>(nsample * nsample);
560 #if HAVE_OPENMP
561     #pragma omp parallel for
562 #endif    
563     for (int ix = 0; ix < colCount; ix++) {
564       int iColStore = ix + iStorageOffset;
565       ImageFileColumn vCol = v[iColStore];
566       for (int iy = 0; iy < ny; iy++)
567         *vCol++ *= factor;
568     }
569   }
570 }
571
572 ////////////////////////////////////////////////////////////////////////////////////////////////////////
573 // CLASS IDENTIFICATION
574 //
575 //      PhantomElement
576 //
577 // PURPOSE
578 //
579 ////////////////////////////////////////////////////////////////////////////////////////////////////////
580
581
582 PhantomElement::PhantomElement (const char *type, const double cx, const double cy, const double u, const double v, const double rot, const double atten)
583 : m_cx(cx), m_cy(cy), m_u(u), m_v(v), m_atten(atten), m_nPoints(0), m_xOutline(0), m_yOutline(0)
584 {
585   m_rot = convertDegreesToRadians (rot);   // convert angle to radians
586
587   m_type = convertNameToType (type);
588
589   makeTransformMatrices ();     // calc transform matrices between phantom and normalized phantomelement
590   makeVectorOutline ();         // calculate vector outline of pelem
591
592   m_rectLimits[0] = m_xmin;   m_rectLimits[1] = m_ymin;
593   m_rectLimits[2] = m_xmax;   m_rectLimits[3] = m_ymax;
594 }
595
596
597
598 PhantomElement::~PhantomElement ()
599 {
600   delete m_xOutline;
601   delete m_yOutline;
602 }
603
604 void
605 PhantomElement::printDefinition (std::ostream& os) const
606 {
607   os << convertTypeToName (m_type) << " " << m_cx << " " << m_cy << " " << m_u << " "
608     << m_v << " " << convertRadiansToDegrees (m_rot) << " " << m_atten << "\n";
609 }
610
611 void
612 PhantomElement::printDefinition (std::ostringstream& os) const
613 {
614   os << convertTypeToName (m_type) << " " << m_cx << " " << m_cy << " " << m_u << " "
615     << m_v << " " << convertRadiansToDegrees (m_rot) << " " << m_atten << "\n";
616 }
617
618 PhmElemType
619 PhantomElement::convertNameToType (const char* const typeName)
620 {
621   PhmElemType type = PELEM_INVALID;
622
623   if (strcasecmp (typeName, "rectangle") == 0)
624     type = PELEM_RECTANGLE;
625   else if (strcasecmp (typeName, "triangle") == 0)
626     type = PELEM_TRIANGLE;
627   else if (strcasecmp (typeName, "ellipse") == 0)
628     type = PELEM_ELLIPSE;
629   else if (strcasecmp (typeName, "sector") == 0)
630     type = PELEM_SECTOR;
631   else if (strcasecmp (typeName, "segment") == 0)
632     type = PELEM_SEGMENT;
633
634   return (type);
635 }
636
637 const char* const
638 PhantomElement::convertTypeToName (PhmElemType iType)
639 {
640   static const char* pszType = "Unknown";
641
642   if (iType == PELEM_RECTANGLE)
643     pszType = "rectangle";
644   else if (iType == PELEM_TRIANGLE)
645     pszType = "triangle";
646   else if (iType == PELEM_ELLIPSE)
647     pszType = "ellipse";
648   else if (iType == PELEM_SECTOR)
649     pszType = "sector";
650   else if (iType == PELEM_SEGMENT)
651     pszType = "segment";
652
653   return pszType;
654 }
655
656
657 void
658 PhantomElement::makeTransformMatrices ()
659 {
660   GRFMTX_2D temp;
661
662   // To map normalized Pelem coords to world Phantom
663   //     scale by (u, v)
664   //     rotate by rot
665   //     translate by (cx, cy)
666
667   scale_mtx2 (m_xformObjToPhm, m_u, m_v);
668   rot_mtx2  (temp, m_rot);
669   mult_mtx2 (m_xformObjToPhm, temp, m_xformObjToPhm);
670   xlat_mtx2 (temp, m_cx, m_cy);
671   mult_mtx2 (m_xformObjToPhm, temp, m_xformObjToPhm);
672
673   // to map world Phantom coodinates to normalized PElem coords
674   //     translate by (-cx, -cy)
675   //     rotate by -rot
676   //     scale by (1/u, 1/v)
677
678   xlat_mtx2 (m_xformPhmToObj, -m_cx, -m_cy);
679   rot_mtx2  (temp, -m_rot);
680   mult_mtx2 (m_xformPhmToObj, temp, m_xformPhmToObj);
681   scale_mtx2 (temp, 1 / m_u, 1 / m_v);
682   mult_mtx2 (m_xformPhmToObj, temp, m_xformPhmToObj);
683 }
684
685
686 /* NAME
687 *   pelem_make_points           INTERNAL routine to calculate point array for an pelem
688 *
689 * SYNOPSIS
690 *   makepelempts (pelem)
691 *   PELEM *pelem        pelem whose points we are calculating
692 *
693 * NOTES
694 *   Called by phm_add_pelem()
695 */
696
697 void
698 PhantomElement::makeVectorOutline ()
699 {
700   double radius, theta, start, stop;
701   double xfact, yfact;
702   int cpts;
703
704   m_nPoints = 0;
705   switch (m_type) {
706   case PELEM_RECTANGLE:
707     m_nPoints = 5;
708     m_xOutline = new double [m_nPoints];
709     m_yOutline = new double [m_nPoints];
710     m_xOutline[0] =-m_u;        m_yOutline[0] =-m_v;
711     m_xOutline[1] = m_u;        m_yOutline[1] =-m_v;
712     m_xOutline[2] = m_u;        m_yOutline[2] = m_v;
713     m_xOutline[3] =-m_u;        m_yOutline[3] = m_v;
714     m_xOutline[4] =-m_u;        m_yOutline[4] =-m_v;
715     break;
716   case PELEM_TRIANGLE:
717     m_nPoints = 4;
718     m_xOutline = new double [m_nPoints];
719     m_yOutline = new double [m_nPoints];
720     m_xOutline[0] =-m_u;        m_yOutline[0] = 0.0;
721     m_xOutline[1] = m_u;        m_yOutline[1] = 0.0;
722     m_xOutline[2] = 0.0;        m_yOutline[2] = m_v;
723     m_xOutline[3] =-m_u;        m_yOutline[3] = 0.0;
724     break;
725   case PELEM_ELLIPSE:
726     cpts = numCirclePoints (TWOPI);
727     m_nPoints = cpts;
728     m_xOutline = new double [m_nPoints];
729     m_yOutline = new double [m_nPoints];
730     calcEllipsePoints (m_xOutline, m_yOutline, cpts, m_u, m_v);
731     break;
732   case PELEM_SECTOR:
733     radius = sqrt(m_u * m_u + m_v * m_v);
734     theta = atan(m_u / m_v);            // angle with y-axis
735     start = 3.0 * HALFPI - theta;
736     stop  = 3.0 * HALFPI + theta;
737     cpts = numCirclePoints (stop - start);
738     m_nPoints = 3 + cpts;
739     m_xOutline = new double [m_nPoints];
740     m_yOutline = new double [m_nPoints];
741
742     m_xOutline[0] = 0.0;                m_yOutline[0] = m_v;
743     m_xOutline[1] =-m_u;                m_yOutline[1] = 0.0;
744     calcArcPoints (&m_xOutline[2], &m_yOutline[2], cpts, 0.0, m_v, radius, start, stop);
745     m_xOutline[cpts + 2] = 0.0;
746     m_yOutline[cpts + 2] = m_v;
747     break;
748   case PELEM_SEGMENT:
749     radius = sqrt(m_u * m_u + m_v * m_v);
750     theta = atan (m_u / m_v);           // angle with y-axis
751     start = 3.0 * HALFPI - theta;
752     stop  = 3.0 * HALFPI + theta;
753
754     cpts = numCirclePoints (stop - start);
755     m_nPoints = cpts + 1;
756     m_xOutline = new double [m_nPoints];
757     m_yOutline = new double [m_nPoints];
758
759     calcArcPoints (m_xOutline, m_yOutline, cpts, 0.0, m_v, radius, start, stop);
760     m_xOutline[cpts] = -m_u;
761     m_yOutline[cpts] = 0.0;
762     break;
763   default:
764     sys_error(ERR_WARNING, "Illegal phantom element type %d [makeVectorOutline]", m_type);
765     return;
766   }
767
768   rotate2d (m_xOutline, m_yOutline, m_nPoints, m_rot);
769   xlat2d (m_xOutline, m_yOutline, m_nPoints, m_cx, m_cy);
770
771   minmax_array (m_xOutline, m_nPoints, m_xmin, m_xmax);
772   minmax_array (m_yOutline, m_nPoints, m_ymin, m_ymax);
773
774   // increase pelem extent by SCALE_PELEM_EXTENT to eliminate chance of
775   //   missing actual pelem maximum due to polygonal sampling
776
777   xfact = (m_xmax - m_xmin) * SCALE_PELEM_EXTENT;
778   yfact = (m_ymax - m_ymin) * SCALE_PELEM_EXTENT;
779
780   m_xmin -= xfact;
781   m_ymin -= yfact;
782   m_xmax += xfact;
783   m_ymax += yfact;
784 }
785
786
787 /* NAME
788 *   calc_arc                    Calculate outline of a arc of a circle
789 *
790 * SYNOPSIS
791 *   calc_arc (x, y, xcent, ycent, pts, r, start, stop)
792 *   double x[], y[];            Array of points
793 *   int pts                     Number of points in array
794 *   double xcent, ycent Center of cirlce
795 *   double r                    Radius of circle
796 *   double start, stop          Beginning & ending angles
797 */
798
799 void
800 PhantomElement::calcArcPoints (double x[], double y[], const int pts, const double xcent, const double ycent, const double r, const double start, const double stop)
801 {
802   if (r <= 0.0)
803     sys_error (ERR_WARNING, "negative or zero radius in calc_arc()");
804
805   double theta = (stop - start) / (pts - 1);    // angle incr. between points
806   double c = cos(theta);
807   double s = sin(theta);
808
809   x[0] = r * cos (start) + xcent;
810   y[0] = r * sin (start) + ycent;
811
812   double xp = x[0] - xcent;
813   double yp = y[0] - ycent;
814   for (int i = 1; i < pts; i++) {
815     double xc = c * xp - s * yp;
816     double yc = s * xp + c * yp;
817     x[i] = xc + xcent;
818     y[i] = yc + ycent;
819     xp = xc;  yp = yc;
820   }
821 }
822
823
824 // NAME
825 //   PhantomElement::calcEllipsePoints    Calculate outline of a ellipse
826 //
827 // SYNOPSIS
828 //   calcEllipsePoints ()
829 //
830
831
832 void
833 PhantomElement::calcEllipsePoints (double x[], double y[], const int pts, const double u, const double v)
834 {
835   calcArcPoints (x, y, m_nPoints, 0.0, 0.0, 1.0, 0.0, TWOPI);   // make a unit circle
836   scale2d (x, y, m_nPoints, m_u, m_v);                       // scale to ellipse
837 }
838
839
840 /* NAME
841 *   circle_pts          Calculate number of points to use for circle segment
842 *
843 * SYNOPSIS
844 *   n = circle_pts (theta)
845 *   int n               Number of points to use for arc
846 *   double theta        Length of arc in radians
847 */
848
849 int
850 PhantomElement::numCirclePoints (double theta)
851 {
852   theta = clamp (theta, 0., TWOPI);
853
854   return static_cast<int> (POINTS_PER_CIRCLE * theta / TWOPI + 1.5);
855 }
856
857
858 bool
859 PhantomElement::clipLineWorldCoords (double& x1, double& y1, double& x2, double &y2) const
860 {
861   /* check if ray is outside of pelem extents */
862   double cx1 = x1, cy1 = y1, cx2 = x2, cy2 = y2;
863   if (! clip_rect (cx1, cy1, cx2, cy2, m_rectLimits))
864     return false;
865
866   // convert phantom coordinates to pelem coordinates
867   xform_mtx2 (m_xformPhmToObj, x1, y1);
868   xform_mtx2 (m_xformPhmToObj, x2, y2);
869
870   if (! clipLineNormalizedCoords (x1, y1, x2, y2))
871     return false;
872
873   // convert standard pelem coordinates back to phantom coordinates
874   xform_mtx2 (m_xformObjToPhm, x1, y1);
875   xform_mtx2 (m_xformObjToPhm, x2, y2);
876
877   return true;
878 }
879
880
881 /* NAME
882 *   pelem_clip_line                     Clip pelem against an arbitrary line
883 *
884 * SYNOPSIS
885 *   pelem_clip_line (pelem, x1, y1, x2, y2)
886 *   PhantomElement& pelem;              Pelem to be clipped
887 *   double *x1, *y1, *x2, *y2   Endpoints of line to be clipped
888 *
889 * RETURNS
890 *   true   if line passes through pelem
891 *               (x1, y1, x2, y2 hold coordinates of new line)
892 *   false  if line do not pass through pelem
893 *               (x1, y1, x2, y2 are undefined)
894 */
895
896 bool
897 PhantomElement::clipLineNormalizedCoords (double& x1, double& y1, double& x2, double& y2) const
898 {
899   bool accept = false;
900
901   switch (m_type) {
902   case PELEM_RECTANGLE:
903     double rect[4];
904     rect[0] = -1.0;  rect[1] = -1.0;
905     rect[2] = 1.0;  rect[3] = 1.0;
906     accept = clip_rect (x1, y1, x2, y2, rect);
907     break;
908   case PELEM_ELLIPSE:
909     accept = clip_circle (x1, y1, x2, y2, 0.0, 0.0, 1.0, 0.0, 0.0);
910     break;
911   case PELEM_TRIANGLE:
912     accept = clip_triangle (x1, y1, x2, y2, 1.0, 1.0, true);
913     break;
914   case PELEM_SEGMENT:
915     accept = clip_segment (x1, y1, x2, y2, m_u, m_v);
916     break;
917   case PELEM_SECTOR:
918     accept = clip_sector (x1, y1, x2, y2, m_u, m_v);
919     break;
920   default:
921     sys_error (ERR_WARNING, "Illegal pelem type %d [pelem_clip_line]", m_type);
922     break;
923   }
924
925   return(accept);
926 }
927
928
929 // METHOD IDENTIFICATION
930 //    PhantomElement::isPointInside             Check if point is inside pelem
931 //
932 // SYNOPSIS
933 //    is_point_inside (pelem, x, y, coord_type)
934 //    double x, y               Point to see if lies in pelem
935 //    int coord_type            Coordinate type (PELEM_COORD or PHM_COORD)
936 //
937 // RETURNS
938 //    true if point lies within pelem
939 //    false if point lies outside of pelem
940
941 bool
942 PhantomElement::isPointInside (double x, double y, const CoordType coord_type) const
943 {
944   if (coord_type == PHM_COORD) {
945     xform_mtx2 (m_xformPhmToObj, x, y);
946   } else if (coord_type != PELEM_COORD) {
947     sys_error(ERR_WARNING, "Illegal coordinate type in pelem_is_point_inside");
948     return (false);
949   }
950
951   switch (m_type) {
952   case PELEM_RECTANGLE:
953     if (x > 1. || x < -1. || y > 1. || y < -1.)
954       return (false);
955     else
956       return (true);
957     break;
958   case PELEM_TRIANGLE:
959     if (y < 0. || y > 1. - x || y > 1. + x)
960       return (false);
961     else
962       return (true);
963     break;
964   case PELEM_ELLIPSE:
965     if (x > 1. || x < -1. || y > 1. || y < -1.)
966       return (false);
967     if (x * x + y * y > 1.)             // check if inside unit circle
968       return (false);
969     else
970       return (true);
971     break;
972
973     // for clipping segments & sectors, must NOT scale by (1/u, 1/v)
974     // because this destroys information about size of arc component
975
976   case PELEM_SEGMENT:
977     if (x > 1. || x < -1. || y > 0.)
978       return (false);           // clip against y > 0
979     x *= m_u;                   // put back u & v scale
980     y *= m_v;
981     if (x * x + (y-m_v) * (y-m_v) > m_u * m_u + m_v * m_v)
982       return (false);           // clip against circle, r = sqrt(@)
983     else
984       return (true);
985     break;
986   case PELEM_SECTOR:
987     if (x > 1. || x < -1. || y > 1.)   // extent
988       return (false);
989     if (y > 1. - x || y > 1. + x)      // triangle
990       return (false);                  // clip against triangle
991     x *= m_u;                  // circle: put back u & v scale
992     y *= m_v;
993     if (x * x + (y-m_v) * (y-m_v) > m_u * m_u + m_v * m_v)
994       return (false);                  // clip against circle
995     else
996       return (true);
997     break;
998   default:
999     sys_error (ERR_WARNING, "Illegal pelem type in pelem_is_point_inside()");
1000     break;
1001   }
1002
1003   return (false);
1004 }
1005
1006