arm_q7_to_q15.c
Go to the documentation of this file.
00001 /* ---------------------------------------------------------------------------- 00002 * Copyright (C) 2011 ARM Limited. All rights reserved. 00003 * 00004 * $Date: 15. December 2011 00005 * $Revision: V2.0.0 00006 * 00007 * Project: Cortex-R DSP Library 00008 * Title: arm_q7_to_q15.c 00009 * 00010 * Description: Converts the elements of the Q7 vector to Q15 vector. 00011 * 00012 * Target Processor: Cortex-R4/R5 00013 * 00014 * Version 1.0.0 2011/03/08 00015 * Alpha release. 00016 * 00017 * Version 1.0.1 2011/09/30 00018 * Beta release. 00019 * 00020 * Version 2.0.0 2011/12/15 00021 * Final release. 00022 * 00023 * ---------------------------------------------------------------------------- */ 00024 #include "arm_math.h" 00025 00060 void arm_q7_to_q15( 00061 q7_t * pSrc, 00062 q15_t * pDst, 00063 uint32_t blockSize) 00064 { 00065 q7_t *pIn = pSrc; /* Src pointer */ 00066 uint32_t blkCnt; /* loop counter */ 00067 q31_t in; 00068 q31_t in1, in2; 00069 q31_t out1, out2; 00070 q31_t and = 0xFF00FF00; 00071 00072 00073 /*loop Unrolling */ 00074 blkCnt = blockSize >> 3u; 00075 00076 /* First part of the processing with loop unrolling. Compute 8 outputs at a time. 00077 ** a second loop below computes the remaining 1 to 7 samples. */ 00078 while(blkCnt > 0u) 00079 { 00080 /* C = (q15_t) A << 8 */ 00081 /* convert from q7 to q15 and then store the results in the destination buffer */ 00082 /* read 4 samples at a time */ 00083 in = *__SIMD32(pIn)++; 00084 00085 #ifdef CCS 00086 00087 /* rotatate in by 8 and extend two q7_t values to q15_t values */ 00088 in1 = __SXTB16(in, 8); 00089 00090 /* extend remainig two q7_t values to q15_t values */ 00091 in2 = __SXTB16(in, 0); 00092 00093 #else 00094 00095 /* rotatate in by 8 and extend two q7_t values to q15_t values */ 00096 in1 = __SXTB16(__ROR(in, 8)); 00097 00098 /* extend remainig two q7_t values to q15_t values */ 00099 in2 = __SXTB16(in); 00100 00101 00102 #endif /* shift in1 by 8 to convert q7_t value to q15_t value (ex: 0x00ff00ff ==> 0xff00ff00*/ 00103 in1 = in1 << 8u; 00104 in2 = in2 << 8u; 00105 00106 /* read next 4 sampels */ 00107 in = *__SIMD32(pIn)++; 00108 00109 /* anding with 0xff00ff00 */ 00110 in1 = in1 & and; 00111 out2 = in2 & and; 00112 00113 /* pack two 16 bit values */ 00114 out1 = __PKHTB(in1, out2, 16); 00115 out2 = __PKHBT(out2, in1, 16); 00116 00117 #ifndef ARM_MATH_BIG_ENDIAN 00118 00119 /* store two q15_t samples at a time to destination */ 00120 _SIMD32_OFFSET(pDst + 2) = out1; 00121 00122 #ifdef CCS 00123 00124 /* rotatate in by 8 and extend two q7_t values to q15_t values */ 00125 in1 = __SXTB16(in, 8); 00126 00127 #else 00128 00129 /* rotatate in by 8 and extend two q7_t values to q15_t values */ 00130 in1 = __SXTB16(__ROR(in, 8)); 00131 00132 #endif 00133 00134 /* store two q15_t samples at a time to destination */ 00135 _SIMD32_OFFSET(pDst) = out2; 00136 00137 #else 00138 00139 /* store two q15_t samples at a time to destination */ 00140 _SIMD32_OFFSET(pDst) = out1; 00141 00142 #ifdef CCS 00143 00144 /* rotatate in by 8 and extend two q7_t values to q15_t values */ 00145 in1 = __SXTB16(in, 8); 00146 00147 #else 00148 00149 /* rotatate in by 8 and extend two q7_t values to q15_t values */ 00150 in1 = __SXTB16(__ROR(in, 8)); 00151 00152 #endif 00153 00154 /* store two q15_t samples at a time to destination */ 00155 _SIMD32_OFFSET(pDst + 2) = out2; 00156 00157 #endif // #ifndef ARM_MATH_BIG_ENDIAN 00158 00159 #ifdef CCS 00160 00161 /* rotatate in by 8 and extend two q7_t values to q15_t values */ 00162 in2 = __SXTB16(in, 0); 00163 00164 #else 00165 00166 /* rotatate in by 8 and extend two q7_t values to q15_t values */ 00167 in2 = __SXTB16(in); 00168 00169 #endif 00170 00171 /* shift in1 by 8 to convert q7_t value to q15_t value (ex: 0x00ff00ff ==> 0xff00ff00*/ 00172 in1 = in1 << 8u; 00173 in2 = in2 << 8u; 00174 00175 /* anding with 0xff00ff00 */ 00176 out1 = in1 & and; 00177 out2 = in2 & and; 00178 00179 /* pack two 16 bit values */ 00180 out1 = __PKHTB(in1, out2, 16); 00181 out2 = __PKHBT(out2, in1, 16); 00182 00183 /* store two q15_t samples at a time to destination */ 00184 #ifndef ARM_MATH_BIG_ENDIAN 00185 00186 _SIMD32_OFFSET(pDst + 6) = out1; 00187 _SIMD32_OFFSET(pDst + 4) = out2; 00188 00189 #else 00190 00191 _SIMD32_OFFSET(pDst + 4) = out1; 00192 _SIMD32_OFFSET(pDst + 6) = out2; 00193 00194 #endif // #ifndef ARM_MATH_BIG_ENDIAN 00195 00196 /* incremnet destination pointer */ 00197 pDst += 8u; 00198 00199 /* Decrement the loop counter */ 00200 blkCnt--; 00201 } 00202 00203 /* If the blockSize is not a multiple of 8, compute any remaining output samples here. 00204 ** No loop unrolling is used. */ 00205 blkCnt = blockSize % 0x8u; 00206 00207 while(blkCnt > 0u) 00208 { 00209 /* C = (q15_t) A << 8 */ 00210 /* convert from q7 to q15 and then store the results in the destination buffer */ 00211 *pDst++ = (q15_t) * pIn++ << 8; 00212 00213 /* Decrement the loop counter */ 00214 blkCnt--; 00215 } 00216 00217 } 00218
