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 25 kB

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