LXR linux/drivers/scsi/arm/acornscsi-io.S

   1/*
   2 *  linux/drivers/acorn/scsi/acornscsi-io.S: Acorn SCSI card IO
   3 *
   4 * This program is free software; you can redistribute it and/or modify
   5 * it under the terms of the GNU General Public License version 2 as
   6 * published by the Free Software Foundation.
   7 */
   8#include <linux/linkage.h>
   9
  10#include <asm/assembler.h>
  11#include <mach/hardware.h>
  12
  13#if defined(__APCS_32__)
  14#define LOADREGS(t,r,l...)      ldm##t  r, l
  15#elif defined(__APCS_26__)
  16#define LOADREGS(t,r,l...)      ldm##t  r, l##^
  17#endif
  18
  19@ Purpose: transfer a block of data from the acorn scsi card to memory
  20@ Proto  : void acornscsi_in(unsigned int addr_start, char *buffer, int length)
  21@ Returns: nothing
  22
  23                .align
  24ENTRY(__acornscsi_in)
  25                stmfd   sp!, {r4 - r7, lr}
  26                bic     r0, r0, #3
  27                mov     lr, #0xff
  28                orr     lr, lr, #0xff00
  29acornscsi_in16lp:
  30                subs    r2, r2, #16
  31                bmi     acornscsi_in8
  32                ldmia   r0!, {r3, r4, r5, r6}
  33                and     r3, r3, lr
  34                orr     r3, r3, r4, lsl #16
  35                and     r4, r5, lr
  36                orr     r4, r4, r6, lsl #16
  37                ldmia   r0!, {r5, r6, r7, ip}
  38                and     r5, r5, lr
  39                orr     r5, r5, r6, lsl #16
  40                and     r6, r7, lr
  41                orr     r6, r6, ip, lsl #16
  42                stmia   r1!, {r3 - r6}
  43                bne     acornscsi_in16lp
  44                LOADREGS(fd, sp!, {r4 - r7, pc})
  45
  46acornscsi_in8:  adds    r2, r2, #8
  47                bmi     acornscsi_in4
  48                ldmia   r0!, {r3, r4, r5, r6}
  49                and     r3, r3, lr
  50                orr     r3, r3, r4, lsl #16
  51                and     r4, r5, lr
  52                orr     r4, r4, r6, lsl #16
  53                stmia   r1!, {r3 - r4}
  54                LOADREGS(eqfd, sp!, {r4 - r7, pc})
  55                sub     r2, r2, #8
  56
  57acornscsi_in4:  adds    r2, r2, #4
  58                bmi     acornscsi_in2
  59                ldmia   r0!, {r3, r4}
  60                and     r3, r3, lr
  61                orr     r3, r3, r4, lsl #16
  62                str     r3, [r1], #4
  63                LOADREGS(eqfd, sp!, {r4 - r7, pc})
  64                sub     r2, r2, #4
  65
  66acornscsi_in2:  adds    r2, r2, #2
  67                ldr     r3, [r0], #4
  68                and     r3, r3, lr
  69                strb    r3, [r1], #1
  70                mov     r3, r3, lsr #8
  71                strplb  r3, [r1], #1
  72                LOADREGS(fd, sp!, {r4 - r7, pc})
  73
  74@ Purpose: transfer a block of data from memory to the acorn scsi card
  75@ Proto  : void acornscsi_in(unsigned int addr_start, char *buffer, int length)
  76@ Returns: nothing
  77
  78ENTRY(__acornscsi_out)
  79                stmfd   sp!, {r4 - r6, lr}
  80                bic     r0, r0, #3
  81acornscsi_out16lp:
  82                subs    r2, r2, #16
  83                bmi     acornscsi_out8
  84                ldmia   r1!, {r4, r6, ip, lr}
  85                mov     r3, r4, lsl #16
  86                orr     r3, r3, r3, lsr #16
  87                mov     r4, r4, lsr #16
  88                orr     r4, r4, r4, lsl #16
  89                mov     r5, r6, lsl #16
  90                orr     r5, r5, r5, lsr #16
  91                mov     r6, r6, lsr #16
  92                orr     r6, r6, r6, lsl #16
  93                stmia   r0!, {r3, r4, r5, r6}
  94                mov     r3, ip, lsl #16
  95                orr     r3, r3, r3, lsr #16
  96                mov     r4, ip, lsr #16
  97                orr     r4, r4, r4, lsl #16
  98                mov     ip, lr, lsl #16
  99                orr     ip, ip, ip, lsr #16
 100                mov     lr, lr, lsr #16
 101                orr     lr, lr, lr, lsl #16
 102                stmia   r0!, {r3, r4, ip, lr}
 103                bne     acornscsi_out16lp
 104                LOADREGS(fd, sp!, {r4 - r6, pc})
 105
 106acornscsi_out8: adds    r2, r2, #8
 107                bmi     acornscsi_out4
 108                ldmia   r1!, {r4, r6}
 109                mov     r3, r4, lsl #16
 110                orr     r3, r3, r3, lsr #16
 111                mov     r4, r4, lsr #16
 112                orr     r4, r4, r4, lsl #16
 113                mov     r5, r6, lsl #16
 114                orr     r5, r5, r5, lsr #16
 115                mov     r6, r6, lsr #16
 116                orr     r6, r6, r6, lsl #16
 117                stmia   r0!, {r3, r4, r5, r6}
 118                LOADREGS(eqfd, sp!, {r4 - r6, pc})
 119
 120                sub     r2, r2, #8
 121acornscsi_out4: adds    r2, r2, #4
 122                bmi     acornscsi_out2
 123                ldr     r4, [r1], #4
 124                mov     r3, r4, lsl #16
 125                orr     r3, r3, r3, lsr #16
 126                mov     r4, r4, lsr #16
 127                orr     r4, r4, r4, lsl #16
 128                stmia   r0!, {r3, r4}
 129                LOADREGS(eqfd, sp!, {r4 - r6, pc})
 130
 131                sub     r2, r2, #4
 132acornscsi_out2: adds    r2, r2, #2
 133                ldr     r3, [r1], #2
 134                strb    r3, [r0], #1
 135                mov     r3, r3, lsr #8
 136                strplb  r3, [r0], #1
 137                LOADREGS(fd, sp!, {r4 - r6, pc})
 138
 139