mirror of https://github.com/ArduPilot/ardupilot
224 lines
30 KiB
HTML
224 lines
30 KiB
HTML
<!DOCTYPE html PUBLIC "-//W3C//DTD XHTML 1.0 Transitional//EN" "http://www.w3.org/TR/xhtml1/DTD/xhtml1-transitional.dtd">
|
||
<html xmlns="http://www.w3.org/1999/xhtml">
|
||
<head>
|
||
<meta http-equiv="Content-Type" content="text/xhtml;charset=UTF-8"/>
|
||
<title>ArduPilot Libraries: vector3.h Source File</title>
|
||
<link href="tabs.css" rel="stylesheet" type="text/css"/>
|
||
<link href="search/search.css" rel="stylesheet" type="text/css"/>
|
||
<script type="text/javaScript" src="search/search.js"></script>
|
||
<link href="doxygen.css" rel="stylesheet" type="text/css"/>
|
||
</head>
|
||
<body onload='searchBox.OnSelectItem(0);'>
|
||
<!-- Generated by Doxygen 1.7.1 -->
|
||
<div class="navigation" id="top">
|
||
<div class="tabs">
|
||
<ul class="tablist">
|
||
<li><a href="main.html"><span>Main Page</span></a></li>
|
||
<li><a href="pages.html"><span>Related Pages</span></a></li>
|
||
<li><a href="namespaces.html"><span>Namespaces</span></a></li>
|
||
<li><a href="annotated.html"><span>Classes</span></a></li>
|
||
<li class="current"><a href="files.html"><span>Files</span></a></li>
|
||
</ul>
|
||
</div>
|
||
<div class="tabs2">
|
||
<ul class="tablist">
|
||
<li><a href="files.html"><span>File List</span></a></li>
|
||
<li><a href="globals.html"><span>File Members</span></a></li>
|
||
</ul>
|
||
</div>
|
||
<div class="header">
|
||
<div class="headertitle">
|
||
<h1>vector3.h</h1> </div>
|
||
</div>
|
||
<div class="contents">
|
||
<a href="vector3_8h.html">Go to the documentation of this file.</a><div class="fragment"><pre class="fragment"><a name="l00001"></a>00001 <span class="comment">// -*- tab-width: 4; Mode: C++; c-basic-offset: 4; indent-tabs-mode: t -*-</span>
|
||
<a name="l00002"></a>00002
|
||
<a name="l00003"></a>00003 <span class="comment">// Copyright 2010 Michael Smith, all rights reserved.</span>
|
||
<a name="l00004"></a>00004
|
||
<a name="l00005"></a>00005 <span class="comment">// This library is free software; you can redistribute it and / or</span>
|
||
<a name="l00006"></a>00006 <span class="comment">// modify it under the terms of the GNU Lesser General Public</span>
|
||
<a name="l00007"></a>00007 <span class="comment">// License as published by the Free Software Foundation; either</span>
|
||
<a name="l00008"></a>00008 <span class="comment">// version 2.1 of the License, or (at your option) any later version.</span>
|
||
<a name="l00009"></a>00009
|
||
<a name="l00010"></a>00010 <span class="comment">// Derived closely from:</span>
|
||
<a name="l00011"></a>00011 <span class="comment">/****************************************</span>
|
||
<a name="l00012"></a>00012 <span class="comment"> * 3D Vector Classes</span>
|
||
<a name="l00013"></a>00013 <span class="comment"> * By Bill Perone (billperone@yahoo.com)</span>
|
||
<a name="l00014"></a>00014 <span class="comment"> * Original: 9-16-2002</span>
|
||
<a name="l00015"></a>00015 <span class="comment"> * Revised: 19-11-2003</span>
|
||
<a name="l00016"></a>00016 <span class="comment"> * 11-12-2003</span>
|
||
<a name="l00017"></a>00017 <span class="comment"> * 18-12-2003</span>
|
||
<a name="l00018"></a>00018 <span class="comment"> * 06-06-2004</span>
|
||
<a name="l00019"></a>00019 <span class="comment"> *</span>
|
||
<a name="l00020"></a>00020 <span class="comment"> * <20> 2003, This code is provided "as is" and you can use it freely as long as</span>
|
||
<a name="l00021"></a>00021 <span class="comment"> * credit is given to Bill Perone in the application it is used in</span>
|
||
<a name="l00022"></a>00022 <span class="comment"> *</span>
|
||
<a name="l00023"></a>00023 <span class="comment"> * Notes:</span>
|
||
<a name="l00024"></a>00024 <span class="comment"> * if a*b = 0 then a & b are orthogonal</span>
|
||
<a name="l00025"></a>00025 <span class="comment"> * a%b = -b%a</span>
|
||
<a name="l00026"></a>00026 <span class="comment"> * a*(b%c) = (a%b)*c</span>
|
||
<a name="l00027"></a>00027 <span class="comment"> * a%b = a(cast to matrix)*b</span>
|
||
<a name="l00028"></a>00028 <span class="comment"> * (a%b).length() = area of parallelogram formed by a & b</span>
|
||
<a name="l00029"></a>00029 <span class="comment"> * (a%b).length() = a.length()*b.length() * sin(angle between a & b)</span>
|
||
<a name="l00030"></a>00030 <span class="comment"> * (a%b).length() = 0 if angle between a & b = 0 or a.length() = 0 or b.length() = 0</span>
|
||
<a name="l00031"></a>00031 <span class="comment"> * a * (b%c) = volume of parallelpiped formed by a, b, c</span>
|
||
<a name="l00032"></a>00032 <span class="comment"> * vector triple product: a%(b%c) = b*(a*c) - c*(a*b)</span>
|
||
<a name="l00033"></a>00033 <span class="comment"> * scalar triple product: a*(b%c) = c*(a%b) = b*(c%a)</span>
|
||
<a name="l00034"></a>00034 <span class="comment"> * vector quadruple product: (a%b)*(c%d) = (a*c)*(b*d) - (a*d)*(b*c)</span>
|
||
<a name="l00035"></a>00035 <span class="comment"> * if a is unit vector along b then a%b = -b%a = -b(cast to matrix)*a = 0</span>
|
||
<a name="l00036"></a>00036 <span class="comment"> * vectors a1...an are linearly dependant if there exists a vector of scalars (b) where a1*b1 + ... + an*bn = 0</span>
|
||
<a name="l00037"></a>00037 <span class="comment"> * or if the matrix (A) * b = 0</span>
|
||
<a name="l00038"></a>00038 <span class="comment"> *</span>
|
||
<a name="l00039"></a>00039 <span class="comment"> ****************************************/</span>
|
||
<a name="l00040"></a>00040
|
||
<a name="l00041"></a>00041 <span class="preprocessor">#ifndef VECTOR3_H</span>
|
||
<a name="l00042"></a>00042 <span class="preprocessor"></span><span class="preprocessor">#define VECTOR3_H</span>
|
||
<a name="l00043"></a>00043 <span class="preprocessor"></span>
|
||
<a name="l00044"></a>00044 <span class="preprocessor">#include <math.h></span>
|
||
<a name="l00045"></a>00045 <span class="preprocessor">#include <string.h></span>
|
||
<a name="l00046"></a>00046
|
||
<a name="l00047"></a>00047 <span class="keyword">template</span> <<span class="keyword">typename</span> T>
|
||
<a name="l00048"></a><a class="code" href="class_vector3.html">00048</a> <span class="keyword">class </span><a class="code" href="class_vector3.html">Vector3</a>
|
||
<a name="l00049"></a>00049 {
|
||
<a name="l00050"></a>00050 <span class="keyword">public</span>:
|
||
<a name="l00051"></a><a class="code" href="class_vector3.html#ab3e7f5401dd6e951978bfa746809f74f">00051</a> T <a class="code" href="class_vector3.html#a1a0f7e168c71ca798099f0ba8a444244">x</a>, <a class="code" href="class_vector3.html#a561df88b28e106e337a25bb86554a569">y</a>, <a class="code" href="class_vector3.html#ab3e7f5401dd6e951978bfa746809f74f">z</a>;
|
||
<a name="l00052"></a>00052
|
||
<a name="l00053"></a>00053 <span class="comment">// trivial ctor</span>
|
||
<a name="l00054"></a>00054 <a class="code" href="class_vector3.html">Vector3<T></a>() { <a class="code" href="class_vector3.html#a1a0f7e168c71ca798099f0ba8a444244">x</a> = <a class="code" href="class_vector3.html#a561df88b28e106e337a25bb86554a569">y</a> = <a class="code" href="class_vector3.html#a1a0f7e168c71ca798099f0ba8a444244">x</a> = 0; }
|
||
<a name="l00055"></a>00055
|
||
<a name="l00056"></a>00056 <span class="comment">// setting ctor</span>
|
||
<a name="l00057"></a>00057 <a class="code" href="class_vector3.html">Vector3<T></a>(<span class="keyword">const</span> T x0, <span class="keyword">const</span> T y0, <span class="keyword">const</span> T z0): <a class="code" href="class_vector3.html#a1a0f7e168c71ca798099f0ba8a444244">x</a>(x0), <a class="code" href="class_vector3.html#a561df88b28e106e337a25bb86554a569">y</a>(y0), <a class="code" href="class_vector3.html#ab3e7f5401dd6e951978bfa746809f74f">z</a>(z0) {}
|
||
<a name="l00058"></a>00058
|
||
<a name="l00059"></a>00059 <span class="comment">// function call operator</span>
|
||
<a name="l00060"></a><a class="code" href="class_vector3.html#a593cdfdbdd00afcd740bc779cc6d9c73">00060</a> <span class="keywordtype">void</span> <a class="code" href="class_vector3.html#a593cdfdbdd00afcd740bc779cc6d9c73">operator ()</a>(<span class="keyword">const</span> T x0, <span class="keyword">const</span> T y0, <span class="keyword">const</span> T z0)
|
||
<a name="l00061"></a>00061 { <a class="code" href="class_vector3.html#a1a0f7e168c71ca798099f0ba8a444244">x</a>= x0; <a class="code" href="class_vector3.html#a561df88b28e106e337a25bb86554a569">y</a>= y0; <a class="code" href="class_vector3.html#ab3e7f5401dd6e951978bfa746809f74f">z</a>= z0; }
|
||
<a name="l00062"></a>00062
|
||
<a name="l00063"></a>00063 <span class="comment">// test for equality</span>
|
||
<a name="l00064"></a><a class="code" href="class_vector3.html#a306a028b0edcbbb511ff2a6ed0b58430">00064</a> <span class="keywordtype">bool</span> <a class="code" href="class_vector3.html#a306a028b0edcbbb511ff2a6ed0b58430">operator==</a>(<span class="keyword">const</span> <a class="code" href="class_vector3.html">Vector3<T></a> &v)
|
||
<a name="l00065"></a>00065 { <span class="keywordflow">return</span> (<a class="code" href="class_vector3.html#a1a0f7e168c71ca798099f0ba8a444244">x</a>==v.<a class="code" href="class_vector3.html#a1a0f7e168c71ca798099f0ba8a444244">x</a> && <a class="code" href="class_vector3.html#a561df88b28e106e337a25bb86554a569">y</a>==v.<a class="code" href="class_vector3.html#a561df88b28e106e337a25bb86554a569">y</a> && <a class="code" href="class_vector3.html#ab3e7f5401dd6e951978bfa746809f74f">z</a>==v.<a class="code" href="class_vector3.html#ab3e7f5401dd6e951978bfa746809f74f">z</a>); }
|
||
<a name="l00066"></a>00066
|
||
<a name="l00067"></a>00067 <span class="comment">// test for inequality</span>
|
||
<a name="l00068"></a><a class="code" href="class_vector3.html#a453097fe6164e4894fa419abc47dac8b">00068</a> <span class="keywordtype">bool</span> <a class="code" href="class_vector3.html#a453097fe6164e4894fa419abc47dac8b">operator!=</a>(<span class="keyword">const</span> <a class="code" href="class_vector3.html">Vector3<T></a> &v)
|
||
<a name="l00069"></a>00069 { <span class="keywordflow">return</span> (<a class="code" href="class_vector3.html#a1a0f7e168c71ca798099f0ba8a444244">x</a>!=v.<a class="code" href="class_vector3.html#a1a0f7e168c71ca798099f0ba8a444244">x</a> || <a class="code" href="class_vector3.html#a561df88b28e106e337a25bb86554a569">y</a>!=v.<a class="code" href="class_vector3.html#a561df88b28e106e337a25bb86554a569">y</a> || <a class="code" href="class_vector3.html#ab3e7f5401dd6e951978bfa746809f74f">z</a>!=v.<a class="code" href="class_vector3.html#ab3e7f5401dd6e951978bfa746809f74f">z</a>); }
|
||
<a name="l00070"></a>00070
|
||
<a name="l00071"></a>00071 <span class="comment">// negation</span>
|
||
<a name="l00072"></a><a class="code" href="class_vector3.html#a08b022c11e783bf75d32313b2dd39af7">00072</a> <a class="code" href="class_vector3.html">Vector3<T></a> <a class="code" href="class_vector3.html#a08b022c11e783bf75d32313b2dd39af7">operator -</a>(<span class="keywordtype">void</span>)<span class="keyword"> const</span>
|
||
<a name="l00073"></a>00073 <span class="keyword"> </span>{ <span class="keywordflow">return</span> <a class="code" href="class_vector3.html">Vector3<T></a>(-<a class="code" href="class_vector3.html#a1a0f7e168c71ca798099f0ba8a444244">x</a>,-<a class="code" href="class_vector3.html#a561df88b28e106e337a25bb86554a569">y</a>,-<a class="code" href="class_vector3.html#ab3e7f5401dd6e951978bfa746809f74f">z</a>); }
|
||
<a name="l00074"></a>00074
|
||
<a name="l00075"></a>00075 <span class="comment">// addition</span>
|
||
<a name="l00076"></a><a class="code" href="class_vector3.html#a866eb5f699307c46abd919e9e28cf874">00076</a> <a class="code" href="class_vector3.html">Vector3<T></a> <a class="code" href="class_vector3.html#a866eb5f699307c46abd919e9e28cf874">operator +</a>(<span class="keyword">const</span> <a class="code" href="class_vector3.html">Vector3<T></a> &v)<span class="keyword"> const</span>
|
||
<a name="l00077"></a>00077 <span class="keyword"> </span>{ <span class="keywordflow">return</span> <a class="code" href="class_vector3.html">Vector3<T></a>(<a class="code" href="class_vector3.html#a1a0f7e168c71ca798099f0ba8a444244">x</a>+v.<a class="code" href="class_vector3.html#a1a0f7e168c71ca798099f0ba8a444244">x</a>, <a class="code" href="class_vector3.html#a561df88b28e106e337a25bb86554a569">y</a>+v.<a class="code" href="class_vector3.html#a561df88b28e106e337a25bb86554a569">y</a>, <a class="code" href="class_vector3.html#ab3e7f5401dd6e951978bfa746809f74f">z</a>+v.<a class="code" href="class_vector3.html#ab3e7f5401dd6e951978bfa746809f74f">z</a>); }
|
||
<a name="l00078"></a>00078
|
||
<a name="l00079"></a>00079 <span class="comment">// subtraction</span>
|
||
<a name="l00080"></a><a class="code" href="class_vector3.html#a628d97651648b0d46ebb0ecd60d357a1">00080</a> <a class="code" href="class_vector3.html">Vector3<T></a> <a class="code" href="class_vector3.html#a08b022c11e783bf75d32313b2dd39af7">operator -</a>(<span class="keyword">const</span> <a class="code" href="class_vector3.html">Vector3<T></a> &v)<span class="keyword"> const</span>
|
||
<a name="l00081"></a>00081 <span class="keyword"> </span>{ <span class="keywordflow">return</span> <a class="code" href="class_vector3.html">Vector3<T></a>(<a class="code" href="class_vector3.html#a1a0f7e168c71ca798099f0ba8a444244">x</a>-v.<a class="code" href="class_vector3.html#a1a0f7e168c71ca798099f0ba8a444244">x</a>, <a class="code" href="class_vector3.html#a561df88b28e106e337a25bb86554a569">y</a>-v.<a class="code" href="class_vector3.html#a561df88b28e106e337a25bb86554a569">y</a>, <a class="code" href="class_vector3.html#ab3e7f5401dd6e951978bfa746809f74f">z</a>-v.<a class="code" href="class_vector3.html#ab3e7f5401dd6e951978bfa746809f74f">z</a>); }
|
||
<a name="l00082"></a>00082
|
||
<a name="l00083"></a>00083 <span class="comment">// uniform scaling</span>
|
||
<a name="l00084"></a><a class="code" href="class_vector3.html#ab8eb35a54b6dc4a3180a8d44e8543826">00084</a> <a class="code" href="class_vector3.html">Vector3<T></a> <a class="code" href="class_vector3.html#ab8eb35a54b6dc4a3180a8d44e8543826">operator *</a>(<span class="keyword">const</span> T num)<span class="keyword"> const</span>
|
||
<a name="l00085"></a>00085 <span class="keyword"> </span>{
|
||
<a name="l00086"></a>00086 <a class="code" href="class_vector3.html">Vector3<T></a> temp(*<span class="keyword">this</span>);
|
||
<a name="l00087"></a>00087 <span class="keywordflow">return</span> temp*=num;
|
||
<a name="l00088"></a>00088 }
|
||
<a name="l00089"></a>00089
|
||
<a name="l00090"></a>00090 <span class="comment">// uniform scaling</span>
|
||
<a name="l00091"></a><a class="code" href="class_vector3.html#a15cf6a9c0d33483a58022a37372ad8e6">00091</a> <a class="code" href="class_vector3.html">Vector3<T></a> <a class="code" href="class_vector3.html#a15cf6a9c0d33483a58022a37372ad8e6">operator /</a>(<span class="keyword">const</span> T num)<span class="keyword"> const</span>
|
||
<a name="l00092"></a>00092 <span class="keyword"> </span>{
|
||
<a name="l00093"></a>00093 <a class="code" href="class_vector3.html">Vector3<T></a> temp(*<span class="keyword">this</span>);
|
||
<a name="l00094"></a>00094 <span class="keywordflow">return</span> temp/=num;
|
||
<a name="l00095"></a>00095 }
|
||
<a name="l00096"></a>00096
|
||
<a name="l00097"></a>00097 <span class="comment">// addition</span>
|
||
<a name="l00098"></a><a class="code" href="class_vector3.html#a0bc5cd207aa5666973246dd002d856f0">00098</a> <a class="code" href="class_vector3.html">Vector3<T></a> &<a class="code" href="class_vector3.html#a0bc5cd207aa5666973246dd002d856f0">operator +=</a>(<span class="keyword">const</span> <a class="code" href="class_vector3.html">Vector3<T></a> &v)
|
||
<a name="l00099"></a>00099 {
|
||
<a name="l00100"></a>00100 <a class="code" href="class_vector3.html#a1a0f7e168c71ca798099f0ba8a444244">x</a>+=v.<a class="code" href="class_vector3.html#a1a0f7e168c71ca798099f0ba8a444244">x</a>; <a class="code" href="class_vector3.html#a561df88b28e106e337a25bb86554a569">y</a>+=v.<a class="code" href="class_vector3.html#a561df88b28e106e337a25bb86554a569">y</a>; <a class="code" href="class_vector3.html#ab3e7f5401dd6e951978bfa746809f74f">z</a>+=v.<a class="code" href="class_vector3.html#ab3e7f5401dd6e951978bfa746809f74f">z</a>;
|
||
<a name="l00101"></a>00101 <span class="keywordflow">return</span> *<span class="keyword">this</span>;
|
||
<a name="l00102"></a>00102 }
|
||
<a name="l00103"></a>00103
|
||
<a name="l00104"></a>00104 <span class="comment">// subtraction</span>
|
||
<a name="l00105"></a><a class="code" href="class_vector3.html#a5f8e3dfb7d3ecfc4e778c6028eccd174">00105</a> <a class="code" href="class_vector3.html">Vector3<T></a> &<a class="code" href="class_vector3.html#a5f8e3dfb7d3ecfc4e778c6028eccd174">operator -=</a>(<span class="keyword">const</span> <a class="code" href="class_vector3.html">Vector3<T></a> &v)
|
||
<a name="l00106"></a>00106 {
|
||
<a name="l00107"></a>00107 <a class="code" href="class_vector3.html#a1a0f7e168c71ca798099f0ba8a444244">x</a>-=v.<a class="code" href="class_vector3.html#a1a0f7e168c71ca798099f0ba8a444244">x</a>; <a class="code" href="class_vector3.html#a561df88b28e106e337a25bb86554a569">y</a>-=v.<a class="code" href="class_vector3.html#a561df88b28e106e337a25bb86554a569">y</a>; <a class="code" href="class_vector3.html#ab3e7f5401dd6e951978bfa746809f74f">z</a>-=v.<a class="code" href="class_vector3.html#ab3e7f5401dd6e951978bfa746809f74f">z</a>;
|
||
<a name="l00108"></a>00108 <span class="keywordflow">return</span> *<span class="keyword">this</span>;
|
||
<a name="l00109"></a>00109 }
|
||
<a name="l00110"></a>00110
|
||
<a name="l00111"></a>00111 <span class="comment">// uniform scaling</span>
|
||
<a name="l00112"></a><a class="code" href="class_vector3.html#aead20a9ece11ff71afeb9d0c4190192e">00112</a> <a class="code" href="class_vector3.html">Vector3<T></a> &<a class="code" href="class_vector3.html#aead20a9ece11ff71afeb9d0c4190192e">operator *=</a>(<span class="keyword">const</span> T num)
|
||
<a name="l00113"></a>00113 {
|
||
<a name="l00114"></a>00114 <a class="code" href="class_vector3.html#a1a0f7e168c71ca798099f0ba8a444244">x</a>*=num; <a class="code" href="class_vector3.html#a561df88b28e106e337a25bb86554a569">y</a>*=num; <a class="code" href="class_vector3.html#ab3e7f5401dd6e951978bfa746809f74f">z</a>*=num;
|
||
<a name="l00115"></a>00115 <span class="keywordflow">return</span> *<span class="keyword">this</span>;
|
||
<a name="l00116"></a>00116 }
|
||
<a name="l00117"></a>00117
|
||
<a name="l00118"></a>00118 <span class="comment">// uniform scaling</span>
|
||
<a name="l00119"></a><a class="code" href="class_vector3.html#abdcdad88c66e4e056a0106627759b8cc">00119</a> <a class="code" href="class_vector3.html">Vector3<T></a> &<a class="code" href="class_vector3.html#abdcdad88c66e4e056a0106627759b8cc">operator /=</a>(<span class="keyword">const</span> T num)
|
||
<a name="l00120"></a>00120 {
|
||
<a name="l00121"></a>00121 <a class="code" href="class_vector3.html#a1a0f7e168c71ca798099f0ba8a444244">x</a>/=num; <a class="code" href="class_vector3.html#a561df88b28e106e337a25bb86554a569">y</a>/=num; <a class="code" href="class_vector3.html#ab3e7f5401dd6e951978bfa746809f74f">z</a>/=num;
|
||
<a name="l00122"></a>00122 <span class="keywordflow">return</span> *<span class="keyword">this</span>;
|
||
<a name="l00123"></a>00123 }
|
||
<a name="l00124"></a>00124
|
||
<a name="l00125"></a>00125 <span class="comment">// dot product</span>
|
||
<a name="l00126"></a><a class="code" href="class_vector3.html#ac2a49fe3dff9cc7f16d6d1e76defdd47">00126</a> T <a class="code" href="class_vector3.html#ab8eb35a54b6dc4a3180a8d44e8543826">operator *</a>(<span class="keyword">const</span> <a class="code" href="class_vector3.html">Vector3<T></a> &v)<span class="keyword"> const</span>
|
||
<a name="l00127"></a>00127 <span class="keyword"> </span>{ <span class="keywordflow">return</span> <a class="code" href="class_vector3.html#a1a0f7e168c71ca798099f0ba8a444244">x</a>*v.<a class="code" href="class_vector3.html#a1a0f7e168c71ca798099f0ba8a444244">x</a> + <a class="code" href="class_vector3.html#a561df88b28e106e337a25bb86554a569">y</a>*v.<a class="code" href="class_vector3.html#a561df88b28e106e337a25bb86554a569">y</a> + <a class="code" href="class_vector3.html#ab3e7f5401dd6e951978bfa746809f74f">z</a>*v.<a class="code" href="class_vector3.html#ab3e7f5401dd6e951978bfa746809f74f">z</a>; }
|
||
<a name="l00128"></a>00128
|
||
<a name="l00129"></a>00129 <span class="comment">// cross product</span>
|
||
<a name="l00130"></a><a class="code" href="class_vector3.html#a58c19cb6972ba6efd05e05cde8af5b12">00130</a> <a class="code" href="class_vector3.html">Vector3<T></a> <a class="code" href="class_vector3.html#a58c19cb6972ba6efd05e05cde8af5b12">operator %</a>(<span class="keyword">const</span> <a class="code" href="class_vector3.html">Vector3<T></a> &v)<span class="keyword"> const</span>
|
||
<a name="l00131"></a>00131 <span class="keyword"> </span>{
|
||
<a name="l00132"></a>00132 <a class="code" href="class_vector3.html">Vector3<T></a> temp(<a class="code" href="class_vector3.html#a561df88b28e106e337a25bb86554a569">y</a>*v.<a class="code" href="class_vector3.html#ab3e7f5401dd6e951978bfa746809f74f">z</a> - <a class="code" href="class_vector3.html#ab3e7f5401dd6e951978bfa746809f74f">z</a>*v.<a class="code" href="class_vector3.html#a561df88b28e106e337a25bb86554a569">y</a>, <a class="code" href="class_vector3.html#ab3e7f5401dd6e951978bfa746809f74f">z</a>*v.<a class="code" href="class_vector3.html#a1a0f7e168c71ca798099f0ba8a444244">x</a> - <a class="code" href="class_vector3.html#a1a0f7e168c71ca798099f0ba8a444244">x</a>*v.<a class="code" href="class_vector3.html#ab3e7f5401dd6e951978bfa746809f74f">z</a>, <a class="code" href="class_vector3.html#a1a0f7e168c71ca798099f0ba8a444244">x</a>*v.<a class="code" href="class_vector3.html#a561df88b28e106e337a25bb86554a569">y</a> - <a class="code" href="class_vector3.html#a561df88b28e106e337a25bb86554a569">y</a>*v.<a class="code" href="class_vector3.html#a1a0f7e168c71ca798099f0ba8a444244">x</a>);
|
||
<a name="l00133"></a>00133 <span class="keywordflow">return</span> temp;
|
||
<a name="l00134"></a>00134 }
|
||
<a name="l00135"></a>00135
|
||
<a name="l00136"></a>00136 <span class="comment">// gets the length of this vector squared</span>
|
||
<a name="l00137"></a><a class="code" href="class_vector3.html#a2e22f60c089b1a0a554e697516e2c4dc">00137</a> T <a class="code" href="class_vector3.html#a2e22f60c089b1a0a554e697516e2c4dc">length_squared</a>()<span class="keyword"> const</span>
|
||
<a name="l00138"></a>00138 <span class="keyword"> </span>{ <span class="keywordflow">return</span> (T)(*<span class="keyword">this</span> * *<span class="keyword">this</span>); }
|
||
<a name="l00139"></a>00139
|
||
<a name="l00140"></a>00140 <span class="comment">// gets the length of this vector</span>
|
||
<a name="l00141"></a><a class="code" href="class_vector3.html#aeae8eae4d5a0a909aa0129c53c493038">00141</a> <span class="keywordtype">float</span> <a class="code" href="class_vector3.html#aeae8eae4d5a0a909aa0129c53c493038">length</a>()<span class="keyword"> const</span>
|
||
<a name="l00142"></a>00142 <span class="keyword"> </span>{ <span class="keywordflow">return</span> (T)sqrt(*<span class="keyword">this</span> * *<span class="keyword">this</span>); }
|
||
<a name="l00143"></a>00143
|
||
<a name="l00144"></a>00144 <span class="comment">// normalizes this vector</span>
|
||
<a name="l00145"></a><a class="code" href="class_vector3.html#a9b147a862a1b86ed2e5b735d19da3da1">00145</a> <span class="keywordtype">void</span> <a class="code" href="class_vector3.html#a9b147a862a1b86ed2e5b735d19da3da1">normalize</a>()
|
||
<a name="l00146"></a>00146 { *<span class="keyword">this</span>/=<a class="code" href="class_vector3.html#aeae8eae4d5a0a909aa0129c53c493038">length</a>(); }
|
||
<a name="l00147"></a>00147
|
||
<a name="l00148"></a>00148 <span class="comment">// returns the normalized version of this vector</span>
|
||
<a name="l00149"></a><a class="code" href="class_vector3.html#a4623c9d95850aec72ba56cb9ceea2cdf">00149</a> <a class="code" href="class_vector3.html">Vector3<T></a> <a class="code" href="class_vector3.html#a4623c9d95850aec72ba56cb9ceea2cdf">normalized</a>()<span class="keyword"> const</span>
|
||
<a name="l00150"></a>00150 <span class="keyword"> </span>{ <span class="keywordflow">return</span> *<span class="keyword">this</span>/<a class="code" href="class_vector3.html#aeae8eae4d5a0a909aa0129c53c493038">length</a>(); }
|
||
<a name="l00151"></a>00151
|
||
<a name="l00152"></a>00152 <span class="comment">// reflects this vector about n</span>
|
||
<a name="l00153"></a><a class="code" href="class_vector3.html#a3a0d28e75255b664b54c82a7463eb698">00153</a> <span class="keywordtype">void</span> <a class="code" href="class_vector3.html#a3a0d28e75255b664b54c82a7463eb698">reflect</a>(<span class="keyword">const</span> <a class="code" href="class_vector3.html">Vector3<T></a> &n)
|
||
<a name="l00154"></a>00154 {
|
||
<a name="l00155"></a>00155 <a class="code" href="class_vector3.html">Vector3<T></a> orig(*<span class="keyword">this</span>);
|
||
<a name="l00156"></a>00156 <a class="code" href="class_vector3.html#ae30e6927fbd51498d29413de4e175fcc">project</a>(n);
|
||
<a name="l00157"></a>00157 *<span class="keyword">this</span>= *<span class="keyword">this</span>*2 - orig;
|
||
<a name="l00158"></a>00158 }
|
||
<a name="l00159"></a>00159
|
||
<a name="l00160"></a>00160 <span class="comment">// projects this vector onto v</span>
|
||
<a name="l00161"></a><a class="code" href="class_vector3.html#ae30e6927fbd51498d29413de4e175fcc">00161</a> <span class="keywordtype">void</span> <a class="code" href="class_vector3.html#ae30e6927fbd51498d29413de4e175fcc">project</a>(<span class="keyword">const</span> <a class="code" href="class_vector3.html">Vector3<T></a> &v)
|
||
<a name="l00162"></a>00162 { *<span class="keyword">this</span>= v * (*<span class="keyword">this</span> * v)/(v*v); }
|
||
<a name="l00163"></a>00163
|
||
<a name="l00164"></a>00164 <span class="comment">// returns this vector projected onto v</span>
|
||
<a name="l00165"></a><a class="code" href="class_vector3.html#a314a68e23b8e72d1c86e8bc9736d6859">00165</a> <a class="code" href="class_vector3.html">Vector3<T></a> <a class="code" href="class_vector3.html#a314a68e23b8e72d1c86e8bc9736d6859">projected</a>(<span class="keyword">const</span> <a class="code" href="class_vector3.html">Vector3<T></a> &v)
|
||
<a name="l00166"></a>00166 { <span class="keywordflow">return</span> v * (*<span class="keyword">this</span> * v)/(v*v); }
|
||
<a name="l00167"></a>00167
|
||
<a name="l00168"></a>00168 <span class="comment">// computes the angle between 2 arbitrary vectors</span>
|
||
<a name="l00169"></a><a class="code" href="class_vector3.html#a2c465418f97886290fe0de26ce539601">00169</a> T <a class="code" href="class_vector3.html#a2c465418f97886290fe0de26ce539601">angle</a>(<span class="keyword">const</span> <a class="code" href="class_vector3.html">Vector3<T></a> &v1, <span class="keyword">const</span> <a class="code" href="class_vector3.html">Vector3<T></a> &v2)
|
||
<a name="l00170"></a>00170 { <span class="keywordflow">return</span> (T)acosf((v1*v2) / (v1.<a class="code" href="class_vector3.html#aeae8eae4d5a0a909aa0129c53c493038">length</a>()*v2.length())); }
|
||
<a name="l00171"></a>00171
|
||
<a name="l00172"></a>00172 <span class="comment">// computes the angle between 2 arbitrary normalized vectors</span>
|
||
<a name="l00173"></a><a class="code" href="class_vector3.html#aed71bc159e177cc91859c0d7da042279">00173</a> T <a class="code" href="class_vector3.html#aed71bc159e177cc91859c0d7da042279">angle_normalized</a>(<span class="keyword">const</span> <a class="code" href="class_vector3.html">Vector3<T></a> &v1, <span class="keyword">const</span> <a class="code" href="class_vector3.html">Vector3<T></a> &v2)
|
||
<a name="l00174"></a>00174 { <span class="keywordflow">return</span> (T)acosf(v1*v2); }
|
||
<a name="l00175"></a>00175
|
||
<a name="l00176"></a>00176 };
|
||
<a name="l00177"></a>00177
|
||
<a name="l00178"></a><a class="code" href="vector3_8h.html#a6951accbbf6263a1ac8019bf718ae31c">00178</a> <span class="keyword">typedef</span> <a class="code" href="class_vector3.html">Vector3<int></a> <a class="code" href="class_vector3.html">Vector3i</a>;
|
||
<a name="l00179"></a><a class="code" href="vector3_8h.html#a6ec31b60b534f0303b042618762c2505">00179</a> <span class="keyword">typedef</span> <a class="code" href="class_vector3.html">Vector3<unsigned int></a> <a class="code" href="class_vector3.html">Vector3ui</a>;
|
||
<a name="l00180"></a><a class="code" href="vector3_8h.html#a1b41bd10c892aa9d109483fdd7fadc6e">00180</a> <span class="keyword">typedef</span> <a class="code" href="class_vector3.html">Vector3<long></a> <a class="code" href="class_vector3.html">Vector3l</a>;
|
||
<a name="l00181"></a><a class="code" href="vector3_8h.html#a6022fdc268104a3d8c7b92be8ddc6d89">00181</a> <span class="keyword">typedef</span> <a class="code" href="class_vector3.html">Vector3<unsigned long></a> <a class="code" href="class_vector3.html">Vector3ul</a>;
|
||
<a name="l00182"></a><a class="code" href="vector3_8h.html#af345ad77ba5e240c7ab72b4b2077e754">00182</a> <span class="keyword">typedef</span> <a class="code" href="class_vector3.html">Vector3<float></a> <a class="code" href="class_vector3.html">Vector3f</a>;
|
||
<a name="l00183"></a>00183
|
||
<a name="l00184"></a>00184 <span class="preprocessor">#endif // VECTOR3_H</span>
|
||
</pre></div></div>
|
||
</div>
|
||
<hr class="footer"/><address class="footer"><small>
|
||
Generated for ArduPilot Libraries by <a href="http://www.doxygen.org/index.html"><img class="footer" src="doxygen.png" alt="doxygen"/></a></small></address>
|
||
</body>
|
||
</html>
|