vector3_8cpp-source.html

来自「这个是关于G.726算法的源程序」· HTML 代码 · 共 424 行 · 第 1/3 页

<a name="l00157"></a>00157     shift = (16-shift)&gt;&gt;1;
<a name="l00158"></a>00158     <span class="keywordflow">if</span>(shift&gt;0)
<a name="l00159"></a>00159         r &gt;&gt;= shift;
<a name="l00160"></a>00160     <span class="keywordflow">if</span>(shift&lt;0)
<a name="l00161"></a>00161         r &lt;&lt;= -shift;
<a name="l00162"></a>00162 
<a name="l00163"></a>00163     <span class="keywordflow">return</span> r;
<a name="l00164"></a>00164     }
<a name="l00165"></a>00165 
<a name="l00166"></a>00166 
<a name="l00167"></a><a class="code" href="classVector3.html#a16">00167</a> <a class="code" href="common_8h.html#a2">EXPORT</a> <span class="keywordtype">int</span> <a class="code" href="classVector3.html#a16">Vector3::CompareLength</a>(<a class="code" href="group__fix.html#ga1">ufix</a> length)<span class="keyword"> const</span>
<a name="l00168"></a>00168 <span class="keyword">    </span>{
<a name="l00169"></a>00169     <span class="comment">// calculate the square of this vectors length as ai:af</span>
<a name="l00170"></a>00170     <a class="code" href="group__integers.html#ga2">uint32</a> af;
<a name="l00171"></a>00171     <a class="code" href="group__integers.html#ga2">uint32</a> ai = <a class="code" href="classVector3.html#a18">LengthSquared</a>(af);
<a name="l00172"></a>00172 
<a name="l00173"></a>00173     <span class="comment">// calculate the square of 'length' as bi:bf</span>
<a name="l00174"></a>00174     <a class="code" href="group__integers.html#ga2">uint32</a> l = length&amp;0xFFFF;
<a name="l00175"></a>00175     <a class="code" href="group__integers.html#ga2">uint32</a> h = length&gt;&gt;16;
<a name="l00176"></a>00176     <a class="code" href="group__integers.html#ga2">uint32</a> bf = l*l;
<a name="l00177"></a>00177     <a class="code" href="group__integers.html#ga2">uint32</a> bi = h*h;
<a name="l00178"></a>00178     <a class="code" href="group__integers.html#ga2">uint32</a> r = l*h;
<a name="l00179"></a>00179     <a class="code" href="group__integers.html#ga2">uint32</a> obf = bf;
<a name="l00180"></a>00180     bf += r&lt;&lt;(16+1);
<a name="l00181"></a>00181     <span class="keywordflow">if</span>(bf&lt;obf) bi++;
<a name="l00182"></a>00182     bi += r&gt;&gt;(16-1);
<a name="l00183"></a>00183 
<a name="l00184"></a>00184     <span class="comment">// compare the squares of the length</span>
<a name="l00185"></a>00185     <span class="keywordflow">if</span>(ai&lt;bi)
<a name="l00186"></a>00186         <span class="keywordflow">return</span> -1;
<a name="l00187"></a>00187     <span class="keywordflow">if</span>(ai&gt;bi)
<a name="l00188"></a>00188         <span class="keywordflow">return</span> 1;
<a name="l00189"></a>00189     <span class="keywordflow">if</span>(af&lt;bf)
<a name="l00190"></a>00190         <span class="keywordflow">return</span> -1;
<a name="l00191"></a>00191     <span class="keywordflow">if</span>(af&gt;bf)
<a name="l00192"></a>00192         <span class="keywordflow">return</span> 1;
<a name="l00193"></a>00193     <span class="keywordflow">return</span> 0;
<a name="l00194"></a>00194     }
<a name="l00195"></a>00195 
<a name="l00196"></a>00196 
<a name="l00197"></a><a class="code" href="classVector3.html#a17">00197</a> <a class="code" href="common_8h.html#a2">EXPORT</a> <span class="keywordtype">int</span> <a class="code" href="classVector3.html#a17">Vector3::CompareLengths</a>(<span class="keyword">const</span> <a class="code" href="classVector3.html">Vector3</a>&amp; vector)<span class="keyword"> const</span>
<a name="l00198"></a>00198 <span class="keyword">    </span>{
<a name="l00199"></a>00199     <a class="code" href="group__integers.html#ga2">uint32</a> af,bf;
<a name="l00200"></a>00200     <a class="code" href="group__integers.html#ga2">uint32</a> ai = <a class="code" href="classVector3.html#a18">LengthSquared</a>(af);
<a name="l00201"></a>00201     <a class="code" href="group__integers.html#ga2">uint32</a> bi = vector.<a class="code" href="classVector3.html#a18">LengthSquared</a>(bf);
<a name="l00202"></a>00202     
<a name="l00203"></a>00203     <span class="keywordflow">if</span>(ai&lt;bi)
<a name="l00204"></a>00204         <span class="keywordflow">return</span> -1;
<a name="l00205"></a>00205     <span class="keywordflow">if</span>(ai&gt;bi)
<a name="l00206"></a>00206         <span class="keywordflow">return</span> 1;
<a name="l00207"></a>00207     <span class="keywordflow">if</span>(af&lt;bf)
<a name="l00208"></a>00208         <span class="keywordflow">return</span> -1;
<a name="l00209"></a>00209     <span class="keywordflow">if</span>(af&gt;bf)
<a name="l00210"></a>00210         <span class="keywordflow">return</span> 1;
<a name="l00211"></a>00211     <span class="keywordflow">return</span> 0;
<a name="l00212"></a>00212     }
<a name="l00213"></a>00213 
<a name="l00214"></a>00214 
<a name="l00215"></a><a class="code" href="classVector3.html#a18">00215</a> <a class="code" href="common_8h.html#a2">EXPORT</a> <a class="code" href="group__integers.html#ga2">uint32</a> <a class="code" href="classVector3.html#a18">Vector3::LengthSquared</a>(<a class="code" href="group__integers.html#ga2">uint32</a>&amp; fraction)<span class="keyword"> const</span>
<a name="l00216"></a>00216 <span class="keyword">    </span>{
<a name="l00217"></a>00217     <a class="code" href="group__integers.html#ga5">int32</a>   v,r;
<a name="l00218"></a>00218     <a class="code" href="group__integers.html#ga2">uint32</a>  l,h,lo,hi,ol;
<a name="l00219"></a>00219     
<a name="l00220"></a>00220     v = <a class="code" href="classVector3.html#o0">X</a>;
<a name="l00221"></a>00221     l = v&amp;0xFFFF;
<a name="l00222"></a>00222     h = v&gt;&gt;16;
<a name="l00223"></a>00223     lo = l*l;
<a name="l00224"></a>00224     hi = h*h;
<a name="l00225"></a>00225     r = l*h;
<a name="l00226"></a>00226     ol = lo;
<a name="l00227"></a>00227     lo += r&lt;&lt;(16+1);
<a name="l00228"></a>00228     <span class="keywordflow">if</span>(lo&lt;ol) hi++;
<a name="l00229"></a>00229     hi += r&gt;&gt;(16-1);
<a name="l00230"></a>00230     
<a name="l00231"></a>00231     v = <a class="code" href="classVector3.html#o1">Y</a>;
<a name="l00232"></a>00232     l = v&amp;0xFFFF;
<a name="l00233"></a>00233     h = v&gt;&gt;16;
<a name="l00234"></a>00234     ol = lo;
<a name="l00235"></a>00235     lo += l*l;
<a name="l00236"></a>00236     <span class="keywordflow">if</span>(lo&lt;ol) hi++;
<a name="l00237"></a>00237     hi += h*h;
<a name="l00238"></a>00238     r = l*h;
<a name="l00239"></a>00239     ol = lo;
<a name="l00240"></a>00240     lo += r&lt;&lt;(16+1);
<a name="l00241"></a>00241     <span class="keywordflow">if</span>(lo&lt;ol) hi++;
<a name="l00242"></a>00242     hi += r&gt;&gt;(16-1);
<a name="l00243"></a>00243     
<a name="l00244"></a>00244     v = <a class="code" href="classVector3.html#o2">Z</a>;
<a name="l00245"></a>00245     l = v&amp;0xFFFF;
<a name="l00246"></a>00246     h = v&gt;&gt;16;
<a name="l00247"></a>00247     ol = lo;
<a name="l00248"></a>00248     lo += l*l;
<a name="l00249"></a>00249     <span class="keywordflow">if</span>(lo&lt;ol) hi++;
<a name="l00250"></a>00250     hi += h*h;
<a name="l00251"></a>00251     r = l*h;
<a name="l00252"></a>00252     ol = lo;
<a name="l00253"></a>00253     lo += r&lt;&lt;(16+1);
<a name="l00254"></a>00254     <span class="keywordflow">if</span>(lo&lt;ol) hi++;
<a name="l00255"></a>00255     hi += r&gt;&gt;(16-1);
<a name="l00256"></a>00256 
<a name="l00257"></a>00257     fraction = lo;
<a name="l00258"></a>00258     <span class="keywordflow">return</span> hi;
<a name="l00259"></a>00259     }
<a name="l00260"></a>00260 
<a name="l00261"></a>00261 
<a name="l00262"></a><a class="code" href="classVector3.html#d0">00262</a> <span class="keywordtype">void</span> <a class="code" href="classVector3.html#d0">Vector3::NormaliseComponents</a>(<a class="code" href="group__integers.html#ga6">uint</a> bits)
<a name="l00263"></a>00263     {
<a name="l00264"></a>00264     <span class="comment">// get components</span>
<a name="l00265"></a>00265     <a class="code" href="group__fix.html#ga0">fix</a> x = <a class="code" href="classVector3.html#o0">X</a>;
<a name="l00266"></a>00266     <a class="code" href="group__fix.html#ga0">fix</a> y = <a class="code" href="classVector3.html#o1">Y</a>;
<a name="l00267"></a>00267     <a class="code" href="group__fix.html#ga0">fix</a> z = <a class="code" href="classVector3.html#o2">Z</a>;
<a name="l00268"></a>00268 
<a name="l00269"></a>00269     <span class="comment">// find the magnitude of the largest component</span>
<a name="l00270"></a>00270     <a class="code" href="group__fix.html#ga1">ufix</a> max = x;
<a name="l00271"></a>00271     <span class="keywordflow">if</span>(x&lt;0)
<a name="l00272"></a>00272         max = ~x;
<a name="l00273"></a>00273 
<a name="l00274"></a>00274     <a class="code" href="group__fix.html#ga1">ufix</a> ay = y;
<a name="l00275"></a>00275     <span class="keywordflow">if</span>(y&lt;0)
<a name="l00276"></a>00276         ay = ~y;
<a name="l00277"></a>00277     <span class="keywordflow">if</span>(ay&gt;max)
<a name="l00278"></a>00278         max = ay;
<a name="l00279"></a>00279 
<a name="l00280"></a>00280     <a class="code" href="group__fix.html#ga1">ufix</a> az = z;
<a name="l00281"></a>00281     <span class="keywordflow">if</span>(z&lt;0)
<a name="l00282"></a>00282         az = ~z;
<a name="l00283"></a>00283     <span class="keywordflow">if</span>(az&gt;max)
<a name="l00284"></a>00284         max = az;
<a name="l00285"></a>00285 
<a name="l00286"></a>00286     <span class="comment">// calculate shift value to get msb in correct place</span>
<a name="l00287"></a>00287     <span class="keywordtype">int</span> shift = <a class="code" href="vector3_8cpp.html#a0">MostSignificantBit</a>(max)-bits;
<a name="l00288"></a>00288 
<a name="l00289"></a>00289     <span class="comment">// shift all components</span>
<a name="l00290"></a>00290     <span class="keywordflow">if</span>(shift&gt;0)
<a name="l00291"></a>00291         {
<a name="l00292"></a>00292         x &gt;&gt;= shift;
<a name="l00293"></a>00293         y &gt;&gt;= shift;
<a name="l00294"></a>00294         z &gt;&gt;= shift;
<a name="l00295"></a>00295         }
<a name="l00296"></a>00296     <span class="keywordflow">else</span> <span class="keywordflow">if</span>(shift&lt;0)
<a name="l00297"></a>00297         {
<a name="l00298"></a>00298         shift = -shift;