[linux-2.6-block.git] / arch / arm / lib / io-readsw-armv3.S

/*
 *  linux/arch/arm/lib/io-readsw-armv3.S
 *
 *  Copyright (C) 1995-2000 Russell King
 *
 * 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 <asm/hardware.h>

.Linsw_bad_alignment:
		adr	r0, .Linsw_bad_align_msg
		mov	r2, lr
		b	panic
.Linsw_bad_align_msg:
		.asciz	"insw: bad buffer alignment (0x%p, lr=0x%08lX)\n"
		.align

.Linsw_align:	tst	r1, #1
		bne	.Linsw_bad_alignment

		ldr	r3, [r0]
		strb	r3, [r1], #1
		mov	r3, r3, lsr #8
		strb	r3, [r1], #1

		subs	r2, r2, #1
		moveq	pc, lr

ENTRY(__raw_readsw)
		teq	r2, #0		@ do we have to check for the zero len?
		moveq	pc, lr
		tst	r1, #3
		bne	.Linsw_align

.Linsw_aligned:	mov	ip, #0xff
		orr	ip, ip, ip, lsl #8
		stmfd	sp!, {r4, r5, r6, lr}

		subs	r2, r2, #8
		bmi	.Lno_insw_8

.Linsw_8_lp:	ldr	r3, [r0]
		and	r3, r3, ip
		ldr	r4, [r0]
		orr	r3, r3, r4, lsl #16

		ldr	r4, [r0]
		and	r4, r4, ip
		ldr	r5, [r0]
		orr	r4, r4, r5, lsl #16

		ldr	r5, [r0]
		and	r5, r5, ip
		ldr	r6, [r0]
		orr	r5, r5, r6, lsl #16

		ldr	r6, [r0]
		and	r6, r6, ip
		ldr	lr, [r0]
		orr	r6, r6, lr, lsl #16

		stmia	r1!, {r3 - r6}

		subs	r2, r2, #8
		bpl	.Linsw_8_lp

		tst	r2, #7
		LOADREGS(eqfd, sp!, {r4, r5, r6, pc})

.Lno_insw_8:	tst	r2, #4
		beq	.Lno_insw_4

		ldr	r3, [r0]
		and	r3, r3, ip
		ldr	r4, [r0]
		orr	r3, r3, r4, lsl #16

		ldr	r4, [r0]
		and	r4, r4, ip
		ldr	r5, [r0]
		orr	r4, r4, r5, lsl #16

		stmia	r1!, {r3, r4}

.Lno_insw_4:	tst	r2, #2
		beq	.Lno_insw_2

		ldr	r3, [r0]
		and	r3, r3, ip
		ldr	r4, [r0]
		orr	r3, r3, r4, lsl #16

		str	r3, [r1], #4

.Lno_insw_2:	tst	r2, #1
		ldrne	r3, [r0]
		strneb	r3, [r1], #1
		movne	r3, r3, lsr #8
		strneb	r3, [r1]

		LOADREGS(fd, sp!, {r4, r5, r6, pc})
Commit	Line	Data
1da177e4 LT	1	/*
	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>
	12	#include <asm/hardware.h>
	13
a9c4814d NP	14	.Linsw_bad_alignment:
a9c4814d NP	15	adr r0, .Linsw_bad_align_msg
1da177e4 LT	16	mov r2, lr
1da177e4 LT	17	b panic
a9c4814d	18	.Linsw_bad_align_msg:
1da177e4 LT	19	.asciz "insw: bad buffer alignment (0x%p, lr=0x%08lX)\n"
	20	.align
	21
a9c4814d NP	22	.Linsw_align: tst r1, #1
a9c4814d NP	23	bne .Linsw_bad_alignment
1da177e4 LT	24
	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
7999d8d7	31	moveq pc, lr
1da177e4 LT	32
	33	ENTRY(__raw_readsw)
	34	teq r2, #0 @ do we have to check for the zero len?
	35	moveq pc, lr
	36	tst r1, #3
a9c4814d	37	bne .Linsw_align
1da177e4	38
a9c4814d	39	.Linsw_aligned: mov ip, #0xff
1da177e4 LT	40	orr ip, ip, ip, lsl #8
	41	stmfd sp!, {r4, r5, r6, lr}
	42
	43	subs r2, r2, #8
a9c4814d	44	bmi .Lno_insw_8
1da177e4	45
a9c4814d	46	.Linsw_8_lp: ldr r3, [r0]
1da177e4 LT	47	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
a9c4814d	69	bpl .Linsw_8_lp
1da177e4 LT	70
	71	tst r2, #7
	72	LOADREGS(eqfd, sp!, {r4, r5, r6, pc})
	73
a9c4814d NP	74	.Lno_insw_8: tst r2, #4
a9c4814d NP	75	beq .Lno_insw_4
1da177e4 LT	76
	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
a9c4814d NP	89	.Lno_insw_4: tst r2, #2
a9c4814d NP	90	beq .Lno_insw_2
1da177e4 LT	91
	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
a9c4814d	99	.Lno_insw_2: tst r2, #1
1da177e4 LT	100	ldrne r3, [r0]
	101	strneb r3, [r1], #1
	102	movne r3, r3, lsr #8
	103	strneb r3, [r1]
	104
	105	LOADREGS(fd, sp!, {r4, r5, r6, pc})
	106
	107