Greg Kroah-Hartman | b244131 | 2017-11-01 15:07:57 +0100 | [diff] [blame] | 1 | /* SPDX-License-Identifier: GPL-2.0 */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2 | /* csum_copy.S: Checksum+copy code for sparc64 |
| 3 | * |
| 4 | * Copyright (C) 2005 David S. Miller <davem@davemloft.net> |
| 5 | */ |
| 6 | |
Al Viro | d3867f04 | 2016-01-16 21:39:30 -0500 | [diff] [blame] | 7 | #include <asm/export.h> |
| 8 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 9 | #ifdef __KERNEL__ |
| 10 | #define GLOBAL_SPARE %g7 |
| 11 | #else |
| 12 | #define GLOBAL_SPARE %g5 |
| 13 | #endif |
| 14 | |
| 15 | #ifndef EX_LD |
| 16 | #define EX_LD(x) x |
| 17 | #endif |
| 18 | |
| 19 | #ifndef EX_ST |
| 20 | #define EX_ST(x) x |
| 21 | #endif |
| 22 | |
| 23 | #ifndef EX_RETVAL |
| 24 | #define EX_RETVAL(x) x |
| 25 | #endif |
| 26 | |
| 27 | #ifndef LOAD |
| 28 | #define LOAD(type,addr,dest) type [addr], dest |
| 29 | #endif |
| 30 | |
| 31 | #ifndef STORE |
| 32 | #define STORE(type,src,addr) type src, [addr] |
| 33 | #endif |
| 34 | |
| 35 | #ifndef FUNC_NAME |
Al Viro | fdf8bee | 2020-07-19 18:31:07 -0400 | [diff] [blame] | 36 | #define FUNC_NAME csum_partial_copy_nocheck |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 37 | #endif |
| 38 | |
| 39 | .register %g2, #scratch |
| 40 | .register %g3, #scratch |
| 41 | |
| 42 | .text |
| 43 | |
| 44 | 90: |
| 45 | /* We checked for zero length already, so there must be |
| 46 | * at least one byte. |
| 47 | */ |
| 48 | be,pt %icc, 1f |
| 49 | nop |
| 50 | EX_LD(LOAD(ldub, %o0 + 0x00, %o4)) |
| 51 | add %o0, 1, %o0 |
| 52 | sub %o2, 1, %o2 |
| 53 | EX_ST(STORE(stb, %o4, %o1 + 0x00)) |
| 54 | add %o1, 1, %o1 |
| 55 | 1: andcc %o0, 0x2, %g0 |
| 56 | be,pn %icc, 80f |
| 57 | cmp %o2, 2 |
| 58 | blu,pn %icc, 60f |
| 59 | nop |
| 60 | EX_LD(LOAD(lduh, %o0 + 0x00, %o5)) |
| 61 | add %o0, 2, %o0 |
| 62 | sub %o2, 2, %o2 |
| 63 | EX_ST(STORE(sth, %o5, %o1 + 0x00)) |
| 64 | add %o1, 2, %o1 |
| 65 | ba,pt %xcc, 80f |
| 66 | add %o5, %o4, %o4 |
| 67 | |
| 68 | .globl FUNC_NAME |
Nagarathnam Muthusamy | f5a651f | 2017-06-19 13:08:50 -0400 | [diff] [blame] | 69 | .type FUNC_NAME,#function |
Al Viro | d3867f04 | 2016-01-16 21:39:30 -0500 | [diff] [blame] | 70 | EXPORT_SYMBOL(FUNC_NAME) |
Al Viro | fdf8bee | 2020-07-19 18:31:07 -0400 | [diff] [blame] | 71 | FUNC_NAME: /* %o0=src, %o1=dst, %o2=len */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 72 | LOAD(prefetch, %o0 + 0x000, #n_reads) |
| 73 | xor %o0, %o1, %g1 |
Al Viro | 6220e48 | 2020-12-08 16:37:47 -0500 | [diff] [blame] | 74 | mov -1, %o3 |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 75 | clr %o4 |
| 76 | andcc %g1, 0x3, %g0 |
| 77 | bne,pn %icc, 95f |
| 78 | LOAD(prefetch, %o0 + 0x040, #n_reads) |
| 79 | |
| 80 | brz,pn %o2, 70f |
| 81 | andcc %o0, 0x3, %g0 |
| 82 | |
| 83 | /* We "remember" whether the lowest bit in the address |
| 84 | * was set in GLOBAL_SPARE. Because if it is, we have to swap |
| 85 | * upper and lower 8 bit fields of the sum we calculate. |
| 86 | */ |
| 87 | bne,pn %icc, 90b |
| 88 | andcc %o0, 0x1, GLOBAL_SPARE |
| 89 | |
| 90 | 80: |
| 91 | LOAD(prefetch, %o0 + 0x080, #n_reads) |
| 92 | andncc %o2, 0x3f, %g3 |
| 93 | |
| 94 | LOAD(prefetch, %o0 + 0x0c0, #n_reads) |
| 95 | sub %o2, %g3, %o2 |
| 96 | brz,pn %g3, 2f |
| 97 | LOAD(prefetch, %o0 + 0x100, #n_reads) |
| 98 | |
| 99 | /* So that we don't need to use the non-pairing |
| 100 | * add-with-carry instructions we accumulate 32-bit |
| 101 | * values into a 64-bit register. At the end of the |
| 102 | * loop we fold it down to 32-bits and so on. |
| 103 | */ |
| 104 | ba,pt %xcc, 1f |
| 105 | LOAD(prefetch, %o0 + 0x140, #n_reads) |
| 106 | |
| 107 | .align 32 |
| 108 | 1: EX_LD(LOAD(lduw, %o0 + 0x00, %o5)) |
| 109 | EX_LD(LOAD(lduw, %o0 + 0x04, %g1)) |
| 110 | EX_LD(LOAD(lduw, %o0 + 0x08, %g2)) |
| 111 | add %o4, %o5, %o4 |
| 112 | EX_ST(STORE(stw, %o5, %o1 + 0x00)) |
| 113 | EX_LD(LOAD(lduw, %o0 + 0x0c, %o5)) |
| 114 | add %o4, %g1, %o4 |
| 115 | EX_ST(STORE(stw, %g1, %o1 + 0x04)) |
| 116 | EX_LD(LOAD(lduw, %o0 + 0x10, %g1)) |
| 117 | add %o4, %g2, %o4 |
| 118 | EX_ST(STORE(stw, %g2, %o1 + 0x08)) |
| 119 | EX_LD(LOAD(lduw, %o0 + 0x14, %g2)) |
| 120 | add %o4, %o5, %o4 |
| 121 | EX_ST(STORE(stw, %o5, %o1 + 0x0c)) |
| 122 | EX_LD(LOAD(lduw, %o0 + 0x18, %o5)) |
| 123 | add %o4, %g1, %o4 |
| 124 | EX_ST(STORE(stw, %g1, %o1 + 0x10)) |
| 125 | EX_LD(LOAD(lduw, %o0 + 0x1c, %g1)) |
| 126 | add %o4, %g2, %o4 |
| 127 | EX_ST(STORE(stw, %g2, %o1 + 0x14)) |
| 128 | EX_LD(LOAD(lduw, %o0 + 0x20, %g2)) |
| 129 | add %o4, %o5, %o4 |
| 130 | EX_ST(STORE(stw, %o5, %o1 + 0x18)) |
| 131 | EX_LD(LOAD(lduw, %o0 + 0x24, %o5)) |
| 132 | add %o4, %g1, %o4 |
| 133 | EX_ST(STORE(stw, %g1, %o1 + 0x1c)) |
| 134 | EX_LD(LOAD(lduw, %o0 + 0x28, %g1)) |
| 135 | add %o4, %g2, %o4 |
| 136 | EX_ST(STORE(stw, %g2, %o1 + 0x20)) |
| 137 | EX_LD(LOAD(lduw, %o0 + 0x2c, %g2)) |
| 138 | add %o4, %o5, %o4 |
| 139 | EX_ST(STORE(stw, %o5, %o1 + 0x24)) |
| 140 | EX_LD(LOAD(lduw, %o0 + 0x30, %o5)) |
| 141 | add %o4, %g1, %o4 |
| 142 | EX_ST(STORE(stw, %g1, %o1 + 0x28)) |
| 143 | EX_LD(LOAD(lduw, %o0 + 0x34, %g1)) |
| 144 | add %o4, %g2, %o4 |
| 145 | EX_ST(STORE(stw, %g2, %o1 + 0x2c)) |
| 146 | EX_LD(LOAD(lduw, %o0 + 0x38, %g2)) |
| 147 | add %o4, %o5, %o4 |
| 148 | EX_ST(STORE(stw, %o5, %o1 + 0x30)) |
| 149 | EX_LD(LOAD(lduw, %o0 + 0x3c, %o5)) |
| 150 | add %o4, %g1, %o4 |
| 151 | EX_ST(STORE(stw, %g1, %o1 + 0x34)) |
| 152 | LOAD(prefetch, %o0 + 0x180, #n_reads) |
| 153 | add %o4, %g2, %o4 |
| 154 | EX_ST(STORE(stw, %g2, %o1 + 0x38)) |
| 155 | subcc %g3, 0x40, %g3 |
| 156 | add %o0, 0x40, %o0 |
| 157 | add %o4, %o5, %o4 |
| 158 | EX_ST(STORE(stw, %o5, %o1 + 0x3c)) |
| 159 | bne,pt %icc, 1b |
| 160 | add %o1, 0x40, %o1 |
| 161 | |
| 162 | 2: and %o2, 0x3c, %g3 |
| 163 | brz,pn %g3, 2f |
| 164 | sub %o2, %g3, %o2 |
| 165 | 1: EX_LD(LOAD(lduw, %o0 + 0x00, %o5)) |
| 166 | subcc %g3, 0x4, %g3 |
| 167 | add %o0, 0x4, %o0 |
| 168 | add %o4, %o5, %o4 |
| 169 | EX_ST(STORE(stw, %o5, %o1 + 0x00)) |
| 170 | bne,pt %icc, 1b |
| 171 | add %o1, 0x4, %o1 |
| 172 | |
| 173 | 2: |
| 174 | /* fold 64-->32 */ |
| 175 | srlx %o4, 32, %o5 |
| 176 | srl %o4, 0, %o4 |
| 177 | add %o4, %o5, %o4 |
| 178 | srlx %o4, 32, %o5 |
| 179 | srl %o4, 0, %o4 |
| 180 | add %o4, %o5, %o4 |
| 181 | |
| 182 | /* fold 32-->16 */ |
| 183 | sethi %hi(0xffff0000), %g1 |
| 184 | srl %o4, 16, %o5 |
| 185 | andn %o4, %g1, %g2 |
| 186 | add %o5, %g2, %o4 |
| 187 | srl %o4, 16, %o5 |
| 188 | andn %o4, %g1, %g2 |
| 189 | add %o5, %g2, %o4 |
| 190 | |
| 191 | 60: |
| 192 | /* %o4 has the 16-bit sum we have calculated so-far. */ |
| 193 | cmp %o2, 2 |
| 194 | blu,pt %icc, 1f |
| 195 | nop |
| 196 | EX_LD(LOAD(lduh, %o0 + 0x00, %o5)) |
| 197 | sub %o2, 2, %o2 |
| 198 | add %o0, 2, %o0 |
| 199 | add %o4, %o5, %o4 |
| 200 | EX_ST(STORE(sth, %o5, %o1 + 0x00)) |
| 201 | add %o1, 0x2, %o1 |
| 202 | 1: brz,pt %o2, 1f |
| 203 | nop |
| 204 | EX_LD(LOAD(ldub, %o0 + 0x00, %o5)) |
| 205 | sub %o2, 1, %o2 |
| 206 | add %o0, 1, %o0 |
| 207 | EX_ST(STORE(stb, %o5, %o1 + 0x00)) |
| 208 | sllx %o5, 8, %o5 |
| 209 | add %o1, 1, %o1 |
| 210 | add %o4, %o5, %o4 |
| 211 | 1: |
| 212 | /* fold 32-->16 */ |
| 213 | sethi %hi(0xffff0000), %g1 |
| 214 | srl %o4, 16, %o5 |
| 215 | andn %o4, %g1, %g2 |
| 216 | add %o5, %g2, %o4 |
| 217 | srl %o4, 16, %o5 |
| 218 | andn %o4, %g1, %g2 |
| 219 | add %o5, %g2, %o4 |
| 220 | |
| 221 | 1: brz,pt GLOBAL_SPARE, 1f |
| 222 | nop |
| 223 | |
| 224 | /* We started with an odd byte, byte-swap the result. */ |
| 225 | srl %o4, 8, %o5 |
| 226 | and %o4, 0xff, %g1 |
| 227 | sll %g1, 8, %g1 |
| 228 | or %o5, %g1, %o4 |
| 229 | |
David S. Miller | ae5de0f | 2006-06-04 21:32:01 -0700 | [diff] [blame] | 230 | 1: addcc %o3, %o4, %o3 |
| 231 | addc %g0, %o3, %o3 |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 232 | |
| 233 | 70: |
| 234 | retl |
David S. Miller | ae5de0f | 2006-06-04 21:32:01 -0700 | [diff] [blame] | 235 | srl %o3, 0, %o0 |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 236 | |
| 237 | 95: mov 0, GLOBAL_SPARE |
| 238 | brlez,pn %o2, 4f |
| 239 | andcc %o0, 1, %o5 |
| 240 | be,a,pt %icc, 1f |
| 241 | srl %o2, 1, %g1 |
| 242 | sub %o2, 1, %o2 |
| 243 | EX_LD(LOAD(ldub, %o0, GLOBAL_SPARE)) |
| 244 | add %o0, 1, %o0 |
| 245 | EX_ST(STORE(stb, GLOBAL_SPARE, %o1)) |
| 246 | srl %o2, 1, %g1 |
| 247 | add %o1, 1, %o1 |
| 248 | 1: brz,a,pn %g1, 3f |
| 249 | andcc %o2, 1, %g0 |
| 250 | andcc %o0, 2, %g0 |
| 251 | be,a,pt %icc, 1f |
| 252 | srl %g1, 1, %g1 |
| 253 | EX_LD(LOAD(lduh, %o0, %o4)) |
| 254 | sub %o2, 2, %o2 |
| 255 | srl %o4, 8, %g2 |
| 256 | sub %g1, 1, %g1 |
| 257 | EX_ST(STORE(stb, %g2, %o1)) |
| 258 | add %o4, GLOBAL_SPARE, GLOBAL_SPARE |
| 259 | EX_ST(STORE(stb, %o4, %o1 + 1)) |
| 260 | add %o0, 2, %o0 |
| 261 | srl %g1, 1, %g1 |
| 262 | add %o1, 2, %o1 |
| 263 | 1: brz,a,pn %g1, 2f |
| 264 | andcc %o2, 2, %g0 |
| 265 | EX_LD(LOAD(lduw, %o0, %o4)) |
| 266 | 5: srl %o4, 24, %g2 |
| 267 | srl %o4, 16, %g3 |
| 268 | EX_ST(STORE(stb, %g2, %o1)) |
| 269 | srl %o4, 8, %g2 |
| 270 | EX_ST(STORE(stb, %g3, %o1 + 1)) |
| 271 | add %o0, 4, %o0 |
| 272 | EX_ST(STORE(stb, %g2, %o1 + 2)) |
| 273 | addcc %o4, GLOBAL_SPARE, GLOBAL_SPARE |
| 274 | EX_ST(STORE(stb, %o4, %o1 + 3)) |
| 275 | addc GLOBAL_SPARE, %g0, GLOBAL_SPARE |
| 276 | add %o1, 4, %o1 |
| 277 | subcc %g1, 1, %g1 |
| 278 | bne,a,pt %icc, 5b |
| 279 | EX_LD(LOAD(lduw, %o0, %o4)) |
| 280 | sll GLOBAL_SPARE, 16, %g2 |
| 281 | srl GLOBAL_SPARE, 16, GLOBAL_SPARE |
| 282 | srl %g2, 16, %g2 |
| 283 | andcc %o2, 2, %g0 |
| 284 | add %g2, GLOBAL_SPARE, GLOBAL_SPARE |
| 285 | 2: be,a,pt %icc, 3f |
| 286 | andcc %o2, 1, %g0 |
| 287 | EX_LD(LOAD(lduh, %o0, %o4)) |
| 288 | andcc %o2, 1, %g0 |
| 289 | srl %o4, 8, %g2 |
| 290 | add %o0, 2, %o0 |
| 291 | EX_ST(STORE(stb, %g2, %o1)) |
| 292 | add GLOBAL_SPARE, %o4, GLOBAL_SPARE |
| 293 | EX_ST(STORE(stb, %o4, %o1 + 1)) |
| 294 | add %o1, 2, %o1 |
| 295 | 3: be,a,pt %icc, 1f |
| 296 | sll GLOBAL_SPARE, 16, %o4 |
| 297 | EX_LD(LOAD(ldub, %o0, %g2)) |
| 298 | sll %g2, 8, %o4 |
| 299 | EX_ST(STORE(stb, %g2, %o1)) |
| 300 | add GLOBAL_SPARE, %o4, GLOBAL_SPARE |
| 301 | sll GLOBAL_SPARE, 16, %o4 |
| 302 | 1: addcc %o4, GLOBAL_SPARE, GLOBAL_SPARE |
| 303 | srl GLOBAL_SPARE, 16, %o4 |
| 304 | addc %g0, %o4, GLOBAL_SPARE |
| 305 | brz,pt %o5, 4f |
| 306 | srl GLOBAL_SPARE, 8, %o4 |
| 307 | and GLOBAL_SPARE, 0xff, %g2 |
| 308 | and %o4, 0xff, %o4 |
| 309 | sll %g2, 8, %g2 |
| 310 | or %g2, %o4, GLOBAL_SPARE |
| 311 | 4: addcc %o3, GLOBAL_SPARE, %o3 |
| 312 | addc %g0, %o3, %o0 |
| 313 | retl |
| 314 | srl %o0, 0, %o0 |
| 315 | .size FUNC_NAME, .-FUNC_NAME |