float_dsp_vfp.S 2.4 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768
  1. /*
  2. * Copyright (c) 2008 Siarhei Siamashka <ssvb@users.sourceforge.net>
  3. *
  4. * This file is part of FFmpeg
  5. *
  6. * FFmpeg is free software; you can redistribute it and/or
  7. * modify it under the terms of the GNU Lesser General Public
  8. * License as published by the Free Software Foundation; either
  9. * version 2.1 of the License, or (at your option) any later version.
  10. *
  11. * FFmpeg is distributed in the hope that it will be useful,
  12. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  13. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
  14. * Lesser General Public License for more details.
  15. *
  16. * You should have received a copy of the GNU Lesser General Public
  17. * License along with FFmpeg; if not, write to the Free Software
  18. * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
  19. */
  20. #include "config.h"
  21. #include "asm.S"
  22. /**
  23. * Assume that len is a positive number and is multiple of 8
  24. */
  25. @ void ff_vector_fmul_vfp(float *dst, const float *src0, const float *src1, int len)
  26. function ff_vector_fmul_vfp, export=1
  27. vpush {d8-d15}
  28. fmrx r12, fpscr
  29. orr r12, r12, #(3 << 16) /* set vector size to 4 */
  30. fmxr fpscr, r12
  31. vldmia r1!, {s0-s3}
  32. vldmia r2!, {s8-s11}
  33. vldmia r1!, {s4-s7}
  34. vldmia r2!, {s12-s15}
  35. vmul.f32 s8, s0, s8
  36. 1:
  37. subs r3, r3, #16
  38. vmul.f32 s12, s4, s12
  39. itttt ge
  40. vldmiage r1!, {s16-s19}
  41. vldmiage r2!, {s24-s27}
  42. vldmiage r1!, {s20-s23}
  43. vldmiage r2!, {s28-s31}
  44. it ge
  45. vmulge.f32 s24, s16, s24
  46. vstmia r0!, {s8-s11}
  47. vstmia r0!, {s12-s15}
  48. it ge
  49. vmulge.f32 s28, s20, s28
  50. itttt gt
  51. vldmiagt r1!, {s0-s3}
  52. vldmiagt r2!, {s8-s11}
  53. vldmiagt r1!, {s4-s7}
  54. vldmiagt r2!, {s12-s15}
  55. ittt ge
  56. vmulge.f32 s8, s0, s8
  57. vstmiage r0!, {s24-s27}
  58. vstmiage r0!, {s28-s31}
  59. bgt 1b
  60. bic r12, r12, #(7 << 16) /* set vector size back to 1 */
  61. fmxr fpscr, r12
  62. vpop {d8-d15}
  63. bx lr
  64. endfunc