Эхлэл Бүгдийг харах Тусламж
Нэвтрэх
cpp
/
JoltPhysics
-ын хуулбар https://github.com/jrouwe/JoltPhysics.git
2
0
Салаа 0
Файлууд Асуудлууд 0 Мэдлэгийн сан
Салаа: gh-pages
Салаанууд Тагууд
JoltPhysics
/
_rotation_euler_constraint_part_8h_source.html

_rotation_euler_constraint_part_8h_source.html 70 KB
Байнгын холболт Түүх Анхны өгөгдөл

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433 
  1. <!DOCTYPE html PUBLIC "-//W3C//DTD XHTML 1.0 Transitional//EN" "https://www.w3.org/TR/xhtml1/DTD/xhtml1-transitional.dtd">
    2. 

  2. <html xmlns="http://www.w3.org/1999/xhtml" lang="en-US">
    3. 

  3. <head>
    4. 

  4. <meta http-equiv="Content-Type" content="text/xhtml;charset=UTF-8"/>
    5. 

  5. <meta http-equiv="X-UA-Compatible" content="IE=11"/>
    6. 

  6. <meta name="generator" content="Doxygen 1.12.0"/>
    7. 

  7. <meta name="viewport" content="width=device-width, initial-scale=1"/>
    8. 

  8. <title>Jolt Physics: Jolt/Physics/Constraints/ConstraintPart/RotationEulerConstraintPart.h Source File</title>
    9. 

  9. <link href="tabs.css" rel="stylesheet" type="text/css"/>
    10. 

  10. <script type="text/javascript" src="jquery.js"></script>
    11. 

  11. <script type="text/javascript" src="dynsections.js"></script>
    12. 

  12. <script type="text/javascript" src="clipboard.js"></script>
    13. 

  13. <link href="navtree.css" rel="stylesheet" type="text/css"/>
    14. 

  14. <script type="text/javascript" src="navtreedata.js"></script>
    15. 

  15. <script type="text/javascript" src="navtree.js"></script>
    16. 

  16. <script type="text/javascript" src="resize.js"></script>
    17. 

  17. <script type="text/javascript" src="cookie.js"></script>
    18. 

  18. <link href="search/search.css" rel="stylesheet" type="text/css"/>
    19. 

  19. <script type="text/javascript" src="search/searchdata.js"></script>
    20. 

  20. <script type="text/javascript" src="search/search.js"></script>
    21. 

  21. <script type="text/x-mathjax-config">
    22. 

  22. MathJax.Hub.Config({
    23. 

  23.   extensions: ["tex2jax.js"],
    24. 

  24.   jax: ["input/TeX","output/HTML-CSS"],
    25. 

  25. });
    26. 

  26. </script>
    27. 

  27. <script type="text/javascript" async="async" src="https://cdnjs.cloudflare.com/ajax/libs/mathjax/2.7.5/MathJax.js"></script>
    28. 

  28. <link href="doxygen.css" rel="stylesheet" type="text/css" />
    29. 

  29. </head>
    30. 

  30. <body>
    31. 

  31. <div id="top"><!-- do not remove this div, it is closed by doxygen! -->
    32. 

  32. <div id="titlearea">
    33. 

  33. <table cellspacing="0" cellpadding="0">
    34. 

  34.  <tbody>
    35. 

  35.  <tr id="projectrow">
    36. 

  36.   <td id="projectlogo"><img alt="Logo" src="LogoSmall.png"/></td>
    37. 

  37.   <td id="projectalign">
    38. 

  38.    <div id="projectname">Jolt Physics
    39. 

  39.    </div>
    40. 

  40.    <div id="projectbrief">A multi core friendly Game Physics Engine</div>
    41. 

  41.   </td>
    42. 

  42.  </tr>
    43. 

  43.  </tbody>
    44. 

  44. </table>
    45. 

  45. </div>
    46. 

  46. <!-- end header part -->
    47. 

  47. <!-- Generated by Doxygen 1.12.0 -->
    48. 

  48. <script type="text/javascript">
    49. 

  49. /* @license magnet:?xt=urn:btih:d3d9a9a6595521f9666a5e94cc830dab83b65699&amp;dn=expat.txt MIT */
    50. 

  50. var searchBox = new SearchBox("searchBox", "search/",'.html');
    51. 

  51. /* @license-end */
    52. 

  52. </script>
    53. 

  53. <script type="text/javascript">
    54. 

  54. /* @license magnet:?xt=urn:btih:d3d9a9a6595521f9666a5e94cc830dab83b65699&amp;dn=expat.txt MIT */
    55. 

  55. $(function() { codefold.init(0); });
    56. 

  56. /* @license-end */
    57. 

  57. </script>
    58. 

  58. <script type="text/javascript" src="menudata.js"></script>
    59. 

  59. <script type="text/javascript" src="menu.js"></script>
    60. 

  60. <script type="text/javascript">
    61. 

  61. /* @license magnet:?xt=urn:btih:d3d9a9a6595521f9666a5e94cc830dab83b65699&amp;dn=expat.txt MIT */
    62. 

  62. $(function() {
    63. 

  63.   initMenu('',true,false,'search.php','Search',true);
    64. 

  64.   $(function() { init_search(); });
    65. 

  65. });
    66. 

  66. /* @license-end */
    67. 

  67. </script>
    68. 

  68. <div id="main-nav"></div>
    69. 

  69. </div><!-- top -->
    70. 

  70. <div id="side-nav" class="ui-resizable side-nav-resizable">
    71. 

  71.   <div id="nav-tree">
    72. 

  72.     <div id="nav-tree-contents">
    73. 

  73.       <div id="nav-sync" class="sync"></div>
    74. 

  74.     </div>
    75. 

  75.   </div>
    76. 

  76.   <div id="splitbar" style="-moz-user-select:none;" 
    77. 

  77.        class="ui-resizable-handle">
    78. 

  78.   </div>
    79. 

  79. </div>
    80. 

  80. <script type="text/javascript">
    81. 

  81. /* @license magnet:?xt=urn:btih:d3d9a9a6595521f9666a5e94cc830dab83b65699&amp;dn=expat.txt MIT */
    82. 

  82. $(function(){initNavTree('_rotation_euler_constraint_part_8h_source.html',''); initResizable(true); });
    83. 

  83. /* @license-end */
    84. 

  84. </script>
    85. 

  85. <div id="doc-content">
    86. 

  86. <!-- window showing the filter options -->
    87. 

  87. <div id="MSearchSelectWindow"
    88. 

  88.      onmouseover="return searchBox.OnSearchSelectShow()"
    89. 

  89.      onmouseout="return searchBox.OnSearchSelectHide()"
    90. 

  90.      onkeydown="return searchBox.OnSearchSelectKey(event)">
    91. 

  91. </div>
    92. 

  92. 

  93. <!-- iframe showing the search results (closed by default) -->
    94. 

  94. <div id="MSearchResultsWindow">
    95. 

  95. <div id="MSearchResults">
    96. 

  96. <div class="SRPage">
    97. 

  97. <div id="SRIndex">
    98. 

  98. <div id="SRResults"></div>
    99. 

  99. <div class="SRStatus" id="Loading">Loading...</div>
    100. 

  100. <div class="SRStatus" id="Searching">Searching...</div>
    101. 

  101. <div class="SRStatus" id="NoMatches">No Matches</div>
    102. 

  102. </div>
    103. 

  103. </div>
    104. 

  104. </div>
    105. 

  105. </div>
    106. 

  106. 

  107. <div class="header">
    108. 

  108.   <div class="headertitle"><div class="title">RotationEulerConstraintPart.h</div></div>
    109. 

  109. </div><!--header-->
    110. 

  110. <div class="contents">
    111. 

  111. <a href="_rotation_euler_constraint_part_8h.html">Go to the documentation of this file.</a><div class="fragment"><div class="line"><a id="l00001" name="l00001"></a><span class="lineno">    1</span><span class="comment">// Jolt Physics Library (https://github.com/jrouwe/JoltPhysics)</span></div>
    112. 

  112. <div class="line"><a id="l00002" name="l00002"></a><span class="lineno">    2</span><span class="comment">// SPDX-FileCopyrightText: 2021 Jorrit Rouwe</span></div>
    113. 

  113. <div class="line"><a id="l00003" name="l00003"></a><span class="lineno">    3</span><span class="comment">// SPDX-License-Identifier: MIT</span></div>
    114. 

  114. <div class="line"><a id="l00004" name="l00004"></a><span class="lineno">    4</span> </div>
    115. 

  115. <div class="line"><a id="l00005" name="l00005"></a><span class="lineno">    5</span><span class="preprocessor">#pragma once</span></div>
    116. 

  116. <div class="line"><a id="l00006" name="l00006"></a><span class="lineno">    6</span> </div>
    117. 

  117. <div class="line"><a id="l00007" name="l00007"></a><span class="lineno">    7</span><span class="preprocessor">#include &lt;<a class="code" href="_body_8h.html">Jolt/Physics/Body/Body.h</a>&gt;</span></div>
    118. 

  118. <div class="line"><a id="l00008" name="l00008"></a><span class="lineno">    8</span><span class="preprocessor">#include &lt;<a class="code" href="_state_recorder_8h.html">Jolt/Physics/StateRecorder.h</a>&gt;</span></div>
    119. 

  119. <div class="line"><a id="l00009" name="l00009"></a><span class="lineno">    9</span> </div>
    120. 

  120. <div class="line"><a id="l00010" name="l00010"></a><span class="lineno">   10</span><a class="code hl_define" href="_core_8h.html#ad14098b68b8c44ea6112601031268405">JPH_NAMESPACE_BEGIN</a></div>
    121. 

  121. <div class="line"><a id="l00011" name="l00011"></a><span class="lineno">   11</span> </div>
    122. 

  122. <div class="foldopen" id="foldopen00035" data-start="{" data-end="};">
    123. 

  123. <div class="line"><a id="l00035" name="l00035"></a><span class="lineno"><a class="line" href="class_rotation_euler_constraint_part.html">   35</a></span><span class="keyword">class </span><a class="code hl_class" href="class_rotation_euler_constraint_part.html">RotationEulerConstraintPart</a></div>
    124. 

  124. <div class="line"><a id="l00036" name="l00036"></a><span class="lineno">   36</span>{</div>
    125. 

  125. <div class="line"><a id="l00037" name="l00037"></a><span class="lineno">   37</span><span class="keyword">private</span>:</div>
    126. 

  126. <div class="line"><a id="l00039" name="l00039"></a><span class="lineno">   39</span>    JPH_INLINE <span class="keywordtype">bool</span>             ApplyVelocityStep(<a class="code hl_class" href="class_body.html">Body</a> &amp;ioBody1, <a class="code hl_class" href="class_body.html">Body</a> &amp;ioBody2, <a class="code hl_class" href="class_vec3.html">Vec3Arg</a> inLambda)<span class="keyword"> const</span></div>
    127. 

  127. <div class="line"><a id="l00040" name="l00040"></a><span class="lineno">   40</span><span class="keyword">    </span>{</div>
    128. 

  128. <div class="line"><a id="l00041" name="l00041"></a><span class="lineno">   41</span>        <span class="comment">// Apply impulse if delta is not zero</span></div>
    129. 

  129. <div class="line"><a id="l00042" name="l00042"></a><span class="lineno">   42</span>        <span class="keywordflow">if</span> (inLambda != <a class="code hl_function" href="class_vec3.html#ad03c52ab27761bc1e64e33c47632ba51">Vec3::sZero</a>())</div>
    130. 

  130. <div class="line"><a id="l00043" name="l00043"></a><span class="lineno">   43</span>        {</div>
    131. 

  131. <div class="line"><a id="l00044" name="l00044"></a><span class="lineno">   44</span>            <span class="comment">// Calculate velocity change due to constraint</span></div>
    132. 

  132. <div class="line"><a id="l00045" name="l00045"></a><span class="lineno">   45</span>            <span class="comment">//</span></div>
    133. 

  133. <div class="line"><a id="l00046" name="l00046"></a><span class="lineno">   46</span>            <span class="comment">// Impulse:</span></div>
    134. 

  134. <div class="line"><a id="l00047" name="l00047"></a><span class="lineno">   47</span>            <span class="comment">// P = J^T lambda</span></div>
    135. 

  135. <div class="line"><a id="l00048" name="l00048"></a><span class="lineno">   48</span>            <span class="comment">//</span></div>
    136. 

  136. <div class="line"><a id="l00049" name="l00049"></a><span class="lineno">   49</span>            <span class="comment">// Euler velocity integration:</span></div>
    137. 

  137. <div class="line"><a id="l00050" name="l00050"></a><span class="lineno">   50</span>            <span class="comment">// v&#39; = v + M^-1 P</span></div>
    138. 

  138. <div class="line"><a id="l00051" name="l00051"></a><span class="lineno">   51</span>            <span class="keywordflow">if</span> (ioBody1.<a class="code hl_function" href="class_body.html#a1b21c30907c8c9ce30c176a054057bef">IsDynamic</a>())</div>
    139. 

  139. <div class="line"><a id="l00052" name="l00052"></a><span class="lineno">   52</span>                ioBody1.<a class="code hl_function" href="class_body.html#a0d39987255227c4221fcea66cb1fc041">GetMotionProperties</a>()-&gt;<a class="code hl_function" href="class_motion_properties.html#a98672fc0c6884643944e570e1d78ac07">SubAngularVelocityStep</a>(mInvI1.<a class="code hl_function" href="class_mat44.html#ab599aaeab3e4b832f7f4097816650b14">Multiply3x3</a>(inLambda));</div>
    140. 

  140. <div class="line"><a id="l00053" name="l00053"></a><span class="lineno">   53</span>            <span class="keywordflow">if</span> (ioBody2.<a class="code hl_function" href="class_body.html#a1b21c30907c8c9ce30c176a054057bef">IsDynamic</a>())</div>
    141. 

  141. <div class="line"><a id="l00054" name="l00054"></a><span class="lineno">   54</span>                ioBody2.<a class="code hl_function" href="class_body.html#a0d39987255227c4221fcea66cb1fc041">GetMotionProperties</a>()-&gt;<a class="code hl_function" href="class_motion_properties.html#afb12aa823a651145b46b271570a7af59">AddAngularVelocityStep</a>(mInvI2.<a class="code hl_function" href="class_mat44.html#ab599aaeab3e4b832f7f4097816650b14">Multiply3x3</a>(inLambda));</div>
    142. 

  142. <div class="line"><a id="l00055" name="l00055"></a><span class="lineno">   55</span>            <span class="keywordflow">return</span> <span class="keyword">true</span>;</div>
    143. 

  143. <div class="line"><a id="l00056" name="l00056"></a><span class="lineno">   56</span>        }</div>
    144. 

  144. <div class="line"><a id="l00057" name="l00057"></a><span class="lineno">   57</span> </div>
    145. 

  145. <div class="line"><a id="l00058" name="l00058"></a><span class="lineno">   58</span>        <span class="keywordflow">return</span> <span class="keyword">false</span>;</div>
    146. 

  146. <div class="line"><a id="l00059" name="l00059"></a><span class="lineno">   59</span>    }</div>
    147. 

  147. <div class="line"><a id="l00060" name="l00060"></a><span class="lineno">   60</span> </div>
    148. 

  148. <div class="line"><a id="l00061" name="l00061"></a><span class="lineno">   61</span><span class="keyword">public</span>:</div>
    149. 

  149. <div class="foldopen" id="foldopen00063" data-start="{" data-end="}">
    150. 

  150. <div class="line"><a id="l00063" name="l00063"></a><span class="lineno"><a class="line" href="class_rotation_euler_constraint_part.html#a40c10735335691be99e7911139dc2884">   63</a></span>    <span class="keyword">static</span> <a class="code hl_class" href="class_quat.html">Quat</a>                 <a class="code hl_function" href="class_rotation_euler_constraint_part.html#a40c10735335691be99e7911139dc2884">sGetInvInitialOrientation</a>(<span class="keyword">const</span> <a class="code hl_class" href="class_body.html">Body</a> &amp;inBody1, <span class="keyword">const</span> <a class="code hl_class" href="class_body.html">Body</a> &amp;inBody2)</div>
    151. 

  151. <div class="line"><a id="l00064" name="l00064"></a><span class="lineno">   64</span>    {</div>
    152. 

  152. <div class="line"><a id="l00065" name="l00065"></a><span class="lineno">   65</span>        <span class="comment">// q20 = q10 r0</span></div>
    153. 

  153. <div class="line"><a id="l00066" name="l00066"></a><span class="lineno">   66</span>        <span class="comment">// &lt;=&gt; r0 = q10^-1 q20</span></div>
    154. 

  154. <div class="line"><a id="l00067" name="l00067"></a><span class="lineno">   67</span>        <span class="comment">// &lt;=&gt; r0^-1 = q20^-1 q10</span></div>
    155. 

  155. <div class="line"><a id="l00068" name="l00068"></a><span class="lineno">   68</span>        <span class="comment">//</span></div>
    156. 

  156. <div class="line"><a id="l00069" name="l00069"></a><span class="lineno">   69</span>        <span class="comment">// where:</span></div>
    157. 

  157. <div class="line"><a id="l00070" name="l00070"></a><span class="lineno">   70</span>        <span class="comment">//</span></div>
    158. 

  158. <div class="line"><a id="l00071" name="l00071"></a><span class="lineno">   71</span>        <span class="comment">// q20 = initial orientation of body 2</span></div>
    159. 

  159. <div class="line"><a id="l00072" name="l00072"></a><span class="lineno">   72</span>        <span class="comment">// q10 = initial orientation of body 1</span></div>
    160. 

  160. <div class="line"><a id="l00073" name="l00073"></a><span class="lineno">   73</span>        <span class="comment">// r0 = initial rotation from body 1 to body 2</span></div>
    161. 

  161. <div class="line"><a id="l00074" name="l00074"></a><span class="lineno">   74</span>        <span class="keywordflow">return</span> inBody2.<a class="code hl_function" href="class_body.html#aaee24bfb5e32e756f50113b9d1f45a2c">GetRotation</a>().<a class="code hl_function" href="class_quat.html#ac69dfd8cdf79a19b8c3f385125ff5ddc">Conjugated</a>() * inBody1.<a class="code hl_function" href="class_body.html#aaee24bfb5e32e756f50113b9d1f45a2c">GetRotation</a>();</div>
    162. 

  162. <div class="line"><a id="l00075" name="l00075"></a><span class="lineno">   75</span>    }</div>
    163. 

  163. </div>
    164. 

  164. <div class="line"><a id="l00076" name="l00076"></a><span class="lineno">   76</span> </div>
    165. 

  165. <div class="foldopen" id="foldopen00082" data-start="{" data-end="}">
    166. 

  166. <div class="line"><a id="l00082" name="l00082"></a><span class="lineno"><a class="line" href="class_rotation_euler_constraint_part.html#a6757c3b96eff4a145d9228fb1679222d">   82</a></span>    <span class="keyword">static</span> <a class="code hl_class" href="class_quat.html">Quat</a>                 <a class="code hl_function" href="class_rotation_euler_constraint_part.html#a6757c3b96eff4a145d9228fb1679222d">sGetInvInitialOrientationXY</a>(<a class="code hl_class" href="class_vec3.html">Vec3Arg</a> inAxisX1, <a class="code hl_class" href="class_vec3.html">Vec3Arg</a> inAxisY1, <a class="code hl_class" href="class_vec3.html">Vec3Arg</a> inAxisX2, <a class="code hl_class" href="class_vec3.html">Vec3Arg</a> inAxisY2)</div>
    167. 

  167. <div class="line"><a id="l00083" name="l00083"></a><span class="lineno">   83</span>    {</div>
    168. 

  168. <div class="line"><a id="l00084" name="l00084"></a><span class="lineno">   84</span>        <span class="comment">// Store inverse of initial rotation from body 1 to body 2 in body 1 space:</span></div>
    169. 

  169. <div class="line"><a id="l00085" name="l00085"></a><span class="lineno">   85</span>        <span class="comment">//</span></div>
    170. 

  170. <div class="line"><a id="l00086" name="l00086"></a><span class="lineno">   86</span>        <span class="comment">// q20 = q10 r0</span></div>
    171. 

  171. <div class="line"><a id="l00087" name="l00087"></a><span class="lineno">   87</span>        <span class="comment">// &lt;=&gt; r0 = q10^-1 q20</span></div>
    172. 

  172. <div class="line"><a id="l00088" name="l00088"></a><span class="lineno">   88</span>        <span class="comment">// &lt;=&gt; r0^-1 = q20^-1 q10</span></div>
    173. 

  173. <div class="line"><a id="l00089" name="l00089"></a><span class="lineno">   89</span>        <span class="comment">//</span></div>
    174. 

  174. <div class="line"><a id="l00090" name="l00090"></a><span class="lineno">   90</span>        <span class="comment">// where:</span></div>
    175. 

  175. <div class="line"><a id="l00091" name="l00091"></a><span class="lineno">   91</span>        <span class="comment">//</span></div>
    176. 

  176. <div class="line"><a id="l00092" name="l00092"></a><span class="lineno">   92</span>        <span class="comment">// q10, q20 = world space initial orientation of body 1 and 2</span></div>
    177. 

  177. <div class="line"><a id="l00093" name="l00093"></a><span class="lineno">   93</span>        <span class="comment">// r0 = initial rotation from body 1 to body 2 in local space of body 1</span></div>
    178. 

  178. <div class="line"><a id="l00094" name="l00094"></a><span class="lineno">   94</span>        <span class="comment">//</span></div>
    179. 

  179. <div class="line"><a id="l00095" name="l00095"></a><span class="lineno">   95</span>        <span class="comment">// We can also write this in terms of the constraint matrices:</span></div>
    180. 

  180. <div class="line"><a id="l00096" name="l00096"></a><span class="lineno">   96</span>        <span class="comment">//</span></div>
    181. 

  181. <div class="line"><a id="l00097" name="l00097"></a><span class="lineno">   97</span>        <span class="comment">// q20 c2 = q10 c1</span></div>
    182. 

  182. <div class="line"><a id="l00098" name="l00098"></a><span class="lineno">   98</span>        <span class="comment">// &lt;=&gt; q20 = q10 c1 c2^-1</span></div>
    183. 

  183. <div class="line"><a id="l00099" name="l00099"></a><span class="lineno">   99</span>        <span class="comment">// =&gt; r0 = c1 c2^-1</span></div>
    184. 

  184. <div class="line"><a id="l00100" name="l00100"></a><span class="lineno">  100</span>        <span class="comment">// &lt;=&gt; r0^-1 = c2 c1^-1</span></div>
    185. 

  185. <div class="line"><a id="l00101" name="l00101"></a><span class="lineno">  101</span>        <span class="comment">//</span></div>
    186. 

  186. <div class="line"><a id="l00102" name="l00102"></a><span class="lineno">  102</span>        <span class="comment">// where:</span></div>
    187. 

  187. <div class="line"><a id="l00103" name="l00103"></a><span class="lineno">  103</span>        <span class="comment">//</span></div>
    188. 

  188. <div class="line"><a id="l00104" name="l00104"></a><span class="lineno">  104</span>        <span class="comment">// c1, c2 = matrix that takes us from body 1 and 2 COM to constraint space 1 and 2</span></div>
    189. 

  189. <div class="line"><a id="l00105" name="l00105"></a><span class="lineno">  105</span>        <span class="keywordflow">if</span> (inAxisX1 == inAxisX2 &amp;&amp; inAxisY1 == inAxisY2)</div>
    190. 

  190. <div class="line"><a id="l00106" name="l00106"></a><span class="lineno">  106</span>        {</div>
    191. 

  191. <div class="line"><a id="l00107" name="l00107"></a><span class="lineno">  107</span>            <span class="comment">// Axis are the same -&gt; identity transform</span></div>
    192. 

  192. <div class="line"><a id="l00108" name="l00108"></a><span class="lineno">  108</span>            <span class="keywordflow">return</span> <a class="code hl_function" href="class_quat.html#a73a43fe262fbbbc0b1872d238b972794">Quat::sIdentity</a>();</div>
    193. 

  193. <div class="line"><a id="l00109" name="l00109"></a><span class="lineno">  109</span>        }</div>
    194. 

  194. <div class="line"><a id="l00110" name="l00110"></a><span class="lineno">  110</span>        <span class="keywordflow">else</span></div>
    195. 

  195. <div class="line"><a id="l00111" name="l00111"></a><span class="lineno">  111</span>        {</div>
    196. 

  196. <div class="line"><a id="l00112" name="l00112"></a><span class="lineno">  112</span>            <a class="code hl_class" href="class_mat44.html">Mat44</a> constraint1(<a class="code hl_class" href="class_vec4.html">Vec4</a>(inAxisX1, 0), <a class="code hl_class" href="class_vec4.html">Vec4</a>(inAxisY1, 0), <a class="code hl_class" href="class_vec4.html">Vec4</a>(inAxisX1.<a class="code hl_function" href="class_vec3.html#a224811af391ccfd1e05282eda22d1de8">Cross</a>(inAxisY1), 0), <a class="code hl_class" href="class_vec4.html">Vec4</a>(0, 0, 0, 1));</div>
    197. 

  197. <div class="line"><a id="l00113" name="l00113"></a><span class="lineno">  113</span>            <a class="code hl_class" href="class_mat44.html">Mat44</a> constraint2(<a class="code hl_class" href="class_vec4.html">Vec4</a>(inAxisX2, 0), <a class="code hl_class" href="class_vec4.html">Vec4</a>(inAxisY2, 0), <a class="code hl_class" href="class_vec4.html">Vec4</a>(inAxisX2.<a class="code hl_function" href="class_vec3.html#a224811af391ccfd1e05282eda22d1de8">Cross</a>(inAxisY2), 0), <a class="code hl_class" href="class_vec4.html">Vec4</a>(0, 0, 0, 1));</div>
    198. 

  198. <div class="line"><a id="l00114" name="l00114"></a><span class="lineno">  114</span>            <span class="keywordflow">return</span> constraint2.<a class="code hl_function" href="class_mat44.html#a1e977c53b5f6a0c03f8da33ebef2c05a">GetQuaternion</a>() * constraint1.<a class="code hl_function" href="class_mat44.html#a1e977c53b5f6a0c03f8da33ebef2c05a">GetQuaternion</a>().<a class="code hl_function" href="class_quat.html#ac69dfd8cdf79a19b8c3f385125ff5ddc">Conjugated</a>();</div>
    199. 

  199. <div class="line"><a id="l00115" name="l00115"></a><span class="lineno">  115</span>        }</div>
    200. 

  200. <div class="line"><a id="l00116" name="l00116"></a><span class="lineno">  116</span>    }</div>
    201. 

  201. </div>
    202. 

  202. <div class="line"><a id="l00117" name="l00117"></a><span class="lineno">  117</span> </div>
    203. 

  203. <div class="foldopen" id="foldopen00123" data-start="{" data-end="}">
    204. 

  204. <div class="line"><a id="l00123" name="l00123"></a><span class="lineno"><a class="line" href="class_rotation_euler_constraint_part.html#ae84f7a33a2d609dd5138c9a7f3f82f65">  123</a></span>    <span class="keyword">static</span> <a class="code hl_class" href="class_quat.html">Quat</a>                 <a class="code hl_function" href="class_rotation_euler_constraint_part.html#ae84f7a33a2d609dd5138c9a7f3f82f65">sGetInvInitialOrientationXZ</a>(<a class="code hl_class" href="class_vec3.html">Vec3Arg</a> inAxisX1, <a class="code hl_class" href="class_vec3.html">Vec3Arg</a> inAxisZ1, <a class="code hl_class" href="class_vec3.html">Vec3Arg</a> inAxisX2, <a class="code hl_class" href="class_vec3.html">Vec3Arg</a> inAxisZ2)</div>
    205. 

  205. <div class="line"><a id="l00124" name="l00124"></a><span class="lineno">  124</span>    {</div>
    206. 

  206. <div class="line"><a id="l00125" name="l00125"></a><span class="lineno">  125</span>        <span class="comment">// See comment at sGetInvInitialOrientationXY</span></div>
    207. 

  207. <div class="line"><a id="l00126" name="l00126"></a><span class="lineno">  126</span>        <span class="keywordflow">if</span> (inAxisX1 == inAxisX2 &amp;&amp; inAxisZ1 == inAxisZ2)</div>
    208. 

  208. <div class="line"><a id="l00127" name="l00127"></a><span class="lineno">  127</span>        {</div>
    209. 

  209. <div class="line"><a id="l00128" name="l00128"></a><span class="lineno">  128</span>            <span class="keywordflow">return</span> <a class="code hl_function" href="class_quat.html#a73a43fe262fbbbc0b1872d238b972794">Quat::sIdentity</a>();</div>
    210. 

  210. <div class="line"><a id="l00129" name="l00129"></a><span class="lineno">  129</span>        }</div>
    211. 

  211. <div class="line"><a id="l00130" name="l00130"></a><span class="lineno">  130</span>        <span class="keywordflow">else</span></div>
    212. 

  212. <div class="line"><a id="l00131" name="l00131"></a><span class="lineno">  131</span>        {</div>
    213. 

  213. <div class="line"><a id="l00132" name="l00132"></a><span class="lineno">  132</span>            <a class="code hl_class" href="class_mat44.html">Mat44</a> constraint1(<a class="code hl_class" href="class_vec4.html">Vec4</a>(inAxisX1, 0), <a class="code hl_class" href="class_vec4.html">Vec4</a>(inAxisZ1.<a class="code hl_function" href="class_vec3.html#a224811af391ccfd1e05282eda22d1de8">Cross</a>(inAxisX1), 0), <a class="code hl_class" href="class_vec4.html">Vec4</a>(inAxisZ1, 0), <a class="code hl_class" href="class_vec4.html">Vec4</a>(0, 0, 0, 1));</div>
    214. 

  214. <div class="line"><a id="l00133" name="l00133"></a><span class="lineno">  133</span>            <a class="code hl_class" href="class_mat44.html">Mat44</a> constraint2(<a class="code hl_class" href="class_vec4.html">Vec4</a>(inAxisX2, 0), <a class="code hl_class" href="class_vec4.html">Vec4</a>(inAxisZ2.<a class="code hl_function" href="class_vec3.html#a224811af391ccfd1e05282eda22d1de8">Cross</a>(inAxisX2), 0), <a class="code hl_class" href="class_vec4.html">Vec4</a>(inAxisZ2, 0), <a class="code hl_class" href="class_vec4.html">Vec4</a>(0, 0, 0, 1));</div>
    215. 

  215. <div class="line"><a id="l00134" name="l00134"></a><span class="lineno">  134</span>            <span class="keywordflow">return</span> constraint2.<a class="code hl_function" href="class_mat44.html#a1e977c53b5f6a0c03f8da33ebef2c05a">GetQuaternion</a>() * constraint1.<a class="code hl_function" href="class_mat44.html#a1e977c53b5f6a0c03f8da33ebef2c05a">GetQuaternion</a>().<a class="code hl_function" href="class_quat.html#ac69dfd8cdf79a19b8c3f385125ff5ddc">Conjugated</a>();</div>
    216. 

  216. <div class="line"><a id="l00135" name="l00135"></a><span class="lineno">  135</span>        }</div>
    217. 

  217. <div class="line"><a id="l00136" name="l00136"></a><span class="lineno">  136</span>    }</div>
    218. 

  218. </div>
    219. 

  219. <div class="line"><a id="l00137" name="l00137"></a><span class="lineno">  137</span> </div>
    220. 

  220. <div class="foldopen" id="foldopen00139" data-start="{" data-end="}">
    221. 

  221. <div class="line"><a id="l00139" name="l00139"></a><span class="lineno"><a class="line" href="class_rotation_euler_constraint_part.html#af37f613895af10af42c71f644fe3f2f5">  139</a></span>    <span class="keyword">inline</span> <span class="keywordtype">void</span>                 <a class="code hl_function" href="class_rotation_euler_constraint_part.html#af37f613895af10af42c71f644fe3f2f5">CalculateConstraintProperties</a>(<span class="keyword">const</span> <a class="code hl_class" href="class_body.html">Body</a> &amp;inBody1, <a class="code hl_class" href="class_mat44.html">Mat44Arg</a> inRotation1, <span class="keyword">const</span> <a class="code hl_class" href="class_body.html">Body</a> &amp;inBody2, <a class="code hl_class" href="class_mat44.html">Mat44Arg</a> inRotation2)</div>
    222. 

  222. <div class="line"><a id="l00140" name="l00140"></a><span class="lineno">  140</span>    {</div>
    223. 

  223. <div class="line"><a id="l00141" name="l00141"></a><span class="lineno">  141</span>        <span class="comment">// Calculate properties used during constraint solving</span></div>
    224. 

  224. <div class="line"><a id="l00142" name="l00142"></a><span class="lineno">  142</span>        mInvI1 = inBody1.<a class="code hl_function" href="class_body.html#a1b21c30907c8c9ce30c176a054057bef">IsDynamic</a>()? inBody1.<a class="code hl_function" href="class_body.html#a0d39987255227c4221fcea66cb1fc041">GetMotionProperties</a>()-&gt;<a class="code hl_function" href="class_motion_properties.html#ab95f2b1c9b6bd9b6082f8cee8a7e1858">GetInverseInertiaForRotation</a>(inRotation1) : <a class="code hl_function" href="class_mat44.html#a1e3a8da1cf3a631ffaf478ca3f6bb1ed">Mat44::sZero</a>();</div>
    225. 

  225. <div class="line"><a id="l00143" name="l00143"></a><span class="lineno">  143</span>        mInvI2 = inBody2.<a class="code hl_function" href="class_body.html#a1b21c30907c8c9ce30c176a054057bef">IsDynamic</a>()? inBody2.<a class="code hl_function" href="class_body.html#a0d39987255227c4221fcea66cb1fc041">GetMotionProperties</a>()-&gt;<a class="code hl_function" href="class_motion_properties.html#ab95f2b1c9b6bd9b6082f8cee8a7e1858">GetInverseInertiaForRotation</a>(inRotation2) : <a class="code hl_function" href="class_mat44.html#a1e3a8da1cf3a631ffaf478ca3f6bb1ed">Mat44::sZero</a>();</div>
    226. 

  226. <div class="line"><a id="l00144" name="l00144"></a><span class="lineno">  144</span> </div>
    227. 

  227. <div class="line"><a id="l00145" name="l00145"></a><span class="lineno">  145</span>        <span class="comment">// Calculate effective mass: K^-1 = (J M^-1 J^T)^-1</span></div>
    228. 

  228. <div class="line"><a id="l00146" name="l00146"></a><span class="lineno">  146</span>        <a class="code hl_class" href="class_mat44.html">Mat44</a> inertia_sum = mInvI1 + mInvI2;</div>
    229. 

  229. <div class="line"><a id="l00147" name="l00147"></a><span class="lineno">  147</span>        <span class="keywordflow">if</span> (!mEffectiveMass.<a class="code hl_function" href="class_mat44.html#a814c04077820ea83f444ccc5ae48299f">SetInversed3x3</a>(inertia_sum))</div>
    230. 

  230. <div class="line"><a id="l00148" name="l00148"></a><span class="lineno">  148</span>        {</div>
    231. 

  231. <div class="line"><a id="l00149" name="l00149"></a><span class="lineno">  149</span>            <span class="comment">// If a column is zero, the axis is locked and we set the column to identity.</span></div>
    232. 

  232. <div class="line"><a id="l00150" name="l00150"></a><span class="lineno">  150</span>            <span class="comment">// This does not matter because any impulse will always be multiplied with mInvI1 or mInvI2 which will result in zero for the locked coordinate.</span></div>
    233. 

  233. <div class="line"><a id="l00151" name="l00151"></a><span class="lineno">  151</span>            <a class="code hl_class" href="class_vec4.html">Vec4</a> zero = <a class="code hl_function" href="class_vec4.html#ab3d9624594386baa4ebd8c1d340ce924">Vec4::sZero</a>();</div>
    234. 

  234. <div class="line"><a id="l00152" name="l00152"></a><span class="lineno">  152</span>            <span class="keywordflow">if</span> (inertia_sum.<a class="code hl_function" href="class_mat44.html#a97c469ed78611039f85415381a67f312">GetColumn4</a>(0) == zero)</div>
    235. 

  235. <div class="line"><a id="l00153" name="l00153"></a><span class="lineno">  153</span>                inertia_sum.<a class="code hl_function" href="class_mat44.html#ace29aeaafa5bbff8a159105fee78e2d2">SetColumn4</a>(0, <a class="code hl_class" href="class_vec4.html">Vec4</a>(1, 0, 0, 0));</div>
    236. 

  236. <div class="line"><a id="l00154" name="l00154"></a><span class="lineno">  154</span>            <span class="keywordflow">if</span> (inertia_sum.<a class="code hl_function" href="class_mat44.html#a97c469ed78611039f85415381a67f312">GetColumn4</a>(1) == zero)</div>
    237. 

  237. <div class="line"><a id="l00155" name="l00155"></a><span class="lineno">  155</span>                inertia_sum.<a class="code hl_function" href="class_mat44.html#ace29aeaafa5bbff8a159105fee78e2d2">SetColumn4</a>(1, <a class="code hl_class" href="class_vec4.html">Vec4</a>(0, 1, 0, 0));</div>
    238. 

  238. <div class="line"><a id="l00156" name="l00156"></a><span class="lineno">  156</span>            <span class="keywordflow">if</span> (inertia_sum.<a class="code hl_function" href="class_mat44.html#a97c469ed78611039f85415381a67f312">GetColumn4</a>(2) == zero)</div>
    239. 

  239. <div class="line"><a id="l00157" name="l00157"></a><span class="lineno">  157</span>                inertia_sum.<a class="code hl_function" href="class_mat44.html#ace29aeaafa5bbff8a159105fee78e2d2">SetColumn4</a>(2, <a class="code hl_class" href="class_vec4.html">Vec4</a>(0, 0, 1, 0));</div>
    240. 

  240. <div class="line"><a id="l00158" name="l00158"></a><span class="lineno">  158</span>            <span class="keywordflow">if</span> (!mEffectiveMass.<a class="code hl_function" href="class_mat44.html#a814c04077820ea83f444ccc5ae48299f">SetInversed3x3</a>(inertia_sum))</div>
    241. 

  241. <div class="line"><a id="l00159" name="l00159"></a><span class="lineno">  159</span>                <a class="code hl_function" href="class_rotation_euler_constraint_part.html#ab5ff022582eb45db942a196a32795661">Deactivate</a>();</div>
    242. 

  242. <div class="line"><a id="l00160" name="l00160"></a><span class="lineno">  160</span>        }</div>
    243. 

  243. <div class="line"><a id="l00161" name="l00161"></a><span class="lineno">  161</span>    }</div>
    244. 

  244. </div>
    245. 

  245. <div class="line"><a id="l00162" name="l00162"></a><span class="lineno">  162</span> </div>
    246. 

  246. <div class="foldopen" id="foldopen00164" data-start="{" data-end="}">
    247. 

  247. <div class="line"><a id="l00164" name="l00164"></a><span class="lineno"><a class="line" href="class_rotation_euler_constraint_part.html#ab5ff022582eb45db942a196a32795661">  164</a></span>    <span class="keyword">inline</span> <span class="keywordtype">void</span>                 <a class="code hl_function" href="class_rotation_euler_constraint_part.html#ab5ff022582eb45db942a196a32795661">Deactivate</a>()</div>
    248. 

  248. <div class="line"><a id="l00165" name="l00165"></a><span class="lineno">  165</span>    {</div>
    249. 

  249. <div class="line"><a id="l00166" name="l00166"></a><span class="lineno">  166</span>        mEffectiveMass = <a class="code hl_function" href="class_mat44.html#a1e3a8da1cf3a631ffaf478ca3f6bb1ed">Mat44::sZero</a>();</div>
    250. 

  250. <div class="line"><a id="l00167" name="l00167"></a><span class="lineno">  167</span>        mTotalLambda = <a class="code hl_function" href="class_vec3.html#ad03c52ab27761bc1e64e33c47632ba51">Vec3::sZero</a>();</div>
    251. 

  251. <div class="line"><a id="l00168" name="l00168"></a><span class="lineno">  168</span>    }</div>
    252. 

  252. </div>
    253. 

  253. <div class="line"><a id="l00169" name="l00169"></a><span class="lineno">  169</span> </div>
    254. 

  254. <div class="foldopen" id="foldopen00171" data-start="{" data-end="}">
    255. 

  255. <div class="line"><a id="l00171" name="l00171"></a><span class="lineno"><a class="line" href="class_rotation_euler_constraint_part.html#a5580f01673bcbbde31fd75108d2866b4">  171</a></span>    <span class="keyword">inline</span> <span class="keywordtype">bool</span>                 <a class="code hl_function" href="class_rotation_euler_constraint_part.html#a5580f01673bcbbde31fd75108d2866b4">IsActive</a>()<span class="keyword"> const</span></div>
    256. 

  256. <div class="line"><a id="l00172" name="l00172"></a><span class="lineno">  172</span><span class="keyword">    </span>{</div>
    257. 

  257. <div class="line"><a id="l00173" name="l00173"></a><span class="lineno">  173</span>        <span class="keywordflow">return</span> mEffectiveMass(3, 3) != 0.0f;</div>
    258. 

  258. <div class="line"><a id="l00174" name="l00174"></a><span class="lineno">  174</span>    }</div>
    259. 

  259. </div>
    260. 

  260. <div class="line"><a id="l00175" name="l00175"></a><span class="lineno">  175</span> </div>
    261. 

  261. <div class="foldopen" id="foldopen00177" data-start="{" data-end="}">
    262. 

  262. <div class="line"><a id="l00177" name="l00177"></a><span class="lineno"><a class="line" href="class_rotation_euler_constraint_part.html#a492a0801dd2881d0ab58f9c8b0abfec8">  177</a></span>    <span class="keyword">inline</span> <span class="keywordtype">void</span>                 <a class="code hl_function" href="class_rotation_euler_constraint_part.html#a492a0801dd2881d0ab58f9c8b0abfec8">WarmStart</a>(<a class="code hl_class" href="class_body.html">Body</a> &amp;ioBody1, <a class="code hl_class" href="class_body.html">Body</a> &amp;ioBody2, <span class="keywordtype">float</span> inWarmStartImpulseRatio)</div>
    263. 

  263. <div class="line"><a id="l00178" name="l00178"></a><span class="lineno">  178</span>    {</div>
    264. 

  264. <div class="line"><a id="l00179" name="l00179"></a><span class="lineno">  179</span>        mTotalLambda *= inWarmStartImpulseRatio;</div>
    265. 

  265. <div class="line"><a id="l00180" name="l00180"></a><span class="lineno">  180</span>        ApplyVelocityStep(ioBody1, ioBody2, mTotalLambda);</div>
    266. 

  266. <div class="line"><a id="l00181" name="l00181"></a><span class="lineno">  181</span>    }</div>
    267. 

  267. </div>
    268. 

  268. <div class="line"><a id="l00182" name="l00182"></a><span class="lineno">  182</span> </div>
    269. 

  269. <div class="foldopen" id="foldopen00184" data-start="{" data-end="}">
    270. 

  270. <div class="line"><a id="l00184" name="l00184"></a><span class="lineno"><a class="line" href="class_rotation_euler_constraint_part.html#af9a7e556643d4162eb300045d9a40df1">  184</a></span>    <span class="keyword">inline</span> <span class="keywordtype">bool</span>                 <a class="code hl_function" href="class_rotation_euler_constraint_part.html#af9a7e556643d4162eb300045d9a40df1">SolveVelocityConstraint</a>(<a class="code hl_class" href="class_body.html">Body</a> &amp;ioBody1, <a class="code hl_class" href="class_body.html">Body</a> &amp;ioBody2)</div>
    271. 

  271. <div class="line"><a id="l00185" name="l00185"></a><span class="lineno">  185</span>    {</div>
    272. 

  272. <div class="line"><a id="l00186" name="l00186"></a><span class="lineno">  186</span>        <span class="comment">// Calculate lagrange multiplier:</span></div>
    273. 

  273. <div class="line"><a id="l00187" name="l00187"></a><span class="lineno">  187</span>        <span class="comment">//</span></div>
    274. 

  274. <div class="line"><a id="l00188" name="l00188"></a><span class="lineno">  188</span>        <span class="comment">// lambda = -K^-1 (J v + b)</span></div>
    275. 

  275. <div class="line"><a id="l00189" name="l00189"></a><span class="lineno">  189</span>        <a class="code hl_class" href="class_vec3.html">Vec3</a> lambda = mEffectiveMass.<a class="code hl_function" href="class_mat44.html#ab599aaeab3e4b832f7f4097816650b14">Multiply3x3</a>(ioBody1.<a class="code hl_function" href="class_body.html#adb1bb49db094ac2ef7c4951d07ba8417">GetAngularVelocity</a>() - ioBody2.<a class="code hl_function" href="class_body.html#adb1bb49db094ac2ef7c4951d07ba8417">GetAngularVelocity</a>());</div>
    276. 

  276. <div class="line"><a id="l00190" name="l00190"></a><span class="lineno">  190</span>        mTotalLambda += lambda;</div>
    277. 

  277. <div class="line"><a id="l00191" name="l00191"></a><span class="lineno">  191</span>        <span class="keywordflow">return</span> ApplyVelocityStep(ioBody1, ioBody2, lambda);</div>
    278. 

  278. <div class="line"><a id="l00192" name="l00192"></a><span class="lineno">  192</span>    }</div>
    279. 

  279. </div>
    280. 

  280. <div class="line"><a id="l00193" name="l00193"></a><span class="lineno">  193</span> </div>
    281. 

  281. <div class="foldopen" id="foldopen00195" data-start="{" data-end="}">
    282. 

  282. <div class="line"><a id="l00195" name="l00195"></a><span class="lineno"><a class="line" href="class_rotation_euler_constraint_part.html#ab2276b37dd0f8eaf4229469def2627b6">  195</a></span>    <span class="keyword">inline</span> <span class="keywordtype">bool</span>                 <a class="code hl_function" href="class_rotation_euler_constraint_part.html#ab2276b37dd0f8eaf4229469def2627b6">SolvePositionConstraint</a>(<a class="code hl_class" href="class_body.html">Body</a> &amp;ioBody1, <a class="code hl_class" href="class_body.html">Body</a> &amp;ioBody2, <a class="code hl_class" href="class_quat.html">QuatArg</a> inInvInitialOrientation, <span class="keywordtype">float</span> inBaumgarte)<span class="keyword"> const</span></div>
    283. 

  283. <div class="line"><a id="l00196" name="l00196"></a><span class="lineno">  196</span><span class="keyword">    </span>{</div>
    284. 

  284. <div class="line"><a id="l00197" name="l00197"></a><span class="lineno">  197</span>        <span class="comment">// Calculate difference in rotation</span></div>
    285. 

  285. <div class="line"><a id="l00198" name="l00198"></a><span class="lineno">  198</span>        <span class="comment">//</span></div>
    286. 

  286. <div class="line"><a id="l00199" name="l00199"></a><span class="lineno">  199</span>        <span class="comment">// The rotation should be:</span></div>
    287. 

  287. <div class="line"><a id="l00200" name="l00200"></a><span class="lineno">  200</span>        <span class="comment">//</span></div>
    288. 

  288. <div class="line"><a id="l00201" name="l00201"></a><span class="lineno">  201</span>        <span class="comment">// q2 = q1 r0</span></div>
    289. 

  289. <div class="line"><a id="l00202" name="l00202"></a><span class="lineno">  202</span>        <span class="comment">//</span></div>
    290. 

  290. <div class="line"><a id="l00203" name="l00203"></a><span class="lineno">  203</span>        <span class="comment">// But because of drift the actual rotation is</span></div>
    291. 

  291. <div class="line"><a id="l00204" name="l00204"></a><span class="lineno">  204</span>        <span class="comment">//</span></div>
    292. 

  292. <div class="line"><a id="l00205" name="l00205"></a><span class="lineno">  205</span>        <span class="comment">// q2 = diff q1 r0</span></div>
    293. 

  293. <div class="line"><a id="l00206" name="l00206"></a><span class="lineno">  206</span>        <span class="comment">// &lt;=&gt; diff = q2 r0^-1 q1^-1</span></div>
    294. 

  294. <div class="line"><a id="l00207" name="l00207"></a><span class="lineno">  207</span>        <span class="comment">//</span></div>
    295. 

  295. <div class="line"><a id="l00208" name="l00208"></a><span class="lineno">  208</span>        <span class="comment">// Where:</span></div>
    296. 

  296. <div class="line"><a id="l00209" name="l00209"></a><span class="lineno">  209</span>        <span class="comment">// q1 = current rotation of body 1</span></div>
    297. 

  297. <div class="line"><a id="l00210" name="l00210"></a><span class="lineno">  210</span>        <span class="comment">// q2 = current rotation of body 2</span></div>
    298. 

  298. <div class="line"><a id="l00211" name="l00211"></a><span class="lineno">  211</span>        <span class="comment">// diff = error that needs to be reduced to zero</span></div>
    299. 

  299. <div class="line"><a id="l00212" name="l00212"></a><span class="lineno">  212</span>        <a class="code hl_class" href="class_quat.html">Quat</a> diff = ioBody2.<a class="code hl_function" href="class_body.html#aaee24bfb5e32e756f50113b9d1f45a2c">GetRotation</a>() * inInvInitialOrientation * ioBody1.<a class="code hl_function" href="class_body.html#aaee24bfb5e32e756f50113b9d1f45a2c">GetRotation</a>().<a class="code hl_function" href="class_quat.html#ac69dfd8cdf79a19b8c3f385125ff5ddc">Conjugated</a>();</div>
    300. 

  300. <div class="line"><a id="l00213" name="l00213"></a><span class="lineno">  213</span> </div>
    301. 

  301. <div class="line"><a id="l00214" name="l00214"></a><span class="lineno">  214</span>        <span class="comment">// A quaternion can be seen as:</span></div>
    302. 

  302. <div class="line"><a id="l00215" name="l00215"></a><span class="lineno">  215</span>        <span class="comment">//</span></div>
    303. 

  303. <div class="line"><a id="l00216" name="l00216"></a><span class="lineno">  216</span>        <span class="comment">// q = [sin(theta / 2) * v, cos(theta/2)]</span></div>
    304. 

  304. <div class="line"><a id="l00217" name="l00217"></a><span class="lineno">  217</span>        <span class="comment">//</span></div>
    305. 

  305. <div class="line"><a id="l00218" name="l00218"></a><span class="lineno">  218</span>        <span class="comment">// Where:</span></div>
    306. 

  306. <div class="line"><a id="l00219" name="l00219"></a><span class="lineno">  219</span>        <span class="comment">// v = rotation vector</span></div>
    307. 

  307. <div class="line"><a id="l00220" name="l00220"></a><span class="lineno">  220</span>        <span class="comment">// theta = rotation angle</span></div>
    308. 

  308. <div class="line"><a id="l00221" name="l00221"></a><span class="lineno">  221</span>        <span class="comment">//</span></div>
    309. 

  309. <div class="line"><a id="l00222" name="l00222"></a><span class="lineno">  222</span>        <span class="comment">// If we assume theta is small (error is small) then sin(x) = x so an approximation of the error angles is:</span></div>
    310. 

  310. <div class="line"><a id="l00223" name="l00223"></a><span class="lineno">  223</span>        <a class="code hl_class" href="class_vec3.html">Vec3</a> error = 2.0f * diff.<a class="code hl_function" href="class_quat.html#a9f563ca8c8a8b71a0aa340d12080c2ef">EnsureWPositive</a>().<a class="code hl_function" href="class_quat.html#afa7fe10bf8a457fb2d524791ccd79ec4">GetXYZ</a>();</div>
    311. 

  311. <div class="line"><a id="l00224" name="l00224"></a><span class="lineno">  224</span>        <span class="keywordflow">if</span> (error != <a class="code hl_function" href="class_vec3.html#ad03c52ab27761bc1e64e33c47632ba51">Vec3::sZero</a>())</div>
    312. 

  312. <div class="line"><a id="l00225" name="l00225"></a><span class="lineno">  225</span>        {</div>
    313. 

  313. <div class="line"><a id="l00226" name="l00226"></a><span class="lineno">  226</span>            <span class="comment">// Calculate lagrange multiplier (lambda) for Baumgarte stabilization:</span></div>
    314. 

  314. <div class="line"><a id="l00227" name="l00227"></a><span class="lineno">  227</span>            <span class="comment">//</span></div>
    315. 

  315. <div class="line"><a id="l00228" name="l00228"></a><span class="lineno">  228</span>            <span class="comment">// lambda = -K^-1 * beta / dt * C</span></div>
    316. 

  316. <div class="line"><a id="l00229" name="l00229"></a><span class="lineno">  229</span>            <span class="comment">//</span></div>
    317. 

  317. <div class="line"><a id="l00230" name="l00230"></a><span class="lineno">  230</span>            <span class="comment">// We should divide by inDeltaTime, but we should multiply by inDeltaTime in the Euler step below so they&#39;re cancelled out</span></div>
    318. 

  318. <div class="line"><a id="l00231" name="l00231"></a><span class="lineno">  231</span>            <a class="code hl_class" href="class_vec3.html">Vec3</a> lambda = -inBaumgarte * mEffectiveMass * error;</div>
    319. 

  319. <div class="line"><a id="l00232" name="l00232"></a><span class="lineno">  232</span> </div>
    320. 

  320. <div class="line"><a id="l00233" name="l00233"></a><span class="lineno">  233</span>            <span class="comment">// Directly integrate velocity change for one time step</span></div>
    321. 

  321. <div class="line"><a id="l00234" name="l00234"></a><span class="lineno">  234</span>            <span class="comment">//</span></div>
    322. 

  322. <div class="line"><a id="l00235" name="l00235"></a><span class="lineno">  235</span>            <span class="comment">// Euler velocity integration:</span></div>
    323. 

  323. <div class="line"><a id="l00236" name="l00236"></a><span class="lineno">  236</span>            <span class="comment">// dv = M^-1 P</span></div>
    324. 

  324. <div class="line"><a id="l00237" name="l00237"></a><span class="lineno">  237</span>            <span class="comment">//</span></div>
    325. 

  325. <div class="line"><a id="l00238" name="l00238"></a><span class="lineno">  238</span>            <span class="comment">// Impulse:</span></div>
    326. 

  326. <div class="line"><a id="l00239" name="l00239"></a><span class="lineno">  239</span>            <span class="comment">// P = J^T lambda</span></div>
    327. 

  327. <div class="line"><a id="l00240" name="l00240"></a><span class="lineno">  240</span>            <span class="comment">//</span></div>
    328. 

  328. <div class="line"><a id="l00241" name="l00241"></a><span class="lineno">  241</span>            <span class="comment">// Euler position integration:</span></div>
    329. 

  329. <div class="line"><a id="l00242" name="l00242"></a><span class="lineno">  242</span>            <span class="comment">// x&#39; = x + dv * dt</span></div>
    330. 

  330. <div class="line"><a id="l00243" name="l00243"></a><span class="lineno">  243</span>            <span class="comment">//</span></div>
    331. 

  331. <div class="line"><a id="l00244" name="l00244"></a><span class="lineno">  244</span>            <span class="comment">// Note we don&#39;t accumulate velocities for the stabilization. This is using the approach described in &#39;Modeling and</span></div>
    332. 

  332. <div class="line"><a id="l00245" name="l00245"></a><span class="lineno">  245</span>            <span class="comment">// Solving Constraints&#39; by Erin Catto presented at GDC 2007. On slide 78 it is suggested to split up the Baumgarte</span></div>
    333. 

  333. <div class="line"><a id="l00246" name="l00246"></a><span class="lineno">  246</span>            <span class="comment">// stabilization for positional drift so that it does not actually add to the momentum. We combine an Euler velocity</span></div>
    334. 

  334. <div class="line"><a id="l00247" name="l00247"></a><span class="lineno">  247</span>            <span class="comment">// integrate + a position integrate and then discard the velocity change.</span></div>
    335. 

  335. <div class="line"><a id="l00248" name="l00248"></a><span class="lineno">  248</span>            <span class="keywordflow">if</span> (ioBody1.<a class="code hl_function" href="class_body.html#a1b21c30907c8c9ce30c176a054057bef">IsDynamic</a>())</div>
    336. 

  336. <div class="line"><a id="l00249" name="l00249"></a><span class="lineno">  249</span>                ioBody1.<a class="code hl_function" href="class_body.html#ab0df53d82e3a8356fac91d178b30c369">SubRotationStep</a>(mInvI1.<a class="code hl_function" href="class_mat44.html#ab599aaeab3e4b832f7f4097816650b14">Multiply3x3</a>(lambda));</div>
    337. 

  337. <div class="line"><a id="l00250" name="l00250"></a><span class="lineno">  250</span>            <span class="keywordflow">if</span> (ioBody2.<a class="code hl_function" href="class_body.html#a1b21c30907c8c9ce30c176a054057bef">IsDynamic</a>())</div>
    338. 

  338. <div class="line"><a id="l00251" name="l00251"></a><span class="lineno">  251</span>                ioBody2.<a class="code hl_function" href="class_body.html#a3385650a73d75c7d9c16d13ea2d5519f">AddRotationStep</a>(mInvI2.<a class="code hl_function" href="class_mat44.html#ab599aaeab3e4b832f7f4097816650b14">Multiply3x3</a>(lambda));</div>
    339. 

  339. <div class="line"><a id="l00252" name="l00252"></a><span class="lineno">  252</span>            <span class="keywordflow">return</span> <span class="keyword">true</span>;</div>
    340. 

  340. <div class="line"><a id="l00253" name="l00253"></a><span class="lineno">  253</span>        }</div>
    341. 

  341. <div class="line"><a id="l00254" name="l00254"></a><span class="lineno">  254</span> </div>
    342. 

  342. <div class="line"><a id="l00255" name="l00255"></a><span class="lineno">  255</span>        <span class="keywordflow">return</span> <span class="keyword">false</span>;</div>
    343. 

  343. <div class="line"><a id="l00256" name="l00256"></a><span class="lineno">  256</span>    }</div>
    344. 

  344. </div>
    345. 

  345. <div class="line"><a id="l00257" name="l00257"></a><span class="lineno">  257</span> </div>
    346. 

  346. <div class="foldopen" id="foldopen00259" data-start="{" data-end="}">
    347. 

  347. <div class="line"><a id="l00259" name="l00259"></a><span class="lineno"><a class="line" href="class_rotation_euler_constraint_part.html#aada1e7c8fcf62c1674aa5080cd70687e">  259</a></span>    <a class="code hl_class" href="class_vec3.html">Vec3</a>                        <a class="code hl_function" href="class_rotation_euler_constraint_part.html#aada1e7c8fcf62c1674aa5080cd70687e">GetTotalLambda</a>()<span class="keyword"> const</span></div>
    348. 

  348. <div class="line"><a id="l00260" name="l00260"></a><span class="lineno">  260</span><span class="keyword">    </span>{</div>
    349. 

  349. <div class="line"><a id="l00261" name="l00261"></a><span class="lineno">  261</span>        <span class="keywordflow">return</span> mTotalLambda;</div>
    350. 

  350. <div class="line"><a id="l00262" name="l00262"></a><span class="lineno">  262</span>    }</div>
    351. 

  351. </div>
    352. 

  352. <div class="line"><a id="l00263" name="l00263"></a><span class="lineno">  263</span> </div>
    353. 

  353. <div class="foldopen" id="foldopen00265" data-start="{" data-end="}">
    354. 

  354. <div class="line"><a id="l00265" name="l00265"></a><span class="lineno"><a class="line" href="class_rotation_euler_constraint_part.html#afda34f355272d02e5daf8103639b22bf">  265</a></span>    <span class="keywordtype">void</span>                        <a class="code hl_function" href="class_rotation_euler_constraint_part.html#afda34f355272d02e5daf8103639b22bf">SaveState</a>(<a class="code hl_class" href="class_state_recorder.html">StateRecorder</a> &amp;inStream)<span class="keyword"> const</span></div>
    355. 

  355. <div class="line"><a id="l00266" name="l00266"></a><span class="lineno">  266</span><span class="keyword">    </span>{</div>
    356. 

  356. <div class="line"><a id="l00267" name="l00267"></a><span class="lineno">  267</span>        inStream.<a class="code hl_function" href="class_stream_out.html#a879dce6c6c6ca5e63835fe61cc745966">Write</a>(mTotalLambda);</div>
    357. 

  357. <div class="line"><a id="l00268" name="l00268"></a><span class="lineno">  268</span>    }</div>
    358. 

  358. </div>
    359. 

  359. <div class="line"><a id="l00269" name="l00269"></a><span class="lineno">  269</span> </div>
    360. 

  360. <div class="foldopen" id="foldopen00271" data-start="{" data-end="}">
    361. 

  361. <div class="line"><a id="l00271" name="l00271"></a><span class="lineno"><a class="line" href="class_rotation_euler_constraint_part.html#aba8f2a3ca2aa7ab982b16499cf938ee3">  271</a></span>    <span class="keywordtype">void</span>                        <a class="code hl_function" href="class_rotation_euler_constraint_part.html#aba8f2a3ca2aa7ab982b16499cf938ee3">RestoreState</a>(<a class="code hl_class" href="class_state_recorder.html">StateRecorder</a> &amp;inStream)</div>
    362. 

  362. <div class="line"><a id="l00272" name="l00272"></a><span class="lineno">  272</span>    {</div>
    363. 

  363. <div class="line"><a id="l00273" name="l00273"></a><span class="lineno">  273</span>        inStream.<a class="code hl_function" href="class_stream_in.html#a5ae9304c310edfc5ef1c67a95e36b1f3">Read</a>(mTotalLambda);</div>
    364. 

  364. <div class="line"><a id="l00274" name="l00274"></a><span class="lineno">  274</span>    }</div>
    365. 

  365. </div>
    366. 

  366. <div class="line"><a id="l00275" name="l00275"></a><span class="lineno">  275</span> </div>
    367. 

  367. <div class="line"><a id="l00276" name="l00276"></a><span class="lineno">  276</span><span class="keyword">private</span>:</div>
    368. 

  368. <div class="line"><a id="l00277" name="l00277"></a><span class="lineno">  277</span>    <a class="code hl_class" href="class_mat44.html">Mat44</a>                       mInvI1;</div>
    369. 

  369. <div class="line"><a id="l00278" name="l00278"></a><span class="lineno">  278</span>    <a class="code hl_class" href="class_mat44.html">Mat44</a>                       mInvI2;</div>
    370. 

  370. <div class="line"><a id="l00279" name="l00279"></a><span class="lineno">  279</span>    <a class="code hl_class" href="class_mat44.html">Mat44</a>                       mEffectiveMass;</div>
    371. 

  371. <div class="line"><a id="l00280" name="l00280"></a><span class="lineno">  280</span>    <a class="code hl_class" href="class_vec3.html">Vec3</a>                        mTotalLambda { <a class="code hl_function" href="class_vec3.html#ad03c52ab27761bc1e64e33c47632ba51">Vec3::sZero</a>() };</div>
    372. 

  372. <div class="line"><a id="l00281" name="l00281"></a><span class="lineno">  281</span>};</div>
    373. 

  373. </div>
    374. 

  374. <div class="line"><a id="l00282" name="l00282"></a><span class="lineno">  282</span> </div>
    375. 

  375. <div class="line"><a id="l00283" name="l00283"></a><span class="lineno">  283</span><a class="code hl_define" href="_core_8h.html#a73da8725998b00321a9db341202d650d">JPH_NAMESPACE_END</a></div>
    376. 

  376. <div class="ttc" id="a_body_8h_html"><div class="ttname"><a href="_body_8h.html">Body.h</a></div></div>
    377. 

  377. <div class="ttc" id="a_core_8h_html_a73da8725998b00321a9db341202d650d"><div class="ttname"><a href="_core_8h.html#a73da8725998b00321a9db341202d650d">JPH_NAMESPACE_END</a></div><div class="ttdeci">#define JPH_NAMESPACE_END</div><div class="ttdef"><b>Definition</b> Core.h:425</div></div>
    378. 

  378. <div class="ttc" id="a_core_8h_html_ad14098b68b8c44ea6112601031268405"><div class="ttname"><a href="_core_8h.html#ad14098b68b8c44ea6112601031268405">JPH_NAMESPACE_BEGIN</a></div><div class="ttdeci">#define JPH_NAMESPACE_BEGIN</div><div class="ttdef"><b>Definition</b> Core.h:419</div></div>
    379. 

  379. <div class="ttc" id="a_state_recorder_8h_html"><div class="ttname"><a href="_state_recorder_8h.html">StateRecorder.h</a></div></div>
    380. 

  380. <div class="ttc" id="aclass_body_html"><div class="ttname"><a href="class_body.html">Body</a></div><div class="ttdef"><b>Definition</b> Body.h:39</div></div>
    381. 

  381. <div class="ttc" id="aclass_body_html_a0d39987255227c4221fcea66cb1fc041"><div class="ttname"><a href="class_body.html#a0d39987255227c4221fcea66cb1fc041">Body::GetMotionProperties</a></div><div class="ttdeci">const MotionProperties * GetMotionProperties() const</div><div class="ttdoc">Access to the motion properties.</div><div class="ttdef"><b>Definition</b> Body.h:308</div></div>
    382. 

  382. <div class="ttc" id="aclass_body_html_a1b21c30907c8c9ce30c176a054057bef"><div class="ttname"><a href="class_body.html#a1b21c30907c8c9ce30c176a054057bef">Body::IsDynamic</a></div><div class="ttdeci">bool IsDynamic() const</div><div class="ttdoc">Check if this body is dynamic, which means that it moves and forces can act on it.</div><div class="ttdef"><b>Definition</b> Body.h:67</div></div>
    383. 

  383. <div class="ttc" id="aclass_body_html_a3385650a73d75c7d9c16d13ea2d5519f"><div class="ttname"><a href="class_body.html#a3385650a73d75c7d9c16d13ea2d5519f">Body::AddRotationStep</a></div><div class="ttdeci">void AddRotationStep(Vec3Arg inAngularVelocityTimesDeltaTime)</div><div class="ttdoc">Update rotation using an Euler step (used during position integrate &amp; constraint solving)</div><div class="ttdef"><b>Definition</b> Body.inl:81</div></div>
    384. 

  384. <div class="ttc" id="aclass_body_html_aaee24bfb5e32e756f50113b9d1f45a2c"><div class="ttname"><a href="class_body.html#aaee24bfb5e32e756f50113b9d1f45a2c">Body::GetRotation</a></div><div class="ttdeci">Quat GetRotation() const</div><div class="ttdoc">World space rotation of the body.</div><div class="ttdef"><b>Definition</b> Body.h:271</div></div>
    385. 

  385. <div class="ttc" id="aclass_body_html_ab0df53d82e3a8356fac91d178b30c369"><div class="ttname"><a href="class_body.html#ab0df53d82e3a8356fac91d178b30c369">Body::SubRotationStep</a></div><div class="ttdeci">void SubRotationStep(Vec3Arg inAngularVelocityTimesDeltaTime)</div><div class="ttdef"><b>Definition</b> Body.inl:100</div></div>
    386. 

  386. <div class="ttc" id="aclass_body_html_adb1bb49db094ac2ef7c4951d07ba8417"><div class="ttname"><a href="class_body.html#adb1bb49db094ac2ef7c4951d07ba8417">Body::GetAngularVelocity</a></div><div class="ttdeci">Vec3 GetAngularVelocity() const</div><div class="ttdoc">Get world space angular velocity of the center of mass (unit: rad/s)</div><div class="ttdef"><b>Definition</b> Body.h:161</div></div>
    387. 

  387. <div class="ttc" id="aclass_mat44_html"><div class="ttname"><a href="class_mat44.html">Mat44</a></div><div class="ttdoc">Holds a 4x4 matrix of floats, but supports also operations on the 3x3 upper left part of the matrix.</div><div class="ttdef"><b>Definition</b> Mat44.h:13</div></div>
    388. 

  388. <div class="ttc" id="aclass_mat44_html_a1e3a8da1cf3a631ffaf478ca3f6bb1ed"><div class="ttname"><a href="class_mat44.html#a1e3a8da1cf3a631ffaf478ca3f6bb1ed">Mat44::sZero</a></div><div class="ttdeci">static JPH_INLINE Mat44 sZero()</div><div class="ttdoc">Zero matrix.</div><div class="ttdef"><b>Definition</b> Mat44.inl:30</div></div>
    389. 

  389. <div class="ttc" id="aclass_mat44_html_a1e977c53b5f6a0c03f8da33ebef2c05a"><div class="ttname"><a href="class_mat44.html#a1e977c53b5f6a0c03f8da33ebef2c05a">Mat44::GetQuaternion</a></div><div class="ttdeci">JPH_INLINE Quat GetQuaternion() const</div><div class="ttdoc">Convert to quaternion.</div><div class="ttdef"><b>Definition</b> Mat44.inl:783</div></div>
    390. 

  390. <div class="ttc" id="aclass_mat44_html_a814c04077820ea83f444ccc5ae48299f"><div class="ttname"><a href="class_mat44.html#a814c04077820ea83f444ccc5ae48299f">Mat44::SetInversed3x3</a></div><div class="ttdeci">JPH_INLINE bool SetInversed3x3(Mat44Arg inM)</div><div class="ttdoc">*this = inM.Inversed3x3(), returns false if the matrix is singular in which case *this is unchanged</div><div class="ttdef"><b>Definition</b> Mat44.inl:767</div></div>
    391. 

  391. <div class="ttc" id="aclass_mat44_html_a97c469ed78611039f85415381a67f312"><div class="ttname"><a href="class_mat44.html#a97c469ed78611039f85415381a67f312">Mat44::GetColumn4</a></div><div class="ttdeci">JPH_INLINE Vec4 GetColumn4(uint inCol) const</div><div class="ttdef"><b>Definition</b> Mat44.h:160</div></div>
    392. 

  392. <div class="ttc" id="aclass_mat44_html_ab599aaeab3e4b832f7f4097816650b14"><div class="ttname"><a href="class_mat44.html#ab599aaeab3e4b832f7f4097816650b14">Mat44::Multiply3x3</a></div><div class="ttdeci">JPH_INLINE Vec3 Multiply3x3(Vec3Arg inV) const</div><div class="ttdoc">Multiply vector by only 3x3 part of the matrix.</div><div class="ttdef"><b>Definition</b> Mat44.inl:316</div></div>
    393. 

  393. <div class="ttc" id="aclass_mat44_html_ace29aeaafa5bbff8a159105fee78e2d2"><div class="ttname"><a href="class_mat44.html#ace29aeaafa5bbff8a159105fee78e2d2">Mat44::SetColumn4</a></div><div class="ttdeci">JPH_INLINE void SetColumn4(uint inCol, Vec4Arg inV)</div><div class="ttdef"><b>Definition</b> Mat44.h:161</div></div>
    394. 

  394. <div class="ttc" id="aclass_motion_properties_html_a98672fc0c6884643944e570e1d78ac07"><div class="ttname"><a href="class_motion_properties.html#a98672fc0c6884643944e570e1d78ac07">MotionProperties::SubAngularVelocityStep</a></div><div class="ttdeci">void SubAngularVelocityStep(Vec3Arg inAngularVelocityChange)</div><div class="ttdef"><b>Definition</b> MotionProperties.h:220</div></div>
    395. 

  395. <div class="ttc" id="aclass_motion_properties_html_ab95f2b1c9b6bd9b6082f8cee8a7e1858"><div class="ttname"><a href="class_motion_properties.html#ab95f2b1c9b6bd9b6082f8cee8a7e1858">MotionProperties::GetInverseInertiaForRotation</a></div><div class="ttdeci">Mat44 GetInverseInertiaForRotation(Mat44Arg inRotation) const</div><div class="ttdoc">Get inverse inertia matrix ( ) for a given object rotation (translation will be ignored)....</div><div class="ttdef"><b>Definition</b> MotionProperties.inl:69</div></div>
    396. 

  396. <div class="ttc" id="aclass_motion_properties_html_afb12aa823a651145b46b271570a7af59"><div class="ttname"><a href="class_motion_properties.html#afb12aa823a651145b46b271570a7af59">MotionProperties::AddAngularVelocityStep</a></div><div class="ttdeci">void AddAngularVelocityStep(Vec3Arg inAngularVelocityChange)</div><div class="ttdef"><b>Definition</b> MotionProperties.h:219</div></div>
    397. 

  397. <div class="ttc" id="aclass_quat_html"><div class="ttname"><a href="class_quat.html">Quat</a></div><div class="ttdef"><b>Definition</b> Quat.h:33</div></div>
    398. 

  398. <div class="ttc" id="aclass_quat_html_a73a43fe262fbbbc0b1872d238b972794"><div class="ttname"><a href="class_quat.html#a73a43fe262fbbbc0b1872d238b972794">Quat::sIdentity</a></div><div class="ttdeci">static JPH_INLINE Quat sIdentity()</div><div class="ttdef"><b>Definition</b> Quat.h:104</div></div>
    399. 

  399. <div class="ttc" id="aclass_quat_html_a9f563ca8c8a8b71a0aa340d12080c2ef"><div class="ttname"><a href="class_quat.html#a9f563ca8c8a8b71a0aa340d12080c2ef">Quat::EnsureWPositive</a></div><div class="ttdeci">JPH_INLINE Quat EnsureWPositive() const</div><div class="ttdoc">Ensures that the W component is positive by negating the entire quaternion if it is not....</div><div class="ttdef"><b>Definition</b> Quat.h:188</div></div>
    400. 

  400. <div class="ttc" id="aclass_quat_html_ac69dfd8cdf79a19b8c3f385125ff5ddc"><div class="ttname"><a href="class_quat.html#ac69dfd8cdf79a19b8c3f385125ff5ddc">Quat::Conjugated</a></div><div class="ttdeci">JPH_INLINE Quat Conjugated() const</div><div class="ttdoc">The conjugate [w, -x, -y, -z] is the same as the inverse for unit quaternions.</div><div class="ttdef"><b>Definition</b> Quat.h:182</div></div>
    401. 

  401. <div class="ttc" id="aclass_quat_html_afa7fe10bf8a457fb2d524791ccd79ec4"><div class="ttname"><a href="class_quat.html#afa7fe10bf8a457fb2d524791ccd79ec4">Quat::GetXYZ</a></div><div class="ttdeci">JPH_INLINE Vec3 GetXYZ() const</div><div class="ttdoc">Get the imaginary part of the quaternion.</div><div class="ttdef"><b>Definition</b> Quat.h:82</div></div>
    402. 

  402. <div class="ttc" id="aclass_rotation_euler_constraint_part_html"><div class="ttname"><a href="class_rotation_euler_constraint_part.html">RotationEulerConstraintPart</a></div><div class="ttdef"><b>Definition</b> RotationEulerConstraintPart.h:36</div></div>
    403. 

  403. <div class="ttc" id="aclass_rotation_euler_constraint_part_html_a40c10735335691be99e7911139dc2884"><div class="ttname"><a href="class_rotation_euler_constraint_part.html#a40c10735335691be99e7911139dc2884">RotationEulerConstraintPart::sGetInvInitialOrientation</a></div><div class="ttdeci">static Quat sGetInvInitialOrientation(const Body &amp;inBody1, const Body &amp;inBody2)</div><div class="ttdoc">Return inverse of initial rotation from body 1 to body 2 in body 1 space.</div><div class="ttdef"><b>Definition</b> RotationEulerConstraintPart.h:63</div></div>
    404. 

  404. <div class="ttc" id="aclass_rotation_euler_constraint_part_html_a492a0801dd2881d0ab58f9c8b0abfec8"><div class="ttname"><a href="class_rotation_euler_constraint_part.html#a492a0801dd2881d0ab58f9c8b0abfec8">RotationEulerConstraintPart::WarmStart</a></div><div class="ttdeci">void WarmStart(Body &amp;ioBody1, Body &amp;ioBody2, float inWarmStartImpulseRatio)</div><div class="ttdoc">Must be called from the WarmStartVelocityConstraint call to apply the previous frame's impulses.</div><div class="ttdef"><b>Definition</b> RotationEulerConstraintPart.h:177</div></div>
    405. 

  405. <div class="ttc" id="aclass_rotation_euler_constraint_part_html_a5580f01673bcbbde31fd75108d2866b4"><div class="ttname"><a href="class_rotation_euler_constraint_part.html#a5580f01673bcbbde31fd75108d2866b4">RotationEulerConstraintPart::IsActive</a></div><div class="ttdeci">bool IsActive() const</div><div class="ttdoc">Check if constraint is active.</div><div class="ttdef"><b>Definition</b> RotationEulerConstraintPart.h:171</div></div>
    406. 

  406. <div class="ttc" id="aclass_rotation_euler_constraint_part_html_a6757c3b96eff4a145d9228fb1679222d"><div class="ttname"><a href="class_rotation_euler_constraint_part.html#a6757c3b96eff4a145d9228fb1679222d">RotationEulerConstraintPart::sGetInvInitialOrientationXY</a></div><div class="ttdeci">static Quat sGetInvInitialOrientationXY(Vec3Arg inAxisX1, Vec3Arg inAxisY1, Vec3Arg inAxisX2, Vec3Arg inAxisY2)</div><div class="ttdoc">Return inverse of initial rotation from body 1 to body 2 in body 1 space.</div><div class="ttdef"><b>Definition</b> RotationEulerConstraintPart.h:82</div></div>
    407. 

  407. <div class="ttc" id="aclass_rotation_euler_constraint_part_html_aada1e7c8fcf62c1674aa5080cd70687e"><div class="ttname"><a href="class_rotation_euler_constraint_part.html#aada1e7c8fcf62c1674aa5080cd70687e">RotationEulerConstraintPart::GetTotalLambda</a></div><div class="ttdeci">Vec3 GetTotalLambda() const</div><div class="ttdoc">Return lagrange multiplier.</div><div class="ttdef"><b>Definition</b> RotationEulerConstraintPart.h:259</div></div>
    408. 

  408. <div class="ttc" id="aclass_rotation_euler_constraint_part_html_ab2276b37dd0f8eaf4229469def2627b6"><div class="ttname"><a href="class_rotation_euler_constraint_part.html#ab2276b37dd0f8eaf4229469def2627b6">RotationEulerConstraintPart::SolvePositionConstraint</a></div><div class="ttdeci">bool SolvePositionConstraint(Body &amp;ioBody1, Body &amp;ioBody2, QuatArg inInvInitialOrientation, float inBaumgarte) const</div><div class="ttdoc">Iteratively update the position constraint. Makes sure C(...) = 0.</div><div class="ttdef"><b>Definition</b> RotationEulerConstraintPart.h:195</div></div>
    409. 

  409. <div class="ttc" id="aclass_rotation_euler_constraint_part_html_ab5ff022582eb45db942a196a32795661"><div class="ttname"><a href="class_rotation_euler_constraint_part.html#ab5ff022582eb45db942a196a32795661">RotationEulerConstraintPart::Deactivate</a></div><div class="ttdeci">void Deactivate()</div><div class="ttdoc">Deactivate this constraint.</div><div class="ttdef"><b>Definition</b> RotationEulerConstraintPart.h:164</div></div>
    410. 

  410. <div class="ttc" id="aclass_rotation_euler_constraint_part_html_aba8f2a3ca2aa7ab982b16499cf938ee3"><div class="ttname"><a href="class_rotation_euler_constraint_part.html#aba8f2a3ca2aa7ab982b16499cf938ee3">RotationEulerConstraintPart::RestoreState</a></div><div class="ttdeci">void RestoreState(StateRecorder &amp;inStream)</div><div class="ttdoc">Restore state of this constraint part.</div><div class="ttdef"><b>Definition</b> RotationEulerConstraintPart.h:271</div></div>
    411. 

  411. <div class="ttc" id="aclass_rotation_euler_constraint_part_html_ae84f7a33a2d609dd5138c9a7f3f82f65"><div class="ttname"><a href="class_rotation_euler_constraint_part.html#ae84f7a33a2d609dd5138c9a7f3f82f65">RotationEulerConstraintPart::sGetInvInitialOrientationXZ</a></div><div class="ttdeci">static Quat sGetInvInitialOrientationXZ(Vec3Arg inAxisX1, Vec3Arg inAxisZ1, Vec3Arg inAxisX2, Vec3Arg inAxisZ2)</div><div class="ttdoc">Return inverse of initial rotation from body 1 to body 2 in body 1 space.</div><div class="ttdef"><b>Definition</b> RotationEulerConstraintPart.h:123</div></div>
    412. 

  412. <div class="ttc" id="aclass_rotation_euler_constraint_part_html_af37f613895af10af42c71f644fe3f2f5"><div class="ttname"><a href="class_rotation_euler_constraint_part.html#af37f613895af10af42c71f644fe3f2f5">RotationEulerConstraintPart::CalculateConstraintProperties</a></div><div class="ttdeci">void CalculateConstraintProperties(const Body &amp;inBody1, Mat44Arg inRotation1, const Body &amp;inBody2, Mat44Arg inRotation2)</div><div class="ttdoc">Calculate properties used during the functions below.</div><div class="ttdef"><b>Definition</b> RotationEulerConstraintPart.h:139</div></div>
    413. 

  413. <div class="ttc" id="aclass_rotation_euler_constraint_part_html_af9a7e556643d4162eb300045d9a40df1"><div class="ttname"><a href="class_rotation_euler_constraint_part.html#af9a7e556643d4162eb300045d9a40df1">RotationEulerConstraintPart::SolveVelocityConstraint</a></div><div class="ttdeci">bool SolveVelocityConstraint(Body &amp;ioBody1, Body &amp;ioBody2)</div><div class="ttdoc">Iteratively update the velocity constraint. Makes sure d/dt C(...) = 0, where C is the constraint equ...</div><div class="ttdef"><b>Definition</b> RotationEulerConstraintPart.h:184</div></div>
    414. 

  414. <div class="ttc" id="aclass_rotation_euler_constraint_part_html_afda34f355272d02e5daf8103639b22bf"><div class="ttname"><a href="class_rotation_euler_constraint_part.html#afda34f355272d02e5daf8103639b22bf">RotationEulerConstraintPart::SaveState</a></div><div class="ttdeci">void SaveState(StateRecorder &amp;inStream) const</div><div class="ttdoc">Save state of this constraint part.</div><div class="ttdef"><b>Definition</b> RotationEulerConstraintPart.h:265</div></div>
    415. 

  415. <div class="ttc" id="aclass_state_recorder_html"><div class="ttname"><a href="class_state_recorder.html">StateRecorder</a></div><div class="ttdef"><b>Definition</b> StateRecorder.h:110</div></div>
    416. 

  416. <div class="ttc" id="aclass_stream_in_html_a5ae9304c310edfc5ef1c67a95e36b1f3"><div class="ttname"><a href="class_stream_in.html#a5ae9304c310edfc5ef1c67a95e36b1f3">StreamIn::Read</a></div><div class="ttdeci">void Read(T &amp;outT)</div><div class="ttdoc">Read a primitive (e.g. float, int, etc.) from the binary stream.</div><div class="ttdef"><b>Definition</b> StreamIn.h:30</div></div>
    417. 

  417. <div class="ttc" id="aclass_stream_out_html_a879dce6c6c6ca5e63835fe61cc745966"><div class="ttname"><a href="class_stream_out.html#a879dce6c6c6ca5e63835fe61cc745966">StreamOut::Write</a></div><div class="ttdeci">void Write(const T &amp;inT)</div><div class="ttdoc">Write a primitive (e.g. float, int, etc.) to the binary stream.</div><div class="ttdef"><b>Definition</b> StreamOut.h:26</div></div>
    418. 

  418. <div class="ttc" id="aclass_vec3_html"><div class="ttname"><a href="class_vec3.html">Vec3</a></div><div class="ttdef"><b>Definition</b> Vec3.h:17</div></div>
    419. 

  419. <div class="ttc" id="aclass_vec3_html_a224811af391ccfd1e05282eda22d1de8"><div class="ttname"><a href="class_vec3.html#a224811af391ccfd1e05282eda22d1de8">Vec3::Cross</a></div><div class="ttdeci">JPH_INLINE Vec3 Cross(Vec3Arg inV2) const</div><div class="ttdoc">Cross product.</div><div class="ttdef"><b>Definition</b> Vec3.inl:595</div></div>
    420. 

  420. <div class="ttc" id="aclass_vec3_html_ad03c52ab27761bc1e64e33c47632ba51"><div class="ttname"><a href="class_vec3.html#ad03c52ab27761bc1e64e33c47632ba51">Vec3::sZero</a></div><div class="ttdeci">static JPH_INLINE Vec3 sZero()</div><div class="ttdoc">Vector with all zeros.</div><div class="ttdef"><b>Definition</b> Vec3.inl:103</div></div>
    421. 

  421. <div class="ttc" id="aclass_vec4_html"><div class="ttname"><a href="class_vec4.html">Vec4</a></div><div class="ttdef"><b>Definition</b> Vec4.h:14</div></div>
    422. 

  422. <div class="ttc" id="aclass_vec4_html_ab3d9624594386baa4ebd8c1d340ce924"><div class="ttname"><a href="class_vec4.html#ab3d9624594386baa4ebd8c1d340ce924">Vec4::sZero</a></div><div class="ttdeci">static JPH_INLINE Vec4 sZero()</div><div class="ttdoc">Vector with all zeros.</div><div class="ttdef"><b>Definition</b> Vec4.inl:63</div></div>
    423. 

  423. </div><!-- fragment --></div><!-- contents -->
    424. 

  424. </div><!-- doc-content -->
    425. 

  425. <!-- start footer part -->
    426. 

  426. <div id="nav-path" class="navpath"><!-- id is needed for treeview function! -->
    427. 

  427.   <ul>
    428. 

  428.     <li class="navelem"><a class="el" href="dir_d99289a5d3c46cf26f14ff6c90658d9f.html">Jolt</a></li><li class="navelem"><a class="el" href="dir_a0f33af92addde396fc27b064c5eb8a9.html">Physics</a></li><li class="navelem"><a class="el" href="dir_166975991df1b4ecc6dd5a6639d45e50.html">Constraints</a></li><li class="navelem"><a class="el" href="dir_e6c5fb27ccbee0305acd3bb7c27d0472.html">ConstraintPart</a></li><li class="navelem"><a class="el" href="_rotation_euler_constraint_part_8h.html">RotationEulerConstraintPart.h</a></li>
    429. 

  429.     <li class="footer">Generated by <a href="https://www.doxygen.org/index.html"><img class="footer" src="doxygen.svg" width="104" height="31" alt="doxygen"/></a> 1.12.0 </li>
    430. 

  430.   </ul>
    431. 

  431. </div>
    432. 

  432. </body>
    433. 

  433. </html>
    434.