map_mat_mat.hpp 32 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895
  1. //Copyright (c) 2008-2016 Emil Dotchevski and Reverge Studios, Inc.
  2. //Distributed under the Boost Software License, Version 1.0. (See accompanying
  3. //file LICENSE_1_0.txt or copy at http://www.boost.org/LICENSE_1_0.txt)
  4. #ifndef UUID_20D98340A3EB11DEB2180CD156D89593
  5. #define UUID_20D98340A3EB11DEB2180CD156D89593
  6. #include <boost/qvm/inline.hpp>
  7. #include <boost/qvm/deduce_mat.hpp>
  8. #include <boost/qvm/assert.hpp>
  9. #include <boost/qvm/enable_if.hpp>
  10. #include <boost/qvm/detail/transp_impl.hpp>
  11. namespace
  12. boost
  13. {
  14. namespace
  15. qvm
  16. {
  17. ////////////////////////////////////////////////
  18. namespace
  19. qvm_detail
  20. {
  21. template <int Row,class OriginalMatrix>
  22. class
  23. del_row_
  24. {
  25. del_row_( del_row_ const & );
  26. del_row_ & operator=( del_row_ const & );
  27. ~del_row_();
  28. public:
  29. template <class T>
  30. BOOST_QVM_INLINE_TRIVIAL
  31. del_row_ &
  32. operator=( T const & x )
  33. {
  34. assign(*this,x);
  35. return *this;
  36. }
  37. template <class R>
  38. BOOST_QVM_INLINE_TRIVIAL
  39. operator R() const
  40. {
  41. R r;
  42. assign(r,*this);
  43. return r;
  44. }
  45. };
  46. }
  47. template <int I,class OriginalMatrix>
  48. struct
  49. mat_traits< qvm_detail::del_row_<I,OriginalMatrix> >
  50. {
  51. typedef qvm_detail::del_row_<I,OriginalMatrix> this_matrix;
  52. typedef typename mat_traits<OriginalMatrix>::scalar_type scalar_type;
  53. static int const rows=mat_traits<OriginalMatrix>::rows-1;
  54. static int const cols=mat_traits<OriginalMatrix>::cols;
  55. template <int Row,int Col>
  56. static
  57. BOOST_QVM_INLINE_CRITICAL
  58. scalar_type
  59. read_element( this_matrix const & x )
  60. {
  61. BOOST_QVM_STATIC_ASSERT(Row>=0);
  62. BOOST_QVM_STATIC_ASSERT(Row<rows);
  63. BOOST_QVM_STATIC_ASSERT(Col>=0);
  64. BOOST_QVM_STATIC_ASSERT(Col<cols);
  65. return mat_traits<OriginalMatrix>::template read_element<Row+(Row>=I),Col>(reinterpret_cast<OriginalMatrix const &>(x));
  66. }
  67. template <int Row,int Col>
  68. static
  69. BOOST_QVM_INLINE_CRITICAL
  70. scalar_type &
  71. write_element( this_matrix & x )
  72. {
  73. BOOST_QVM_STATIC_ASSERT(Row>=0);
  74. BOOST_QVM_STATIC_ASSERT(Row<rows);
  75. BOOST_QVM_STATIC_ASSERT(Col>=0);
  76. BOOST_QVM_STATIC_ASSERT(Col<cols);
  77. return mat_traits<OriginalMatrix>::template write_element<Row+(Row>=I),Col>(reinterpret_cast<OriginalMatrix &>(x));
  78. }
  79. static
  80. BOOST_QVM_INLINE_CRITICAL
  81. scalar_type
  82. read_element_idx( int row, int col, this_matrix const & x )
  83. {
  84. BOOST_QVM_ASSERT(row>=0);
  85. BOOST_QVM_ASSERT(row<rows);
  86. BOOST_QVM_ASSERT(col>=0);
  87. BOOST_QVM_ASSERT(col<cols);
  88. return mat_traits<OriginalMatrix>::read_element_idx(row+(row>=I),col,reinterpret_cast<OriginalMatrix const &>(x));
  89. }
  90. static
  91. BOOST_QVM_INLINE_CRITICAL
  92. scalar_type &
  93. write_element_idx( int row, int col, this_matrix & x )
  94. {
  95. BOOST_QVM_ASSERT(row>=0);
  96. BOOST_QVM_ASSERT(row<rows);
  97. BOOST_QVM_ASSERT(col>=0);
  98. BOOST_QVM_ASSERT(col<cols);
  99. return mat_traits<OriginalMatrix>::write_element_idx(row+(row>=I),col,reinterpret_cast<OriginalMatrix &>(x));
  100. }
  101. };
  102. template <int J,class OriginalMatrix,int R,int C>
  103. struct
  104. deduce_mat<qvm_detail::del_row_<J,OriginalMatrix>,R,C>
  105. {
  106. typedef mat<typename mat_traits<OriginalMatrix>::scalar_type,R,C> type;
  107. };
  108. template <int J,class OriginalMatrix,int R,int C>
  109. struct
  110. deduce_mat2<qvm_detail::del_row_<J,OriginalMatrix>,qvm_detail::del_row_<J,OriginalMatrix>,R,C>
  111. {
  112. typedef mat<typename mat_traits<OriginalMatrix>::scalar_type,R,C> type;
  113. };
  114. template <int Row,class A>
  115. typename boost::enable_if_c<
  116. is_mat<A>::value,
  117. qvm_detail::del_row_<Row,A> const &>::type
  118. BOOST_QVM_INLINE_TRIVIAL
  119. del_row( A const & a )
  120. {
  121. return reinterpret_cast<typename qvm_detail::del_row_<Row,A> const &>(a);
  122. }
  123. template <int Row,class A>
  124. typename boost::enable_if_c<
  125. is_mat<A>::value,
  126. qvm_detail::del_row_<Row,A> &>::type
  127. BOOST_QVM_INLINE_TRIVIAL
  128. del_row( A & a )
  129. {
  130. return reinterpret_cast<typename qvm_detail::del_row_<Row,A> &>(a);
  131. }
  132. ////////////////////////////////////////////////
  133. namespace
  134. qvm_detail
  135. {
  136. template <int Col,class OriginalMatrix>
  137. class
  138. del_col_
  139. {
  140. del_col_( del_col_ const & );
  141. del_col_ & operator=( del_col_ const & );
  142. ~del_col_();
  143. public:
  144. template <class T>
  145. BOOST_QVM_INLINE_TRIVIAL
  146. del_col_ &
  147. operator=( T const & x )
  148. {
  149. assign(*this,x);
  150. return *this;
  151. }
  152. template <class R>
  153. BOOST_QVM_INLINE_TRIVIAL
  154. operator R() const
  155. {
  156. R r;
  157. assign(r,*this);
  158. return r;
  159. }
  160. };
  161. }
  162. template <int J,class OriginalMatrix>
  163. struct
  164. mat_traits< qvm_detail::del_col_<J,OriginalMatrix> >
  165. {
  166. typedef qvm_detail::del_col_<J,OriginalMatrix> this_matrix;
  167. typedef typename mat_traits<OriginalMatrix>::scalar_type scalar_type;
  168. static int const rows=mat_traits<OriginalMatrix>::rows;
  169. static int const cols=mat_traits<OriginalMatrix>::cols-1;
  170. template <int Row,int Col>
  171. static
  172. BOOST_QVM_INLINE_CRITICAL
  173. scalar_type
  174. read_element( this_matrix const & x )
  175. {
  176. BOOST_QVM_STATIC_ASSERT(Row>=0);
  177. BOOST_QVM_STATIC_ASSERT(Row<rows);
  178. BOOST_QVM_STATIC_ASSERT(Col>=0);
  179. BOOST_QVM_STATIC_ASSERT(Col<cols);
  180. return mat_traits<OriginalMatrix>::template read_element<Row,Col+(Col>=J)>(reinterpret_cast<OriginalMatrix const &>(x));
  181. }
  182. template <int Row,int Col>
  183. static
  184. BOOST_QVM_INLINE_CRITICAL
  185. scalar_type &
  186. write_element( this_matrix & x )
  187. {
  188. BOOST_QVM_STATIC_ASSERT(Row>=0);
  189. BOOST_QVM_STATIC_ASSERT(Row<rows);
  190. BOOST_QVM_STATIC_ASSERT(Col>=0);
  191. BOOST_QVM_STATIC_ASSERT(Col<cols);
  192. return mat_traits<OriginalMatrix>::template write_element<Row,Col+(Col>=J)>(reinterpret_cast<OriginalMatrix &>(x));
  193. }
  194. static
  195. BOOST_QVM_INLINE_CRITICAL
  196. scalar_type
  197. read_element_idx( int row, int col, this_matrix const & x )
  198. {
  199. BOOST_QVM_ASSERT(row>=0);
  200. BOOST_QVM_ASSERT(row<rows);
  201. BOOST_QVM_ASSERT(col>=0);
  202. BOOST_QVM_ASSERT(col<cols);
  203. return mat_traits<OriginalMatrix>::read_element_idx(row,col+(col>=J),reinterpret_cast<OriginalMatrix const &>(x));
  204. }
  205. static
  206. BOOST_QVM_INLINE_CRITICAL
  207. scalar_type &
  208. write_element_idx( int row, int col, this_matrix & x )
  209. {
  210. BOOST_QVM_ASSERT(row>=0);
  211. BOOST_QVM_ASSERT(row<rows);
  212. BOOST_QVM_ASSERT(col>=0);
  213. BOOST_QVM_ASSERT(col<cols);
  214. return mat_traits<OriginalMatrix>::write_element_idx(row,col+(col>=J),reinterpret_cast<OriginalMatrix &>(x));
  215. }
  216. };
  217. template <int J,class OriginalMatrix,int R,int C>
  218. struct
  219. deduce_mat<qvm_detail::del_col_<J,OriginalMatrix>,R,C>
  220. {
  221. typedef mat<typename mat_traits<OriginalMatrix>::scalar_type,R,C> type;
  222. };
  223. template <int J,class OriginalMatrix,int R,int C>
  224. struct
  225. deduce_mat2<qvm_detail::del_col_<J,OriginalMatrix>,qvm_detail::del_col_<J,OriginalMatrix>,R,C>
  226. {
  227. typedef mat<typename mat_traits<OriginalMatrix>::scalar_type,R,C> type;
  228. };
  229. template <int Col,class A>
  230. typename boost::enable_if_c<
  231. is_mat<A>::value,
  232. qvm_detail::del_col_<Col,A> const &>::type
  233. BOOST_QVM_INLINE_TRIVIAL
  234. del_col( A const & a )
  235. {
  236. return reinterpret_cast<typename qvm_detail::del_col_<Col,A> const &>(a);
  237. }
  238. template <int Col,class A>
  239. typename boost::enable_if_c<
  240. is_mat<A>::value,
  241. qvm_detail::del_col_<Col,A> &>::type
  242. BOOST_QVM_INLINE_TRIVIAL
  243. del_col( A & a )
  244. {
  245. return reinterpret_cast<typename qvm_detail::del_col_<Col,A> &>(a);
  246. }
  247. ////////////////////////////////////////////////
  248. namespace
  249. qvm_detail
  250. {
  251. template <int Row,int Col,class OriginalMatrix>
  252. class
  253. del_row_col_
  254. {
  255. del_row_col_( del_row_col_ const & );
  256. ~del_row_col_();
  257. public:
  258. BOOST_QVM_INLINE_TRIVIAL
  259. del_row_col_ &
  260. operator=( del_row_col_ const & x )
  261. {
  262. assign(*this,x);
  263. return *this;
  264. }
  265. template <class T>
  266. BOOST_QVM_INLINE_TRIVIAL
  267. del_row_col_ &
  268. operator=( T const & x )
  269. {
  270. assign(*this,x);
  271. return *this;
  272. }
  273. template <class R>
  274. BOOST_QVM_INLINE_TRIVIAL
  275. operator R() const
  276. {
  277. R r;
  278. assign(r,*this);
  279. return r;
  280. }
  281. };
  282. }
  283. template <int I,int J,class OriginalMatrix>
  284. struct
  285. mat_traits< qvm_detail::del_row_col_<I,J,OriginalMatrix> >
  286. {
  287. typedef qvm_detail::del_row_col_<I,J,OriginalMatrix> this_matrix;
  288. typedef typename mat_traits<OriginalMatrix>::scalar_type scalar_type;
  289. static int const rows=mat_traits<OriginalMatrix>::rows-1;
  290. static int const cols=mat_traits<OriginalMatrix>::cols-1;
  291. template <int Row,int Col>
  292. static
  293. BOOST_QVM_INLINE_CRITICAL
  294. scalar_type
  295. read_element( this_matrix const & x )
  296. {
  297. BOOST_QVM_STATIC_ASSERT(Row>=0);
  298. BOOST_QVM_STATIC_ASSERT(Row<rows);
  299. BOOST_QVM_STATIC_ASSERT(Col>=0);
  300. BOOST_QVM_STATIC_ASSERT(Col<cols);
  301. return mat_traits<OriginalMatrix>::template read_element<Row+(Row>=I),Col+(Col>=J)>(reinterpret_cast<OriginalMatrix const &>(x));
  302. }
  303. template <int Row,int Col>
  304. static
  305. BOOST_QVM_INLINE_CRITICAL
  306. scalar_type &
  307. write_element( this_matrix & x )
  308. {
  309. BOOST_QVM_STATIC_ASSERT(Row>=0);
  310. BOOST_QVM_STATIC_ASSERT(Row<rows);
  311. BOOST_QVM_STATIC_ASSERT(Col>=0);
  312. BOOST_QVM_STATIC_ASSERT(Col<cols);
  313. return mat_traits<OriginalMatrix>::template write_element<Row+(Row>=I),Col+(Col>=J)>(reinterpret_cast<OriginalMatrix &>(x));
  314. }
  315. static
  316. BOOST_QVM_INLINE_CRITICAL
  317. scalar_type
  318. read_element_idx( int row, int col, this_matrix const & x )
  319. {
  320. BOOST_QVM_ASSERT(row>=0);
  321. BOOST_QVM_ASSERT(row<rows);
  322. BOOST_QVM_ASSERT(col>=0);
  323. BOOST_QVM_ASSERT(col<cols);
  324. return mat_traits<OriginalMatrix>::read_element_idx(row+(row>=I),col+(col>=J),reinterpret_cast<OriginalMatrix const &>(x));
  325. }
  326. static
  327. BOOST_QVM_INLINE_CRITICAL
  328. scalar_type &
  329. write_element_idx( int row, int col, this_matrix & x )
  330. {
  331. BOOST_QVM_ASSERT(row>=0);
  332. BOOST_QVM_ASSERT(row<rows);
  333. BOOST_QVM_ASSERT(col>=0);
  334. BOOST_QVM_ASSERT(col<cols);
  335. return mat_traits<OriginalMatrix>::write_element_idx(row+(row>=I),col+(col>=J),reinterpret_cast<OriginalMatrix &>(x));
  336. }
  337. };
  338. template <int I,int J,class OriginalMatrix,int R,int C>
  339. struct
  340. deduce_mat<qvm_detail::del_row_col_<I,J,OriginalMatrix>,R,C>
  341. {
  342. typedef mat<typename mat_traits<OriginalMatrix>::scalar_type,R,C> type;
  343. };
  344. template <int I,int J,class OriginalMatrix,int R,int C>
  345. struct
  346. deduce_mat2<qvm_detail::del_row_col_<I,J,OriginalMatrix>,qvm_detail::del_row_col_<I,J,OriginalMatrix>,R,C>
  347. {
  348. typedef mat<typename mat_traits<OriginalMatrix>::scalar_type,R,C> type;
  349. };
  350. template <int Row,int Col,class A>
  351. typename boost::enable_if_c<
  352. is_mat<A>::value,
  353. qvm_detail::del_row_col_<Row,Col,A> const &>::type
  354. BOOST_QVM_INLINE_TRIVIAL
  355. del_row_col( A const & a )
  356. {
  357. return reinterpret_cast<typename qvm_detail::del_row_col_<Row,Col,A> const &>(a);
  358. }
  359. template <int Row,int Col,class A>
  360. typename boost::enable_if_c<
  361. is_mat<A>::value,
  362. qvm_detail::del_row_col_<Row,Col,A> &>::type
  363. BOOST_QVM_INLINE_TRIVIAL
  364. del_row_col( A & a )
  365. {
  366. return reinterpret_cast<typename qvm_detail::del_row_col_<Row,Col,A> &>(a);
  367. }
  368. ////////////////////////////////////////////////
  369. namespace
  370. qvm_detail
  371. {
  372. template <int Row,class OriginalMatrix>
  373. class
  374. neg_row_
  375. {
  376. neg_row_( neg_row_ const & );
  377. neg_row_ & operator=( neg_row_ const & );
  378. ~neg_row_();
  379. public:
  380. template <class T>
  381. BOOST_QVM_INLINE_TRIVIAL
  382. neg_row_ &
  383. operator=( T const & x )
  384. {
  385. assign(*this,x);
  386. return *this;
  387. }
  388. template <class R>
  389. BOOST_QVM_INLINE_TRIVIAL
  390. operator R() const
  391. {
  392. R r;
  393. assign(r,*this);
  394. return r;
  395. }
  396. };
  397. }
  398. template <int I,class OriginalMatrix>
  399. struct
  400. mat_traits< qvm_detail::neg_row_<I,OriginalMatrix> >
  401. {
  402. typedef qvm_detail::neg_row_<I,OriginalMatrix> this_matrix;
  403. typedef typename mat_traits<OriginalMatrix>::scalar_type scalar_type;
  404. static int const rows=mat_traits<OriginalMatrix>::rows;
  405. static int const cols=mat_traits<OriginalMatrix>::cols;
  406. template <int Row,int Col>
  407. static
  408. BOOST_QVM_INLINE_CRITICAL
  409. scalar_type
  410. read_element( this_matrix const & x )
  411. {
  412. BOOST_QVM_STATIC_ASSERT(Row>=0);
  413. BOOST_QVM_STATIC_ASSERT(Row<rows);
  414. BOOST_QVM_STATIC_ASSERT(Col>=0);
  415. BOOST_QVM_STATIC_ASSERT(Col<cols);
  416. return Row==I ?
  417. -mat_traits<OriginalMatrix>::template read_element<Row,Col>(reinterpret_cast<OriginalMatrix const &>(x)) :
  418. mat_traits<OriginalMatrix>::template read_element<Row,Col>(reinterpret_cast<OriginalMatrix const &>(x));
  419. }
  420. static
  421. BOOST_QVM_INLINE_CRITICAL
  422. scalar_type
  423. read_element_idx( int row, int col, this_matrix const & x )
  424. {
  425. BOOST_QVM_ASSERT(row>=0);
  426. BOOST_QVM_ASSERT(row<rows);
  427. BOOST_QVM_ASSERT(col>=0);
  428. BOOST_QVM_ASSERT(col<cols);
  429. return row==I?
  430. -mat_traits<OriginalMatrix>::read_element_idx(row,col,reinterpret_cast<OriginalMatrix const &>(x)) :
  431. mat_traits<OriginalMatrix>::read_element_idx(row,col,reinterpret_cast<OriginalMatrix const &>(x));
  432. }
  433. };
  434. template <int J,class OriginalMatrix,int R,int C>
  435. struct
  436. deduce_mat<qvm_detail::neg_row_<J,OriginalMatrix>,R,C>
  437. {
  438. typedef mat<typename mat_traits<OriginalMatrix>::scalar_type,R,C> type;
  439. };
  440. template <int J,class OriginalMatrix,int R,int C>
  441. struct
  442. deduce_mat2<qvm_detail::neg_row_<J,OriginalMatrix>,qvm_detail::neg_row_<J,OriginalMatrix>,R,C>
  443. {
  444. typedef mat<typename mat_traits<OriginalMatrix>::scalar_type,R,C> type;
  445. };
  446. template <int Row,class A>
  447. typename boost::enable_if_c<
  448. is_mat<A>::value,
  449. qvm_detail::neg_row_<Row,A> const &>::type
  450. BOOST_QVM_INLINE_TRIVIAL
  451. neg_row( A const & a )
  452. {
  453. return reinterpret_cast<typename qvm_detail::neg_row_<Row,A> const &>(a);
  454. }
  455. ////////////////////////////////////////////////
  456. namespace
  457. qvm_detail
  458. {
  459. template <int Col,class OriginalMatrix>
  460. class
  461. neg_col_
  462. {
  463. neg_col_( neg_col_ const & );
  464. neg_col_ & operator=( neg_col_ const & );
  465. ~neg_col_();
  466. public:
  467. template <class T>
  468. BOOST_QVM_INLINE_TRIVIAL
  469. neg_col_ &
  470. operator=( T const & x )
  471. {
  472. assign(*this,x);
  473. return *this;
  474. }
  475. template <class R>
  476. BOOST_QVM_INLINE_TRIVIAL
  477. operator R() const
  478. {
  479. R r;
  480. assign(r,*this);
  481. return r;
  482. }
  483. };
  484. }
  485. template <int J,class OriginalMatrix>
  486. struct
  487. mat_traits< qvm_detail::neg_col_<J,OriginalMatrix> >
  488. {
  489. typedef qvm_detail::neg_col_<J,OriginalMatrix> this_matrix;
  490. typedef typename mat_traits<OriginalMatrix>::scalar_type scalar_type;
  491. static int const rows=mat_traits<OriginalMatrix>::rows;
  492. static int const cols=mat_traits<OriginalMatrix>::cols;
  493. template <int Row,int Col>
  494. static
  495. BOOST_QVM_INLINE_CRITICAL
  496. scalar_type
  497. read_element( this_matrix const & x )
  498. {
  499. BOOST_QVM_STATIC_ASSERT(Row>=0);
  500. BOOST_QVM_STATIC_ASSERT(Row<rows);
  501. BOOST_QVM_STATIC_ASSERT(Col>=0);
  502. BOOST_QVM_STATIC_ASSERT(Col<cols);
  503. return Col==J?
  504. -mat_traits<OriginalMatrix>::template read_element<Row,Col>(reinterpret_cast<OriginalMatrix const &>(x)) :
  505. mat_traits<OriginalMatrix>::template read_element<Row,Col>(reinterpret_cast<OriginalMatrix const &>(x));
  506. }
  507. static
  508. BOOST_QVM_INLINE_CRITICAL
  509. scalar_type
  510. read_element_idx( int row, int col, this_matrix const & x )
  511. {
  512. BOOST_QVM_ASSERT(row>=0);
  513. BOOST_QVM_ASSERT(row<rows);
  514. BOOST_QVM_ASSERT(col>=0);
  515. BOOST_QVM_ASSERT(col<cols);
  516. return col==J?
  517. -mat_traits<OriginalMatrix>::read_element_idx(row,col,reinterpret_cast<OriginalMatrix const &>(x)) :
  518. mat_traits<OriginalMatrix>::read_element_idx(row,col,reinterpret_cast<OriginalMatrix const &>(x));
  519. }
  520. };
  521. template <int J,class OriginalMatrix,int R,int C>
  522. struct
  523. deduce_mat<qvm_detail::neg_col_<J,OriginalMatrix>,R,C>
  524. {
  525. typedef mat<typename mat_traits<OriginalMatrix>::scalar_type,R,C> type;
  526. };
  527. template <int J,class OriginalMatrix,int R,int C>
  528. struct
  529. deduce_mat2<qvm_detail::neg_col_<J,OriginalMatrix>,qvm_detail::neg_col_<J,OriginalMatrix>,R,C>
  530. {
  531. typedef mat<typename mat_traits<OriginalMatrix>::scalar_type,R,C> type;
  532. };
  533. template <int Col,class A>
  534. typename boost::enable_if_c<
  535. is_mat<A>::value,
  536. qvm_detail::neg_col_<Col,A> const &>::type
  537. BOOST_QVM_INLINE_TRIVIAL
  538. neg_col( A const & a )
  539. {
  540. return reinterpret_cast<typename qvm_detail::neg_col_<Col,A> const &>(a);
  541. }
  542. ////////////////////////////////////////////////
  543. template <class A>
  544. typename boost::enable_if_c<
  545. is_mat<A>::value,
  546. qvm_detail::transposed_<A> const &>::type
  547. BOOST_QVM_INLINE_TRIVIAL
  548. transposed( A const & a )
  549. {
  550. return reinterpret_cast<typename qvm_detail::transposed_<A> const &>(a);
  551. }
  552. template <class A>
  553. typename boost::enable_if_c<
  554. is_mat<A>::value,
  555. qvm_detail::transposed_<A> &>::type
  556. BOOST_QVM_INLINE_TRIVIAL
  557. transposed( A & a )
  558. {
  559. return reinterpret_cast<typename qvm_detail::transposed_<A> &>(a);
  560. }
  561. ////////////////////////////////////////////////
  562. namespace
  563. qvm_detail
  564. {
  565. template <int Row1,int Row2,class OriginalMatrix>
  566. class
  567. swap_rows_
  568. {
  569. swap_rows_( swap_rows_ const & );
  570. swap_rows_ & operator=( swap_rows_ const & );
  571. ~swap_rows_();
  572. public:
  573. template <class T>
  574. BOOST_QVM_INLINE_TRIVIAL
  575. swap_rows_ &
  576. operator=( T const & x )
  577. {
  578. assign(*this,x);
  579. return *this;
  580. }
  581. template <class R>
  582. BOOST_QVM_INLINE_TRIVIAL
  583. operator R() const
  584. {
  585. R r;
  586. assign(r,*this);
  587. return r;
  588. }
  589. };
  590. }
  591. template <int R1,int R2,class OriginalMatrix>
  592. struct
  593. mat_traits< qvm_detail::swap_rows_<R1,R2,OriginalMatrix> >
  594. {
  595. typedef qvm_detail::swap_rows_<R1,R2,OriginalMatrix> this_matrix;
  596. typedef typename mat_traits<OriginalMatrix>::scalar_type scalar_type;
  597. static int const rows=mat_traits<OriginalMatrix>::rows;
  598. static int const cols=mat_traits<OriginalMatrix>::cols;
  599. template <int Row,int Col>
  600. static
  601. BOOST_QVM_INLINE_CRITICAL
  602. scalar_type
  603. read_element( this_matrix const & x )
  604. {
  605. BOOST_QVM_STATIC_ASSERT(Row>=0);
  606. BOOST_QVM_STATIC_ASSERT(Row<rows);
  607. BOOST_QVM_STATIC_ASSERT(Col>=0);
  608. BOOST_QVM_STATIC_ASSERT(Col<cols);
  609. return mat_traits<OriginalMatrix>::template read_element<(Row==R1 && R1!=R2)*R2+(Row==R2 && R1!=R2)*R1+((Row!=R1 && Row!=R2) || R1==R2)*Row,Col>(reinterpret_cast<OriginalMatrix const &>(x));
  610. }
  611. template <int Row,int Col>
  612. static
  613. BOOST_QVM_INLINE_CRITICAL
  614. scalar_type &
  615. write_element( this_matrix & x )
  616. {
  617. BOOST_QVM_STATIC_ASSERT(Row>=0);
  618. BOOST_QVM_STATIC_ASSERT(Row<rows);
  619. BOOST_QVM_STATIC_ASSERT(Col>=0);
  620. BOOST_QVM_STATIC_ASSERT(Col<cols);
  621. return mat_traits<OriginalMatrix>::template write_element<(Row==R1 && R1!=R2)*R2+(Row==R2 && R1!=R2)*R1+((Row!=R1 && Row!=R2) || R1==R2)*Row,Col>(reinterpret_cast<OriginalMatrix &>(x));
  622. }
  623. static
  624. BOOST_QVM_INLINE_CRITICAL
  625. scalar_type
  626. read_element_idx( int row, int col, this_matrix const & x )
  627. {
  628. BOOST_QVM_ASSERT(row>=0);
  629. BOOST_QVM_ASSERT(row<rows);
  630. BOOST_QVM_ASSERT(col>=0);
  631. BOOST_QVM_ASSERT(col<cols);
  632. return mat_traits<OriginalMatrix>::read_element_idx(row==R1?R2:row==R2?R1:row,col,reinterpret_cast<OriginalMatrix const &>(x));
  633. }
  634. static
  635. BOOST_QVM_INLINE_CRITICAL
  636. scalar_type &
  637. write_element_idx( int row, int col, this_matrix & x )
  638. {
  639. BOOST_QVM_ASSERT(row>=0);
  640. BOOST_QVM_ASSERT(row<rows);
  641. BOOST_QVM_ASSERT(col>=0);
  642. BOOST_QVM_ASSERT(col<cols);
  643. return mat_traits<OriginalMatrix>::write_element_idx(row==R1?R2:row==R2?R1:row,col,reinterpret_cast<OriginalMatrix &>(x));
  644. }
  645. };
  646. template <int R1,int R2,class OriginalMatrix,int R,int C>
  647. struct
  648. deduce_mat<qvm_detail::swap_rows_<R1,R2,OriginalMatrix>,R,C>
  649. {
  650. typedef mat<typename mat_traits<OriginalMatrix>::scalar_type,R,C> type;
  651. };
  652. template <int R1,int R2,class OriginalMatrix,int R,int C>
  653. struct
  654. deduce_mat2<qvm_detail::swap_rows_<R1,R2,OriginalMatrix>,qvm_detail::swap_rows_<R1,R2,OriginalMatrix>,R,C>
  655. {
  656. typedef mat<typename mat_traits<OriginalMatrix>::scalar_type,R,C> type;
  657. };
  658. template <int R1,int R2,class A>
  659. typename boost::enable_if_c<
  660. is_mat<A>::value,
  661. qvm_detail::swap_rows_<R1,R2,A> const &>::type
  662. BOOST_QVM_INLINE_TRIVIAL
  663. swap_rows( A const & a )
  664. {
  665. return reinterpret_cast<typename qvm_detail::swap_rows_<R1,R2,A> const &>(a);
  666. }
  667. template <int R1,int R2,class A>
  668. typename boost::enable_if_c<
  669. is_mat<A>::value,
  670. qvm_detail::swap_rows_<R1,R2,A> &>::type
  671. BOOST_QVM_INLINE_TRIVIAL
  672. swap_rows( A & a )
  673. {
  674. return reinterpret_cast<typename qvm_detail::swap_rows_<R1,R2,A> &>(a);
  675. }
  676. ////////////////////////////////////////////////
  677. namespace
  678. qvm_detail
  679. {
  680. template <int Row1,int Row2,class OriginalMatrix>
  681. class
  682. swap_cols_
  683. {
  684. swap_cols_( swap_cols_ const & );
  685. swap_cols_ & operator=( swap_cols_ const & );
  686. ~swap_cols_();
  687. public:
  688. template <class T>
  689. BOOST_QVM_INLINE_TRIVIAL
  690. swap_cols_ &
  691. operator=( T const & x )
  692. {
  693. assign(*this,x);
  694. return *this;
  695. }
  696. template <class R>
  697. BOOST_QVM_INLINE_TRIVIAL
  698. operator R() const
  699. {
  700. R r;
  701. assign(r,*this);
  702. return r;
  703. }
  704. };
  705. }
  706. template <int C1,int C2,class OriginalMatrix>
  707. struct
  708. mat_traits< qvm_detail::swap_cols_<C1,C2,OriginalMatrix> >
  709. {
  710. typedef qvm_detail::swap_cols_<C1,C2,OriginalMatrix> this_matrix;
  711. typedef typename mat_traits<OriginalMatrix>::scalar_type scalar_type;
  712. static int const rows=mat_traits<OriginalMatrix>::rows;
  713. static int const cols=mat_traits<OriginalMatrix>::cols;
  714. template <int Row,int Col>
  715. static
  716. BOOST_QVM_INLINE_CRITICAL
  717. scalar_type
  718. read_element( this_matrix const & x )
  719. {
  720. BOOST_QVM_STATIC_ASSERT(Row>=0);
  721. BOOST_QVM_STATIC_ASSERT(Row<rows);
  722. BOOST_QVM_STATIC_ASSERT(Col>=0);
  723. BOOST_QVM_STATIC_ASSERT(Col<cols);
  724. return mat_traits<OriginalMatrix>::template read_element<Row,(Col==C1 && C1!=C2)*C2+(Col==C2 && C1!=C2)*C1+((Col!=C1 && Col!=C2) || C1==C2)*Col>(reinterpret_cast<OriginalMatrix const &>(x));
  725. }
  726. template <int Row,int Col>
  727. static
  728. BOOST_QVM_INLINE_CRITICAL
  729. scalar_type &
  730. write_element( this_matrix & x )
  731. {
  732. BOOST_QVM_STATIC_ASSERT(Row>=0);
  733. BOOST_QVM_STATIC_ASSERT(Row<rows);
  734. BOOST_QVM_STATIC_ASSERT(Col>=0);
  735. BOOST_QVM_STATIC_ASSERT(Col<cols);
  736. return mat_traits<OriginalMatrix>::template write_element<Row,(Col==C1 && C1!=C2)*C2+(Col==C2 && C1!=C2)*C1+((Col!=C1 && Col!=C2) || C1==C2)*Col>(reinterpret_cast<OriginalMatrix &>(x));
  737. }
  738. static
  739. BOOST_QVM_INLINE_CRITICAL
  740. scalar_type
  741. read_element_idx( int row, int col, this_matrix const & x )
  742. {
  743. BOOST_QVM_ASSERT(row>=0);
  744. BOOST_QVM_ASSERT(row<rows);
  745. BOOST_QVM_ASSERT(col>=0);
  746. BOOST_QVM_ASSERT(col<cols);
  747. return mat_traits<OriginalMatrix>::read_element_idx(row,col==C1?C2:col==C2?C1:col,reinterpret_cast<OriginalMatrix const &>(x));
  748. }
  749. static
  750. BOOST_QVM_INLINE_CRITICAL
  751. scalar_type &
  752. write_element_idx( int row, int col, this_matrix & x )
  753. {
  754. BOOST_QVM_ASSERT(row>=0);
  755. BOOST_QVM_ASSERT(row<rows);
  756. BOOST_QVM_ASSERT(col>=0);
  757. BOOST_QVM_ASSERT(col<cols);
  758. return mat_traits<OriginalMatrix>::write_element_idx(row,col==C1?C2:col==C2?C1:col,reinterpret_cast<OriginalMatrix &>(x));
  759. }
  760. };
  761. template <int C1,int C2,class OriginalMatrix,int R,int C>
  762. struct
  763. deduce_mat<qvm_detail::swap_cols_<C1,C2,OriginalMatrix>,R,C>
  764. {
  765. typedef mat<typename mat_traits<OriginalMatrix>::scalar_type,R,C> type;
  766. };
  767. template <int C1,int C2,class OriginalMatrix,int R,int C>
  768. struct
  769. deduce_mat2<qvm_detail::swap_cols_<C1,C2,OriginalMatrix>,qvm_detail::swap_cols_<C1,C2,OriginalMatrix>,R,C>
  770. {
  771. typedef mat<typename mat_traits<OriginalMatrix>::scalar_type,R,C> type;
  772. };
  773. template <int C1,int C2,class A>
  774. typename boost::enable_if_c<
  775. is_mat<A>::value,
  776. qvm_detail::swap_cols_<C1,C2,A> const &>::type
  777. BOOST_QVM_INLINE_TRIVIAL
  778. swap_cols( A const & a )
  779. {
  780. return reinterpret_cast<typename qvm_detail::swap_cols_<C1,C2,A> const &>(a);
  781. }
  782. template <int C1,int C2,class A>
  783. typename boost::enable_if_c<
  784. is_mat<A>::value,
  785. qvm_detail::swap_cols_<C1,C2,A> &>::type
  786. BOOST_QVM_INLINE_TRIVIAL
  787. swap_cols( A & a )
  788. {
  789. return reinterpret_cast<typename qvm_detail::swap_cols_<C1,C2,A> &>(a);
  790. }
  791. ////////////////////////////////////////////////
  792. }
  793. }
  794. #endif