You can not select more than 25 topics Topics must start with a chinese character,a letter or number, can include dashes ('-') and can be up to 35 characters long.

dtrsm_kernel_RT_8x4_msa.c 26 kB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045
  1. /*******************************************************************************
  2. Copyright (c) 2016, The OpenBLAS Project
  3. All rights reserved.
  4. Redistribution and use in source and binary forms, with or without
  5. modification, are permitted provided that the following conditions are
  6. met:
  7. 1. Redistributions of source code must retain the above copyright
  8. notice, this list of conditions and the following disclaimer.
  9. 2. Redistributions in binary form must reproduce the above copyright
  10. notice, this list of conditions and the following disclaimer in
  11. the documentation and/or other materials provided with the
  12. distribution.
  13. 3. Neither the name of the OpenBLAS project nor the names of
  14. its contributors may be used to endorse or promote products
  15. derived from this software without specific prior written permission.
  16. THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
  17. AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  18. IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  19. ARE DISCLAIMED. IN NO EVENT SHALL THE OPENBLAS PROJECT OR CONTRIBUTORS BE
  20. LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  21. DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
  22. SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
  23. CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
  24. OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE
  25. USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  26. *******************************************************************************/
  27. #include "common.h"
  28. #include "macros_msa.h"
  29. static __attribute__ ((noinline))
  30. void dsolve_8x4_rt_msa(FLOAT *a, FLOAT *b, FLOAT *c, BLASLONG ldc, BLASLONG bk)
  31. {
  32. v2f64 src_c0, src_c1, src_c2, src_c3, src_c4, src_c5, src_c6, src_c7;
  33. v2f64 src_c8, src_c9, src_c10, src_c11, src_c12, src_c13, src_c14, src_c15;
  34. v2f64 src_b0, src_b4, src_b5, src_b8, src_b9, src_b10, src_b12, src_b13;
  35. v2f64 src_b14, src_b15;
  36. FLOAT *c_nxt1line = c + ldc;
  37. FLOAT *c_nxt2line = c + 2 * ldc;
  38. FLOAT *c_nxt3line = c + 3 * ldc;
  39. LD_DP4(c, 2, src_c0, src_c1, src_c2, src_c3);
  40. LD_DP4(c_nxt1line, 2, src_c4, src_c5, src_c6, src_c7);
  41. LD_DP4(c_nxt2line, 2, src_c8, src_c9, src_c10, src_c11);
  42. LD_DP4(c_nxt3line, 2, src_c12, src_c13, src_c14, src_c15);
  43. if (bk > 0)
  44. {
  45. BLASLONG i, pref_offset;
  46. FLOAT *pba = a, *pbb = b, *pa0_pref;
  47. v2f64 src_b, src_b0, src_b1, src_a0, src_a1, src_a2, src_a3;
  48. pref_offset = (uintptr_t)a & (L1_DATA_LINESIZE - 1);
  49. if (pref_offset)
  50. {
  51. pref_offset = L1_DATA_LINESIZE - pref_offset;
  52. pref_offset = pref_offset / sizeof(FLOAT);
  53. }
  54. pa0_pref = a + pref_offset;
  55. for (i = (bk >> 1); i--;)
  56. {
  57. PREF_OFFSET(pa0_pref, 128);
  58. PREF_OFFSET(pa0_pref, 160);
  59. PREF_OFFSET(pa0_pref, 192);
  60. PREF_OFFSET(pa0_pref, 224);
  61. LD_DP4_INC(pba, 2, src_a0, src_a1, src_a2, src_a3);
  62. LD_DP2_INC(pbb, 2, src_b0, src_b1);
  63. src_b = (v2f64) __msa_ilvr_d((v2i64) src_b0, (v2i64) src_b0);
  64. src_c0 -= src_a0 * src_b;
  65. src_c1 -= src_a1 * src_b;
  66. src_c2 -= src_a2 * src_b;
  67. src_c3 -= src_a3 * src_b;
  68. src_b = (v2f64) __msa_ilvl_d((v2i64) src_b0, (v2i64) src_b0);
  69. src_c4 -= src_a0 * src_b;
  70. src_c5 -= src_a1 * src_b;
  71. src_c6 -= src_a2 * src_b;
  72. src_c7 -= src_a3 * src_b;
  73. src_b = (v2f64) __msa_ilvr_d((v2i64) src_b1, (v2i64) src_b1);
  74. src_c8 -= src_a0 * src_b;
  75. src_c9 -= src_a1 * src_b;
  76. src_c10 -= src_a2 * src_b;
  77. src_c11 -= src_a3 * src_b;
  78. src_b = (v2f64) __msa_ilvl_d((v2i64) src_b1, (v2i64) src_b1);
  79. src_c12 -= src_a0 * src_b;
  80. src_c13 -= src_a1 * src_b;
  81. src_c14 -= src_a2 * src_b;
  82. src_c15 -= src_a3 * src_b;
  83. LD_DP4_INC(pba, 2, src_a0, src_a1, src_a2, src_a3);
  84. LD_DP2_INC(pbb, 2, src_b0, src_b1);
  85. src_b = (v2f64) __msa_ilvr_d((v2i64) src_b0, (v2i64) src_b0);
  86. src_c0 -= src_a0 * src_b;
  87. src_c1 -= src_a1 * src_b;
  88. src_c2 -= src_a2 * src_b;
  89. src_c3 -= src_a3 * src_b;
  90. src_b = (v2f64) __msa_ilvl_d((v2i64) src_b0, (v2i64) src_b0);
  91. src_c4 -= src_a0 * src_b;
  92. src_c5 -= src_a1 * src_b;
  93. src_c6 -= src_a2 * src_b;
  94. src_c7 -= src_a3 * src_b;
  95. src_b = (v2f64) __msa_ilvr_d((v2i64) src_b1, (v2i64) src_b1);
  96. src_c8 -= src_a0 * src_b;
  97. src_c9 -= src_a1 * src_b;
  98. src_c10 -= src_a2 * src_b;
  99. src_c11 -= src_a3 * src_b;
  100. src_b = (v2f64) __msa_ilvl_d((v2i64) src_b1, (v2i64) src_b1);
  101. src_c12 -= src_a0 * src_b;
  102. src_c13 -= src_a1 * src_b;
  103. src_c14 -= src_a2 * src_b;
  104. src_c15 -= src_a3 * src_b;
  105. pa0_pref += 16;
  106. }
  107. if (bk & 1)
  108. {
  109. LD_DP4_INC(pba, 2, src_a0, src_a1, src_a2, src_a3);
  110. LD_DP2_INC(pbb, 2, src_b0, src_b1);
  111. src_b = (v2f64) __msa_ilvr_d((v2i64) src_b0, (v2i64) src_b0);
  112. src_c0 -= src_a0 * src_b;
  113. src_c1 -= src_a1 * src_b;
  114. src_c2 -= src_a2 * src_b;
  115. src_c3 -= src_a3 * src_b;
  116. src_b = (v2f64) __msa_ilvl_d((v2i64) src_b0, (v2i64) src_b0);
  117. src_c4 -= src_a0 * src_b;
  118. src_c5 -= src_a1 * src_b;
  119. src_c6 -= src_a2 * src_b;
  120. src_c7 -= src_a3 * src_b;
  121. src_b = (v2f64) __msa_ilvr_d((v2i64) src_b1, (v2i64) src_b1);
  122. src_c8 -= src_a0 * src_b;
  123. src_c9 -= src_a1 * src_b;
  124. src_c10 -= src_a2 * src_b;
  125. src_c11 -= src_a3 * src_b;
  126. src_b = (v2f64) __msa_ilvl_d((v2i64) src_b1, (v2i64) src_b1);
  127. src_c12 -= src_a0 * src_b;
  128. src_c13 -= src_a1 * src_b;
  129. src_c14 -= src_a2 * src_b;
  130. src_c15 -= src_a3 * src_b;
  131. }
  132. }
  133. a -= 32;
  134. b -= 16;
  135. src_b12 = LD_DP(b + 12);
  136. src_b13 = (v2f64) __msa_splati_d((v2i64) src_b12, 1);
  137. src_b12 = (v2f64) __msa_splati_d((v2i64) src_b12, 0);
  138. src_b14 = LD_DP(b + 14);
  139. src_b15 = (v2f64) __msa_splati_d((v2i64) src_b14, 1);
  140. src_b14 = (v2f64) __msa_splati_d((v2i64) src_b14, 0);
  141. src_b8 = LD_DP(b + 8);
  142. src_b9 = (v2f64) __msa_splati_d((v2i64) src_b8, 1);
  143. src_b8 = (v2f64) __msa_splati_d((v2i64) src_b8, 0);
  144. src_b10 = COPY_DOUBLE_TO_VECTOR(*(b + 10));
  145. src_b0 = COPY_DOUBLE_TO_VECTOR(*(b + 0));
  146. src_b4 = LD_DP(b + 4);
  147. src_b5 = (v2f64) __msa_splati_d((v2i64) src_b4, 1);
  148. src_b4 = (v2f64) __msa_splati_d((v2i64) src_b4, 0);
  149. src_c12 *= src_b15;
  150. src_c13 *= src_b15;
  151. src_c14 *= src_b15;
  152. src_c15 *= src_b15;
  153. src_c8 -= src_c12 * src_b14;
  154. src_c9 -= src_c13 * src_b14;
  155. src_c10 -= src_c14 * src_b14;
  156. src_c11 -= src_c15 * src_b14;
  157. src_c8 *= src_b10;
  158. src_c9 *= src_b10;
  159. src_c10 *= src_b10;
  160. src_c11 *= src_b10;
  161. src_c4 -= src_c12 * src_b13;
  162. src_c5 -= src_c13 * src_b13;
  163. src_c6 -= src_c14 * src_b13;
  164. src_c7 -= src_c15 * src_b13;
  165. src_c4 -= src_c8 * src_b9;
  166. src_c5 -= src_c9 * src_b9;
  167. src_c6 -= src_c10 * src_b9;
  168. src_c7 -= src_c11 * src_b9;
  169. src_c4 *= src_b5;
  170. src_c5 *= src_b5;
  171. src_c6 *= src_b5;
  172. src_c7 *= src_b5;
  173. src_c0 -= src_c12 * src_b12;
  174. src_c1 -= src_c13 * src_b12;
  175. src_c2 -= src_c14 * src_b12;
  176. src_c3 -= src_c15 * src_b12;
  177. src_c0 -= src_c8 * src_b8;
  178. src_c1 -= src_c9 * src_b8;
  179. src_c2 -= src_c10 * src_b8;
  180. src_c3 -= src_c11 * src_b8;
  181. src_c0 -= src_c4 * src_b4;
  182. src_c1 -= src_c5 * src_b4;
  183. src_c2 -= src_c6 * src_b4;
  184. src_c3 -= src_c7 * src_b4;
  185. src_c0 *= src_b0;
  186. src_c1 *= src_b0;
  187. src_c2 *= src_b0;
  188. src_c3 *= src_b0;
  189. ST_DP4(src_c12, src_c13, src_c14, src_c15, c_nxt3line, 2);
  190. ST_DP4(src_c12, src_c13, src_c14, src_c15, a + 24, 2);
  191. ST_DP4(src_c8, src_c9, src_c10, src_c11, c_nxt2line, 2);
  192. ST_DP4(src_c8, src_c9, src_c10, src_c11, a + 16, 2);
  193. ST_DP4(src_c4, src_c5, src_c6, src_c7, c_nxt1line, 2);
  194. ST_DP4(src_c4, src_c5, src_c6, src_c7, a + 8, 2);
  195. ST_DP4(src_c0, src_c1, src_c2, src_c3, c, 2);
  196. ST_DP4(src_c0, src_c1, src_c2, src_c3, a, 2);
  197. }
  198. static void dsolve_8x2_rt_msa(FLOAT *a, FLOAT *b, FLOAT *c, BLASLONG ldc, BLASLONG bk)
  199. {
  200. v2f64 src_c0, src_c1, src_c2, src_c3, src_c4, src_c5, src_c6, src_c7;
  201. v2f64 src_b0, src_b2, src_b3;
  202. LD_DP4(c, 2, src_c0, src_c1, src_c2, src_c3);
  203. LD_DP4(c + ldc, 2, src_c4, src_c5, src_c6, src_c7);
  204. if (bk > 0)
  205. {
  206. BLASLONG i;
  207. FLOAT *pba = a, *pbb = b;
  208. v2f64 src_b, src_b1, src_a0, src_a1, src_a2, src_a3;
  209. v2f64 src_a4, src_a5, src_a6, src_a7;
  210. LD_DP4(pba, 2, src_a0, src_a1, src_a2, src_a3);
  211. src_b0 = LD_DP(pbb);
  212. for (i = bk - 1; i--;)
  213. {
  214. pba += 8;
  215. pbb += 2;
  216. LD_DP4(pba, 2, src_a4, src_a5, src_a6, src_a7);
  217. src_b1 = LD_DP(pbb);
  218. src_b = (v2f64) __msa_ilvr_d((v2i64) src_b0, (v2i64) src_b0);
  219. src_c0 -= src_a0 * src_b;
  220. src_c1 -= src_a1 * src_b;
  221. src_c2 -= src_a2 * src_b;
  222. src_c3 -= src_a3 * src_b;
  223. src_b = (v2f64) __msa_ilvl_d((v2i64) src_b0, (v2i64) src_b0);
  224. src_c4 -= src_a0 * src_b;
  225. src_c5 -= src_a1 * src_b;
  226. src_c6 -= src_a2 * src_b;
  227. src_c7 -= src_a3 * src_b;
  228. src_a0 = src_a4;
  229. src_a1 = src_a5;
  230. src_a2 = src_a6;
  231. src_a3 = src_a7;
  232. src_b0 = src_b1;
  233. }
  234. src_b = (v2f64) __msa_ilvr_d((v2i64) src_b0, (v2i64) src_b0);
  235. src_c0 -= src_a0 * src_b;
  236. src_c1 -= src_a1 * src_b;
  237. src_c2 -= src_a2 * src_b;
  238. src_c3 -= src_a3 * src_b;
  239. src_b = (v2f64) __msa_ilvl_d((v2i64) src_b0, (v2i64) src_b0);
  240. src_c4 -= src_a0 * src_b;
  241. src_c5 -= src_a1 * src_b;
  242. src_c6 -= src_a2 * src_b;
  243. src_c7 -= src_a3 * src_b;
  244. }
  245. a -= 16;
  246. b -= 4;
  247. src_b0 = COPY_DOUBLE_TO_VECTOR(*(b + 0));
  248. src_b2 = LD_DP(b + 2);
  249. src_b3 = (v2f64) __msa_splati_d((v2i64) src_b2, 1);
  250. src_b2 = (v2f64) __msa_splati_d((v2i64) src_b2, 0);
  251. src_c4 *= src_b3;
  252. src_c5 *= src_b3;
  253. src_c6 *= src_b3;
  254. src_c7 *= src_b3;
  255. src_c0 -= src_c4 * src_b2;
  256. src_c1 -= src_c5 * src_b2;
  257. src_c2 -= src_c6 * src_b2;
  258. src_c3 -= src_c7 * src_b2;
  259. src_c0 *= src_b0;
  260. src_c1 *= src_b0;
  261. src_c2 *= src_b0;
  262. src_c3 *= src_b0;
  263. ST_DP4(src_c0, src_c1, src_c2, src_c3, c, 2);
  264. ST_DP4(src_c4, src_c5, src_c6, src_c7, c + ldc, 2);
  265. ST_DP4(src_c0, src_c1, src_c2, src_c3, a, 2);
  266. ST_DP4(src_c4, src_c5, src_c6, src_c7, a + 8, 2);
  267. }
  268. static void dsolve_8x1_rt_msa(FLOAT *a, FLOAT *b, FLOAT *c, BLASLONG bk)
  269. {
  270. v2f64 src_c0, src_c1, src_c2, src_c3;
  271. v2f64 src_b0;
  272. LD_DP4(c, 2, src_c0, src_c1, src_c2, src_c3);
  273. if (bk > 0)
  274. {
  275. BLASLONG i;
  276. FLOAT *aa = a, *bb = b;
  277. v2f64 src_a0, src_a1, src_a2, src_a3, src_a4, src_a5, src_a6, src_a7;
  278. v2f64 src_b1;
  279. LD_DP4(aa, 2, src_a0, src_a1, src_a2, src_a3);
  280. src_b0 = LD_DP(bb);
  281. aa += 8;
  282. bb += 1;
  283. for (i = (bk - 1); i--;)
  284. {
  285. LD_DP4(aa, 2, src_a4, src_a5, src_a6, src_a7);
  286. src_b1 = LD_DP(bb);
  287. src_b0 = (v2f64) __msa_ilvr_d((v2i64) src_b0, (v2i64) src_b0);
  288. src_c0 -= src_a0 * src_b0;
  289. src_c1 -= src_a1 * src_b0;
  290. src_c2 -= src_a2 * src_b0;
  291. src_c3 -= src_a3 * src_b0;
  292. src_a0 = src_a4;
  293. src_a1 = src_a5;
  294. src_a2 = src_a6;
  295. src_a3 = src_a7;
  296. src_b0 = src_b1;
  297. aa += 8;
  298. bb += 1;
  299. }
  300. src_b0 = (v2f64) __msa_ilvr_d((v2i64) src_b0, (v2i64) src_b0);
  301. src_c0 -= src_a0 * src_b0;
  302. src_c1 -= src_a1 * src_b0;
  303. src_c2 -= src_a2 * src_b0;
  304. src_c3 -= src_a3 * src_b0;
  305. }
  306. a -= 8;
  307. b -= 1;
  308. src_b0 = COPY_DOUBLE_TO_VECTOR(*b);
  309. src_c0 *= src_b0;
  310. src_c1 *= src_b0;
  311. src_c2 *= src_b0;
  312. src_c3 *= src_b0;
  313. ST_DP4(src_c0, src_c1, src_c2, src_c3, c, 2);
  314. ST_DP4(src_c0, src_c1, src_c2, src_c3, a, 2);
  315. }
  316. static void dsolve_4x4_rt_msa(FLOAT *a, FLOAT *b, FLOAT *c, BLASLONG ldc, BLASLONG bk)
  317. {
  318. v2f64 src_c0, src_c1, src_c2, src_c3, src_c4, src_c5, src_c6, src_c7;
  319. v2f64 src_b0, src_b4, src_b5, src_b8, src_b9, src_b10, src_b12, src_b13;
  320. v2f64 src_b14, src_b15;
  321. LD_DP2(c, 2, src_c0, src_c1);
  322. LD_DP2(c + ldc, 2, src_c2, src_c3);
  323. LD_DP2(c + 2 * ldc, 2, src_c4, src_c5);
  324. LD_DP2(c + 3 * ldc, 2, src_c6, src_c7);
  325. if (bk > 0)
  326. {
  327. BLASLONG i;
  328. FLOAT *aa = a, *bb = b;
  329. v2f64 src_a0, src_a1, src_b, src_b0, src_b1;
  330. for (i = bk; i--;)
  331. {
  332. LD_DP2(aa, 2, src_a0, src_a1);
  333. LD_DP2(bb, 2, src_b0, src_b1);
  334. src_b = (v2f64) __msa_ilvr_d((v2i64) src_b0, (v2i64) src_b0);
  335. src_c0 -= src_a0 * src_b;
  336. src_c1 -= src_a1 * src_b;
  337. src_b = (v2f64) __msa_ilvl_d((v2i64) src_b0, (v2i64) src_b0);
  338. src_c2 -= src_a0 * src_b;
  339. src_c3 -= src_a1 * src_b;
  340. src_b = (v2f64) __msa_ilvr_d((v2i64) src_b1, (v2i64) src_b1);
  341. src_c4 -= src_a0 * src_b;
  342. src_c5 -= src_a1 * src_b;
  343. src_b = (v2f64) __msa_ilvl_d((v2i64) src_b1, (v2i64) src_b1);
  344. src_c6 -= src_a0 * src_b;
  345. src_c7 -= src_a1 * src_b;
  346. aa += 4;
  347. bb += 4;
  348. }
  349. }
  350. a -= 16;
  351. b -= 16;
  352. src_b12 = LD_DP(b + 12);
  353. src_b13 = (v2f64) __msa_splati_d((v2i64) src_b12, 1);
  354. src_b12 = (v2f64) __msa_splati_d((v2i64) src_b12, 0);
  355. src_b14 = LD_DP(b + 14);
  356. src_b15 = (v2f64) __msa_splati_d((v2i64) src_b14, 1);
  357. src_b14 = (v2f64) __msa_splati_d((v2i64) src_b14, 0);
  358. src_b8 = LD_DP(b + 8);
  359. src_b9 = (v2f64) __msa_splati_d((v2i64) src_b8, 1);
  360. src_b8 = (v2f64) __msa_splati_d((v2i64) src_b8, 0);
  361. src_b10 = COPY_DOUBLE_TO_VECTOR(*(b + 10));
  362. src_b0 = COPY_DOUBLE_TO_VECTOR(*(b + 0));
  363. src_b4 = LD_DP(b + 4);
  364. src_b5 = (v2f64) __msa_splati_d((v2i64) src_b4, 1);
  365. src_b4 = (v2f64) __msa_splati_d((v2i64) src_b4, 0);
  366. src_c6 *= src_b15;
  367. src_c7 *= src_b15;
  368. src_c4 -= src_c6 * src_b14;
  369. src_c5 -= src_c7 * src_b14;
  370. src_c4 *= src_b10;
  371. src_c5 *= src_b10;
  372. src_c2 -= src_c6 * src_b13;
  373. src_c3 -= src_c7 * src_b13;
  374. src_c2 -= src_c4 * src_b9;
  375. src_c3 -= src_c5 * src_b9;
  376. src_c2 *= src_b5;
  377. src_c3 *= src_b5;
  378. src_c0 -= src_c6 * src_b12;
  379. src_c1 -= src_c7 * src_b12;
  380. src_c0 -= src_c4 * src_b8;
  381. src_c1 -= src_c5 * src_b8;
  382. src_c0 -= src_c2 * src_b4;
  383. src_c1 -= src_c3 * src_b4;
  384. src_c0 *= src_b0;
  385. src_c1 *= src_b0;
  386. ST_DP2(src_c6, src_c7, c + 3 * ldc, 2);
  387. ST_DP2(src_c4, src_c5, c + 2 * ldc, 2);
  388. ST_DP2(src_c2, src_c3, c + ldc, 2);
  389. ST_DP2(src_c0, src_c1, c, 2);
  390. ST_DP4(src_c4, src_c5, src_c6, src_c7, a + 8, 2);
  391. ST_DP4(src_c0, src_c1, src_c2, src_c3, a, 2);
  392. }
  393. static void dsolve_4x2_rt_msa(FLOAT *a, FLOAT *b, FLOAT *c, BLASLONG ldc, BLASLONG bk)
  394. {
  395. v2f64 src_c0, src_c1, src_c2, src_c3, src_b0, src_b2, src_b3;
  396. LD_DP2(c, 2, src_c0, src_c1);
  397. LD_DP2(c + ldc, 2, src_c2, src_c3);
  398. if (bk > 0)
  399. {
  400. BLASLONG i;
  401. FLOAT *aa = a, *bb = b;
  402. v2f64 src_a0, src_a1, src_b, src_b0;
  403. for (i = bk; i--;)
  404. {
  405. LD_DP2(aa, 2, src_a0, src_a1);
  406. src_b0 = LD_DP(bb);
  407. src_b = (v2f64) __msa_ilvr_d((v2i64) src_b0, (v2i64) src_b0);
  408. src_c0 -= src_a0 * src_b;
  409. src_c1 -= src_a1 * src_b;
  410. src_b = (v2f64) __msa_ilvl_d((v2i64) src_b0, (v2i64) src_b0);
  411. src_c2 -= src_a0 * src_b;
  412. src_c3 -= src_a1 * src_b;
  413. aa += 4;
  414. bb += 2;
  415. }
  416. }
  417. a -= 8;
  418. b -= 4;
  419. src_b0 = COPY_DOUBLE_TO_VECTOR(*(b + 0));
  420. src_b2 = LD_DP(b + 2);
  421. src_b3 = (v2f64) __msa_splati_d((v2i64) src_b2, 1);
  422. src_b2 = (v2f64) __msa_splati_d((v2i64) src_b2, 0);
  423. src_c2 *= src_b3;
  424. src_c3 *= src_b3;
  425. src_c0 -= src_c2 * src_b2;
  426. src_c1 -= src_c3 * src_b2;
  427. src_c0 *= src_b0;
  428. src_c1 *= src_b0;
  429. ST_DP2(src_c0, src_c1, c, 2);
  430. ST_DP2(src_c2, src_c3, c + ldc, 2);
  431. ST_DP4(src_c0, src_c1, src_c2, src_c3, a, 2);
  432. }
  433. static void dsolve_4x1_rt_msa(FLOAT *a, FLOAT *b, FLOAT *c, BLASLONG bk)
  434. {
  435. FLOAT b0, c0, c1, c2, c3;
  436. c0 = *(c + 0);
  437. c1 = *(c + 1);
  438. c2 = *(c + 2);
  439. c3 = *(c + 3);
  440. if (bk > 0)
  441. {
  442. BLASLONG i;
  443. FLOAT *aa = a, *bb = b;
  444. for (i = bk; i--;)
  445. {
  446. c0 -= aa[0] * bb[0];
  447. c1 -= aa[1] * bb[0];
  448. c2 -= aa[2] * bb[0];
  449. c3 -= aa[3] * bb[0];
  450. aa += 4;
  451. bb += 1;
  452. }
  453. }
  454. a -= 4;
  455. b0 = *(b - 1);
  456. c0 *= b0;
  457. c1 *= b0;
  458. c2 *= b0;
  459. c3 *= b0;
  460. *(a + 0) = c0;
  461. *(a + 1) = c1;
  462. *(a + 2) = c2;
  463. *(a + 3) = c3;
  464. *(c + 0) = c0;
  465. *(c + 1) = c1;
  466. *(c + 2) = c2;
  467. *(c + 3) = c3;
  468. }
  469. static void dsolve_2x4_rt_msa(FLOAT *a, FLOAT *b, FLOAT *c, BLASLONG ldc, BLASLONG bk)
  470. {
  471. FLOAT b0, b4, b5, b8, b9, b10, b12, b13, b14, b15;
  472. FLOAT c0, c1, c0_nxt1, c1_nxt1, c0_nxt2, c1_nxt2, c0_nxt3, c1_nxt3;
  473. c0 = *(c + 0);
  474. c1 = *(c + 1);
  475. c0_nxt1 = *(c + 0 + 1 * ldc);
  476. c1_nxt1 = *(c + 1 + 1 * ldc);
  477. c0_nxt2 = *(c + 0 + 2 * ldc);
  478. c1_nxt2 = *(c + 1 + 2 * ldc);
  479. c0_nxt3 = *(c + 0 + 3 * ldc);
  480. c1_nxt3 = *(c + 1 + 3 * ldc);
  481. if (bk > 0)
  482. {
  483. BLASLONG i;
  484. FLOAT *aa = a, *bb = b;
  485. for (i = bk; i--;)
  486. {
  487. c0 -= aa[0] * bb[0];
  488. c1 -= aa[1] * bb[0];
  489. c0_nxt1 -= aa[0] * bb[1];
  490. c1_nxt1 -= aa[1] * bb[1];
  491. c0_nxt2 -= aa[0] * bb[2];
  492. c1_nxt2 -= aa[1] * bb[2];
  493. c0_nxt3 -= aa[0] * bb[3];
  494. c1_nxt3 -= aa[1] * bb[3];
  495. aa += 2;
  496. bb += 4;
  497. }
  498. }
  499. a -= 8;
  500. b -= 16;
  501. b0 = *b;
  502. b4 = *(b + 4);
  503. b5 = *(b + 5);
  504. b8 = *(b + 8);
  505. b9 = *(b + 9);
  506. b10 = *(b + 10);
  507. b12 = *(b + 12);
  508. b13 = *(b + 13);
  509. b14 = *(b + 14);
  510. b15 = *(b + 15);
  511. c0_nxt3 *= b15;
  512. c1_nxt3 *= b15;
  513. c0_nxt2 -= c0_nxt3 * b14;
  514. c1_nxt2 -= c1_nxt3 * b14;
  515. c0_nxt2 *= b10;
  516. c1_nxt2 *= b10;
  517. c0_nxt1 -= c0_nxt3 * b13;
  518. c1_nxt1 -= c1_nxt3 * b13;
  519. c0_nxt1 -= c0_nxt2 * b9;
  520. c1_nxt1 -= c1_nxt2 * b9;
  521. c0_nxt1 *= b5;
  522. c1_nxt1 *= b5;
  523. c0 -= c0_nxt3 * b12;
  524. c1 -= c1_nxt3 * b12;
  525. c0 -= c0_nxt2 * b8;
  526. c1 -= c1_nxt2 * b8;
  527. c0 -= c0_nxt1 * b4;
  528. c1 -= c1_nxt1 * b4;
  529. c0 *= b0;
  530. c1 *= b0;
  531. *(a + 0) = c0;
  532. *(a + 1) = c1;
  533. *(a + 2) = c0_nxt1;
  534. *(a + 3) = c1_nxt1;
  535. *(a + 4) = c0_nxt2;
  536. *(a + 5) = c1_nxt2;
  537. *(a + 6) = c0_nxt3;
  538. *(a + 7) = c1_nxt3;
  539. *(c + 0) = c0;
  540. *(c + 1) = c1;
  541. *(c + 0 + 1 * ldc) = c0_nxt1;
  542. *(c + 1 + 1 * ldc) = c1_nxt1;
  543. *(c + 0 + 2 * ldc) = c0_nxt2;
  544. *(c + 1 + 2 * ldc) = c1_nxt2;
  545. *(c + 0 + 3 * ldc) = c0_nxt3;
  546. *(c + 1 + 3 * ldc) = c1_nxt3;
  547. }
  548. static void dsolve_2x2_rt_msa(FLOAT *a, FLOAT *b, FLOAT *c, BLASLONG ldc, BLASLONG bk)
  549. {
  550. FLOAT b0, b2, b3, c0, c1, c0_nxt, c1_nxt;
  551. c0 = *(c + 0);
  552. c1 = *(c + 1);
  553. c0_nxt = *(c + 0 + ldc);
  554. c1_nxt = *(c + 1 + ldc);
  555. if (bk > 0)
  556. {
  557. BLASLONG i;
  558. FLOAT *aa = a, *bb = b;
  559. for (i = bk; i--;)
  560. {
  561. c0 -= aa[0] * bb[0];
  562. c1 -= aa[1] * bb[0];
  563. c0_nxt -= aa[0] * bb[1];
  564. c1_nxt -= aa[1] * bb[1];
  565. aa += 2;
  566. bb += 2;
  567. }
  568. }
  569. a -= 4;
  570. b -= 4;
  571. b3 = *(b + 3);
  572. b2 = *(b + 2);
  573. b0 = *b;
  574. c0_nxt *= b3;
  575. c1_nxt *= b3;
  576. c0 -= c0_nxt * b2;
  577. c0 *= b0;
  578. c1 -= c1_nxt * b2;
  579. c1 *= b0;
  580. *(a + 0) = c0;
  581. *(a + 1) = c1;
  582. *(a + 2) = c0_nxt;
  583. *(a + 3) = c1_nxt;
  584. *(c + 0) = c0;
  585. *(c + 1) = c1;
  586. *(c + 0 + ldc) = c0_nxt;
  587. *(c + 1 + ldc) = c1_nxt;
  588. }
  589. static void dsolve_2x1_rt_msa(FLOAT *a, FLOAT *b, FLOAT *c, BLASLONG bk)
  590. {
  591. FLOAT b0, c0, c1;
  592. c0 = *(c + 0);
  593. c1 = *(c + 1);
  594. if (bk > 0)
  595. {
  596. BLASLONG i;
  597. FLOAT *aa = a, *bb = b;
  598. for (i = bk; i--;)
  599. {
  600. c0 -= aa[0] * bb[0];
  601. c1 -= aa[1] * bb[0];
  602. aa += 2;
  603. bb += 1;
  604. }
  605. }
  606. b0 = *(b - 1);
  607. c0 *= b0;
  608. c1 *= b0;
  609. *(a - 2) = c0;
  610. *(a - 1) = c1;
  611. *(c + 0) = c0;
  612. *(c + 1) = c1;
  613. }
  614. static void dsolve_1x4_rt_msa(FLOAT *a, FLOAT *b, FLOAT *c, BLASLONG ldc, BLASLONG bk)
  615. {
  616. FLOAT b0, b4, b5, b8, b9, b10, b12, b13, b14, b15, c0, c1, c2, c3;
  617. c0 = *(c + 0);
  618. c1 = *(c + 1 * ldc);
  619. c2 = *(c + 2 * ldc);
  620. c3 = *(c + 3 * ldc);
  621. if (bk > 0)
  622. {
  623. BLASLONG i;
  624. FLOAT *aa = a, *bb = b;
  625. for (i = bk; i--;)
  626. {
  627. c0 -= aa[0] * bb[0];
  628. c1 -= aa[0] * bb[1];
  629. c2 -= aa[0] * bb[2];
  630. c3 -= aa[0] * bb[3];
  631. aa += 1;
  632. bb += 4;
  633. }
  634. }
  635. a -= 4;
  636. b -= 16;
  637. b0 = *b;
  638. b4 = *(b + 4);
  639. b5 = *(b + 5);
  640. b8 = *(b + 8);
  641. b9 = *(b + 9);
  642. b10 = *(b + 10);
  643. b12 = *(b + 12);
  644. b13 = *(b + 13);
  645. b14 = *(b + 14);
  646. b15 = *(b + 15);
  647. c3 *= b15;
  648. c2 -= c3 * b14;
  649. c2 *= b10;
  650. c1 -= c3 * b13;
  651. c1 -= c2 * b9;
  652. c1 *= b5;
  653. c0 -= c3 * b12;
  654. c0 -= c2 * b8;
  655. c0 -= c1 * b4;
  656. c0 *= b0;
  657. *(a + 0) = c0;
  658. *(a + 1) = c1;
  659. *(a + 2) = c2;
  660. *(a + 3) = c3;
  661. *(c + 0 * ldc) = c0;
  662. *(c + 1 * ldc) = c1;
  663. *(c + 2 * ldc) = c2;
  664. *(c + 3 * ldc) = c3;
  665. }
  666. static void dsolve_1x2_rt_msa(FLOAT *a, FLOAT *b, FLOAT *c, BLASLONG ldc, BLASLONG bk)
  667. {
  668. FLOAT b0, b2, b3, c0, c1;
  669. c0 = *(c + 0);
  670. c1 = *(c + ldc);
  671. if (bk > 0)
  672. {
  673. BLASLONG i;
  674. FLOAT *aa = a, *bb = b;
  675. for (i = bk; i--;)
  676. {
  677. c0 -= *aa * bb[0];
  678. c1 -= *aa * bb[1];
  679. aa += 1;
  680. bb += 2;
  681. }
  682. }
  683. a -= 2;
  684. b -= 4;
  685. b3 = *(b + 3);
  686. b2 = *(b + 2);
  687. b0 = *b;
  688. c1 *= b3;
  689. c0 -= c1 * b2;
  690. c0 *= b0;
  691. *(a + 0) = c0;
  692. *(a + 1) = c1;
  693. *(c + 0) = c0;
  694. *(c + ldc) = c1;
  695. }
  696. static void dsolve_1x1_rt_msa(FLOAT *a, FLOAT *b, FLOAT *c, BLASLONG bk)
  697. {
  698. if (bk > 0)
  699. {
  700. BLASLONG i;
  701. for (i = 0; i < bk; i++)
  702. {
  703. *c -= a[i] * b[i];
  704. }
  705. }
  706. *c *= *(b - 1);
  707. *(a - 1) = *c;
  708. }
  709. int CNAME(BLASLONG m, BLASLONG n, BLASLONG k, FLOAT dummy1, FLOAT *a, FLOAT *b,
  710. FLOAT *c, BLASLONG ldc, BLASLONG offset)
  711. {
  712. BLASLONG i, j, kk;
  713. FLOAT *aa, *cc, *bb;
  714. kk = n - offset;
  715. c += n * ldc;
  716. b += n * k;
  717. if (n & 3)
  718. {
  719. if (n & 1)
  720. {
  721. aa = a;
  722. c -= ldc;
  723. b -= k;
  724. bb = b + kk;
  725. cc = c;
  726. for (i = (m >> 3); i--;)
  727. {
  728. dsolve_8x1_rt_msa(aa + 8 * kk, bb, cc, (k - kk));
  729. aa += 8 * k;
  730. cc += 8;
  731. }
  732. if (m & 7)
  733. {
  734. if (m & 4)
  735. {
  736. dsolve_4x1_rt_msa(aa + 4 * kk, bb, cc, (k - kk));
  737. aa += 4 * k;
  738. cc += 4;
  739. }
  740. if (m & 2)
  741. {
  742. dsolve_2x1_rt_msa(aa + 2 * kk, bb, cc, (k - kk));
  743. aa += 2 * k;
  744. cc += 2;
  745. }
  746. if (m & 1)
  747. {
  748. dsolve_1x1_rt_msa(aa + kk, bb, cc, (k - kk));
  749. aa += k;
  750. cc += 1;
  751. }
  752. }
  753. kk -= 1;
  754. }
  755. if (n & 2)
  756. {
  757. aa = a;
  758. c -= 2 * ldc;
  759. b -= 2 * k;
  760. bb = b + 2 * kk;
  761. cc = c;
  762. for (i = (m >> 3); i--;)
  763. {
  764. dsolve_8x2_rt_msa(aa + 8 * kk, bb, cc, ldc, (k - kk));
  765. aa += 8 * k;
  766. cc += 8;
  767. }
  768. if (m & 7)
  769. {
  770. if (m & 4)
  771. {
  772. dsolve_4x2_rt_msa(aa + 4 * kk, bb, cc, ldc, (k - kk));
  773. aa += 4 * k;
  774. cc += 4;
  775. }
  776. if (m & 2)
  777. {
  778. dsolve_2x2_rt_msa(aa + 2 * kk, bb, cc, ldc, (k - kk));
  779. aa += 2 * k;
  780. cc += 2;
  781. }
  782. if (m & 1)
  783. {
  784. dsolve_1x2_rt_msa(aa + kk, bb, cc, ldc, (k - kk));
  785. aa += k;
  786. cc += 1;
  787. }
  788. }
  789. kk -= 2;
  790. }
  791. }
  792. for (j = (n >> 2); j--;)
  793. {
  794. aa = a;
  795. b -= 4 * k;
  796. bb = b + 4 * kk;
  797. c -= 4 * ldc;
  798. cc = c;
  799. for (i = (m >> 3); i--;)
  800. {
  801. dsolve_8x4_rt_msa(aa + kk * 8, bb, cc, ldc, (k - kk));
  802. aa += 8 * k;
  803. cc += 8;
  804. }
  805. if (m & 7)
  806. {
  807. if (m & 4)
  808. {
  809. dsolve_4x4_rt_msa(aa + kk * 4, bb, cc, ldc, (k - kk));
  810. aa += 4 * k;
  811. cc += 4;
  812. }
  813. if (m & 2)
  814. {
  815. dsolve_2x4_rt_msa(aa + kk * 2, bb, cc, ldc, (k - kk));
  816. aa += 2 * k;
  817. cc += 2;
  818. }
  819. if (m & 1)
  820. {
  821. dsolve_1x4_rt_msa(aa + kk, bb, cc, ldc, (k - kk));
  822. aa += k;
  823. cc += 1;
  824. }
  825. }
  826. kk -= 4;
  827. }
  828. return 0;
  829. }