TheAlgorithms-C/de/d7b/group__vec__3d.html

646 lines
45 KiB
HTML
Raw Normal View History

<!DOCTYPE html PUBLIC "-//W3C//DTD XHTML 1.0 Transitional//EN" "https://www.w3.org/TR/xhtml1/DTD/xhtml1-transitional.dtd">
<html xmlns="http://www.w3.org/1999/xhtml" lang="en-US">
<head>
<meta http-equiv="Content-Type" content="text/xhtml;charset=UTF-8"/>
<meta http-equiv="X-UA-Compatible" content="IE=11"/>
<meta name="generator" content="Doxygen 1.9.5"/>
<meta name="viewport" content="width=device-width, initial-scale=1"/>
<title>Algorithms_in_C: 3D Vector operations</title>
<link href="../../tabs.css" rel="stylesheet" type="text/css"/>
<script type="text/javascript" src="../../jquery.js"></script>
<script type="text/javascript" src="../../dynsections.js"></script>
<link href="../../navtree.css" rel="stylesheet" type="text/css"/>
<script type="text/javascript" src="../../resize.js"></script>
<script type="text/javascript" src="../../navtreedata.js"></script>
<script type="text/javascript" src="../../navtree.js"></script>
<link href="../../search/search.css" rel="stylesheet" type="text/css"/>
<script type="text/javascript" src="../../search/searchdata.js"></script>
<script type="text/javascript" src="../../search/search.js"></script>
<script type="text/x-mathjax-config">
MathJax.Hub.Config({
extensions: ["tex2jax.js", "TeX/AMSmath.js", "TeX/AMSsymbols.js"],
jax: ["input/TeX","output/HTML-CSS"],
});
</script>
<script type="text/javascript" async="async" src="https://cdnjs.cloudflare.com/ajax/libs/mathjax/2.7.7/MathJax.js?config=TeX-MML-AM_CHTML/MathJax.js"></script>
<link href="../../doxygen.css" rel="stylesheet" type="text/css" />
</head>
<body>
<div id="top"><!-- do not remove this div, it is closed by doxygen! -->
<div id="titlearea">
<table cellspacing="0" cellpadding="0">
<tbody>
<tr id="projectrow">
<td id="projectalign">
<div id="projectname">Algorithms_in_C<span id="projectnumber">&#160;1.0.0</span>
</div>
<div id="projectbrief">Set of algorithms implemented in C.</div>
</td>
</tr>
</tbody>
</table>
</div>
<!-- end header part -->
<!-- Generated by Doxygen 1.9.5 -->
<script type="text/javascript">
/* @license magnet:?xt=urn:btih:d3d9a9a6595521f9666a5e94cc830dab83b65699&amp;dn=expat.txt MIT */
var searchBox = new SearchBox("searchBox", "../../search/",'.html');
/* @license-end */
</script>
<script type="text/javascript" src="../../menudata.js"></script>
<script type="text/javascript" src="../../menu.js"></script>
<script type="text/javascript">
/* @license magnet:?xt=urn:btih:d3d9a9a6595521f9666a5e94cc830dab83b65699&amp;dn=expat.txt MIT */
$(function() {
initMenu('../../',true,false,'search.php','Search');
$(document).ready(function() { init_search(); });
});
/* @license-end */
</script>
<div id="main-nav"></div>
</div><!-- top -->
<div id="side-nav" class="ui-resizable side-nav-resizable">
<div id="nav-tree">
<div id="nav-tree-contents">
<div id="nav-sync" class="sync"></div>
</div>
</div>
<div id="splitbar" style="-moz-user-select:none;"
class="ui-resizable-handle">
</div>
</div>
<script type="text/javascript">
/* @license magnet:?xt=urn:btih:d3d9a9a6595521f9666a5e94cc830dab83b65699&amp;dn=expat.txt MIT */
$(document).ready(function(){initNavTree('de/d7b/group__vec__3d.html','../../'); initResizable(); });
/* @license-end */
</script>
<div id="doc-content">
<!-- window showing the filter options -->
<div id="MSearchSelectWindow"
onmouseover="return searchBox.OnSearchSelectShow()"
onmouseout="return searchBox.OnSearchSelectHide()"
onkeydown="return searchBox.OnSearchSelectKey(event)">
</div>
<!-- iframe showing the search results (closed by default) -->
<div id="MSearchResultsWindow">
<div id="MSearchResults">
<div class="SRPage">
<div id="SRIndex">
<div id="SRResults"></div>
<div class="SRStatus" id="Loading">Loading...</div>
<div class="SRStatus" id="Searching">Searching...</div>
<div class="SRStatus" id="NoMatches">No Matches</div>
</div>
</div>
</div>
</div>
<div class="header">
<div class="summary">
<a href="#nested-classes">Data Structures</a> &#124;
<a href="#typedef-members">Typedefs</a> &#124;
<a href="#func-members">Functions</a> </div>
<div class="headertitle"><div class="title">3D Vector operations<div class="ingroups"><a class="el" href="../../de/d5a/group__quaternions.html">Library for 3D Vectors &amp; Quaternions</a></div></div></div>
</div><!--header-->
<div class="contents">
<div class="dynheader">
Collaboration diagram for 3D Vector operations:</div>
<div class="dyncontent">
<div class="center"><iframe scrolling="no" frameborder="0" src="../../de/d7b/group__vec__3d.svg" width="355" height="51"><p><b>This browser is not able to show SVG: try Firefox, Chrome, Safari, or Opera instead.</b></p></iframe>
</div>
</div>
<table class="memberdecls">
<tr class="heading"><td colspan="2"><h2 class="groupheader"><a id="nested-classes" name="nested-classes"></a>
Data Structures</h2></td></tr>
<tr class="memitem:"><td class="memItemLeft" align="right" valign="top">struct &#160;</td><td class="memItemRight" valign="bottom"><a class="el" href="../../d5/db4/structvec__3d__.html">vec_3d_</a></td></tr>
<tr class="memdesc:"><td class="mdescLeft">&#160;</td><td class="mdescRight">3D vector type <a href="../../d5/db4/structvec__3d__.html#details">More...</a><br /></td></tr>
<tr class="separator:"><td class="memSeparator" colspan="2">&#160;</td></tr>
</table><table class="memberdecls">
<tr class="heading"><td colspan="2"><h2 class="groupheader"><a id="typedef-members" name="typedef-members"></a>
Typedefs</h2></td></tr>
<tr class="memitem:gaf9ee870d4922e488bdd3e7262485c270"><td class="memItemLeft" align="right" valign="top"><a id="gaf9ee870d4922e488bdd3e7262485c270" name="gaf9ee870d4922e488bdd3e7262485c270"></a>
typedef struct <a class="el" href="../../d5/db4/structvec__3d__.html">vec_3d_</a>&#160;</td><td class="memItemRight" valign="bottom"><b>vec_3d</b></td></tr>
<tr class="memdesc:gaf9ee870d4922e488bdd3e7262485c270"><td class="mdescLeft">&#160;</td><td class="mdescRight">3D vector type <br /></td></tr>
<tr class="separator:gaf9ee870d4922e488bdd3e7262485c270"><td class="memSeparator" colspan="2">&#160;</td></tr>
</table><table class="memberdecls">
<tr class="heading"><td colspan="2"><h2 class="groupheader"><a id="func-members" name="func-members"></a>
Functions</h2></td></tr>
<tr class="memitem:ga97da356cb7d5da73a0ac9bad09a435cc"><td class="memItemLeft" align="right" valign="top"><a class="el" href="../../de/d7b/group__vec__3d.html#gaf9ee870d4922e488bdd3e7262485c270">vec_3d</a>&#160;</td><td class="memItemRight" valign="bottom"><a class="el" href="../../de/d7b/group__vec__3d.html#ga97da356cb7d5da73a0ac9bad09a435cc">vector_sub</a> (const <a class="el" href="../../de/d7b/group__vec__3d.html#gaf9ee870d4922e488bdd3e7262485c270">vec_3d</a> *a, const <a class="el" href="../../de/d7b/group__vec__3d.html#gaf9ee870d4922e488bdd3e7262485c270">vec_3d</a> *b)</td></tr>
<tr class="memdesc:ga97da356cb7d5da73a0ac9bad09a435cc"><td class="mdescLeft">&#160;</td><td class="mdescRight">Subtract one vector from another. <a href="../../de/d7b/group__vec__3d.html#ga97da356cb7d5da73a0ac9bad09a435cc">More...</a><br /></td></tr>
<tr class="separator:ga97da356cb7d5da73a0ac9bad09a435cc"><td class="memSeparator" colspan="2">&#160;</td></tr>
<tr class="memitem:gaa6b5ac18429ffb0131dc8593d31c25a4"><td class="memItemLeft" align="right" valign="top"><a class="el" href="../../de/d7b/group__vec__3d.html#gaf9ee870d4922e488bdd3e7262485c270">vec_3d</a>&#160;</td><td class="memItemRight" valign="bottom"><a class="el" href="../../de/d7b/group__vec__3d.html#gaa6b5ac18429ffb0131dc8593d31c25a4">vector_add</a> (const <a class="el" href="../../de/d7b/group__vec__3d.html#gaf9ee870d4922e488bdd3e7262485c270">vec_3d</a> *a, const <a class="el" href="../../de/d7b/group__vec__3d.html#gaf9ee870d4922e488bdd3e7262485c270">vec_3d</a> *b)</td></tr>
<tr class="memdesc:gaa6b5ac18429ffb0131dc8593d31c25a4"><td class="mdescLeft">&#160;</td><td class="mdescRight">Add one vector to another. <a href="../../de/d7b/group__vec__3d.html#gaa6b5ac18429ffb0131dc8593d31c25a4">More...</a><br /></td></tr>
<tr class="separator:gaa6b5ac18429ffb0131dc8593d31c25a4"><td class="memSeparator" colspan="2">&#160;</td></tr>
<tr class="memitem:ga243e74d542d0d4d14fa3ae0bc2170d84"><td class="memItemLeft" align="right" valign="top">float&#160;</td><td class="memItemRight" valign="bottom"><a class="el" href="../../de/d7b/group__vec__3d.html#ga243e74d542d0d4d14fa3ae0bc2170d84">dot_prod</a> (const <a class="el" href="../../de/d7b/group__vec__3d.html#gaf9ee870d4922e488bdd3e7262485c270">vec_3d</a> *a, const <a class="el" href="../../de/d7b/group__vec__3d.html#gaf9ee870d4922e488bdd3e7262485c270">vec_3d</a> *b)</td></tr>
<tr class="memdesc:ga243e74d542d0d4d14fa3ae0bc2170d84"><td class="mdescLeft">&#160;</td><td class="mdescRight">Obtain the dot product of two 3D vectors. <a href="../../de/d7b/group__vec__3d.html#ga243e74d542d0d4d14fa3ae0bc2170d84">More...</a><br /></td></tr>
<tr class="separator:ga243e74d542d0d4d14fa3ae0bc2170d84"><td class="memSeparator" colspan="2">&#160;</td></tr>
<tr class="memitem:gae4a49e6bdf13df949e8b23c7925bb5f5"><td class="memItemLeft" align="right" valign="top"><a class="el" href="../../de/d7b/group__vec__3d.html#gaf9ee870d4922e488bdd3e7262485c270">vec_3d</a>&#160;</td><td class="memItemRight" valign="bottom"><a class="el" href="../../de/d7b/group__vec__3d.html#gae4a49e6bdf13df949e8b23c7925bb5f5">vector_prod</a> (const <a class="el" href="../../de/d7b/group__vec__3d.html#gaf9ee870d4922e488bdd3e7262485c270">vec_3d</a> *a, const <a class="el" href="../../de/d7b/group__vec__3d.html#gaf9ee870d4922e488bdd3e7262485c270">vec_3d</a> *b)</td></tr>
<tr class="memdesc:gae4a49e6bdf13df949e8b23c7925bb5f5"><td class="mdescLeft">&#160;</td><td class="mdescRight">Compute the vector product of two 3d vectors. <a href="../../de/d7b/group__vec__3d.html#gae4a49e6bdf13df949e8b23c7925bb5f5">More...</a><br /></td></tr>
<tr class="separator:gae4a49e6bdf13df949e8b23c7925bb5f5"><td class="memSeparator" colspan="2">&#160;</td></tr>
<tr class="memitem:gae25e1f2e973933bef65838601e2de0af"><td class="memItemLeft" align="right" valign="top">const char *&#160;</td><td class="memItemRight" valign="bottom"><a class="el" href="../../de/d7b/group__vec__3d.html#gae25e1f2e973933bef65838601e2de0af">print_vector</a> (const <a class="el" href="../../de/d7b/group__vec__3d.html#gaf9ee870d4922e488bdd3e7262485c270">vec_3d</a> *a, const char *name)</td></tr>
<tr class="memdesc:gae25e1f2e973933bef65838601e2de0af"><td class="mdescLeft">&#160;</td><td class="mdescRight">Print formatted vector on stdout. <a href="../../de/d7b/group__vec__3d.html#gae25e1f2e973933bef65838601e2de0af">More...</a><br /></td></tr>
<tr class="separator:gae25e1f2e973933bef65838601e2de0af"><td class="memSeparator" colspan="2">&#160;</td></tr>
<tr class="memitem:ga94805165d037d111d7d7c0df99e3a5de"><td class="memItemLeft" align="right" valign="top">float&#160;</td><td class="memItemRight" valign="bottom"><a class="el" href="../../de/d7b/group__vec__3d.html#ga94805165d037d111d7d7c0df99e3a5de">vector_norm</a> (const <a class="el" href="../../de/d7b/group__vec__3d.html#gaf9ee870d4922e488bdd3e7262485c270">vec_3d</a> *a)</td></tr>
<tr class="memdesc:ga94805165d037d111d7d7c0df99e3a5de"><td class="mdescLeft">&#160;</td><td class="mdescRight">Compute the norm a vector. <a href="../../de/d7b/group__vec__3d.html#ga94805165d037d111d7d7c0df99e3a5de">More...</a><br /></td></tr>
<tr class="separator:ga94805165d037d111d7d7c0df99e3a5de"><td class="memSeparator" colspan="2">&#160;</td></tr>
<tr class="memitem:ga3cdfd8378a0b115563ea6c561bb46b7e"><td class="memItemLeft" align="right" valign="top"><a class="el" href="../../de/d7b/group__vec__3d.html#gaf9ee870d4922e488bdd3e7262485c270">vec_3d</a>&#160;</td><td class="memItemRight" valign="bottom"><a class="el" href="../../de/d7b/group__vec__3d.html#ga3cdfd8378a0b115563ea6c561bb46b7e">unit_vec</a> (const <a class="el" href="../../de/d7b/group__vec__3d.html#gaf9ee870d4922e488bdd3e7262485c270">vec_3d</a> *a)</td></tr>
<tr class="memdesc:ga3cdfd8378a0b115563ea6c561bb46b7e"><td class="mdescLeft">&#160;</td><td class="mdescRight">Obtain unit vector in the same direction as given vector. <a href="../../de/d7b/group__vec__3d.html#ga3cdfd8378a0b115563ea6c561bb46b7e">More...</a><br /></td></tr>
<tr class="separator:ga3cdfd8378a0b115563ea6c561bb46b7e"><td class="memSeparator" colspan="2">&#160;</td></tr>
<tr class="memitem:ga5082b0720c2cc51ae84bf19bd76dc849"><td class="memItemLeft" align="right" valign="top"><a class="el" href="../../dd/d7a/group__matrix.html#ga9f844010cb96591fa94c9d533a500ab7">mat_3x3</a>&#160;</td><td class="memItemRight" valign="bottom"><a class="el" href="../../de/d7b/group__vec__3d.html#ga5082b0720c2cc51ae84bf19bd76dc849">get_cross_matrix</a> (const <a class="el" href="../../de/d7b/group__vec__3d.html#gaf9ee870d4922e488bdd3e7262485c270">vec_3d</a> *a)</td></tr>
<tr class="memdesc:ga5082b0720c2cc51ae84bf19bd76dc849"><td class="mdescLeft">&#160;</td><td class="mdescRight">The cross product of vectors can be represented as a matrix multiplication operation. <a href="../../de/d7b/group__vec__3d.html#ga5082b0720c2cc51ae84bf19bd76dc849">More...</a><br /></td></tr>
<tr class="separator:ga5082b0720c2cc51ae84bf19bd76dc849"><td class="memSeparator" colspan="2">&#160;</td></tr>
<tr class="memitem:ga55be1d766c8a824b35d97e79744834d8"><td class="memItemLeft" align="right" valign="top">double&#160;</td><td class="memItemRight" valign="bottom"><a class="el" href="../../de/d7b/group__vec__3d.html#ga55be1d766c8a824b35d97e79744834d8">get_angle</a> (const <a class="el" href="../../de/d7b/group__vec__3d.html#gaf9ee870d4922e488bdd3e7262485c270">vec_3d</a> *a, const <a class="el" href="../../de/d7b/group__vec__3d.html#gaf9ee870d4922e488bdd3e7262485c270">vec_3d</a> *b)</td></tr>
<tr class="memdesc:ga55be1d766c8a824b35d97e79744834d8"><td class="mdescLeft">&#160;</td><td class="mdescRight">Obtain the angle between two given vectors. <a href="../../de/d7b/group__vec__3d.html#ga55be1d766c8a824b35d97e79744834d8">More...</a><br /></td></tr>
<tr class="separator:ga55be1d766c8a824b35d97e79744834d8"><td class="memSeparator" colspan="2">&#160;</td></tr>
</table>
<a name="details" id="details"></a><h2 class="groupheader">Detailed Description</h2>
<h2 class="groupheader">Function Documentation</h2>
<a id="ga243e74d542d0d4d14fa3ae0bc2170d84" name="ga243e74d542d0d4d14fa3ae0bc2170d84"></a>
<h2 class="memtitle"><span class="permalink"><a href="#ga243e74d542d0d4d14fa3ae0bc2170d84">&#9670;&#160;</a></span>dot_prod()</h2>
<div class="memitem">
<div class="memproto">
<table class="memname">
<tr>
<td class="memname">float dot_prod </td>
<td>(</td>
<td class="paramtype">const <a class="el" href="../../de/d7b/group__vec__3d.html#gaf9ee870d4922e488bdd3e7262485c270">vec_3d</a> *&#160;</td>
<td class="paramname"><em>a</em>, </td>
</tr>
<tr>
<td class="paramkey"></td>
<td></td>
<td class="paramtype">const <a class="el" href="../../de/d7b/group__vec__3d.html#gaf9ee870d4922e488bdd3e7262485c270">vec_3d</a> *&#160;</td>
<td class="paramname"><em>b</em>&#160;</td>
</tr>
<tr>
<td></td>
<td>)</td>
<td></td><td></td>
</tr>
</table>
</div><div class="memdoc">
<p>Obtain the dot product of two 3D vectors. </p>
<p class="formulaDsp">
\[
\vec{a}\cdot\vec{b}=a_xb_x + a_yb_y + a_zb_z
\]
</p>
<dl class="params"><dt>Parameters</dt><dd>
<table class="params">
<tr><td class="paramdir">[in]</td><td class="paramname">a</td><td>first vector </td></tr>
<tr><td class="paramdir">[in]</td><td class="paramname">b</td><td>second vector </td></tr>
</table>
</dd>
</dl>
<dl class="section return"><dt>Returns</dt><dd>resulting dot product </dd></dl>
<div class="fragment"><div class="line"><span class="lineno"> 77</span>{</div>
<div class="line"><span class="lineno"> 78</span> <span class="keywordtype">float</span> dot;</div>
<div class="line"><span class="lineno"> 79</span><span class="preprocessor">#ifdef LIBQUAT_ARM</span></div>
<div class="line"><span class="lineno"> 80</span> arm_dot_prod_f32((<span class="keywordtype">float</span> *)a, (<span class="keywordtype">float</span> *)b, &amp;dot);</div>
<div class="line"><span class="lineno"> 81</span><span class="preprocessor">#else</span></div>
<div class="line"><span class="lineno"> 82</span> dot = a-&gt;x * b-&gt;<a class="code hl_variable" href="../../d5/db4/structvec__3d__.html#a53462a5a195c9e16fb584f73fd66c3d0">x</a>;</div>
<div class="line"><span class="lineno"> 83</span> dot += a-&gt;y * b-&gt;<a class="code hl_variable" href="../../d5/db4/structvec__3d__.html#a76098d39a382838df3b4b48c3443413b">y</a>;</div>
<div class="line"><span class="lineno"> 84</span> dot += a-&gt;z * b-&gt;<a class="code hl_variable" href="../../d5/db4/structvec__3d__.html#a3339a40de7385fa55bee30be81c098c6">z</a>;</div>
<div class="line"><span class="lineno"> 85</span><span class="preprocessor">#endif</span></div>
<div class="line"><span class="lineno"> 86</span> </div>
<div class="line"><span class="lineno"> 87</span> <span class="keywordflow">return</span> dot;</div>
<div class="line"><span class="lineno"> 88</span>}</div>
<div class="ttc" id="astructvec__3d___html_a3339a40de7385fa55bee30be81c098c6"><div class="ttname"><a href="../../d5/db4/structvec__3d__.html#a3339a40de7385fa55bee30be81c098c6">vec_3d_::z</a></div><div class="ttdeci">float z</div><div class="ttdoc">Z co-ordinate.</div><div class="ttdef"><b>Definition:</b> geometry_datatypes.h:25</div></div>
<div class="ttc" id="astructvec__3d___html_a53462a5a195c9e16fb584f73fd66c3d0"><div class="ttname"><a href="../../d5/db4/structvec__3d__.html#a53462a5a195c9e16fb584f73fd66c3d0">vec_3d_::x</a></div><div class="ttdeci">float x</div><div class="ttdoc">X co-ordinate.</div><div class="ttdef"><b>Definition:</b> geometry_datatypes.h:23</div></div>
<div class="ttc" id="astructvec__3d___html_a76098d39a382838df3b4b48c3443413b"><div class="ttname"><a href="../../d5/db4/structvec__3d__.html#a76098d39a382838df3b4b48c3443413b">vec_3d_::y</a></div><div class="ttdeci">float y</div><div class="ttdoc">Y co-ordinate.</div><div class="ttdef"><b>Definition:</b> geometry_datatypes.h:24</div></div>
</div><!-- fragment -->
</div>
</div>
<a id="ga55be1d766c8a824b35d97e79744834d8" name="ga55be1d766c8a824b35d97e79744834d8"></a>
<h2 class="memtitle"><span class="permalink"><a href="#ga55be1d766c8a824b35d97e79744834d8">&#9670;&#160;</a></span>get_angle()</h2>
<div class="memitem">
<div class="memproto">
<table class="memname">
<tr>
<td class="memname">double get_angle </td>
<td>(</td>
<td class="paramtype">const <a class="el" href="../../de/d7b/group__vec__3d.html#gaf9ee870d4922e488bdd3e7262485c270">vec_3d</a> *&#160;</td>
<td class="paramname"><em>a</em>, </td>
</tr>
<tr>
<td class="paramkey"></td>
<td></td>
<td class="paramtype">const <a class="el" href="../../de/d7b/group__vec__3d.html#gaf9ee870d4922e488bdd3e7262485c270">vec_3d</a> *&#160;</td>
<td class="paramname"><em>b</em>&#160;</td>
</tr>
<tr>
<td></td>
<td>)</td>
<td></td><td></td>
</tr>
</table>
</div><div class="memdoc">
<p>Obtain the angle between two given vectors. </p>
<p class="formulaDsp">
\[\alpha=acos\left(\frac{\vec{a} \cdot \vec{b}}{\lVert\vec{a}\rVert \cdot \lVert\vec{b}\rVert}\right)\]
</p>
<dl class="params"><dt>Parameters</dt><dd>
<table class="params">
<tr><td class="paramdir">[in]</td><td class="paramname">a</td><td>first input vector </td></tr>
<tr><td class="paramdir">[in]</td><td class="paramname">b</td><td>second input vector </td></tr>
</table>
</dd>
</dl>
<dl class="section return"><dt>Returns</dt><dd>angle between \(\vec{a}\) and \(\vec{b}\) in radians </dd></dl>
<p >&lt; The norm of vector a</p>
<p >&lt; The norm of vector b</p>
<p >detect possible division by 0 - the angle is not defined in this case</p>
<div class="fragment"><div class="line"><span class="lineno"> 203</span>{</div>
<div class="line"><span class="lineno"> 204</span> <span class="keywordtype">double</span> alpha, cos_alpha;</div>
<div class="line"><span class="lineno"> 205</span> <span class="keywordtype">float</span> norm_a = <a class="code hl_function" href="../../de/d7b/group__vec__3d.html#ga94805165d037d111d7d7c0df99e3a5de">vector_norm</a>(a); <span class="comment">///&lt; The norm of vector a</span></div>
<div class="line"><span class="lineno"> 206</span> <span class="keywordtype">float</span> norm_b = <a class="code hl_function" href="../../de/d7b/group__vec__3d.html#ga94805165d037d111d7d7c0df99e3a5de">vector_norm</a>(b); <span class="comment">///&lt; The norm of vector b</span></div>
<div class="line"><span class="lineno"> 207</span> <span class="keywordflow">if</span> (fabsf(norm_a) &lt; <a class="code hl_define" href="../../de/d5a/group__quaternions.html#ga002b2f4894492820fe708b1b7e7c5e70">EPSILON</a> || fabsf(norm_b) &lt; <a class="code hl_define" href="../../de/d5a/group__quaternions.html#ga002b2f4894492820fe708b1b7e7c5e70">EPSILON</a>) <span class="comment">/// detect possible division by 0 - the angle is not defined in this case</span></div>
<div class="line"><span class="lineno"> 208</span> { </div>
<div class="line"><span class="lineno"> 209</span> <span class="keywordflow">return</span> NAN; </div>
<div class="line"><span class="lineno"> 210</span> }</div>
<div class="line"><span class="lineno"> 211</span> </div>
<div class="line"><span class="lineno"> 212</span> cos_alpha = <a class="code hl_function" href="../../de/d7b/group__vec__3d.html#ga243e74d542d0d4d14fa3ae0bc2170d84">dot_prod</a>(a, b) / (norm_a * norm_b);</div>
<div class="line"><span class="lineno"> 213</span> alpha = acos(cos_alpha); <span class="comment">// delivers the radian</span></div>
<div class="line"><span class="lineno"> 214</span> <span class="keywordflow">return</span> alpha; <span class="comment">// in range from -1 to 1</span></div>
<div class="line"><span class="lineno"> 215</span>}</div>
<div class="ttc" id="agroup__quaternions_html_ga002b2f4894492820fe708b1b7e7c5e70"><div class="ttname"><a href="../../de/d5a/group__quaternions.html#ga002b2f4894492820fe708b1b7e7c5e70">EPSILON</a></div><div class="ttdeci">#define EPSILON</div><div class="ttdoc">Minimum recognizable value.</div><div class="ttdef"><b>Definition:</b> geometry_datatypes.h:14</div></div>
<div class="ttc" id="agroup__vec__3d_html_ga243e74d542d0d4d14fa3ae0bc2170d84"><div class="ttname"><a href="../../de/d7b/group__vec__3d.html#ga243e74d542d0d4d14fa3ae0bc2170d84">dot_prod</a></div><div class="ttdeci">float dot_prod(const vec_3d *a, const vec_3d *b)</div><div class="ttdoc">Obtain the dot product of two 3D vectors.</div><div class="ttdef"><b>Definition:</b> vectors_3d.c:76</div></div>
<div class="ttc" id="agroup__vec__3d_html_ga94805165d037d111d7d7c0df99e3a5de"><div class="ttname"><a href="../../de/d7b/group__vec__3d.html#ga94805165d037d111d7d7c0df99e3a5de">vector_norm</a></div><div class="ttdeci">float vector_norm(const vec_3d *a)</div><div class="ttdoc">Compute the norm a vector.</div><div class="ttdef"><b>Definition:</b> vectors_3d.c:138</div></div>
</div><!-- fragment --><div class="dynheader">
Here is the call graph for this function:</div>
<div class="dyncontent">
<div class="center"><iframe scrolling="no" frameborder="0" src="../../de/d7b/group__vec__3d_ga55be1d766c8a824b35d97e79744834d8_cgraph.svg" width="352" height="62"><p><b>This browser is not able to show SVG: try Firefox, Chrome, Safari, or Opera instead.</b></p></iframe>
</div>
</div>
</div>
</div>
<a id="ga5082b0720c2cc51ae84bf19bd76dc849" name="ga5082b0720c2cc51ae84bf19bd76dc849"></a>
<h2 class="memtitle"><span class="permalink"><a href="#ga5082b0720c2cc51ae84bf19bd76dc849">&#9670;&#160;</a></span>get_cross_matrix()</h2>
<div class="memitem">
<div class="memproto">
<table class="memname">
<tr>
<td class="memname"><a class="el" href="../../dd/d7a/group__matrix.html#ga9f844010cb96591fa94c9d533a500ab7">mat_3x3</a> get_cross_matrix </td>
<td>(</td>
<td class="paramtype">const <a class="el" href="../../de/d7b/group__vec__3d.html#gaf9ee870d4922e488bdd3e7262485c270">vec_3d</a> *&#160;</td>
<td class="paramname"><em>a</em></td><td>)</td>
<td></td>
</tr>
</table>
</div><div class="memdoc">
<p>The cross product of vectors can be represented as a matrix multiplication operation. </p>
<p >This function obtains the <code>3x3</code> matrix of the cross-product operator from the first vector. </p><p class="formulaDsp">
\[\begin{align*}
\left(\vec{a}\times\right)\vec{b} &amp;= \tilde{A}_a\vec{b}\\
\tilde{A}_a &amp;=
\begin{bmatrix}0&amp;-a_z&amp;a_y\\a_z&amp;0&amp;-a_x\\-a_y&amp;a_x&amp;0\end{bmatrix}
\end{align*}\]
</p>
<dl class="params"><dt>Parameters</dt><dd>
<table class="params">
<tr><td class="paramdir">[in]</td><td class="paramname">a</td><td>input vector </td></tr>
</table>
</dd>
</dl>
<dl class="section return"><dt>Returns</dt><dd>the <code>3x3</code> matrix for the cross product operator \(\left(\vec{a}\times\right)\) </dd></dl>
<div class="fragment"><div class="line"><span class="lineno"> 189</span>{</div>
<div class="line"><span class="lineno"> 190</span> <a class="code hl_struct" href="../../d9/d8b/structmat__3x3__.html">mat_3x3</a> A = {0., -a-&gt;z, a-&gt;y, a-&gt;z, 0., -a-&gt;x, -a-&gt;y, a-&gt;x, 0.};</div>
<div class="line"><span class="lineno"> 191</span> <span class="keywordflow">return</span> A;</div>
<div class="line"><span class="lineno"> 192</span>}</div>
<div class="ttc" id="astructmat__3x3___html"><div class="ttname"><a href="../../d9/d8b/structmat__3x3__.html">mat_3x3_</a></div><div class="ttdoc">A 3x3 Matrix type definition.</div><div class="ttdef"><b>Definition:</b> geometry_datatypes.h:35</div></div>
</div><!-- fragment -->
</div>
</div>
<a id="gae25e1f2e973933bef65838601e2de0af" name="gae25e1f2e973933bef65838601e2de0af"></a>
<h2 class="memtitle"><span class="permalink"><a href="#gae25e1f2e973933bef65838601e2de0af">&#9670;&#160;</a></span>print_vector()</h2>
<div class="memitem">
<div class="memproto">
<table class="memname">
<tr>
<td class="memname">const char * print_vector </td>
<td>(</td>
<td class="paramtype">const <a class="el" href="../../de/d7b/group__vec__3d.html#gaf9ee870d4922e488bdd3e7262485c270">vec_3d</a> *&#160;</td>
<td class="paramname"><em>a</em>, </td>
</tr>
<tr>
<td class="paramkey"></td>
<td></td>
<td class="paramtype">const char *&#160;</td>
<td class="paramname"><em>name</em>&#160;</td>
</tr>
<tr>
<td></td>
<td>)</td>
<td></td><td></td>
</tr>
</table>
</div><div class="memdoc">
<p>Print formatted vector on stdout. </p>
<dl class="params"><dt>Parameters</dt><dd>
<table class="params">
<tr><td class="paramdir">[in]</td><td class="paramname">a</td><td>vector to print </td></tr>
<tr><td class="paramdir">[in]</td><td class="paramname">name</td><td>name of the vector </td></tr>
</table>
</dd>
</dl>
<dl class="section return"><dt>Returns</dt><dd>string representation of vector </dd></dl>
<div class="fragment"><div class="line"><span class="lineno"> 123</span>{</div>
<div class="line"><span class="lineno"> 124</span> <span class="keyword">static</span> <span class="keywordtype">char</span> vec_str[100]; <span class="comment">// static to ensure the string life extends the</span></div>
<div class="line"><span class="lineno"> 125</span> <span class="comment">// life of function</span></div>
<div class="line"><span class="lineno"> 126</span> </div>
<div class="line"><span class="lineno"> 127</span> snprintf(vec_str, 99, <span class="stringliteral">&quot;vec(%s) = (%.3g)i + (%.3g)j + (%.3g)k\n&quot;</span>, name, a-&gt;x,</div>
<div class="line"><span class="lineno"> 128</span> a-&gt;y, a-&gt;z);</div>
<div class="line"><span class="lineno"> 129</span> <span class="keywordflow">return</span> vec_str;</div>
<div class="line"><span class="lineno"> 130</span>}</div>
</div><!-- fragment -->
</div>
</div>
<a id="ga3cdfd8378a0b115563ea6c561bb46b7e" name="ga3cdfd8378a0b115563ea6c561bb46b7e"></a>
<h2 class="memtitle"><span class="permalink"><a href="#ga3cdfd8378a0b115563ea6c561bb46b7e">&#9670;&#160;</a></span>unit_vec()</h2>
<div class="memitem">
<div class="memproto">
<table class="memname">
<tr>
<td class="memname"><a class="el" href="../../de/d7b/group__vec__3d.html#gaf9ee870d4922e488bdd3e7262485c270">vec_3d</a> unit_vec </td>
<td>(</td>
<td class="paramtype">const <a class="el" href="../../de/d7b/group__vec__3d.html#gaf9ee870d4922e488bdd3e7262485c270">vec_3d</a> *&#160;</td>
<td class="paramname"><em>a</em></td><td>)</td>
<td></td>
</tr>
</table>
</div><div class="memdoc">
<p>Obtain unit vector in the same direction as given vector. </p>
<p class="formulaDsp">
\[\hat{a}=\frac{\vec{a}}{\lVert\vec{a}\rVert}\]
</p>
<dl class="params"><dt>Parameters</dt><dd>
<table class="params">
<tr><td class="paramdir">[in]</td><td class="paramname">a</td><td>input vector </td></tr>
</table>
</dd>
</dl>
<dl class="section return"><dt>Returns</dt><dd>n unit vector in the direction of \(\vec{a}\) </dd></dl>
<div class="fragment"><div class="line"><span class="lineno"> 157</span>{</div>
<div class="line"><span class="lineno"> 158</span> <a class="code hl_struct" href="../../d5/db4/structvec__3d__.html">vec_3d</a> n = {0};</div>
<div class="line"><span class="lineno"> 159</span> </div>
<div class="line"><span class="lineno"> 160</span> <span class="keywordtype">float</span> norm = <a class="code hl_function" href="../../de/d7b/group__vec__3d.html#ga94805165d037d111d7d7c0df99e3a5de">vector_norm</a>(a);</div>
<div class="line"><span class="lineno"> 161</span> <span class="keywordflow">if</span> (fabsf(norm) &lt; <a class="code hl_define" href="../../de/d5a/group__quaternions.html#ga002b2f4894492820fe708b1b7e7c5e70">EPSILON</a>)</div>
<div class="line"><span class="lineno"> 162</span> { <span class="comment">// detect possible divide by 0</span></div>
<div class="line"><span class="lineno"> 163</span> <span class="keywordflow">return</span> n;</div>
<div class="line"><span class="lineno"> 164</span> }</div>
<div class="line"><span class="lineno"> 165</span> </div>
<div class="line"><span class="lineno"> 166</span> <span class="keywordflow">if</span> (norm != 1.F) <span class="comment">// perform division only if needed</span></div>
<div class="line"><span class="lineno"> 167</span> {</div>
<div class="line"><span class="lineno"> 168</span> n.<a class="code hl_variable" href="../../d5/db4/structvec__3d__.html#a53462a5a195c9e16fb584f73fd66c3d0">x</a> = a-&gt;x / norm;</div>
<div class="line"><span class="lineno"> 169</span> n.<a class="code hl_variable" href="../../d5/db4/structvec__3d__.html#a76098d39a382838df3b4b48c3443413b">y</a> = a-&gt;y / norm;</div>
<div class="line"><span class="lineno"> 170</span> n.<a class="code hl_variable" href="../../d5/db4/structvec__3d__.html#a3339a40de7385fa55bee30be81c098c6">z</a> = a-&gt;z / norm;</div>
<div class="line"><span class="lineno"> 171</span> }</div>
<div class="line"><span class="lineno"> 172</span> <span class="keywordflow">return</span> n;</div>
<div class="line"><span class="lineno"> 173</span>}</div>
<div class="ttc" id="astructvec__3d___html"><div class="ttname"><a href="../../d5/db4/structvec__3d__.html">vec_3d_</a></div><div class="ttdoc">3D vector type</div><div class="ttdef"><b>Definition:</b> geometry_datatypes.h:22</div></div>
</div><!-- fragment --><div class="dynheader">
Here is the call graph for this function:</div>
<div class="dyncontent">
<div class="center"><iframe scrolling="no" frameborder="0" src="../../de/d7b/group__vec__3d_ga3cdfd8378a0b115563ea6c561bb46b7e_cgraph.svg" width="344" height="36"><p><b>This browser is not able to show SVG: try Firefox, Chrome, Safari, or Opera instead.</b></p></iframe>
</div>
</div>
</div>
</div>
<a id="gaa6b5ac18429ffb0131dc8593d31c25a4" name="gaa6b5ac18429ffb0131dc8593d31c25a4"></a>
<h2 class="memtitle"><span class="permalink"><a href="#gaa6b5ac18429ffb0131dc8593d31c25a4">&#9670;&#160;</a></span>vector_add()</h2>
<div class="memitem">
<div class="memproto">
<table class="memname">
<tr>
<td class="memname"><a class="el" href="../../de/d7b/group__vec__3d.html#gaf9ee870d4922e488bdd3e7262485c270">vec_3d</a> vector_add </td>
<td>(</td>
<td class="paramtype">const <a class="el" href="../../de/d7b/group__vec__3d.html#gaf9ee870d4922e488bdd3e7262485c270">vec_3d</a> *&#160;</td>
<td class="paramname"><em>a</em>, </td>
</tr>
<tr>
<td class="paramkey"></td>
<td></td>
<td class="paramtype">const <a class="el" href="../../de/d7b/group__vec__3d.html#gaf9ee870d4922e488bdd3e7262485c270">vec_3d</a> *&#160;</td>
<td class="paramname"><em>b</em>&#160;</td>
</tr>
<tr>
<td></td>
<td>)</td>
<td></td><td></td>
</tr>
</table>
</div><div class="memdoc">
<p>Add one vector to another. </p>
<p class="formulaDsp">
\[
\vec{c}=\vec{a}+\vec{b}=\left(a_x+b_x\right)\hat{i}+
\left(a_y+b_y\right)\hat{j}+\left(a_z+b_z\right)\hat{k}\]
</p>
<dl class="params"><dt>Parameters</dt><dd>
<table class="params">
<tr><td class="paramdir">[in]</td><td class="paramname">a</td><td>vector to add to </td></tr>
<tr><td class="paramdir">[in]</td><td class="paramname">b</td><td>vector to add </td></tr>
</table>
</dd>
</dl>
<dl class="section return"><dt>Returns</dt><dd>resultant vector </dd></dl>
<div class="fragment"><div class="line"><span class="lineno"> 54</span>{</div>
<div class="line"><span class="lineno"> 55</span> <a class="code hl_struct" href="../../d5/db4/structvec__3d__.html">vec_3d</a> out;</div>
<div class="line"><span class="lineno"> 56</span><span class="preprocessor">#ifdef LIBQUAT_ARM</span></div>
<div class="line"><span class="lineno"> 57</span> arm_add_f32((<span class="keywordtype">float</span> *)a, (<span class="keywordtype">float</span> *)b, (<span class="keywordtype">float</span> *)&amp;out);</div>
<div class="line"><span class="lineno"> 58</span><span class="preprocessor">#else</span></div>
<div class="line"><span class="lineno"> 59</span> out.<a class="code hl_variable" href="../../d5/db4/structvec__3d__.html#a53462a5a195c9e16fb584f73fd66c3d0">x</a> = a-&gt;x + b-&gt;x;</div>
<div class="line"><span class="lineno"> 60</span> out.<a class="code hl_variable" href="../../d5/db4/structvec__3d__.html#a76098d39a382838df3b4b48c3443413b">y</a> = a-&gt;y + b-&gt;y;</div>
<div class="line"><span class="lineno"> 61</span> out.<a class="code hl_variable" href="../../d5/db4/structvec__3d__.html#a3339a40de7385fa55bee30be81c098c6">z</a> = a-&gt;z + b-&gt;z;</div>
<div class="line"><span class="lineno"> 62</span><span class="preprocessor">#endif</span></div>
<div class="line"><span class="lineno"> 63</span> </div>
<div class="line"><span class="lineno"> 64</span> <span class="keywordflow">return</span> out;</div>
<div class="line"><span class="lineno"> 65</span>}</div>
</div><!-- fragment -->
</div>
</div>
<a id="ga94805165d037d111d7d7c0df99e3a5de" name="ga94805165d037d111d7d7c0df99e3a5de"></a>
<h2 class="memtitle"><span class="permalink"><a href="#ga94805165d037d111d7d7c0df99e3a5de">&#9670;&#160;</a></span>vector_norm()</h2>
<div class="memitem">
<div class="memproto">
<table class="memname">
<tr>
<td class="memname">float vector_norm </td>
<td>(</td>
<td class="paramtype">const <a class="el" href="../../de/d7b/group__vec__3d.html#gaf9ee870d4922e488bdd3e7262485c270">vec_3d</a> *&#160;</td>
<td class="paramname"><em>a</em></td><td>)</td>
<td></td>
</tr>
</table>
</div><div class="memdoc">
<p>Compute the norm a vector. </p>
<p class="formulaDsp">
\[\lVert\vec{a}\rVert = \sqrt{\vec{a}\cdot\vec{a}} \]
</p>
<dl class="params"><dt>Parameters</dt><dd>
<table class="params">
<tr><td class="paramdir">[in]</td><td class="paramname">a</td><td>input vector </td></tr>
</table>
</dd>
</dl>
<dl class="section return"><dt>Returns</dt><dd>norm of the given vector </dd></dl>
<div class="fragment"><div class="line"><span class="lineno"> 139</span>{</div>
<div class="line"><span class="lineno"> 140</span> <span class="keywordtype">float</span> n = <a class="code hl_function" href="../../de/d7b/group__vec__3d.html#ga243e74d542d0d4d14fa3ae0bc2170d84">dot_prod</a>(a, a);</div>
<div class="line"><span class="lineno"> 141</span><span class="preprocessor">#ifdef LIBQUAT_ARM</span></div>
<div class="line"><span class="lineno"> 142</span> arm_sqrt_f32(*n, n);</div>
<div class="line"><span class="lineno"> 143</span><span class="preprocessor">#else</span></div>
<div class="line"><span class="lineno"> 144</span> n = sqrtf(n);</div>
<div class="line"><span class="lineno"> 145</span><span class="preprocessor">#endif</span></div>
<div class="line"><span class="lineno"> 146</span> </div>
<div class="line"><span class="lineno"> 147</span> <span class="keywordflow">return</span> n;</div>
<div class="line"><span class="lineno"> 148</span>}</div>
</div><!-- fragment --><div class="dynheader">
Here is the call graph for this function:</div>
<div class="dyncontent">
<div class="center"><iframe scrolling="no" frameborder="0" src="../../de/d7b/group__vec__3d_ga94805165d037d111d7d7c0df99e3a5de_cgraph.svg" width="226" height="36"><p><b>This browser is not able to show SVG: try Firefox, Chrome, Safari, or Opera instead.</b></p></iframe>
</div>
</div>
</div>
</div>
<a id="gae4a49e6bdf13df949e8b23c7925bb5f5" name="gae4a49e6bdf13df949e8b23c7925bb5f5"></a>
<h2 class="memtitle"><span class="permalink"><a href="#gae4a49e6bdf13df949e8b23c7925bb5f5">&#9670;&#160;</a></span>vector_prod()</h2>
<div class="memitem">
<div class="memproto">
<table class="memname">
<tr>
<td class="memname"><a class="el" href="../../de/d7b/group__vec__3d.html#gaf9ee870d4922e488bdd3e7262485c270">vec_3d</a> vector_prod </td>
<td>(</td>
<td class="paramtype">const <a class="el" href="../../de/d7b/group__vec__3d.html#gaf9ee870d4922e488bdd3e7262485c270">vec_3d</a> *&#160;</td>
<td class="paramname"><em>a</em>, </td>
</tr>
<tr>
<td class="paramkey"></td>
<td></td>
<td class="paramtype">const <a class="el" href="../../de/d7b/group__vec__3d.html#gaf9ee870d4922e488bdd3e7262485c270">vec_3d</a> *&#160;</td>
<td class="paramname"><em>b</em>&#160;</td>
</tr>
<tr>
<td></td>
<td>)</td>
<td></td><td></td>
</tr>
</table>
</div><div class="memdoc">
<p>Compute the vector product of two 3d vectors. </p>
<p class="formulaDsp">
\[\begin{align*}
\vec{a}\times\vec{b} &amp;= \begin{vmatrix}
\hat{i} &amp; \hat{j} &amp; \hat{k}\\
a_x &amp; a_y &amp; a_z\\
b_x &amp; b_y &amp; b_z
\end{vmatrix}\\
&amp;= \left(a_yb_z-b_ya_z\right)\hat{i} - \left(a_xb_z-b_xa_z\right)\hat{j}
+ \left(a_xb_y-b_xa_y\right)\hat{k} \end{align*}
\]
</p>
<dl class="params"><dt>Parameters</dt><dd>
<table class="params">
<tr><td class="paramdir">[in]</td><td class="paramname">a</td><td>first vector \(\vec{a}\) </td></tr>
<tr><td class="paramdir">[in]</td><td class="paramname">b</td><td>second vector \(\vec{b}\) </td></tr>
</table>
</dd>
</dl>
<dl class="section return"><dt>Returns</dt><dd>resultant vector \(\vec{o}=\vec{a}\times\vec{b}\) </dd></dl>
<div class="fragment"><div class="line"><span class="lineno"> 106</span>{</div>
<div class="line"><span class="lineno"> 107</span> <a class="code hl_struct" href="../../d5/db4/structvec__3d__.html">vec_3d</a> out; <span class="comment">// better this way to avoid copying results to input</span></div>
<div class="line"><span class="lineno"> 108</span> <span class="comment">// vectors themselves</span></div>
<div class="line"><span class="lineno"> 109</span> out.<a class="code hl_variable" href="../../d5/db4/structvec__3d__.html#a53462a5a195c9e16fb584f73fd66c3d0">x</a> = a-&gt;y * b-&gt;<a class="code hl_variable" href="../../d5/db4/structvec__3d__.html#a3339a40de7385fa55bee30be81c098c6">z</a> - a-&gt;z * b-&gt;<a class="code hl_variable" href="../../d5/db4/structvec__3d__.html#a76098d39a382838df3b4b48c3443413b">y</a>;</div>
<div class="line"><span class="lineno"> 110</span> out.<a class="code hl_variable" href="../../d5/db4/structvec__3d__.html#a76098d39a382838df3b4b48c3443413b">y</a> = -a-&gt;x * b-&gt;<a class="code hl_variable" href="../../d5/db4/structvec__3d__.html#a3339a40de7385fa55bee30be81c098c6">z</a> + a-&gt;z * b-&gt;<a class="code hl_variable" href="../../d5/db4/structvec__3d__.html#a53462a5a195c9e16fb584f73fd66c3d0">x</a>;</div>
<div class="line"><span class="lineno"> 111</span> out.<a class="code hl_variable" href="../../d5/db4/structvec__3d__.html#a3339a40de7385fa55bee30be81c098c6">z</a> = a-&gt;x * b-&gt;<a class="code hl_variable" href="../../d5/db4/structvec__3d__.html#a76098d39a382838df3b4b48c3443413b">y</a> - a-&gt;y * b-&gt;<a class="code hl_variable" href="../../d5/db4/structvec__3d__.html#a53462a5a195c9e16fb584f73fd66c3d0">x</a>;</div>
<div class="line"><span class="lineno"> 112</span> </div>
<div class="line"><span class="lineno"> 113</span> <span class="keywordflow">return</span> out;</div>
<div class="line"><span class="lineno"> 114</span>}</div>
</div><!-- fragment -->
</div>
</div>
<a id="ga97da356cb7d5da73a0ac9bad09a435cc" name="ga97da356cb7d5da73a0ac9bad09a435cc"></a>
<h2 class="memtitle"><span class="permalink"><a href="#ga97da356cb7d5da73a0ac9bad09a435cc">&#9670;&#160;</a></span>vector_sub()</h2>
<div class="memitem">
<div class="memproto">
<table class="memname">
<tr>
<td class="memname"><a class="el" href="../../de/d7b/group__vec__3d.html#gaf9ee870d4922e488bdd3e7262485c270">vec_3d</a> vector_sub </td>
<td>(</td>
<td class="paramtype">const <a class="el" href="../../de/d7b/group__vec__3d.html#gaf9ee870d4922e488bdd3e7262485c270">vec_3d</a> *&#160;</td>
<td class="paramname"><em>a</em>, </td>
</tr>
<tr>
<td class="paramkey"></td>
<td></td>
<td class="paramtype">const <a class="el" href="../../de/d7b/group__vec__3d.html#gaf9ee870d4922e488bdd3e7262485c270">vec_3d</a> *&#160;</td>
<td class="paramname"><em>b</em>&#160;</td>
</tr>
<tr>
<td></td>
<td>)</td>
<td></td><td></td>
</tr>
</table>
</div><div class="memdoc">
<p>Subtract one vector from another. </p>
<p class="formulaDsp">
\[
\vec{c}=\vec{a}-\vec{b}=\left(a_x-b_x\right)\hat{i}+
\left(a_y-b_y\right)\hat{j}+\left(a_z-b_z\right)\hat{k}\]
</p>
<dl class="params"><dt>Parameters</dt><dd>
<table class="params">
<tr><td class="paramdir">[in]</td><td class="paramname">a</td><td>vector to subtract from </td></tr>
<tr><td class="paramdir">[in]</td><td class="paramname">b</td><td>vector to subtract </td></tr>
</table>
</dd>
</dl>
<dl class="section return"><dt>Returns</dt><dd>resultant vector </dd></dl>
<div class="fragment"><div class="line"><span class="lineno"> 32</span>{</div>
<div class="line"><span class="lineno"> 33</span> <a class="code hl_struct" href="../../d5/db4/structvec__3d__.html">vec_3d</a> out;</div>
<div class="line"><span class="lineno"> 34</span><span class="preprocessor">#ifdef LIBQUAT_ARM</span></div>
<div class="line"><span class="lineno"> 35</span> arm_sub_f32((<span class="keywordtype">float</span> *)a, (<span class="keywordtype">float</span> *)b, (<span class="keywordtype">float</span> *)&amp;out);</div>
<div class="line"><span class="lineno"> 36</span><span class="preprocessor">#else</span></div>
<div class="line"><span class="lineno"> 37</span> out.<a class="code hl_variable" href="../../d5/db4/structvec__3d__.html#a53462a5a195c9e16fb584f73fd66c3d0">x</a> = a-&gt;x - b-&gt;x;</div>
<div class="line"><span class="lineno"> 38</span> out.<a class="code hl_variable" href="../../d5/db4/structvec__3d__.html#a76098d39a382838df3b4b48c3443413b">y</a> = a-&gt;y - b-&gt;y;</div>
<div class="line"><span class="lineno"> 39</span> out.<a class="code hl_variable" href="../../d5/db4/structvec__3d__.html#a3339a40de7385fa55bee30be81c098c6">z</a> = a-&gt;z - b-&gt;z;</div>
<div class="line"><span class="lineno"> 40</span><span class="preprocessor">#endif</span></div>
<div class="line"><span class="lineno"> 41</span> </div>
<div class="line"><span class="lineno"> 42</span> <span class="keywordflow">return</span> out;</div>
<div class="line"><span class="lineno"> 43</span>}</div>
</div><!-- fragment -->
</div>
</div>
</div><!-- contents -->
</div><!-- doc-content -->
<!-- start footer part -->
<div id="nav-path" class="navpath"><!-- id is needed for treeview function! -->
<ul>
<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.9.5 </li>
</ul>
</div>
</body>
</html>