Debian Codegraph @

libctsim/phantom.cpp

raw
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