Home | History | Annotate | Download | only in signal_processing
      1 /*
      2  * Written by Wilco Dijkstra, 1996. The following email exchange establishes the
      3  * license.
      4  *
      5  * From: Wilco Dijkstra <Wilco.Dijkstra (at) ntlworld.com>
      6  * Date: Fri, Jun 24, 2011 at 3:20 AM
      7  * Subject: Re: sqrt routine
      8  * To: Kevin Ma <kma (at) google.com>
      9  * Hi Kevin,
     10  * Thanks for asking. Those routines are public domain (originally posted to
     11  * comp.sys.arm a long time ago), so you can use them freely for any purpose.
     12  * Cheers,
     13  * Wilco
     14  *
     15  * ----- Original Message -----
     16  * From: "Kevin Ma" <kma (at) google.com>
     17  * To: <Wilco.Dijkstra (at) ntlworld.com>
     18  * Sent: Thursday, June 23, 2011 11:44 PM
     19  * Subject: Fwd: sqrt routine
     20  * Hi Wilco,
     21  * I saw your sqrt routine from several web sites, including
     22  * http://www.finesse.demon.co.uk/steven/sqrt.html.
     23  * Just wonder if there's any copyright information with your Successive
     24  * approximation routines, or if I can freely use it for any purpose.
     25  * Thanks.
     26  * Kevin
     27  */
     28 
     29 // Minor modifications in code style for WebRTC, 2012.
     30 
     31 #include "webrtc/common_audio/signal_processing/include/signal_processing_library.h"
     32 
     33 /*
     34  * Algorithm:
     35  * Successive approximation of the equation (root + delta) ^ 2 = N
     36  * until delta < 1. If delta < 1 we have the integer part of SQRT (N).
     37  * Use delta = 2^i for i = 15 .. 0.
     38  *
     39  * Output precision is 16 bits. Note for large input values (close to
     40  * 0x7FFFFFFF), bit 15 (the highest bit of the low 16-bit half word)
     41  * contains the MSB information (a non-sign value). Do with caution
     42  * if you need to cast the output to int16_t type.
     43  *
     44  * If the input value is negative, it returns 0.
     45  */
     46 
     47 #define WEBRTC_SPL_SQRT_ITER(N)                 \
     48   try1 = root + (1 << (N));                     \
     49   if (value >= try1 << (N))                     \
     50   {                                             \
     51     value -= try1 << (N);                       \
     52     root |= 2 << (N);                           \
     53   }
     54 
     55 int32_t WebRtcSpl_SqrtFloor(int32_t value)
     56 {
     57   int32_t root = 0, try1;
     58 
     59   WEBRTC_SPL_SQRT_ITER (15);
     60   WEBRTC_SPL_SQRT_ITER (14);
     61   WEBRTC_SPL_SQRT_ITER (13);
     62   WEBRTC_SPL_SQRT_ITER (12);
     63   WEBRTC_SPL_SQRT_ITER (11);
     64   WEBRTC_SPL_SQRT_ITER (10);
     65   WEBRTC_SPL_SQRT_ITER ( 9);
     66   WEBRTC_SPL_SQRT_ITER ( 8);
     67   WEBRTC_SPL_SQRT_ITER ( 7);
     68   WEBRTC_SPL_SQRT_ITER ( 6);
     69   WEBRTC_SPL_SQRT_ITER ( 5);
     70   WEBRTC_SPL_SQRT_ITER ( 4);
     71   WEBRTC_SPL_SQRT_ITER ( 3);
     72   WEBRTC_SPL_SQRT_ITER ( 2);
     73   WEBRTC_SPL_SQRT_ITER ( 1);
     74   WEBRTC_SPL_SQRT_ITER ( 0);
     75 
     76   return root >> 1;
     77 }
     78