1/* NGmemcpy.S: Niagara optimized memcpy. 2 * 3 * Copyright (C) 2006, 2007 David S. Miller (davem@davemloft.net) 4 */ 5 6#ifdef __KERNEL__ 7#include <linux/linkage.h> 8#include <asm/asi.h> 9#include <asm/thread_info.h> 10#define GLOBAL_SPARE %g7 11#define RESTORE_ASI(TMP) \ 12 ldub [%g6 + TI_CURRENT_DS], TMP; \ 13 wr TMP, 0x0, %asi; 14#else 15#define GLOBAL_SPARE %g5 16#define RESTORE_ASI(TMP) \ 17 wr %g0, ASI_PNF, %asi 18#endif 19 20#ifdef __sparc_v9__ 21#define SAVE_AMOUNT 128 22#else 23#define SAVE_AMOUNT 64 24#endif 25 26#ifndef STORE_ASI 27#define STORE_ASI ASI_BLK_INIT_QUAD_LDD_P 28#endif 29 30#ifndef EX_LD 31#define EX_LD(x,y) x 32#endif 33 34#ifndef EX_ST 35#define EX_ST(x,y) x 36#endif 37 38#ifndef LOAD 39#ifndef MEMCPY_DEBUG 40#define LOAD(type,addr,dest) type [addr], dest 41#else 42#define LOAD(type,addr,dest) type##a [addr] 0x80, dest 43#endif 44#endif 45 46#ifndef LOAD_TWIN 47#define LOAD_TWIN(addr_reg,dest0,dest1) \ 48 ldda [addr_reg] ASI_BLK_INIT_QUAD_LDD_P, dest0 49#endif 50 51#ifndef STORE 52#define STORE(type,src,addr) type src, [addr] 53#endif 54 55#ifndef STORE_INIT 56#ifndef SIMULATE_NIAGARA_ON_NON_NIAGARA 57#define STORE_INIT(src,addr) stxa src, [addr] %asi 58#else 59#define STORE_INIT(src,addr) stx src, [addr + 0x00] 60#endif 61#endif 62 63#ifndef FUNC_NAME 64#define FUNC_NAME NGmemcpy 65#endif 66 67#ifndef PREAMBLE 68#define PREAMBLE 69#endif 70 71#ifndef XCC 72#define XCC xcc 73#endif 74 75 .register %g2,#scratch 76 .register %g3,#scratch 77 78 .text 79#ifndef EX_RETVAL 80#define EX_RETVAL(x) x 81__restore_asi: 82 ret 83 wr %g0, ASI_AIUS, %asi 84 restore 85ENTRY(NG_ret_i2_plus_i4_plus_1) 86 ba,pt %xcc, __restore_asi 87 add %i2, %i5, %i0 88ENDPROC(NG_ret_i2_plus_i4_plus_1) 89ENTRY(NG_ret_i2_plus_g1) 90 ba,pt %xcc, __restore_asi 91 add %i2, %g1, %i0 92ENDPROC(NG_ret_i2_plus_g1) 93ENTRY(NG_ret_i2_plus_g1_minus_8) 94 sub %g1, 8, %g1 95 ba,pt %xcc, __restore_asi 96 add %i2, %g1, %i0 97ENDPROC(NG_ret_i2_plus_g1_minus_8) 98ENTRY(NG_ret_i2_plus_g1_minus_16) 99 sub %g1, 16, %g1 100 ba,pt %xcc, __restore_asi 101 add %i2, %g1, %i0 102ENDPROC(NG_ret_i2_plus_g1_minus_16) 103ENTRY(NG_ret_i2_plus_g1_minus_24) 104 sub %g1, 24, %g1 105 ba,pt %xcc, __restore_asi 106 add %i2, %g1, %i0 107ENDPROC(NG_ret_i2_plus_g1_minus_24) 108ENTRY(NG_ret_i2_plus_g1_minus_32) 109 sub %g1, 32, %g1 110 ba,pt %xcc, __restore_asi 111 add %i2, %g1, %i0 112ENDPROC(NG_ret_i2_plus_g1_minus_32) 113ENTRY(NG_ret_i2_plus_g1_minus_40) 114 sub %g1, 40, %g1 115 ba,pt %xcc, __restore_asi 116 add %i2, %g1, %i0 117ENDPROC(NG_ret_i2_plus_g1_minus_40) 118ENTRY(NG_ret_i2_plus_g1_minus_48) 119 sub %g1, 48, %g1 120 ba,pt %xcc, __restore_asi 121 add %i2, %g1, %i0 122ENDPROC(NG_ret_i2_plus_g1_minus_48) 123ENTRY(NG_ret_i2_plus_g1_minus_56) 124 sub %g1, 56, %g1 125 ba,pt %xcc, __restore_asi 126 add %i2, %g1, %i0 127ENDPROC(NG_ret_i2_plus_g1_minus_56) 128ENTRY(NG_ret_i2_plus_i4) 129 ba,pt %xcc, __restore_asi 130 add %i2, %i4, %i0 131ENDPROC(NG_ret_i2_plus_i4) 132ENTRY(NG_ret_i2_plus_i4_minus_8) 133 sub %i4, 8, %i4 134 ba,pt %xcc, __restore_asi 135 add %i2, %i4, %i0 136ENDPROC(NG_ret_i2_plus_i4_minus_8) 137ENTRY(NG_ret_i2_plus_8) 138 ba,pt %xcc, __restore_asi 139 add %i2, 8, %i0 140ENDPROC(NG_ret_i2_plus_8) 141ENTRY(NG_ret_i2_plus_4) 142 ba,pt %xcc, __restore_asi 143 add %i2, 4, %i0 144ENDPROC(NG_ret_i2_plus_4) 145ENTRY(NG_ret_i2_plus_1) 146 ba,pt %xcc, __restore_asi 147 add %i2, 1, %i0 148ENDPROC(NG_ret_i2_plus_1) 149ENTRY(NG_ret_i2_plus_g1_plus_1) 150 add %g1, 1, %g1 151 ba,pt %xcc, __restore_asi 152 add %i2, %g1, %i0 153ENDPROC(NG_ret_i2_plus_g1_plus_1) 154ENTRY(NG_ret_i2) 155 ba,pt %xcc, __restore_asi 156 mov %i2, %i0 157ENDPROC(NG_ret_i2) 158ENTRY(NG_ret_i2_and_7_plus_i4) 159 and %i2, 7, %i2 160 ba,pt %xcc, __restore_asi 161 add %i2, %i4, %i0 162ENDPROC(NG_ret_i2_and_7_plus_i4) 163#endif 164 165 .align 64 166 167 .globl FUNC_NAME 168 .type FUNC_NAME,#function 169FUNC_NAME: /* %i0=dst, %i1=src, %i2=len */ 170 PREAMBLE 171 save %sp, -SAVE_AMOUNT, %sp 172 srlx %i2, 31, %g2 173 cmp %g2, 0 174 tne %xcc, 5 175 mov %i0, %o0 176 cmp %i2, 0 177 be,pn %XCC, 85f 178 or %o0, %i1, %i3 179 cmp %i2, 16 180 blu,a,pn %XCC, 80f 181 or %i3, %i2, %i3 182 183 /* 2 blocks (128 bytes) is the minimum we can do the block 184 * copy with. We need to ensure that we'll iterate at least 185 * once in the block copy loop. At worst we'll need to align 186 * the destination to a 64-byte boundary which can chew up 187 * to (64 - 1) bytes from the length before we perform the 188 * block copy loop. 189 */ 190 cmp %i2, (2 * 64) 191 blu,pt %XCC, 70f 192 andcc %i3, 0x7, %g0 193 194 /* %o0: dst 195 * %i1: src 196 * %i2: len (known to be >= 128) 197 * 198 * The block copy loops will use %i4/%i5,%g2/%g3 as 199 * temporaries while copying the data. 200 */ 201 202 LOAD(prefetch, %i1, #one_read) 203 wr %g0, STORE_ASI, %asi 204 205 /* Align destination on 64-byte boundary. */ 206 andcc %o0, (64 - 1), %i4 207 be,pt %XCC, 2f 208 sub %i4, 64, %i4 209 sub %g0, %i4, %i4 ! bytes to align dst 210 sub %i2, %i4, %i2 2111: subcc %i4, 1, %i4 212 EX_LD(LOAD(ldub, %i1, %g1), NG_ret_i2_plus_i4_plus_1) 213 EX_ST(STORE(stb, %g1, %o0), NG_ret_i2_plus_i4_plus_1) 214 add %i1, 1, %i1 215 bne,pt %XCC, 1b 216 add %o0, 1, %o0 217 218 /* If the source is on a 16-byte boundary we can do 219 * the direct block copy loop. If it is 8-byte aligned 220 * we can do the 16-byte loads offset by -8 bytes and the 221 * init stores offset by one register. 222 * 223 * If the source is not even 8-byte aligned, we need to do 224 * shifting and masking (basically integer faligndata). 225 * 226 * The careful bit with init stores is that if we store 227 * to any part of the cache line we have to store the whole 228 * cacheline else we can end up with corrupt L2 cache line 229 * contents. Since the loop works on 64-bytes of 64-byte 230 * aligned store data at a time, this is easy to ensure. 231 */ 2322: 233 andcc %i1, (16 - 1), %i4 234 andn %i2, (64 - 1), %g1 ! block copy loop iterator 235 be,pt %XCC, 50f 236 sub %i2, %g1, %i2 ! final sub-block copy bytes 237 238 cmp %i4, 8 239 be,pt %XCC, 10f 240 sub %i1, %i4, %i1 241 242 /* Neither 8-byte nor 16-byte aligned, shift and mask. */ 243 and %i4, 0x7, GLOBAL_SPARE 244 sll GLOBAL_SPARE, 3, GLOBAL_SPARE 245 mov 64, %i5 246 EX_LD(LOAD_TWIN(%i1, %g2, %g3), NG_ret_i2_plus_g1) 247 sub %i5, GLOBAL_SPARE, %i5 248 mov 16, %o4 249 mov 32, %o5 250 mov 48, %o7 251 mov 64, %i3 252 253 bg,pn %XCC, 9f 254 nop 255 256#define MIX_THREE_WORDS(WORD1, WORD2, WORD3, PRE_SHIFT, POST_SHIFT, TMP) \ 257 sllx WORD1, POST_SHIFT, WORD1; \ 258 srlx WORD2, PRE_SHIFT, TMP; \ 259 sllx WORD2, POST_SHIFT, WORD2; \ 260 or WORD1, TMP, WORD1; \ 261 srlx WORD3, PRE_SHIFT, TMP; \ 262 or WORD2, TMP, WORD2; 263 2648: EX_LD(LOAD_TWIN(%i1 + %o4, %o2, %o3), NG_ret_i2_plus_g1) 265 MIX_THREE_WORDS(%g2, %g3, %o2, %i5, GLOBAL_SPARE, %o1) 266 LOAD(prefetch, %i1 + %i3, #one_read) 267 268 EX_ST(STORE_INIT(%g2, %o0 + 0x00), NG_ret_i2_plus_g1) 269 EX_ST(STORE_INIT(%g3, %o0 + 0x08), NG_ret_i2_plus_g1_minus_8) 270 271 EX_LD(LOAD_TWIN(%i1 + %o5, %g2, %g3), NG_ret_i2_plus_g1_minus_16) 272 MIX_THREE_WORDS(%o2, %o3, %g2, %i5, GLOBAL_SPARE, %o1) 273 274 EX_ST(STORE_INIT(%o2, %o0 + 0x10), NG_ret_i2_plus_g1_minus_16) 275 EX_ST(STORE_INIT(%o3, %o0 + 0x18), NG_ret_i2_plus_g1_minus_24) 276 277 EX_LD(LOAD_TWIN(%i1 + %o7, %o2, %o3), NG_ret_i2_plus_g1_minus_32) 278 MIX_THREE_WORDS(%g2, %g3, %o2, %i5, GLOBAL_SPARE, %o1) 279 280 EX_ST(STORE_INIT(%g2, %o0 + 0x20), NG_ret_i2_plus_g1_minus_32) 281 EX_ST(STORE_INIT(%g3, %o0 + 0x28), NG_ret_i2_plus_g1_minus_40) 282 283 EX_LD(LOAD_TWIN(%i1 + %i3, %g2, %g3), NG_ret_i2_plus_g1_minus_48) 284 add %i1, 64, %i1 285 MIX_THREE_WORDS(%o2, %o3, %g2, %i5, GLOBAL_SPARE, %o1) 286 287 EX_ST(STORE_INIT(%o2, %o0 + 0x30), NG_ret_i2_plus_g1_minus_48) 288 EX_ST(STORE_INIT(%o3, %o0 + 0x38), NG_ret_i2_plus_g1_minus_56) 289 290 subcc %g1, 64, %g1 291 bne,pt %XCC, 8b 292 add %o0, 64, %o0 293 294 ba,pt %XCC, 60f 295 add %i1, %i4, %i1 296 2979: EX_LD(LOAD_TWIN(%i1 + %o4, %o2, %o3), NG_ret_i2_plus_g1) 298 MIX_THREE_WORDS(%g3, %o2, %o3, %i5, GLOBAL_SPARE, %o1) 299 LOAD(prefetch, %i1 + %i3, #one_read) 300 301 EX_ST(STORE_INIT(%g3, %o0 + 0x00), NG_ret_i2_plus_g1) 302 EX_ST(STORE_INIT(%o2, %o0 + 0x08), NG_ret_i2_plus_g1_minus_8) 303 304 EX_LD(LOAD_TWIN(%i1 + %o5, %g2, %g3), NG_ret_i2_plus_g1_minus_16) 305 MIX_THREE_WORDS(%o3, %g2, %g3, %i5, GLOBAL_SPARE, %o1) 306 307 EX_ST(STORE_INIT(%o3, %o0 + 0x10), NG_ret_i2_plus_g1_minus_16) 308 EX_ST(STORE_INIT(%g2, %o0 + 0x18), NG_ret_i2_plus_g1_minus_24) 309 310 EX_LD(LOAD_TWIN(%i1 + %o7, %o2, %o3), NG_ret_i2_plus_g1_minus_32) 311 MIX_THREE_WORDS(%g3, %o2, %o3, %i5, GLOBAL_SPARE, %o1) 312 313 EX_ST(STORE_INIT(%g3, %o0 + 0x20), NG_ret_i2_plus_g1_minus_32) 314 EX_ST(STORE_INIT(%o2, %o0 + 0x28), NG_ret_i2_plus_g1_minus_40) 315 316 EX_LD(LOAD_TWIN(%i1 + %i3, %g2, %g3), NG_ret_i2_plus_g1_minus_48) 317 add %i1, 64, %i1 318 MIX_THREE_WORDS(%o3, %g2, %g3, %i5, GLOBAL_SPARE, %o1) 319 320 EX_ST(STORE_INIT(%o3, %o0 + 0x30), NG_ret_i2_plus_g1_minus_48) 321 EX_ST(STORE_INIT(%g2, %o0 + 0x38), NG_ret_i2_plus_g1_minus_56) 322 323 subcc %g1, 64, %g1 324 bne,pt %XCC, 9b 325 add %o0, 64, %o0 326 327 ba,pt %XCC, 60f 328 add %i1, %i4, %i1 329 33010: /* Destination is 64-byte aligned, source was only 8-byte 331 * aligned but it has been subtracted by 8 and we perform 332 * one twin load ahead, then add 8 back into source when 333 * we finish the loop. 334 */ 335 EX_LD(LOAD_TWIN(%i1, %o4, %o5), NG_ret_i2_plus_g1) 336 mov 16, %o7 337 mov 32, %g2 338 mov 48, %g3 339 mov 64, %o1 3401: EX_LD(LOAD_TWIN(%i1 + %o7, %o2, %o3), NG_ret_i2_plus_g1) 341 LOAD(prefetch, %i1 + %o1, #one_read) 342 EX_ST(STORE_INIT(%o5, %o0 + 0x00), NG_ret_i2_plus_g1) ! initializes cache line 343 EX_ST(STORE_INIT(%o2, %o0 + 0x08), NG_ret_i2_plus_g1_minus_8) 344 EX_LD(LOAD_TWIN(%i1 + %g2, %o4, %o5), NG_ret_i2_plus_g1_minus_16) 345 EX_ST(STORE_INIT(%o3, %o0 + 0x10), NG_ret_i2_plus_g1_minus_16) 346 EX_ST(STORE_INIT(%o4, %o0 + 0x18), NG_ret_i2_plus_g1_minus_24) 347 EX_LD(LOAD_TWIN(%i1 + %g3, %o2, %o3), NG_ret_i2_plus_g1_minus_32) 348 EX_ST(STORE_INIT(%o5, %o0 + 0x20), NG_ret_i2_plus_g1_minus_32) 349 EX_ST(STORE_INIT(%o2, %o0 + 0x28), NG_ret_i2_plus_g1_minus_40) 350 EX_LD(LOAD_TWIN(%i1 + %o1, %o4, %o5), NG_ret_i2_plus_g1_minus_48) 351 add %i1, 64, %i1 352 EX_ST(STORE_INIT(%o3, %o0 + 0x30), NG_ret_i2_plus_g1_minus_48) 353 EX_ST(STORE_INIT(%o4, %o0 + 0x38), NG_ret_i2_plus_g1_minus_56) 354 subcc %g1, 64, %g1 355 bne,pt %XCC, 1b 356 add %o0, 64, %o0 357 358 ba,pt %XCC, 60f 359 add %i1, 0x8, %i1 360 36150: /* Destination is 64-byte aligned, and source is 16-byte 362 * aligned. 363 */ 364 mov 16, %o7 365 mov 32, %g2 366 mov 48, %g3 367 mov 64, %o1 3681: EX_LD(LOAD_TWIN(%i1 + %g0, %o4, %o5), NG_ret_i2_plus_g1) 369 EX_LD(LOAD_TWIN(%i1 + %o7, %o2, %o3), NG_ret_i2_plus_g1) 370 LOAD(prefetch, %i1 + %o1, #one_read) 371 EX_ST(STORE_INIT(%o4, %o0 + 0x00), NG_ret_i2_plus_g1) ! initializes cache line 372 EX_ST(STORE_INIT(%o5, %o0 + 0x08), NG_ret_i2_plus_g1_minus_8) 373 EX_LD(LOAD_TWIN(%i1 + %g2, %o4, %o5), NG_ret_i2_plus_g1_minus_16) 374 EX_ST(STORE_INIT(%o2, %o0 + 0x10), NG_ret_i2_plus_g1_minus_16) 375 EX_ST(STORE_INIT(%o3, %o0 + 0x18), NG_ret_i2_plus_g1_minus_24) 376 EX_LD(LOAD_TWIN(%i1 + %g3, %o2, %o3), NG_ret_i2_plus_g1_minus_32) 377 add %i1, 64, %i1 378 EX_ST(STORE_INIT(%o4, %o0 + 0x20), NG_ret_i2_plus_g1_minus_32) 379 EX_ST(STORE_INIT(%o5, %o0 + 0x28), NG_ret_i2_plus_g1_minus_40) 380 EX_ST(STORE_INIT(%o2, %o0 + 0x30), NG_ret_i2_plus_g1_minus_48) 381 EX_ST(STORE_INIT(%o3, %o0 + 0x38), NG_ret_i2_plus_g1_minus_56) 382 subcc %g1, 64, %g1 383 bne,pt %XCC, 1b 384 add %o0, 64, %o0 385 /* fall through */ 386 38760: 388 membar #Sync 389 390 /* %i2 contains any final bytes still needed to be copied 391 * over. If anything is left, we copy it one byte at a time. 392 */ 393 RESTORE_ASI(%i3) 394 brz,pt %i2, 85f 395 sub %o0, %i1, %i3 396 ba,a,pt %XCC, 90f 397 398 .align 64 39970: /* 16 < len <= 64 */ 400 bne,pn %XCC, 75f 401 sub %o0, %i1, %i3 402 40372: 404 andn %i2, 0xf, %i4 405 and %i2, 0xf, %i2 4061: subcc %i4, 0x10, %i4 407 EX_LD(LOAD(ldx, %i1, %o4), NG_ret_i2_plus_i4) 408 add %i1, 0x08, %i1 409 EX_LD(LOAD(ldx, %i1, %g1), NG_ret_i2_plus_i4) 410 sub %i1, 0x08, %i1 411 EX_ST(STORE(stx, %o4, %i1 + %i3), NG_ret_i2_plus_i4) 412 add %i1, 0x8, %i1 413 EX_ST(STORE(stx, %g1, %i1 + %i3), NG_ret_i2_plus_i4_minus_8) 414 bgu,pt %XCC, 1b 415 add %i1, 0x8, %i1 41673: andcc %i2, 0x8, %g0 417 be,pt %XCC, 1f 418 nop 419 sub %i2, 0x8, %i2 420 EX_LD(LOAD(ldx, %i1, %o4), NG_ret_i2_plus_8) 421 EX_ST(STORE(stx, %o4, %i1 + %i3), NG_ret_i2_plus_8) 422 add %i1, 0x8, %i1 4231: andcc %i2, 0x4, %g0 424 be,pt %XCC, 1f 425 nop 426 sub %i2, 0x4, %i2 427 EX_LD(LOAD(lduw, %i1, %i5), NG_ret_i2_plus_4) 428 EX_ST(STORE(stw, %i5, %i1 + %i3), NG_ret_i2_plus_4) 429 add %i1, 0x4, %i1 4301: cmp %i2, 0 431 be,pt %XCC, 85f 432 nop 433 ba,pt %xcc, 90f 434 nop 435 43675: 437 andcc %o0, 0x7, %g1 438 sub %g1, 0x8, %g1 439 be,pn %icc, 2f 440 sub %g0, %g1, %g1 441 sub %i2, %g1, %i2 442 4431: subcc %g1, 1, %g1 444 EX_LD(LOAD(ldub, %i1, %i5), NG_ret_i2_plus_g1_plus_1) 445 EX_ST(STORE(stb, %i5, %i1 + %i3), NG_ret_i2_plus_g1_plus_1) 446 bgu,pt %icc, 1b 447 add %i1, 1, %i1 448 4492: add %i1, %i3, %o0 450 andcc %i1, 0x7, %g1 451 bne,pt %icc, 8f 452 sll %g1, 3, %g1 453 454 cmp %i2, 16 455 bgeu,pt %icc, 72b 456 nop 457 ba,a,pt %xcc, 73b 458 4598: mov 64, %i3 460 andn %i1, 0x7, %i1 461 EX_LD(LOAD(ldx, %i1, %g2), NG_ret_i2) 462 sub %i3, %g1, %i3 463 andn %i2, 0x7, %i4 464 sllx %g2, %g1, %g2 4651: add %i1, 0x8, %i1 466 EX_LD(LOAD(ldx, %i1, %g3), NG_ret_i2_and_7_plus_i4) 467 subcc %i4, 0x8, %i4 468 srlx %g3, %i3, %i5 469 or %i5, %g2, %i5 470 EX_ST(STORE(stx, %i5, %o0), NG_ret_i2_and_7_plus_i4) 471 add %o0, 0x8, %o0 472 bgu,pt %icc, 1b 473 sllx %g3, %g1, %g2 474 475 srl %g1, 3, %g1 476 andcc %i2, 0x7, %i2 477 be,pn %icc, 85f 478 add %i1, %g1, %i1 479 ba,pt %xcc, 90f 480 sub %o0, %i1, %i3 481 482 .align 64 48380: /* 0 < len <= 16 */ 484 andcc %i3, 0x3, %g0 485 bne,pn %XCC, 90f 486 sub %o0, %i1, %i3 487 4881: 489 subcc %i2, 4, %i2 490 EX_LD(LOAD(lduw, %i1, %g1), NG_ret_i2_plus_4) 491 EX_ST(STORE(stw, %g1, %i1 + %i3), NG_ret_i2_plus_4) 492 bgu,pt %XCC, 1b 493 add %i1, 4, %i1 494 49585: ret 496 restore EX_RETVAL(%i0), %g0, %o0 497 498 .align 32 49990: 500 subcc %i2, 1, %i2 501 EX_LD(LOAD(ldub, %i1, %g1), NG_ret_i2_plus_1) 502 EX_ST(STORE(stb, %g1, %i1 + %i3), NG_ret_i2_plus_1) 503 bgu,pt %XCC, 90b 504 add %i1, 1, %i1 505 ret 506 restore EX_RETVAL(%i0), %g0, %o0 507 508 .size FUNC_NAME, .-FUNC_NAME 509