Thomas Gleixner | d2912cb | 2019-06-04 10:11:33 +0200 | [diff] [blame^] | 1 | /* SPDX-License-Identifier: GPL-2.0-only */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2 | /* |
| 3 | * linux/arch/arm/lib/ll_char_wr.S |
| 4 | * |
| 5 | * Copyright (C) 1995, 1996 Russell King. |
| 6 | * |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 7 | * Speedups & 1bpp code (C) 1996 Philip Blundell & Russell King. |
| 8 | * |
| 9 | * 10-04-96 RMK Various cleanups & reduced register usage. |
| 10 | * 08-04-98 RMK Shifts re-ordered |
| 11 | */ |
| 12 | |
| 13 | @ Regs: [] = corruptible |
| 14 | @ {} = used |
| 15 | @ () = do not use |
| 16 | |
| 17 | #include <linux/linkage.h> |
| 18 | #include <asm/assembler.h> |
| 19 | .text |
| 20 | |
| 21 | LC0: .word LC0 |
| 22 | .word bytes_per_char_h |
| 23 | .word video_size_row |
| 24 | .word acorndata_8x8 |
| 25 | .word con_charconvtable |
| 26 | |
| 27 | /* |
| 28 | * r0 = ptr |
| 29 | * r1 = char |
| 30 | * r2 = white |
| 31 | */ |
| 32 | ENTRY(ll_write_char) |
| 33 | stmfd sp!, {r4 - r7, lr} |
| 34 | @ |
| 35 | @ Smashable regs: {r0 - r3}, [r4 - r7], (r8 - fp), [ip], (sp), [lr], (pc) |
| 36 | @ |
| 37 | /* |
| 38 | * calculate offset into character table |
| 39 | */ |
| 40 | mov r1, r1, lsl #3 |
| 41 | /* |
| 42 | * calculate offset required for each row. |
| 43 | */ |
| 44 | adr ip, LC0 |
| 45 | ldmia ip, {r3, r4, r5, r6, lr} |
| 46 | sub ip, ip, r3 |
| 47 | add r6, r6, ip |
| 48 | add lr, lr, ip |
| 49 | ldr r4, [r4, ip] |
| 50 | ldr r5, [r5, ip] |
| 51 | /* |
| 52 | * Go to resolution-dependent routine... |
| 53 | */ |
| 54 | cmp r4, #4 |
| 55 | blt Lrow1bpp |
| 56 | add r0, r0, r5, lsl #3 @ Move to bottom of character |
| 57 | orr r1, r1, #7 |
| 58 | ldrb r7, [r6, r1] |
| 59 | teq r4, #8 |
| 60 | beq Lrow8bpplp |
| 61 | @ |
| 62 | @ Smashable regs: {r0 - r3}, [r4], {r5 - r7}, (r8 - fp), [ip], (sp), {lr}, (pc) |
| 63 | @ |
| 64 | Lrow4bpplp: |
| 65 | ldr r7, [lr, r7, lsl #2] |
| 66 | mul r7, r2, r7 |
| 67 | sub r1, r1, #1 @ avoid using r7 directly after |
| 68 | str r7, [r0, -r5]! |
| 69 | ldrb r7, [r6, r1] |
| 70 | ldr r7, [lr, r7, lsl #2] |
| 71 | mul r7, r2, r7 |
| 72 | tst r1, #7 @ avoid using r7 directly after |
| 73 | str r7, [r0, -r5]! |
| 74 | subne r1, r1, #1 |
Stefan Agner | e44fc38 | 2019-02-18 00:57:38 +0100 | [diff] [blame] | 75 | ldrbne r7, [r6, r1] |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 76 | bne Lrow4bpplp |
Russell King | 1b93a71 | 2006-06-25 11:23:45 +0100 | [diff] [blame] | 77 | ldmfd sp!, {r4 - r7, pc} |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 78 | |
| 79 | @ |
| 80 | @ Smashable regs: {r0 - r3}, [r4], {r5 - r7}, (r8 - fp), [ip], (sp), {lr}, (pc) |
| 81 | @ |
| 82 | Lrow8bpplp: |
| 83 | mov ip, r7, lsr #4 |
| 84 | ldr ip, [lr, ip, lsl #2] |
| 85 | mul r4, r2, ip |
| 86 | and ip, r7, #15 @ avoid r4 |
| 87 | ldr ip, [lr, ip, lsl #2] @ avoid r4 |
| 88 | mul ip, r2, ip @ avoid r4 |
| 89 | sub r1, r1, #1 @ avoid ip |
| 90 | sub r0, r0, r5 @ avoid ip |
| 91 | stmia r0, {r4, ip} |
| 92 | ldrb r7, [r6, r1] |
| 93 | mov ip, r7, lsr #4 |
| 94 | ldr ip, [lr, ip, lsl #2] |
| 95 | mul r4, r2, ip |
| 96 | and ip, r7, #15 @ avoid r4 |
| 97 | ldr ip, [lr, ip, lsl #2] @ avoid r4 |
| 98 | mul ip, r2, ip @ avoid r4 |
| 99 | tst r1, #7 @ avoid ip |
| 100 | sub r0, r0, r5 @ avoid ip |
| 101 | stmia r0, {r4, ip} |
| 102 | subne r1, r1, #1 |
Stefan Agner | e44fc38 | 2019-02-18 00:57:38 +0100 | [diff] [blame] | 103 | ldrbne r7, [r6, r1] |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 104 | bne Lrow8bpplp |
Russell King | 1b93a71 | 2006-06-25 11:23:45 +0100 | [diff] [blame] | 105 | ldmfd sp!, {r4 - r7, pc} |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 106 | |
| 107 | @ |
| 108 | @ Smashable regs: {r0 - r3}, [r4], {r5, r6}, [r7], (r8 - fp), [ip], (sp), [lr], (pc) |
| 109 | @ |
| 110 | Lrow1bpp: |
| 111 | add r6, r6, r1 |
| 112 | ldmia r6, {r4, r7} |
| 113 | strb r4, [r0], r5 |
| 114 | mov r4, r4, lsr #8 |
| 115 | strb r4, [r0], r5 |
| 116 | mov r4, r4, lsr #8 |
| 117 | strb r4, [r0], r5 |
| 118 | mov r4, r4, lsr #8 |
| 119 | strb r4, [r0], r5 |
| 120 | strb r7, [r0], r5 |
| 121 | mov r7, r7, lsr #8 |
| 122 | strb r7, [r0], r5 |
| 123 | mov r7, r7, lsr #8 |
| 124 | strb r7, [r0], r5 |
| 125 | mov r7, r7, lsr #8 |
| 126 | strb r7, [r0], r5 |
Russell King | 1b93a71 | 2006-06-25 11:23:45 +0100 | [diff] [blame] | 127 | ldmfd sp!, {r4 - r7, pc} |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 128 | |
| 129 | .bss |
| 130 | ENTRY(con_charconvtable) |
| 131 | .space 1024 |