memcpy.S 35 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927
  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. .globl bcopy
  173. .set bcopy,__bcopy
  174. .hidden __bcopy
  175. ENTRY(__bcopy)
  176. sub %o1, %o0, %o4 /* IEU0 Group */
  177. mov %o0, %g3 /* IEU1 */
  178. cmp %o4, %o2 /* IEU1 Group */
  179. mov %o1, %o0 /* IEU0 */
  180. bgeu,pt %XCC, 210f /* CTI */
  181. mov %g3, %o1 /* IEU0 Group */
  182. #ifndef USE_BPR
  183. srl %o2, 0, %o2 /* IEU1 */
  184. #endif
  185. brnz,pn %o2, 220f /* CTI Group */
  186. add %o0, %o2, %o0 /* IEU0 */
  187. retl
  188. nop
  189. END(__bcopy)
  190. .align 32
  191. 200: be,pt %xcc, 201f /* CTI */
  192. andcc %o0, 0x38, %g5 /* IEU1 Group */
  193. mov 8, %g1 /* IEU0 */
  194. sub %g1, %g2, %g2 /* IEU0 Group */
  195. andcc %o0, 1, %g0 /* IEU1 */
  196. be,pt %icc, 2f /* CTI */
  197. sub %o2, %g2, %o2 /* IEU0 Group */
  198. 1: ldub [%o1], %o5 /* Load Group */
  199. add %o1, 1, %o1 /* IEU0 */
  200. add %o0, 1, %o0 /* IEU1 */
  201. subcc %g2, 1, %g2 /* IEU1 Group */
  202. be,pn %xcc, 3f /* CTI */
  203. stb %o5, [%o0 - 1] /* Store */
  204. 2: ldub [%o1], %o5 /* Load Group */
  205. add %o0, 2, %o0 /* IEU0 */
  206. ldub [%o1 + 1], %g3 /* Load Group */
  207. subcc %g2, 2, %g2 /* IEU1 Group */
  208. stb %o5, [%o0 - 2] /* Store */
  209. add %o1, 2, %o1 /* IEU0 */
  210. bne,pt %xcc, 2b /* CTI Group */
  211. stb %g3, [%o0 - 1] /* Store */
  212. 3: andcc %o0, 0x38, %g5 /* IEU1 Group */
  213. 201: be,pt %icc, 202f /* CTI */
  214. mov 64, %g1 /* IEU0 */
  215. fmovd %f0, %f2 /* FPU */
  216. sub %g1, %g5, %g5 /* IEU0 Group */
  217. alignaddr %o1, %g0, %g1 /* GRU Group */
  218. ldd [%g1], %f4 /* Load Group */
  219. sub %o2, %g5, %o2 /* IEU0 */
  220. 1: ldd [%g1 + 0x8], %f6 /* Load Group */
  221. add %g1, 0x8, %g1 /* IEU0 Group */
  222. subcc %g5, 8, %g5 /* IEU1 */
  223. faligndata %f4, %f6, %f0 /* GRU Group */
  224. std %f0, [%o0] /* Store */
  225. add %o1, 8, %o1 /* IEU0 Group */
  226. be,pn %xcc, 202f /* CTI */
  227. add %o0, 8, %o0 /* IEU1 */
  228. ldd [%g1 + 0x8], %f4 /* Load Group */
  229. add %g1, 8, %g1 /* IEU0 */
  230. subcc %g5, 8, %g5 /* IEU1 */
  231. faligndata %f6, %f4, %f0 /* GRU Group */
  232. std %f0, [%o0] /* Store */
  233. add %o1, 8, %o1 /* IEU0 */
  234. bne,pt %xcc, 1b /* CTI Group */
  235. add %o0, 8, %o0 /* IEU0 */
  236. 202: membar #LoadStore | #StoreStore | #StoreLoad /* LSU Group */
  237. wr %g0, ASI_BLK_P, %asi /* LSU Group */
  238. subcc %o2, 0x40, %g6 /* IEU1 Group */
  239. mov %o1, %g1 /* IEU0 */
  240. andncc %g6, (0x40 - 1), %g6 /* IEU1 Group */
  241. srl %g1, 3, %g2 /* IEU0 */
  242. sub %o2, %g6, %g3 /* IEU0 Group */
  243. andn %o1, (0x40 - 1), %o1 /* IEU1 */
  244. and %g2, 7, %g2 /* IEU0 Group */
  245. andncc %g3, 0x7, %g3 /* IEU1 */
  246. fmovd %f0, %f2 /* FPU */
  247. sub %g3, 0x10, %g3 /* IEU0 Group */
  248. sub %o2, %g6, %o2 /* IEU1 */
  249. alignaddr %g1, %g0, %g0 /* GRU Group */
  250. add %g1, %g6, %g1 /* IEU0 Group */
  251. subcc %o2, %g3, %o2 /* IEU1 */
  252. ldda [%o1 + 0x00] %asi, %f0 /* LSU Group */
  253. add %g1, %g3, %g1 /* IEU0 */
  254. ldda [%o1 + 0x40] %asi, %f16 /* LSU Group */
  255. sub %g6, 0x80, %g6 /* IEU0 */
  256. ldda [%o1 + 0x80] %asi, %f32 /* LSU Group */
  257. /* Clk1 Group 8-( */
  258. /* Clk2 Group 8-( */
  259. /* Clk3 Group 8-( */
  260. /* Clk4 Group 8-( */
  261. 203: rd %pc, %g5 /* PDU Group 8-( */
  262. addcc %g5, %lo(300f - 203b), %g5 /* IEU1 Group */
  263. sll %g2, 9, %g2 /* IEU0 */
  264. jmpl %g5 + %g2, %g0 /* CTI Group brk forced*/
  265. addcc %o1, 0xc0, %o1 /* IEU1 Group */
  266. .align 512 /* OK, here comes the fun part... */
  267. 300: FREG_FROB(f0, f2, f4, f6, f8, f10,f12,f14,f16) LOOP_CHUNK1(o1, o0, g6, 301f)
  268. FREG_FROB(f16,f18,f20,f22,f24,f26,f28,f30,f32) LOOP_CHUNK2(o1, o0, g6, 302f)
  269. FREG_FROB(f32,f34,f36,f38,f40,f42,f44,f46,f0) LOOP_CHUNK3(o1, o0, g6, 303f)
  270. b,pt %xcc, 300b+4; faligndata %f0, %f2, %f48
  271. 301: FREG_FROB(f16,f18,f20,f22,f24,f26,f28,f30,f32) STORE_SYNC(o0, f48) membar #Sync
  272. FREG_FROB(f32,f34,f36,f38,f40,f42,f44,f46,f0) STORE_JUMP(o0, f48, 400f) membar #Sync
  273. 302: FREG_FROB(f32,f34,f36,f38,f40,f42,f44,f46,f0) STORE_SYNC(o0, f48) membar #Sync
  274. FREG_FROB(f0, f2, f4, f6, f8, f10,f12,f14,f16) STORE_JUMP(o0, f48, 416f) membar #Sync
  275. 303: FREG_FROB(f0, f2, f4, f6, f8, f10,f12,f14,f16) STORE_SYNC(o0, f48) membar #Sync
  276. FREG_FROB(f16,f18,f20,f22,f24,f26,f28,f30,f32) STORE_JUMP(o0, f48, 432f) membar #Sync
  277. VISLOOP_PAD
  278. 310: FREG_FROB(f2, f4, f6, f8, f10,f12,f14,f16,f18) LOOP_CHUNK1(o1, o0, g6, 311f)
  279. FREG_FROB(f18,f20,f22,f24,f26,f28,f30,f32,f34) LOOP_CHUNK2(o1, o0, g6, 312f)
  280. FREG_FROB(f34,f36,f38,f40,f42,f44,f46,f0, f2) LOOP_CHUNK3(o1, o0, g6, 313f)
  281. b,pt %xcc, 310b+4; faligndata %f2, %f4, %f48
  282. 311: FREG_FROB(f18,f20,f22,f24,f26,f28,f30,f32,f34) STORE_SYNC(o0, f48) membar #Sync
  283. FREG_FROB(f34,f36,f38,f40,f42,f44,f46,f0, f2) STORE_JUMP(o0, f48, 402f) membar #Sync
  284. 312: FREG_FROB(f34,f36,f38,f40,f42,f44,f46,f0, f2) STORE_SYNC(o0, f48) membar #Sync
  285. FREG_FROB(f2, f4, f6, f8, f10,f12,f14,f16,f18) STORE_JUMP(o0, f48, 418f) membar #Sync
  286. 313: FREG_FROB(f2, f4, f6, f8, f10,f12,f14,f16,f18) STORE_SYNC(o0, f48) membar #Sync
  287. FREG_FROB(f18,f20,f22,f24,f26,f28,f30,f32,f34) STORE_JUMP(o0, f48, 434f) membar #Sync
  288. VISLOOP_PAD
  289. 320: FREG_FROB(f4, f6, f8, f10,f12,f14,f16,f18,f20) LOOP_CHUNK1(o1, o0, g6, 321f)
  290. FREG_FROB(f20,f22,f24,f26,f28,f30,f32,f34,f36) LOOP_CHUNK2(o1, o0, g6, 322f)
  291. FREG_FROB(f36,f38,f40,f42,f44,f46,f0, f2, f4) LOOP_CHUNK3(o1, o0, g6, 323f)
  292. b,pt %xcc, 320b+4; faligndata %f4, %f6, %f48
  293. 321: FREG_FROB(f20,f22,f24,f26,f28,f30,f32,f34,f36) STORE_SYNC(o0, f48) membar #Sync
  294. FREG_FROB(f36,f38,f40,f42,f44,f46,f0, f2, f4) STORE_JUMP(o0, f48, 404f) membar #Sync
  295. 322: FREG_FROB(f36,f38,f40,f42,f44,f46,f0, f2, f4) STORE_SYNC(o0, f48) membar #Sync
  296. FREG_FROB(f4, f6, f8, f10,f12,f14,f16,f18,f20) STORE_JUMP(o0, f48, 420f) membar #Sync
  297. 323: FREG_FROB(f4, f6, f8, f10,f12,f14,f16,f18,f20) STORE_SYNC(o0, f48) membar #Sync
  298. FREG_FROB(f20,f22,f24,f26,f28,f30,f32,f34,f36) STORE_JUMP(o0, f48, 436f) membar #Sync
  299. VISLOOP_PAD
  300. 330: FREG_FROB(f6, f8, f10,f12,f14,f16,f18,f20,f22) LOOP_CHUNK1(o1, o0, g6, 331f)
  301. FREG_FROB(f22,f24,f26,f28,f30,f32,f34,f36,f38) LOOP_CHUNK2(o1, o0, g6, 332f)
  302. FREG_FROB(f38,f40,f42,f44,f46,f0, f2, f4, f6) LOOP_CHUNK3(o1, o0, g6, 333f)
  303. b,pt %xcc, 330b+4; faligndata %f6, %f8, %f48
  304. 331: FREG_FROB(f22,f24,f26,f28,f30,f32,f34,f36,f38) STORE_SYNC(o0, f48) membar #Sync
  305. FREG_FROB(f38,f40,f42,f44,f46,f0, f2, f4, f6) STORE_JUMP(o0, f48, 406f) membar #Sync
  306. 332: FREG_FROB(f38,f40,f42,f44,f46,f0, f2, f4, f6) STORE_SYNC(o0, f48) membar #Sync
  307. FREG_FROB(f6, f8, f10,f12,f14,f16,f18,f20,f22) STORE_JUMP(o0, f48, 422f) membar #Sync
  308. 333: FREG_FROB(f6, f8, f10,f12,f14,f16,f18,f20,f22) STORE_SYNC(o0, f48) membar #Sync
  309. FREG_FROB(f22,f24,f26,f28,f30,f32,f34,f36,f38) STORE_JUMP(o0, f48, 438f) membar #Sync
  310. VISLOOP_PAD
  311. 340: FREG_FROB(f8, f10,f12,f14,f16,f18,f20,f22,f24) LOOP_CHUNK1(o1, o0, g6, 341f)
  312. FREG_FROB(f24,f26,f28,f30,f32,f34,f36,f38,f40) LOOP_CHUNK2(o1, o0, g6, 342f)
  313. FREG_FROB(f40,f42,f44,f46,f0, f2, f4, f6, f8) LOOP_CHUNK3(o1, o0, g6, 343f)
  314. b,pt %xcc, 340b+4; faligndata %f8, %f10, %f48
  315. 341: FREG_FROB(f24,f26,f28,f30,f32,f34,f36,f38,f40) STORE_SYNC(o0, f48) membar #Sync
  316. FREG_FROB(f40,f42,f44,f46,f0, f2, f4, f6, f8) STORE_JUMP(o0, f48, 408f) membar #Sync
  317. 342: FREG_FROB(f40,f42,f44,f46,f0, f2, f4, f6, f8) STORE_SYNC(o0, f48) membar #Sync
  318. FREG_FROB(f8, f10,f12,f14,f16,f18,f20,f22,f24) STORE_JUMP(o0, f48, 424f) membar #Sync
  319. 343: FREG_FROB(f8, f10,f12,f14,f16,f18,f20,f22,f24) STORE_SYNC(o0, f48) membar #Sync
  320. FREG_FROB(f24,f26,f28,f30,f32,f34,f36,f38,f40) STORE_JUMP(o0, f48, 440f) membar #Sync
  321. VISLOOP_PAD
  322. 350: FREG_FROB(f10,f12,f14,f16,f18,f20,f22,f24,f26) LOOP_CHUNK1(o1, o0, g6, 351f)
  323. FREG_FROB(f26,f28,f30,f32,f34,f36,f38,f40,f42) LOOP_CHUNK2(o1, o0, g6, 352f)
  324. FREG_FROB(f42,f44,f46,f0, f2, f4, f6, f8, f10) LOOP_CHUNK3(o1, o0, g6, 353f)
  325. b,pt %xcc, 350b+4; faligndata %f10, %f12, %f48
  326. 351: FREG_FROB(f26,f28,f30,f32,f34,f36,f38,f40,f42) STORE_SYNC(o0, f48) membar #Sync
  327. FREG_FROB(f42,f44,f46,f0, f2, f4, f6, f8, f10) STORE_JUMP(o0, f48, 410f) membar #Sync
  328. 352: FREG_FROB(f42,f44,f46,f0, f2, f4, f6, f8, f10) STORE_SYNC(o0, f48) membar #Sync
  329. FREG_FROB(f10,f12,f14,f16,f18,f20,f22,f24,f26) STORE_JUMP(o0, f48, 426f) membar #Sync
  330. 353: FREG_FROB(f10,f12,f14,f16,f18,f20,f22,f24,f26) STORE_SYNC(o0, f48) membar #Sync
  331. FREG_FROB(f26,f28,f30,f32,f34,f36,f38,f40,f42) STORE_JUMP(o0, f48, 442f) membar #Sync
  332. VISLOOP_PAD
  333. 360: FREG_FROB(f12,f14,f16,f18,f20,f22,f24,f26,f28) LOOP_CHUNK1(o1, o0, g6, 361f)
  334. FREG_FROB(f28,f30,f32,f34,f36,f38,f40,f42,f44) LOOP_CHUNK2(o1, o0, g6, 362f)
  335. FREG_FROB(f44,f46,f0, f2, f4, f6, f8, f10,f12) LOOP_CHUNK3(o1, o0, g6, 363f)
  336. b,pt %xcc, 360b+4; faligndata %f12, %f14, %f48
  337. 361: FREG_FROB(f28,f30,f32,f34,f36,f38,f40,f42,f44) STORE_SYNC(o0, f48) membar #Sync
  338. FREG_FROB(f44,f46,f0, f2, f4, f6, f8, f10,f12) STORE_JUMP(o0, f48, 412f) membar #Sync
  339. 362: FREG_FROB(f44,f46,f0, f2, f4, f6, f8, f10,f12) STORE_SYNC(o0, f48) membar #Sync
  340. FREG_FROB(f12,f14,f16,f18,f20,f22,f24,f26,f28) STORE_JUMP(o0, f48, 428f) membar #Sync
  341. 363: FREG_FROB(f12,f14,f16,f18,f20,f22,f24,f26,f28) STORE_SYNC(o0, f48) membar #Sync
  342. FREG_FROB(f28,f30,f32,f34,f36,f38,f40,f42,f44) STORE_JUMP(o0, f48, 444f) membar #Sync
  343. VISLOOP_PAD
  344. 370: FREG_FROB(f14,f16,f18,f20,f22,f24,f26,f28,f30) LOOP_CHUNK1(o1, o0, g6, 371f)
  345. FREG_FROB(f30,f32,f34,f36,f38,f40,f42,f44,f46) LOOP_CHUNK2(o1, o0, g6, 372f)
  346. FREG_FROB(f46,f0, f2, f4, f6, f8, f10,f12,f14) LOOP_CHUNK3(o1, o0, g6, 373f)
  347. b,pt %xcc, 370b+4; faligndata %f14, %f16, %f48
  348. 371: FREG_FROB(f30,f32,f34,f36,f38,f40,f42,f44,f46) STORE_SYNC(o0, f48) membar #Sync
  349. FREG_FROB(f46,f0, f2, f4, f6, f8, f10,f12,f14) STORE_JUMP(o0, f48, 414f) membar #Sync
  350. 372: FREG_FROB(f46,f0, f2, f4, f6, f8, f10,f12,f14) STORE_SYNC(o0, f48) membar #Sync
  351. FREG_FROB(f14,f16,f18,f20,f22,f24,f26,f28,f30) STORE_JUMP(o0, f48, 430f) membar #Sync
  352. 373: FREG_FROB(f14,f16,f18,f20,f22,f24,f26,f28,f30) STORE_SYNC(o0, f48) membar #Sync
  353. FREG_FROB(f30,f32,f34,f36,f38,f40,f42,f44,f46) STORE_JUMP(o0, f48, 446f) membar #Sync
  354. VISLOOP_PAD
  355. 400: FINISH_VISCHUNK(o0, f0, f2, g3)
  356. 402: FINISH_VISCHUNK(o0, f2, f4, g3)
  357. 404: FINISH_VISCHUNK(o0, f4, f6, g3)
  358. 406: FINISH_VISCHUNK(o0, f6, f8, g3)
  359. 408: FINISH_VISCHUNK(o0, f8, f10, g3)
  360. 410: FINISH_VISCHUNK(o0, f10, f12, g3)
  361. 412: FINISH_VISCHUNK(o0, f12, f14, g3)
  362. 414: UNEVEN_VISCHUNK(o0, f14, f0, g3)
  363. 416: FINISH_VISCHUNK(o0, f16, f18, g3)
  364. 418: FINISH_VISCHUNK(o0, f18, f20, g3)
  365. 420: FINISH_VISCHUNK(o0, f20, f22, g3)
  366. 422: FINISH_VISCHUNK(o0, f22, f24, g3)
  367. 424: FINISH_VISCHUNK(o0, f24, f26, g3)
  368. 426: FINISH_VISCHUNK(o0, f26, f28, g3)
  369. 428: FINISH_VISCHUNK(o0, f28, f30, g3)
  370. 430: UNEVEN_VISCHUNK(o0, f30, f0, g3)
  371. 432: FINISH_VISCHUNK(o0, f32, f34, g3)
  372. 434: FINISH_VISCHUNK(o0, f34, f36, g3)
  373. 436: FINISH_VISCHUNK(o0, f36, f38, g3)
  374. 438: FINISH_VISCHUNK(o0, f38, f40, g3)
  375. 440: FINISH_VISCHUNK(o0, f40, f42, g3)
  376. 442: FINISH_VISCHUNK(o0, f42, f44, g3)
  377. 444: FINISH_VISCHUNK(o0, f44, f46, g3)
  378. 446: UNEVEN_VISCHUNK(o0, f46, f0, g3)
  379. 204: ldd [%o1], %f2 /* Load Group */
  380. add %o1, 8, %o1 /* IEU0 */
  381. subcc %g3, 8, %g3 /* IEU1 */
  382. faligndata %f0, %f2, %f8 /* GRU Group */
  383. std %f8, [%o0] /* Store */
  384. bl,pn %xcc, 205f /* CTI */
  385. add %o0, 8, %o0 /* IEU0 Group */
  386. ldd [%o1], %f0 /* Load Group */
  387. add %o1, 8, %o1 /* IEU0 */
  388. subcc %g3, 8, %g3 /* IEU1 */
  389. faligndata %f2, %f0, %f8 /* GRU Group */
  390. std %f8, [%o0] /* Store */
  391. bge,pt %xcc, 204b /* CTI */
  392. add %o0, 8, %o0 /* IEU0 Group */
  393. 205: brz,pt %o2, 207f /* CTI Group */
  394. mov %g1, %o1 /* IEU0 */
  395. 206: ldub [%o1], %g5 /* LOAD */
  396. add %o1, 1, %o1 /* IEU0 */
  397. add %o0, 1, %o0 /* IEU1 */
  398. subcc %o2, 1, %o2 /* IEU1 */
  399. bne,pt %xcc, 206b /* CTI */
  400. stb %g5, [%o0 - 1] /* Store Group */
  401. 207: membar #StoreLoad | #StoreStore /* LSU Group */
  402. wr %g0, FPRS_FEF, %fprs
  403. retl
  404. mov %g4, %o0
  405. 208: andcc %o2, 1, %g0 /* IEU1 Group */
  406. be,pt %icc, 2f+4 /* CTI */
  407. 1: ldub [%o1], %g5 /* LOAD Group */
  408. add %o1, 1, %o1 /* IEU0 */
  409. add %o0, 1, %o0 /* IEU1 */
  410. subcc %o2, 1, %o2 /* IEU1 Group */
  411. be,pn %xcc, 209f /* CTI */
  412. stb %g5, [%o0 - 1] /* Store */
  413. 2: ldub [%o1], %g5 /* LOAD Group */
  414. add %o0, 2, %o0 /* IEU0 */
  415. ldub [%o1 + 1], %o5 /* LOAD Group */
  416. add %o1, 2, %o1 /* IEU0 */
  417. subcc %o2, 2, %o2 /* IEU1 Group */
  418. stb %g5, [%o0 - 2] /* Store */
  419. bne,pt %xcc, 2b /* CTI */
  420. stb %o5, [%o0 - 1] /* Store */
  421. 209: retl
  422. mov %g4, %o0
  423. #ifdef USE_BPR
  424. /* void *__align_cpy_4(void *dest, void *src, size_t n)
  425. * SPARC v9 SYSV ABI
  426. * Like memcpy, but results are undefined if (!n || ((dest | src | n) & 3))
  427. */
  428. .align 32
  429. ENTRY(__align_cpy_4)
  430. mov %o0, %g4 /* IEU0 Group */
  431. cmp %o2, 15 /* IEU1 */
  432. bleu,pn %xcc, 208b /* CTI */
  433. cmp %o2, (64 * 6) /* IEU1 Group */
  434. bgeu,pn %xcc, 200b /* CTI */
  435. andcc %o0, 7, %g2 /* IEU1 Group */
  436. ba,pt %xcc, 216f /* CTI */
  437. andcc %o1, 4, %g0 /* IEU1 Group */
  438. END(__align_cpy_4)
  439. /* void *__align_cpy_8(void *dest, void *src, size_t n)
  440. * SPARC v9 SYSV ABI
  441. * Like memcpy, but results are undefined if (!n || ((dest | src | n) & 7))
  442. */
  443. .align 32
  444. ENTRY(__align_cpy_8)
  445. mov %o0, %g4 /* IEU0 Group */
  446. cmp %o2, 15 /* IEU1 */
  447. bleu,pn %xcc, 208b /* CTI */
  448. cmp %o2, (64 * 6) /* IEU1 Group */
  449. bgeu,pn %xcc, 201b /* CTI */
  450. andcc %o0, 0x38, %g5 /* IEU1 Group */
  451. andcc %o2, -128, %g6 /* IEU1 Group */
  452. bne,a,pt %xcc, 82f + 4 /* CTI */
  453. ldx [%o1], %g1 /* Load */
  454. ba,pt %xcc, 41f /* CTI Group */
  455. andcc %o2, 0x70, %g6 /* IEU1 */
  456. END(__align_cpy_8)
  457. /* void *__align_cpy_16(void *dest, void *src, size_t n)
  458. * SPARC v9 SYSV ABI
  459. * Like memcpy, but results are undefined if (!n || ((dest | src | n) & 15))
  460. */
  461. .align 32
  462. ENTRY(__align_cpy_16)
  463. mov %o0, %g4 /* IEU0 Group */
  464. cmp %o2, (64 * 6) /* IEU1 */
  465. bgeu,pn %xcc, 201b /* CTI */
  466. andcc %o0, 0x38, %g5 /* IEU1 Group */
  467. andcc %o2, -128, %g6 /* IEU1 Group */
  468. bne,a,pt %xcc, 82f + 4 /* CTI */
  469. ldx [%o1], %g1 /* Load */
  470. ba,pt %xcc, 41f /* CTI Group */
  471. andcc %o2, 0x70, %g6 /* IEU1 */
  472. END(__align_cpy_16)
  473. #endif
  474. .align 32
  475. .globl memcpy
  476. .set memcpy,__memcpy
  477. .hidden __memcpy
  478. ENTRY(__memcpy)
  479. 210:
  480. #ifndef USE_BPR
  481. srl %o2, 0, %o2 /* IEU1 Group */
  482. #endif
  483. brz,pn %o2, 209b /* CTI Group */
  484. mov %o0, %g4 /* IEU0 */
  485. 218: cmp %o2, 15 /* IEU1 Group */
  486. bleu,pn %xcc, 208b /* CTI */
  487. cmp %o2, (64 * 6) /* IEU1 Group */
  488. bgeu,pn %xcc, 200b /* CTI */
  489. andcc %o0, 7, %g2 /* IEU1 Group */
  490. sub %o0, %o1, %g5 /* IEU0 */
  491. andcc %g5, 3, %o5 /* IEU1 Group */
  492. bne,pn %xcc, 212f /* CTI */
  493. andcc %o1, 3, %g0 /* IEU1 Group */
  494. be,a,pt %xcc, 216f /* CTI */
  495. andcc %o1, 4, %g0 /* IEU1 Group */
  496. andcc %o1, 1, %g0 /* IEU1 Group */
  497. be,pn %xcc, 4f /* CTI */
  498. andcc %o1, 2, %g0 /* IEU1 Group */
  499. ldub [%o1], %g2 /* Load Group */
  500. add %o1, 1, %o1 /* IEU0 */
  501. add %o0, 1, %o0 /* IEU1 */
  502. sub %o2, 1, %o2 /* IEU0 Group */
  503. bne,pn %xcc, 5f /* CTI Group */
  504. stb %g2, [%o0 - 1] /* Store */
  505. 4: lduh [%o1], %g2 /* Load Group */
  506. add %o1, 2, %o1 /* IEU0 */
  507. add %o0, 2, %o0 /* IEU1 */
  508. sub %o2, 2, %o2 /* IEU0 */
  509. sth %g2, [%o0 - 2] /* Store Group + bubble */
  510. 5: andcc %o1, 4, %g0 /* IEU1 */
  511. 216: be,a,pn %xcc, 2f /* CTI */
  512. andcc %o2, -128, %g6 /* IEU1 Group */
  513. lduw [%o1], %g5 /* Load Group */
  514. add %o1, 4, %o1 /* IEU0 */
  515. add %o0, 4, %o0 /* IEU1 */
  516. sub %o2, 4, %o2 /* IEU0 Group */
  517. stw %g5, [%o0 - 4] /* Store */
  518. andcc %o2, -128, %g6 /* IEU1 Group */
  519. 2: be,pn %xcc, 215f /* CTI */
  520. andcc %o0, 4, %g0 /* IEU1 Group */
  521. be,pn %xcc, 82f + 4 /* CTI Group */
  522. 5: MOVE_BIGCHUNK(o1, o0, 0x00, g1, g3, g5, o5)
  523. MOVE_BIGCHUNK(o1, o0, 0x20, g1, g3, g5, o5)
  524. MOVE_BIGCHUNK(o1, o0, 0x40, g1, g3, g5, o5)
  525. MOVE_BIGCHUNK(o1, o0, 0x60, g1, g3, g5, o5)
  526. 35: subcc %g6, 128, %g6 /* IEU1 Group */
  527. add %o1, 128, %o1 /* IEU0 */
  528. bne,pt %xcc, 5b /* CTI */
  529. add %o0, 128, %o0 /* IEU0 Group */
  530. 215: andcc %o2, 0x70, %g6 /* IEU1 Group */
  531. 41: be,pn %xcc, 80f /* CTI */
  532. andcc %o2, 8, %g0 /* IEU1 Group */
  533. /* Clk1 8-( */
  534. /* Clk2 8-( */
  535. /* Clk3 8-( */
  536. /* Clk4 8-( */
  537. 79: rd %pc, %o5 /* PDU Group */
  538. sll %g6, 1, %g5 /* IEU0 Group */
  539. add %o1, %g6, %o1 /* IEU1 */
  540. sub %o5, %g5, %o5 /* IEU0 Group */
  541. jmpl %o5 + %lo(80f - 79b), %g0 /* CTI Group brk forced*/
  542. add %o0, %g6, %o0 /* IEU0 Group */
  543. 36: MOVE_LASTCHUNK(o1, o0, 0x60, g2, g3, g5, o5)
  544. MOVE_LASTCHUNK(o1, o0, 0x50, g2, g3, g5, o5)
  545. MOVE_LASTCHUNK(o1, o0, 0x40, g2, g3, g5, o5)
  546. MOVE_LASTCHUNK(o1, o0, 0x30, g2, g3, g5, o5)
  547. MOVE_LASTCHUNK(o1, o0, 0x20, g2, g3, g5, o5)
  548. MOVE_LASTCHUNK(o1, o0, 0x10, g2, g3, g5, o5)
  549. MOVE_LASTCHUNK(o1, o0, 0x00, g2, g3, g5, o5)
  550. 80: be,pt %xcc, 81f /* CTI */
  551. andcc %o2, 4, %g0 /* IEU1 */
  552. ldx [%o1], %g2 /* Load Group */
  553. add %o0, 8, %o0 /* IEU0 */
  554. stw %g2, [%o0 - 0x4] /* Store Group */
  555. add %o1, 8, %o1 /* IEU1 */
  556. srlx %g2, 32, %g2 /* IEU0 Group */
  557. stw %g2, [%o0 - 0x8] /* Store */
  558. 81: be,pt %xcc, 1f /* CTI */
  559. andcc %o2, 2, %g0 /* IEU1 Group */
  560. lduw [%o1], %g2 /* Load Group */
  561. add %o1, 4, %o1 /* IEU0 */
  562. stw %g2, [%o0] /* Store Group */
  563. add %o0, 4, %o0 /* IEU0 */
  564. 1: be,pt %xcc, 1f /* CTI */
  565. andcc %o2, 1, %g0 /* IEU1 Group */
  566. lduh [%o1], %g2 /* Load Group */
  567. add %o1, 2, %o1 /* IEU0 */
  568. sth %g2, [%o0] /* Store Group */
  569. add %o0, 2, %o0 /* IEU0 */
  570. 1: be,pt %xcc, 211f /* CTI */
  571. nop /* IEU1 */
  572. ldub [%o1], %g2 /* Load Group */
  573. stb %g2, [%o0] /* Store Group + bubble */
  574. 211: retl
  575. mov %g4, %o0
  576. 82: MOVE_BIGALIGNCHUNK(o1, o0, 0x00, g1, g3, g5, o5)
  577. MOVE_BIGALIGNCHUNK(o1, o0, 0x40, g1, g3, g5, o5)
  578. 37: subcc %g6, 128, %g6 /* IEU1 Group */
  579. add %o1, 128, %o1 /* IEU0 */
  580. bne,pt %xcc, 82b /* CTI */
  581. add %o0, 128, %o0 /* IEU0 Group */
  582. andcc %o2, 0x70, %g6 /* IEU1 */
  583. be,pn %xcc, 84f /* CTI */
  584. andcc %o2, 8, %g0 /* IEU1 Group */
  585. /* Clk1 8-( */
  586. /* Clk2 8-( */
  587. /* Clk3 8-( */
  588. /* Clk4 8-( */
  589. 83: rd %pc, %o5 /* PDU Group */
  590. add %o1, %g6, %o1 /* IEU0 Group */
  591. sub %o5, %g6, %o5 /* IEU1 */
  592. jmpl %o5 + %lo(84f - 83b), %g0 /* CTI Group brk forced*/
  593. add %o0, %g6, %o0 /* IEU0 Group */
  594. 38: MOVE_LASTALIGNCHUNK(o1, o0, 0x60, g2, g3)
  595. MOVE_LASTALIGNCHUNK(o1, o0, 0x50, g2, g3)
  596. MOVE_LASTALIGNCHUNK(o1, o0, 0x40, g2, g3)
  597. MOVE_LASTALIGNCHUNK(o1, o0, 0x30, g2, g3)
  598. MOVE_LASTALIGNCHUNK(o1, o0, 0x20, g2, g3)
  599. MOVE_LASTALIGNCHUNK(o1, o0, 0x10, g2, g3)
  600. MOVE_LASTALIGNCHUNK(o1, o0, 0x00, g2, g3)
  601. 84: be,pt %xcc, 85f /* CTI Group */
  602. andcc %o2, 4, %g0 /* IEU1 */
  603. ldx [%o1], %g2 /* Load Group */
  604. add %o0, 8, %o0 /* IEU0 */
  605. add %o1, 8, %o1 /* IEU0 Group */
  606. stx %g2, [%o0 - 0x8] /* Store */
  607. 85: be,pt %xcc, 1f /* CTI */
  608. andcc %o2, 2, %g0 /* IEU1 Group */
  609. lduw [%o1], %g2 /* Load Group */
  610. add %o0, 4, %o0 /* IEU0 */
  611. add %o1, 4, %o1 /* IEU0 Group */
  612. stw %g2, [%o0 - 0x4] /* Store */
  613. 1: be,pt %xcc, 1f /* CTI */
  614. andcc %o2, 1, %g0 /* IEU1 Group */
  615. lduh [%o1], %g2 /* Load Group */
  616. add %o0, 2, %o0 /* IEU0 */
  617. add %o1, 2, %o1 /* IEU0 Group */
  618. sth %g2, [%o0 - 0x2] /* Store */
  619. 1: be,pt %xcc, 1f /* CTI */
  620. nop /* IEU0 Group */
  621. ldub [%o1], %g2 /* Load Group */
  622. stb %g2, [%o0] /* Store Group + bubble */
  623. 1: retl
  624. mov %g4, %o0
  625. 212: brz,pt %g2, 2f /* CTI Group */
  626. mov 8, %g1 /* IEU0 */
  627. sub %g1, %g2, %g2 /* IEU0 Group */
  628. sub %o2, %g2, %o2 /* IEU0 Group */
  629. 1: ldub [%o1], %g5 /* Load Group */
  630. add %o1, 1, %o1 /* IEU0 */
  631. add %o0, 1, %o0 /* IEU1 */
  632. subcc %g2, 1, %g2 /* IEU1 Group */
  633. bne,pt %xcc, 1b /* CTI */
  634. stb %g5, [%o0 - 1] /* Store */
  635. 2: andn %o2, 7, %g5 /* IEU0 Group */
  636. and %o2, 7, %o2 /* IEU1 */
  637. fmovd %f0, %f2 /* FPU */
  638. alignaddr %o1, %g0, %g1 /* GRU Group */
  639. ldd [%g1], %f4 /* Load Group */
  640. 1: ldd [%g1 + 0x8], %f6 /* Load Group */
  641. add %g1, 0x8, %g1 /* IEU0 Group */
  642. subcc %g5, 8, %g5 /* IEU1 */
  643. faligndata %f4, %f6, %f0 /* GRU Group */
  644. std %f0, [%o0] /* Store */
  645. add %o1, 8, %o1 /* IEU0 Group */
  646. be,pn %xcc, 213f /* CTI */
  647. add %o0, 8, %o0 /* IEU1 */
  648. ldd [%g1 + 0x8], %f4 /* Load Group */
  649. add %g1, 8, %g1 /* IEU0 */
  650. subcc %g5, 8, %g5 /* IEU1 */
  651. faligndata %f6, %f4, %f0 /* GRU Group */
  652. std %f0, [%o0] /* Store */
  653. add %o1, 8, %o1 /* IEU0 */
  654. bne,pn %xcc, 1b /* CTI Group */
  655. add %o0, 8, %o0 /* IEU0 */
  656. 213: brz,pn %o2, 214f /* CTI Group */
  657. nop /* IEU0 */
  658. ldub [%o1], %g5 /* LOAD */
  659. add %o1, 1, %o1 /* IEU0 */
  660. add %o0, 1, %o0 /* IEU1 */
  661. subcc %o2, 1, %o2 /* IEU1 */
  662. bne,pt %xcc, 206b /* CTI */
  663. stb %g5, [%o0 - 1] /* Store Group */
  664. 214: wr %g0, FPRS_FEF, %fprs
  665. retl
  666. mov %g4, %o0
  667. END(__memcpy)
  668. .align 32
  669. 228: andcc %o2, 1, %g0 /* IEU1 Group */
  670. be,pt %icc, 2f+4 /* CTI */
  671. 1: ldub [%o1 - 1], %o5 /* LOAD Group */
  672. sub %o1, 1, %o1 /* IEU0 */
  673. sub %o0, 1, %o0 /* IEU1 */
  674. subcc %o2, 1, %o2 /* IEU1 Group */
  675. be,pn %xcc, 229f /* CTI */
  676. stb %o5, [%o0] /* Store */
  677. 2: ldub [%o1 - 1], %o5 /* LOAD Group */
  678. sub %o0, 2, %o0 /* IEU0 */
  679. ldub [%o1 - 2], %g5 /* LOAD Group */
  680. sub %o1, 2, %o1 /* IEU0 */
  681. subcc %o2, 2, %o2 /* IEU1 Group */
  682. stb %o5, [%o0 + 1] /* Store */
  683. bne,pt %xcc, 2b /* CTI */
  684. stb %g5, [%o0] /* Store */
  685. 229: retl
  686. mov %g4, %o0
  687. 219: retl
  688. nop
  689. .align 32
  690. .globl memmove
  691. .set memmove,__memmove
  692. .hidden __memmove
  693. ENTRY(__memmove)
  694. #ifndef USE_BPR
  695. srl %o2, 0, %o2 /* IEU1 Group */
  696. #endif
  697. brz,pn %o2, 219b /* CTI Group */
  698. sub %o0, %o1, %o4 /* IEU0 */
  699. cmp %o4, %o2 /* IEU1 Group */
  700. bgeu,pt %XCC, 218b /* CTI */
  701. mov %o0, %g4 /* IEU0 */
  702. add %o0, %o2, %o0 /* IEU0 Group */
  703. 220: add %o1, %o2, %o1 /* IEU1 */
  704. cmp %o2, 15 /* IEU1 Group */
  705. bleu,pn %xcc, 228b /* CTI */
  706. andcc %o0, 7, %g2 /* IEU1 Group */
  707. sub %o0, %o1, %g5 /* IEU0 */
  708. andcc %g5, 3, %o5 /* IEU1 Group */
  709. bne,pn %xcc, 232f /* CTI */
  710. andcc %o1, 3, %g0 /* IEU1 Group */
  711. be,a,pt %xcc, 236f /* CTI */
  712. andcc %o1, 4, %g0 /* IEU1 Group */
  713. andcc %o1, 1, %g0 /* IEU1 Group */
  714. be,pn %xcc, 4f /* CTI */
  715. andcc %o1, 2, %g0 /* IEU1 Group */
  716. ldub [%o1 - 1], %g2 /* Load Group */
  717. sub %o1, 1, %o1 /* IEU0 */
  718. sub %o0, 1, %o0 /* IEU1 */
  719. sub %o2, 1, %o2 /* IEU0 Group */
  720. be,pn %xcc, 5f /* CTI Group */
  721. stb %g2, [%o0] /* Store */
  722. 4: lduh [%o1 - 2], %g2 /* Load Group */
  723. sub %o1, 2, %o1 /* IEU0 */
  724. sub %o0, 2, %o0 /* IEU1 */
  725. sub %o2, 2, %o2 /* IEU0 */
  726. sth %g2, [%o0] /* Store Group + bubble */
  727. 5: andcc %o1, 4, %g0 /* IEU1 */
  728. 236: be,a,pn %xcc, 2f /* CTI */
  729. andcc %o2, -128, %g6 /* IEU1 Group */
  730. lduw [%o1 - 4], %g5 /* Load Group */
  731. sub %o1, 4, %o1 /* IEU0 */
  732. sub %o0, 4, %o0 /* IEU1 */
  733. sub %o2, 4, %o2 /* IEU0 Group */
  734. stw %g5, [%o0] /* Store */
  735. andcc %o2, -128, %g6 /* IEU1 Group */
  736. 2: be,pn %xcc, 235f /* CTI */
  737. andcc %o0, 4, %g0 /* IEU1 Group */
  738. be,pn %xcc, 282f + 4 /* CTI Group */
  739. 5: RMOVE_BIGCHUNK(o1, o0, 0x00, g1, g3, g5, o5)
  740. RMOVE_BIGCHUNK(o1, o0, 0x20, g1, g3, g5, o5)
  741. RMOVE_BIGCHUNK(o1, o0, 0x40, g1, g3, g5, o5)
  742. RMOVE_BIGCHUNK(o1, o0, 0x60, g1, g3, g5, o5)
  743. subcc %g6, 128, %g6 /* IEU1 Group */
  744. sub %o1, 128, %o1 /* IEU0 */
  745. bne,pt %xcc, 5b /* CTI */
  746. sub %o0, 128, %o0 /* IEU0 Group */
  747. 235: andcc %o2, 0x70, %g6 /* IEU1 Group */
  748. 41: be,pn %xcc, 280f /* CTI */
  749. andcc %o2, 8, %g0 /* IEU1 Group */
  750. /* Clk1 8-( */
  751. /* Clk2 8-( */
  752. /* Clk3 8-( */
  753. /* Clk4 8-( */
  754. 279: rd %pc, %o5 /* PDU Group */
  755. sll %g6, 1, %g5 /* IEU0 Group */
  756. sub %o1, %g6, %o1 /* IEU1 */
  757. sub %o5, %g5, %o5 /* IEU0 Group */
  758. jmpl %o5 + %lo(280f - 279b), %g0 /* CTI Group brk forced*/
  759. sub %o0, %g6, %o0 /* IEU0 Group */
  760. RMOVE_LASTCHUNK(o1, o0, 0x60, g2, g3, g5, o5)
  761. RMOVE_LASTCHUNK(o1, o0, 0x50, g2, g3, g5, o5)
  762. RMOVE_LASTCHUNK(o1, o0, 0x40, g2, g3, g5, o5)
  763. RMOVE_LASTCHUNK(o1, o0, 0x30, g2, g3, g5, o5)
  764. RMOVE_LASTCHUNK(o1, o0, 0x20, g2, g3, g5, o5)
  765. RMOVE_LASTCHUNK(o1, o0, 0x10, g2, g3, g5, o5)
  766. RMOVE_LASTCHUNK(o1, o0, 0x00, g2, g3, g5, o5)
  767. 280: be,pt %xcc, 281f /* CTI */
  768. andcc %o2, 4, %g0 /* IEU1 */
  769. ldx [%o1 - 8], %g2 /* Load Group */
  770. sub %o0, 8, %o0 /* IEU0 */
  771. stw %g2, [%o0 + 4] /* Store Group */
  772. sub %o1, 8, %o1 /* IEU1 */
  773. srlx %g2, 32, %g2 /* IEU0 Group */
  774. stw %g2, [%o0] /* Store */
  775. 281: be,pt %xcc, 1f /* CTI */
  776. andcc %o2, 2, %g0 /* IEU1 Group */
  777. lduw [%o1 - 4], %g2 /* Load Group */
  778. sub %o1, 4, %o1 /* IEU0 */
  779. stw %g2, [%o0 - 4] /* Store Group */
  780. sub %o0, 4, %o0 /* IEU0 */
  781. 1: be,pt %xcc, 1f /* CTI */
  782. andcc %o2, 1, %g0 /* IEU1 Group */
  783. lduh [%o1 - 2], %g2 /* Load Group */
  784. sub %o1, 2, %o1 /* IEU0 */
  785. sth %g2, [%o0 - 2] /* Store Group */
  786. sub %o0, 2, %o0 /* IEU0 */
  787. 1: be,pt %xcc, 211f /* CTI */
  788. nop /* IEU1 */
  789. ldub [%o1 - 1], %g2 /* Load Group */
  790. stb %g2, [%o0 - 1] /* Store Group + bubble */
  791. 211: retl
  792. mov %g4, %o0
  793. 282: RMOVE_BIGALIGNCHUNK(o1, o0, 0x00, g1, g3, g5, o5)
  794. RMOVE_BIGALIGNCHUNK(o1, o0, 0x40, g1, g3, g5, o5)
  795. subcc %g6, 128, %g6 /* IEU1 Group */
  796. sub %o1, 128, %o1 /* IEU0 */
  797. bne,pt %xcc, 282b /* CTI */
  798. sub %o0, 128, %o0 /* IEU0 Group */
  799. andcc %o2, 0x70, %g6 /* IEU1 */
  800. be,pn %xcc, 284f /* CTI */
  801. andcc %o2, 8, %g0 /* IEU1 Group */
  802. /* Clk1 8-( */
  803. /* Clk2 8-( */
  804. /* Clk3 8-( */
  805. /* Clk4 8-( */
  806. 283: rd %pc, %o5 /* PDU Group */
  807. sub %o1, %g6, %o1 /* IEU0 Group */
  808. sub %o5, %g6, %o5 /* IEU1 */
  809. jmpl %o5 + %lo(284f - 283b), %g0 /* CTI Group brk forced*/
  810. sub %o0, %g6, %o0 /* IEU0 Group */
  811. RMOVE_LASTALIGNCHUNK(o1, o0, 0x60, g2, g3)
  812. RMOVE_LASTALIGNCHUNK(o1, o0, 0x50, g2, g3)
  813. RMOVE_LASTALIGNCHUNK(o1, o0, 0x40, g2, g3)
  814. RMOVE_LASTALIGNCHUNK(o1, o0, 0x30, g2, g3)
  815. RMOVE_LASTALIGNCHUNK(o1, o0, 0x20, g2, g3)
  816. RMOVE_LASTALIGNCHUNK(o1, o0, 0x10, g2, g3)
  817. RMOVE_LASTALIGNCHUNK(o1, o0, 0x00, g2, g3)
  818. 284: be,pt %xcc, 285f /* CTI Group */
  819. andcc %o2, 4, %g0 /* IEU1 */
  820. ldx [%o1 - 8], %g2 /* Load Group */
  821. sub %o0, 8, %o0 /* IEU0 */
  822. sub %o1, 8, %o1 /* IEU0 Group */
  823. stx %g2, [%o0] /* Store */
  824. 285: be,pt %xcc, 1f /* CTI */
  825. andcc %o2, 2, %g0 /* IEU1 Group */
  826. lduw [%o1 - 4], %g2 /* Load Group */
  827. sub %o0, 4, %o0 /* IEU0 */
  828. sub %o1, 4, %o1 /* IEU0 Group */
  829. stw %g2, [%o0] /* Store */
  830. 1: be,pt %xcc, 1f /* CTI */
  831. andcc %o2, 1, %g0 /* IEU1 Group */
  832. lduh [%o1 - 2], %g2 /* Load Group */
  833. sub %o0, 2, %o0 /* IEU0 */
  834. sub %o1, 2, %o1 /* IEU0 Group */
  835. sth %g2, [%o0] /* Store */
  836. 1: be,pt %xcc, 1f /* CTI */
  837. nop /* IEU0 Group */
  838. ldub [%o1 - 1], %g2 /* Load Group */
  839. stb %g2, [%o0 - 1] /* Store Group + bubble */
  840. 1: retl
  841. mov %g4, %o0
  842. 232: brz,pt %g2, 2f /* CTI Group */
  843. sub %o2, %g2, %o2 /* IEU0 Group */
  844. 1: ldub [%o1 - 1], %g5 /* Load Group */
  845. sub %o1, 1, %o1 /* IEU0 */
  846. sub %o0, 1, %o0 /* IEU1 */
  847. subcc %g2, 1, %g2 /* IEU1 Group */
  848. bne,pt %xcc, 1b /* CTI */
  849. stb %g5, [%o0] /* Store */
  850. 2: andn %o2, 7, %g5 /* IEU0 Group */
  851. and %o2, 7, %o2 /* IEU1 */
  852. fmovd %f0, %f2 /* FPU */
  853. alignaddr %o1, %g0, %g1 /* GRU Group */
  854. ldd [%g1], %f4 /* Load Group */
  855. 1: ldd [%g1 - 8], %f6 /* Load Group */
  856. sub %g1, 8, %g1 /* IEU0 Group */
  857. subcc %g5, 8, %g5 /* IEU1 */
  858. faligndata %f6, %f4, %f0 /* GRU Group */
  859. std %f0, [%o0 - 8] /* Store */
  860. sub %o1, 8, %o1 /* IEU0 Group */
  861. be,pn %xcc, 233f /* CTI */
  862. sub %o0, 8, %o0 /* IEU1 */
  863. ldd [%g1 - 8], %f4 /* Load Group */
  864. sub %g1, 8, %g1 /* IEU0 */
  865. subcc %g5, 8, %g5 /* IEU1 */
  866. faligndata %f4, %f6, %f0 /* GRU Group */
  867. std %f0, [%o0 - 8] /* Store */
  868. sub %o1, 8, %o1 /* IEU0 */
  869. bne,pn %xcc, 1b /* CTI Group */
  870. sub %o0, 8, %o0 /* IEU0 */
  871. 233: brz,pn %o2, 234f /* CTI Group */
  872. nop /* IEU0 */
  873. 237: ldub [%o1 - 1], %g5 /* LOAD */
  874. sub %o1, 1, %o1 /* IEU0 */
  875. sub %o0, 1, %o0 /* IEU1 */
  876. subcc %o2, 1, %o2 /* IEU1 */
  877. bne,pt %xcc, 237b /* CTI */
  878. stb %g5, [%o0] /* Store Group */
  879. 234: wr %g0, FPRS_FEF, %fprs
  880. retl
  881. mov %g4, %o0
  882. END(__memmove)
  883. #ifdef USE_BPR
  884. weak_alias (memcpy, __align_cpy_1)
  885. weak_alias (memcpy, __align_cpy_2)
  886. #endif