Blame view

kernel/linux-imx6_3.14.28/drivers/spi/spi-s3c24xx-fiq.S 2.88 KB
6b13f685e   김민수   BSP 최초 추가
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
  /* linux/drivers/spi/spi_s3c24xx_fiq.S
   *
   * Copyright 2009 Simtec Electronics
   *	Ben Dooks <ben@simtec.co.uk>
   *
   * S3C24XX SPI - FIQ pseudo-DMA transfer code
   *
   * This program is free software; you can redistribute it and/or modify
   * it under the terms of the GNU General Public License version 2 as
   * published by the Free Software Foundation.
  */
  
  #include <linux/linkage.h>
  #include <asm/assembler.h>
  
  #include <mach/map.h>
  #include <mach/regs-irq.h>
  #include <plat/regs-spi.h>
  
  #include "spi-s3c24xx-fiq.h"
  
  	.text
  
  	@ entry to these routines is as follows, with the register names
  	@ defined in fiq.h so that they can be shared with the C files which
  	@ setup the calling registers.
  	@
  	@ fiq_rirq	The base of the IRQ registers to find S3C2410_SRCPND
  	@ fiq_rtmp	Temporary register to hold tx/rx data
  	@ fiq_rspi	The base of the SPI register block
  	@ fiq_rtx	The tx buffer pointer
  	@ fiq_rrx	The rx buffer pointer
  	@ fiq_rcount	The number of bytes to move
  
  	@ each entry starts with a word entry of how long it is
  	@ and an offset to the irq acknowledgment word
  
  ENTRY(s3c24xx_spi_fiq_rx)
  s3c24xx_spi_fix_rx:
  	.word	fiq_rx_end - fiq_rx_start
  	.word	fiq_rx_irq_ack - fiq_rx_start
  fiq_rx_start:
  	ldr	fiq_rtmp, fiq_rx_irq_ack
  	str	fiq_rtmp, [ fiq_rirq, # S3C2410_SRCPND - S3C24XX_VA_IRQ ]
  
  	ldrb	fiq_rtmp, [ fiq_rspi, #  S3C2410_SPRDAT ]
  	strb	fiq_rtmp, [ fiq_rrx ], #1
  
  	mov	fiq_rtmp, #0xff
  	strb	fiq_rtmp, [ fiq_rspi, # S3C2410_SPTDAT ]
  
  	subs	fiq_rcount, fiq_rcount, #1
  	subnes	pc, lr, #4		@@ return, still have work to do
  
  	@@ set IRQ controller so that next op will trigger IRQ
  	mov	fiq_rtmp, #0
  	str	fiq_rtmp, [ fiq_rirq, # S3C2410_INTMOD  - S3C24XX_VA_IRQ ]
  	subs	pc, lr, #4
  
  fiq_rx_irq_ack:
  	.word	0
  fiq_rx_end:
  
  ENTRY(s3c24xx_spi_fiq_txrx)
  s3c24xx_spi_fiq_txrx:
  	.word	fiq_txrx_end - fiq_txrx_start
  	.word	fiq_txrx_irq_ack - fiq_txrx_start
  fiq_txrx_start:
  
  	ldrb	fiq_rtmp, [ fiq_rspi, #  S3C2410_SPRDAT ]
  	strb	fiq_rtmp, [ fiq_rrx ], #1
  
  	ldr	fiq_rtmp, fiq_txrx_irq_ack
  	str	fiq_rtmp, [ fiq_rirq, # S3C2410_SRCPND - S3C24XX_VA_IRQ ]
  
  	ldrb	fiq_rtmp, [ fiq_rtx ], #1
  	strb	fiq_rtmp, [ fiq_rspi, # S3C2410_SPTDAT ]
  
  	subs	fiq_rcount, fiq_rcount, #1
  	subnes	pc, lr, #4		@@ return, still have work to do
  
  	mov	fiq_rtmp, #0
  	str	fiq_rtmp, [ fiq_rirq, # S3C2410_INTMOD  - S3C24XX_VA_IRQ ]
  	subs	pc, lr, #4
  
  fiq_txrx_irq_ack:
  	.word	0
  
  fiq_txrx_end:
  
  ENTRY(s3c24xx_spi_fiq_tx)
  s3c24xx_spi_fix_tx:
  	.word	fiq_tx_end - fiq_tx_start
  	.word	fiq_tx_irq_ack - fiq_tx_start
  fiq_tx_start:
  	ldrb	fiq_rtmp, [ fiq_rspi, #  S3C2410_SPRDAT ]
  
  	ldr	fiq_rtmp, fiq_tx_irq_ack
  	str	fiq_rtmp, [ fiq_rirq, # S3C2410_SRCPND - S3C24XX_VA_IRQ ]
  
  	ldrb	fiq_rtmp, [ fiq_rtx ], #1
  	strb	fiq_rtmp, [ fiq_rspi, # S3C2410_SPTDAT ]
  
  	subs	fiq_rcount, fiq_rcount, #1
  	subnes	pc, lr, #4		@@ return, still have work to do
  
  	mov	fiq_rtmp, #0
  	str	fiq_rtmp, [ fiq_rirq, # S3C2410_INTMOD  - S3C24XX_VA_IRQ ]
  	subs	pc, lr, #4
  
  fiq_tx_irq_ack:
  	.word	0
  
  fiq_tx_end:
  
  	.end