Loading...
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 | /* SPDX-License-Identifier: GPL-2.0-only */ /* * linux/arch/arm/lib/io-readsb.S * * Copyright (C) 1995-2000 Russell King */ #include <linux/linkage.h> #include <asm/assembler.h> .Linsb_align: rsb ip, ip, #4 cmp ip, r2 movgt ip, r2 cmp ip, #2 ldrb r3, [r0] strb r3, [r1], #1 ldrbge r3, [r0] strbge r3, [r1], #1 ldrbgt r3, [r0] strbgt r3, [r1], #1 subs r2, r2, ip bne .Linsb_aligned ENTRY(__raw_readsb) teq r2, #0 @ do we have to check for the zero len? reteq lr ands ip, r1, #3 bne .Linsb_align .Linsb_aligned: stmfd sp!, {r4 - r6, lr} subs r2, r2, #16 bmi .Linsb_no_16 .Linsb_16_lp: ldrb r3, [r0] ldrb r4, [r0] ldrb r5, [r0] mov r3, r3, put_byte_0 ldrb r6, [r0] orr r3, r3, r4, put_byte_1 ldrb r4, [r0] orr r3, r3, r5, put_byte_2 ldrb r5, [r0] orr r3, r3, r6, put_byte_3 ldrb r6, [r0] mov r4, r4, put_byte_0 ldrb ip, [r0] orr r4, r4, r5, put_byte_1 ldrb r5, [r0] orr r4, r4, r6, put_byte_2 ldrb r6, [r0] orr r4, r4, ip, put_byte_3 ldrb ip, [r0] mov r5, r5, put_byte_0 ldrb lr, [r0] orr r5, r5, r6, put_byte_1 ldrb r6, [r0] orr r5, r5, ip, put_byte_2 ldrb ip, [r0] orr r5, r5, lr, put_byte_3 ldrb lr, [r0] mov r6, r6, put_byte_0 orr r6, r6, ip, put_byte_1 ldrb ip, [r0] orr r6, r6, lr, put_byte_2 orr r6, r6, ip, put_byte_3 stmia r1!, {r3 - r6} subs r2, r2, #16 bpl .Linsb_16_lp tst r2, #15 ldmfdeq sp!, {r4 - r6, pc} .Linsb_no_16: tst r2, #8 beq .Linsb_no_8 ldrb r3, [r0] ldrb r4, [r0] ldrb r5, [r0] mov r3, r3, put_byte_0 ldrb r6, [r0] orr r3, r3, r4, put_byte_1 ldrb r4, [r0] orr r3, r3, r5, put_byte_2 ldrb r5, [r0] orr r3, r3, r6, put_byte_3 ldrb r6, [r0] mov r4, r4, put_byte_0 ldrb ip, [r0] orr r4, r4, r5, put_byte_1 orr r4, r4, r6, put_byte_2 orr r4, r4, ip, put_byte_3 stmia r1!, {r3, r4} .Linsb_no_8: tst r2, #4 beq .Linsb_no_4 ldrb r3, [r0] ldrb r4, [r0] ldrb r5, [r0] ldrb r6, [r0] mov r3, r3, put_byte_0 orr r3, r3, r4, put_byte_1 orr r3, r3, r5, put_byte_2 orr r3, r3, r6, put_byte_3 str r3, [r1], #4 .Linsb_no_4: ands r2, r2, #3 ldmfdeq sp!, {r4 - r6, pc} cmp r2, #2 ldrb r3, [r0] strb r3, [r1], #1 ldrbge r3, [r0] strbge r3, [r1], #1 ldrbgt r3, [r0] strbgt r3, [r1] ldmfd sp!, {r4 - r6, pc} ENDPROC(__raw_readsb) |