The Android Open Source Project | 30957f5 | 2008-10-21 07:00:00 -0700 | [diff] [blame^] | 1 | /* |
| 2 | * Copyright (C) 2008 The Android Open Source Project |
| 3 | * |
| 4 | * Licensed under the Apache License, Version 2.0 (the "License"); |
| 5 | * you may not use this file except in compliance with the License. |
| 6 | * You may obtain a copy of the License at |
| 7 | * |
| 8 | * http://www.apache.org/licenses/LICENSE-2.0 |
| 9 | * |
| 10 | * Unless required by applicable law or agreed to in writing, software |
| 11 | * distributed under the License is distributed on an "AS IS" BASIS, |
| 12 | * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. |
| 13 | * See the License for the specific language governing permissions and |
| 14 | * limitations under the License. |
| 15 | */ |
| 16 | |
| 17 | /* ---- includes ----------------------------------------------------------- */ |
| 18 | |
| 19 | #include "b_BasicEm/Phase.h" |
| 20 | #include "b_BasicEm/Math.h" |
| 21 | |
| 22 | /* ------------------------------------------------------------------------- */ |
| 23 | |
| 24 | /* ========================================================================= */ |
| 25 | /* */ |
| 26 | /* ---- \ghd{ auxiliary functions } ---------------------------------------- */ |
| 27 | /* */ |
| 28 | /* ========================================================================= */ |
| 29 | |
| 30 | /* ------------------------------------------------------------------------- */ |
| 31 | |
| 32 | /* ========================================================================= */ |
| 33 | /* */ |
| 34 | /* ---- \ghd{ constructor / destructor } ----------------------------------- */ |
| 35 | /* */ |
| 36 | /* ========================================================================= */ |
| 37 | |
| 38 | /* ------------------------------------------------------------------------- */ |
| 39 | /* ========================================================================= */ |
| 40 | /* */ |
| 41 | /* ---- \ghd{ operators } -------------------------------------------------- */ |
| 42 | /* */ |
| 43 | /* ========================================================================= */ |
| 44 | |
| 45 | /* ------------------------------------------------------------------------- */ |
| 46 | |
| 47 | /* ========================================================================= */ |
| 48 | /* */ |
| 49 | /* ---- \ghd{ query functions } -------------------------------------------- */ |
| 50 | /* */ |
| 51 | /* ========================================================================= */ |
| 52 | |
| 53 | /* ------------------------------------------------------------------------- */ |
| 54 | |
| 55 | /* ========================================================================= */ |
| 56 | /* */ |
| 57 | /* ---- \ghd{ modify functions } ------------------------------------------- */ |
| 58 | /* */ |
| 59 | /* ========================================================================= */ |
| 60 | |
| 61 | /* ------------------------------------------------------------------------- */ |
| 62 | |
| 63 | /* ========================================================================= */ |
| 64 | /* */ |
| 65 | /* ---- \ghd{ I/O } -------------------------------------------------------- */ |
| 66 | /* */ |
| 67 | /* ========================================================================= */ |
| 68 | |
| 69 | /* ------------------------------------------------------------------------- */ |
| 70 | |
| 71 | /* ========================================================================= */ |
| 72 | /* */ |
| 73 | /* ---- \ghd{ exec functions } --------------------------------------------- */ |
| 74 | /* */ |
| 75 | /* ========================================================================= */ |
| 76 | |
| 77 | /* ------------------------------------------------------------------------- */ |
| 78 | |
| 79 | /* ------------------------------------------------------------------------- */ |
| 80 | |
| 81 | #ifndef bbs_SIN_INTERPOLATION_METHOD_2 |
| 82 | const int32 bbs_sin32_table1G[] = |
| 83 | { |
| 84 | 0, 1608, 411648, 1607, 823040, 1606, 1234176, 1602, |
| 85 | 1644288, 1599, 2053632, 1594, 2461696, 1588, 2868224, 1581, |
| 86 | 3272960, 1574, 3675904, 1564, 4076288, 1556, 4474624, 1545, |
| 87 | 4870144, 1533, 5262592, 1521, 5651968, 1508, 6038016, 1493, |
| 88 | 6420224, 1478, 6798592, 1463, 7173120, 1445, 7543040, 1428, |
| 89 | 7908608, 1409, 8269312, 1390, 8625152, 1369, 8975616, 1348, |
| 90 | 9320704, 1327, 9660416, 1303, 9993984, 1280, 10321664, 1256, |
| 91 | 10643200, 1231, 10958336, 1205, 11266816, 1178, 11568384, 1151, |
| 92 | 11863040, 1124, 12150784, 1094, 12430848, 1066, 12703744, 1036, |
| 93 | 12968960, 1005, 13226240, 974, 13475584, 942, 13716736, 910, |
| 94 | 13949696, 877, 14174208, 844, 14390272, 810, 14597632, 775, |
| 95 | 14796032, 741, 14985728, 705, 15166208, 670, 15337728, 634, |
| 96 | 15500032, 597, 15652864, 561, 15796480, 523, 15930368, 486, |
| 97 | 16054784, 448, 16169472, 409, 16274176, 372, 16369408, 333, |
| 98 | 16454656, 295, 16530176, 255, 16595456, 217, 16651008, 177, |
| 99 | 16696320, 138, 16731648, 99, 16756992, 59, 16772096, 20, |
| 100 | 16777216, -20, 16772096, -59, 16756992, -99, 16731648, -138, |
| 101 | 16696320, -177, 16651008, -217, 16595456, -255, 16530176, -295, |
| 102 | 16454656, -333, 16369408, -372, 16274176, -409, 16169472, -448, |
| 103 | 16054784, -486, 15930368, -523, 15796480, -561, 15652864, -597, |
| 104 | 15500032, -634, 15337728, -670, 15166208, -705, 14985728, -741, |
| 105 | 14796032, -775, 14597632, -810, 14390272, -844, 14174208, -877, |
| 106 | 13949696, -910, 13716736, -942, 13475584, -974, 13226240, -1005, |
| 107 | 12968960, -1036, 12703744, -1066, 12430848, -1094, 12150784, -1124, |
| 108 | 11863040, -1151, 11568384, -1178, 11266816, -1205, 10958336, -1231, |
| 109 | 10643200, -1256, 10321664, -1280, 9993984, -1303, 9660416, -1327, |
| 110 | 9320704, -1348, 8975616, -1369, 8625152, -1390, 8269312, -1409, |
| 111 | 7908608, -1428, 7543040, -1445, 7173120, -1463, 6798592, -1478, |
| 112 | 6420224, -1493, 6038016, -1508, 5651968, -1521, 5262592, -1533, |
| 113 | 4870144, -1545, 4474624, -1556, 4076288, -1564, 3675904, -1574, |
| 114 | 3272960, -1581, 2868224, -1588, 2461696, -1594, 2053632, -1599, |
| 115 | 1644288, -1602, 1234176, -1606, 823040, -1607, 411648, -1608 |
| 116 | }; |
| 117 | #else |
| 118 | const int32 bbs_sin32_table2G[] = |
| 119 | { |
| 120 | 0, 12907, -122, |
| 121 | 209469440, 12662, -368, |
| 122 | 410894336, 11926, -596, |
| 123 | 596525056, 10733, -802, |
| 124 | 759234560, 9129, -978, |
| 125 | 892780544, 7168, -1112, |
| 126 | 992002048, 4939, -1210, |
| 127 | 1053097984, 2516, -1256, |
| 128 | 1073741824, -4, -1256, |
| 129 | 1053097984, -2519, -1210, |
| 130 | 992002048, -4944, -1112, |
| 131 | 892780544, -7173, -978, |
| 132 | 759234560, -9129, -802, |
| 133 | 596525056, -10734, -596, |
| 134 | 410894336, -11926, -368, |
| 135 | 209469440, -12663, -122 |
| 136 | }; |
| 137 | #endif |
| 138 | |
| 139 | int32 bbs_sin32( phase16 phaseA ) |
| 140 | { |
| 141 | #ifndef bbs_SIN_INTERPOLATION_METHOD_2 |
| 142 | |
| 143 | int32 oL = ( phaseA & 0x00FF ); |
| 144 | uint16 indexL = ( ( phaseA & 0x7F00 ) >> 8 ) << 1; |
| 145 | int32 sinL = bbs_sin32_table1G[ indexL ] + oL * bbs_sin32_table1G[ indexL + 1 ]; |
| 146 | |
| 147 | if( ( phaseA & 0x8000 ) != 0 ) |
| 148 | { |
| 149 | return -sinL; |
| 150 | } |
| 151 | else |
| 152 | { |
| 153 | return sinL; |
| 154 | } |
| 155 | |
| 156 | #else /*bbs_SIN_INTERPOLATION_METHOD_2*/ |
| 157 | |
| 158 | int32 o1L = ( phaseA & 0x07FF ); |
| 159 | int32 o2L = ( o1L * o1L ) >> 8; |
| 160 | uint16 indexL = ( ( phaseA & 0x7800 ) >> 11 ) * 3; |
| 161 | int32 sinL = bbs_sin32_table2G[ indexL ] + ( ( o1L * bbs_sin32_table2G[ indexL + 1 ] ) << 3 ) + o2L * bbs_sin32_table2G[ indexL + 2 ]; |
| 162 | |
| 163 | if( ( phaseA & 0x8000 ) != 0 ) |
| 164 | { |
| 165 | return -sinL >> 6; |
| 166 | } |
| 167 | else |
| 168 | { |
| 169 | return sinL >> 6; |
| 170 | } |
| 171 | |
| 172 | #endif /*bbs_SIN_INTERPOLATION_METHOD_2*/ |
| 173 | } |
| 174 | |
| 175 | /** computation of sine tables (do not uncomment or remove) |
| 176 | void sin1Table() |
| 177 | { |
| 178 | long iL; |
| 179 | for( iL = 0; iL < 128; iL++ ) |
| 180 | { |
| 181 | int32 phase1L = iL * 256; |
| 182 | int32 phase2L = phase1L + 256; |
| 183 | double angle1L = ( M_PI * phase1L ) / 32768; |
| 184 | double angle2L = ( M_PI * phase2L ) / 32768; |
| 185 | int32 sin1L = ( sin( angle1L ) * 65536 ); |
| 186 | int32 sin2L = ( sin( angle2L ) * 65536 ); |
| 187 | int32 diffL = sin2L - sin1L; |
| 188 | eout << iL << ": " << ( sin1L << 8 ) << " + oL * " << diffL << endl; |
| 189 | } |
| 190 | } |
| 191 | |
| 192 | void sin2Table() |
| 193 | { |
| 194 | long iL; |
| 195 | for( iL = 0; iL < 16; iL++ ) |
| 196 | { |
| 197 | int32 p0L = iL * ( 1 << 11 ); |
| 198 | int32 p1L = p0L + ( 1 << 10 ); |
| 199 | int32 p2L = p0L + ( 1 << 11 ); |
| 200 | |
| 201 | double a0L = ( M_PI * p0L ) / ( 1 << 15 ); |
| 202 | double a1L = ( M_PI * p1L ) / ( 1 << 15 ); |
| 203 | double a2L = ( M_PI * p2L ) / ( 1 << 15 ); |
| 204 | |
| 205 | int32 s0L = ( sin( a0L ) * ( 1 << 16 ) ); |
| 206 | int32 s1L = ( sin( a1L ) * ( 1 << 16 ) ); |
| 207 | int32 s2L = ( sin( a2L ) * ( 1 << 16 ) ); |
| 208 | |
| 209 | int32 aL = 4 * s1L - 3 * s0L - s2L; |
| 210 | int32 bL = 2 * s2L + 2 * s0L - 4 * s1L; |
| 211 | |
| 212 | eout << iL << ": " << ( s0L << 14 ) << " + ( ( o1L * " << aL << " ) << 3 )" |
| 213 | << " + o2L * " << bL << endl; |
| 214 | } |
| 215 | } |
| 216 | */ |
| 217 | |
| 218 | /* ------------------------------------------------------------------------- */ |
| 219 | |
| 220 | int32 bbs_cos32( phase16 phaseA ) |
| 221 | { |
| 222 | return bbs_sin32( ( phase16 )( phaseA + bbs_M_PI_2_16 ) ); |
| 223 | } |
| 224 | |
| 225 | /* ------------------------------------------------------------------------- */ |
| 226 | |
| 227 | int16 bbs_sin16( phase16 phaseA ) |
| 228 | { |
| 229 | return bbs_sin32( phaseA ) >> 10; |
| 230 | } |
| 231 | |
| 232 | /* ------------------------------------------------------------------------- */ |
| 233 | |
| 234 | int16 bbs_cos16( phase16 phaseA ) |
| 235 | { |
| 236 | return bbs_sin32( ( phase16 )( phaseA + bbs_M_PI_2_16 ) ) >> 10; |
| 237 | } |
| 238 | |
| 239 | /* ------------------------------------------------------------------------- */ |
| 240 | |
| 241 | const int32 bbs_atan16_tableG[] = |
| 242 | { |
| 243 | 0, 325, 332800, 326, 666624, 326, 1000448, 325, |
| 244 | 1333248, 324, 1665024, 323, 1995776, 323, 2326528, 322, |
| 245 | 2656256, 320, 2983936, 319, 3310592, 317, 3635200, 316, |
| 246 | 3958784, 314, 4280320, 312, 4599808, 310, 4917248, 308, |
| 247 | 5232640, 306, 5545984, 303, 5856256, 301, 6164480, 298, |
| 248 | 6469632, 296, 6772736, 292, 7071744, 291, 7369728, 287, |
| 249 | 7663616, 284, 7954432, 281, 8242176, 279, 8527872, 275, |
| 250 | 8809472, 272, 9088000, 269, 9363456, 265, 9634816, 263, |
| 251 | 9904128, 259, 10169344, 256, 10431488, 252, 10689536, 249, |
| 252 | 10944512, 246, 11196416, 243, 11445248, 239, 11689984, 236, |
| 253 | 11931648, 233, 12170240, 230, 12405760, 226, 12637184, 223, |
| 254 | 12865536, 219, 13089792, 217, 13312000, 213, 13530112, 210, |
| 255 | 13745152, 207, 13957120, 204, 14166016, 201, 14371840, 198, |
| 256 | 14574592, 195, 14774272, 192, 14970880, 189, 15164416, 186, |
| 257 | 15354880, 183, 15542272, 180, 15726592, 178, 15908864, 175, |
| 258 | 16088064, 172, 16264192, 169, 16437248, 167, 16608256, 165 |
| 259 | }; |
| 260 | |
| 261 | phase16 bbs_atan16( uint32 valA ) |
| 262 | { |
| 263 | uint32 oL = valA & 0x03FF; |
| 264 | uint16 indexL = ( valA >> 10 ) << 1; |
| 265 | uint32 phaseL = bbs_atan16_tableG[ indexL ] + oL * bbs_atan16_tableG[ indexL + 1 ]; |
| 266 | return ( phase16 )( phaseL >> 11 ); |
| 267 | } |
| 268 | |
| 269 | /* ------------------------------------------------------------------------- */ |
| 270 | |
| 271 | phase16 bbs_phase16( int32 xA, int32 yA ) |
| 272 | { |
| 273 | uint32 xL = ( xA > 0 ) ? xA : -xA; |
| 274 | uint32 yL = ( yA > 0 ) ? yA : -yA; |
| 275 | phase16 phaseL; |
| 276 | |
| 277 | if( xL == 0 && yL == 0 ) return 0; |
| 278 | |
| 279 | if( xL == yL ) |
| 280 | { |
| 281 | phaseL = bbs_M_PI_4_16; /*PI/4*/ |
| 282 | } |
| 283 | else if( xL > yL ) |
| 284 | { |
| 285 | if( yL >= 65536 ) /* avoid overflow (1 << 16) */ |
| 286 | { |
| 287 | uint32 shiftL = bbs_intLog2( yL ) - 15; |
| 288 | xL >>= shiftL; |
| 289 | yL >>= shiftL; |
| 290 | } |
| 291 | phaseL = bbs_atan16( ( yL << 16 ) / xL ); |
| 292 | } |
| 293 | else |
| 294 | { |
| 295 | if( xL >= 65536 ) /* avoid overflow (1 << 16) */ |
| 296 | { |
| 297 | uint32 shiftL = bbs_intLog2( xL ) - 15; |
| 298 | xL >>= shiftL; |
| 299 | yL >>= shiftL; |
| 300 | } |
| 301 | phaseL = bbs_M_PI_2_16 - bbs_atan16( ( xL << 16 ) / yL ); |
| 302 | } |
| 303 | |
| 304 | if( xA >= 0 ) |
| 305 | { |
| 306 | if( yA >= 0 ) |
| 307 | { |
| 308 | return phaseL; |
| 309 | } |
| 310 | else |
| 311 | { |
| 312 | return -phaseL; |
| 313 | } |
| 314 | } |
| 315 | else |
| 316 | { |
| 317 | if( yA >= 0 ) |
| 318 | { |
| 319 | return bbs_M_PI_16 - phaseL; |
| 320 | } |
| 321 | else |
| 322 | { |
| 323 | return phaseL - bbs_M_PI_16; |
| 324 | } |
| 325 | } |
| 326 | } |
| 327 | |
| 328 | /* ------------------------------------------------------------------------- */ |
| 329 | |
| 330 | /* ========================================================================= */ |
| 331 | |
| 332 | |