Book a Demo!
CoCalc Logo Icon
StoreFeaturesDocsShareSupportNewsAboutPoliciesSign UpSign In
awilliam
GitHub Repository: awilliam/linux-vfio
 Path: blob/master/arch/arm/lib/io-readsw-armv3.S
10817 views
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 <mach/hardware.h>

13


14
.Linsw_bad_alignment:

15
		adr	r0, .Linsw_bad_align_msg

16
		mov	r2, lr

17
		b	panic

18
.Linsw_bad_align_msg:

19
		.asciz	"insw: bad buffer alignment (0x%p, lr=0x%08lX)\n"

20
		.align

21


22
.Linsw_align:	tst	r1, #1

23
		bne	.Linsw_bad_alignment

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

31
		moveq	pc, lr

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

37
		bne	.Linsw_align

38


39
.Linsw_aligned:	mov	ip, #0xff

40
		orr	ip, ip, ip, lsl #8

41
		stmfd	sp!, {r4, r5, r6, lr}

42


43
		subs	r2, r2, #8

44
		bmi	.Lno_insw_8

45


46
.Linsw_8_lp:	ldr	r3, [r0]

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

69
		bpl	.Linsw_8_lp

70


71
		tst	r2, #7

72
		ldmeqfd	sp!, {r4, r5, r6, pc}

73


74
.Lno_insw_8:	tst	r2, #4

75
		beq	.Lno_insw_4

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


89
.Lno_insw_4:	tst	r2, #2

90
		beq	.Lno_insw_2

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


99
.Lno_insw_2:	tst	r2, #1

100
		ldrne	r3, [r0]

101
		strneb	r3, [r1], #1

102
		movne	r3, r3, lsr #8

103
		strneb	r3, [r1]

104


105
		ldmfd	sp!, {r4, r5, r6, pc}

106


107


108


109