mx1-camera-fiq.S 880 B

123456789101112131415161718192021222324252627282930313233343536
  1. /*
  2. * Copyright (C) 2008 Paulius Zaleckas <paulius.zaleckas@teltonika.lt>
  3. *
  4. * Based on linux/arch/arm/lib/floppydma.S
  5. * Copyright (C) 1995, 1996 Russell King
  6. *
  7. * This program is free software; you can redistribute it and/or modify
  8. * it under the terms of the GNU General Public License version 2 as
  9. * published by the Free Software Foundation.
  10. */
  11. #include <linux/linkage.h>
  12. #include <asm/assembler.h>
  13. .text
  14. .global mx1_camera_sof_fiq_end
  15. .global mx1_camera_sof_fiq_start
  16. mx1_camera_sof_fiq_start:
  17. @ enable dma
  18. ldr r12, [r9]
  19. orr r12, r12, #0x00000001
  20. str r12, [r9]
  21. @ unmask DMA interrupt
  22. ldr r12, [r8]
  23. bic r12, r12, r13
  24. str r12, [r8]
  25. @ disable SOF interrupt
  26. ldr r12, [r10]
  27. bic r12, r12, #0x00010000
  28. str r12, [r10]
  29. @ clear SOF flag
  30. mov r12, #0x00010000
  31. str r12, [r11]
  32. @ return from FIQ
  33. subs pc, lr, #4
  34. mx1_camera_sof_fiq_end: