1 | // boost quaternion.hpp header file |
---|
2 | |
---|
3 | // (C) Copyright Hubert Holin 2001. |
---|
4 | // Distributed under the Boost Software License, Version 1.0. (See |
---|
5 | // accompanying file LICENSE_1_0.txt or copy at |
---|
6 | // http://www.boost.org/LICENSE_1_0.txt) |
---|
7 | |
---|
8 | // See http://www.boost.org for updates, documentation, and revision history. |
---|
9 | |
---|
10 | #ifndef BOOST_QUATERNION_HPP |
---|
11 | #define BOOST_QUATERNION_HPP |
---|
12 | |
---|
13 | |
---|
14 | #include <complex> |
---|
15 | #include <iosfwd> // for the "<<" and ">>" operators |
---|
16 | #include <sstream> // for the "<<" operator |
---|
17 | |
---|
18 | #include <boost/config.hpp> // for BOOST_NO_STD_LOCALE |
---|
19 | #include <boost/detail/workaround.hpp> |
---|
20 | #ifndef BOOST_NO_STD_LOCALE |
---|
21 | #include <locale> // for the "<<" operator |
---|
22 | #endif /* BOOST_NO_STD_LOCALE */ |
---|
23 | |
---|
24 | #include <valarray> |
---|
25 | |
---|
26 | |
---|
27 | |
---|
28 | #include <boost/math/special_functions/sinc.hpp> // for the Sinus cardinal |
---|
29 | #include <boost/math/special_functions/sinhc.hpp> // for the Hyperbolic Sinus cardinal |
---|
30 | |
---|
31 | |
---|
32 | namespace boost |
---|
33 | { |
---|
34 | namespace math |
---|
35 | { |
---|
36 | #if BOOST_WORKAROUND(__GNUC__, < 3) |
---|
37 | // gcc 2.95.x uses expression templates for valarray calculations, but |
---|
38 | // the result is not conforming. We need BOOST_GET_VALARRAY to get an |
---|
39 | // actual valarray result when we need to call a member function |
---|
40 | #define BOOST_GET_VALARRAY(T,x) ::std::valarray<T>(x) |
---|
41 | // gcc 2.95.x has an "std::ios" class that is similar to |
---|
42 | // "std::ios_base", so we just use a #define |
---|
43 | #define BOOST_IOS_BASE ::std::ios |
---|
44 | // gcc 2.x ignores function scope using declarations, |
---|
45 | // put them in the scope of the enclosing namespace instead: |
---|
46 | using ::std::valarray; |
---|
47 | using ::std::sqrt; |
---|
48 | using ::std::cos; |
---|
49 | using ::std::sin; |
---|
50 | using ::std::exp; |
---|
51 | using ::std::cosh; |
---|
52 | #endif /* BOOST_WORKAROUND(__GNUC__, < 3) */ |
---|
53 | |
---|
54 | #define BOOST_QUATERNION_ACCESSOR_GENERATOR(type) \ |
---|
55 | type real() const \ |
---|
56 | { \ |
---|
57 | return(a); \ |
---|
58 | } \ |
---|
59 | \ |
---|
60 | quaternion<type> unreal() const \ |
---|
61 | { \ |
---|
62 | return(quaternion<type>(static_cast<type>(0),b,c,d)); \ |
---|
63 | } \ |
---|
64 | \ |
---|
65 | type R_component_1() const \ |
---|
66 | { \ |
---|
67 | return(a); \ |
---|
68 | } \ |
---|
69 | \ |
---|
70 | type R_component_2() const \ |
---|
71 | { \ |
---|
72 | return(b); \ |
---|
73 | } \ |
---|
74 | \ |
---|
75 | type R_component_3() const \ |
---|
76 | { \ |
---|
77 | return(c); \ |
---|
78 | } \ |
---|
79 | \ |
---|
80 | type R_component_4() const \ |
---|
81 | { \ |
---|
82 | return(d); \ |
---|
83 | } \ |
---|
84 | \ |
---|
85 | ::std::complex<type> C_component_1() const \ |
---|
86 | { \ |
---|
87 | return(::std::complex<type>(a,b)); \ |
---|
88 | } \ |
---|
89 | \ |
---|
90 | ::std::complex<type> C_component_2() const \ |
---|
91 | { \ |
---|
92 | return(::std::complex<type>(c,d)); \ |
---|
93 | } |
---|
94 | |
---|
95 | |
---|
96 | #define BOOST_QUATERNION_MEMBER_ASSIGNMENT_GENERATOR(type) \ |
---|
97 | template<typename X> \ |
---|
98 | quaternion<type> & operator = (quaternion<X> const & a_affecter) \ |
---|
99 | { \ |
---|
100 | a = static_cast<type>(a_affecter.R_component_1()); \ |
---|
101 | b = static_cast<type>(a_affecter.R_component_2()); \ |
---|
102 | c = static_cast<type>(a_affecter.R_component_3()); \ |
---|
103 | d = static_cast<type>(a_affecter.R_component_4()); \ |
---|
104 | \ |
---|
105 | return(*this); \ |
---|
106 | } \ |
---|
107 | \ |
---|
108 | quaternion<type> & operator = (quaternion<type> const & a_affecter) \ |
---|
109 | { \ |
---|
110 | a = a_affecter.a; \ |
---|
111 | b = a_affecter.b; \ |
---|
112 | c = a_affecter.c; \ |
---|
113 | d = a_affecter.d; \ |
---|
114 | \ |
---|
115 | return(*this); \ |
---|
116 | } \ |
---|
117 | \ |
---|
118 | quaternion<type> & operator = (type const & a_affecter) \ |
---|
119 | { \ |
---|
120 | a = a_affecter; \ |
---|
121 | \ |
---|
122 | b = c = d = static_cast<type>(0); \ |
---|
123 | \ |
---|
124 | return(*this); \ |
---|
125 | } \ |
---|
126 | \ |
---|
127 | quaternion<type> & operator = (::std::complex<type> const & a_affecter) \ |
---|
128 | { \ |
---|
129 | a = a_affecter.real(); \ |
---|
130 | b = a_affecter.imag(); \ |
---|
131 | \ |
---|
132 | c = d = static_cast<type>(0); \ |
---|
133 | \ |
---|
134 | return(*this); \ |
---|
135 | } |
---|
136 | |
---|
137 | |
---|
138 | #define BOOST_QUATERNION_MEMBER_DATA_GENERATOR(type) \ |
---|
139 | type a; \ |
---|
140 | type b; \ |
---|
141 | type c; \ |
---|
142 | type d; |
---|
143 | |
---|
144 | |
---|
145 | template<typename T> |
---|
146 | class quaternion |
---|
147 | { |
---|
148 | public: |
---|
149 | |
---|
150 | typedef T value_type; |
---|
151 | |
---|
152 | |
---|
153 | // constructor for H seen as R^4 |
---|
154 | // (also default constructor) |
---|
155 | |
---|
156 | explicit quaternion( T const & requested_a = T(), |
---|
157 | T const & requested_b = T(), |
---|
158 | T const & requested_c = T(), |
---|
159 | T const & requested_d = T()) |
---|
160 | : a(requested_a), |
---|
161 | b(requested_b), |
---|
162 | c(requested_c), |
---|
163 | d(requested_d) |
---|
164 | { |
---|
165 | // nothing to do! |
---|
166 | } |
---|
167 | |
---|
168 | |
---|
169 | // constructor for H seen as C^2 |
---|
170 | |
---|
171 | explicit quaternion( ::std::complex<T> const & z0, |
---|
172 | ::std::complex<T> const & z1 = ::std::complex<T>()) |
---|
173 | : a(z0.real()), |
---|
174 | b(z0.imag()), |
---|
175 | c(z1.real()), |
---|
176 | d(z1.imag()) |
---|
177 | { |
---|
178 | // nothing to do! |
---|
179 | } |
---|
180 | |
---|
181 | |
---|
182 | // UNtemplated copy constructor |
---|
183 | // (this is taken care of by the compiler itself) |
---|
184 | |
---|
185 | |
---|
186 | // templated copy constructor |
---|
187 | |
---|
188 | template<typename X> |
---|
189 | explicit quaternion(quaternion<X> const & a_recopier) |
---|
190 | : a(static_cast<T>(a_recopier.R_component_1())), |
---|
191 | b(static_cast<T>(a_recopier.R_component_2())), |
---|
192 | c(static_cast<T>(a_recopier.R_component_3())), |
---|
193 | d(static_cast<T>(a_recopier.R_component_4())) |
---|
194 | { |
---|
195 | // nothing to do! |
---|
196 | } |
---|
197 | |
---|
198 | |
---|
199 | // destructor |
---|
200 | // (this is taken care of by the compiler itself) |
---|
201 | |
---|
202 | |
---|
203 | // accessors |
---|
204 | // |
---|
205 | // Note: Like complex number, quaternions do have a meaningful notion of "real part", |
---|
206 | // but unlike them there is no meaningful notion of "imaginary part". |
---|
207 | // Instead there is an "unreal part" which itself is a quaternion, and usually |
---|
208 | // nothing simpler (as opposed to the complex number case). |
---|
209 | // However, for practicallity, there are accessors for the other components |
---|
210 | // (these are necessary for the templated copy constructor, for instance). |
---|
211 | |
---|
212 | BOOST_QUATERNION_ACCESSOR_GENERATOR(T) |
---|
213 | |
---|
214 | // assignment operators |
---|
215 | |
---|
216 | BOOST_QUATERNION_MEMBER_ASSIGNMENT_GENERATOR(T) |
---|
217 | |
---|
218 | // other assignment-related operators |
---|
219 | // |
---|
220 | // NOTE: Quaternion multiplication is *NOT* commutative; |
---|
221 | // symbolically, "q *= rhs;" means "q = q * rhs;" |
---|
222 | // and "q /= rhs;" means "q = q * inverse_of(rhs);" |
---|
223 | |
---|
224 | quaternion<T> & operator += (T const & rhs) |
---|
225 | { |
---|
226 | T at = a + rhs; // exception guard |
---|
227 | |
---|
228 | a = at; |
---|
229 | |
---|
230 | return(*this); |
---|
231 | } |
---|
232 | |
---|
233 | |
---|
234 | quaternion<T> & operator += (::std::complex<T> const & rhs) |
---|
235 | { |
---|
236 | T at = a + rhs.real(); // exception guard |
---|
237 | T bt = b + rhs.imag(); // exception guard |
---|
238 | |
---|
239 | a = at; |
---|
240 | b = bt; |
---|
241 | |
---|
242 | return(*this); |
---|
243 | } |
---|
244 | |
---|
245 | |
---|
246 | template<typename X> |
---|
247 | quaternion<T> & operator += (quaternion<X> const & rhs) |
---|
248 | { |
---|
249 | T at = a + static_cast<T>(rhs.R_component_1()); // exception guard |
---|
250 | T bt = b + static_cast<T>(rhs.R_component_2()); // exception guard |
---|
251 | T ct = c + static_cast<T>(rhs.R_component_3()); // exception guard |
---|
252 | T dt = d + static_cast<T>(rhs.R_component_4()); // exception guard |
---|
253 | |
---|
254 | a = at; |
---|
255 | b = bt; |
---|
256 | c = ct; |
---|
257 | d = dt; |
---|
258 | |
---|
259 | return(*this); |
---|
260 | } |
---|
261 | |
---|
262 | |
---|
263 | |
---|
264 | quaternion<T> & operator -= (T const & rhs) |
---|
265 | { |
---|
266 | T at = a - rhs; // exception guard |
---|
267 | |
---|
268 | a = at; |
---|
269 | |
---|
270 | return(*this); |
---|
271 | } |
---|
272 | |
---|
273 | |
---|
274 | quaternion<T> & operator -= (::std::complex<T> const & rhs) |
---|
275 | { |
---|
276 | T at = a - rhs.real(); // exception guard |
---|
277 | T bt = b - rhs.imag(); // exception guard |
---|
278 | |
---|
279 | a = at; |
---|
280 | b = bt; |
---|
281 | |
---|
282 | return(*this); |
---|
283 | } |
---|
284 | |
---|
285 | |
---|
286 | template<typename X> |
---|
287 | quaternion<T> & operator -= (quaternion<X> const & rhs) |
---|
288 | { |
---|
289 | T at = a - static_cast<T>(rhs.R_component_1()); // exception guard |
---|
290 | T bt = b - static_cast<T>(rhs.R_component_2()); // exception guard |
---|
291 | T ct = c - static_cast<T>(rhs.R_component_3()); // exception guard |
---|
292 | T dt = d - static_cast<T>(rhs.R_component_4()); // exception guard |
---|
293 | |
---|
294 | a = at; |
---|
295 | b = bt; |
---|
296 | c = ct; |
---|
297 | d = dt; |
---|
298 | |
---|
299 | return(*this); |
---|
300 | } |
---|
301 | |
---|
302 | |
---|
303 | quaternion<T> & operator *= (T const & rhs) |
---|
304 | { |
---|
305 | T at = a * rhs; // exception guard |
---|
306 | T bt = b * rhs; // exception guard |
---|
307 | T ct = c * rhs; // exception guard |
---|
308 | T dt = d * rhs; // exception guard |
---|
309 | |
---|
310 | a = at; |
---|
311 | b = bt; |
---|
312 | c = ct; |
---|
313 | d = dt; |
---|
314 | |
---|
315 | return(*this); |
---|
316 | } |
---|
317 | |
---|
318 | |
---|
319 | quaternion<T> & operator *= (::std::complex<T> const & rhs) |
---|
320 | { |
---|
321 | T ar = rhs.real(); |
---|
322 | T br = rhs.imag(); |
---|
323 | |
---|
324 | T at = +a*ar-b*br; |
---|
325 | T bt = +a*br+b*ar; |
---|
326 | T ct = +c*ar+d*br; |
---|
327 | T dt = -c*br+d*ar; |
---|
328 | |
---|
329 | a = at; |
---|
330 | b = bt; |
---|
331 | c = ct; |
---|
332 | d = dt; |
---|
333 | |
---|
334 | return(*this); |
---|
335 | } |
---|
336 | |
---|
337 | |
---|
338 | template<typename X> |
---|
339 | quaternion<T> & operator *= (quaternion<X> const & rhs) |
---|
340 | { |
---|
341 | T ar = static_cast<T>(rhs.R_component_1()); |
---|
342 | T br = static_cast<T>(rhs.R_component_2()); |
---|
343 | T cr = static_cast<T>(rhs.R_component_3()); |
---|
344 | T dr = static_cast<T>(rhs.R_component_4()); |
---|
345 | |
---|
346 | T at = +a*ar-b*br-c*cr-d*dr; |
---|
347 | T bt = +a*br+b*ar+c*dr-d*cr; //(a*br+ar*b)+(c*dr-cr*d); |
---|
348 | T ct = +a*cr-b*dr+c*ar+d*br; //(a*cr+ar*c)+(d*br-dr*b); |
---|
349 | T dt = +a*dr+b*cr-c*br+d*ar; //(a*dr+ar*d)+(b*cr-br*c); |
---|
350 | |
---|
351 | a = at; |
---|
352 | b = bt; |
---|
353 | c = ct; |
---|
354 | d = dt; |
---|
355 | |
---|
356 | return(*this); |
---|
357 | } |
---|
358 | |
---|
359 | |
---|
360 | |
---|
361 | quaternion<T> & operator /= (T const & rhs) |
---|
362 | { |
---|
363 | T at = a / rhs; // exception guard |
---|
364 | T bt = b / rhs; // exception guard |
---|
365 | T ct = c / rhs; // exception guard |
---|
366 | T dt = d / rhs; // exception guard |
---|
367 | |
---|
368 | a = at; |
---|
369 | b = bt; |
---|
370 | c = ct; |
---|
371 | d = dt; |
---|
372 | |
---|
373 | return(*this); |
---|
374 | } |
---|
375 | |
---|
376 | |
---|
377 | quaternion<T> & operator /= (::std::complex<T> const & rhs) |
---|
378 | { |
---|
379 | T ar = rhs.real(); |
---|
380 | T br = rhs.imag(); |
---|
381 | |
---|
382 | T denominator = ar*ar+br*br; |
---|
383 | |
---|
384 | T at = (+a*ar+b*br)/denominator; //(a*ar+b*br)/denominator; |
---|
385 | T bt = (-a*br+b*ar)/denominator; //(ar*b-a*br)/denominator; |
---|
386 | T ct = (+c*ar-d*br)/denominator; //(ar*c-d*br)/denominator; |
---|
387 | T dt = (+c*br+d*ar)/denominator; //(ar*d+br*c)/denominator; |
---|
388 | |
---|
389 | a = at; |
---|
390 | b = bt; |
---|
391 | c = ct; |
---|
392 | d = dt; |
---|
393 | |
---|
394 | return(*this); |
---|
395 | } |
---|
396 | |
---|
397 | |
---|
398 | template<typename X> |
---|
399 | quaternion<T> & operator /= (quaternion<X> const & rhs) |
---|
400 | { |
---|
401 | T ar = static_cast<T>(rhs.R_component_1()); |
---|
402 | T br = static_cast<T>(rhs.R_component_2()); |
---|
403 | T cr = static_cast<T>(rhs.R_component_3()); |
---|
404 | T dr = static_cast<T>(rhs.R_component_4()); |
---|
405 | |
---|
406 | T denominator = ar*ar+br*br+cr*cr+dr*dr; |
---|
407 | |
---|
408 | T at = (+a*ar+b*br+c*cr+d*dr)/denominator; //(a*ar+b*br+c*cr+d*dr)/denominator; |
---|
409 | T bt = (-a*br+b*ar-c*dr+d*cr)/denominator; //((ar*b-a*br)+(cr*d-c*dr))/denominator; |
---|
410 | T ct = (-a*cr+b*dr+c*ar-d*br)/denominator; //((ar*c-a*cr)+(dr*b-d*br))/denominator; |
---|
411 | T dt = (-a*dr-b*cr+c*br+d*ar)/denominator; //((ar*d-a*dr)+(br*c-b*cr))/denominator; |
---|
412 | |
---|
413 | a = at; |
---|
414 | b = bt; |
---|
415 | c = ct; |
---|
416 | d = dt; |
---|
417 | |
---|
418 | return(*this); |
---|
419 | } |
---|
420 | |
---|
421 | |
---|
422 | protected: |
---|
423 | |
---|
424 | BOOST_QUATERNION_MEMBER_DATA_GENERATOR(T) |
---|
425 | |
---|
426 | |
---|
427 | private: |
---|
428 | |
---|
429 | }; |
---|
430 | |
---|
431 | |
---|
432 | // declaration of quaternion specialization |
---|
433 | |
---|
434 | template<> class quaternion<float>; |
---|
435 | template<> class quaternion<double>; |
---|
436 | template<> class quaternion<long double>; |
---|
437 | |
---|
438 | |
---|
439 | // helper templates for converting copy constructors (declaration) |
---|
440 | |
---|
441 | namespace detail |
---|
442 | { |
---|
443 | |
---|
444 | template< typename T, |
---|
445 | typename U |
---|
446 | > |
---|
447 | quaternion<T> quaternion_type_converter(quaternion<U> const & rhs); |
---|
448 | } |
---|
449 | |
---|
450 | |
---|
451 | // implementation of quaternion specialization |
---|
452 | |
---|
453 | |
---|
454 | #define BOOST_QUATERNION_CONSTRUCTOR_GENERATOR(type) \ |
---|
455 | explicit quaternion( type const & requested_a = static_cast<type>(0), \ |
---|
456 | type const & requested_b = static_cast<type>(0), \ |
---|
457 | type const & requested_c = static_cast<type>(0), \ |
---|
458 | type const & requested_d = static_cast<type>(0)) \ |
---|
459 | : a(requested_a), \ |
---|
460 | b(requested_b), \ |
---|
461 | c(requested_c), \ |
---|
462 | d(requested_d) \ |
---|
463 | { \ |
---|
464 | } \ |
---|
465 | \ |
---|
466 | explicit quaternion( ::std::complex<type> const & z0, \ |
---|
467 | ::std::complex<type> const & z1 = ::std::complex<type>()) \ |
---|
468 | : a(z0.real()), \ |
---|
469 | b(z0.imag()), \ |
---|
470 | c(z1.real()), \ |
---|
471 | d(z1.imag()) \ |
---|
472 | { \ |
---|
473 | } |
---|
474 | |
---|
475 | |
---|
476 | #define BOOST_QUATERNION_MEMBER_ADD_GENERATOR_1(type) \ |
---|
477 | quaternion<type> & operator += (type const & rhs) \ |
---|
478 | { \ |
---|
479 | a += rhs; \ |
---|
480 | \ |
---|
481 | return(*this); \ |
---|
482 | } |
---|
483 | |
---|
484 | #define BOOST_QUATERNION_MEMBER_ADD_GENERATOR_2(type) \ |
---|
485 | quaternion<type> & operator += (::std::complex<type> const & rhs) \ |
---|
486 | { \ |
---|
487 | a += rhs.real(); \ |
---|
488 | b += rhs.imag(); \ |
---|
489 | \ |
---|
490 | return(*this); \ |
---|
491 | } |
---|
492 | |
---|
493 | #define BOOST_QUATERNION_MEMBER_ADD_GENERATOR_3(type) \ |
---|
494 | template<typename X> \ |
---|
495 | quaternion<type> & operator += (quaternion<X> const & rhs) \ |
---|
496 | { \ |
---|
497 | a += static_cast<type>(rhs.R_component_1()); \ |
---|
498 | b += static_cast<type>(rhs.R_component_2()); \ |
---|
499 | c += static_cast<type>(rhs.R_component_3()); \ |
---|
500 | d += static_cast<type>(rhs.R_component_4()); \ |
---|
501 | \ |
---|
502 | return(*this); \ |
---|
503 | } |
---|
504 | |
---|
505 | #define BOOST_QUATERNION_MEMBER_SUB_GENERATOR_1(type) \ |
---|
506 | quaternion<type> & operator -= (type const & rhs) \ |
---|
507 | { \ |
---|
508 | a -= rhs; \ |
---|
509 | \ |
---|
510 | return(*this); \ |
---|
511 | } |
---|
512 | |
---|
513 | #define BOOST_QUATERNION_MEMBER_SUB_GENERATOR_2(type) \ |
---|
514 | quaternion<type> & operator -= (::std::complex<type> const & rhs) \ |
---|
515 | { \ |
---|
516 | a -= rhs.real(); \ |
---|
517 | b -= rhs.imag(); \ |
---|
518 | \ |
---|
519 | return(*this); \ |
---|
520 | } |
---|
521 | |
---|
522 | #define BOOST_QUATERNION_MEMBER_SUB_GENERATOR_3(type) \ |
---|
523 | template<typename X> \ |
---|
524 | quaternion<type> & operator -= (quaternion<X> const & rhs) \ |
---|
525 | { \ |
---|
526 | a -= static_cast<type>(rhs.R_component_1()); \ |
---|
527 | b -= static_cast<type>(rhs.R_component_2()); \ |
---|
528 | c -= static_cast<type>(rhs.R_component_3()); \ |
---|
529 | d -= static_cast<type>(rhs.R_component_4()); \ |
---|
530 | \ |
---|
531 | return(*this); \ |
---|
532 | } |
---|
533 | |
---|
534 | #define BOOST_QUATERNION_MEMBER_MUL_GENERATOR_1(type) \ |
---|
535 | quaternion<type> & operator *= (type const & rhs) \ |
---|
536 | { \ |
---|
537 | a *= rhs; \ |
---|
538 | b *= rhs; \ |
---|
539 | c *= rhs; \ |
---|
540 | d *= rhs; \ |
---|
541 | \ |
---|
542 | return(*this); \ |
---|
543 | } |
---|
544 | |
---|
545 | #define BOOST_QUATERNION_MEMBER_MUL_GENERATOR_2(type) \ |
---|
546 | quaternion<type> & operator *= (::std::complex<type> const & rhs) \ |
---|
547 | { \ |
---|
548 | type ar = rhs.real(); \ |
---|
549 | type br = rhs.imag(); \ |
---|
550 | \ |
---|
551 | type at = +a*ar-b*br; \ |
---|
552 | type bt = +a*br+b*ar; \ |
---|
553 | type ct = +c*ar+d*br; \ |
---|
554 | type dt = -c*br+d*ar; \ |
---|
555 | \ |
---|
556 | a = at; \ |
---|
557 | b = bt; \ |
---|
558 | c = ct; \ |
---|
559 | d = dt; \ |
---|
560 | \ |
---|
561 | return(*this); \ |
---|
562 | } |
---|
563 | |
---|
564 | #define BOOST_QUATERNION_MEMBER_MUL_GENERATOR_3(type) \ |
---|
565 | template<typename X> \ |
---|
566 | quaternion<type> & operator *= (quaternion<X> const & rhs) \ |
---|
567 | { \ |
---|
568 | type ar = static_cast<type>(rhs.R_component_1()); \ |
---|
569 | type br = static_cast<type>(rhs.R_component_2()); \ |
---|
570 | type cr = static_cast<type>(rhs.R_component_3()); \ |
---|
571 | type dr = static_cast<type>(rhs.R_component_4()); \ |
---|
572 | \ |
---|
573 | type at = +a*ar-b*br-c*cr-d*dr; \ |
---|
574 | type bt = +a*br+b*ar+c*dr-d*cr; \ |
---|
575 | type ct = +a*cr-b*dr+c*ar+d*br; \ |
---|
576 | type dt = +a*dr+b*cr-c*br+d*ar; \ |
---|
577 | \ |
---|
578 | a = at; \ |
---|
579 | b = bt; \ |
---|
580 | c = ct; \ |
---|
581 | d = dt; \ |
---|
582 | \ |
---|
583 | return(*this); \ |
---|
584 | } |
---|
585 | |
---|
586 | // There is quite a lot of repetition in the code below. This is intentional. |
---|
587 | // The last conditional block is the normal form, and the others merely |
---|
588 | // consist of workarounds for various compiler deficiencies. Hopefuly, when |
---|
589 | // more compilers are conformant and we can retire support for those that are |
---|
590 | // not, we will be able to remove the clutter. This is makes the situation |
---|
591 | // (painfully) explicit. |
---|
592 | |
---|
593 | #define BOOST_QUATERNION_MEMBER_DIV_GENERATOR_1(type) \ |
---|
594 | quaternion<type> & operator /= (type const & rhs) \ |
---|
595 | { \ |
---|
596 | a /= rhs; \ |
---|
597 | b /= rhs; \ |
---|
598 | c /= rhs; \ |
---|
599 | d /= rhs; \ |
---|
600 | \ |
---|
601 | return(*this); \ |
---|
602 | } |
---|
603 | |
---|
604 | #if defined(__GNUC__) && (__GNUC__ < 3) |
---|
605 | #define BOOST_QUATERNION_MEMBER_DIV_GENERATOR_2(type) \ |
---|
606 | quaternion<type> & operator /= (::std::complex<type> const & rhs) \ |
---|
607 | { \ |
---|
608 | using ::std::valarray; \ |
---|
609 | \ |
---|
610 | valarray<type> tr(2); \ |
---|
611 | \ |
---|
612 | tr[0] = rhs.real(); \ |
---|
613 | tr[1] = rhs.imag(); \ |
---|
614 | \ |
---|
615 | type mixam = (BOOST_GET_VALARRAY(type,static_cast<type>(1)/abs(tr)).max)(); \ |
---|
616 | \ |
---|
617 | tr *= mixam; \ |
---|
618 | \ |
---|
619 | valarray<type> tt(4); \ |
---|
620 | \ |
---|
621 | tt[0] = +a*tr[0]+b*tr[1]; \ |
---|
622 | tt[1] = -a*tr[1]+b*tr[0]; \ |
---|
623 | tt[2] = +c*tr[0]-d*tr[1]; \ |
---|
624 | tt[3] = +c*tr[1]+d*tr[0]; \ |
---|
625 | \ |
---|
626 | tr *= tr; \ |
---|
627 | \ |
---|
628 | tt *= (mixam/tr.sum()); \ |
---|
629 | \ |
---|
630 | a = tt[0]; \ |
---|
631 | b = tt[1]; \ |
---|
632 | c = tt[2]; \ |
---|
633 | d = tt[3]; \ |
---|
634 | \ |
---|
635 | return(*this); \ |
---|
636 | } |
---|
637 | #elif defined(BOOST_NO_ARGUMENT_DEPENDENT_LOOKUP) |
---|
638 | #define BOOST_QUATERNION_MEMBER_DIV_GENERATOR_2(type) \ |
---|
639 | quaternion<type> & operator /= (::std::complex<type> const & rhs) \ |
---|
640 | { \ |
---|
641 | using ::std::valarray; \ |
---|
642 | using ::std::abs; \ |
---|
643 | \ |
---|
644 | valarray<type> tr(2); \ |
---|
645 | \ |
---|
646 | tr[0] = rhs.real(); \ |
---|
647 | tr[1] = rhs.imag(); \ |
---|
648 | \ |
---|
649 | type mixam = static_cast<type>(1)/(abs(tr).max)(); \ |
---|
650 | \ |
---|
651 | tr *= mixam; \ |
---|
652 | \ |
---|
653 | valarray<type> tt(4); \ |
---|
654 | \ |
---|
655 | tt[0] = +a*tr[0]+b*tr[1]; \ |
---|
656 | tt[1] = -a*tr[1]+b*tr[0]; \ |
---|
657 | tt[2] = +c*tr[0]-d*tr[1]; \ |
---|
658 | tt[3] = +c*tr[1]+d*tr[0]; \ |
---|
659 | \ |
---|
660 | tr *= tr; \ |
---|
661 | \ |
---|
662 | tt *= (mixam/tr.sum()); \ |
---|
663 | \ |
---|
664 | a = tt[0]; \ |
---|
665 | b = tt[1]; \ |
---|
666 | c = tt[2]; \ |
---|
667 | d = tt[3]; \ |
---|
668 | \ |
---|
669 | return(*this); \ |
---|
670 | } |
---|
671 | #else |
---|
672 | #define BOOST_QUATERNION_MEMBER_DIV_GENERATOR_2(type) \ |
---|
673 | quaternion<type> & operator /= (::std::complex<type> const & rhs) \ |
---|
674 | { \ |
---|
675 | using ::std::valarray; \ |
---|
676 | \ |
---|
677 | valarray<type> tr(2); \ |
---|
678 | \ |
---|
679 | tr[0] = rhs.real(); \ |
---|
680 | tr[1] = rhs.imag(); \ |
---|
681 | \ |
---|
682 | type mixam = static_cast<type>(1)/(abs(tr).max)(); \ |
---|
683 | \ |
---|
684 | tr *= mixam; \ |
---|
685 | \ |
---|
686 | valarray<type> tt(4); \ |
---|
687 | \ |
---|
688 | tt[0] = +a*tr[0]+b*tr[1]; \ |
---|
689 | tt[1] = -a*tr[1]+b*tr[0]; \ |
---|
690 | tt[2] = +c*tr[0]-d*tr[1]; \ |
---|
691 | tt[3] = +c*tr[1]+d*tr[0]; \ |
---|
692 | \ |
---|
693 | tr *= tr; \ |
---|
694 | \ |
---|
695 | tt *= (mixam/tr.sum()); \ |
---|
696 | \ |
---|
697 | a = tt[0]; \ |
---|
698 | b = tt[1]; \ |
---|
699 | c = tt[2]; \ |
---|
700 | d = tt[3]; \ |
---|
701 | \ |
---|
702 | return(*this); \ |
---|
703 | } |
---|
704 | #endif /* defined(__GNUC__) && (__GNUC__ < 3) */ /* BOOST_NO_ARGUMENT_DEPENDENT_LOOKUP */ |
---|
705 | |
---|
706 | #if defined(__GNUC__) && (__GNUC__ < 3) |
---|
707 | #define BOOST_QUATERNION_MEMBER_DIV_GENERATOR_3(type) \ |
---|
708 | template<typename X> \ |
---|
709 | quaternion<type> & operator /= (quaternion<X> const & rhs) \ |
---|
710 | { \ |
---|
711 | using ::std::valarray; \ |
---|
712 | \ |
---|
713 | valarray<type> tr(4); \ |
---|
714 | \ |
---|
715 | tr[0] = static_cast<type>(rhs.R_component_1()); \ |
---|
716 | tr[1] = static_cast<type>(rhs.R_component_2()); \ |
---|
717 | tr[2] = static_cast<type>(rhs.R_component_3()); \ |
---|
718 | tr[3] = static_cast<type>(rhs.R_component_4()); \ |
---|
719 | \ |
---|
720 | type mixam = (BOOST_GET_VALARRAY(type,static_cast<type>(1)/abs(tr)).max)(); \ |
---|
721 | \ |
---|
722 | tr *= mixam; \ |
---|
723 | \ |
---|
724 | valarray<type> tt(4); \ |
---|
725 | \ |
---|
726 | tt[0] = +a*tr[0]+b*tr[1]+c*tr[2]+d*tr[3]; \ |
---|
727 | tt[1] = -a*tr[1]+b*tr[0]-c*tr[3]+d*tr[2]; \ |
---|
728 | tt[2] = -a*tr[2]+b*tr[3]+c*tr[0]-d*tr[1]; \ |
---|
729 | tt[3] = -a*tr[3]-b*tr[2]+c*tr[1]+d*tr[0]; \ |
---|
730 | \ |
---|
731 | tr *= tr; \ |
---|
732 | \ |
---|
733 | tt *= (mixam/tr.sum()); \ |
---|
734 | \ |
---|
735 | a = tt[0]; \ |
---|
736 | b = tt[1]; \ |
---|
737 | c = tt[2]; \ |
---|
738 | d = tt[3]; \ |
---|
739 | \ |
---|
740 | return(*this); \ |
---|
741 | } |
---|
742 | #elif defined(BOOST_NO_ARGUMENT_DEPENDENT_LOOKUP) |
---|
743 | #define BOOST_QUATERNION_MEMBER_DIV_GENERATOR_3(type) \ |
---|
744 | template<typename X> \ |
---|
745 | quaternion<type> & operator /= (quaternion<X> const & rhs) \ |
---|
746 | { \ |
---|
747 | using ::std::valarray; \ |
---|
748 | using ::std::abs; \ |
---|
749 | \ |
---|
750 | valarray<type> tr(4); \ |
---|
751 | \ |
---|
752 | tr[0] = static_cast<type>(rhs.R_component_1()); \ |
---|
753 | tr[1] = static_cast<type>(rhs.R_component_2()); \ |
---|
754 | tr[2] = static_cast<type>(rhs.R_component_3()); \ |
---|
755 | tr[3] = static_cast<type>(rhs.R_component_4()); \ |
---|
756 | \ |
---|
757 | type mixam = static_cast<type>(1)/(abs(tr).max)(); \ |
---|
758 | \ |
---|
759 | tr *= mixam; \ |
---|
760 | \ |
---|
761 | valarray<type> tt(4); \ |
---|
762 | \ |
---|
763 | tt[0] = +a*tr[0]+b*tr[1]+c*tr[2]+d*tr[3]; \ |
---|
764 | tt[1] = -a*tr[1]+b*tr[0]-c*tr[3]+d*tr[2]; \ |
---|
765 | tt[2] = -a*tr[2]+b*tr[3]+c*tr[0]-d*tr[1]; \ |
---|
766 | tt[3] = -a*tr[3]-b*tr[2]+c*tr[1]+d*tr[0]; \ |
---|
767 | \ |
---|
768 | tr *= tr; \ |
---|
769 | \ |
---|
770 | tt *= (mixam/tr.sum()); \ |
---|
771 | \ |
---|
772 | a = tt[0]; \ |
---|
773 | b = tt[1]; \ |
---|
774 | c = tt[2]; \ |
---|
775 | d = tt[3]; \ |
---|
776 | \ |
---|
777 | return(*this); \ |
---|
778 | } |
---|
779 | #else |
---|
780 | #define BOOST_QUATERNION_MEMBER_DIV_GENERATOR_3(type) \ |
---|
781 | template<typename X> \ |
---|
782 | quaternion<type> & operator /= (quaternion<X> const & rhs) \ |
---|
783 | { \ |
---|
784 | using ::std::valarray; \ |
---|
785 | \ |
---|
786 | valarray<type> tr(4); \ |
---|
787 | \ |
---|
788 | tr[0] = static_cast<type>(rhs.R_component_1()); \ |
---|
789 | tr[1] = static_cast<type>(rhs.R_component_2()); \ |
---|
790 | tr[2] = static_cast<type>(rhs.R_component_3()); \ |
---|
791 | tr[3] = static_cast<type>(rhs.R_component_4()); \ |
---|
792 | \ |
---|
793 | type mixam = static_cast<type>(1)/(abs(tr).max)(); \ |
---|
794 | \ |
---|
795 | tr *= mixam; \ |
---|
796 | \ |
---|
797 | valarray<type> tt(4); \ |
---|
798 | \ |
---|
799 | tt[0] = +a*tr[0]+b*tr[1]+c*tr[2]+d*tr[3]; \ |
---|
800 | tt[1] = -a*tr[1]+b*tr[0]-c*tr[3]+d*tr[2]; \ |
---|
801 | tt[2] = -a*tr[2]+b*tr[3]+c*tr[0]-d*tr[1]; \ |
---|
802 | tt[3] = -a*tr[3]-b*tr[2]+c*tr[1]+d*tr[0]; \ |
---|
803 | \ |
---|
804 | tr *= tr; \ |
---|
805 | \ |
---|
806 | tt *= (mixam/tr.sum()); \ |
---|
807 | \ |
---|
808 | a = tt[0]; \ |
---|
809 | b = tt[1]; \ |
---|
810 | c = tt[2]; \ |
---|
811 | d = tt[3]; \ |
---|
812 | \ |
---|
813 | return(*this); \ |
---|
814 | } |
---|
815 | #endif /* defined(__GNUC__) && (__GNUC__ < 3) */ /* BOOST_NO_ARGUMENT_DEPENDENT_LOOKUP */ |
---|
816 | |
---|
817 | #define BOOST_QUATERNION_MEMBER_ADD_GENERATOR(type) \ |
---|
818 | BOOST_QUATERNION_MEMBER_ADD_GENERATOR_1(type) \ |
---|
819 | BOOST_QUATERNION_MEMBER_ADD_GENERATOR_2(type) \ |
---|
820 | BOOST_QUATERNION_MEMBER_ADD_GENERATOR_3(type) |
---|
821 | |
---|
822 | #define BOOST_QUATERNION_MEMBER_SUB_GENERATOR(type) \ |
---|
823 | BOOST_QUATERNION_MEMBER_SUB_GENERATOR_1(type) \ |
---|
824 | BOOST_QUATERNION_MEMBER_SUB_GENERATOR_2(type) \ |
---|
825 | BOOST_QUATERNION_MEMBER_SUB_GENERATOR_3(type) |
---|
826 | |
---|
827 | #define BOOST_QUATERNION_MEMBER_MUL_GENERATOR(type) \ |
---|
828 | BOOST_QUATERNION_MEMBER_MUL_GENERATOR_1(type) \ |
---|
829 | BOOST_QUATERNION_MEMBER_MUL_GENERATOR_2(type) \ |
---|
830 | BOOST_QUATERNION_MEMBER_MUL_GENERATOR_3(type) |
---|
831 | |
---|
832 | #define BOOST_QUATERNION_MEMBER_DIV_GENERATOR(type) \ |
---|
833 | BOOST_QUATERNION_MEMBER_DIV_GENERATOR_1(type) \ |
---|
834 | BOOST_QUATERNION_MEMBER_DIV_GENERATOR_2(type) \ |
---|
835 | BOOST_QUATERNION_MEMBER_DIV_GENERATOR_3(type) |
---|
836 | |
---|
837 | #define BOOST_QUATERNION_MEMBER_ALGEBRAIC_GENERATOR(type) \ |
---|
838 | BOOST_QUATERNION_MEMBER_ADD_GENERATOR(type) \ |
---|
839 | BOOST_QUATERNION_MEMBER_SUB_GENERATOR(type) \ |
---|
840 | BOOST_QUATERNION_MEMBER_MUL_GENERATOR(type) \ |
---|
841 | BOOST_QUATERNION_MEMBER_DIV_GENERATOR(type) |
---|
842 | |
---|
843 | |
---|
844 | template<> |
---|
845 | class quaternion<float> |
---|
846 | { |
---|
847 | public: |
---|
848 | |
---|
849 | typedef float value_type; |
---|
850 | |
---|
851 | BOOST_QUATERNION_CONSTRUCTOR_GENERATOR(float) |
---|
852 | |
---|
853 | // UNtemplated copy constructor |
---|
854 | // (this is taken care of by the compiler itself) |
---|
855 | |
---|
856 | // explicit copy constructors (precision-loosing converters) |
---|
857 | |
---|
858 | explicit quaternion(quaternion<double> const & a_recopier) |
---|
859 | { |
---|
860 | *this = detail::quaternion_type_converter<float, double>(a_recopier); |
---|
861 | } |
---|
862 | |
---|
863 | explicit quaternion(quaternion<long double> const & a_recopier) |
---|
864 | { |
---|
865 | *this = detail::quaternion_type_converter<float, long double>(a_recopier); |
---|
866 | } |
---|
867 | |
---|
868 | // destructor |
---|
869 | // (this is taken care of by the compiler itself) |
---|
870 | |
---|
871 | // accessors |
---|
872 | // |
---|
873 | // Note: Like complex number, quaternions do have a meaningful notion of "real part", |
---|
874 | // but unlike them there is no meaningful notion of "imaginary part". |
---|
875 | // Instead there is an "unreal part" which itself is a quaternion, and usually |
---|
876 | // nothing simpler (as opposed to the complex number case). |
---|
877 | // However, for practicallity, there are accessors for the other components |
---|
878 | // (these are necessary for the templated copy constructor, for instance). |
---|
879 | |
---|
880 | BOOST_QUATERNION_ACCESSOR_GENERATOR(float) |
---|
881 | |
---|
882 | // assignment operators |
---|
883 | |
---|
884 | BOOST_QUATERNION_MEMBER_ASSIGNMENT_GENERATOR(float) |
---|
885 | |
---|
886 | // other assignment-related operators |
---|
887 | // |
---|
888 | // NOTE: Quaternion multiplication is *NOT* commutative; |
---|
889 | // symbolically, "q *= rhs;" means "q = q * rhs;" |
---|
890 | // and "q /= rhs;" means "q = q * inverse_of(rhs);" |
---|
891 | |
---|
892 | BOOST_QUATERNION_MEMBER_ALGEBRAIC_GENERATOR(float) |
---|
893 | |
---|
894 | |
---|
895 | protected: |
---|
896 | |
---|
897 | BOOST_QUATERNION_MEMBER_DATA_GENERATOR(float) |
---|
898 | |
---|
899 | |
---|
900 | private: |
---|
901 | |
---|
902 | }; |
---|
903 | |
---|
904 | |
---|
905 | template<> |
---|
906 | class quaternion<double> |
---|
907 | { |
---|
908 | public: |
---|
909 | |
---|
910 | typedef double value_type; |
---|
911 | |
---|
912 | BOOST_QUATERNION_CONSTRUCTOR_GENERATOR(double) |
---|
913 | |
---|
914 | // UNtemplated copy constructor |
---|
915 | // (this is taken care of by the compiler itself) |
---|
916 | |
---|
917 | // converting copy constructor |
---|
918 | |
---|
919 | explicit quaternion(quaternion<float> const & a_recopier) |
---|
920 | { |
---|
921 | *this = detail::quaternion_type_converter<double, float>(a_recopier); |
---|
922 | } |
---|
923 | |
---|
924 | // explicit copy constructors (precision-loosing converters) |
---|
925 | |
---|
926 | explicit quaternion(quaternion<long double> const & a_recopier) |
---|
927 | { |
---|
928 | *this = detail::quaternion_type_converter<double, long double>(a_recopier); |
---|
929 | } |
---|
930 | |
---|
931 | // destructor |
---|
932 | // (this is taken care of by the compiler itself) |
---|
933 | |
---|
934 | // accessors |
---|
935 | // |
---|
936 | // Note: Like complex number, quaternions do have a meaningful notion of "real part", |
---|
937 | // but unlike them there is no meaningful notion of "imaginary part". |
---|
938 | // Instead there is an "unreal part" which itself is a quaternion, and usually |
---|
939 | // nothing simpler (as opposed to the complex number case). |
---|
940 | // However, for practicallity, there are accessors for the other components |
---|
941 | // (these are necessary for the templated copy constructor, for instance). |
---|
942 | |
---|
943 | BOOST_QUATERNION_ACCESSOR_GENERATOR(double) |
---|
944 | |
---|
945 | // assignment operators |
---|
946 | |
---|
947 | BOOST_QUATERNION_MEMBER_ASSIGNMENT_GENERATOR(double) |
---|
948 | |
---|
949 | // other assignment-related operators |
---|
950 | // |
---|
951 | // NOTE: Quaternion multiplication is *NOT* commutative; |
---|
952 | // symbolically, "q *= rhs;" means "q = q * rhs;" |
---|
953 | // and "q /= rhs;" means "q = q * inverse_of(rhs);" |
---|
954 | |
---|
955 | BOOST_QUATERNION_MEMBER_ALGEBRAIC_GENERATOR(double) |
---|
956 | |
---|
957 | |
---|
958 | protected: |
---|
959 | |
---|
960 | BOOST_QUATERNION_MEMBER_DATA_GENERATOR(double) |
---|
961 | |
---|
962 | |
---|
963 | private: |
---|
964 | |
---|
965 | }; |
---|
966 | |
---|
967 | |
---|
968 | template<> |
---|
969 | class quaternion<long double> |
---|
970 | { |
---|
971 | public: |
---|
972 | |
---|
973 | typedef long double value_type; |
---|
974 | |
---|
975 | BOOST_QUATERNION_CONSTRUCTOR_GENERATOR(long double) |
---|
976 | |
---|
977 | // UNtemplated copy constructor |
---|
978 | // (this is taken care of by the compiler itself) |
---|
979 | |
---|
980 | // converting copy constructors |
---|
981 | |
---|
982 | explicit quaternion(quaternion<float> const & a_recopier) |
---|
983 | { |
---|
984 | *this = detail::quaternion_type_converter<long double, float>(a_recopier); |
---|
985 | } |
---|
986 | |
---|
987 | explicit quaternion(quaternion<double> const & a_recopier) |
---|
988 | { |
---|
989 | *this = detail::quaternion_type_converter<long double, double>(a_recopier); |
---|
990 | } |
---|
991 | |
---|
992 | // destructor |
---|
993 | // (this is taken care of by the compiler itself) |
---|
994 | |
---|
995 | // accessors |
---|
996 | // |
---|
997 | // Note: Like complex number, quaternions do have a meaningful notion of "real part", |
---|
998 | // but unlike them there is no meaningful notion of "imaginary part". |
---|
999 | // Instead there is an "unreal part" which itself is a quaternion, and usually |
---|
1000 | // nothing simpler (as opposed to the complex number case). |
---|
1001 | // However, for practicallity, there are accessors for the other components |
---|
1002 | // (these are necessary for the templated copy constructor, for instance). |
---|
1003 | |
---|
1004 | BOOST_QUATERNION_ACCESSOR_GENERATOR(long double) |
---|
1005 | |
---|
1006 | // assignment operators |
---|
1007 | |
---|
1008 | BOOST_QUATERNION_MEMBER_ASSIGNMENT_GENERATOR(long double) |
---|
1009 | |
---|
1010 | // other assignment-related operators |
---|
1011 | // |
---|
1012 | // NOTE: Quaternion multiplication is *NOT* commutative; |
---|
1013 | // symbolically, "q *= rhs;" means "q = q * rhs;" |
---|
1014 | // and "q /= rhs;" means "q = q * inverse_of(rhs);" |
---|
1015 | |
---|
1016 | BOOST_QUATERNION_MEMBER_ALGEBRAIC_GENERATOR(long double) |
---|
1017 | |
---|
1018 | |
---|
1019 | protected: |
---|
1020 | |
---|
1021 | BOOST_QUATERNION_MEMBER_DATA_GENERATOR(long double) |
---|
1022 | |
---|
1023 | |
---|
1024 | private: |
---|
1025 | |
---|
1026 | }; |
---|
1027 | |
---|
1028 | |
---|
1029 | #undef BOOST_QUATERNION_MEMBER_ALGEBRAIC_GENERATOR |
---|
1030 | #undef BOOST_QUATERNION_MEMBER_ADD_GENERATOR |
---|
1031 | #undef BOOST_QUATERNION_MEMBER_SUB_GENERATOR |
---|
1032 | #undef BOOST_QUATERNION_MEMBER_MUL_GENERATOR |
---|
1033 | #undef BOOST_QUATERNION_MEMBER_DIV_GENERATOR |
---|
1034 | #undef BOOST_QUATERNION_MEMBER_ADD_GENERATOR_1 |
---|
1035 | #undef BOOST_QUATERNION_MEMBER_ADD_GENERATOR_2 |
---|
1036 | #undef BOOST_QUATERNION_MEMBER_ADD_GENERATOR_3 |
---|
1037 | #undef BOOST_QUATERNION_MEMBER_SUB_GENERATOR_1 |
---|
1038 | #undef BOOST_QUATERNION_MEMBER_SUB_GENERATOR_2 |
---|
1039 | #undef BOOST_QUATERNION_MEMBER_SUB_GENERATOR_3 |
---|
1040 | #undef BOOST_QUATERNION_MEMBER_MUL_GENERATOR_1 |
---|
1041 | #undef BOOST_QUATERNION_MEMBER_MUL_GENERATOR_2 |
---|
1042 | #undef BOOST_QUATERNION_MEMBER_MUL_GENERATOR_3 |
---|
1043 | #undef BOOST_QUATERNION_MEMBER_DIV_GENERATOR_1 |
---|
1044 | #undef BOOST_QUATERNION_MEMBER_DIV_GENERATOR_2 |
---|
1045 | #undef BOOST_QUATERNION_MEMBER_DIV_GENERATOR_3 |
---|
1046 | |
---|
1047 | #undef BOOST_QUATERNION_CONSTRUCTOR_GENERATOR |
---|
1048 | |
---|
1049 | |
---|
1050 | #undef BOOST_QUATERNION_MEMBER_ASSIGNMENT_GENERATOR |
---|
1051 | |
---|
1052 | #undef BOOST_QUATERNION_MEMBER_DATA_GENERATOR |
---|
1053 | |
---|
1054 | #undef BOOST_QUATERNION_ACCESSOR_GENERATOR |
---|
1055 | |
---|
1056 | |
---|
1057 | // operators |
---|
1058 | |
---|
1059 | #define BOOST_QUATERNION_OPERATOR_GENERATOR_BODY(op) \ |
---|
1060 | { \ |
---|
1061 | quaternion<T> res(lhs); \ |
---|
1062 | res op##= rhs; \ |
---|
1063 | return(res); \ |
---|
1064 | } |
---|
1065 | |
---|
1066 | #define BOOST_QUATERNION_OPERATOR_GENERATOR_1_L(op) \ |
---|
1067 | template<typename T> \ |
---|
1068 | inline quaternion<T> operator op (T const & lhs, quaternion<T> const & rhs) \ |
---|
1069 | BOOST_QUATERNION_OPERATOR_GENERATOR_BODY(op) |
---|
1070 | |
---|
1071 | #define BOOST_QUATERNION_OPERATOR_GENERATOR_1_R(op) \ |
---|
1072 | template<typename T> \ |
---|
1073 | inline quaternion<T> operator op (quaternion<T> const & lhs, T const & rhs) \ |
---|
1074 | BOOST_QUATERNION_OPERATOR_GENERATOR_BODY(op) |
---|
1075 | |
---|
1076 | #define BOOST_QUATERNION_OPERATOR_GENERATOR_2_L(op) \ |
---|
1077 | template<typename T> \ |
---|
1078 | inline quaternion<T> operator op (::std::complex<T> const & lhs, quaternion<T> const & rhs) \ |
---|
1079 | BOOST_QUATERNION_OPERATOR_GENERATOR_BODY(op) |
---|
1080 | |
---|
1081 | #define BOOST_QUATERNION_OPERATOR_GENERATOR_2_R(op) \ |
---|
1082 | template<typename T> \ |
---|
1083 | inline quaternion<T> operator op (quaternion<T> const & lhs, ::std::complex<T> const & rhs) \ |
---|
1084 | BOOST_QUATERNION_OPERATOR_GENERATOR_BODY(op) |
---|
1085 | |
---|
1086 | #define BOOST_QUATERNION_OPERATOR_GENERATOR_3(op) \ |
---|
1087 | template<typename T> \ |
---|
1088 | inline quaternion<T> operator op (quaternion<T> const & lhs, quaternion<T> const & rhs) \ |
---|
1089 | BOOST_QUATERNION_OPERATOR_GENERATOR_BODY(op) |
---|
1090 | |
---|
1091 | #define BOOST_QUATERNION_OPERATOR_GENERATOR(op) \ |
---|
1092 | BOOST_QUATERNION_OPERATOR_GENERATOR_1_L(op) \ |
---|
1093 | BOOST_QUATERNION_OPERATOR_GENERATOR_1_R(op) \ |
---|
1094 | BOOST_QUATERNION_OPERATOR_GENERATOR_2_L(op) \ |
---|
1095 | BOOST_QUATERNION_OPERATOR_GENERATOR_2_R(op) \ |
---|
1096 | BOOST_QUATERNION_OPERATOR_GENERATOR_3(op) |
---|
1097 | |
---|
1098 | |
---|
1099 | BOOST_QUATERNION_OPERATOR_GENERATOR(+) |
---|
1100 | BOOST_QUATERNION_OPERATOR_GENERATOR(-) |
---|
1101 | BOOST_QUATERNION_OPERATOR_GENERATOR(*) |
---|
1102 | BOOST_QUATERNION_OPERATOR_GENERATOR(/) |
---|
1103 | |
---|
1104 | |
---|
1105 | #undef BOOST_QUATERNION_OPERATOR_GENERATOR |
---|
1106 | |
---|
1107 | #undef BOOST_QUATERNION_OPERATOR_GENERATOR_1_L |
---|
1108 | #undef BOOST_QUATERNION_OPERATOR_GENERATOR_1_R |
---|
1109 | #undef BOOST_QUATERNION_OPERATOR_GENERATOR_2_L |
---|
1110 | #undef BOOST_QUATERNION_OPERATOR_GENERATOR_2_R |
---|
1111 | #undef BOOST_QUATERNION_OPERATOR_GENERATOR_3 |
---|
1112 | |
---|
1113 | #undef BOOST_QUATERNION_OPERATOR_GENERATOR_BODY |
---|
1114 | |
---|
1115 | |
---|
1116 | template<typename T> |
---|
1117 | inline quaternion<T> operator + (quaternion<T> const & q) |
---|
1118 | { |
---|
1119 | return(q); |
---|
1120 | } |
---|
1121 | |
---|
1122 | |
---|
1123 | template<typename T> |
---|
1124 | inline quaternion<T> operator - (quaternion<T> const & q) |
---|
1125 | { |
---|
1126 | return(quaternion<T>(-q.R_component_1(),-q.R_component_2(),-q.R_component_3(),-q.R_component_4())); |
---|
1127 | } |
---|
1128 | |
---|
1129 | |
---|
1130 | template<typename T> |
---|
1131 | inline bool operator == (T const & lhs, quaternion<T> const & rhs) |
---|
1132 | { |
---|
1133 | return ( |
---|
1134 | (rhs.R_component_1() == lhs)&& |
---|
1135 | (rhs.R_component_2() == static_cast<T>(0))&& |
---|
1136 | (rhs.R_component_3() == static_cast<T>(0))&& |
---|
1137 | (rhs.R_component_4() == static_cast<T>(0)) |
---|
1138 | ); |
---|
1139 | } |
---|
1140 | |
---|
1141 | |
---|
1142 | template<typename T> |
---|
1143 | inline bool operator == (quaternion<T> const & lhs, T const & rhs) |
---|
1144 | { |
---|
1145 | return ( |
---|
1146 | (lhs.R_component_1() == rhs)&& |
---|
1147 | (lhs.R_component_2() == static_cast<T>(0))&& |
---|
1148 | (lhs.R_component_3() == static_cast<T>(0))&& |
---|
1149 | (lhs.R_component_4() == static_cast<T>(0)) |
---|
1150 | ); |
---|
1151 | } |
---|
1152 | |
---|
1153 | |
---|
1154 | template<typename T> |
---|
1155 | inline bool operator == (::std::complex<T> const & lhs, quaternion<T> const & rhs) |
---|
1156 | { |
---|
1157 | return ( |
---|
1158 | (rhs.R_component_1() == lhs.real())&& |
---|
1159 | (rhs.R_component_2() == lhs.imag())&& |
---|
1160 | (rhs.R_component_3() == static_cast<T>(0))&& |
---|
1161 | (rhs.R_component_4() == static_cast<T>(0)) |
---|
1162 | ); |
---|
1163 | } |
---|
1164 | |
---|
1165 | |
---|
1166 | template<typename T> |
---|
1167 | inline bool operator == (quaternion<T> const & lhs, ::std::complex<T> const & rhs) |
---|
1168 | { |
---|
1169 | return ( |
---|
1170 | (lhs.R_component_1() == rhs.real())&& |
---|
1171 | (lhs.R_component_2() == rhs.imag())&& |
---|
1172 | (lhs.R_component_3() == static_cast<T>(0))&& |
---|
1173 | (lhs.R_component_4() == static_cast<T>(0)) |
---|
1174 | ); |
---|
1175 | } |
---|
1176 | |
---|
1177 | |
---|
1178 | template<typename T> |
---|
1179 | inline bool operator == (quaternion<T> const & lhs, quaternion<T> const & rhs) |
---|
1180 | { |
---|
1181 | return ( |
---|
1182 | (rhs.R_component_1() == lhs.R_component_1())&& |
---|
1183 | (rhs.R_component_2() == lhs.R_component_2())&& |
---|
1184 | (rhs.R_component_3() == lhs.R_component_3())&& |
---|
1185 | (rhs.R_component_4() == lhs.R_component_4()) |
---|
1186 | ); |
---|
1187 | } |
---|
1188 | |
---|
1189 | |
---|
1190 | #define BOOST_QUATERNION_NOT_EQUAL_GENERATOR \ |
---|
1191 | { \ |
---|
1192 | return(!(lhs == rhs)); \ |
---|
1193 | } |
---|
1194 | |
---|
1195 | template<typename T> |
---|
1196 | inline bool operator != (T const & lhs, quaternion<T> const & rhs) |
---|
1197 | BOOST_QUATERNION_NOT_EQUAL_GENERATOR |
---|
1198 | |
---|
1199 | template<typename T> |
---|
1200 | inline bool operator != (quaternion<T> const & lhs, T const & rhs) |
---|
1201 | BOOST_QUATERNION_NOT_EQUAL_GENERATOR |
---|
1202 | |
---|
1203 | template<typename T> |
---|
1204 | inline bool operator != (::std::complex<T> const & lhs, quaternion<T> const & rhs) |
---|
1205 | BOOST_QUATERNION_NOT_EQUAL_GENERATOR |
---|
1206 | |
---|
1207 | template<typename T> |
---|
1208 | inline bool operator != (quaternion<T> const & lhs, ::std::complex<T> const & rhs) |
---|
1209 | BOOST_QUATERNION_NOT_EQUAL_GENERATOR |
---|
1210 | |
---|
1211 | template<typename T> |
---|
1212 | inline bool operator != (quaternion<T> const & lhs, quaternion<T> const & rhs) |
---|
1213 | BOOST_QUATERNION_NOT_EQUAL_GENERATOR |
---|
1214 | |
---|
1215 | #undef BOOST_QUATERNION_NOT_EQUAL_GENERATOR |
---|
1216 | |
---|
1217 | |
---|
1218 | // Note: we allow the following formats, whith a, b, c, and d reals |
---|
1219 | // a |
---|
1220 | // (a), (a,b), (a,b,c), (a,b,c,d) |
---|
1221 | // (a,(c)), (a,(c,d)), ((a)), ((a),c), ((a),(c)), ((a),(c,d)), ((a,b)), ((a,b),c), ((a,b),(c)), ((a,b),(c,d)) |
---|
1222 | #if BOOST_WORKAROUND(__GNUC__, < 3) |
---|
1223 | template<typename T> |
---|
1224 | std::istream & operator >> ( ::std::istream & is, |
---|
1225 | quaternion<T> & q) |
---|
1226 | #else |
---|
1227 | template<typename T, typename charT, class traits> |
---|
1228 | ::std::basic_istream<charT,traits> & operator >> ( ::std::basic_istream<charT,traits> & is, |
---|
1229 | quaternion<T> & q) |
---|
1230 | #endif /* BOOST_WORKAROUND(__GNUC__, < 3) */ |
---|
1231 | { |
---|
1232 | #if BOOST_WORKAROUND(__GNUC__, < 3) |
---|
1233 | typedef char charT; |
---|
1234 | #endif /* BOOST_WORKAROUND(__GNUC__, < 3) */ |
---|
1235 | |
---|
1236 | #ifdef BOOST_NO_STD_LOCALE |
---|
1237 | #else |
---|
1238 | const ::std::ctype<charT> & ct = ::std::use_facet< ::std::ctype<charT> >(is.getloc()); |
---|
1239 | #endif /* BOOST_NO_STD_LOCALE */ |
---|
1240 | |
---|
1241 | T a = T(); |
---|
1242 | T b = T(); |
---|
1243 | T c = T(); |
---|
1244 | T d = T(); |
---|
1245 | |
---|
1246 | ::std::complex<T> u = ::std::complex<T>(); |
---|
1247 | ::std::complex<T> v = ::std::complex<T>(); |
---|
1248 | |
---|
1249 | charT ch = charT(); |
---|
1250 | char cc; |
---|
1251 | |
---|
1252 | is >> ch; // get the first lexeme |
---|
1253 | |
---|
1254 | if (!is.good()) goto finish; |
---|
1255 | |
---|
1256 | #ifdef BOOST_NO_STD_LOCALE |
---|
1257 | cc = ch; |
---|
1258 | #else |
---|
1259 | cc = ct.narrow(ch, char()); |
---|
1260 | #endif /* BOOST_NO_STD_LOCALE */ |
---|
1261 | |
---|
1262 | if (cc == '(') // read "(", possible: (a), (a,b), (a,b,c), (a,b,c,d), (a,(c)), (a,(c,d)), ((a)), ((a),c), ((a),(c)), ((a),(c,d)), ((a,b)), ((a,b),c), ((a,b),(c)), ((a,b,),(c,d,)) |
---|
1263 | { |
---|
1264 | is >> ch; // get the second lexeme |
---|
1265 | |
---|
1266 | if (!is.good()) goto finish; |
---|
1267 | |
---|
1268 | #ifdef BOOST_NO_STD_LOCALE |
---|
1269 | cc = ch; |
---|
1270 | #else |
---|
1271 | cc = ct.narrow(ch, char()); |
---|
1272 | #endif /* BOOST_NO_STD_LOCALE */ |
---|
1273 | |
---|
1274 | if (cc == '(') // read "((", possible: ((a)), ((a),c), ((a),(c)), ((a),(c,d)), ((a,b)), ((a,b),c), ((a,b),(c)), ((a,b,),(c,d,)) |
---|
1275 | { |
---|
1276 | is.putback(ch); |
---|
1277 | |
---|
1278 | is >> u; // we extract the first and second components |
---|
1279 | a = u.real(); |
---|
1280 | b = u.imag(); |
---|
1281 | |
---|
1282 | if (!is.good()) goto finish; |
---|
1283 | |
---|
1284 | is >> ch; // get the next lexeme |
---|
1285 | |
---|
1286 | if (!is.good()) goto finish; |
---|
1287 | |
---|
1288 | #ifdef BOOST_NO_STD_LOCALE |
---|
1289 | cc = ch; |
---|
1290 | #else |
---|
1291 | cc = ct.narrow(ch, char()); |
---|
1292 | #endif /* BOOST_NO_STD_LOCALE */ |
---|
1293 | |
---|
1294 | if (cc == ')') // format: ((a)) or ((a,b)) |
---|
1295 | { |
---|
1296 | q = quaternion<T>(a,b); |
---|
1297 | } |
---|
1298 | else if (cc == ',') // read "((a)," or "((a,b),", possible: ((a),c), ((a),(c)), ((a),(c,d)), ((a,b),c), ((a,b),(c)), ((a,b,),(c,d,)) |
---|
1299 | { |
---|
1300 | is >> v; // we extract the third and fourth components |
---|
1301 | c = v.real(); |
---|
1302 | d = v.imag(); |
---|
1303 | |
---|
1304 | if (!is.good()) goto finish; |
---|
1305 | |
---|
1306 | is >> ch; // get the last lexeme |
---|
1307 | |
---|
1308 | if (!is.good()) goto finish; |
---|
1309 | |
---|
1310 | #ifdef BOOST_NO_STD_LOCALE |
---|
1311 | cc = ch; |
---|
1312 | #else |
---|
1313 | cc = ct.narrow(ch, char()); |
---|
1314 | #endif /* BOOST_NO_STD_LOCALE */ |
---|
1315 | |
---|
1316 | if (cc == ')') // format: ((a),c), ((a),(c)), ((a),(c,d)), ((a,b),c), ((a,b),(c)) or ((a,b,),(c,d,)) |
---|
1317 | { |
---|
1318 | q = quaternion<T>(a,b,c,d); |
---|
1319 | } |
---|
1320 | else // error |
---|
1321 | { |
---|
1322 | #if BOOST_WORKAROUND(__GNUC__, < 3) |
---|
1323 | is.setstate(::std::ios::failbit); |
---|
1324 | #else |
---|
1325 | is.setstate(::std::ios_base::failbit); |
---|
1326 | #endif /* BOOST_WORKAROUND(__GNUC__, < 3) */ |
---|
1327 | } |
---|
1328 | } |
---|
1329 | else // error |
---|
1330 | { |
---|
1331 | #if BOOST_WORKAROUND(__GNUC__, < 3) |
---|
1332 | is.setstate(::std::ios::failbit); |
---|
1333 | #else |
---|
1334 | is.setstate(::std::ios_base::failbit); |
---|
1335 | #endif /* BOOST_WORKAROUND(__GNUC__, < 3) */ |
---|
1336 | } |
---|
1337 | } |
---|
1338 | else // read "(a", possible: (a), (a,b), (a,b,c), (a,b,c,d), (a,(c)), (a,(c,d)) |
---|
1339 | { |
---|
1340 | is.putback(ch); |
---|
1341 | |
---|
1342 | is >> a; // we extract the first component |
---|
1343 | |
---|
1344 | if (!is.good()) goto finish; |
---|
1345 | |
---|
1346 | is >> ch; // get the third lexeme |
---|
1347 | |
---|
1348 | if (!is.good()) goto finish; |
---|
1349 | |
---|
1350 | #ifdef BOOST_NO_STD_LOCALE |
---|
1351 | cc = ch; |
---|
1352 | #else |
---|
1353 | cc = ct.narrow(ch, char()); |
---|
1354 | #endif /* BOOST_NO_STD_LOCALE */ |
---|
1355 | |
---|
1356 | if (cc == ')') // format: (a) |
---|
1357 | { |
---|
1358 | q = quaternion<T>(a); |
---|
1359 | } |
---|
1360 | else if (cc == ',') // read "(a,", possible: (a,b), (a,b,c), (a,b,c,d), (a,(c)), (a,(c,d)) |
---|
1361 | { |
---|
1362 | is >> ch; // get the fourth lexeme |
---|
1363 | |
---|
1364 | if (!is.good()) goto finish; |
---|
1365 | |
---|
1366 | #ifdef BOOST_NO_STD_LOCALE |
---|
1367 | cc = ch; |
---|
1368 | #else |
---|
1369 | cc = ct.narrow(ch, char()); |
---|
1370 | #endif /* BOOST_NO_STD_LOCALE */ |
---|
1371 | |
---|
1372 | if (cc == '(') // read "(a,(", possible: (a,(c)), (a,(c,d)) |
---|
1373 | { |
---|
1374 | is.putback(ch); |
---|
1375 | |
---|
1376 | is >> v; // we extract the third and fourth component |
---|
1377 | |
---|
1378 | c = v.real(); |
---|
1379 | d = v.imag(); |
---|
1380 | |
---|
1381 | if (!is.good()) goto finish; |
---|
1382 | |
---|
1383 | is >> ch; // get the ninth lexeme |
---|
1384 | |
---|
1385 | if (!is.good()) goto finish; |
---|
1386 | |
---|
1387 | #ifdef BOOST_NO_STD_LOCALE |
---|
1388 | cc = ch; |
---|
1389 | #else |
---|
1390 | cc = ct.narrow(ch, char()); |
---|
1391 | #endif /* BOOST_NO_STD_LOCALE */ |
---|
1392 | |
---|
1393 | if (cc == ')') // format: (a,(c)) or (a,(c,d)) |
---|
1394 | { |
---|
1395 | q = quaternion<T>(a,b,c,d); |
---|
1396 | } |
---|
1397 | else // error |
---|
1398 | { |
---|
1399 | #if BOOST_WORKAROUND(__GNUC__, < 3) |
---|
1400 | is.setstate(::std::ios::failbit); |
---|
1401 | #else |
---|
1402 | is.setstate(::std::ios_base::failbit); |
---|
1403 | #endif /* BOOST_WORKAROUND(__GNUC__, < 3) */ |
---|
1404 | } |
---|
1405 | } |
---|
1406 | else // read "(a,b", possible: (a,b), (a,b,c), (a,b,c,d) |
---|
1407 | { |
---|
1408 | is.putback(ch); |
---|
1409 | |
---|
1410 | is >> b; // we extract the second component |
---|
1411 | |
---|
1412 | if (!is.good()) goto finish; |
---|
1413 | |
---|
1414 | is >> ch; // get the fifth lexeme |
---|
1415 | |
---|
1416 | if (!is.good()) goto finish; |
---|
1417 | |
---|
1418 | #ifdef BOOST_NO_STD_LOCALE |
---|
1419 | cc = ch; |
---|
1420 | #else |
---|
1421 | cc = ct.narrow(ch, char()); |
---|
1422 | #endif /* BOOST_NO_STD_LOCALE */ |
---|
1423 | |
---|
1424 | if (cc == ')') // format: (a,b) |
---|
1425 | { |
---|
1426 | q = quaternion<T>(a,b); |
---|
1427 | } |
---|
1428 | else if (cc == ',') // read "(a,b,", possible: (a,b,c), (a,b,c,d) |
---|
1429 | { |
---|
1430 | is >> c; // we extract the third component |
---|
1431 | |
---|
1432 | if (!is.good()) goto finish; |
---|
1433 | |
---|
1434 | is >> ch; // get the seventh lexeme |
---|
1435 | |
---|
1436 | if (!is.good()) goto finish; |
---|
1437 | |
---|
1438 | #ifdef BOOST_NO_STD_LOCALE |
---|
1439 | cc = ch; |
---|
1440 | #else |
---|
1441 | cc = ct.narrow(ch, char()); |
---|
1442 | #endif /* BOOST_NO_STD_LOCALE */ |
---|
1443 | |
---|
1444 | if (cc == ')') // format: (a,b,c) |
---|
1445 | { |
---|
1446 | q = quaternion<T>(a,b,c); |
---|
1447 | } |
---|
1448 | else if (cc == ',') // read "(a,b,c,", possible: (a,b,c,d) |
---|
1449 | { |
---|
1450 | is >> d; // we extract the fourth component |
---|
1451 | |
---|
1452 | if (!is.good()) goto finish; |
---|
1453 | |
---|
1454 | is >> ch; // get the ninth lexeme |
---|
1455 | |
---|
1456 | if (!is.good()) goto finish; |
---|
1457 | |
---|
1458 | #ifdef BOOST_NO_STD_LOCALE |
---|
1459 | cc = ch; |
---|
1460 | #else |
---|
1461 | cc = ct.narrow(ch, char()); |
---|
1462 | #endif /* BOOST_NO_STD_LOCALE */ |
---|
1463 | |
---|
1464 | if (cc == ')') // format: (a,b,c,d) |
---|
1465 | { |
---|
1466 | q = quaternion<T>(a,b,c,d); |
---|
1467 | } |
---|
1468 | else // error |
---|
1469 | { |
---|
1470 | #if BOOST_WORKAROUND(__GNUC__, < 3) |
---|
1471 | is.setstate(::std::ios::failbit); |
---|
1472 | #else |
---|
1473 | is.setstate(::std::ios_base::failbit); |
---|
1474 | #endif /* BOOST_WORKAROUND(__GNUC__, < 3) */ |
---|
1475 | } |
---|
1476 | } |
---|
1477 | else // error |
---|
1478 | { |
---|
1479 | #if BOOST_WORKAROUND(__GNUC__, < 3) |
---|
1480 | is.setstate(::std::ios::failbit); |
---|
1481 | #else |
---|
1482 | is.setstate(::std::ios_base::failbit); |
---|
1483 | #endif /* BOOST_WORKAROUND(__GNUC__, < 3) */ |
---|
1484 | } |
---|
1485 | } |
---|
1486 | else // error |
---|
1487 | { |
---|
1488 | #if BOOST_WORKAROUND(__GNUC__, < 3) |
---|
1489 | is.setstate(::std::ios::failbit); |
---|
1490 | #else |
---|
1491 | is.setstate(::std::ios_base::failbit); |
---|
1492 | #endif /* BOOST_WORKAROUND(__GNUC__, < 3) */ |
---|
1493 | } |
---|
1494 | } |
---|
1495 | } |
---|
1496 | else // error |
---|
1497 | { |
---|
1498 | #if BOOST_WORKAROUND(__GNUC__, < 3) |
---|
1499 | is.setstate(::std::ios::failbit); |
---|
1500 | #else |
---|
1501 | is.setstate(::std::ios_base::failbit); |
---|
1502 | #endif /* BOOST_WORKAROUND(__GNUC__, < 3) */ |
---|
1503 | } |
---|
1504 | } |
---|
1505 | } |
---|
1506 | else // format: a |
---|
1507 | { |
---|
1508 | is.putback(ch); |
---|
1509 | |
---|
1510 | is >> a; // we extract the first component |
---|
1511 | |
---|
1512 | if (!is.good()) goto finish; |
---|
1513 | |
---|
1514 | q = quaternion<T>(a); |
---|
1515 | } |
---|
1516 | |
---|
1517 | finish: |
---|
1518 | return(is); |
---|
1519 | } |
---|
1520 | |
---|
1521 | |
---|
1522 | #if BOOST_WORKAROUND(__GNUC__, < 3) |
---|
1523 | template<typename T> |
---|
1524 | ::std::ostream & operator << ( ::std::ostream & os, |
---|
1525 | quaternion<T> const & q) |
---|
1526 | #else |
---|
1527 | template<typename T, typename charT, class traits> |
---|
1528 | ::std::basic_ostream<charT,traits> & operator << ( ::std::basic_ostream<charT,traits> & os, |
---|
1529 | quaternion<T> const & q) |
---|
1530 | #endif /* BOOST_WORKAROUND(__GNUC__, < 3) */ |
---|
1531 | { |
---|
1532 | #if BOOST_WORKAROUND(__GNUC__, < 3) |
---|
1533 | ::std::ostringstream s; |
---|
1534 | #else |
---|
1535 | ::std::basic_ostringstream<charT,traits> s; |
---|
1536 | #endif /* BOOST_WORKAROUND(__GNUC__, < 3) */ |
---|
1537 | |
---|
1538 | s.flags(os.flags()); |
---|
1539 | #ifdef BOOST_NO_STD_LOCALE |
---|
1540 | #else |
---|
1541 | s.imbue(os.getloc()); |
---|
1542 | #endif /* BOOST_NO_STD_LOCALE */ |
---|
1543 | s.precision(os.precision()); |
---|
1544 | |
---|
1545 | s << '(' << q.R_component_1() << ',' |
---|
1546 | << q.R_component_2() << ',' |
---|
1547 | << q.R_component_3() << ',' |
---|
1548 | << q.R_component_4() << ')'; |
---|
1549 | |
---|
1550 | return os << s.str(); |
---|
1551 | } |
---|
1552 | |
---|
1553 | |
---|
1554 | // values |
---|
1555 | |
---|
1556 | template<typename T> |
---|
1557 | inline T real(quaternion<T> const & q) |
---|
1558 | { |
---|
1559 | return(q.real()); |
---|
1560 | } |
---|
1561 | |
---|
1562 | |
---|
1563 | template<typename T> |
---|
1564 | inline quaternion<T> unreal(quaternion<T> const & q) |
---|
1565 | { |
---|
1566 | return(q.unreal()); |
---|
1567 | } |
---|
1568 | |
---|
1569 | |
---|
1570 | #define BOOST_QUATERNION_VALARRAY_LOADER \ |
---|
1571 | using ::std::valarray; \ |
---|
1572 | \ |
---|
1573 | valarray<T> temp(4); \ |
---|
1574 | \ |
---|
1575 | temp[0] = q.R_component_1(); \ |
---|
1576 | temp[1] = q.R_component_2(); \ |
---|
1577 | temp[2] = q.R_component_3(); \ |
---|
1578 | temp[3] = q.R_component_4(); |
---|
1579 | |
---|
1580 | |
---|
1581 | template<typename T> |
---|
1582 | inline T sup(quaternion<T> const & q) |
---|
1583 | { |
---|
1584 | #ifdef BOOST_NO_ARGUMENT_DEPENDENT_LOOKUP |
---|
1585 | using ::std::abs; |
---|
1586 | #endif /* BOOST_NO_ARGUMENT_DEPENDENT_LOOKUP */ |
---|
1587 | |
---|
1588 | BOOST_QUATERNION_VALARRAY_LOADER |
---|
1589 | |
---|
1590 | #if BOOST_WORKAROUND(__GNUC__, < 3) |
---|
1591 | return((BOOST_GET_VALARRAY(T, abs(temp)).max)()); |
---|
1592 | #else |
---|
1593 | return((abs(temp).max)()); |
---|
1594 | #endif /* BOOST_WORKAROUND(__GNUC__, < 3) */ |
---|
1595 | } |
---|
1596 | |
---|
1597 | |
---|
1598 | template<typename T> |
---|
1599 | inline T l1(quaternion<T> const & q) |
---|
1600 | { |
---|
1601 | #ifdef BOOST_NO_ARGUMENT_DEPENDENT_LOOKUP |
---|
1602 | using ::std::abs; |
---|
1603 | #endif /* BOOST_NO_ARGUMENT_DEPENDENT_LOOKUP */ |
---|
1604 | |
---|
1605 | BOOST_QUATERNION_VALARRAY_LOADER |
---|
1606 | |
---|
1607 | #if BOOST_WORKAROUND(__GNUC__, < 3) |
---|
1608 | return(BOOST_GET_VALARRAY(T, abs(temp)).sum()); |
---|
1609 | #else |
---|
1610 | return(abs(temp).sum()); |
---|
1611 | #endif /* BOOST_WORKAROUND(__GNUC__, < 3) */ |
---|
1612 | } |
---|
1613 | |
---|
1614 | |
---|
1615 | template<typename T> |
---|
1616 | inline T abs(quaternion<T> const & q) |
---|
1617 | { |
---|
1618 | #ifdef BOOST_NO_ARGUMENT_DEPENDENT_LOOKUP |
---|
1619 | using ::std::abs; |
---|
1620 | #endif /* BOOST_NO_ARGUMENT_DEPENDENT_LOOKUP */ |
---|
1621 | |
---|
1622 | using ::std::sqrt; |
---|
1623 | |
---|
1624 | BOOST_QUATERNION_VALARRAY_LOADER |
---|
1625 | |
---|
1626 | #if BOOST_WORKAROUND(__GNUC__, < 3) |
---|
1627 | T maxim = (BOOST_GET_VALARRAY(T, abs(temp)).max)(); // overflow protection |
---|
1628 | #else |
---|
1629 | T maxim = (abs(temp).max)(); // overflow protection |
---|
1630 | #endif /* BOOST_WORKAROUND(__GNUC__, < 3) */ |
---|
1631 | |
---|
1632 | if (maxim == static_cast<T>(0)) |
---|
1633 | { |
---|
1634 | return(maxim); |
---|
1635 | } |
---|
1636 | else |
---|
1637 | { |
---|
1638 | T mixam = static_cast<T>(1)/maxim; // prefer multiplications over divisions |
---|
1639 | |
---|
1640 | temp *= mixam; |
---|
1641 | |
---|
1642 | temp *= temp; |
---|
1643 | |
---|
1644 | return(maxim*sqrt(temp.sum())); |
---|
1645 | } |
---|
1646 | |
---|
1647 | //return(sqrt(norm(q))); |
---|
1648 | } |
---|
1649 | |
---|
1650 | |
---|
1651 | #undef BOOST_QUATERNION_VALARRAY_LOADER |
---|
1652 | |
---|
1653 | |
---|
1654 | // Note: This is the Cayley norm, not the Euclidian norm... |
---|
1655 | |
---|
1656 | template<typename T> |
---|
1657 | inline T norm(quaternion<T>const & q) |
---|
1658 | { |
---|
1659 | return(real(q*conj(q))); |
---|
1660 | } |
---|
1661 | |
---|
1662 | |
---|
1663 | template<typename T> |
---|
1664 | inline quaternion<T> conj(quaternion<T> const & q) |
---|
1665 | { |
---|
1666 | return(quaternion<T>( +q.R_component_1(), |
---|
1667 | -q.R_component_2(), |
---|
1668 | -q.R_component_3(), |
---|
1669 | -q.R_component_4())); |
---|
1670 | } |
---|
1671 | |
---|
1672 | |
---|
1673 | template<typename T> |
---|
1674 | inline quaternion<T> spherical( T const & rho, |
---|
1675 | T const & theta, |
---|
1676 | T const & phi1, |
---|
1677 | T const & phi2) |
---|
1678 | { |
---|
1679 | using ::std::cos; |
---|
1680 | using ::std::sin; |
---|
1681 | |
---|
1682 | //T a = cos(theta)*cos(phi1)*cos(phi2); |
---|
1683 | //T b = sin(theta)*cos(phi1)*cos(phi2); |
---|
1684 | //T c = sin(phi1)*cos(phi2); |
---|
1685 | //T d = sin(phi2); |
---|
1686 | |
---|
1687 | T courrant = static_cast<T>(1); |
---|
1688 | |
---|
1689 | T d = sin(phi2); |
---|
1690 | |
---|
1691 | courrant *= cos(phi2); |
---|
1692 | |
---|
1693 | T c = sin(phi1)*courrant; |
---|
1694 | |
---|
1695 | courrant *= cos(phi1); |
---|
1696 | |
---|
1697 | T b = sin(theta)*courrant; |
---|
1698 | T a = cos(theta)*courrant; |
---|
1699 | |
---|
1700 | return(rho*quaternion<T>(a,b,c,d)); |
---|
1701 | } |
---|
1702 | |
---|
1703 | |
---|
1704 | template<typename T> |
---|
1705 | inline quaternion<T> semipolar( T const & rho, |
---|
1706 | T const & alpha, |
---|
1707 | T const & theta1, |
---|
1708 | T const & theta2) |
---|
1709 | { |
---|
1710 | using ::std::cos; |
---|
1711 | using ::std::sin; |
---|
1712 | |
---|
1713 | T a = cos(alpha)*cos(theta1); |
---|
1714 | T b = cos(alpha)*sin(theta1); |
---|
1715 | T c = sin(alpha)*cos(theta2); |
---|
1716 | T d = sin(alpha)*sin(theta2); |
---|
1717 | |
---|
1718 | return(rho*quaternion<T>(a,b,c,d)); |
---|
1719 | } |
---|
1720 | |
---|
1721 | |
---|
1722 | template<typename T> |
---|
1723 | inline quaternion<T> multipolar( T const & rho1, |
---|
1724 | T const & theta1, |
---|
1725 | T const & rho2, |
---|
1726 | T const & theta2) |
---|
1727 | { |
---|
1728 | using ::std::cos; |
---|
1729 | using ::std::sin; |
---|
1730 | |
---|
1731 | T a = rho1*cos(theta1); |
---|
1732 | T b = rho1*sin(theta1); |
---|
1733 | T c = rho2*cos(theta2); |
---|
1734 | T d = rho2*sin(theta2); |
---|
1735 | |
---|
1736 | return(quaternion<T>(a,b,c,d)); |
---|
1737 | } |
---|
1738 | |
---|
1739 | |
---|
1740 | template<typename T> |
---|
1741 | inline quaternion<T> cylindrospherical( T const & t, |
---|
1742 | T const & radius, |
---|
1743 | T const & longitude, |
---|
1744 | T const & latitude) |
---|
1745 | { |
---|
1746 | using ::std::cos; |
---|
1747 | using ::std::sin; |
---|
1748 | |
---|
1749 | |
---|
1750 | |
---|
1751 | T b = radius*cos(longitude)*cos(latitude); |
---|
1752 | T c = radius*sin(longitude)*cos(latitude); |
---|
1753 | T d = radius*sin(latitude); |
---|
1754 | |
---|
1755 | return(quaternion<T>(t,b,c,d)); |
---|
1756 | } |
---|
1757 | |
---|
1758 | |
---|
1759 | template<typename T> |
---|
1760 | inline quaternion<T> cylindrical(T const & r, |
---|
1761 | T const & angle, |
---|
1762 | T const & h1, |
---|
1763 | T const & h2) |
---|
1764 | { |
---|
1765 | using ::std::cos; |
---|
1766 | using ::std::sin; |
---|
1767 | |
---|
1768 | T a = r*cos(angle); |
---|
1769 | T b = r*sin(angle); |
---|
1770 | |
---|
1771 | return(quaternion<T>(a,b,h1,h2)); |
---|
1772 | } |
---|
1773 | |
---|
1774 | |
---|
1775 | // transcendentals |
---|
1776 | // (please see the documentation) |
---|
1777 | |
---|
1778 | |
---|
1779 | template<typename T> |
---|
1780 | inline quaternion<T> exp(quaternion<T> const & q) |
---|
1781 | { |
---|
1782 | using ::std::exp; |
---|
1783 | using ::std::cos; |
---|
1784 | |
---|
1785 | using ::boost::math::sinc_pi; |
---|
1786 | |
---|
1787 | T u = exp(real(q)); |
---|
1788 | |
---|
1789 | T z = abs(unreal(q)); |
---|
1790 | |
---|
1791 | T w = sinc_pi(z); |
---|
1792 | |
---|
1793 | return(u*quaternion<T>(cos(z), |
---|
1794 | w*q.R_component_2(), w*q.R_component_3(), |
---|
1795 | w*q.R_component_4())); |
---|
1796 | } |
---|
1797 | |
---|
1798 | |
---|
1799 | template<typename T> |
---|
1800 | inline quaternion<T> cos(quaternion<T> const & q) |
---|
1801 | { |
---|
1802 | using ::std::sin; |
---|
1803 | using ::std::cos; |
---|
1804 | using ::std::cosh; |
---|
1805 | |
---|
1806 | using ::boost::math::sinhc_pi; |
---|
1807 | |
---|
1808 | T z = abs(unreal(q)); |
---|
1809 | |
---|
1810 | T w = -sin(q.real())*sinhc_pi(z); |
---|
1811 | |
---|
1812 | return(quaternion<T>(cos(q.real())*cosh(z), |
---|
1813 | w*q.R_component_2(), w*q.R_component_3(), |
---|
1814 | w*q.R_component_4())); |
---|
1815 | } |
---|
1816 | |
---|
1817 | |
---|
1818 | template<typename T> |
---|
1819 | inline quaternion<T> sin(quaternion<T> const & q) |
---|
1820 | { |
---|
1821 | using ::std::sin; |
---|
1822 | using ::std::cos; |
---|
1823 | using ::std::cosh; |
---|
1824 | |
---|
1825 | using ::boost::math::sinhc_pi; |
---|
1826 | |
---|
1827 | T z = abs(unreal(q)); |
---|
1828 | |
---|
1829 | T w = +cos(q.real())*sinhc_pi(z); |
---|
1830 | |
---|
1831 | return(quaternion<T>(sin(q.real())*cosh(z), |
---|
1832 | w*q.R_component_2(), w*q.R_component_3(), |
---|
1833 | w*q.R_component_4())); |
---|
1834 | } |
---|
1835 | |
---|
1836 | |
---|
1837 | template<typename T> |
---|
1838 | inline quaternion<T> tan(quaternion<T> const & q) |
---|
1839 | { |
---|
1840 | return(sin(q)/cos(q)); |
---|
1841 | } |
---|
1842 | |
---|
1843 | |
---|
1844 | template<typename T> |
---|
1845 | inline quaternion<T> cosh(quaternion<T> const & q) |
---|
1846 | { |
---|
1847 | return((exp(+q)+exp(-q))/static_cast<T>(2)); |
---|
1848 | } |
---|
1849 | |
---|
1850 | |
---|
1851 | template<typename T> |
---|
1852 | inline quaternion<T> sinh(quaternion<T> const & q) |
---|
1853 | { |
---|
1854 | return((exp(+q)-exp(-q))/static_cast<T>(2)); |
---|
1855 | } |
---|
1856 | |
---|
1857 | |
---|
1858 | template<typename T> |
---|
1859 | inline quaternion<T> tanh(quaternion<T> const & q) |
---|
1860 | { |
---|
1861 | return(sinh(q)/cosh(q)); |
---|
1862 | } |
---|
1863 | |
---|
1864 | |
---|
1865 | template<typename T> |
---|
1866 | quaternion<T> pow(quaternion<T> const & q, |
---|
1867 | int n) |
---|
1868 | { |
---|
1869 | if (n > 1) |
---|
1870 | { |
---|
1871 | int m = n>>1; |
---|
1872 | |
---|
1873 | quaternion<T> result = pow(q, m); |
---|
1874 | |
---|
1875 | result *= result; |
---|
1876 | |
---|
1877 | if (n != (m<<1)) |
---|
1878 | { |
---|
1879 | result *= q; // n odd |
---|
1880 | } |
---|
1881 | |
---|
1882 | return(result); |
---|
1883 | } |
---|
1884 | else if (n == 1) |
---|
1885 | { |
---|
1886 | return(q); |
---|
1887 | } |
---|
1888 | else if (n == 0) |
---|
1889 | { |
---|
1890 | return(quaternion<T>(1)); |
---|
1891 | } |
---|
1892 | else /* n < 0 */ |
---|
1893 | { |
---|
1894 | return(pow(quaternion<T>(1)/q,-n)); |
---|
1895 | } |
---|
1896 | } |
---|
1897 | |
---|
1898 | |
---|
1899 | // helper templates for converting copy constructors (definition) |
---|
1900 | |
---|
1901 | namespace detail |
---|
1902 | { |
---|
1903 | |
---|
1904 | template< typename T, |
---|
1905 | typename U |
---|
1906 | > |
---|
1907 | quaternion<T> quaternion_type_converter(quaternion<U> const & rhs) |
---|
1908 | { |
---|
1909 | return(quaternion<T>( static_cast<T>(rhs.R_component_1()), |
---|
1910 | static_cast<T>(rhs.R_component_2()), |
---|
1911 | static_cast<T>(rhs.R_component_3()), |
---|
1912 | static_cast<T>(rhs.R_component_4()))); |
---|
1913 | } |
---|
1914 | } |
---|
1915 | } |
---|
1916 | } |
---|
1917 | |
---|
1918 | |
---|
1919 | #if BOOST_WORKAROUND(__GNUC__, < 3) |
---|
1920 | #undef BOOST_GET_VALARRAY |
---|
1921 | #endif /* BOOST_WORKAROUND(__GNUC__, < 3) */ |
---|
1922 | |
---|
1923 | |
---|
1924 | #endif /* BOOST_QUATERNION_HPP */ |
---|