123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435 |
- //Copyright (c) 2008-2016 Emil Dotchevski and Reverge Studios, Inc.
- //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)
- #include <boost/qvm/operations.hpp>
- #include <boost/qvm/quat.hpp>
- #include <boost/qvm/vec.hpp>
- #include <boost/qvm/mat.hpp>
- namespace
- my_stuff
- {
- struct
- mat
- {
- float a[3][3];
- };
- struct
- vec
- {
- float a[3];
- };
- struct
- quat
- {
- float a[4];
- };
- }
- namespace
- boost
- {
- namespace
- qvm
- {
- template <>
- struct
- mat_traits<my_stuff::mat>
- {
- typedef float scalar_type;
- static int const rows=3;
- static int const cols=3;
- template <int R,int C>
- static
- scalar_type &
- write_element( my_stuff::mat & m )
- {
- BOOST_QVM_STATIC_ASSERT(R>=0);
- BOOST_QVM_STATIC_ASSERT(R<rows);
- BOOST_QVM_STATIC_ASSERT(C>=0);
- BOOST_QVM_STATIC_ASSERT(C<cols);
- return m.a[R][C];
- }
- template <int R,int C>
- static
- scalar_type
- read_element( my_stuff::mat const & m )
- {
- BOOST_QVM_STATIC_ASSERT(R>=0);
- BOOST_QVM_STATIC_ASSERT(R<rows);
- BOOST_QVM_STATIC_ASSERT(C>=0);
- BOOST_QVM_STATIC_ASSERT(C<cols);
- return m.a[R][C];
- }
- static
- inline
- scalar_type &
- write_element_idx( int r, int c, my_stuff::mat & m )
- {
- BOOST_QVM_ASSERT(r>=0);
- BOOST_QVM_ASSERT(r<rows);
- BOOST_QVM_ASSERT(c>=0);
- BOOST_QVM_ASSERT(c<cols);
- return m.a[r][c];
- }
- static
- inline
- scalar_type
- read_element_idx( int r, int c, my_stuff::mat const & m )
- {
- BOOST_QVM_ASSERT(r>=0);
- BOOST_QVM_ASSERT(r<rows);
- BOOST_QVM_ASSERT(c>=0);
- BOOST_QVM_ASSERT(c<cols);
- return m.a[r][c];
- }
- };
- template <>
- struct
- vec_traits<my_stuff::vec>
- {
- static int const dim=3;
- typedef float scalar_type;
- template <int I>
- static
- scalar_type &
- write_element( my_stuff::vec & m )
- {
- BOOST_QVM_STATIC_ASSERT(I>=0);
- BOOST_QVM_STATIC_ASSERT(I<dim);
- return m.a[I];
- }
- template <int I>
- static
- scalar_type
- read_element( my_stuff::vec const & m )
- {
- BOOST_QVM_STATIC_ASSERT(I>=0);
- BOOST_QVM_STATIC_ASSERT(I<dim);
- return m.a[I];
- }
- static
- inline
- scalar_type &
- write_element_idx( int i, my_stuff::vec & m )
- {
- BOOST_QVM_ASSERT(i>=0);
- BOOST_QVM_ASSERT(i<dim);
- return m.a[i];
- }
- static
- inline
- scalar_type
- read_element_idx( int i, my_stuff::vec const & m )
- {
- BOOST_QVM_ASSERT(i>=0);
- BOOST_QVM_ASSERT(i<dim);
- return m.a[i];
- }
- };
- template <>
- struct
- quat_traits<my_stuff::quat>
- {
- typedef float scalar_type;
- template <int I>
- static
- scalar_type &
- write_element( my_stuff::quat & m )
- {
- BOOST_QVM_STATIC_ASSERT(I>=0);
- BOOST_QVM_STATIC_ASSERT(I<4);
- return m.a[I];
- }
- template <int I>
- static
- scalar_type
- read_element( my_stuff::quat const & m )
- {
- BOOST_QVM_STATIC_ASSERT(I>=0);
- BOOST_QVM_STATIC_ASSERT(I<4);
- return m.a[I];
- }
- };
- }
- }
- namespace
- my_stuff
- {
- mat &
- operator/=( mat & x, float y )
- {
- return boost::qvm::operator/=(x,y);
- }
- vec &
- operator/=( vec & x, float y )
- {
- return boost::qvm::operator/=(x,y);
- }
- quat &
- operator/=( quat & x, float y )
- {
- return boost::qvm::operator/=(x,y);
- }
- mat &
- operator*=( mat & x, float y )
- {
- return boost::qvm::operator*=(x,y);
- }
- vec &
- operator*=( vec & x, float y )
- {
- return boost::qvm::operator*=(x,y);
- }
- quat &
- operator*=( quat & x, float y )
- {
- return boost::qvm::operator*=(x,y);
- }
- mat
- operator/( mat const & x, float y )
- {
- return boost::qvm::operator/(x,y);
- }
- vec
- operator/( vec const & x, float y )
- {
- return boost::qvm::operator/(x,y);
- }
- quat
- operator/( quat const & x, float y )
- {
- return boost::qvm::operator/(x,y);
- }
- mat
- operator*( mat const & x, float y )
- {
- return boost::qvm::operator*(x,y);
- }
- vec
- operator*( vec const & x, float y )
- {
- return boost::qvm::operator*(x,y);
- }
- quat
- operator*( quat const & x, float y )
- {
- return boost::qvm::operator*(x,y);
- }
- mat &
- operator*=( mat & x, mat const & y )
- {
- return boost::qvm::operator*=(x,y);
- }
- mat
- operator*=( mat const & x, mat const & y )
- {
- return boost::qvm::operator*(x,y);
- }
- vec
- operator*( mat const & x, vec const & y )
- {
- return boost::qvm::operator*(x,y);
- }
- vec
- operator*( quat const & x, vec const & y )
- {
- return boost::qvm::operator*(x,y);
- }
- vec
- operator*( vec const & x, mat const & y )
- {
- return boost::qvm::operator*(x,y);
- }
- bool
- operator==( mat const & x, mat const & y )
- {
- return boost::qvm::operator==(x,y);
- }
- bool
- operator!=( mat const & x, mat const & y )
- {
- return boost::qvm::operator!=(x,y);
- }
- bool
- operator==( vec const & x, vec const & y )
- {
- return boost::qvm::operator==(x,y);
- }
- bool
- operator!=( vec const & x, vec const & y )
- {
- return boost::qvm::operator!=(x,y);
- }
- bool
- operator==( quat const & x, quat const & y )
- {
- return boost::qvm::operator==(x,y);
- }
- bool
- operator!=( quat const & x, quat const & y )
- {
- return boost::qvm::operator!=(x,y);
- }
- }
- int
- main()
- {
- using namespace boost::qvm::sfinae;
- using namespace my_stuff;
- typedef boost::qvm::mat<double,3,3> mat2;
- typedef boost::qvm::vec<double,3> vec2;
- typedef boost::qvm::quat<double> quat2;
- mat ma1, mb1; set_zero(ma1); set_zero(mb1);
- vec va1, vb1; set_zero(va1); set_zero(vb1);
- quat qa1, qb1; set_zero(qa1); set_zero(qb1);
- mat2 ma2, mb2; set_zero(ma2); set_zero(mb2);
- vec2 va2, vb2; set_zero(va2); set_zero(vb2);
- quat2 qa2, qb2; set_zero(qa2); set_zero(qb2);
- set_zero(ma1);
- set_zero(mb1);
- set_zero(va1);
- set_zero(vb1);
- set_zero(qa1);
- set_zero(qb1);
- set_zero(ma2);
- set_zero(mb2);
- set_zero(va2);
- set_zero(vb2);
- set_zero(qa2);
- set_zero(qb2);
- ma1/=2;
- va1/=2;
- qa1/=2;
- ma2/=2;
- va2/=2;
- qa2/=2;
- ma1*=2;
- va1*=2;
- qa1*=2;
- ma2*=2;
- va2*=2;
- qa2*=2;
- mb1=ma1/2;
- vb1=va1/2;
- qb1=qb1/2;
- mb2=convert_to<mat2>(ma1/2);
- vb2=convert_to<vec2>(va1/2);
- qb2=convert_to<quat2>(qa1/2);
- mb1=scalar_cast<float>(ma2/2);
- vb1=scalar_cast<float>(va2/2);
- qb1=scalar_cast<float>(qa2/2);
- mb1=ma1*2;
- vb1=va1*2;
- qb1=qa1*2;
- mb2=convert_to<mat2>(ma1*2);
- vb2=convert_to<vec2>(va1*2);
- qb2=convert_to<quat2>(qa1*2);
- mb1=scalar_cast<float>(ma2*2);
- vb1=scalar_cast<float>(va2*2);
- qb1=scalar_cast<float>(qa2*2);
- ma1*=mb1;
- ma1*=scalar_cast<float>(ma2);
- ma2*=ma1;
- va1=ma1*va1;
- va1=qa1*va1;
- va1=scalar_cast<float>(ma2*va1);
- va1=scalar_cast<float>(ma1*va2);
- va1=scalar_cast<float>(ma2*va2);
- va1=scalar_cast<float>(qa2*va1);
- va1=scalar_cast<float>(qa1*va2);
- va1=scalar_cast<float>(qa2*va2);
- va2=convert_to<vec2>(ma1*va1);
- va2=convert_to<vec2>(qa1*va1);
- va2=ma2*va1;
- va2=ma1*va2;
- va2=ma2*va2;
- va2=qa2*va1;
- va2=qa1*va2;
- va2=qa2*va2;
- va1=va1*ma1;
- va1=scalar_cast<float>(va1*ma2);
- va1=scalar_cast<float>(va2*ma1);
- va1=scalar_cast<float>(va2*ma2);
- va2=convert_to<vec2>(va1*ma1);
- va2=va1*ma2;
- va2=va2*ma1;
- va2=va2*ma2;
- (void) (ma1==mb1);
- (void) (ma1==ma2);
- (void) (ma2==ma1);
- (void) (ma1!=mb1);
- (void) (ma1!=ma2);
- (void) (ma2!=ma1);
- (void) (va1==vb1);
- (void) (va1==va2);
- (void) (va2==va1);
- (void) (va1!=vb1);
- (void) (va1!=va2);
- (void) (va2!=va1);
- (void) (qa1==qb1);
- (void) (qa1==qa2);
- (void) (qa2==qa1);
- (void) (qa1!=qb1);
- (void) (qa1!=qa2);
- (void) (qa2!=qa1);
- return 0;
- }
|