00001
00015
00016
00017
00018
00019
00020
00021
00022
00023
00024
00025
00026
00027
00028
00029
00030
00031
00032
00033
00034
00035
00036
00037
00038
00039
00040
00041
00042
00043
00044
00045 #include "dsp.h"
00046 #include "preprocessor.h"
00047
00048 #if defined(FORCE_ALL_GENERICS) || \
00049 defined(FORCE_GENERIC_OP32_LN) || \
00050 !defined(TARGET_SPECIFIC_OP32_LN)
00051
00052 S64 dsp32_op_ln_raw(dsp32_t num)
00053 {
00054 dsp32_t num_temp;
00055 S64 a, a_sqr, res;
00056 int under_bit_val;
00057
00058
00059 if (num <= DSP32_Q(0.))
00060 return DSP_Q_MIN(DSP32_QA, DSP32_QB);
00061
00062
00063 #if DSP32_QA > 1
00064
00065
00066 if (num > DSP32_Q(1.))
00067 {
00068 under_bit_val = 0;
00069 num_temp = num;
00070 while (num_temp > DSP32_Q(1.))
00071 {
00072 num_temp >>= 1;
00073 under_bit_val++;
00074 }
00075 num_temp = (num >> under_bit_val);
00076 }
00077 else
00078 #endif
00079 {
00080 under_bit_val = 0;
00081 num_temp = num;
00082 while (num_temp < DSP32_Q(0.5))
00083 {
00084 num_temp <<= 1;
00085 under_bit_val++;
00086 }
00087 num_temp = (num << under_bit_val);
00088 }
00089
00090
00091 a = (((S64) num_temp) - DSP32_Q(1.)) << DSP32_QB;
00092 a = a/(((S64) num_temp) + DSP32_Q(1.));
00093
00094 a_sqr = (a*a) >> DSP32_QB;
00095
00096 res = (a_sqr*DSP32_Q(1./13.)) >> DSP32_QB;
00097 res = (a_sqr*(res + DSP32_Q(1./11.))) >> DSP32_QB;
00098 res = (a_sqr*(res + DSP32_Q(1./9.))) >> DSP32_QB;
00099 res = (a_sqr*(res + DSP32_Q(1./7.))) >> DSP32_QB;
00100 res = (a_sqr*(res + DSP32_Q(1./5.))) >> DSP32_QB;
00101 res = (a_sqr*(res + DSP32_Q(1./3.))) >> DSP32_QB;
00102 res = (a*(res + DSP32_Q(1.))) >> (DSP32_QB - 1);
00103
00104
00105 #if DSP32_QA > 1
00106 if (num > DSP32_Q(1.))
00107 res += ((S64) under_bit_val)*((S64) DSP32_Q(CST_LN_2));
00108 else
00109 #endif
00110 res -= ((S64) under_bit_val)*((S64) DSP32_Q(CST_LN_2));
00111
00112 return res;
00113 }
00114
00115 #endif