blob: 9aaf7c72065d852a9fa049479d8f333430c0fe26 [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
2 * linux/arch/arm/lib/io-readsw-armv3.S
3 *
4 * Copyright (C) 1995-2000 Russell King
5 *
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License version 2 as
8 * published by the Free Software Foundation.
9 */
10#include <linux/linkage.h>
11#include <asm/assembler.h>
Russell Kinga09e64f2008-08-05 16:14:15 +010012#include <mach/hardware.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070013
Nicolas Pitrea9c48142005-11-11 21:51:48 +000014.Linsw_bad_alignment:
15 adr r0, .Linsw_bad_align_msg
Linus Torvalds1da177e2005-04-16 15:20:36 -070016 mov r2, lr
17 b panic
Nicolas Pitrea9c48142005-11-11 21:51:48 +000018.Linsw_bad_align_msg:
Linus Torvalds1da177e2005-04-16 15:20:36 -070019 .asciz "insw: bad buffer alignment (0x%p, lr=0x%08lX)\n"
20 .align
21
Nicolas Pitrea9c48142005-11-11 21:51:48 +000022.Linsw_align: tst r1, #1
23 bne .Linsw_bad_alignment
Linus Torvalds1da177e2005-04-16 15:20:36 -070024
25 ldr r3, [r0]
26 strb r3, [r1], #1
27 mov r3, r3, lsr #8
28 strb r3, [r1], #1
29
30 subs r2, r2, #1
Russell King7999d8d2006-06-25 11:17:23 +010031 moveq pc, lr
Linus Torvalds1da177e2005-04-16 15:20:36 -070032
33ENTRY(__raw_readsw)
34 teq r2, #0 @ do we have to check for the zero len?
35 moveq pc, lr
36 tst r1, #3
Nicolas Pitrea9c48142005-11-11 21:51:48 +000037 bne .Linsw_align
Linus Torvalds1da177e2005-04-16 15:20:36 -070038
Nicolas Pitrea9c48142005-11-11 21:51:48 +000039.Linsw_aligned: mov ip, #0xff
Linus Torvalds1da177e2005-04-16 15:20:36 -070040 orr ip, ip, ip, lsl #8
41 stmfd sp!, {r4, r5, r6, lr}
42
43 subs r2, r2, #8
Nicolas Pitrea9c48142005-11-11 21:51:48 +000044 bmi .Lno_insw_8
Linus Torvalds1da177e2005-04-16 15:20:36 -070045
Nicolas Pitrea9c48142005-11-11 21:51:48 +000046.Linsw_8_lp: ldr r3, [r0]
Linus Torvalds1da177e2005-04-16 15:20:36 -070047 and r3, r3, ip
48 ldr r4, [r0]
49 orr r3, r3, r4, lsl #16
50
51 ldr r4, [r0]
52 and r4, r4, ip
53 ldr r5, [r0]
54 orr r4, r4, r5, lsl #16
55
56 ldr r5, [r0]
57 and r5, r5, ip
58 ldr r6, [r0]
59 orr r5, r5, r6, lsl #16
60
61 ldr r6, [r0]
62 and r6, r6, ip
63 ldr lr, [r0]
64 orr r6, r6, lr, lsl #16
65
66 stmia r1!, {r3 - r6}
67
68 subs r2, r2, #8
Nicolas Pitrea9c48142005-11-11 21:51:48 +000069 bpl .Linsw_8_lp
Linus Torvalds1da177e2005-04-16 15:20:36 -070070
71 tst r2, #7
Russell King1b93a712006-06-25 11:23:45 +010072 ldmeqfd sp!, {r4, r5, r6, pc}
Linus Torvalds1da177e2005-04-16 15:20:36 -070073
Nicolas Pitrea9c48142005-11-11 21:51:48 +000074.Lno_insw_8: tst r2, #4
75 beq .Lno_insw_4
Linus Torvalds1da177e2005-04-16 15:20:36 -070076
77 ldr r3, [r0]
78 and r3, r3, ip
79 ldr r4, [r0]
80 orr r3, r3, r4, lsl #16
81
82 ldr r4, [r0]
83 and r4, r4, ip
84 ldr r5, [r0]
85 orr r4, r4, r5, lsl #16
86
87 stmia r1!, {r3, r4}
88
Nicolas Pitrea9c48142005-11-11 21:51:48 +000089.Lno_insw_4: tst r2, #2
90 beq .Lno_insw_2
Linus Torvalds1da177e2005-04-16 15:20:36 -070091
92 ldr r3, [r0]
93 and r3, r3, ip
94 ldr r4, [r0]
95 orr r3, r3, r4, lsl #16
96
97 str r3, [r1], #4
98
Nicolas Pitrea9c48142005-11-11 21:51:48 +000099.Lno_insw_2: tst r2, #1
Linus Torvalds1da177e2005-04-16 15:20:36 -0700100 ldrne r3, [r0]
101 strneb r3, [r1], #1
102 movne r3, r3, lsr #8
103 strneb r3, [r1]
104
Russell King1b93a712006-06-25 11:23:45 +0100105 ldmfd sp!, {r4, r5, r6, pc}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700106
107