memcpy.S 35 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918
  1. /* Copy SIZE bytes from SRC to DEST.
  2. For UltraSPARC.
  3. Copyright (C) 1996, 97, 98, 99, 2003 Free Software Foundation, Inc.
  4. This file is part of the GNU C Library.
  5. Contributed by David S. Miller (davem@caip.rutgers.edu) and
  6. Jakub Jelinek (jakub@redhat.com).
  7. The GNU C Library is free software; you can redistribute it and/or
  8. modify it under the terms of the GNU Lesser General Public
  9. License as published by the Free Software Foundation; either
  10. version 2.1 of the License, or (at your option) any later version.
  11. The GNU C Library is distributed in the hope that it will be useful,
  12. but WITHOUT ANY WARRANTY; without even the implied warranty of
  13. MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
  14. Lesser General Public License for more details.
  15. You should have received a copy of the GNU Lesser General Public
  16. License along with the GNU C Library; if not, write to the Free
  17. Software Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA
  18. 02111-1307 USA. */
  19. #include <asm/asi.h>
  20. #ifndef XCC
  21. #define USE_BPR
  22. .register %g2, #scratch
  23. .register %g3, #scratch
  24. .register %g6, #scratch
  25. #define XCC xcc
  26. #endif
  27. #define FPRS_FEF 4
  28. #define FREG_FROB(f1, f2, f3, f4, f5, f6, f7, f8, f9) \
  29. faligndata %f1, %f2, %f48; \
  30. faligndata %f2, %f3, %f50; \
  31. faligndata %f3, %f4, %f52; \
  32. faligndata %f4, %f5, %f54; \
  33. faligndata %f5, %f6, %f56; \
  34. faligndata %f6, %f7, %f58; \
  35. faligndata %f7, %f8, %f60; \
  36. faligndata %f8, %f9, %f62;
  37. #define MAIN_LOOP_CHUNK(src, dest, fdest, fsrc, len, jmptgt) \
  38. ldda [%src] %asi, %fdest; \
  39. add %src, 0x40, %src; \
  40. add %dest, 0x40, %dest; \
  41. subcc %len, 0x40, %len; \
  42. be,pn %xcc, jmptgt; \
  43. stda %fsrc, [%dest - 0x40] %asi;
  44. #define LOOP_CHUNK1(src, dest, len, branch_dest) \
  45. MAIN_LOOP_CHUNK(src, dest, f0, f48, len, branch_dest)
  46. #define LOOP_CHUNK2(src, dest, len, branch_dest) \
  47. MAIN_LOOP_CHUNK(src, dest, f16, f48, len, branch_dest)
  48. #define LOOP_CHUNK3(src, dest, len, branch_dest) \
  49. MAIN_LOOP_CHUNK(src, dest, f32, f48, len, branch_dest)
  50. #define STORE_SYNC(dest, fsrc) \
  51. stda %fsrc, [%dest] %asi; \
  52. add %dest, 0x40, %dest;
  53. #define STORE_JUMP(dest, fsrc, target) \
  54. stda %fsrc, [%dest] %asi; \
  55. add %dest, 0x40, %dest; \
  56. ba,pt %xcc, target;
  57. #define VISLOOP_PAD nop; nop; nop; nop; \
  58. nop; nop; nop; nop; \
  59. nop; nop; nop; nop; \
  60. nop; nop; nop;
  61. #define FINISH_VISCHUNK(dest, f0, f1, left) \
  62. subcc %left, 8, %left; \
  63. bl,pn %xcc, 205f; \
  64. faligndata %f0, %f1, %f48; \
  65. std %f48, [%dest]; \
  66. add %dest, 8, %dest;
  67. #define UNEVEN_VISCHUNK(dest, f0, f1, left) \
  68. subcc %left, 8, %left; \
  69. bl,pn %xcc, 205f; \
  70. fsrc1 %f0, %f1; \
  71. ba,a,pt %xcc, 204f;
  72. /* Macros for non-VIS memcpy code. */
  73. #define MOVE_BIGCHUNK(src, dst, offset, t0, t1, t2, t3) \
  74. ldx [%src + offset + 0x00], %t0; \
  75. ldx [%src + offset + 0x08], %t1; \
  76. ldx [%src + offset + 0x10], %t2; \
  77. ldx [%src + offset + 0x18], %t3; \
  78. stw %t0, [%dst + offset + 0x04]; \
  79. srlx %t0, 32, %t0; \
  80. stw %t0, [%dst + offset + 0x00]; \
  81. stw %t1, [%dst + offset + 0x0c]; \
  82. srlx %t1, 32, %t1; \
  83. stw %t1, [%dst + offset + 0x08]; \
  84. stw %t2, [%dst + offset + 0x14]; \
  85. srlx %t2, 32, %t2; \
  86. stw %t2, [%dst + offset + 0x10]; \
  87. stw %t3, [%dst + offset + 0x1c]; \
  88. srlx %t3, 32, %t3; \
  89. stw %t3, [%dst + offset + 0x18];
  90. #define MOVE_BIGALIGNCHUNK(src, dst, offset, t0, t1, t2, t3) \
  91. ldx [%src + offset + 0x00], %t0; \
  92. ldx [%src + offset + 0x08], %t1; \
  93. ldx [%src + offset + 0x10], %t2; \
  94. ldx [%src + offset + 0x18], %t3; \
  95. stx %t0, [%dst + offset + 0x00]; \
  96. stx %t1, [%dst + offset + 0x08]; \
  97. stx %t2, [%dst + offset + 0x10]; \
  98. stx %t3, [%dst + offset + 0x18]; \
  99. ldx [%src + offset + 0x20], %t0; \
  100. ldx [%src + offset + 0x28], %t1; \
  101. ldx [%src + offset + 0x30], %t2; \
  102. ldx [%src + offset + 0x38], %t3; \
  103. stx %t0, [%dst + offset + 0x20]; \
  104. stx %t1, [%dst + offset + 0x28]; \
  105. stx %t2, [%dst + offset + 0x30]; \
  106. stx %t3, [%dst + offset + 0x38];
  107. #define MOVE_LASTCHUNK(src, dst, offset, t0, t1, t2, t3) \
  108. ldx [%src - offset - 0x10], %t0; \
  109. ldx [%src - offset - 0x08], %t1; \
  110. stw %t0, [%dst - offset - 0x0c]; \
  111. srlx %t0, 32, %t2; \
  112. stw %t2, [%dst - offset - 0x10]; \
  113. stw %t1, [%dst - offset - 0x04]; \
  114. srlx %t1, 32, %t3; \
  115. stw %t3, [%dst - offset - 0x08];
  116. #define MOVE_LASTALIGNCHUNK(src, dst, offset, t0, t1) \
  117. ldx [%src - offset - 0x10], %t0; \
  118. ldx [%src - offset - 0x08], %t1; \
  119. stx %t0, [%dst - offset - 0x10]; \
  120. stx %t1, [%dst - offset - 0x08];
  121. /* Macros for non-VIS memmove code. */
  122. #define RMOVE_BIGCHUNK(src, dst, offset, t0, t1, t2, t3) \
  123. ldx [%src - offset - 0x20], %t0; \
  124. ldx [%src - offset - 0x18], %t1; \
  125. ldx [%src - offset - 0x10], %t2; \
  126. ldx [%src - offset - 0x08], %t3; \
  127. stw %t0, [%dst - offset - 0x1c]; \
  128. srlx %t0, 32, %t0; \
  129. stw %t0, [%dst - offset - 0x20]; \
  130. stw %t1, [%dst - offset - 0x14]; \
  131. srlx %t1, 32, %t1; \
  132. stw %t1, [%dst - offset - 0x18]; \
  133. stw %t2, [%dst - offset - 0x0c]; \
  134. srlx %t2, 32, %t2; \
  135. stw %t2, [%dst - offset - 0x10]; \
  136. stw %t3, [%dst - offset - 0x04]; \
  137. srlx %t3, 32, %t3; \
  138. stw %t3, [%dst - offset - 0x08];
  139. #define RMOVE_BIGALIGNCHUNK(src, dst, offset, t0, t1, t2, t3) \
  140. ldx [%src - offset - 0x20], %t0; \
  141. ldx [%src - offset - 0x18], %t1; \
  142. ldx [%src - offset - 0x10], %t2; \
  143. ldx [%src - offset - 0x08], %t3; \
  144. stx %t0, [%dst - offset - 0x20]; \
  145. stx %t1, [%dst - offset - 0x18]; \
  146. stx %t2, [%dst - offset - 0x10]; \
  147. stx %t3, [%dst - offset - 0x08]; \
  148. ldx [%src - offset - 0x40], %t0; \
  149. ldx [%src - offset - 0x38], %t1; \
  150. ldx [%src - offset - 0x30], %t2; \
  151. ldx [%src - offset - 0x28], %t3; \
  152. stx %t0, [%dst - offset - 0x40]; \
  153. stx %t1, [%dst - offset - 0x38]; \
  154. stx %t2, [%dst - offset - 0x30]; \
  155. stx %t3, [%dst - offset - 0x28];
  156. #define RMOVE_LASTCHUNK(src, dst, offset, t0, t1, t2, t3) \
  157. ldx [%src + offset + 0x00], %t0; \
  158. ldx [%src + offset + 0x08], %t1; \
  159. stw %t0, [%dst + offset + 0x04]; \
  160. srlx %t0, 32, %t2; \
  161. stw %t2, [%dst + offset + 0x00]; \
  162. stw %t1, [%dst + offset + 0x0c]; \
  163. srlx %t1, 32, %t3; \
  164. stw %t3, [%dst + offset + 0x08];
  165. #define RMOVE_LASTALIGNCHUNK(src, dst, offset, t0, t1) \
  166. ldx [%src + offset + 0x00], %t0; \
  167. ldx [%src + offset + 0x08], %t1; \
  168. stx %t0, [%dst + offset + 0x00]; \
  169. stx %t1, [%dst + offset + 0x08];
  170. .text
  171. .align 32
  172. ENTRY(bcopy)
  173. sub %o1, %o0, %o4 /* IEU0 Group */
  174. mov %o0, %g3 /* IEU1 */
  175. cmp %o4, %o2 /* IEU1 Group */
  176. mov %o1, %o0 /* IEU0 */
  177. bgeu,pt %XCC, 210f /* CTI */
  178. mov %g3, %o1 /* IEU0 Group */
  179. #ifndef USE_BPR
  180. srl %o2, 0, %o2 /* IEU1 */
  181. #endif
  182. brnz,pn %o2, 220f /* CTI Group */
  183. add %o0, %o2, %o0 /* IEU0 */
  184. retl
  185. nop
  186. END(bcopy)
  187. .align 32
  188. 200: be,pt %xcc, 201f /* CTI */
  189. andcc %o0, 0x38, %g5 /* IEU1 Group */
  190. mov 8, %g1 /* IEU0 */
  191. sub %g1, %g2, %g2 /* IEU0 Group */
  192. andcc %o0, 1, %g0 /* IEU1 */
  193. be,pt %icc, 2f /* CTI */
  194. sub %o2, %g2, %o2 /* IEU0 Group */
  195. 1: ldub [%o1], %o5 /* Load Group */
  196. add %o1, 1, %o1 /* IEU0 */
  197. add %o0, 1, %o0 /* IEU1 */
  198. subcc %g2, 1, %g2 /* IEU1 Group */
  199. be,pn %xcc, 3f /* CTI */
  200. stb %o5, [%o0 - 1] /* Store */
  201. 2: ldub [%o1], %o5 /* Load Group */
  202. add %o0, 2, %o0 /* IEU0 */
  203. ldub [%o1 + 1], %g3 /* Load Group */
  204. subcc %g2, 2, %g2 /* IEU1 Group */
  205. stb %o5, [%o0 - 2] /* Store */
  206. add %o1, 2, %o1 /* IEU0 */
  207. bne,pt %xcc, 2b /* CTI Group */
  208. stb %g3, [%o0 - 1] /* Store */
  209. 3: andcc %o0, 0x38, %g5 /* IEU1 Group */
  210. 201: be,pt %icc, 202f /* CTI */
  211. mov 64, %g1 /* IEU0 */
  212. fmovd %f0, %f2 /* FPU */
  213. sub %g1, %g5, %g5 /* IEU0 Group */
  214. alignaddr %o1, %g0, %g1 /* GRU Group */
  215. ldd [%g1], %f4 /* Load Group */
  216. sub %o2, %g5, %o2 /* IEU0 */
  217. 1: ldd [%g1 + 0x8], %f6 /* Load Group */
  218. add %g1, 0x8, %g1 /* IEU0 Group */
  219. subcc %g5, 8, %g5 /* IEU1 */
  220. faligndata %f4, %f6, %f0 /* GRU Group */
  221. std %f0, [%o0] /* Store */
  222. add %o1, 8, %o1 /* IEU0 Group */
  223. be,pn %xcc, 202f /* CTI */
  224. add %o0, 8, %o0 /* IEU1 */
  225. ldd [%g1 + 0x8], %f4 /* Load Group */
  226. add %g1, 8, %g1 /* IEU0 */
  227. subcc %g5, 8, %g5 /* IEU1 */
  228. faligndata %f6, %f4, %f0 /* GRU Group */
  229. std %f0, [%o0] /* Store */
  230. add %o1, 8, %o1 /* IEU0 */
  231. bne,pt %xcc, 1b /* CTI Group */
  232. add %o0, 8, %o0 /* IEU0 */
  233. 202: membar #LoadStore | #StoreStore | #StoreLoad /* LSU Group */
  234. wr %g0, ASI_BLK_P, %asi /* LSU Group */
  235. subcc %o2, 0x40, %g6 /* IEU1 Group */
  236. mov %o1, %g1 /* IEU0 */
  237. andncc %g6, (0x40 - 1), %g6 /* IEU1 Group */
  238. srl %g1, 3, %g2 /* IEU0 */
  239. sub %o2, %g6, %g3 /* IEU0 Group */
  240. andn %o1, (0x40 - 1), %o1 /* IEU1 */
  241. and %g2, 7, %g2 /* IEU0 Group */
  242. andncc %g3, 0x7, %g3 /* IEU1 */
  243. fmovd %f0, %f2 /* FPU */
  244. sub %g3, 0x10, %g3 /* IEU0 Group */
  245. sub %o2, %g6, %o2 /* IEU1 */
  246. alignaddr %g1, %g0, %g0 /* GRU Group */
  247. add %g1, %g6, %g1 /* IEU0 Group */
  248. subcc %o2, %g3, %o2 /* IEU1 */
  249. ldda [%o1 + 0x00] %asi, %f0 /* LSU Group */
  250. add %g1, %g3, %g1 /* IEU0 */
  251. ldda [%o1 + 0x40] %asi, %f16 /* LSU Group */
  252. sub %g6, 0x80, %g6 /* IEU0 */
  253. ldda [%o1 + 0x80] %asi, %f32 /* LSU Group */
  254. /* Clk1 Group 8-( */
  255. /* Clk2 Group 8-( */
  256. /* Clk3 Group 8-( */
  257. /* Clk4 Group 8-( */
  258. 203: rd %pc, %g5 /* PDU Group 8-( */
  259. addcc %g5, %lo(300f - 203b), %g5 /* IEU1 Group */
  260. sll %g2, 9, %g2 /* IEU0 */
  261. jmpl %g5 + %g2, %g0 /* CTI Group brk forced*/
  262. addcc %o1, 0xc0, %o1 /* IEU1 Group */
  263. .align 512 /* OK, here comes the fun part... */
  264. 300: FREG_FROB(f0, f2, f4, f6, f8, f10,f12,f14,f16) LOOP_CHUNK1(o1, o0, g6, 301f)
  265. FREG_FROB(f16,f18,f20,f22,f24,f26,f28,f30,f32) LOOP_CHUNK2(o1, o0, g6, 302f)
  266. FREG_FROB(f32,f34,f36,f38,f40,f42,f44,f46,f0) LOOP_CHUNK3(o1, o0, g6, 303f)
  267. b,pt %xcc, 300b+4; faligndata %f0, %f2, %f48
  268. 301: FREG_FROB(f16,f18,f20,f22,f24,f26,f28,f30,f32) STORE_SYNC(o0, f48) membar #Sync
  269. FREG_FROB(f32,f34,f36,f38,f40,f42,f44,f46,f0) STORE_JUMP(o0, f48, 400f) membar #Sync
  270. 302: FREG_FROB(f32,f34,f36,f38,f40,f42,f44,f46,f0) STORE_SYNC(o0, f48) membar #Sync
  271. FREG_FROB(f0, f2, f4, f6, f8, f10,f12,f14,f16) STORE_JUMP(o0, f48, 416f) membar #Sync
  272. 303: FREG_FROB(f0, f2, f4, f6, f8, f10,f12,f14,f16) STORE_SYNC(o0, f48) membar #Sync
  273. FREG_FROB(f16,f18,f20,f22,f24,f26,f28,f30,f32) STORE_JUMP(o0, f48, 432f) membar #Sync
  274. VISLOOP_PAD
  275. 310: FREG_FROB(f2, f4, f6, f8, f10,f12,f14,f16,f18) LOOP_CHUNK1(o1, o0, g6, 311f)
  276. FREG_FROB(f18,f20,f22,f24,f26,f28,f30,f32,f34) LOOP_CHUNK2(o1, o0, g6, 312f)
  277. FREG_FROB(f34,f36,f38,f40,f42,f44,f46,f0, f2) LOOP_CHUNK3(o1, o0, g6, 313f)
  278. b,pt %xcc, 310b+4; faligndata %f2, %f4, %f48
  279. 311: FREG_FROB(f18,f20,f22,f24,f26,f28,f30,f32,f34) STORE_SYNC(o0, f48) membar #Sync
  280. FREG_FROB(f34,f36,f38,f40,f42,f44,f46,f0, f2) STORE_JUMP(o0, f48, 402f) membar #Sync
  281. 312: FREG_FROB(f34,f36,f38,f40,f42,f44,f46,f0, f2) STORE_SYNC(o0, f48) membar #Sync
  282. FREG_FROB(f2, f4, f6, f8, f10,f12,f14,f16,f18) STORE_JUMP(o0, f48, 418f) membar #Sync
  283. 313: FREG_FROB(f2, f4, f6, f8, f10,f12,f14,f16,f18) STORE_SYNC(o0, f48) membar #Sync
  284. FREG_FROB(f18,f20,f22,f24,f26,f28,f30,f32,f34) STORE_JUMP(o0, f48, 434f) membar #Sync
  285. VISLOOP_PAD
  286. 320: FREG_FROB(f4, f6, f8, f10,f12,f14,f16,f18,f20) LOOP_CHUNK1(o1, o0, g6, 321f)
  287. FREG_FROB(f20,f22,f24,f26,f28,f30,f32,f34,f36) LOOP_CHUNK2(o1, o0, g6, 322f)
  288. FREG_FROB(f36,f38,f40,f42,f44,f46,f0, f2, f4) LOOP_CHUNK3(o1, o0, g6, 323f)
  289. b,pt %xcc, 320b+4; faligndata %f4, %f6, %f48
  290. 321: FREG_FROB(f20,f22,f24,f26,f28,f30,f32,f34,f36) STORE_SYNC(o0, f48) membar #Sync
  291. FREG_FROB(f36,f38,f40,f42,f44,f46,f0, f2, f4) STORE_JUMP(o0, f48, 404f) membar #Sync
  292. 322: FREG_FROB(f36,f38,f40,f42,f44,f46,f0, f2, f4) STORE_SYNC(o0, f48) membar #Sync
  293. FREG_FROB(f4, f6, f8, f10,f12,f14,f16,f18,f20) STORE_JUMP(o0, f48, 420f) membar #Sync
  294. 323: FREG_FROB(f4, f6, f8, f10,f12,f14,f16,f18,f20) STORE_SYNC(o0, f48) membar #Sync
  295. FREG_FROB(f20,f22,f24,f26,f28,f30,f32,f34,f36) STORE_JUMP(o0, f48, 436f) membar #Sync
  296. VISLOOP_PAD
  297. 330: FREG_FROB(f6, f8, f10,f12,f14,f16,f18,f20,f22) LOOP_CHUNK1(o1, o0, g6, 331f)
  298. FREG_FROB(f22,f24,f26,f28,f30,f32,f34,f36,f38) LOOP_CHUNK2(o1, o0, g6, 332f)
  299. FREG_FROB(f38,f40,f42,f44,f46,f0, f2, f4, f6) LOOP_CHUNK3(o1, o0, g6, 333f)
  300. b,pt %xcc, 330b+4; faligndata %f6, %f8, %f48
  301. 331: FREG_FROB(f22,f24,f26,f28,f30,f32,f34,f36,f38) STORE_SYNC(o0, f48) membar #Sync
  302. FREG_FROB(f38,f40,f42,f44,f46,f0, f2, f4, f6) STORE_JUMP(o0, f48, 406f) membar #Sync
  303. 332: FREG_FROB(f38,f40,f42,f44,f46,f0, f2, f4, f6) STORE_SYNC(o0, f48) membar #Sync
  304. FREG_FROB(f6, f8, f10,f12,f14,f16,f18,f20,f22) STORE_JUMP(o0, f48, 422f) membar #Sync
  305. 333: FREG_FROB(f6, f8, f10,f12,f14,f16,f18,f20,f22) STORE_SYNC(o0, f48) membar #Sync
  306. FREG_FROB(f22,f24,f26,f28,f30,f32,f34,f36,f38) STORE_JUMP(o0, f48, 438f) membar #Sync
  307. VISLOOP_PAD
  308. 340: FREG_FROB(f8, f10,f12,f14,f16,f18,f20,f22,f24) LOOP_CHUNK1(o1, o0, g6, 341f)
  309. FREG_FROB(f24,f26,f28,f30,f32,f34,f36,f38,f40) LOOP_CHUNK2(o1, o0, g6, 342f)
  310. FREG_FROB(f40,f42,f44,f46,f0, f2, f4, f6, f8) LOOP_CHUNK3(o1, o0, g6, 343f)
  311. b,pt %xcc, 340b+4; faligndata %f8, %f10, %f48
  312. 341: FREG_FROB(f24,f26,f28,f30,f32,f34,f36,f38,f40) STORE_SYNC(o0, f48) membar #Sync
  313. FREG_FROB(f40,f42,f44,f46,f0, f2, f4, f6, f8) STORE_JUMP(o0, f48, 408f) membar #Sync
  314. 342: FREG_FROB(f40,f42,f44,f46,f0, f2, f4, f6, f8) STORE_SYNC(o0, f48) membar #Sync
  315. FREG_FROB(f8, f10,f12,f14,f16,f18,f20,f22,f24) STORE_JUMP(o0, f48, 424f) membar #Sync
  316. 343: FREG_FROB(f8, f10,f12,f14,f16,f18,f20,f22,f24) STORE_SYNC(o0, f48) membar #Sync
  317. FREG_FROB(f24,f26,f28,f30,f32,f34,f36,f38,f40) STORE_JUMP(o0, f48, 440f) membar #Sync
  318. VISLOOP_PAD
  319. 350: FREG_FROB(f10,f12,f14,f16,f18,f20,f22,f24,f26) LOOP_CHUNK1(o1, o0, g6, 351f)
  320. FREG_FROB(f26,f28,f30,f32,f34,f36,f38,f40,f42) LOOP_CHUNK2(o1, o0, g6, 352f)
  321. FREG_FROB(f42,f44,f46,f0, f2, f4, f6, f8, f10) LOOP_CHUNK3(o1, o0, g6, 353f)
  322. b,pt %xcc, 350b+4; faligndata %f10, %f12, %f48
  323. 351: FREG_FROB(f26,f28,f30,f32,f34,f36,f38,f40,f42) STORE_SYNC(o0, f48) membar #Sync
  324. FREG_FROB(f42,f44,f46,f0, f2, f4, f6, f8, f10) STORE_JUMP(o0, f48, 410f) membar #Sync
  325. 352: FREG_FROB(f42,f44,f46,f0, f2, f4, f6, f8, f10) STORE_SYNC(o0, f48) membar #Sync
  326. FREG_FROB(f10,f12,f14,f16,f18,f20,f22,f24,f26) STORE_JUMP(o0, f48, 426f) membar #Sync
  327. 353: FREG_FROB(f10,f12,f14,f16,f18,f20,f22,f24,f26) STORE_SYNC(o0, f48) membar #Sync
  328. FREG_FROB(f26,f28,f30,f32,f34,f36,f38,f40,f42) STORE_JUMP(o0, f48, 442f) membar #Sync
  329. VISLOOP_PAD
  330. 360: FREG_FROB(f12,f14,f16,f18,f20,f22,f24,f26,f28) LOOP_CHUNK1(o1, o0, g6, 361f)
  331. FREG_FROB(f28,f30,f32,f34,f36,f38,f40,f42,f44) LOOP_CHUNK2(o1, o0, g6, 362f)
  332. FREG_FROB(f44,f46,f0, f2, f4, f6, f8, f10,f12) LOOP_CHUNK3(o1, o0, g6, 363f)
  333. b,pt %xcc, 360b+4; faligndata %f12, %f14, %f48
  334. 361: FREG_FROB(f28,f30,f32,f34,f36,f38,f40,f42,f44) STORE_SYNC(o0, f48) membar #Sync
  335. FREG_FROB(f44,f46,f0, f2, f4, f6, f8, f10,f12) STORE_JUMP(o0, f48, 412f) membar #Sync
  336. 362: FREG_FROB(f44,f46,f0, f2, f4, f6, f8, f10,f12) STORE_SYNC(o0, f48) membar #Sync
  337. FREG_FROB(f12,f14,f16,f18,f20,f22,f24,f26,f28) STORE_JUMP(o0, f48, 428f) membar #Sync
  338. 363: FREG_FROB(f12,f14,f16,f18,f20,f22,f24,f26,f28) STORE_SYNC(o0, f48) membar #Sync
  339. FREG_FROB(f28,f30,f32,f34,f36,f38,f40,f42,f44) STORE_JUMP(o0, f48, 444f) membar #Sync
  340. VISLOOP_PAD
  341. 370: FREG_FROB(f14,f16,f18,f20,f22,f24,f26,f28,f30) LOOP_CHUNK1(o1, o0, g6, 371f)
  342. FREG_FROB(f30,f32,f34,f36,f38,f40,f42,f44,f46) LOOP_CHUNK2(o1, o0, g6, 372f)
  343. FREG_FROB(f46,f0, f2, f4, f6, f8, f10,f12,f14) LOOP_CHUNK3(o1, o0, g6, 373f)
  344. b,pt %xcc, 370b+4; faligndata %f14, %f16, %f48
  345. 371: FREG_FROB(f30,f32,f34,f36,f38,f40,f42,f44,f46) STORE_SYNC(o0, f48) membar #Sync
  346. FREG_FROB(f46,f0, f2, f4, f6, f8, f10,f12,f14) STORE_JUMP(o0, f48, 414f) membar #Sync
  347. 372: FREG_FROB(f46,f0, f2, f4, f6, f8, f10,f12,f14) STORE_SYNC(o0, f48) membar #Sync
  348. FREG_FROB(f14,f16,f18,f20,f22,f24,f26,f28,f30) STORE_JUMP(o0, f48, 430f) membar #Sync
  349. 373: FREG_FROB(f14,f16,f18,f20,f22,f24,f26,f28,f30) STORE_SYNC(o0, f48) membar #Sync
  350. FREG_FROB(f30,f32,f34,f36,f38,f40,f42,f44,f46) STORE_JUMP(o0, f48, 446f) membar #Sync
  351. VISLOOP_PAD
  352. 400: FINISH_VISCHUNK(o0, f0, f2, g3)
  353. 402: FINISH_VISCHUNK(o0, f2, f4, g3)
  354. 404: FINISH_VISCHUNK(o0, f4, f6, g3)
  355. 406: FINISH_VISCHUNK(o0, f6, f8, g3)
  356. 408: FINISH_VISCHUNK(o0, f8, f10, g3)
  357. 410: FINISH_VISCHUNK(o0, f10, f12, g3)
  358. 412: FINISH_VISCHUNK(o0, f12, f14, g3)
  359. 414: UNEVEN_VISCHUNK(o0, f14, f0, g3)
  360. 416: FINISH_VISCHUNK(o0, f16, f18, g3)
  361. 418: FINISH_VISCHUNK(o0, f18, f20, g3)
  362. 420: FINISH_VISCHUNK(o0, f20, f22, g3)
  363. 422: FINISH_VISCHUNK(o0, f22, f24, g3)
  364. 424: FINISH_VISCHUNK(o0, f24, f26, g3)
  365. 426: FINISH_VISCHUNK(o0, f26, f28, g3)
  366. 428: FINISH_VISCHUNK(o0, f28, f30, g3)
  367. 430: UNEVEN_VISCHUNK(o0, f30, f0, g3)
  368. 432: FINISH_VISCHUNK(o0, f32, f34, g3)
  369. 434: FINISH_VISCHUNK(o0, f34, f36, g3)
  370. 436: FINISH_VISCHUNK(o0, f36, f38, g3)
  371. 438: FINISH_VISCHUNK(o0, f38, f40, g3)
  372. 440: FINISH_VISCHUNK(o0, f40, f42, g3)
  373. 442: FINISH_VISCHUNK(o0, f42, f44, g3)
  374. 444: FINISH_VISCHUNK(o0, f44, f46, g3)
  375. 446: UNEVEN_VISCHUNK(o0, f46, f0, g3)
  376. 204: ldd [%o1], %f2 /* Load Group */
  377. add %o1, 8, %o1 /* IEU0 */
  378. subcc %g3, 8, %g3 /* IEU1 */
  379. faligndata %f0, %f2, %f8 /* GRU Group */
  380. std %f8, [%o0] /* Store */
  381. bl,pn %xcc, 205f /* CTI */
  382. add %o0, 8, %o0 /* IEU0 Group */
  383. ldd [%o1], %f0 /* Load Group */
  384. add %o1, 8, %o1 /* IEU0 */
  385. subcc %g3, 8, %g3 /* IEU1 */
  386. faligndata %f2, %f0, %f8 /* GRU Group */
  387. std %f8, [%o0] /* Store */
  388. bge,pt %xcc, 204b /* CTI */
  389. add %o0, 8, %o0 /* IEU0 Group */
  390. 205: brz,pt %o2, 207f /* CTI Group */
  391. mov %g1, %o1 /* IEU0 */
  392. 206: ldub [%o1], %g5 /* LOAD */
  393. add %o1, 1, %o1 /* IEU0 */
  394. add %o0, 1, %o0 /* IEU1 */
  395. subcc %o2, 1, %o2 /* IEU1 */
  396. bne,pt %xcc, 206b /* CTI */
  397. stb %g5, [%o0 - 1] /* Store Group */
  398. 207: membar #StoreLoad | #StoreStore /* LSU Group */
  399. wr %g0, FPRS_FEF, %fprs
  400. retl
  401. mov %g4, %o0
  402. 208: andcc %o2, 1, %g0 /* IEU1 Group */
  403. be,pt %icc, 2f+4 /* CTI */
  404. 1: ldub [%o1], %g5 /* LOAD Group */
  405. add %o1, 1, %o1 /* IEU0 */
  406. add %o0, 1, %o0 /* IEU1 */
  407. subcc %o2, 1, %o2 /* IEU1 Group */
  408. be,pn %xcc, 209f /* CTI */
  409. stb %g5, [%o0 - 1] /* Store */
  410. 2: ldub [%o1], %g5 /* LOAD Group */
  411. add %o0, 2, %o0 /* IEU0 */
  412. ldub [%o1 + 1], %o5 /* LOAD Group */
  413. add %o1, 2, %o1 /* IEU0 */
  414. subcc %o2, 2, %o2 /* IEU1 Group */
  415. stb %g5, [%o0 - 2] /* Store */
  416. bne,pt %xcc, 2b /* CTI */
  417. stb %o5, [%o0 - 1] /* Store */
  418. 209: retl
  419. mov %g4, %o0
  420. #ifdef USE_BPR
  421. /* void *__align_cpy_4(void *dest, void *src, size_t n)
  422. * SPARC v9 SYSV ABI
  423. * Like memcpy, but results are undefined if (!n || ((dest | src | n) & 3))
  424. */
  425. .align 32
  426. ENTRY(__align_cpy_4)
  427. mov %o0, %g4 /* IEU0 Group */
  428. cmp %o2, 15 /* IEU1 */
  429. bleu,pn %xcc, 208b /* CTI */
  430. cmp %o2, (64 * 6) /* IEU1 Group */
  431. bgeu,pn %xcc, 200b /* CTI */
  432. andcc %o0, 7, %g2 /* IEU1 Group */
  433. ba,pt %xcc, 216f /* CTI */
  434. andcc %o1, 4, %g0 /* IEU1 Group */
  435. END(__align_cpy_4)
  436. /* void *__align_cpy_8(void *dest, void *src, size_t n)
  437. * SPARC v9 SYSV ABI
  438. * Like memcpy, but results are undefined if (!n || ((dest | src | n) & 7))
  439. */
  440. .align 32
  441. ENTRY(__align_cpy_8)
  442. mov %o0, %g4 /* IEU0 Group */
  443. cmp %o2, 15 /* IEU1 */
  444. bleu,pn %xcc, 208b /* CTI */
  445. cmp %o2, (64 * 6) /* IEU1 Group */
  446. bgeu,pn %xcc, 201b /* CTI */
  447. andcc %o0, 0x38, %g5 /* IEU1 Group */
  448. andcc %o2, -128, %g6 /* IEU1 Group */
  449. bne,a,pt %xcc, 82f + 4 /* CTI */
  450. ldx [%o1], %g1 /* Load */
  451. ba,pt %xcc, 41f /* CTI Group */
  452. andcc %o2, 0x70, %g6 /* IEU1 */
  453. END(__align_cpy_8)
  454. /* void *__align_cpy_16(void *dest, void *src, size_t n)
  455. * SPARC v9 SYSV ABI
  456. * Like memcpy, but results are undefined if (!n || ((dest | src | n) & 15))
  457. */
  458. .align 32
  459. ENTRY(__align_cpy_16)
  460. mov %o0, %g4 /* IEU0 Group */
  461. cmp %o2, (64 * 6) /* IEU1 */
  462. bgeu,pn %xcc, 201b /* CTI */
  463. andcc %o0, 0x38, %g5 /* IEU1 Group */
  464. andcc %o2, -128, %g6 /* IEU1 Group */
  465. bne,a,pt %xcc, 82f + 4 /* CTI */
  466. ldx [%o1], %g1 /* Load */
  467. ba,pt %xcc, 41f /* CTI Group */
  468. andcc %o2, 0x70, %g6 /* IEU1 */
  469. END(__align_cpy_16)
  470. #endif
  471. .align 32
  472. ENTRY(memcpy)
  473. 210:
  474. #ifndef USE_BPR
  475. srl %o2, 0, %o2 /* IEU1 Group */
  476. #endif
  477. brz,pn %o2, 209b /* CTI Group */
  478. mov %o0, %g4 /* IEU0 */
  479. 218: cmp %o2, 15 /* IEU1 Group */
  480. bleu,pn %xcc, 208b /* CTI */
  481. cmp %o2, (64 * 6) /* IEU1 Group */
  482. bgeu,pn %xcc, 200b /* CTI */
  483. andcc %o0, 7, %g2 /* IEU1 Group */
  484. sub %o0, %o1, %g5 /* IEU0 */
  485. andcc %g5, 3, %o5 /* IEU1 Group */
  486. bne,pn %xcc, 212f /* CTI */
  487. andcc %o1, 3, %g0 /* IEU1 Group */
  488. be,a,pt %xcc, 216f /* CTI */
  489. andcc %o1, 4, %g0 /* IEU1 Group */
  490. andcc %o1, 1, %g0 /* IEU1 Group */
  491. be,pn %xcc, 4f /* CTI */
  492. andcc %o1, 2, %g0 /* IEU1 Group */
  493. ldub [%o1], %g2 /* Load Group */
  494. add %o1, 1, %o1 /* IEU0 */
  495. add %o0, 1, %o0 /* IEU1 */
  496. sub %o2, 1, %o2 /* IEU0 Group */
  497. bne,pn %xcc, 5f /* CTI Group */
  498. stb %g2, [%o0 - 1] /* Store */
  499. 4: lduh [%o1], %g2 /* Load Group */
  500. add %o1, 2, %o1 /* IEU0 */
  501. add %o0, 2, %o0 /* IEU1 */
  502. sub %o2, 2, %o2 /* IEU0 */
  503. sth %g2, [%o0 - 2] /* Store Group + bubble */
  504. 5: andcc %o1, 4, %g0 /* IEU1 */
  505. 216: be,a,pn %xcc, 2f /* CTI */
  506. andcc %o2, -128, %g6 /* IEU1 Group */
  507. lduw [%o1], %g5 /* Load Group */
  508. add %o1, 4, %o1 /* IEU0 */
  509. add %o0, 4, %o0 /* IEU1 */
  510. sub %o2, 4, %o2 /* IEU0 Group */
  511. stw %g5, [%o0 - 4] /* Store */
  512. andcc %o2, -128, %g6 /* IEU1 Group */
  513. 2: be,pn %xcc, 215f /* CTI */
  514. andcc %o0, 4, %g0 /* IEU1 Group */
  515. be,pn %xcc, 82f + 4 /* CTI Group */
  516. 5: MOVE_BIGCHUNK(o1, o0, 0x00, g1, g3, g5, o5)
  517. MOVE_BIGCHUNK(o1, o0, 0x20, g1, g3, g5, o5)
  518. MOVE_BIGCHUNK(o1, o0, 0x40, g1, g3, g5, o5)
  519. MOVE_BIGCHUNK(o1, o0, 0x60, g1, g3, g5, o5)
  520. 35: subcc %g6, 128, %g6 /* IEU1 Group */
  521. add %o1, 128, %o1 /* IEU0 */
  522. bne,pt %xcc, 5b /* CTI */
  523. add %o0, 128, %o0 /* IEU0 Group */
  524. 215: andcc %o2, 0x70, %g6 /* IEU1 Group */
  525. 41: be,pn %xcc, 80f /* CTI */
  526. andcc %o2, 8, %g0 /* IEU1 Group */
  527. /* Clk1 8-( */
  528. /* Clk2 8-( */
  529. /* Clk3 8-( */
  530. /* Clk4 8-( */
  531. 79: rd %pc, %o5 /* PDU Group */
  532. sll %g6, 1, %g5 /* IEU0 Group */
  533. add %o1, %g6, %o1 /* IEU1 */
  534. sub %o5, %g5, %o5 /* IEU0 Group */
  535. jmpl %o5 + %lo(80f - 79b), %g0 /* CTI Group brk forced*/
  536. add %o0, %g6, %o0 /* IEU0 Group */
  537. 36: MOVE_LASTCHUNK(o1, o0, 0x60, g2, g3, g5, o5)
  538. MOVE_LASTCHUNK(o1, o0, 0x50, g2, g3, g5, o5)
  539. MOVE_LASTCHUNK(o1, o0, 0x40, g2, g3, g5, o5)
  540. MOVE_LASTCHUNK(o1, o0, 0x30, g2, g3, g5, o5)
  541. MOVE_LASTCHUNK(o1, o0, 0x20, g2, g3, g5, o5)
  542. MOVE_LASTCHUNK(o1, o0, 0x10, g2, g3, g5, o5)
  543. MOVE_LASTCHUNK(o1, o0, 0x00, g2, g3, g5, o5)
  544. 80: be,pt %xcc, 81f /* CTI */
  545. andcc %o2, 4, %g0 /* IEU1 */
  546. ldx [%o1], %g2 /* Load Group */
  547. add %o0, 8, %o0 /* IEU0 */
  548. stw %g2, [%o0 - 0x4] /* Store Group */
  549. add %o1, 8, %o1 /* IEU1 */
  550. srlx %g2, 32, %g2 /* IEU0 Group */
  551. stw %g2, [%o0 - 0x8] /* Store */
  552. 81: be,pt %xcc, 1f /* CTI */
  553. andcc %o2, 2, %g0 /* IEU1 Group */
  554. lduw [%o1], %g2 /* Load Group */
  555. add %o1, 4, %o1 /* IEU0 */
  556. stw %g2, [%o0] /* Store Group */
  557. add %o0, 4, %o0 /* IEU0 */
  558. 1: be,pt %xcc, 1f /* CTI */
  559. andcc %o2, 1, %g0 /* IEU1 Group */
  560. lduh [%o1], %g2 /* Load Group */
  561. add %o1, 2, %o1 /* IEU0 */
  562. sth %g2, [%o0] /* Store Group */
  563. add %o0, 2, %o0 /* IEU0 */
  564. 1: be,pt %xcc, 211f /* CTI */
  565. nop /* IEU1 */
  566. ldub [%o1], %g2 /* Load Group */
  567. stb %g2, [%o0] /* Store Group + bubble */
  568. 211: retl
  569. mov %g4, %o0
  570. 82: MOVE_BIGALIGNCHUNK(o1, o0, 0x00, g1, g3, g5, o5)
  571. MOVE_BIGALIGNCHUNK(o1, o0, 0x40, g1, g3, g5, o5)
  572. 37: subcc %g6, 128, %g6 /* IEU1 Group */
  573. add %o1, 128, %o1 /* IEU0 */
  574. bne,pt %xcc, 82b /* CTI */
  575. add %o0, 128, %o0 /* IEU0 Group */
  576. andcc %o2, 0x70, %g6 /* IEU1 */
  577. be,pn %xcc, 84f /* CTI */
  578. andcc %o2, 8, %g0 /* IEU1 Group */
  579. /* Clk1 8-( */
  580. /* Clk2 8-( */
  581. /* Clk3 8-( */
  582. /* Clk4 8-( */
  583. 83: rd %pc, %o5 /* PDU Group */
  584. add %o1, %g6, %o1 /* IEU0 Group */
  585. sub %o5, %g6, %o5 /* IEU1 */
  586. jmpl %o5 + %lo(84f - 83b), %g0 /* CTI Group brk forced*/
  587. add %o0, %g6, %o0 /* IEU0 Group */
  588. 38: MOVE_LASTALIGNCHUNK(o1, o0, 0x60, g2, g3)
  589. MOVE_LASTALIGNCHUNK(o1, o0, 0x50, g2, g3)
  590. MOVE_LASTALIGNCHUNK(o1, o0, 0x40, g2, g3)
  591. MOVE_LASTALIGNCHUNK(o1, o0, 0x30, g2, g3)
  592. MOVE_LASTALIGNCHUNK(o1, o0, 0x20, g2, g3)
  593. MOVE_LASTALIGNCHUNK(o1, o0, 0x10, g2, g3)
  594. MOVE_LASTALIGNCHUNK(o1, o0, 0x00, g2, g3)
  595. 84: be,pt %xcc, 85f /* CTI Group */
  596. andcc %o2, 4, %g0 /* IEU1 */
  597. ldx [%o1], %g2 /* Load Group */
  598. add %o0, 8, %o0 /* IEU0 */
  599. add %o1, 8, %o1 /* IEU0 Group */
  600. stx %g2, [%o0 - 0x8] /* Store */
  601. 85: be,pt %xcc, 1f /* CTI */
  602. andcc %o2, 2, %g0 /* IEU1 Group */
  603. lduw [%o1], %g2 /* Load Group */
  604. add %o0, 4, %o0 /* IEU0 */
  605. add %o1, 4, %o1 /* IEU0 Group */
  606. stw %g2, [%o0 - 0x4] /* Store */
  607. 1: be,pt %xcc, 1f /* CTI */
  608. andcc %o2, 1, %g0 /* IEU1 Group */
  609. lduh [%o1], %g2 /* Load Group */
  610. add %o0, 2, %o0 /* IEU0 */
  611. add %o1, 2, %o1 /* IEU0 Group */
  612. sth %g2, [%o0 - 0x2] /* Store */
  613. 1: be,pt %xcc, 1f /* CTI */
  614. nop /* IEU0 Group */
  615. ldub [%o1], %g2 /* Load Group */
  616. stb %g2, [%o0] /* Store Group + bubble */
  617. 1: retl
  618. mov %g4, %o0
  619. 212: brz,pt %g2, 2f /* CTI Group */
  620. mov 8, %g1 /* IEU0 */
  621. sub %g1, %g2, %g2 /* IEU0 Group */
  622. sub %o2, %g2, %o2 /* IEU0 Group */
  623. 1: ldub [%o1], %g5 /* Load Group */
  624. add %o1, 1, %o1 /* IEU0 */
  625. add %o0, 1, %o0 /* IEU1 */
  626. subcc %g2, 1, %g2 /* IEU1 Group */
  627. bne,pt %xcc, 1b /* CTI */
  628. stb %g5, [%o0 - 1] /* Store */
  629. 2: andn %o2, 7, %g5 /* IEU0 Group */
  630. and %o2, 7, %o2 /* IEU1 */
  631. fmovd %f0, %f2 /* FPU */
  632. alignaddr %o1, %g0, %g1 /* GRU Group */
  633. ldd [%g1], %f4 /* Load Group */
  634. 1: ldd [%g1 + 0x8], %f6 /* Load Group */
  635. add %g1, 0x8, %g1 /* IEU0 Group */
  636. subcc %g5, 8, %g5 /* IEU1 */
  637. faligndata %f4, %f6, %f0 /* GRU Group */
  638. std %f0, [%o0] /* Store */
  639. add %o1, 8, %o1 /* IEU0 Group */
  640. be,pn %xcc, 213f /* CTI */
  641. add %o0, 8, %o0 /* IEU1 */
  642. ldd [%g1 + 0x8], %f4 /* Load Group */
  643. add %g1, 8, %g1 /* IEU0 */
  644. subcc %g5, 8, %g5 /* IEU1 */
  645. faligndata %f6, %f4, %f0 /* GRU Group */
  646. std %f0, [%o0] /* Store */
  647. add %o1, 8, %o1 /* IEU0 */
  648. bne,pn %xcc, 1b /* CTI Group */
  649. add %o0, 8, %o0 /* IEU0 */
  650. 213: brz,pn %o2, 214f /* CTI Group */
  651. nop /* IEU0 */
  652. ldub [%o1], %g5 /* LOAD */
  653. add %o1, 1, %o1 /* IEU0 */
  654. add %o0, 1, %o0 /* IEU1 */
  655. subcc %o2, 1, %o2 /* IEU1 */
  656. bne,pt %xcc, 206b /* CTI */
  657. stb %g5, [%o0 - 1] /* Store Group */
  658. 214: wr %g0, FPRS_FEF, %fprs
  659. retl
  660. mov %g4, %o0
  661. END(memcpy)
  662. .align 32
  663. 228: andcc %o2, 1, %g0 /* IEU1 Group */
  664. be,pt %icc, 2f+4 /* CTI */
  665. 1: ldub [%o1 - 1], %o5 /* LOAD Group */
  666. sub %o1, 1, %o1 /* IEU0 */
  667. sub %o0, 1, %o0 /* IEU1 */
  668. subcc %o2, 1, %o2 /* IEU1 Group */
  669. be,pn %xcc, 229f /* CTI */
  670. stb %o5, [%o0] /* Store */
  671. 2: ldub [%o1 - 1], %o5 /* LOAD Group */
  672. sub %o0, 2, %o0 /* IEU0 */
  673. ldub [%o1 - 2], %g5 /* LOAD Group */
  674. sub %o1, 2, %o1 /* IEU0 */
  675. subcc %o2, 2, %o2 /* IEU1 Group */
  676. stb %o5, [%o0 + 1] /* Store */
  677. bne,pt %xcc, 2b /* CTI */
  678. stb %g5, [%o0] /* Store */
  679. 229: retl
  680. mov %g4, %o0
  681. 219: retl
  682. nop
  683. .align 32
  684. ENTRY(memmove)
  685. #ifndef USE_BPR
  686. srl %o2, 0, %o2 /* IEU1 Group */
  687. #endif
  688. brz,pn %o2, 219b /* CTI Group */
  689. sub %o0, %o1, %o4 /* IEU0 */
  690. cmp %o4, %o2 /* IEU1 Group */
  691. bgeu,pt %XCC, 218b /* CTI */
  692. mov %o0, %g4 /* IEU0 */
  693. add %o0, %o2, %o0 /* IEU0 Group */
  694. 220: add %o1, %o2, %o1 /* IEU1 */
  695. cmp %o2, 15 /* IEU1 Group */
  696. bleu,pn %xcc, 228b /* CTI */
  697. andcc %o0, 7, %g2 /* IEU1 Group */
  698. sub %o0, %o1, %g5 /* IEU0 */
  699. andcc %g5, 3, %o5 /* IEU1 Group */
  700. bne,pn %xcc, 232f /* CTI */
  701. andcc %o1, 3, %g0 /* IEU1 Group */
  702. be,a,pt %xcc, 236f /* CTI */
  703. andcc %o1, 4, %g0 /* IEU1 Group */
  704. andcc %o1, 1, %g0 /* IEU1 Group */
  705. be,pn %xcc, 4f /* CTI */
  706. andcc %o1, 2, %g0 /* IEU1 Group */
  707. ldub [%o1 - 1], %g2 /* Load Group */
  708. sub %o1, 1, %o1 /* IEU0 */
  709. sub %o0, 1, %o0 /* IEU1 */
  710. sub %o2, 1, %o2 /* IEU0 Group */
  711. be,pn %xcc, 5f /* CTI Group */
  712. stb %g2, [%o0] /* Store */
  713. 4: lduh [%o1 - 2], %g2 /* Load Group */
  714. sub %o1, 2, %o1 /* IEU0 */
  715. sub %o0, 2, %o0 /* IEU1 */
  716. sub %o2, 2, %o2 /* IEU0 */
  717. sth %g2, [%o0] /* Store Group + bubble */
  718. 5: andcc %o1, 4, %g0 /* IEU1 */
  719. 236: be,a,pn %xcc, 2f /* CTI */
  720. andcc %o2, -128, %g6 /* IEU1 Group */
  721. lduw [%o1 - 4], %g5 /* Load Group */
  722. sub %o1, 4, %o1 /* IEU0 */
  723. sub %o0, 4, %o0 /* IEU1 */
  724. sub %o2, 4, %o2 /* IEU0 Group */
  725. stw %g5, [%o0] /* Store */
  726. andcc %o2, -128, %g6 /* IEU1 Group */
  727. 2: be,pn %xcc, 235f /* CTI */
  728. andcc %o0, 4, %g0 /* IEU1 Group */
  729. be,pn %xcc, 282f + 4 /* CTI Group */
  730. 5: RMOVE_BIGCHUNK(o1, o0, 0x00, g1, g3, g5, o5)
  731. RMOVE_BIGCHUNK(o1, o0, 0x20, g1, g3, g5, o5)
  732. RMOVE_BIGCHUNK(o1, o0, 0x40, g1, g3, g5, o5)
  733. RMOVE_BIGCHUNK(o1, o0, 0x60, g1, g3, g5, o5)
  734. subcc %g6, 128, %g6 /* IEU1 Group */
  735. sub %o1, 128, %o1 /* IEU0 */
  736. bne,pt %xcc, 5b /* CTI */
  737. sub %o0, 128, %o0 /* IEU0 Group */
  738. 235: andcc %o2, 0x70, %g6 /* IEU1 Group */
  739. 41: be,pn %xcc, 280f /* CTI */
  740. andcc %o2, 8, %g0 /* IEU1 Group */
  741. /* Clk1 8-( */
  742. /* Clk2 8-( */
  743. /* Clk3 8-( */
  744. /* Clk4 8-( */
  745. 279: rd %pc, %o5 /* PDU Group */
  746. sll %g6, 1, %g5 /* IEU0 Group */
  747. sub %o1, %g6, %o1 /* IEU1 */
  748. sub %o5, %g5, %o5 /* IEU0 Group */
  749. jmpl %o5 + %lo(280f - 279b), %g0 /* CTI Group brk forced*/
  750. sub %o0, %g6, %o0 /* IEU0 Group */
  751. RMOVE_LASTCHUNK(o1, o0, 0x60, g2, g3, g5, o5)
  752. RMOVE_LASTCHUNK(o1, o0, 0x50, g2, g3, g5, o5)
  753. RMOVE_LASTCHUNK(o1, o0, 0x40, g2, g3, g5, o5)
  754. RMOVE_LASTCHUNK(o1, o0, 0x30, g2, g3, g5, o5)
  755. RMOVE_LASTCHUNK(o1, o0, 0x20, g2, g3, g5, o5)
  756. RMOVE_LASTCHUNK(o1, o0, 0x10, g2, g3, g5, o5)
  757. RMOVE_LASTCHUNK(o1, o0, 0x00, g2, g3, g5, o5)
  758. 280: be,pt %xcc, 281f /* CTI */
  759. andcc %o2, 4, %g0 /* IEU1 */
  760. ldx [%o1 - 8], %g2 /* Load Group */
  761. sub %o0, 8, %o0 /* IEU0 */
  762. stw %g2, [%o0 + 4] /* Store Group */
  763. sub %o1, 8, %o1 /* IEU1 */
  764. srlx %g2, 32, %g2 /* IEU0 Group */
  765. stw %g2, [%o0] /* Store */
  766. 281: be,pt %xcc, 1f /* CTI */
  767. andcc %o2, 2, %g0 /* IEU1 Group */
  768. lduw [%o1 - 4], %g2 /* Load Group */
  769. sub %o1, 4, %o1 /* IEU0 */
  770. stw %g2, [%o0 - 4] /* Store Group */
  771. sub %o0, 4, %o0 /* IEU0 */
  772. 1: be,pt %xcc, 1f /* CTI */
  773. andcc %o2, 1, %g0 /* IEU1 Group */
  774. lduh [%o1 - 2], %g2 /* Load Group */
  775. sub %o1, 2, %o1 /* IEU0 */
  776. sth %g2, [%o0 - 2] /* Store Group */
  777. sub %o0, 2, %o0 /* IEU0 */
  778. 1: be,pt %xcc, 211f /* CTI */
  779. nop /* IEU1 */
  780. ldub [%o1 - 1], %g2 /* Load Group */
  781. stb %g2, [%o0 - 1] /* Store Group + bubble */
  782. 211: retl
  783. mov %g4, %o0
  784. 282: RMOVE_BIGALIGNCHUNK(o1, o0, 0x00, g1, g3, g5, o5)
  785. RMOVE_BIGALIGNCHUNK(o1, o0, 0x40, g1, g3, g5, o5)
  786. subcc %g6, 128, %g6 /* IEU1 Group */
  787. sub %o1, 128, %o1 /* IEU0 */
  788. bne,pt %xcc, 282b /* CTI */
  789. sub %o0, 128, %o0 /* IEU0 Group */
  790. andcc %o2, 0x70, %g6 /* IEU1 */
  791. be,pn %xcc, 284f /* CTI */
  792. andcc %o2, 8, %g0 /* IEU1 Group */
  793. /* Clk1 8-( */
  794. /* Clk2 8-( */
  795. /* Clk3 8-( */
  796. /* Clk4 8-( */
  797. 283: rd %pc, %o5 /* PDU Group */
  798. sub %o1, %g6, %o1 /* IEU0 Group */
  799. sub %o5, %g6, %o5 /* IEU1 */
  800. jmpl %o5 + %lo(284f - 283b), %g0 /* CTI Group brk forced*/
  801. sub %o0, %g6, %o0 /* IEU0 Group */
  802. RMOVE_LASTALIGNCHUNK(o1, o0, 0x60, g2, g3)
  803. RMOVE_LASTALIGNCHUNK(o1, o0, 0x50, g2, g3)
  804. RMOVE_LASTALIGNCHUNK(o1, o0, 0x40, g2, g3)
  805. RMOVE_LASTALIGNCHUNK(o1, o0, 0x30, g2, g3)
  806. RMOVE_LASTALIGNCHUNK(o1, o0, 0x20, g2, g3)
  807. RMOVE_LASTALIGNCHUNK(o1, o0, 0x10, g2, g3)
  808. RMOVE_LASTALIGNCHUNK(o1, o0, 0x00, g2, g3)
  809. 284: be,pt %xcc, 285f /* CTI Group */
  810. andcc %o2, 4, %g0 /* IEU1 */
  811. ldx [%o1 - 8], %g2 /* Load Group */
  812. sub %o0, 8, %o0 /* IEU0 */
  813. sub %o1, 8, %o1 /* IEU0 Group */
  814. stx %g2, [%o0] /* Store */
  815. 285: be,pt %xcc, 1f /* CTI */
  816. andcc %o2, 2, %g0 /* IEU1 Group */
  817. lduw [%o1 - 4], %g2 /* Load Group */
  818. sub %o0, 4, %o0 /* IEU0 */
  819. sub %o1, 4, %o1 /* IEU0 Group */
  820. stw %g2, [%o0] /* Store */
  821. 1: be,pt %xcc, 1f /* CTI */
  822. andcc %o2, 1, %g0 /* IEU1 Group */
  823. lduh [%o1 - 2], %g2 /* Load Group */
  824. sub %o0, 2, %o0 /* IEU0 */
  825. sub %o1, 2, %o1 /* IEU0 Group */
  826. sth %g2, [%o0] /* Store */
  827. 1: be,pt %xcc, 1f /* CTI */
  828. nop /* IEU0 Group */
  829. ldub [%o1 - 1], %g2 /* Load Group */
  830. stb %g2, [%o0 - 1] /* Store Group + bubble */
  831. 1: retl
  832. mov %g4, %o0
  833. 232: brz,pt %g2, 2f /* CTI Group */
  834. sub %o2, %g2, %o2 /* IEU0 Group */
  835. 1: ldub [%o1 - 1], %g5 /* Load Group */
  836. sub %o1, 1, %o1 /* IEU0 */
  837. sub %o0, 1, %o0 /* IEU1 */
  838. subcc %g2, 1, %g2 /* IEU1 Group */
  839. bne,pt %xcc, 1b /* CTI */
  840. stb %g5, [%o0] /* Store */
  841. 2: andn %o2, 7, %g5 /* IEU0 Group */
  842. and %o2, 7, %o2 /* IEU1 */
  843. fmovd %f0, %f2 /* FPU */
  844. alignaddr %o1, %g0, %g1 /* GRU Group */
  845. ldd [%g1], %f4 /* Load Group */
  846. 1: ldd [%g1 - 8], %f6 /* Load Group */
  847. sub %g1, 8, %g1 /* IEU0 Group */
  848. subcc %g5, 8, %g5 /* IEU1 */
  849. faligndata %f6, %f4, %f0 /* GRU Group */
  850. std %f0, [%o0 - 8] /* Store */
  851. sub %o1, 8, %o1 /* IEU0 Group */
  852. be,pn %xcc, 233f /* CTI */
  853. sub %o0, 8, %o0 /* IEU1 */
  854. ldd [%g1 - 8], %f4 /* Load Group */
  855. sub %g1, 8, %g1 /* IEU0 */
  856. subcc %g5, 8, %g5 /* IEU1 */
  857. faligndata %f4, %f6, %f0 /* GRU Group */
  858. std %f0, [%o0 - 8] /* Store */
  859. sub %o1, 8, %o1 /* IEU0 */
  860. bne,pn %xcc, 1b /* CTI Group */
  861. sub %o0, 8, %o0 /* IEU0 */
  862. 233: brz,pn %o2, 234f /* CTI Group */
  863. nop /* IEU0 */
  864. 237: ldub [%o1 - 1], %g5 /* LOAD */
  865. sub %o1, 1, %o1 /* IEU0 */
  866. sub %o0, 1, %o0 /* IEU1 */
  867. subcc %o2, 1, %o2 /* IEU1 */
  868. bne,pt %xcc, 237b /* CTI */
  869. stb %g5, [%o0] /* Store Group */
  870. 234: wr %g0, FPRS_FEF, %fprs
  871. retl
  872. mov %g4, %o0
  873. END(memmove)
  874. #ifdef USE_BPR
  875. weak_alias (memcpy, __align_cpy_1)
  876. weak_alias (memcpy, __align_cpy_2)
  877. #endif