]> nv-tegra.nvidia Code Review - linux-2.6.git/blob - drivers/acorn/block/fd1772dma.S
[PATCH] ARM: switch fd1772.c from sleep_on to wait_event
[linux-2.6.git] / drivers / acorn / block / fd1772dma.S
1 #include <asm/hardware.h>
2
3 @ Code for DMA with the 1772 fdc
4 .text
5
6
7   .global fdc1772_dataaddr
8 fdc1772_fiqdata:
9 @ Number of bytes left to DMA
10   .global fdc1772_bytestogo
11 fdc1772_bytestogo:
12   .word 0
13 @ Place to put/get data from in DMA
14   .global fdc1772_dataaddr
15 fdc1772_dataaddr:
16   .word 0
17   
18   .global fdc1772_fdc_int_done
19 fdc1772_fdc_int_done:
20   .word 0
21   .global fdc1772_comendstatus
22 fdc1772_comendstatus:
23   .word 0
24
25 @ We hang this off DMA channel 1
26     .global fdc1772_comendhandler
27 fdc1772_comendhandler:
28   mov      r8,#IOC_BASE
29   ldrb     r9,[r8,#0x34]    @ IOC FIQ status
30   tst      r9,#2
31   subeqs   pc,r14,#4        @ should I leave a space here
32   orr      r9,r8,#0x10000   @ FDC base
33   adr      r8,fdc1772_fdc_int_done
34   ldrb     r10,[r9,#0]  @ FDC status
35   mov      r9,#1        @ Got a FIQ flag
36   stmia    r8,{r9,r10}
37   subs     pc,r14,#4
38
39
40     .global fdc1772_dma_read
41 fdc1772_dma_read:
42   mov      r8,#IOC_BASE
43   ldrb     r9,[r8,#0x34]    @ IOC FIQ status
44   tst      r9,#1
45   beq      fdc1772_dma_read_notours
46   orr      r8,r8,#0x10000   @ FDC base
47   ldrb     r10,[r8,#0xc]   @ Read from FDC data reg (also clears interrupt)
48   ldmia    r11,{r8,r9}
49   subs     r8,r8,#1        @ One less byte to go
50   @ If there was somewhere for this data to go then store it and update pointers
51   strplb   r10,[r9],#1     @ Store the data and increment the pointer
52   stmplia  r11,{r8,r9}     @ Update count/pointers
53   @ Handle any other interrupts if there are any
54 fdc1772_dma_read_notours:
55   @ Cant branch because this code has been copied down to the FIQ vector
56   ldr pc,[pc,#-4]
57   .word fdc1772_comendhandler
58   .global fdc1772_dma_read_end
59 fdc1772_dma_read_end:
60
61     .global fdc1772_dma_write
62 fdc1772_dma_write:
63   mov      r8,#IOC_BASE
64   ldrb     r9,[r8,#0x34]    @ IOC FIQ status
65   tst      r9,#1
66   beq      fdc1772_dma_write_notours
67   orr      r8,r8,#0x10000   @ FDC base
68   ldmia    r11,{r9,r10}
69   subs     r9,r9,#1        @ One less byte to go
70   @ If there really is some data then get it, store it and update count
71   ldrplb   r12,[r10],#1
72   strplb   r12,[r8,#0xc]   @ write it to FDC data reg
73   stmplia  r11,{r9,r10}    @ Update count and pointer - should clear interrupt
74   @ Handle any other interrupts
75 fdc1772_dma_write_notours:
76   @ Cant branch because this code has been copied down to the FIQ vector
77   ldr pc,[pc,#-4]
78   .word fdc1772_comendhandler
79
80   .global fdc1772_dma_write_end
81 fdc1772_dma_write_end:
82   
83
84 @ Setup the FIQ R11 to point to the data and store the count, address
85 @ for this dma
86 @ R0=count
87 @ R1=address
88   .global fdc1772_setupdma
89 fdc1772_setupdma:
90         @ The big job is flipping in and out of FIQ mode
91         adr     r2,fdc1772_fiqdata      @ This is what we really came here for
92   stmia  r2,{r0,r1}
93         mov     r3, pc
94         teqp    pc,#0x0c000001  @ Disable FIQs, IRQs and switch to FIQ mode
95         mov     r0,r0           @ NOP
96         mov r11,r2
97         teqp    r3,#0           @ Normal mode
98         mov     r0,r0           @ NOP
99   mov pc,r14
100