12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253 |
- // boost quaternion.hpp header file
- // (C) Copyright Hubert Holin 2001.
- // Distributed under the Boost Software License, Version 1.0. (See
- // accompanying file LICENSE_1_0.txt or copy at
- // http://www.boost.org/LICENSE_1_0.txt)
- // See http://www.boost.org for updates, documentation, and revision history.
- #ifndef BOOST_QUATERNION_HPP
- #define BOOST_QUATERNION_HPP
- #include <boost/config.hpp> // for BOOST_NO_STD_LOCALE
- #include <boost/math_fwd.hpp>
- #include <boost/detail/workaround.hpp>
- #include <boost/type_traits/is_convertible.hpp>
- #include <boost/utility/enable_if.hpp>
- #ifndef BOOST_NO_STD_LOCALE
- # include <locale> // for the "<<" operator
- #endif /* BOOST_NO_STD_LOCALE */
- #include <complex>
- #include <iosfwd> // for the "<<" and ">>" operators
- #include <sstream> // for the "<<" operator
- #include <boost/math/special_functions/sinc.hpp> // for the Sinus cardinal
- #include <boost/math/special_functions/sinhc.hpp> // for the Hyperbolic Sinus cardinal
- #if defined(BOOST_NO_CXX11_NOEXCEPT) || defined(BOOST_NO_CXX11_RVALUE_REFERENCES) || defined(BOOST_NO_SFINAE_EXPR)
- #include <boost/type_traits/is_pod.hpp>
- #endif
- namespace boost
- {
- namespace math
- {
- namespace detail {
- #if !defined(BOOST_NO_CXX11_NOEXCEPT) && !defined(BOOST_NO_CXX11_RVALUE_REFERENCES) && !defined(BOOST_NO_SFINAE_EXPR)
- template <class T>
- struct is_trivial_arithmetic_type_imp
- {
- typedef mpl::bool_<
- noexcept(std::declval<T&>() += std::declval<T>())
- && noexcept(std::declval<T&>() -= std::declval<T>())
- && noexcept(std::declval<T&>() *= std::declval<T>())
- && noexcept(std::declval<T&>() /= std::declval<T>())
- > type;
- };
- template <class T>
- struct is_trivial_arithmetic_type : public is_trivial_arithmetic_type_imp<T>::type {};
- #else
- template <class T>
- struct is_trivial_arithmetic_type : public boost::is_pod<T> {};
- #endif
- }
- #ifndef BOOST_NO_CXX14_CONSTEXPR
- namespace constexpr_detail
- {
- template <class T>
- constexpr void swap(T& a, T& b)
- {
- T t(a);
- a = b;
- b = t;
- }
- }
- #endif
- template<typename T>
- class quaternion
- {
- public:
-
- typedef T value_type;
-
-
- // constructor for H seen as R^4
- // (also default constructor)
-
- BOOST_CONSTEXPR explicit quaternion( T const & requested_a = T(),
- T const & requested_b = T(),
- T const & requested_c = T(),
- T const & requested_d = T())
- : a(requested_a),
- b(requested_b),
- c(requested_c),
- d(requested_d)
- {
- // nothing to do!
- }
-
-
- // constructor for H seen as C^2
-
- BOOST_CONSTEXPR explicit quaternion( ::std::complex<T> const & z0,
- ::std::complex<T> const & z1 = ::std::complex<T>())
- : a(z0.real()),
- b(z0.imag()),
- c(z1.real()),
- d(z1.imag())
- {
- // nothing to do!
- }
-
-
- // UNtemplated copy constructor
- BOOST_CONSTEXPR quaternion(quaternion const & a_recopier)
- : a(a_recopier.R_component_1()),
- b(a_recopier.R_component_2()),
- c(a_recopier.R_component_3()),
- d(a_recopier.R_component_4()) {}
- #ifndef BOOST_NO_CXX11_RVALUE_REFERENCES
- BOOST_CONSTEXPR quaternion(quaternion && a_recopier)
- : a(std::move(a_recopier.R_component_1())),
- b(std::move(a_recopier.R_component_2())),
- c(std::move(a_recopier.R_component_3())),
- d(std::move(a_recopier.R_component_4())) {}
- #endif
-
- // templated copy constructor
-
- template<typename X>
- BOOST_CONSTEXPR explicit quaternion(quaternion<X> const & a_recopier)
- : a(static_cast<T>(a_recopier.R_component_1())),
- b(static_cast<T>(a_recopier.R_component_2())),
- c(static_cast<T>(a_recopier.R_component_3())),
- d(static_cast<T>(a_recopier.R_component_4()))
- {
- // nothing to do!
- }
-
-
- // destructor
- // (this is taken care of by the compiler itself)
-
-
- // accessors
- //
- // Note: Like complex number, quaternions do have a meaningful notion of "real part",
- // but unlike them there is no meaningful notion of "imaginary part".
- // Instead there is an "unreal part" which itself is a quaternion, and usually
- // nothing simpler (as opposed to the complex number case).
- // However, for practicallity, there are accessors for the other components
- // (these are necessary for the templated copy constructor, for instance).
-
- BOOST_CONSTEXPR T real() const
- {
- return(a);
- }
- BOOST_CONSTEXPR quaternion<T> unreal() const
- {
- return(quaternion<T>(static_cast<T>(0), b, c, d));
- }
- BOOST_CONSTEXPR T R_component_1() const
- {
- return(a);
- }
- BOOST_CONSTEXPR T R_component_2() const
- {
- return(b);
- }
- BOOST_CONSTEXPR T R_component_3() const
- {
- return(c);
- }
- BOOST_CONSTEXPR T R_component_4() const
- {
- return(d);
- }
- BOOST_CONSTEXPR ::std::complex<T> C_component_1() const
- {
- return(::std::complex<T>(a, b));
- }
- BOOST_CONSTEXPR ::std::complex<T> C_component_2() const
- {
- return(::std::complex<T>(c, d));
- }
- BOOST_CXX14_CONSTEXPR void swap(quaternion& o)
- {
- #ifndef BOOST_NO_CXX14_CONSTEXPR
- using constexpr_detail::swap;
- #else
- using std::swap;
- #endif
- swap(a, o.a);
- swap(b, o.b);
- swap(c, o.c);
- swap(d, o.d);
- }
- // assignment operators
-
- template<typename X>
- BOOST_CXX14_CONSTEXPR quaternion<T> & operator = (quaternion<X> const & a_affecter)
- {
- a = static_cast<T>(a_affecter.R_component_1());
- b = static_cast<T>(a_affecter.R_component_2());
- c = static_cast<T>(a_affecter.R_component_3());
- d = static_cast<T>(a_affecter.R_component_4());
- return(*this);
- }
- BOOST_CXX14_CONSTEXPR quaternion<T> & operator = (quaternion<T> const & a_affecter)
- {
- a = a_affecter.a;
- b = a_affecter.b;
- c = a_affecter.c;
- d = a_affecter.d;
- return(*this);
- }
- #ifndef BOOST_NO_CXX11_RVALUE_REFERENCES
- BOOST_CXX14_CONSTEXPR quaternion<T> & operator = (quaternion<T> && a_affecter)
- {
- a = std::move(a_affecter.a);
- b = std::move(a_affecter.b);
- c = std::move(a_affecter.c);
- d = std::move(a_affecter.d);
- return(*this);
- }
- #endif
- BOOST_CXX14_CONSTEXPR quaternion<T> & operator = (T const & a_affecter)
- {
- a = a_affecter;
- b = c = d = static_cast<T>(0);
- return(*this);
- }
- BOOST_CXX14_CONSTEXPR quaternion<T> & operator = (::std::complex<T> const & a_affecter)
- {
- a = a_affecter.real();
- b = a_affecter.imag();
- c = d = static_cast<T>(0);
- return(*this);
- }
- // other assignment-related operators
- //
- // NOTE: Quaternion multiplication is *NOT* commutative;
- // symbolically, "q *= rhs;" means "q = q * rhs;"
- // and "q /= rhs;" means "q = q * inverse_of(rhs);"
- //
- // Note2: Each operator comes in 2 forms - one for the simple case where
- // type T throws no exceptions, and one exception-safe version
- // for the case where it might.
- private:
- BOOST_CXX14_CONSTEXPR quaternion<T> & do_add(T const & rhs, const mpl::true_&)
- {
- a += rhs;
- return *this;
- }
- BOOST_CXX14_CONSTEXPR quaternion<T> & do_add(T const & rhs, const mpl::false_&)
- {
- quaternion<T> result(a + rhs, b, c, d); // exception guard
- swap(result);
- return *this;
- }
- BOOST_CXX14_CONSTEXPR quaternion<T> & do_add(std::complex<T> const & rhs, const mpl::true_&)
- {
- a += std::real(rhs);
- b += std::imag(rhs);
- return *this;
- }
- BOOST_CXX14_CONSTEXPR quaternion<T> & do_add(std::complex<T> const & rhs, const mpl::false_&)
- {
- quaternion<T> result(a + std::real(rhs), b + std::imag(rhs), c, d); // exception guard
- swap(result);
- return *this;
- }
- template <class X>
- BOOST_CXX14_CONSTEXPR quaternion<T> & do_add(quaternion<X> const & rhs, const mpl::true_&)
- {
- a += rhs.R_component_1();
- b += rhs.R_component_2();
- c += rhs.R_component_3();
- d += rhs.R_component_4();
- return *this;
- }
- template <class X>
- BOOST_CXX14_CONSTEXPR quaternion<T> & do_add(quaternion<X> const & rhs, const mpl::false_&)
- {
- quaternion<T> result(a + rhs.R_component_1(), b + rhs.R_component_2(), c + rhs.R_component_3(), d + rhs.R_component_4()); // exception guard
- swap(result);
- return *this;
- }
- BOOST_CXX14_CONSTEXPR quaternion<T> & do_subtract(T const & rhs, const mpl::true_&)
- {
- a -= rhs;
- return *this;
- }
- BOOST_CXX14_CONSTEXPR quaternion<T> & do_subtract(T const & rhs, const mpl::false_&)
- {
- quaternion<T> result(a - rhs, b, c, d); // exception guard
- swap(result);
- return *this;
- }
- BOOST_CXX14_CONSTEXPR quaternion<T> & do_subtract(std::complex<T> const & rhs, const mpl::true_&)
- {
- a -= std::real(rhs);
- b -= std::imag(rhs);
- return *this;
- }
- BOOST_CXX14_CONSTEXPR quaternion<T> & do_subtract(std::complex<T> const & rhs, const mpl::false_&)
- {
- quaternion<T> result(a - std::real(rhs), b - std::imag(rhs), c, d); // exception guard
- swap(result);
- return *this;
- }
- template <class X>
- BOOST_CXX14_CONSTEXPR quaternion<T> & do_subtract(quaternion<X> const & rhs, const mpl::true_&)
- {
- a -= rhs.R_component_1();
- b -= rhs.R_component_2();
- c -= rhs.R_component_3();
- d -= rhs.R_component_4();
- return *this;
- }
- template <class X>
- BOOST_CXX14_CONSTEXPR quaternion<T> & do_subtract(quaternion<X> const & rhs, const mpl::false_&)
- {
- quaternion<T> result(a - rhs.R_component_1(), b - rhs.R_component_2(), c - rhs.R_component_3(), d - rhs.R_component_4()); // exception guard
- swap(result);
- return *this;
- }
- BOOST_CXX14_CONSTEXPR quaternion<T> & do_multiply(T const & rhs, const mpl::true_&)
- {
- a *= rhs;
- b *= rhs;
- c *= rhs;
- d *= rhs;
- return *this;
- }
- BOOST_CXX14_CONSTEXPR quaternion<T> & do_multiply(T const & rhs, const mpl::false_&)
- {
- quaternion<T> result(a * rhs, b * rhs, c * rhs, d * rhs); // exception guard
- swap(result);
- return *this;
- }
- BOOST_CXX14_CONSTEXPR quaternion<T> & do_divide(T const & rhs, const mpl::true_&)
- {
- a /= rhs;
- b /= rhs;
- c /= rhs;
- d /= rhs;
- return *this;
- }
- BOOST_CXX14_CONSTEXPR quaternion<T> & do_divide(T const & rhs, const mpl::false_&)
- {
- quaternion<T> result(a / rhs, b / rhs, c / rhs, d / rhs); // exception guard
- swap(result);
- return *this;
- }
- public:
- BOOST_CXX14_CONSTEXPR quaternion<T> & operator += (T const & rhs) { return do_add(rhs, detail::is_trivial_arithmetic_type<T>()); }
- BOOST_CXX14_CONSTEXPR quaternion<T> & operator += (::std::complex<T> const & rhs) { return do_add(rhs, detail::is_trivial_arithmetic_type<T>()); }
- template<typename X> BOOST_CXX14_CONSTEXPR quaternion<T> & operator += (quaternion<X> const & rhs) { return do_add(rhs, detail::is_trivial_arithmetic_type<T>()); }
- BOOST_CXX14_CONSTEXPR quaternion<T> & operator -= (T const & rhs) { return do_subtract(rhs, detail::is_trivial_arithmetic_type<T>()); }
- BOOST_CXX14_CONSTEXPR quaternion<T> & operator -= (::std::complex<T> const & rhs) { return do_subtract(rhs, detail::is_trivial_arithmetic_type<T>()); }
- template<typename X> BOOST_CXX14_CONSTEXPR quaternion<T> & operator -= (quaternion<X> const & rhs) { return do_subtract(rhs, detail::is_trivial_arithmetic_type<T>()); }
-
- BOOST_CXX14_CONSTEXPR quaternion<T> & operator *= (T const & rhs) { return do_multiply(rhs, detail::is_trivial_arithmetic_type<T>()); }
-
- BOOST_CXX14_CONSTEXPR quaternion<T> & operator *= (::std::complex<T> const & rhs)
- {
- T ar = rhs.real();
- T br = rhs.imag();
- quaternion<T> result(a*ar - b*br, a*br + b*ar, c*ar + d*br, -c*br+d*ar);
- swap(result);
- return(*this);
- }
-
- template<typename X>
- BOOST_CXX14_CONSTEXPR quaternion<T> & operator *= (quaternion<X> const & rhs)
- {
- T ar = static_cast<T>(rhs.R_component_1());
- T br = static_cast<T>(rhs.R_component_2());
- T cr = static_cast<T>(rhs.R_component_3());
- T dr = static_cast<T>(rhs.R_component_4());
-
- quaternion<T> result(a*ar - b*br - c*cr - d*dr, a*br + b*ar + c*dr - d*cr, a*cr - b*dr + c*ar + d*br, a*dr + b*cr - c*br + d*ar);
- swap(result);
- return(*this);
- }
-
- BOOST_CXX14_CONSTEXPR quaternion<T> & operator /= (T const & rhs) { return do_divide(rhs, detail::is_trivial_arithmetic_type<T>()); }
-
- BOOST_CXX14_CONSTEXPR quaternion<T> & operator /= (::std::complex<T> const & rhs)
- {
- T ar = rhs.real();
- T br = rhs.imag();
- T denominator = ar*ar+br*br;
- quaternion<T> result((+a*ar + b*br) / denominator, (-a*br + b*ar) / denominator, (+c*ar - d*br) / denominator, (+c*br + d*ar) / denominator);
- swap(result);
- return(*this);
- }
-
- template<typename X>
- BOOST_CXX14_CONSTEXPR quaternion<T> & operator /= (quaternion<X> const & rhs)
- {
- T ar = static_cast<T>(rhs.R_component_1());
- T br = static_cast<T>(rhs.R_component_2());
- T cr = static_cast<T>(rhs.R_component_3());
- T dr = static_cast<T>(rhs.R_component_4());
-
- T denominator = ar*ar+br*br+cr*cr+dr*dr;
- quaternion<T> result((+a*ar+b*br+c*cr+d*dr)/denominator, (-a*br+b*ar-c*dr+d*cr)/denominator, (-a*cr+b*dr+c*ar-d*br)/denominator, (-a*dr-b*cr+c*br+d*ar)/denominator);
- swap(result);
- return(*this);
- }
- private:
- T a, b, c, d;
-
- };
- // swap:
- template <class T>
- BOOST_CXX14_CONSTEXPR void swap(quaternion<T>& a, quaternion<T>& b) { a.swap(b); }
-
- // operator+
- template <class T1, class T2>
- inline BOOST_CONSTEXPR typename boost::enable_if_c<boost::is_convertible<T2, T1>::value, quaternion<T1> >::type
- operator + (const quaternion<T1>& a, const T2& b)
- {
- return quaternion<T1>(static_cast<T1>(a.R_component_1() + b), a.R_component_2(), a.R_component_3(), a.R_component_4());
- }
- template <class T1, class T2>
- inline BOOST_CONSTEXPR typename boost::enable_if_c<boost::is_convertible<T1, T2>::value, quaternion<T2> >::type
- operator + (const T1& a, const quaternion<T2>& b)
- {
- return quaternion<T2>(static_cast<T2>(b.R_component_1() + a), b.R_component_2(), b.R_component_3(), b.R_component_4());
- }
- template <class T1, class T2>
- inline BOOST_CONSTEXPR typename boost::enable_if_c<boost::is_convertible<T2, T1>::value, quaternion<T1> >::type
- operator + (const quaternion<T1>& a, const std::complex<T2>& b)
- {
- return quaternion<T1>(a.R_component_1() + std::real(b), a.R_component_2() + std::imag(b), a.R_component_3(), a.R_component_4());
- }
- template <class T1, class T2>
- inline BOOST_CONSTEXPR typename boost::enable_if_c<boost::is_convertible<T1, T2>::value, quaternion<T2> >::type
- operator + (const std::complex<T1>& a, const quaternion<T2>& b)
- {
- return quaternion<T1>(b.R_component_1() + real(a), b.R_component_2() + imag(a), b.R_component_3(), b.R_component_4());
- }
- template <class T>
- inline BOOST_CONSTEXPR quaternion<T> operator + (const quaternion<T>& a, const quaternion<T>& b)
- {
- return quaternion<T>(a.R_component_1() + b.R_component_1(), a.R_component_2() + b.R_component_2(), a.R_component_3() + b.R_component_3(), a.R_component_4() + b.R_component_4());
- }
- // operator-
- template <class T1, class T2>
- inline BOOST_CONSTEXPR typename boost::enable_if_c<boost::is_convertible<T2, T1>::value, quaternion<T1> >::type
- operator - (const quaternion<T1>& a, const T2& b)
- {
- return quaternion<T1>(static_cast<T1>(a.R_component_1() - b), a.R_component_2(), a.R_component_3(), a.R_component_4());
- }
- template <class T1, class T2>
- inline BOOST_CONSTEXPR typename boost::enable_if_c<boost::is_convertible<T1, T2>::value, quaternion<T2> >::type
- operator - (const T1& a, const quaternion<T2>& b)
- {
- return quaternion<T2>(static_cast<T2>(a - b.R_component_1()), -b.R_component_2(), -b.R_component_3(), -b.R_component_4());
- }
- template <class T1, class T2>
- inline BOOST_CONSTEXPR typename boost::enable_if_c<boost::is_convertible<T2, T1>::value, quaternion<T1> >::type
- operator - (const quaternion<T1>& a, const std::complex<T2>& b)
- {
- return quaternion<T1>(a.R_component_1() - std::real(b), a.R_component_2() - std::imag(b), a.R_component_3(), a.R_component_4());
- }
- template <class T1, class T2>
- inline BOOST_CONSTEXPR typename boost::enable_if_c<boost::is_convertible<T1, T2>::value, quaternion<T2> >::type
- operator - (const std::complex<T1>& a, const quaternion<T2>& b)
- {
- return quaternion<T1>(real(a) - b.R_component_1(), imag(a) - b.R_component_2(), -b.R_component_3(), -b.R_component_4());
- }
- template <class T>
- inline BOOST_CONSTEXPR quaternion<T> operator - (const quaternion<T>& a, const quaternion<T>& b)
- {
- return quaternion<T>(a.R_component_1() - b.R_component_1(), a.R_component_2() - b.R_component_2(), a.R_component_3() - b.R_component_3(), a.R_component_4() - b.R_component_4());
- }
- // operator*
- template <class T1, class T2>
- inline BOOST_CONSTEXPR typename boost::enable_if_c<boost::is_convertible<T2, T1>::value, quaternion<T1> >::type
- operator * (const quaternion<T1>& a, const T2& b)
- {
- return quaternion<T1>(static_cast<T1>(a.R_component_1() * b), a.R_component_2() * b, a.R_component_3() * b, a.R_component_4() * b);
- }
- template <class T1, class T2>
- inline BOOST_CONSTEXPR typename boost::enable_if_c<boost::is_convertible<T1, T2>::value, quaternion<T2> >::type
- operator * (const T1& a, const quaternion<T2>& b)
- {
- return quaternion<T2>(static_cast<T2>(a * b.R_component_1()), a * b.R_component_2(), a * b.R_component_3(), a * b.R_component_4());
- }
- template <class T1, class T2>
- inline BOOST_CXX14_CONSTEXPR typename boost::enable_if_c<boost::is_convertible<T2, T1>::value, quaternion<T1> >::type
- operator * (const quaternion<T1>& a, const std::complex<T2>& b)
- {
- quaternion<T1> result(a);
- result *= b;
- return result;
- }
- template <class T1, class T2>
- inline BOOST_CXX14_CONSTEXPR typename boost::enable_if_c<boost::is_convertible<T1, T2>::value, quaternion<T2> >::type
- operator * (const std::complex<T1>& a, const quaternion<T2>& b)
- {
- quaternion<T1> result(a);
- result *= b;
- return result;
- }
- template <class T>
- inline BOOST_CXX14_CONSTEXPR quaternion<T> operator * (const quaternion<T>& a, const quaternion<T>& b)
- {
- quaternion<T> result(a);
- result *= b;
- return result;
- }
- // operator/
- template <class T1, class T2>
- inline BOOST_CONSTEXPR typename boost::enable_if_c<boost::is_convertible<T2, T1>::value, quaternion<T1> >::type
- operator / (const quaternion<T1>& a, const T2& b)
- {
- return quaternion<T1>(a.R_component_1() / b, a.R_component_2() / b, a.R_component_3() / b, a.R_component_4() / b);
- }
- template <class T1, class T2>
- inline BOOST_CXX14_CONSTEXPR typename boost::enable_if_c<boost::is_convertible<T1, T2>::value, quaternion<T2> >::type
- operator / (const T1& a, const quaternion<T2>& b)
- {
- quaternion<T2> result(a);
- result /= b;
- return result;
- }
- template <class T1, class T2>
- inline BOOST_CXX14_CONSTEXPR typename boost::enable_if_c<boost::is_convertible<T2, T1>::value, quaternion<T1> >::type
- operator / (const quaternion<T1>& a, const std::complex<T2>& b)
- {
- quaternion<T1> result(a);
- result /= b;
- return result;
- }
- template <class T1, class T2>
- inline BOOST_CXX14_CONSTEXPR typename boost::enable_if_c<boost::is_convertible<T1, T2>::value, quaternion<T2> >::type
- operator / (const std::complex<T1>& a, const quaternion<T2>& b)
- {
- quaternion<T2> result(a);
- result /= b;
- return result;
- }
- template <class T>
- inline BOOST_CXX14_CONSTEXPR quaternion<T> operator / (const quaternion<T>& a, const quaternion<T>& b)
- {
- quaternion<T> result(a);
- result /= b;
- return result;
- }
-
-
- template<typename T>
- inline BOOST_CONSTEXPR const quaternion<T>& operator + (quaternion<T> const & q)
- {
- return q;
- }
-
-
- template<typename T>
- inline BOOST_CONSTEXPR quaternion<T> operator - (quaternion<T> const & q)
- {
- return(quaternion<T>(-q.R_component_1(),-q.R_component_2(),-q.R_component_3(),-q.R_component_4()));
- }
-
-
- template<typename R, typename T>
- inline BOOST_CONSTEXPR typename boost::enable_if_c<boost::is_convertible<R, T>::value, bool>::type operator == (R const & lhs, quaternion<T> const & rhs)
- {
- return (
- (rhs.R_component_1() == lhs)&&
- (rhs.R_component_2() == static_cast<T>(0))&&
- (rhs.R_component_3() == static_cast<T>(0))&&
- (rhs.R_component_4() == static_cast<T>(0))
- );
- }
-
-
- template<typename T, typename R>
- inline BOOST_CONSTEXPR typename boost::enable_if_c<boost::is_convertible<R, T>::value, bool>::type operator == (quaternion<T> const & lhs, R const & rhs)
- {
- return rhs == lhs;
- }
-
-
- template<typename T>
- inline BOOST_CONSTEXPR bool operator == (::std::complex<T> const & lhs, quaternion<T> const & rhs)
- {
- return (
- (rhs.R_component_1() == lhs.real())&&
- (rhs.R_component_2() == lhs.imag())&&
- (rhs.R_component_3() == static_cast<T>(0))&&
- (rhs.R_component_4() == static_cast<T>(0))
- );
- }
-
-
- template<typename T>
- inline BOOST_CONSTEXPR bool operator == (quaternion<T> const & lhs, ::std::complex<T> const & rhs)
- {
- return rhs == lhs;
- }
-
-
- template<typename T>
- inline BOOST_CONSTEXPR bool operator == (quaternion<T> const & lhs, quaternion<T> const & rhs)
- {
- return (
- (rhs.R_component_1() == lhs.R_component_1())&&
- (rhs.R_component_2() == lhs.R_component_2())&&
- (rhs.R_component_3() == lhs.R_component_3())&&
- (rhs.R_component_4() == lhs.R_component_4())
- );
- }
-
- template<typename R, typename T> inline BOOST_CONSTEXPR bool operator != (R const & lhs, quaternion<T> const & rhs) { return !(lhs == rhs); }
- template<typename T, typename R> inline BOOST_CONSTEXPR bool operator != (quaternion<T> const & lhs, R const & rhs) { return !(lhs == rhs); }
- template<typename T> inline BOOST_CONSTEXPR bool operator != (::std::complex<T> const & lhs, quaternion<T> const & rhs) { return !(lhs == rhs); }
- template<typename T> inline BOOST_CONSTEXPR bool operator != (quaternion<T> const & lhs, ::std::complex<T> const & rhs) { return !(lhs == rhs); }
- template<typename T> inline BOOST_CONSTEXPR bool operator != (quaternion<T> const & lhs, quaternion<T> const & rhs) { return !(lhs == rhs); }
-
-
- // Note: we allow the following formats, whith a, b, c, and d reals
- // a
- // (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))
- template<typename T, typename charT, class traits>
- ::std::basic_istream<charT,traits> & operator >> ( ::std::basic_istream<charT,traits> & is,
- quaternion<T> & q)
- {
-
- #ifdef BOOST_NO_STD_LOCALE
- #else
- const ::std::ctype<charT> & ct = ::std::use_facet< ::std::ctype<charT> >(is.getloc());
- #endif /* BOOST_NO_STD_LOCALE */
-
- T a = T();
- T b = T();
- T c = T();
- T d = T();
-
- ::std::complex<T> u = ::std::complex<T>();
- ::std::complex<T> v = ::std::complex<T>();
-
- charT ch = charT();
- char cc;
-
- is >> ch; // get the first lexeme
-
- if (!is.good()) goto finish;
-
- #ifdef BOOST_NO_STD_LOCALE
- cc = ch;
- #else
- cc = ct.narrow(ch, char());
- #endif /* BOOST_NO_STD_LOCALE */
-
- 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,))
- {
- is >> ch; // get the second lexeme
-
- if (!is.good()) goto finish;
-
- #ifdef BOOST_NO_STD_LOCALE
- cc = ch;
- #else
- cc = ct.narrow(ch, char());
- #endif /* BOOST_NO_STD_LOCALE */
-
- if (cc == '(') // read "((", possible: ((a)), ((a),c), ((a),(c)), ((a),(c,d)), ((a,b)), ((a,b),c), ((a,b),(c)), ((a,b,),(c,d,))
- {
- is.putback(ch);
-
- is >> u; // we extract the first and second components
- a = u.real();
- b = u.imag();
-
- if (!is.good()) goto finish;
-
- is >> ch; // get the next lexeme
-
- if (!is.good()) goto finish;
-
- #ifdef BOOST_NO_STD_LOCALE
- cc = ch;
- #else
- cc = ct.narrow(ch, char());
- #endif /* BOOST_NO_STD_LOCALE */
-
- if (cc == ')') // format: ((a)) or ((a,b))
- {
- q = quaternion<T>(a,b);
- }
- 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,))
- {
- is >> v; // we extract the third and fourth components
- c = v.real();
- d = v.imag();
-
- if (!is.good()) goto finish;
-
- is >> ch; // get the last lexeme
-
- if (!is.good()) goto finish;
-
- #ifdef BOOST_NO_STD_LOCALE
- cc = ch;
- #else
- cc = ct.narrow(ch, char());
- #endif /* BOOST_NO_STD_LOCALE */
-
- if (cc == ')') // format: ((a),c), ((a),(c)), ((a),(c,d)), ((a,b),c), ((a,b),(c)) or ((a,b,),(c,d,))
- {
- q = quaternion<T>(a,b,c,d);
- }
- else // error
- {
- is.setstate(::std::ios_base::failbit);
- }
- }
- else // error
- {
- is.setstate(::std::ios_base::failbit);
- }
- }
- else // read "(a", possible: (a), (a,b), (a,b,c), (a,b,c,d), (a,(c)), (a,(c,d))
- {
- is.putback(ch);
-
- is >> a; // we extract the first component
-
- if (!is.good()) goto finish;
-
- is >> ch; // get the third lexeme
-
- if (!is.good()) goto finish;
-
- #ifdef BOOST_NO_STD_LOCALE
- cc = ch;
- #else
- cc = ct.narrow(ch, char());
- #endif /* BOOST_NO_STD_LOCALE */
-
- if (cc == ')') // format: (a)
- {
- q = quaternion<T>(a);
- }
- else if (cc == ',') // read "(a,", possible: (a,b), (a,b,c), (a,b,c,d), (a,(c)), (a,(c,d))
- {
- is >> ch; // get the fourth lexeme
-
- if (!is.good()) goto finish;
-
- #ifdef BOOST_NO_STD_LOCALE
- cc = ch;
- #else
- cc = ct.narrow(ch, char());
- #endif /* BOOST_NO_STD_LOCALE */
-
- if (cc == '(') // read "(a,(", possible: (a,(c)), (a,(c,d))
- {
- is.putback(ch);
-
- is >> v; // we extract the third and fourth component
-
- c = v.real();
- d = v.imag();
-
- if (!is.good()) goto finish;
-
- is >> ch; // get the ninth lexeme
-
- if (!is.good()) goto finish;
-
- #ifdef BOOST_NO_STD_LOCALE
- cc = ch;
- #else
- cc = ct.narrow(ch, char());
- #endif /* BOOST_NO_STD_LOCALE */
-
- if (cc == ')') // format: (a,(c)) or (a,(c,d))
- {
- q = quaternion<T>(a,b,c,d);
- }
- else // error
- {
- is.setstate(::std::ios_base::failbit);
- }
- }
- else // read "(a,b", possible: (a,b), (a,b,c), (a,b,c,d)
- {
- is.putback(ch);
-
- is >> b; // we extract the second component
-
- if (!is.good()) goto finish;
-
- is >> ch; // get the fifth lexeme
-
- if (!is.good()) goto finish;
-
- #ifdef BOOST_NO_STD_LOCALE
- cc = ch;
- #else
- cc = ct.narrow(ch, char());
- #endif /* BOOST_NO_STD_LOCALE */
-
- if (cc == ')') // format: (a,b)
- {
- q = quaternion<T>(a,b);
- }
- else if (cc == ',') // read "(a,b,", possible: (a,b,c), (a,b,c,d)
- {
- is >> c; // we extract the third component
-
- if (!is.good()) goto finish;
-
- is >> ch; // get the seventh lexeme
-
- if (!is.good()) goto finish;
-
- #ifdef BOOST_NO_STD_LOCALE
- cc = ch;
- #else
- cc = ct.narrow(ch, char());
- #endif /* BOOST_NO_STD_LOCALE */
-
- if (cc == ')') // format: (a,b,c)
- {
- q = quaternion<T>(a,b,c);
- }
- else if (cc == ',') // read "(a,b,c,", possible: (a,b,c,d)
- {
- is >> d; // we extract the fourth component
-
- if (!is.good()) goto finish;
-
- is >> ch; // get the ninth lexeme
-
- if (!is.good()) goto finish;
-
- #ifdef BOOST_NO_STD_LOCALE
- cc = ch;
- #else
- cc = ct.narrow(ch, char());
- #endif /* BOOST_NO_STD_LOCALE */
-
- if (cc == ')') // format: (a,b,c,d)
- {
- q = quaternion<T>(a,b,c,d);
- }
- else // error
- {
- is.setstate(::std::ios_base::failbit);
- }
- }
- else // error
- {
- is.setstate(::std::ios_base::failbit);
- }
- }
- else // error
- {
- is.setstate(::std::ios_base::failbit);
- }
- }
- }
- else // error
- {
- is.setstate(::std::ios_base::failbit);
- }
- }
- }
- else // format: a
- {
- is.putback(ch);
-
- is >> a; // we extract the first component
-
- if (!is.good()) goto finish;
-
- q = quaternion<T>(a);
- }
-
- finish:
- return(is);
- }
-
-
- template<typename T, typename charT, class traits>
- ::std::basic_ostream<charT,traits> & operator << ( ::std::basic_ostream<charT,traits> & os,
- quaternion<T> const & q)
- {
- ::std::basic_ostringstream<charT,traits> s;
- s.flags(os.flags());
- #ifdef BOOST_NO_STD_LOCALE
- #else
- s.imbue(os.getloc());
- #endif /* BOOST_NO_STD_LOCALE */
- s.precision(os.precision());
-
- s << '(' << q.R_component_1() << ','
- << q.R_component_2() << ','
- << q.R_component_3() << ','
- << q.R_component_4() << ')';
-
- return os << s.str();
- }
-
-
- // values
-
- template<typename T>
- inline BOOST_CONSTEXPR T real(quaternion<T> const & q)
- {
- return(q.real());
- }
-
-
- template<typename T>
- inline BOOST_CONSTEXPR quaternion<T> unreal(quaternion<T> const & q)
- {
- return(q.unreal());
- }
-
- template<typename T>
- inline T sup(quaternion<T> const & q)
- {
- using ::std::abs;
- return (std::max)((std::max)(abs(q.R_component_1()), abs(q.R_component_2())), (std::max)(abs(q.R_component_3()), abs(q.R_component_4())));
- }
-
-
- template<typename T>
- inline T l1(quaternion<T> const & q)
- {
- using ::std::abs;
- return abs(q.R_component_1()) + abs(q.R_component_2()) + abs(q.R_component_3()) + abs(q.R_component_4());
- }
-
-
- template<typename T>
- inline T abs(quaternion<T> const & q)
- {
- using ::std::abs;
- using ::std::sqrt;
-
- T maxim = sup(q); // overflow protection
-
- if (maxim == static_cast<T>(0))
- {
- return(maxim);
- }
- else
- {
- T mixam = static_cast<T>(1)/maxim; // prefer multiplications over divisions
-
- T a = q.R_component_1() * mixam;
- T b = q.R_component_2() * mixam;
- T c = q.R_component_3() * mixam;
- T d = q.R_component_4() * mixam;
- a *= a;
- b *= b;
- c *= c;
- d *= d;
-
- return(maxim * sqrt(a + b + c + d));
- }
-
- //return(sqrt(norm(q)));
- }
-
-
- // Note: This is the Cayley norm, not the Euclidian norm...
-
- template<typename T>
- inline BOOST_CXX14_CONSTEXPR T norm(quaternion<T>const & q)
- {
- return(real(q*conj(q)));
- }
-
-
- template<typename T>
- inline BOOST_CONSTEXPR quaternion<T> conj(quaternion<T> const & q)
- {
- return(quaternion<T>( +q.R_component_1(),
- -q.R_component_2(),
- -q.R_component_3(),
- -q.R_component_4()));
- }
-
-
- template<typename T>
- inline quaternion<T> spherical( T const & rho,
- T const & theta,
- T const & phi1,
- T const & phi2)
- {
- using ::std::cos;
- using ::std::sin;
-
- //T a = cos(theta)*cos(phi1)*cos(phi2);
- //T b = sin(theta)*cos(phi1)*cos(phi2);
- //T c = sin(phi1)*cos(phi2);
- //T d = sin(phi2);
-
- T courrant = static_cast<T>(1);
-
- T d = sin(phi2);
-
- courrant *= cos(phi2);
-
- T c = sin(phi1)*courrant;
-
- courrant *= cos(phi1);
-
- T b = sin(theta)*courrant;
- T a = cos(theta)*courrant;
-
- return(rho*quaternion<T>(a,b,c,d));
- }
-
-
- template<typename T>
- inline quaternion<T> semipolar( T const & rho,
- T const & alpha,
- T const & theta1,
- T const & theta2)
- {
- using ::std::cos;
- using ::std::sin;
-
- T a = cos(alpha)*cos(theta1);
- T b = cos(alpha)*sin(theta1);
- T c = sin(alpha)*cos(theta2);
- T d = sin(alpha)*sin(theta2);
-
- return(rho*quaternion<T>(a,b,c,d));
- }
-
-
- template<typename T>
- inline quaternion<T> multipolar( T const & rho1,
- T const & theta1,
- T const & rho2,
- T const & theta2)
- {
- using ::std::cos;
- using ::std::sin;
-
- T a = rho1*cos(theta1);
- T b = rho1*sin(theta1);
- T c = rho2*cos(theta2);
- T d = rho2*sin(theta2);
-
- return(quaternion<T>(a,b,c,d));
- }
-
-
- template<typename T>
- inline quaternion<T> cylindrospherical( T const & t,
- T const & radius,
- T const & longitude,
- T const & latitude)
- {
- using ::std::cos;
- using ::std::sin;
-
-
-
- T b = radius*cos(longitude)*cos(latitude);
- T c = radius*sin(longitude)*cos(latitude);
- T d = radius*sin(latitude);
-
- return(quaternion<T>(t,b,c,d));
- }
-
-
- template<typename T>
- inline quaternion<T> cylindrical(T const & r,
- T const & angle,
- T const & h1,
- T const & h2)
- {
- using ::std::cos;
- using ::std::sin;
-
- T a = r*cos(angle);
- T b = r*sin(angle);
-
- return(quaternion<T>(a,b,h1,h2));
- }
-
-
- // transcendentals
- // (please see the documentation)
-
-
- template<typename T>
- inline quaternion<T> exp(quaternion<T> const & q)
- {
- using ::std::exp;
- using ::std::cos;
-
- using ::boost::math::sinc_pi;
-
- T u = exp(real(q));
-
- T z = abs(unreal(q));
-
- T w = sinc_pi(z);
-
- return(u*quaternion<T>(cos(z),
- w*q.R_component_2(), w*q.R_component_3(),
- w*q.R_component_4()));
- }
-
-
- template<typename T>
- inline quaternion<T> cos(quaternion<T> const & q)
- {
- using ::std::sin;
- using ::std::cos;
- using ::std::cosh;
-
- using ::boost::math::sinhc_pi;
-
- T z = abs(unreal(q));
-
- T w = -sin(q.real())*sinhc_pi(z);
-
- return(quaternion<T>(cos(q.real())*cosh(z),
- w*q.R_component_2(), w*q.R_component_3(),
- w*q.R_component_4()));
- }
-
-
- template<typename T>
- inline quaternion<T> sin(quaternion<T> const & q)
- {
- using ::std::sin;
- using ::std::cos;
- using ::std::cosh;
-
- using ::boost::math::sinhc_pi;
-
- T z = abs(unreal(q));
-
- T w = +cos(q.real())*sinhc_pi(z);
-
- return(quaternion<T>(sin(q.real())*cosh(z),
- w*q.R_component_2(), w*q.R_component_3(),
- w*q.R_component_4()));
- }
-
-
- template<typename T>
- inline quaternion<T> tan(quaternion<T> const & q)
- {
- return(sin(q)/cos(q));
- }
-
-
- template<typename T>
- inline quaternion<T> cosh(quaternion<T> const & q)
- {
- return((exp(+q)+exp(-q))/static_cast<T>(2));
- }
-
-
- template<typename T>
- inline quaternion<T> sinh(quaternion<T> const & q)
- {
- return((exp(+q)-exp(-q))/static_cast<T>(2));
- }
-
-
- template<typename T>
- inline quaternion<T> tanh(quaternion<T> const & q)
- {
- return(sinh(q)/cosh(q));
- }
-
-
- template<typename T>
- quaternion<T> pow(quaternion<T> const & q,
- int n)
- {
- if (n > 1)
- {
- int m = n>>1;
-
- quaternion<T> result = pow(q, m);
-
- result *= result;
-
- if (n != (m<<1))
- {
- result *= q; // n odd
- }
-
- return(result);
- }
- else if (n == 1)
- {
- return(q);
- }
- else if (n == 0)
- {
- return(quaternion<T>(static_cast<T>(1)));
- }
- else /* n < 0 */
- {
- return(pow(quaternion<T>(static_cast<T>(1))/q,-n));
- }
- }
- }
- }
- #endif /* BOOST_QUATERNION_HPP */
|