<!doctype html public "-//W3C//DTD HTML 4.0 Transitional//EN" "http://www.w3.org/TR/REC-html40/loose.dtd">
<HTML>
<HEAD>
<TITLE>nevrax.org : docs</TITLE>
<LINK REL=stylesheet TYPE="text/css" HREF="http://www.nevrax.org/inc/css/nevrax.css">
<link href="doxygen.css" rel="stylesheet" type="text/css">
</HEAD>
<BODY MARGINHEIGHT="0" MARGINWIDTH="0">
<!-- uplinks -->
<TABLE CELLSPACING=0 CELLPADDING=0 BORDER=0>
<TR>
<TD WIDTH=16><IMG SRC="http://www.nevrax.org/inc/img/pixel.gif" WIDTH="16" HEIGHT="16" BORDER=0 ALT=""></TD>
<TD WIDTH=140 BGCOLOR=#dddddd><IMG SRC="http://www.nevrax.org/inc/img/pixel.gif" WIDTH="140" HEIGHT="16" BORDER=0 ALT=""></TD>
<TD WIDTH=16><IMG SRC="http://www.nevrax.org/inc/img/pixel.gif" WIDTH="16" HEIGHT="16" BORDER=0 ALT=""></TD>
<TD><IMG width=6 height=14 SRC="http://www.nevrax.org/inc/img/reddots.gif" ALT="#" VSPACE=2 HSPACE=2 BORDER=0 ></TD><TD VALIGN=middle> <A CLASS=uplinks HREF=http://www.nevrax.org><b>Home</B></FONT></A> </TD>
<TD><IMG width=6 height=14 SRC="http://www.nevrax.org/inc/img/reddots.gif" ALT="#" VSPACE=2 HSPACE=2 BORDER=0 ></TD><TD VALIGN=middle> <A CLASS=uplinks HREF=http://www.nevrax.com><b>nevrax.com</B></FONT></A> </TD>
</TR>
</TABLE>
<!-- banner Nevrax -->
<TABLE CELLSPACING=0 CELLPADDING=0 BORDER=0 WIDTH=100%>
<TR><TD BGCOLOR="#000000" BACKGROUND="http://www.nevrax.org/inc/img/black_banner.jpg"><A HREF="http://www.nevrax.org"><IMG SRC="http://www.nevrax.org/inc/img/nevrax.gif" WIDTH="170" HEIGHT="45" BORDER=0 ALT="Nevrax" ></A></TD></TR>
</TABLE>
<!-- main table -->
<TABLE CELLSPACING=0 CELLPADDING=0 BORDER=0 height=100%>
<TR>
<TD WIDTH=16><IMG SRC="http://www.nevrax.org/inc/img/pixel.gif" WIDTH="16" HEIGHT="10" BORDER=0 ALT=""></TD>
<TD WIDTH=140 BGCOLOR=#dddddd VALIGN=TOP ALIGN=middle><IMG SRC="http://www.nevrax.org/inc/img/pixel.gif" WIDTH="140" HEIGHT="10" BORDER=0 ALT="">
<!------ Begin Box ------>
<TABLE BORDER=0 CELLSPACING=0 CELLPADDING=0 BGCOLOR=black><TR><TD><TABLE border=0 cellspacing=2 cellpadding=0 width=120><tr><TD ALIGN=middle bgcolor=black>
<FONT COLOR=white FACE="sans-serif"><B>Nevrax.org</B></FONT></TD></TR><tr><td colspan=2 bgcolor=#FFFFFF>
<TABLE cellspacing=0 cellpadding=1 border=0>
<tr><td ALIGN=middle><a class='linkbox' href="http://www.nevrax.org/news/" TITLE="Rubrique news"><img width=13 height=15 hspace=5 border=0 src=http://www.nevrax.org/inc/img/picto-news.gif ALT=#></A></td><td><a class='linkbox' href="http://www.nevrax.org/news/" TITLE="News">News</a></td></tr>
<tr><td ALIGN=middle><a class='linkbox' href="http://www.nevrax.org/mail/" TITLE="Rubrique mail"><img width=15 height=11 hspace=5 border=0 src=http://www.nevrax.org/inc/img/picto-mail.gif ALT=#></A></td><td><a class='linkbox' href="http://www.nevrax.org/mail/" TITLE="Mailing list archive">Mailing-list</a></td></tr>
<tr><td ALIGN=middle><a class='linkbox' href="http://www.nevrax.org/docs/" TITLE="Rubrique docs"><img width=14 height=16 hspace=5 border=0 src=http://www.nevrax.org/inc/img/picto-docs.gif ALT=#></A></td><td><a class='linkbox' href="http://www.nevrax.org/docs/" TITLE="Documentation">Documentation</a></td></tr>
<tr><td ALIGN=middle><a class='linkbox' href="http://www.nevrax.org/cvs/" TITLE="Rubrique cvs"><img width=13 height=17 hspace=5 border=0 src=http://www.nevrax.org/inc/img/picto-cvs.gif ALT=#></A></td><td><a class='linkbox' href="http://www.nevrax.org/cvs/" TITLE="CVS Web">CVS</a></td></tr>
<tr><td ALIGN=middle><a class='linkbox' href="http://www.nevrax.org/bugs/" TITLE="Rubrique bugs"><img width=20 height=16 hspace=5 border=0 src=http://www.nevrax.org/inc/img/picto-bugs.gif ALT=#></A></td><td><a class='linkbox' href="http://www.nevrax.org/bugs/" TITLE="Bugtracking">Bugs</a></td></tr>
<tr><td ALIGN=middle><a class='linkbox' href="http://www.nevrax.org/GPL.php3" TITLE="Rubrique license"><img width=18 height=12 hspace=5 border=0 src=http://www.nevrax.org/inc/img/picto-gpl.gif ALT=#></A></td><td><a class='linkbox' href="http://www.nevrax.org/GPL.php3" TITLE="License">License</a></td></tr>
</TABLE>
</TD></TR></TABLE></TD></TR></TABLE>
<!------ End Box ------>
</TD>
<TD WIDTH=15><IMG SRC="http://www.nevrax.org/inc/img/pixel.gif" WIDTH="16" HEIGHT="16" BORDER=0 ALT=""></TD>
<TD ALIGN=left valign=top><IMG SRC="http://www.nevrax.org/inc/img/pixel.gif" WIDTH="140" HEIGHT="10" BORDER=0 ALT="">
<!-- title -->
<TABLE background="http://www.nevrax.org/inc/img/redline.gif" CELLSPACING=0 CELLPADDING=0 BORDER=0 width=100%><tr><td>
<A HREF="http://www.nevrax.org/docs/"><img src="http://www.nevrax.org/inc/img/t_docs.gif" ALT="Docs" HEIGHT=20 BORDER=0></A>
</td><td><IMG SRC="http://www.nevrax.org/inc/img/pixel.gif" WIDTH="1" HEIGHT="1" BORDER=0 ALT="">
</td></tr></table>
<!-- block -->
<TABLE bgcolor="#dddddd" CELLSPACING=0 CELLPADDING=0 BORDER=0 width=100%><tr><td width=1% valign=middle><img width=6 height=14 hspace=2 vspace=2 src="http://www.nevrax.org/inc/img/reddots.gif"></TD>
<TD><B>Documentation</B></TD>
<TD ALIGN=RIGHT> </td>
</tr></table>
<!-- Generated by Doxygen 1.2.14 -->
<center>
<a class="qindex" href="index.html">Main Page</a> <a class="qindex" href="namespaces.html">Namespace List</a> <a class="qindex" href="hierarchy.html">Class Hierarchy</a> <a class="qindex" href="classes.html">Alphabetical List</a> <a class="qindex" href="annotated.html">Compound List</a> <a class="qindex" href="files.html">File List</a> <a class="qindex" href="namespacemembers.html">Namespace Members</a> <a class="qindex" href="functions.html">Compound Members</a> <a class="qindex" href="globals.html">File Members</a> <a class="qindex" href="pages.html">Related Pages</a> <a class="qindexRef" doxygen="_cgi:http://www.nevrax.org/cgi-bin/nel-search.cgi" href="http://www.nevrax.org/cgi-bin/nel-search.cgi">Search</a> </center>
<hr><h1>quat.h</h1><a href="quat_8h.html">Go to the documentation of this file.</a><div class="fragment"><pre>00001
00007 <font class="comment">/* Copyright, 2000 Nevrax Ltd.</font>
00008 <font class="comment"> *</font>
00009 <font class="comment"> * This file is part of NEVRAX NEL.</font>
00010 <font class="comment"> * NEVRAX NEL is free software; you can redistribute it and/or modify</font>
00011 <font class="comment"> * it under the terms of the GNU General Public License as published by</font>
00012 <font class="comment"> * the Free Software Foundation; either version 2, or (at your option)</font>
00013 <font class="comment"> * any later version.</font>
00014 <font class="comment"></font>
00015 <font class="comment"> * NEVRAX NEL is distributed in the hope that it will be useful, but</font>
00016 <font class="comment"> * WITHOUT ANY WARRANTY; without even the implied warranty of</font>
00017 <font class="comment"> * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU</font>
00018 <font class="comment"> * General Public License for more details.</font>
00019 <font class="comment"></font>
00020 <font class="comment"> * You should have received a copy of the GNU General Public License</font>
00021 <font class="comment"> * along with NEVRAX NEL; see the file COPYING. If not, write to the</font>
00022 <font class="comment"> * Free Software Foundation, Inc., 59 Temple Place - Suite 330, Boston,</font>
00023 <font class="comment"> * MA 02111-1307, USA.</font>
00024 <font class="comment"> */</font>
00025
00026 <font class="preprocessor">#ifndef NL_QUAT_H </font>
00027 <font class="preprocessor"></font><font class="preprocessor">#define NL_QUAT_H </font>
00028 <font class="preprocessor"></font>
00029 <font class="preprocessor">#include "<a class="code" href="types__nl_8h.html">nel/misc/types_nl.h</a>"</font>
00030 <font class="preprocessor">#include "<a class="code" href="vector_8h.html">nel/misc/vector.h</a>"</font>
00031 <font class="preprocessor">#include "<a class="code" href="stream_8h.html">nel/misc/stream.h</a>"</font>
00032 <font class="preprocessor">#include <math.h></font>
00033
00034 <font class="keyword">namespace </font>NLMISC
00035 {
00036
00037
00038 <font class="comment">// ***************************************************************************</font>
00039 <font class="keyword">const</font> <font class="keywordtype">double</font> <a class="code" href="namespaceNLMISC.html#a171">QuatEpsilon</a>= 0.000001;
00040
00041
00042
00043 <font class="comment">// ***************************************************************************</font>
<a name="l00050"></a><a class="code" href="structNLMISC_1_1CAngleAxis.html">00050</a> <font class="comment"></font><font class="keyword">struct </font>CAngleAxis
00051 {
<a name="l00052"></a><a class="code" href="structNLMISC_1_1CAngleAxis.html#m0">00052</a> CVector <a class="code" href="structNLMISC_1_1CAngleAxis.html#m0">Axis</a>;
<a name="l00053"></a><a class="code" href="structNLMISC_1_1CAngleAxis.html#m1">00053</a> <font class="keywordtype">float</font> <a class="code" href="structNLMISC_1_1CAngleAxis.html#m1">Angle</a>;
00054
<a name="l00055"></a><a class="code" href="structNLMISC_1_1CAngleAxis.html#a0">00055</a> <a class="code" href="structNLMISC_1_1CAngleAxis.html#a0">CAngleAxis</a>() {}
<a name="l00056"></a><a class="code" href="structNLMISC_1_1CAngleAxis.html#a1">00056</a> <a class="code" href="structNLMISC_1_1CAngleAxis.html#a0">CAngleAxis</a>(CVector axis, <font class="keywordtype">float</font> ang) : <a class="code" href="structNLMISC_1_1CAngleAxis.html#m0">Axis</a>(axis), <a class="code" href="structNLMISC_1_1CAngleAxis.html#m1">Angle</a>(ang) {}
00057
<a name="l00059"></a><a class="code" href="structNLMISC_1_1CAngleAxis.html#a2">00059</a> <font class="keywordtype">void</font> <a class="code" href="structNLMISC_1_1CAngleAxis.html#a2">serial</a>(IStream &f)
00060 {
00061 f.serial(<a class="code" href="structNLMISC_1_1CAngleAxis.html#m0">Axis</a>);
00062 f.serial(<a class="code" href="structNLMISC_1_1CAngleAxis.html#m1">Angle</a>);
00063 }
00064 };
00065
00066
00067 <font class="comment">// ***************************************************************************</font>
<a name="l00074"></a><a class="code" href="classNLMISC_1_1CQuatT.html">00074</a> <font class="comment"></font><font class="keyword">template</font> <<font class="keyword">class</font> T> <font class="keyword">class </font>CQuatT
00075 {
00076 <font class="keyword">public</font>:
<a name="l00077"></a><a class="code" href="classNLMISC_1_1CQuatT.html#m2">00077</a> T <a class="code" href="classNLMISC_1_1CQuatT.html#m0">x</a>,<a class="code" href="classNLMISC_1_1CQuatT.html#m1">y</a>,<a class="code" href="classNLMISC_1_1CQuatT.html#m2">z</a>,<a class="code" href="classNLMISC_1_1CQuatT.html#m3">w</a>;
00078
00079
00080 <font class="keyword">public</font>:
00081
00083 <font class="comment">// @{</font>
<a name="l00084"></a><a class="code" href="classNLMISC_1_1CQuatT.html#z310_0">00084</a> <a class="code" href="classNLMISC_1_1CQuatT.html#z310_0">CQuatT</a>() : <a class="code" href="classNLMISC_1_1CQuatT.html#m0">x</a>((T)0.0),<a class="code" href="classNLMISC_1_1CQuatT.html#m1">y</a>((T)0.0),<a class="code" href="classNLMISC_1_1CQuatT.html#m2">z</a>((T)0.0),<a class="code" href="classNLMISC_1_1CQuatT.html#m3">w</a>((T)1.0) {}
<a name="l00085"></a><a class="code" href="classNLMISC_1_1CQuatT.html#z310_1">00085</a> <a class="code" href="classNLMISC_1_1CQuatT.html#z310_0">CQuatT</a>(T X, T Y, T Z, T W) : <a class="code" href="classNLMISC_1_1CQuatT.html#m0">x</a>(X), <a class="code" href="classNLMISC_1_1CQuatT.html#m1">y</a>(Y), <a class="code" href="classNLMISC_1_1CQuatT.html#m2">z</a>(Z), <a class="code" href="classNLMISC_1_1CQuatT.html#m3">w</a>(W) {}
<a name="l00087"></a><a class="code" href="classNLMISC_1_1CQuatT.html#z310_2">00087</a> <a class="code" href="classNLMISC_1_1CQuatT.html#z310_0">CQuatT</a>(<font class="keyword">const</font> CVector &axis, <font class="keywordtype">float</font> angle) {<a class="code" href="classNLMISC_1_1CQuatT.html#z315_3">setAngleAxis</a>(axis, angle);}
<a name="l00089"></a><a class="code" href="classNLMISC_1_1CQuatT.html#z310_3">00089</a> <a class="code" href="classNLMISC_1_1CQuatT.html#z310_0">CQuatT</a>(<font class="keyword">const</font> CAngleAxis &aa) {<a class="code" href="classNLMISC_1_1CQuatT.html#z315_3">setAngleAxis</a>(aa);}
00090 <font class="comment">// @}</font>
00091
00092
00094 <font class="comment">// @{</font>
<a name="l00095"></a><a class="code" href="classNLMISC_1_1CQuatT.html#z311_0">00095</a> <font class="keywordtype">void</font> <a class="code" href="classNLMISC_1_1CQuatT.html#z311_0">set</a>(T X, T Y, T Z, T W) {<a class="code" href="classNLMISC_1_1CQuatT.html#m0">x</a>= X; <a class="code" href="classNLMISC_1_1CQuatT.html#m1">y</a>= Y; <a class="code" href="classNLMISC_1_1CQuatT.html#m2">z</a>= Z; <a class="code" href="classNLMISC_1_1CQuatT.html#m3">w</a>= W;}
00096 <font class="comment">// @}</font>
00097
00099 <font class="comment">// @{</font>
<a name="l00100"></a><a class="code" href="classNLMISC_1_1CQuatT.html#z312_0">00100</a> <font class="keywordtype">bool</font> <a class="code" href="classNLMISC_1_1CQuatT.html#z312_0">operator==</a>(<font class="keyword">const</font> <a class="code" href="classNLMISC_1_1CQuatT.html#z310_0">CQuatT</a>& a)<font class="keyword"> const </font>{<font class="keywordflow">return</font> (<a class="code" href="classNLMISC_1_1CQuatT.html#m0">x</a>==0 && <a class="code" href="classNLMISC_1_1CQuatT.html#m1">y</a>==0 && <a class="code" href="classNLMISC_1_1CQuatT.html#m2">z</a>==0 && <a class="code" href="classNLMISC_1_1CQuatT.html#m3">w</a>==1.0f);}
00101 <font class="keywordtype">bool</font> <a class="code" href="classNLMISC_1_1CQuatT.html#z312_1">equal</a>(<font class="keyword">const</font> <a class="code" href="classNLMISC_1_1CQuatT.html#z310_0">CQuatT</a>& a, <font class="keywordtype">float</font> epsilon = 1E-6f) <font class="keyword">const</font>;
<a name="l00102"></a><a class="code" href="classNLMISC_1_1CQuatT.html#z312_2">00102</a> <font class="keywordtype">void</font> <a class="code" href="classNLMISC_1_1CQuatT.html#z312_2">identity</a>() {<a class="code" href="classNLMISC_1_1CQuatT.html#m0">x</a> = <a class="code" href="classNLMISC_1_1CQuatT.html#m1">y</a> = <a class="code" href="classNLMISC_1_1CQuatT.html#m2">z</a> = 0.0f ; <a class="code" href="classNLMISC_1_1CQuatT.html#m3">w</a> = 1.0f; }
<a name="l00103"></a><a class="code" href="classNLMISC_1_1CQuatT.html#z312_3">00103</a> <font class="keywordtype">bool</font> <a class="code" href="classNLMISC_1_1CQuatT.html#z312_3">isIdentity</a>()<font class="keyword"> const </font>{<font class="keywordflow">return</font> (<a class="code" href="classNLMISC_1_1CQuatT.html#m0">x</a>==0.0f && <a class="code" href="classNLMISC_1_1CQuatT.html#m1">y</a>==0.0f && <a class="code" href="classNLMISC_1_1CQuatT.html#m2">z</a>==0.0f && <a class="code" href="classNLMISC_1_1CQuatT.html#m3">w</a>==1.0f);}
00104 <font class="comment">// @}</font>
00105
00107 <font class="comment">// @{</font>
<a name="l00108"></a><a class="code" href="classNLMISC_1_1CQuatT.html#z313_0">00108</a> <a class="code" href="classNLMISC_1_1CQuatT.html#z310_0">CQuatT</a>& <a class="code" href="classNLMISC_1_1CQuatT.html#z313_0">operator+=</a>(<font class="keyword">const</font> <a class="code" href="classNLMISC_1_1CQuatT.html#z310_0">CQuatT</a>&o) {<a class="code" href="classNLMISC_1_1CQuatT.html#m0">x</a>+=o.x; <a class="code" href="classNLMISC_1_1CQuatT.html#m1">y</a>+=o.y; <a class="code" href="classNLMISC_1_1CQuatT.html#m2">z</a>+=o.z; <a class="code" href="classNLMISC_1_1CQuatT.html#m3">w</a>+=o.w; <font class="keywordflow">return</font> *<font class="keyword">this</font>;}
<a name="l00109"></a><a class="code" href="classNLMISC_1_1CQuatT.html#z313_1">00109</a> <a class="code" href="classNLMISC_1_1CQuatT.html#z310_0">CQuatT</a>& <a class="code" href="classNLMISC_1_1CQuatT.html#z313_1">operator-=</a>(<font class="keyword">const</font> <a class="code" href="classNLMISC_1_1CQuatT.html#z310_0">CQuatT</a>&o) {<a class="code" href="classNLMISC_1_1CQuatT.html#m0">x</a>-=o.x; <a class="code" href="classNLMISC_1_1CQuatT.html#m1">y</a>-=o.y; <a class="code" href="classNLMISC_1_1CQuatT.html#m2">z</a>-=o.z; <a class="code" href="classNLMISC_1_1CQuatT.html#m3">w</a>-=o.w; <font class="keywordflow">return</font> *<font class="keyword">this</font>;}
<a name="l00110"></a><a class="code" href="classNLMISC_1_1CQuatT.html#z313_2">00110</a> <a class="code" href="classNLMISC_1_1CQuatT.html#z310_0">CQuatT</a>& <a class="code" href="classNLMISC_1_1CQuatT.html#z313_2">operator*=</a>(T f) {<a class="code" href="classNLMISC_1_1CQuatT.html#m0">x</a>*=f;<a class="code" href="classNLMISC_1_1CQuatT.html#m1">y</a>*=f;<a class="code" href="classNLMISC_1_1CQuatT.html#m2">z</a>*=f;<a class="code" href="classNLMISC_1_1CQuatT.html#m3">w</a>*=f; <font class="keywordflow">return</font> *<font class="keyword">this</font>;}
<a name="l00111"></a><a class="code" href="classNLMISC_1_1CQuatT.html#z313_3">00111</a> <a class="code" href="classNLMISC_1_1CQuatT.html#z310_0">CQuatT</a>& <a class="code" href="classNLMISC_1_1CQuatT.html#z313_3">operator/=</a>(T f) {<font class="keywordtype">double</font> oof= 1.0/f; <a class="code" href="classNLMISC_1_1CQuatT.html#m0">x</a>=(T)(<a class="code" href="classNLMISC_1_1CQuatT.html#m0">x</a>*oof); <a class="code" href="classNLMISC_1_1CQuatT.html#m1">y</a>=(T)(<a class="code" href="classNLMISC_1_1CQuatT.html#m1">y</a>*oof); <a class="code" href="classNLMISC_1_1CQuatT.html#m2">z</a>= (T)(<a class="code" href="classNLMISC_1_1CQuatT.html#m2">z</a>*oof); <a class="code" href="classNLMISC_1_1CQuatT.html#m3">w</a>=(T)(<a class="code" href="classNLMISC_1_1CQuatT.html#m3">w</a>*oof); <font class="keywordflow">return</font> *<font class="keyword">this</font>;}
<a name="l00112"></a><a class="code" href="classNLMISC_1_1CQuatT.html#z313_4">00112</a> <a class="code" href="classNLMISC_1_1CQuatT.html#z310_0">CQuatT</a> <a class="code" href="classNLMISC_1_1CQuatT.html#z313_9">operator+</a>(<font class="keyword">const</font> <a class="code" href="classNLMISC_1_1CQuatT.html#z310_0">CQuatT</a>&o)<font class="keyword"> const </font>{<font class="keywordflow">return</font> <a class="code" href="classNLMISC_1_1CQuatT.html#z310_0">CQuatT</a>(<a class="code" href="classNLMISC_1_1CQuatT.html#m0">x</a>+o.x,<a class="code" href="classNLMISC_1_1CQuatT.html#m1">y</a>+o.y,<a class="code" href="classNLMISC_1_1CQuatT.html#m2">z</a>+o.z,<a class="code" href="classNLMISC_1_1CQuatT.html#m3">w</a>+o.w);}
<a name="l00113"></a><a class="code" href="classNLMISC_1_1CQuatT.html#z313_5">00113</a> <a class="code" href="classNLMISC_1_1CQuatT.html#z310_0">CQuatT</a> <a class="code" href="classNLMISC_1_1CQuatT.html#z313_8">operator-</a>(<font class="keyword">const</font> <a class="code" href="classNLMISC_1_1CQuatT.html#z310_0">CQuatT</a>&o)<font class="keyword"> const </font>{<font class="keywordflow">return</font> <a class="code" href="classNLMISC_1_1CQuatT.html#z310_0">CQuatT</a>(<a class="code" href="classNLMISC_1_1CQuatT.html#m0">x</a>-o.x,<a class="code" href="classNLMISC_1_1CQuatT.html#m1">y</a>-o.y,<a class="code" href="classNLMISC_1_1CQuatT.html#m2">z</a>-o.z,<a class="code" href="classNLMISC_1_1CQuatT.html#m3">w</a>-o.w);}
<a name="l00114"></a><a class="code" href="classNLMISC_1_1CQuatT.html#z313_6">00114</a> <a class="code" href="classNLMISC_1_1CQuatT.html#z310_0">CQuatT</a> <a class="code" href="classNLMISC_1_1CQuatT.html#z313_6">operator*</a>(T f)<font class="keyword"> const </font>{<font class="keywordflow">return</font> <a class="code" href="classNLMISC_1_1CQuatT.html#z310_0">CQuatT</a>(<a class="code" href="classNLMISC_1_1CQuatT.html#m0">x</a>*f,<a class="code" href="classNLMISC_1_1CQuatT.html#m1">y</a>*f,<a class="code" href="classNLMISC_1_1CQuatT.html#m2">z</a>*f,<a class="code" href="classNLMISC_1_1CQuatT.html#m3">w</a>*f);}
<a name="l00115"></a><a class="code" href="classNLMISC_1_1CQuatT.html#z313_7">00115</a> <a class="code" href="classNLMISC_1_1CQuatT.html#z310_0">CQuatT</a> <a class="code" href="classNLMISC_1_1CQuatT.html#z313_7">operator/</a>(T f)<font class="keyword"> const </font>{<font class="keywordtype">double</font> oof= 1.0/f; <font class="keywordflow">return</font> <a class="code" href="classNLMISC_1_1CQuatT.html#z310_0">CQuatT</a>(<a class="code" href="classNLMISC_1_1CQuatT.html#m0">x</a>*oof,<a class="code" href="classNLMISC_1_1CQuatT.html#m1">y</a>*oof,<a class="code" href="classNLMISC_1_1CQuatT.html#m2">z</a>*oof,<a class="code" href="classNLMISC_1_1CQuatT.html#m3">w</a>*oof);}
<a name="l00116"></a><a class="code" href="classNLMISC_1_1CQuatT.html#z313_8">00116</a> <a class="code" href="classNLMISC_1_1CQuatT.html#z310_0">CQuatT</a> <a class="code" href="classNLMISC_1_1CQuatT.html#z313_8">operator-</a>()<font class="keyword"> const </font>{<font class="keywordflow">return</font>(<a class="code" href="classNLMISC_1_1CQuatT.html#z310_0">CQuatT</a>(-<a class="code" href="classNLMISC_1_1CQuatT.html#m0">x</a>,-<a class="code" href="classNLMISC_1_1CQuatT.html#m1">y</a>,-<a class="code" href="classNLMISC_1_1CQuatT.html#m2">z</a>,-<a class="code" href="classNLMISC_1_1CQuatT.html#m3">w</a>)); }
<a name="l00117"></a><a class="code" href="classNLMISC_1_1CQuatT.html#z313_9">00117</a> <a class="code" href="classNLMISC_1_1CQuatT.html#z310_0">CQuatT</a> <a class="code" href="classNLMISC_1_1CQuatT.html#z313_9">operator+</a>()<font class="keyword"> const </font>{<font class="keywordflow">return</font> *<font class="keyword">this</font>; }
<a name="l00119"></a><a class="code" href="classNLMISC_1_1CQuatT.html#z313_10">00119</a> T <a class="code" href="classNLMISC_1_1CQuatT.html#z313_10">sqrnorm</a>()<font class="keyword"> const </font>{<font class="keywordflow">return</font> (<a class="code" href="classNLMISC_1_1CQuatT.html#m0">x</a>*<a class="code" href="classNLMISC_1_1CQuatT.html#m0">x</a> + <a class="code" href="classNLMISC_1_1CQuatT.html#m1">y</a>*<a class="code" href="classNLMISC_1_1CQuatT.html#m1">y</a> + <a class="code" href="classNLMISC_1_1CQuatT.html#m2">z</a>*<a class="code" href="classNLMISC_1_1CQuatT.html#m2">z</a> + <a class="code" href="classNLMISC_1_1CQuatT.html#m3">w</a>*<a class="code" href="classNLMISC_1_1CQuatT.html#m3">w</a>);}
<a name="l00121"></a><a class="code" href="classNLMISC_1_1CQuatT.html#z313_11">00121</a> T <a class="code" href="classNLMISC_1_1CQuatT.html#z313_11">norm</a>()<font class="keyword"> const </font>{<font class="keywordflow">return</font> (T)sqrt(<a class="code" href="classNLMISC_1_1CQuatT.html#z313_10">sqrnorm</a>());}
00123 <font class="keywordtype">void</font> <a class="code" href="classNLMISC_1_1CQuatT.html#z313_12">normalize</a>();
<a name="l00125"></a><a class="code" href="classNLMISC_1_1CQuatT.html#z313_13">00125</a> <a class="code" href="classNLMISC_1_1CQuatT.html#z310_0">CQuatT</a> <a class="code" href="classNLMISC_1_1CQuatT.html#z313_13">normed</a>()<font class="keyword"> const </font>{<a class="code" href="classNLMISC_1_1CQuatT.html#z310_0">CQuatT</a> ret= *<font class="keyword">this</font>; ret.normalize(); <font class="keywordflow">return</font> ret;}
00126 <font class="comment">// @}</font>
00127
00128
00130 <font class="comment">// @{</font>
00132 <font class="comment"> CQuatT operator*(const CQuatT&) const; </font>
00133 <a class="code" href="classNLMISC_1_1CQuatT.html#z310_0">CQuatT</a>& <a class="code" href="classNLMISC_1_1CQuatT.html#z313_2">operator*=</a>(<font class="keyword">const</font> <a class="code" href="classNLMISC_1_1CQuatT.html#z310_0">CQuatT</a>&);
00135 <font class="keywordtype">void</font> <a class="code" href="classNLMISC_1_1CQuatT.html#z314_2">invert</a>();
<a name="l00137"></a><a class="code" href="classNLMISC_1_1CQuatT.html#z314_3">00137</a> <a class="code" href="classNLMISC_1_1CQuatT.html#z310_0">CQuatT</a> <a class="code" href="classNLMISC_1_1CQuatT.html#z314_3">inverted</a>()<font class="keyword"> const </font>{<a class="code" href="classNLMISC_1_1CQuatT.html#z310_0">CQuatT</a> ret= *<font class="keyword">this</font>; ret.invert(); <font class="keywordflow">return</font> ret;}
<a name="l00139"></a><a class="code" href="classNLMISC_1_1CQuatT.html#z314_4">00139</a> <a class="code" href="classNLMISC_1_1CQuatT.html#z310_0">CQuatT</a> <a class="code" href="classNLMISC_1_1CQuatT.html#z314_4">conjugate</a>()<font class="keyword"> const </font>{<font class="keywordflow">return</font> <a class="code" href="classNLMISC_1_1CQuatT.html#z310_0">CQuatT</a>(-<a class="code" href="classNLMISC_1_1CQuatT.html#m0">x</a>, -<a class="code" href="classNLMISC_1_1CQuatT.html#m1">y</a>, -<a class="code" href="classNLMISC_1_1CQuatT.html#m2">z</a>, <a class="code" href="classNLMISC_1_1CQuatT.html#m3">w</a>);}
00140 <font class="comment">// @}</font>
00141
00142
00144 <font class="comment">// @{</font>
<a name="l00146"></a><a class="code" href="classNLMISC_1_1CQuatT.html#z315_0">00146</a> <font class="comment"> CVector getAxis() const {CVector ret((float)x,(float)y,(float)z); return ret.normed();}</font>
<a name="l00148"></a><a class="code" href="classNLMISC_1_1CQuatT.html#z315_1">00148</a> <font class="comment"> float getAngle() const {return (float)(2*acos(w/norm()));}</font>
<a name="l00150"></a><a class="code" href="classNLMISC_1_1CQuatT.html#z315_2">00150</a> <font class="comment"> CAngleAxis getAngleAxis() const {return CAngleAxis(getAxis(), getAngle());}</font>
00151
00153 <font class="keywordtype">void</font> <a class="code" href="classNLMISC_1_1CQuatT.html#z315_3">setAngleAxis</a>(<font class="keyword">const</font> CVector &axis, <font class="keywordtype">float</font> angle);
<a name="l00155"></a><a class="code" href="classNLMISC_1_1CQuatT.html#z315_4">00155</a> <font class="keywordtype">void</font> <a class="code" href="classNLMISC_1_1CQuatT.html#z315_3">setAngleAxis</a>(<font class="keyword">const</font> CAngleAxis &angAxis) {<a class="code" href="classNLMISC_1_1CQuatT.html#z315_3">setAngleAxis</a>(angAxis.Axis, angAxis.Angle);}
00156 <font class="comment">// @}</font>
00157
00158
00160 <font class="comment">// @{</font>
00162 <font class="comment"> CQuatT log();</font>
00164 <font class="comment"> CQuatT exp();</font>
00166 <font class="comment"> void makeClosest(const CQuatT &o);</font>
<a name="l00168"></a><a class="code" href="classNLMISC_1_1CQuatT.html#z316_3">00168</a> <font class="comment"> void serial(IStream &f)</font>
00169 {
00170 f.serial(<a class="code" href="classNLMISC_1_1CQuatT.html#m0">x</a>,<a class="code" href="classNLMISC_1_1CQuatT.html#m1">y</a>,<a class="code" href="classNLMISC_1_1CQuatT.html#m2">z</a>,<a class="code" href="classNLMISC_1_1CQuatT.html#m3">w</a>);
00171 }
00172 <font class="comment">// @}</font>
00173
00174
00175 <font class="keyword">public</font>:
00176
00178 <font class="comment">// @{</font>
00180 <font class="comment"> static T dotProduct(const CQuatT<T> &q0, const CQuatT<T> &q1);</font>
00184 <font class="comment"></font> <font class="keyword">static</font> <a class="code" href="classNLMISC_1_1CQuatT.html#z310_0">CQuatT</a> <a class="code" href="classNLMISC_1_1CQuatT.html#z317_1">slerp</a>(<font class="keyword">const</font> CQuatT<T>& q0, <font class="keyword">const</font> CQuatT<T>& q1, <font class="keywordtype">float</font> <a class="code" href="driver__opengl__extension__def_8h.html#a384">t</a>);
00188 <font class="keyword">static</font> <a class="code" href="classNLMISC_1_1CQuatT.html#z310_0">CQuatT</a> <a class="code" href="classNLMISC_1_1CQuatT.html#z317_2">squad</a>(<font class="keyword">const</font> CQuatT<T>& q0, <font class="keyword">const</font> CQuatT<T>& tgtQ0, <font class="keyword">const</font> CQuatT<T>& tgtQ1, <font class="keyword">const</font> CQuatT<T>& q1, <font class="keywordtype">float</font> <a class="code" href="driver__opengl__extension__def_8h.html#a384">t</a>);
00191 <font class="keyword">static</font> <a class="code" href="classNLMISC_1_1CQuatT.html#z310_0">CQuatT</a> <a class="code" href="classNLMISC_1_1CQuatT.html#z317_3">squadrev</a>(<font class="keyword">const</font> CAngleAxis &rot, <font class="keyword">const</font> CQuatT<T>& q0, <font class="keyword">const</font> CQuatT<T>& tgtQ0, <font class="keyword">const</font> CQuatT<T>& tgtQ1, <font class="keyword">const</font> CQuatT<T>& q1, <font class="keywordtype">float</font> <a class="code" href="driver__opengl__extension__def_8h.html#a384">t</a>);
00192
00194 <font class="keyword">static</font> <a class="code" href="classNLMISC_1_1CQuatT.html#z310_0">CQuatT</a> <a class="code" href="classNLMISC_1_1CQuatT.html#z317_4">lnDif</a>(<font class="keyword">const</font> <a class="code" href="classNLMISC_1_1CQuatT.html#z310_0">CQuatT</a> &q0, <font class="keyword">const</font> <a class="code" href="classNLMISC_1_1CQuatT.html#z310_0">CQuatT</a> &q1);
00195
00196 <font class="comment">// @}</font>
00197
00198
00199 };
00200
00201
00202
00203 <font class="comment">// ***************************************************************************</font>
00204
00205
00207 <font class="comment">// @{</font>
00208
00210 <font class="keyword">template</font> <<font class="keyword">class</font> T>
00211 <font class="keyword">inline</font> CQuatT<T> <a class="code" href="namespaceNLMISC.html#a273">operator*</a>(T f, <font class="keyword">const</font> CQuatT<T> &o) {<font class="keywordflow">return</font> o*f;}
00212
00213 <font class="comment">// @}</font>
00214
00215
00216
00217 <font class="comment">// ***************************************************************************</font>
00218 <font class="comment">// ***************************************************************************</font>
00219 <font class="comment">// Template implementation.</font>
00220 <font class="comment">// ***************************************************************************</font>
00221 <font class="comment">// ***************************************************************************</font>
00222
00223
00224
00225 <font class="comment">// ***************************************************************************</font>
00226 <font class="keyword">template</font> <<font class="keyword">class</font> T>
<a name="l00227"></a><a class="code" href="classNLMISC_1_1CQuatT.html#z312_1">00227</a> <font class="keyword">inline</font> <font class="keywordtype">bool</font> CQuatT<T>::equal(<font class="keyword">const</font> CQuatT<T>& a, <font class="keywordtype">float</font> epsilon)<font class="keyword"> const</font>
00228 <font class="keyword"></font>{
00229 <font class="keywordflow">if</font> (fabs(<a class="code" href="classNLMISC_1_1CQuatT.html#m0">x</a>-a.x)<epsilon &&
00230 fabs(<a class="code" href="classNLMISC_1_1CQuatT.html#m1">y</a>-a.y)<epsilon &&
00231 fabs(<a class="code" href="classNLMISC_1_1CQuatT.html#m2">z</a>-a.z)<epsilon &&
00232 fabs(<a class="code" href="classNLMISC_1_1CQuatT.html#m3">w</a>-a.w)<epsilon )
00233 {
00234 <font class="keywordflow">return</font> <font class="keyword">true</font>;
00235 }
00236 <font class="keywordflow">return</font> <font class="keyword">false</font>;
00237 }
00238
00239
00240 <font class="comment">// ***************************************************************************</font>
00241 <font class="keyword">template</font> <<font class="keyword">class</font> T>
<a name="l00242"></a><a class="code" href="classNLMISC_1_1CQuatT.html#z314_0">00242</a> <font class="keyword">inline</font> CQuatT<T> CQuatT<T>::operator*(<font class="keyword">const</font> CQuatT<T>& o)<font class="keyword"> const</font>
00243 <font class="keyword"></font>{
00244 <font class="comment">// wres= ww� - v�v�</font>
00245 <font class="comment">// vres= wv� + w�v + v^v� ] </font>
00246 <font class="keywordflow">return</font> CQuatT<T>(
00247 (<a class="code" href="classNLMISC_1_1CQuatT.html#m3">w</a>*o.x) +(<a class="code" href="classNLMISC_1_1CQuatT.html#m0">x</a>*o.w) + (<a class="code" href="classNLMISC_1_1CQuatT.html#m1">y</a>*o.z)-(<a class="code" href="classNLMISC_1_1CQuatT.html#m2">z</a>*o.y),
00248 (<a class="code" href="classNLMISC_1_1CQuatT.html#m3">w</a>*o.y) +(<a class="code" href="classNLMISC_1_1CQuatT.html#m1">y</a>*o.w) + (<a class="code" href="classNLMISC_1_1CQuatT.html#m2">z</a>*o.x)-(<a class="code" href="classNLMISC_1_1CQuatT.html#m0">x</a>*o.z),
00249 (<a class="code" href="classNLMISC_1_1CQuatT.html#m3">w</a>*o.z) +(<a class="code" href="classNLMISC_1_1CQuatT.html#m2">z</a>*o.w) + (<a class="code" href="classNLMISC_1_1CQuatT.html#m0">x</a>*o.y)-(<a class="code" href="classNLMISC_1_1CQuatT.html#m1">y</a>*o.x),
00250 (<a class="code" href="classNLMISC_1_1CQuatT.html#m3">w</a>*o.w)-(<a class="code" href="classNLMISC_1_1CQuatT.html#m0">x</a>*o.x)-(<a class="code" href="classNLMISC_1_1CQuatT.html#m1">y</a>*o.y)-(<a class="code" href="classNLMISC_1_1CQuatT.html#m2">z</a>*o.z) );
00251
00252 }
00253
00254 <font class="comment">// ***************************************************************************</font>
00255 <font class="keyword">template</font> <<font class="keyword">class</font> T>
<a name="l00256"></a><a class="code" href="classNLMISC_1_1CQuatT.html#z314_1">00256</a> <font class="keyword">inline</font> CQuatT<T>& CQuatT<T>::operator*=(<font class="keyword">const</font> CQuatT<T>& o)
00257 {
00258 *<font class="keyword">this</font>= *<font class="keyword">this</font> * o;
00259 <font class="keywordflow">return</font> *<font class="keyword">this</font>;
00260 }
00261
00262
00263 <font class="comment">// ***************************************************************************</font>
00264 <font class="keyword">template</font> <<font class="keyword">class</font> T>
<a name="l00265"></a><a class="code" href="classNLMISC_1_1CQuatT.html#z314_2">00265</a> <font class="keyword">inline</font> <font class="keywordtype">void</font> CQuatT<T>::invert()
00266 {
00267 <font class="comment">// Must invert the norm.</font>
00268 T f= <a class="code" href="classNLMISC_1_1CQuatT.html#z313_10">sqrnorm</a>();
00269 <font class="keywordflow">if</font>(f!=0)
00270 {
00271 *<font class="keyword">this</font>/=f;
00272 }
00273
00274 *<font class="keyword">this</font>= <a class="code" href="classNLMISC_1_1CQuatT.html#z314_4">conjugate</a>();
00275 }
00276
00277
00278 <font class="comment">// ***************************************************************************</font>
00279 <font class="keyword">template</font> <<font class="keyword">class</font> T>
<a name="l00280"></a><a class="code" href="classNLMISC_1_1CQuatT.html#z313_12">00280</a> <font class="keyword">inline</font> <font class="keywordtype">void</font> CQuatT<T>::normalize()
00281 {
00282 T f= <a class="code" href="classNLMISC_1_1CQuatT.html#z313_11">norm</a>();
00283 <font class="keywordflow">if</font>(f==0)
00284 <a class="code" href="classNLMISC_1_1CQuatT.html#z312_2">identity</a>();
00285 <font class="keywordflow">else</font>
00286 {
00287 *<font class="keyword">this</font>/=f;
00288 }
00289 }
00290
00291
00292 <font class="comment">// ***************************************************************************</font>
00293 <font class="keyword">template</font> <<font class="keyword">class</font> T>
<a name="l00294"></a><a class="code" href="classNLMISC_1_1CQuatT.html#z315_3">00294</a> <font class="keyword">inline</font> <font class="keywordtype">void</font> CQuatT<T>::setAngleAxis(<font class="keyword">const</font> CVector &axis, <font class="keywordtype">float</font> angle)
00295 {
00296 CVector <a class="code" href="driver__opengl__extension__def_8h.html#a368">v</a>= axis;
00297 <a class="code" href="driver__opengl__extension__def_8h.html#a368">v</a>.normalize();
00298 <font class="keywordtype">double</font> ca= cos(angle/2);
00299 <font class="keywordtype">double</font> sa= sin(angle/2);
00300 <a class="code" href="classNLMISC_1_1CQuatT.html#m0">x</a>= (T)(<a class="code" href="driver__opengl__extension__def_8h.html#a368">v</a>.x*sa);
00301 <a class="code" href="classNLMISC_1_1CQuatT.html#m1">y</a>= (T)(<a class="code" href="driver__opengl__extension__def_8h.html#a368">v</a>.y*sa);
00302 <a class="code" href="classNLMISC_1_1CQuatT.html#m2">z</a>= (T)(<a class="code" href="driver__opengl__extension__def_8h.html#a368">v</a>.z*sa);
00303 <a class="code" href="classNLMISC_1_1CQuatT.html#m3">w</a>= (T)(ca);
00304 }
00305
00306
00307 <font class="comment">// ***************************************************************************</font>
00308 <font class="keyword">template</font> <<font class="keyword">class</font> T>
<a name="l00309"></a><a class="code" href="classNLMISC_1_1CQuatT.html#z317_0">00309</a> T CQuatT<T>::dotProduct(<font class="keyword">const</font> CQuatT<T> &q0, <font class="keyword">const</font> CQuatT<T> &q1)
00310 {
00311 <font class="keywordflow">return</font> q0.x*q1.x + q0.y*q1.y + q0.z*q1.z + q0.w*q1.w;
00312 }
00313
00314
00315 <font class="comment">// ***************************************************************************</font>
00316 <font class="keyword">template</font> <<font class="keyword">class</font> T>
<a name="l00317"></a><a class="code" href="classNLMISC_1_1CQuatT.html#z317_1">00317</a> CQuatT<T> CQuatT<T>::slerp(<font class="keyword">const</font> CQuatT<T>& q0, <font class="keyword">const</font> CQuatT<T>& q1, <font class="keywordtype">float</font> <a class="code" href="driver__opengl__extension__def_8h.html#a384">t</a>)
00318 {
00319 <font class="comment">// omega is the 4D angle between q0 and q1.</font>
00320 <font class="keywordtype">double</font> omega, cosom,sinom;
00321 T factq0= 1;
00322 T s0,s1;
00323
00324 cosom = CQuatT<T>::dotProduct(q0, q1);
00325
00326 <font class="comment">// Make q0 and q1 on the same hemisphere.</font>
00327 <font class="comment">/*if(cosom<0)</font>
00328 <font class="comment"> {</font>
00329 <font class="comment"> cosom= -cosom;</font>
00330 <font class="comment"> factq0= -1;</font>
00331 <font class="comment"> }*/</font>
00332 <font class="comment">// ????</font>
00333
00334 <font class="keywordflow">if</font> ( cosom < 1.0 - NLMISC::QuatEpsilon)
00335 {
00336 omega = acos(cosom);
00337 sinom = sin(omega);
00338 s0 = (T) (sin((1.0f - <a class="code" href="driver__opengl__extension__def_8h.html#a384">t</a>)*omega) / sinom);
00339 s1 = (T) (sin(<a class="code" href="driver__opengl__extension__def_8h.html#a384">t</a>*omega) / sinom);
00340 }
00341 <font class="keywordflow">else</font>
00342 { <font class="comment">// q0 and q1 are nearly the same => sinom nearly 0. We can't slerp.</font>
00343 <font class="comment">// just linear interpolate.</font>
00344 s0 = (T)(1.0 - <a class="code" href="driver__opengl__extension__def_8h.html#a384">t</a>);
00345 s1 = <a class="code" href="driver__opengl__extension__def_8h.html#a384">t</a>;
00346 }
00347
00348 <font class="keywordflow">return</font> q0*(factq0*s0) + q1*s1;
00349
00350 }
00351
00352
00353 <font class="comment">// ***************************************************************************</font>
00354 <font class="keyword">template</font> <<font class="keyword">class</font> T>
<a name="l00355"></a><a class="code" href="classNLMISC_1_1CQuatT.html#z317_2">00355</a> CQuatT<T> CQuatT<T>::squad(<font class="keyword">const</font> CQuatT<T>& q0, <font class="keyword">const</font> CQuatT<T>& tgtQ0, <font class="keyword">const</font> CQuatT<T>& tgtQ1, <font class="keyword">const</font> CQuatT<T>& q1, <font class="keywordtype">float</font> <a class="code" href="driver__opengl__extension__def_8h.html#a384">t</a>)
00356 {
00357 <font class="keywordflow">return</font> CQuatT<T>::slerp(
00358 CQuatT<T>::<a class="code" href="classNLMISC_1_1CQuatT.html#z317_1">slerp</a>(q0, q1, <a class="code" href="driver__opengl__extension__def_8h.html#a384">t</a>),
00359 CQuatT<T>::<a class="code" href="classNLMISC_1_1CQuatT.html#z317_1">slerp</a>(tgtQ0, tgtQ1, <a class="code" href="driver__opengl__extension__def_8h.html#a384">t</a>),
00360 2.f*(1.f-<a class="code" href="driver__opengl__extension__def_8h.html#a384">t</a>)*<a class="code" href="driver__opengl__extension__def_8h.html#a384">t</a>);
00361 }
00362
00363
00364 <font class="comment">// ***************************************************************************</font>
00365 <font class="keyword">template</font> <<font class="keyword">class</font> T>
<a name="l00366"></a><a class="code" href="classNLMISC_1_1CQuatT.html#z317_3">00366</a> CQuatT<T> CQuatT<T>::squadrev(<font class="keyword">const</font> CAngleAxis &rot, <font class="keyword">const</font> CQuatT<T>& q0, <font class="keyword">const</font> CQuatT<T>& tgtQ0, <font class="keyword">const</font> CQuatT<T>& tgtQ1, <font class="keyword">const</font> CQuatT<T>& q1, <font class="keywordtype">float</font> <a class="code" href="driver__opengl__extension__def_8h.html#a384">t</a>)
00367 {
00368 <font class="keywordtype">float</font> <a class="code" href="driver__opengl__extension__def_8h.html#a383">s</a>,<a class="code" href="driver__opengl__extension__def_8h.html#a368">v</a>;
00369 <font class="keywordtype">float</font> omega = rot.Angle* 0.5f;
00370 <font class="keywordtype">float</font> nrevs = 0.0f;
00371 CQuatT<T> ret,qaxis,pp,qq;
00372
00373 <font class="comment">// just one rev?</font>
00374 <font class="comment">//==============</font>
00375 <font class="keywordflow">if</font> (omega<<a class="code" href="namespaceNLMISC.html#a7">Pi</a>-<a class="code" href="namespaceNLMISC.html#a171">QuatEpsilon</a>)
00376 {
00377 ret = CQuatT<T>::squad(q0,tgtQ0,tgtQ1,q1,<a class="code" href="driver__opengl__extension__def_8h.html#a384">t</a>);
00378 <font class="keywordflow">return</font> ret;
00379 }
00380
00381
00382 <font class="comment">// multirev.</font>
00383 <font class="comment">//==============</font>
00384
00385 <font class="comment">// rotation of 180� around rot.Axis. (=> sin(a/2)==sin(Pi/2)==1, and c(a/2)=0).</font>
00386 qaxis.set(rot.Axis.x, rot.Axis.y, rot.Axis.z, 0);
00387
00388 <font class="comment">// the number of revisions (float!)</font>
00389 nrevs= (float)(omega/<a class="code" href="namespaceNLMISC.html#a7">Pi</a>);
00390 <font class="comment">// Angle>2Pi. squad from 0 to Pi, slerp from Pi to Angle-Pi, squad from Angle-Pi to Angle.</font>
00391 <a class="code" href="driver__opengl__extension__def_8h.html#a383">s</a> = <a class="code" href="driver__opengl__extension__def_8h.html#a384">t</a>*2*nrevs;
00392
00393
00394 <font class="comment">// So for s, squad from 0 to 1, slerp from 1 to 2*nrevs-1, squad from 2*nrevs-1 to 2*nrevs.</font>
00395 <font class="keywordflow">if</font> (<a class="code" href="driver__opengl__extension__def_8h.html#a383">s</a> < 1.0f)
00396 {
00397 <font class="comment">// first part.</font>
00398 pp = q0*qaxis;
00399 ret = CQuatT<T>::squad(q0,tgtQ0,pp,pp,<a class="code" href="driver__opengl__extension__def_8h.html#a383">s</a>);
00400 }
00401 <font class="keywordflow">else</font>
00402 {
00403 <a class="code" href="driver__opengl__extension__def_8h.html#a368">v</a> = <a class="code" href="driver__opengl__extension__def_8h.html#a383">s</a> - (2.0f*nrevs - 1.0f);
00404 <font class="keywordflow">if</font>( <a class="code" href="driver__opengl__extension__def_8h.html#a368">v</a> <= 0.0f)
00405 {
00406 <font class="comment">// middle part</font>
00407 <font class="keywordflow">while</font> (<a class="code" href="driver__opengl__extension__def_8h.html#a383">s</a> >= 2.0f) <a class="code" href="driver__opengl__extension__def_8h.html#a383">s</a> -= 2.0f;
00408 pp = q0*qaxis;
00409 <font class="comment">// s vary from 1 to 2. This is still correct for slerp().</font>
00410 ret = CQuatT<T>::slerp(q0,pp,<a class="code" href="driver__opengl__extension__def_8h.html#a383">s</a>);
00411 }
00412 <font class="keywordflow">else</font>
00413 {
00414 <font class="comment">// Last part.</font>
00415 qq = - q1*qaxis;
00416 ret= CQuatT<T>::squad(qq,qq,tgtQ1,q1,<a class="code" href="driver__opengl__extension__def_8h.html#a368">v</a>);
00417 }
00418 }
00419
00420 <font class="keywordflow">return</font> ret;
00421 }
00422
00423
00424
00425 <font class="comment">// ***************************************************************************</font>
00426 <font class="keyword">template</font> <<font class="keyword">class</font> T>
<a name="l00427"></a><a class="code" href="classNLMISC_1_1CQuatT.html#z316_0">00427</a> CQuatT<T> CQuatT<T>::log()
00428 {
00429 <font class="keywordtype">double</font> len;
00430 len = sqrt (<a class="code" href="classNLMISC_1_1CQuatT.html#m0">x</a>*<a class="code" href="classNLMISC_1_1CQuatT.html#m0">x</a> + <a class="code" href="classNLMISC_1_1CQuatT.html#m1">y</a>*<a class="code" href="classNLMISC_1_1CQuatT.html#m1">y</a> + <a class="code" href="classNLMISC_1_1CQuatT.html#m2">z</a>*<a class="code" href="classNLMISC_1_1CQuatT.html#m2">z</a>);
00431
00432 <font class="keywordflow">if</font> (len < <a class="code" href="namespaceNLMISC.html#a171">QuatEpsilon</a>)
00433 <font class="keywordflow">return</font> CQuatT<T>(0.f, 0.f, 0.f, 0.f);
00434 <font class="keywordflow">else</font>
00435 {
00436 <font class="keywordtype">double</font> div = (float) acos (<a class="code" href="classNLMISC_1_1CQuatT.html#m3">w</a>) / len;
00437 <font class="keywordflow">return</font> CQuatT<T>( (T)(<a class="code" href="classNLMISC_1_1CQuatT.html#m0">x</a>*div), (T)(<a class="code" href="classNLMISC_1_1CQuatT.html#m1">y</a>*div), (T)(<a class="code" href="classNLMISC_1_1CQuatT.html#m2">z</a>*div), 0.f);
00438 }
00439
00440 }
00441
00442
00443 <font class="comment">// ***************************************************************************</font>
00444 <font class="keyword">template</font> <<font class="keyword">class</font> T>
<a name="l00445"></a><a class="code" href="classNLMISC_1_1CQuatT.html#z316_1">00445</a> CQuatT<T> CQuatT<T>::exp()
00446 {
00447 <font class="keywordtype">double</font> len;
00448 len = sqrt (<a class="code" href="classNLMISC_1_1CQuatT.html#m0">x</a>*<a class="code" href="classNLMISC_1_1CQuatT.html#m0">x</a> + <a class="code" href="classNLMISC_1_1CQuatT.html#m1">y</a>*<a class="code" href="classNLMISC_1_1CQuatT.html#m1">y</a> + <a class="code" href="classNLMISC_1_1CQuatT.html#m2">z</a>*<a class="code" href="classNLMISC_1_1CQuatT.html#m2">z</a>);
00449
00450 <font class="keywordflow">if</font> (len < <a class="code" href="namespaceNLMISC.html#a171">QuatEpsilon</a>)
00451 <font class="keywordflow">return</font> CQuatT<T>(0.f, 0.f, 0.f, 1.f);
00452 <font class="keywordflow">else</font>
00453 {
00454 <font class="keywordtype">double</font> len1 = sin(len) / len;
00455 <font class="keywordflow">return</font> CQuatT<T>( (T)(<a class="code" href="classNLMISC_1_1CQuatT.html#m0">x</a>*len1), (T)(<a class="code" href="classNLMISC_1_1CQuatT.html#m1">y</a>*len1), (T)(<a class="code" href="classNLMISC_1_1CQuatT.html#m2">z</a>*len1), (T)cos(len));
00456 }
00457 }
00458
00459
00460 <font class="comment">// ***************************************************************************</font>
00461 <font class="keyword">template</font> <<font class="keyword">class</font> T>
<a name="l00462"></a><a class="code" href="classNLMISC_1_1CQuatT.html#z317_4">00462</a> CQuatT<T> CQuatT<T>::lnDif(<font class="keyword">const</font> CQuatT<T> &q0, <font class="keyword">const</font> CQuatT<T> &q1)
00463 {
00464 CQuatT<T> dif = q0.inverted()*q1;
00465 dif.normalize();
00466
00467 <font class="keywordflow">return</font> dif.log();
00468 }
00469
00470
00471 <font class="comment">// ***************************************************************************</font>
00472 <font class="keyword">template</font> <<font class="keyword">class</font> T>
<a name="l00473"></a><a class="code" href="classNLMISC_1_1CQuatT.html#z316_2">00473</a> <font class="keywordtype">void</font> CQuatT<T>::makeClosest(<font class="keyword">const</font> CQuatT<T> &o)
00474 {
00475 <font class="keywordflow">if</font>( <a class="code" href="classNLMISC_1_1CQuatT.html#z317_0">dotProduct</a>(*<font class="keyword">this</font>, o) < 0 )
00476 *<font class="keyword">this</font>= -(*this);
00477 }
00478
00479
00480
00481 <font class="comment">// ***************************************************************************</font>
00482 <font class="comment">// ***************************************************************************</font>
00483 <font class="comment">// CQuat/CQuatD</font>
00484 <font class="comment">// ***************************************************************************</font>
00485 <font class="comment">// ***************************************************************************</font>
00486
00487
00488
00489 <font class="comment">// ***************************************************************************</font>
<a name="l00496"></a><a class="code" href="classNLMISC_1_1CQuat.html">00496</a> <font class="comment"></font><font class="keyword">class </font>CQuat : <font class="keyword">public</font> CQuatT<float>
00497 {
00498 <font class="keyword">public</font>:
00499 <font class="keyword">static</font> <font class="keyword">const</font> <a class="code" href="classNLMISC_1_1CQuat.html#z318_1">CQuat</a> <a class="code" href="classNLMISC_1_1CQuat.html#p0">Identity</a>;
00500
00502 <font class="comment">// @{</font>
<a name="l00503"></a><a class="code" href="classNLMISC_1_1CQuat.html#z318_0">00503</a> <a class="code" href="classNLMISC_1_1CQuat.html#z318_1">CQuat</a> &<a class="code" href="classNLMISC_1_1CQuat.html#z318_0">operator=</a>(<font class="keyword">const</font> CQuatT<float> &o) {<a class="code" href="classNLMISC_1_1CQuatT.html#m0">x</a>=o.x; <a class="code" href="classNLMISC_1_1CQuatT.html#m1">y</a>=o.y; <a class="code" href="classNLMISC_1_1CQuatT.html#m2">z</a>=o.z; <a class="code" href="classNLMISC_1_1CQuatT.html#m3">w</a>=o.w; <font class="keywordflow">return</font> *<font class="keyword">this</font>;}
<a name="l00504"></a><a class="code" href="classNLMISC_1_1CQuat.html#z318_1">00504</a> <a class="code" href="classNLMISC_1_1CQuat.html#z318_2">CQuat</a>(<font class="keyword">const</font> CQuatT<float> &o) : <a class="code" href="classNLMISC_1_1CQuatT.html#z310_0">CQuatT</a><float>(o) {}
<a name="l00505"></a><a class="code" href="classNLMISC_1_1CQuat.html#z318_2">00505</a> <a class="code" href="classNLMISC_1_1CQuat.html#z318_2">CQuat</a>() {}
<a name="l00506"></a><a class="code" href="classNLMISC_1_1CQuat.html#z318_3">00506</a> <a class="code" href="classNLMISC_1_1CQuat.html#z318_2">CQuat</a>(<font class="keywordtype">float</font> X, <font class="keywordtype">float</font> Y, <font class="keywordtype">float</font> Z, <font class="keywordtype">float</font> W) : <a class="code" href="classNLMISC_1_1CQuatT.html#z310_0">CQuatT</a><float>(X,Y,Z,W) {}
<a name="l00508"></a><a class="code" href="classNLMISC_1_1CQuat.html#z318_4">00508</a> <a class="code" href="classNLMISC_1_1CQuat.html#z318_2">CQuat</a>(<font class="keyword">const</font> CVector &axis, <font class="keywordtype">float</font> angle) : <a class="code" href="classNLMISC_1_1CQuatT.html#z310_0">CQuatT</a><float>(axis, angle) {}
<a name="l00510"></a><a class="code" href="classNLMISC_1_1CQuat.html#z318_5">00510</a> <a class="code" href="classNLMISC_1_1CQuat.html#z318_2">CQuat</a>(<font class="keyword">const</font> CAngleAxis &aa) : <a class="code" href="classNLMISC_1_1CQuatT.html#z310_0">CQuatT</a><float>(aa) {}
00511 <font class="comment">// @}</font>
00512
00513 };
00514
00515
00516 <font class="comment">// ***************************************************************************</font>
<a name="l00523"></a><a class="code" href="classNLMISC_1_1CQuatD.html">00523</a> <font class="comment"></font><font class="keyword">class </font>CQuatD : <font class="keyword">public</font> CQuatT<double>
00524 {
00525 <font class="keyword">public</font>:
00526 <font class="keyword">static</font> <font class="keyword">const</font> <a class="code" href="classNLMISC_1_1CQuatD.html#z319_1">CQuatD</a> <a class="code" href="classNLMISC_1_1CQuatD.html#p0">Identity</a>;
00527
00529 <font class="comment">// @{</font>
<a name="l00530"></a><a class="code" href="classNLMISC_1_1CQuatD.html#z319_0">00530</a> <a class="code" href="classNLMISC_1_1CQuatD.html#z319_1">CQuatD</a> &<a class="code" href="classNLMISC_1_1CQuatD.html#z319_0">operator=</a>(<font class="keyword">const</font> CQuatT<double> &o) {<a class="code" href="classNLMISC_1_1CQuatT.html#m0">x</a>=o.x; <a class="code" href="classNLMISC_1_1CQuatT.html#m1">y</a>=o.y; <a class="code" href="classNLMISC_1_1CQuatT.html#m2">z</a>=o.z; <a class="code" href="classNLMISC_1_1CQuatT.html#m3">w</a>=o.w; <font class="keywordflow">return</font> *<font class="keyword">this</font>;}
<a name="l00531"></a><a class="code" href="classNLMISC_1_1CQuatD.html#z319_1">00531</a> <a class="code" href="classNLMISC_1_1CQuatD.html#z319_2">CQuatD</a>(<font class="keyword">const</font> CQuatT<double> &o) : <a class="code" href="classNLMISC_1_1CQuatT.html#z310_0">CQuatT</a><double>(o) {}
<a name="l00532"></a><a class="code" href="classNLMISC_1_1CQuatD.html#z319_2">00532</a> <a class="code" href="classNLMISC_1_1CQuatD.html#z319_2">CQuatD</a>() {}
<a name="l00533"></a><a class="code" href="classNLMISC_1_1CQuatD.html#z319_3">00533</a> <a class="code" href="classNLMISC_1_1CQuatD.html#z319_2">CQuatD</a>(<font class="keywordtype">double</font> X, <font class="keywordtype">double</font> Y, <font class="keywordtype">double</font> Z, <font class="keywordtype">double</font> W) : <a class="code" href="classNLMISC_1_1CQuatT.html#z310_0">CQuatT</a><double>(X,Y,Z,W) {}
<a name="l00535"></a><a class="code" href="classNLMISC_1_1CQuatD.html#z319_4">00535</a> <a class="code" href="classNLMISC_1_1CQuatD.html#z319_2">CQuatD</a>(<font class="keyword">const</font> CVector &axis, <font class="keywordtype">float</font> angle) : <a class="code" href="classNLMISC_1_1CQuatT.html#z310_0">CQuatT</a><double>(axis, angle) {}
<a name="l00537"></a><a class="code" href="classNLMISC_1_1CQuatD.html#z319_5">00537</a> <a class="code" href="classNLMISC_1_1CQuatD.html#z319_2">CQuatD</a>(<font class="keyword">const</font> CAngleAxis &aa) : <a class="code" href="classNLMISC_1_1CQuatT.html#z310_0">CQuatT</a><double>(aa) {}
00538 <font class="comment">// @}</font>
00539
00540
00542 <font class="comment">// @{</font>
<a name="l00543"></a><a class="code" href="classNLMISC_1_1CQuatD.html#z320_0">00543</a> <a class="code" href="classNLMISC_1_1CQuatD.html#z319_2">CQuatD</a>(<font class="keyword">const</font> CQuat &o) {<a class="code" href="classNLMISC_1_1CQuatT.html#m0">x</a>=o.x; <a class="code" href="classNLMISC_1_1CQuatT.html#m1">y</a>=o.y; <a class="code" href="classNLMISC_1_1CQuatT.html#m2">z</a>=o.z; <a class="code" href="classNLMISC_1_1CQuatT.html#m3">w</a>=o.w;}
<a name="l00544"></a><a class="code" href="classNLMISC_1_1CQuatD.html#z320_1">00544</a> <a class="code" href="classNLMISC_1_1CQuatD.html#z319_1">CQuatD</a> &<a class="code" href="classNLMISC_1_1CQuatD.html#z319_0">operator=</a>(<font class="keyword">const</font> CQuatT<float> &o) {<a class="code" href="classNLMISC_1_1CQuatT.html#m0">x</a>=o.x; <a class="code" href="classNLMISC_1_1CQuatT.html#m1">y</a>=o.y; <a class="code" href="classNLMISC_1_1CQuatT.html#m2">z</a>=o.z; <a class="code" href="classNLMISC_1_1CQuatT.html#m3">w</a>=o.w; <font class="keywordflow">return</font> *<font class="keyword">this</font>;}
<a name="l00545"></a><a class="code" href="classNLMISC_1_1CQuatD.html#z320_2">00545</a> operator CQuat()<font class="keyword"> const </font>{<font class="keywordflow">return</font> CQuat((<font class="keywordtype">float</font>)<a class="code" href="classNLMISC_1_1CQuatT.html#m0">x</a>, (<font class="keywordtype">float</font>)<a class="code" href="classNLMISC_1_1CQuatT.html#m1">y</a>, (<font class="keywordtype">float</font>)<a class="code" href="classNLMISC_1_1CQuatT.html#m2">z</a>, (<font class="keywordtype">float</font>)<a class="code" href="classNLMISC_1_1CQuatT.html#m3">w</a>);}
00546 <font class="comment">// @}</font>
00547
00548 };
00549
00550
00551
00552
00553
00554 } <font class="comment">// NLMISC</font>
00555
00556 <font class="preprocessor">#endif // NL_QUAT_H </font>
00557 <font class="preprocessor"></font>
</pre></div>
<!-- footer -->
<BR><FONT Size=+5> </FONT>
</TD>
<TD WIDTH=15><IMG SRC=http://www.nevrax.org/inc/img/pixel.gif WIDTH=15 HEIGHT=15 BORDER=0 ALT=""></TD>
</TR>
</TABLE>
</BODY>
</HTML>