diff options
Diffstat (limited to 'media/openmax_dl/dl/sp/src/armSP_FFT_CToC_SC16_Radix8_fs_unsafe_s.S')
-rw-r--r-- | media/openmax_dl/dl/sp/src/armSP_FFT_CToC_SC16_Radix8_fs_unsafe_s.S | 619 |
1 files changed, 619 insertions, 0 deletions
diff --git a/media/openmax_dl/dl/sp/src/armSP_FFT_CToC_SC16_Radix8_fs_unsafe_s.S b/media/openmax_dl/dl/sp/src/armSP_FFT_CToC_SC16_Radix8_fs_unsafe_s.S new file mode 100644 index 000000000..b67260e22 --- /dev/null +++ b/media/openmax_dl/dl/sp/src/armSP_FFT_CToC_SC16_Radix8_fs_unsafe_s.S @@ -0,0 +1,619 @@ +@// +@// Copyright (c) 2013 The WebRTC project authors. All Rights Reserved. +@// +@// Use of this source code is governed by a BSD-style license +@// that can be found in the LICENSE file in the root of the source +@// tree. An additional intellectual property rights grant can be found +@// in the file PATENTS. All contributing project authors may +@// be found in the AUTHORS file in the root of the source tree. +@// +@// This file was originally licensed as follows. It has been +@// relicensed with permission from the copyright holders. + +@// +@// +@// File Name: armSP_FFT_CToC_SC16_Radix8_fs_unsafe_s.s +@// OpenMAX DL: v1.0.2 +@// Last Modified Revision: 7766 +@// Last Modified Date: Thu, 27 Sep 2007 +@// +@// (c) Copyright 2007-2008 ARM Limited. All Rights Reserved. +@// +@// +@// +@// Description: +@// Compute a first stage Radix 8 FFT stage for a N point complex signal +@// +@// + + +@// Include standard headers + +#include "dl/api/armCOMM_s.h" +#include "dl/api/omxtypes_s.h" + + +@// Import symbols required from other files +@// (For example tables) + + +@// Set debugging level +@//DEBUG_ON SETL {TRUE} + + + +@// Guarding implementation by the processor name + + + + +@// Guarding implementation by the processor name + + +@//Input Registers + +#define pSrc r0 +#define pDst r2 +#define pTwiddle r1 +#define subFFTNum r6 +#define subFFTSize r7 +@// dest buffer for the next stage (not pSrc for first stage) +#define pPingPongBuf r5 + + +@//Output Registers + + +@//Local Scratch Registers + +#define grpSize r3 +@// Reuse grpSize as setCount +#define setCount r3 +#define pointStep r4 +#define outPointStep r4 +#define setStep r8 +#define step1 r9 +#define step2 r10 +#define t0 r11 + + +@// Neon Registers + +#define dXr0 D14.S16 +#define dXi0 D15.S16 +#define dXr1 D2.S16 +#define dXi1 D3.S16 +#define dXr2 D4.S16 +#define dXi2 D5.S16 +#define dXr3 D6.S16 +#define dXi3 D7.S16 +#define dXr4 D8.S16 +#define dXi4 D9.S16 +#define dXr5 D10.S16 +#define dXi5 D11.S16 +#define dXr6 D12.S16 +#define dXi6 D13.S16 +#define dXr7 D0.S16 +#define dXi7 D1.S16 +#define qX0 Q7.S16 +#define qX1 Q1.S16 +#define qX2 Q2.S16 +#define qX3 Q3.S16 +#define qX4 Q4.S16 +#define qX5 Q5.S16 +#define qX6 Q6.S16 +#define qX7 Q0.S16 + +#define dUr0 D16.S16 +#define dUi0 D17.S16 +#define dUr2 D18.S16 +#define dUi2 D19.S16 +#define dUr4 D20.S16 +#define dUi4 D21.S16 +#define dUr6 D22.S16 +#define dUi6 D23.S16 +#define dUr1 D24.S16 +#define dUi1 D25.S16 +#define dUr3 D26.S16 +#define dUi3 D27.S16 +#define dUr5 D28.S16 +#define dUi5 D29.S16 +@// reuse dXr7 and dXi7 +#define dUr7 D30.S16 +#define dUi7 D31.S16 +#define qU0 Q8.S16 +#define qU1 Q12.S16 +#define qU2 Q9.S16 +#define qU3 Q13.S16 +#define qU4 Q10.S16 +#define qU5 Q14.S16 +#define qU6 Q11.S16 +#define qU7 Q15.S16 + + + +#define dVr0 D24.S16 +#define dVi0 D25.S16 +#define dVr2 D26.S16 +#define dVi2 D27.S16 +#define dVr4 D28.S16 +#define dVi4 D29.S16 +#define dVr6 D30.S16 +#define dVi6 D31.S16 +#define dVr1 D16.S16 +#define dVi1 D17.S16 +#define dVr3 D18.S16 +#define dVi3 D19.S16 +#define dVr5 D20.S16 +#define dVi5 D21.S16 +@// reuse dUi7 +#define dVr7 D22.S16 +@// reuse dUr7 +#define dVi7 D23.S16 +#define qV0 Q12.S16 +#define qV1 Q8.S16 +#define qV2 Q13.S16 +#define qV3 Q9.S16 +#define qV4 Q14.S16 +#define qV5 Q10.S16 +#define qV6 Q15.S16 +#define qV7 Q11.S16 + + + +#define dYr0 D16.S16 +#define dYi0 D17.S16 +#define dYr2 D18.S16 +#define dYi2 D19.S16 +#define dYr4 D20.S16 +#define dYi4 D21.S16 +#define dYr6 D22.S16 +#define dYi6 D23.S16 +#define dYr1 D24.S16 +#define dYi1 D25.S16 +#define dYr3 D26.S16 +#define dYi3 D27.S16 +#define dYr5 D28.S16 +#define dYi5 D29.S16 +@// reuse dYr4 and dYi4 +#define dYr7 D30.S16 +#define dYi7 D31.S16 +#define qY0 Q8.S16 +#define qY1 Q12.S16 +#define qY2 Q9.S16 +#define qY3 Q13.S16 +#define qY4 Q10.S16 +#define qY5 Q14.S16 +#define qY6 Q11.S16 +#define qY7 Q15.S16 + + +#define dT0 D0.S16 +#define dT1 D1.S16 + + +@// Define constants + .set ONEBYSQRT2, 0x00005A82 @// Q15 format + + + .MACRO FFTSTAGE scaled, inverse , name + + @// Define stack arguments + + @// Update pSubFFTSize and pSubFFTNum regs + MOV subFFTSize,#8 @// subFFTSize = 1 for the first stage + LDR t0,=ONEBYSQRT2 @// t0=(1/sqrt(2)) as Q15 format + + @// Note: setCount = subFFTNum/8 (reuse the grpSize reg for setCount) + LSR grpSize,subFFTNum,#3 + MOV subFFTNum,grpSize + + + @// pT0+1 increments pT0 by 4 bytes + @// pT0+pointStep = increment of 4*pointStep bytes = grpSize/2 bytes + @// Note: outPointStep = pointStep for firststage + + MOV pointStep,grpSize,LSL #2 + + + @// Calculate the step of input data for the next set + @//MOV step1,pointStep,LSL #1 @// step1 = 2*pointStep + VLD2 {dXr0,dXi0},[pSrc, :128],pointStep @// data[0] + MOV step1,grpSize,LSL #3 + + MOV step2,pointStep,LSL #3 + VLD2 {dXr1,dXi1},[pSrc, :128],pointStep @// data[1] + SUB step2,step2,pointStep @// step2 = 7*pointStep + RSB setStep,step2,#16 @// setStep = - 7*pointStep+16 + + + + VLD2 {dXr2,dXi2},[pSrc, :128],pointStep @// data[2] + VLD2 {dXr3,dXi3},[pSrc, :128],pointStep @// data[3] + VLD2 {dXr4,dXi4},[pSrc, :128],pointStep @// data[4] + VLD2 {dXr5,dXi5},[pSrc, :128],pointStep @// data[5] + VLD2 {dXr6,dXi6},[pSrc, :128],pointStep @// data[6] + VLD2 {dXr7,dXi7},[pSrc, :128],setStep @// data[7] & update pSrc for the next set + @// setStep = -7*pointStep + 16 + @// grp = 0 a special case since all the twiddle factors are 1 + @// Loop on the sets : 4 sets at a time + +grpZeroSetLoop\name: + + @// Decrement setcount + SUBS setCount,setCount,#4 @// decrement the set loop counter + + + .ifeqs "\scaled", "TRUE" + @// finish first stage of 8 point FFT + + VHADD qU0,qX0,qX4 + VHADD qU2,qX1,qX5 + VHADD qU4,qX2,qX6 + VHADD qU6,qX3,qX7 + + @// finish second stage of 8 point FFT + + VHADD qV0,qU0,qU4 + VHSUB qV2,qU0,qU4 + VHADD qV4,qU2,qU6 + VHSUB qV6,qU2,qU6 + + @// finish third stage of 8 point FFT + + VHADD qY0,qV0,qV4 + VHSUB qY4,qV0,qV4 + VST2 {dYr0,dYi0},[pDst, :128],step1 @// store y0 + + .ifeqs "\inverse", "TRUE" + + VHSUB dYr2,dVr2,dVi6 + VHADD dYi2,dVi2,dVr6 + + VHADD dYr6,dVr2,dVi6 + VST2 {dYr2,dYi2},[pDst, :128],step1 @// store y2 + VHSUB dYi6,dVi2,dVr6 + + VHSUB qU1,qX0,qX4 + VST2 {dYr4,dYi4},[pDst, :128],step1 @// store y4 + + VHSUB qU3,qX1,qX5 + VHSUB qU5,qX2,qX6 + VST2 {dYr6,dYi6},[pDst, :128],step1 @// store y6 + + .ELSE + + VHADD dYr6,dVr2,dVi6 + VHSUB dYi6,dVi2,dVr6 + + VHSUB dYr2,dVr2,dVi6 + VST2 {dYr6,dYi6},[pDst, :128],step1 @// store y2 + VHADD dYi2,dVi2,dVr6 + + + VHSUB qU1,qX0,qX4 + VST2 {dYr4,dYi4},[pDst, :128],step1 @// store y4 + VHSUB qU3,qX1,qX5 + VHSUB qU5,qX2,qX6 + VST2 {dYr2,dYi2},[pDst, :128],step1 @// store y6 + + + .ENDIF + + @// finish first stage of 8 point FFT + + VHSUB qU7,qX3,qX7 + VMOV dT0[0],t0 + + @// finish second stage of 8 point FFT + + VHSUB dVr1,dUr1,dUi5 + VLD2 {dXr0,dXi0},[pSrc, :128],pointStep @// data[0] for next iteration + VHADD dVi1,dUi1,dUr5 + VHADD dVr3,dUr1,dUi5 + VLD2 {dXr1,dXi1},[pSrc, :128],pointStep @// data[1] + VHSUB dVi3,dUi1,dUr5 + + VHSUB dVr5,dUr3,dUi7 + VLD2 {dXr2,dXi2},[pSrc, :128],pointStep @// data[2] + VHADD dVi5,dUi3,dUr7 + VHADD dVr7,dUr3,dUi7 + VLD2 {dXr3,dXi3},[pSrc, :128],pointStep @// data[3] + VHSUB dVi7,dUi3,dUr7 + + @// finish third stage of 8 point FFT + + .ifeqs "\inverse", "TRUE" + + @// calculate a*v5 + VQRDMULH dT1,dVr5,dT0[0] @// use dVi0 for dT1 + VLD2 {dXr4,dXi4},[pSrc, :128],pointStep @// data[4] + VQRDMULH dVi5,dVi5,dT0[0] + + VLD2 {dXr5,dXi5},[pSrc, :128],pointStep @// data[5] + VSUB dVr5,dT1,dVi5 @// a * V5 + VADD dVi5,dT1,dVi5 + + VLD2 {dXr6,dXi6},[pSrc, :128],pointStep @// data[6] + + @// calculate b*v7 + VQRDMULH dT1,dVr7,dT0[0] + VQRDMULH dVi7,dVi7,dT0[0] + + VHADD qY1,qV1,qV5 + VHSUB qY5,qV1,qV5 + + + VADD dVr7,dT1,dVi7 @// b * V7 + VSUB dVi7,dVi7,dT1 + SUB pDst, pDst, step2 @// set pDst to y1 + + VLD2 {dXr7,dXi7},[pSrc, :128],setStep @// data[7] + + + VHSUB dYr3,dVr3,dVr7 + VHSUB dYi3,dVi3,dVi7 + VST2 {dYr1,dYi1},[pDst, :128],step1 @// store y1 + VHADD dYr7,dVr3,dVr7 + VHADD dYi7,dVi3,dVi7 + + + VST2 {dYr3,dYi3},[pDst, :128],step1 @// store y3 + VST2 {dYr5,dYi5},[pDst, :128],step1 @// store y5 +#if 0 + VST2 {dYr7,dYi7},[pDst, :128],#16 @// store y7 +#else + VST2 {dYr7,dYi7},[pDst, :128]! @// store y7 +#endif + .ELSE + + @// calculate b*v7 + VQRDMULH dT1,dVr7,dT0[0] + VLD2 {dXr4,dXi4},[pSrc, :128],pointStep @// data[4] + VQRDMULH dVi7,dVi7,dT0[0] + + VLD2 {dXr5,dXi5},[pSrc, :128],pointStep @// data[5] + VADD dVr7,dT1,dVi7 @// b * V7 + VSUB dVi7,dVi7,dT1 + + VLD2 {dXr6,dXi6},[pSrc, :128],pointStep @// data[6] + + @// calculate a*v5 + VQRDMULH dT1,dVr5,dT0[0] @// use dVi0 for dT1 + VQRDMULH dVi5,dVi5,dT0[0] + + VHADD dYr7,dVr3,dVr7 + VHADD dYi7,dVi3,dVi7 + SUB pDst, pDst, step2 @// set pDst to y1 + + VSUB dVr5,dT1,dVi5 @// a * V5 + VADD dVi5,dT1,dVi5 + VLD2 {dXr7,dXi7},[pSrc, :128],setStep @// data[7] + + VHSUB qY5,qV1,qV5 + + VHSUB dYr3,dVr3,dVr7 + VST2 {dYr7,dYi7},[pDst, :128],step1 @// store y1 + VHSUB dYi3,dVi3,dVi7 + VHADD qY1,qV1,qV5 + + + VST2 {dYr5,dYi5},[pDst, :128],step1 @// store y3 + VST2 {dYr3,dYi3},[pDst, :128],step1 @// store y5 +#if 0 + VST2 {dYr1,dYi1},[pDst, :128],#16 @// store y7 +#else + VST2 {dYr1,dYi1},[pDst, :128]! @// store y7 +#endif + + .ENDIF + + + + .ELSE + @// finish first stage of 8 point FFT + + VADD qU0,qX0,qX4 + VADD qU2,qX1,qX5 + VADD qU4,qX2,qX6 + VADD qU6,qX3,qX7 + + @// finish second stage of 8 point FFT + + VADD qV0,qU0,qU4 + VSUB qV2,qU0,qU4 + VADD qV4,qU2,qU6 + VSUB qV6,qU2,qU6 + + @// finish third stage of 8 point FFT + + VADD qY0,qV0,qV4 + VSUB qY4,qV0,qV4 + VST2 {dYr0,dYi0},[pDst, :128],step1 @// store y0 + + .ifeqs "\inverse", "TRUE" + + VSUB dYr2,dVr2,dVi6 + VADD dYi2,dVi2,dVr6 + + VADD dYr6,dVr2,dVi6 + VST2 {dYr2,dYi2},[pDst, :128],step1 @// store y2 + VSUB dYi6,dVi2,dVr6 + + VSUB qU1,qX0,qX4 + VST2 {dYr4,dYi4},[pDst, :128],step1 @// store y4 + + VSUB qU3,qX1,qX5 + VSUB qU5,qX2,qX6 + VST2 {dYr6,dYi6},[pDst, :128],step1 @// store y6 + + .ELSE + + VADD dYr6,dVr2,dVi6 + VSUB dYi6,dVi2,dVr6 + + VSUB dYr2,dVr2,dVi6 + VST2 {dYr6,dYi6},[pDst, :128],step1 @// store y2 + VADD dYi2,dVi2,dVr6 + + + VSUB qU1,qX0,qX4 + VST2 {dYr4,dYi4},[pDst, :128],step1 @// store y4 + VSUB qU3,qX1,qX5 + VSUB qU5,qX2,qX6 + VST2 {dYr2,dYi2},[pDst, :128],step1 @// store y6 + + + .ENDIF + + @// finish first stage of 8 point FFT + + VSUB qU7,qX3,qX7 + VMOV dT0[0],t0 + + @// finish second stage of 8 point FFT + + VSUB dVr1,dUr1,dUi5 + VLD2 {dXr0,dXi0},[pSrc, :128],pointStep @// data[0] for next iteration + VADD dVi1,dUi1,dUr5 + VADD dVr3,dUr1,dUi5 + VLD2 {dXr1,dXi1},[pSrc, :128],pointStep @// data[1] + VSUB dVi3,dUi1,dUr5 + + VSUB dVr5,dUr3,dUi7 + VLD2 {dXr2,dXi2},[pSrc, :128],pointStep @// data[2] + VADD dVi5,dUi3,dUr7 + VADD dVr7,dUr3,dUi7 + VLD2 {dXr3,dXi3},[pSrc, :128],pointStep @// data[3] + VSUB dVi7,dUi3,dUr7 + + @// finish third stage of 8 point FFT + + .ifeqs "\inverse", "TRUE" + + @// calculate a*v5 + VQRDMULH dT1,dVr5,dT0[0] @// use dVi0 for dT1 + VLD2 {dXr4,dXi4},[pSrc, :128],pointStep @// data[4] + VQRDMULH dVi5,dVi5,dT0[0] + + VLD2 {dXr5,dXi5},[pSrc, :128],pointStep @// data[5] + VSUB dVr5,dT1,dVi5 @// a * V5 + VADD dVi5,dT1,dVi5 + + VLD2 {dXr6,dXi6},[pSrc, :128],pointStep @// data[6] + + @// calculate b*v7 + VQRDMULH dT1,dVr7,dT0[0] + VQRDMULH dVi7,dVi7,dT0[0] + + VADD qY1,qV1,qV5 + VSUB qY5,qV1,qV5 + + + VADD dVr7,dT1,dVi7 @// b * V7 + VSUB dVi7,dVi7,dT1 + SUB pDst, pDst, step2 @// set pDst to y1 + + VLD2 {dXr7,dXi7},[pSrc, :128],setStep @// data[7] + + + VSUB dYr3,dVr3,dVr7 + VSUB dYi3,dVi3,dVi7 + VST2 {dYr1,dYi1},[pDst, :128],step1 @// store y1 + VADD dYr7,dVr3,dVr7 + VADD dYi7,dVi3,dVi7 + + + VST2 {dYr3,dYi3},[pDst, :128],step1 @// store y3 + VST2 {dYr5,dYi5},[pDst, :128],step1 @// store y5 +#if 0 + VST2 {dYr7,dYi7},[pDst, :128],#16 @// store y7 +#else + VST2 {dYr7,dYi7},[pDst, :128]! @// store y7 +#endif + .ELSE + + @// calculate b*v7 + VQRDMULH dT1,dVr7,dT0[0] + VLD2 {dXr4,dXi4},[pSrc, :128],pointStep @// data[4] + VQRDMULH dVi7,dVi7,dT0[0] + + VLD2 {dXr5,dXi5},[pSrc, :128],pointStep @// data[5] + VADD dVr7,dT1,dVi7 @// b * V7 + VSUB dVi7,dVi7,dT1 + + VLD2 {dXr6,dXi6},[pSrc, :128],pointStep @// data[6] + + @// calculate a*v5 + VQRDMULH dT1,dVr5,dT0[0] @// use dVi0 for dT1 + VQRDMULH dVi5,dVi5,dT0[0] + + VADD dYr7,dVr3,dVr7 + VADD dYi7,dVi3,dVi7 + SUB pDst, pDst, step2 @// set pDst to y1 + + VSUB dVr5,dT1,dVi5 @// a * V5 + VADD dVi5,dT1,dVi5 + VLD2 {dXr7,dXi7},[pSrc, :128],setStep @// data[7] + + VSUB qY5,qV1,qV5 + + VSUB dYr3,dVr3,dVr7 + VST2 {dYr7,dYi7},[pDst, :128],step1 @// store y1 + VSUB dYi3,dVi3,dVi7 + VADD qY1,qV1,qV5 + + + VST2 {dYr5,dYi5},[pDst, :128],step1 @// store y3 + VST2 {dYr3,dYi3},[pDst, :128],step1 @// store y5 +#if 0 + VST2 {dYr1,dYi1},[pDst, :128],#16 @// store y7 +#else + VST2 {dYr1,dYi1},[pDst, :128]! @// store y7 +#endif + + .ENDIF + + + .ENDIF + + SUB pDst, pDst, step2 @// update pDst for the next set + BGT grpZeroSetLoop\name + + + @// reset pSrc to pDst for the next stage + SUB pSrc,pDst,pointStep @// pDst -= 2*grpSize + MOV pDst,pPingPongBuf + + + + .endm + + + @// Allocate stack memory required by the function + + + M_START armSP_FFTFwd_CToC_SC16_Radix8_fs_OutOfPlace_unsafe,r4 + FFTSTAGE "FALSE","FALSE",FWD + M_END + + + M_START armSP_FFTInv_CToC_SC16_Radix8_fs_OutOfPlace_unsafe,r4 + FFTSTAGE "FALSE","TRUE",INV + M_END + + + M_START armSP_FFTFwd_CToC_SC16_Sfs_Radix8_fs_OutOfPlace_unsafe,r4 + FFTSTAGE "TRUE","FALSE",FWDSFS + M_END + + + M_START armSP_FFTInv_CToC_SC16_Sfs_Radix8_fs_OutOfPlace_unsafe,r4 + FFTSTAGE "TRUE","TRUE",INVSFS + M_END + + + + + + .END |