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.

trmm_uncopy_16.c 32 kB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543
  1. /*********************************************************************/
  2. /* Copyright 2009, 2010 The University of Texas at Austin. */
  3. /* All rights reserved. */
  4. /* */
  5. /* Redistribution and use in source and binary forms, with or */
  6. /* without modification, are permitted provided that the following */
  7. /* conditions are met: */
  8. /* */
  9. /* 1. Redistributions of source code must retain the above */
  10. /* copyright notice, this list of conditions and the following */
  11. /* disclaimer. */
  12. /* */
  13. /* 2. Redistributions in binary form must reproduce the above */
  14. /* copyright notice, this list of conditions and the following */
  15. /* disclaimer in the documentation and/or other materials */
  16. /* provided with the distribution. */
  17. /* */
  18. /* THIS SOFTWARE IS PROVIDED BY THE UNIVERSITY OF TEXAS AT */
  19. /* AUSTIN ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, */
  20. /* INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF */
  21. /* MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE */
  22. /* DISCLAIMED. IN NO EVENT SHALL THE UNIVERSITY OF TEXAS AT */
  23. /* AUSTIN OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, */
  24. /* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES */
  25. /* (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE */
  26. /* GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR */
  27. /* BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF */
  28. /* LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT */
  29. /* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT */
  30. /* OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE */
  31. /* POSSIBILITY OF SUCH DAMAGE. */
  32. /* */
  33. /* The views and conclusions contained in the software and */
  34. /* documentation are those of the authors and should not be */
  35. /* interpreted as representing official policies, either expressed */
  36. /* or implied, of The University of Texas at Austin. */
  37. /*********************************************************************/
  38. #include <stdio.h>
  39. #include "common.h"
  40. int CNAME(BLASLONG m, BLASLONG n, FLOAT *a, BLASLONG lda, BLASLONG posX, BLASLONG posY, FLOAT *b){
  41. BLASLONG i, js;
  42. BLASLONG X, ii;
  43. FLOAT *a01, *a02, *a03 ,*a04, *a05, *a06, *a07, *a08;
  44. FLOAT *a09, *a10, *a11, *a12, *a13, *a14, *a15, *a16;
  45. js = (n >> 4);
  46. if (js > 0){
  47. do {
  48. X = posX;
  49. if (posX <= posY) {
  50. a01 = a + posX + (posY + 0) * lda;
  51. a02 = a + posX + (posY + 1) * lda;
  52. a03 = a + posX + (posY + 2) * lda;
  53. a04 = a + posX + (posY + 3) * lda;
  54. a05 = a + posX + (posY + 4) * lda;
  55. a06 = a + posX + (posY + 5) * lda;
  56. a07 = a + posX + (posY + 6) * lda;
  57. a08 = a + posX + (posY + 7) * lda;
  58. a09 = a + posX + (posY + 8) * lda;
  59. a10 = a + posX + (posY + 9) * lda;
  60. a11 = a + posX + (posY + 10) * lda;
  61. a12 = a + posX + (posY + 11) * lda;
  62. a13 = a + posX + (posY + 12) * lda;
  63. a14 = a + posX + (posY + 13) * lda;
  64. a15 = a + posX + (posY + 14) * lda;
  65. a16 = a + posX + (posY + 15) * lda;
  66. } else {
  67. a01 = a + posY + (posX + 0) * lda;
  68. a02 = a + posY + (posX + 1) * lda;
  69. a03 = a + posY + (posX + 2) * lda;
  70. a04 = a + posY + (posX + 3) * lda;
  71. a05 = a + posY + (posX + 4) * lda;
  72. a06 = a + posY + (posX + 5) * lda;
  73. a07 = a + posY + (posX + 6) * lda;
  74. a08 = a + posY + (posX + 7) * lda;
  75. a09 = a + posY + (posX + 8) * lda;
  76. a10 = a + posY + (posX + 9) * lda;
  77. a11 = a + posY + (posX + 10) * lda;
  78. a12 = a + posY + (posX + 11) * lda;
  79. a13 = a + posY + (posX + 12) * lda;
  80. a14 = a + posY + (posX + 13) * lda;
  81. a15 = a + posY + (posX + 14) * lda;
  82. a16 = a + posY + (posX + 15) * lda;
  83. }
  84. i = (m >> 4);
  85. if (i > 0) {
  86. do {
  87. if (X < posY) {
  88. for (ii = 0; ii < 16; ii++){
  89. b[ 0] = *(a01 + 0);
  90. b[ 1] = *(a02 + 0);
  91. b[ 2] = *(a03 + 0);
  92. b[ 3] = *(a04 + 0);
  93. b[ 4] = *(a05 + 0);
  94. b[ 5] = *(a06 + 0);
  95. b[ 6] = *(a07 + 0);
  96. b[ 7] = *(a08 + 0);
  97. b[ 8] = *(a09 + 0);
  98. b[ 9] = *(a10 + 0);
  99. b[ 10] = *(a11 + 0);
  100. b[ 11] = *(a12 + 0);
  101. b[ 12] = *(a13 + 0);
  102. b[ 13] = *(a14 + 0);
  103. b[ 14] = *(a15 + 0);
  104. b[ 15] = *(a16 + 0);
  105. a01 ++;
  106. a02 ++;
  107. a03 ++;
  108. a04 ++;
  109. a05 ++;
  110. a06 ++;
  111. a07 ++;
  112. a08 ++;
  113. a09 ++;
  114. a10 ++;
  115. a11 ++;
  116. a12 ++;
  117. a13 ++;
  118. a14 ++;
  119. a15 ++;
  120. a16 ++;
  121. b += 16;
  122. }
  123. } else
  124. if (X > posY) {
  125. a01 += 16 * lda;
  126. a02 += 16 * lda;
  127. a03 += 16 * lda;
  128. a04 += 16 * lda;
  129. a05 += 16 * lda;
  130. a06 += 16 * lda;
  131. a07 += 16 * lda;
  132. a08 += 16 * lda;
  133. a09 += 16 * lda;
  134. a10 += 16 * lda;
  135. a11 += 16 * lda;
  136. a12 += 16 * lda;
  137. a13 += 16 * lda;
  138. a14 += 16 * lda;
  139. a15 += 16 * lda;
  140. a16 += 16 * lda;
  141. b += 256;
  142. } else {
  143. #ifdef UNIT
  144. b[ 0] = ONE;
  145. #else
  146. b[ 0] = *(a01 + 0);
  147. #endif
  148. b[ 1] = *(a02 + 0);
  149. b[ 2] = *(a03 + 0);
  150. b[ 3] = *(a04 + 0);
  151. b[ 4] = *(a05 + 0);
  152. b[ 5] = *(a06 + 0);
  153. b[ 6] = *(a07 + 0);
  154. b[ 7] = *(a08 + 0);
  155. b[ 8] = *(a09 + 0);
  156. b[ 9] = *(a10 + 0);
  157. b[ 10] = *(a11 + 0);
  158. b[ 11] = *(a12 + 0);
  159. b[ 12] = *(a13 + 0);
  160. b[ 13] = *(a14 + 0);
  161. b[ 14] = *(a15 + 0);
  162. b[ 15] = *(a16 + 0);
  163. b[ 16] = ZERO;
  164. #ifdef UNIT
  165. b[ 17] = ONE;
  166. #else
  167. b[ 17] = *(a02 + 1);
  168. #endif
  169. b[ 18] = *(a03 + 1);
  170. b[ 19] = *(a04 + 1);
  171. b[ 20] = *(a05 + 1);
  172. b[ 21] = *(a06 + 1);
  173. b[ 22] = *(a07 + 1);
  174. b[ 23] = *(a08 + 1);
  175. b[ 24] = *(a09 + 1);
  176. b[ 25] = *(a10 + 1);
  177. b[ 26] = *(a11 + 1);
  178. b[ 27] = *(a12 + 1);
  179. b[ 28] = *(a13 + 1);
  180. b[ 29] = *(a14 + 1);
  181. b[ 30] = *(a15 + 1);
  182. b[ 31] = *(a16 + 1);
  183. b[ 32] = ZERO;
  184. b[ 33] = ZERO;
  185. #ifdef UNIT
  186. b[ 34] = ONE;
  187. #else
  188. b[ 34] = *(a03 + 2);
  189. #endif
  190. b[ 35] = *(a04 + 2);
  191. b[ 36] = *(a05 + 2);
  192. b[ 37] = *(a06 + 2);
  193. b[ 38] = *(a07 + 2);
  194. b[ 39] = *(a08 + 2);
  195. b[ 40] = *(a09 + 2);
  196. b[ 41] = *(a10 + 2);
  197. b[ 42] = *(a11 + 2);
  198. b[ 43] = *(a12 + 2);
  199. b[ 44] = *(a13 + 2);
  200. b[ 45] = *(a14 + 2);
  201. b[ 46] = *(a15 + 2);
  202. b[ 47] = *(a16 + 2);
  203. b[ 48] = ZERO;
  204. b[ 49] = ZERO;
  205. b[ 50] = ZERO;
  206. #ifdef UNIT
  207. b[ 51] = ONE;
  208. #else
  209. b[ 51] = *(a04 + 3);
  210. #endif
  211. b[ 52] = *(a05 + 3);
  212. b[ 53] = *(a06 + 3);
  213. b[ 54] = *(a07 + 3);
  214. b[ 55] = *(a08 + 3);
  215. b[ 56] = *(a09 + 3);
  216. b[ 57] = *(a10 + 3);
  217. b[ 58] = *(a11 + 3);
  218. b[ 59] = *(a12 + 3);
  219. b[ 60] = *(a13 + 3);
  220. b[ 61] = *(a14 + 3);
  221. b[ 62] = *(a15 + 3);
  222. b[ 63] = *(a16 + 3);
  223. b[ 64] = ZERO;
  224. b[ 65] = ZERO;
  225. b[ 66] = ZERO;
  226. b[ 67] = ZERO;
  227. #ifdef UNIT
  228. b[ 68] = ONE;
  229. #else
  230. b[ 68] = *(a05 + 4);
  231. #endif
  232. b[ 69] = *(a06 + 4);
  233. b[ 70] = *(a07 + 4);
  234. b[ 71] = *(a08 + 4);
  235. b[ 72] = *(a09 + 4);
  236. b[ 73] = *(a10 + 4);
  237. b[ 74] = *(a11 + 4);
  238. b[ 75] = *(a12 + 4);
  239. b[ 76] = *(a13 + 4);
  240. b[ 77] = *(a14 + 4);
  241. b[ 78] = *(a15 + 4);
  242. b[ 79] = *(a16 + 4);
  243. b[ 80] = ZERO;
  244. b[ 81] = ZERO;
  245. b[ 82] = ZERO;
  246. b[ 83] = ZERO;
  247. b[ 84] = ZERO;
  248. #ifdef UNIT
  249. b[ 85] = ONE;
  250. #else
  251. b[ 85] = *(a06 + 5);
  252. #endif
  253. b[ 86] = *(a07 + 5);
  254. b[ 87] = *(a08 + 5);
  255. b[ 88] = *(a09 + 5);
  256. b[ 89] = *(a10 + 5);
  257. b[ 90] = *(a11 + 5);
  258. b[ 91] = *(a12 + 5);
  259. b[ 92] = *(a13 + 5);
  260. b[ 93] = *(a14 + 5);
  261. b[ 94] = *(a15 + 5);
  262. b[ 95] = *(a16 + 5);
  263. b[ 96] = ZERO;
  264. b[ 97] = ZERO;
  265. b[ 98] = ZERO;
  266. b[ 99] = ZERO;
  267. b[100] = ZERO;
  268. b[101] = ZERO;
  269. #ifdef UNIT
  270. b[102] = ONE;
  271. #else
  272. b[102] = *(a07 + 6);
  273. #endif
  274. b[103] = *(a08 + 6);
  275. b[104] = *(a09 + 6);
  276. b[105] = *(a10 + 6);
  277. b[106] = *(a11 + 6);
  278. b[107] = *(a12 + 6);
  279. b[108] = *(a13 + 6);
  280. b[109] = *(a14 + 6);
  281. b[110] = *(a15 + 6);
  282. b[111] = *(a16 + 6);
  283. b[112] = ZERO;
  284. b[113] = ZERO;
  285. b[114] = ZERO;
  286. b[115] = ZERO;
  287. b[116] = ZERO;
  288. b[117] = ZERO;
  289. b[118] = ZERO;
  290. #ifdef UNIT
  291. b[119] = ONE;
  292. #else
  293. b[119] = *(a08 + 7);
  294. #endif
  295. b[120] = *(a09 + 7);
  296. b[121] = *(a10 + 7);
  297. b[122] = *(a11 + 7);
  298. b[123] = *(a12 + 7);
  299. b[124] = *(a13 + 7);
  300. b[125] = *(a14 + 7);
  301. b[126] = *(a15 + 7);
  302. b[127] = *(a16 + 7);
  303. b[128] = ZERO;
  304. b[129] = ZERO;
  305. b[130] = ZERO;
  306. b[131] = ZERO;
  307. b[132] = ZERO;
  308. b[133] = ZERO;
  309. b[134] = ZERO;
  310. b[135] = ZERO;
  311. #ifdef UNIT
  312. b[136] = ONE;
  313. #else
  314. b[136] = *(a09 + 8);
  315. #endif
  316. b[137] = *(a10 + 8);
  317. b[138] = *(a11 + 8);
  318. b[139] = *(a12 + 8);
  319. b[140] = *(a13 + 8);
  320. b[141] = *(a14 + 8);
  321. b[142] = *(a15 + 8);
  322. b[143] = *(a16 + 8);
  323. b[144] = ZERO;
  324. b[145] = ZERO;
  325. b[146] = ZERO;
  326. b[147] = ZERO;
  327. b[148] = ZERO;
  328. b[149] = ZERO;
  329. b[150] = ZERO;
  330. b[151] = ZERO;
  331. b[152] = ZERO;
  332. #ifdef UNIT
  333. b[153] = ONE;
  334. #else
  335. b[153] = *(a10 + 9);
  336. #endif
  337. b[154] = *(a11 + 9);
  338. b[155] = *(a12 + 9);
  339. b[156] = *(a13 + 9);
  340. b[157] = *(a14 + 9);
  341. b[158] = *(a15 + 9);
  342. b[159] = *(a16 + 9);
  343. b[160] = ZERO;
  344. b[161] = ZERO;
  345. b[162] = ZERO;
  346. b[163] = ZERO;
  347. b[164] = ZERO;
  348. b[165] = ZERO;
  349. b[166] = ZERO;
  350. b[167] = ZERO;
  351. b[168] = ZERO;
  352. b[169] = ZERO;
  353. #ifdef UNIT
  354. b[170] = ONE;
  355. #else
  356. b[170] = *(a11 + 10);
  357. #endif
  358. b[171] = *(a12 + 10);
  359. b[172] = *(a13 + 10);
  360. b[173] = *(a14 + 10);
  361. b[174] = *(a15 + 10);
  362. b[175] = *(a16 + 10);
  363. b[176] = ZERO;
  364. b[177] = ZERO;
  365. b[178] = ZERO;
  366. b[179] = ZERO;
  367. b[180] = ZERO;
  368. b[181] = ZERO;
  369. b[182] = ZERO;
  370. b[183] = ZERO;
  371. b[184] = ZERO;
  372. b[185] = ZERO;
  373. b[186] = ZERO;
  374. #ifdef UNIT
  375. b[187] = ONE;
  376. #else
  377. b[187] = *(a12 + 11);
  378. #endif
  379. b[188] = *(a13 + 11);
  380. b[189] = *(a14 + 11);
  381. b[190] = *(a15 + 11);
  382. b[191] = *(a16 + 11);
  383. b[192] = ZERO;
  384. b[193] = ZERO;
  385. b[194] = ZERO;
  386. b[195] = ZERO;
  387. b[196] = ZERO;
  388. b[197] = ZERO;
  389. b[198] = ZERO;
  390. b[199] = ZERO;
  391. b[200] = ZERO;
  392. b[201] = ZERO;
  393. b[202] = ZERO;
  394. b[203] = ZERO;
  395. #ifdef UNIT
  396. b[204] = ONE;
  397. #else
  398. b[204] = *(a13 + 12);
  399. #endif
  400. b[205] = *(a14 + 12);
  401. b[206] = *(a15 + 12);
  402. b[207] = *(a16 + 12);
  403. b[208] = ZERO;
  404. b[209] = ZERO;
  405. b[210] = ZERO;
  406. b[211] = ZERO;
  407. b[212] = ZERO;
  408. b[213] = ZERO;
  409. b[214] = ZERO;
  410. b[215] = ZERO;
  411. b[216] = ZERO;
  412. b[217] = ZERO;
  413. b[218] = ZERO;
  414. b[219] = ZERO;
  415. b[220] = ZERO;
  416. #ifdef UNIT
  417. b[221] = ONE;
  418. #else
  419. b[221] = *(a14 + 13);
  420. #endif
  421. b[222] = *(a15 + 13);
  422. b[223] = *(a16 + 13);
  423. b[224] = ZERO;
  424. b[225] = ZERO;
  425. b[226] = ZERO;
  426. b[227] = ZERO;
  427. b[228] = ZERO;
  428. b[229] = ZERO;
  429. b[230] = ZERO;
  430. b[231] = ZERO;
  431. b[232] = ZERO;
  432. b[233] = ZERO;
  433. b[234] = ZERO;
  434. b[235] = ZERO;
  435. b[236] = ZERO;
  436. b[237] = ZERO;
  437. #ifdef UNIT
  438. b[238] = ONE;
  439. #else
  440. b[238] = *(a15 + 14);
  441. #endif
  442. b[239] = *(a16 + 14);
  443. b[240] = ZERO;
  444. b[241] = ZERO;
  445. b[242] = ZERO;
  446. b[243] = ZERO;
  447. b[244] = ZERO;
  448. b[245] = ZERO;
  449. b[246] = ZERO;
  450. b[247] = ZERO;
  451. b[248] = ZERO;
  452. b[249] = ZERO;
  453. b[250] = ZERO;
  454. b[251] = ZERO;
  455. b[252] = ZERO;
  456. b[253] = ZERO;
  457. b[254] = ZERO;
  458. #ifdef UNIT
  459. b[255] = ONE;
  460. #else
  461. b[255] = *(a16 + 15);
  462. #endif
  463. a01 += 16 * lda;
  464. a02 += 16 * lda;
  465. a03 += 16 * lda;
  466. a04 += 16 * lda;
  467. a05 += 16 * lda;
  468. a06 += 16 * lda;
  469. a07 += 16 * lda;
  470. a08 += 16 * lda;
  471. a09 += 16 * lda;
  472. a10 += 16 * lda;
  473. a11 += 16 * lda;
  474. a12 += 16 * lda;
  475. a13 += 16 * lda;
  476. a14 += 16 * lda;
  477. a15 += 16 * lda;
  478. a16 += 16 * lda;
  479. b += 256;
  480. }
  481. X += 16;
  482. i --;
  483. } while (i > 0);
  484. }
  485. i = (m & 15);
  486. if (i) {
  487. if (X < posY) {
  488. for (ii = 0; ii < i; ii++){
  489. b[ 0] = *(a01 + 0);
  490. b[ 1] = *(a02 + 0);
  491. b[ 2] = *(a03 + 0);
  492. b[ 3] = *(a04 + 0);
  493. b[ 4] = *(a05 + 0);
  494. b[ 5] = *(a06 + 0);
  495. b[ 6] = *(a07 + 0);
  496. b[ 7] = *(a08 + 0);
  497. b[ 8] = *(a09 + 0);
  498. b[ 9] = *(a10 + 0);
  499. b[ 10] = *(a11 + 0);
  500. b[ 11] = *(a12 + 0);
  501. b[ 12] = *(a13 + 0);
  502. b[ 13] = *(a14 + 0);
  503. b[ 14] = *(a15 + 0);
  504. b[ 15] = *(a16 + 0);
  505. a01 ++;
  506. a02 ++;
  507. a03 ++;
  508. a04 ++;
  509. a05 ++;
  510. a06 ++;
  511. a07 ++;
  512. a08 ++;
  513. a09 ++;
  514. a10 ++;
  515. a11 ++;
  516. a12 ++;
  517. a13 ++;
  518. a14 ++;
  519. a15 ++;
  520. a16 ++;
  521. b += 16;
  522. }
  523. } else
  524. if (X > posY) {
  525. a01 += i * lda;
  526. a02 += i * lda;
  527. a03 += i * lda;
  528. a04 += i * lda;
  529. a05 += i * lda;
  530. a06 += i * lda;
  531. a07 += i * lda;
  532. a08 += i * lda;
  533. a09 += i * lda;
  534. a10 += i * lda;
  535. a11 += i * lda;
  536. a12 += i * lda;
  537. a13 += i * lda;
  538. a14 += i * lda;
  539. a15 += i * lda;
  540. a16 += i * lda;
  541. b += 16 * i;
  542. } else {
  543. #ifdef UNIT
  544. b[ 0] = ONE;
  545. #else
  546. b[ 0] = *(a01 + 0);
  547. #endif
  548. b[ 1] = *(a02 + 0);
  549. b[ 2] = *(a03 + 0);
  550. b[ 3] = *(a04 + 0);
  551. b[ 4] = *(a05 + 0);
  552. b[ 5] = *(a06 + 0);
  553. b[ 6] = *(a07 + 0);
  554. b[ 7] = *(a08 + 0);
  555. b[ 8] = *(a09 + 0);
  556. b[ 9] = *(a10 + 0);
  557. b[ 10] = *(a11 + 0);
  558. b[ 11] = *(a12 + 0);
  559. b[ 12] = *(a13 + 0);
  560. b[ 13] = *(a14 + 0);
  561. b[ 14] = *(a15 + 0);
  562. b[ 15] = *(a16 + 0);
  563. b += 16;
  564. if (i >= 2) {
  565. b[ 0] = ZERO;
  566. #ifdef UNIT
  567. b[ 1] = ONE;
  568. #else
  569. b[ 1] = *(a02 + 1);
  570. #endif
  571. b[ 2] = *(a03 + 1);
  572. b[ 3] = *(a04 + 1);
  573. b[ 4] = *(a05 + 1);
  574. b[ 5] = *(a06 + 1);
  575. b[ 6] = *(a07 + 1);
  576. b[ 7] = *(a08 + 1);
  577. b[ 8] = *(a09 + 1);
  578. b[ 9] = *(a10 + 1);
  579. b[ 10] = *(a11 + 1);
  580. b[ 11] = *(a12 + 1);
  581. b[ 12] = *(a13 + 1);
  582. b[ 13] = *(a14 + 1);
  583. b[ 14] = *(a15 + 1);
  584. b[ 15] = *(a16 + 1);
  585. b += 16;
  586. }
  587. if (i >= 3) {
  588. b[ 0] = ZERO;
  589. b[ 1] = ZERO;
  590. #ifdef UNIT
  591. b[ 2] = ONE;
  592. #else
  593. b[ 2] = *(a03 + 2);
  594. #endif
  595. b[ 3] = *(a04 + 2);
  596. b[ 4] = *(a05 + 2);
  597. b[ 5] = *(a06 + 2);
  598. b[ 6] = *(a07 + 2);
  599. b[ 7] = *(a08 + 2);
  600. b[ 8] = *(a09 + 2);
  601. b[ 9] = *(a10 + 2);
  602. b[ 10] = *(a11 + 2);
  603. b[ 11] = *(a12 + 2);
  604. b[ 12] = *(a13 + 2);
  605. b[ 13] = *(a14 + 2);
  606. b[ 14] = *(a15 + 2);
  607. b[ 15] = *(a16 + 2);
  608. b += 16;
  609. }
  610. if (i >= 4) {
  611. b[ 0] = ZERO;
  612. b[ 1] = ZERO;
  613. b[ 2] = ZERO;
  614. #ifdef UNIT
  615. b[ 3] = ONE;
  616. #else
  617. b[ 3] = *(a04 + 3);
  618. #endif
  619. b[ 4] = *(a05 + 3);
  620. b[ 5] = *(a06 + 3);
  621. b[ 6] = *(a07 + 3);
  622. b[ 7] = *(a08 + 3);
  623. b[ 8] = *(a09 + 3);
  624. b[ 9] = *(a10 + 3);
  625. b[ 10] = *(a11 + 3);
  626. b[ 11] = *(a12 + 3);
  627. b[ 12] = *(a13 + 3);
  628. b[ 13] = *(a14 + 3);
  629. b[ 14] = *(a15 + 3);
  630. b[ 15] = *(a16 + 3);
  631. b += 16;
  632. }
  633. if (i >= 5) {
  634. b[ 0] = ZERO;
  635. b[ 1] = ZERO;
  636. b[ 2] = ZERO;
  637. b[ 3] = ZERO;
  638. #ifdef UNIT
  639. b[ 4] = ONE;
  640. #else
  641. b[ 4] = *(a05 + 4);
  642. #endif
  643. b[ 5] = *(a06 + 4);
  644. b[ 6] = *(a07 + 4);
  645. b[ 7] = *(a08 + 4);
  646. b[ 8] = *(a09 + 4);
  647. b[ 9] = *(a10 + 4);
  648. b[ 10] = *(a11 + 4);
  649. b[ 11] = *(a12 + 4);
  650. b[ 12] = *(a13 + 4);
  651. b[ 13] = *(a14 + 4);
  652. b[ 14] = *(a15 + 4);
  653. b[ 15] = *(a16 + 4);
  654. b += 16;
  655. }
  656. if (i >= 6) {
  657. b[ 0] = ZERO;
  658. b[ 1] = ZERO;
  659. b[ 2] = ZERO;
  660. b[ 3] = ZERO;
  661. b[ 4] = ZERO;
  662. #ifdef UNIT
  663. b[ 5] = ONE;
  664. #else
  665. b[ 5] = *(a06 + 5);
  666. #endif
  667. b[ 6] = *(a07 + 5);
  668. b[ 7] = *(a08 + 5);
  669. b[ 8] = *(a09 + 5);
  670. b[ 9] = *(a10 + 5);
  671. b[ 10] = *(a11 + 5);
  672. b[ 11] = *(a12 + 5);
  673. b[ 12] = *(a13 + 5);
  674. b[ 13] = *(a14 + 5);
  675. b[ 14] = *(a15 + 5);
  676. b[ 15] = *(a16 + 5);
  677. b += 16;
  678. }
  679. if (i >= 7) {
  680. b[ 0] = ZERO;
  681. b[ 1] = ZERO;
  682. b[ 2] = ZERO;
  683. b[ 3] = ZERO;
  684. b[ 4] = ZERO;
  685. b[ 5] = ZERO;
  686. #ifdef UNIT
  687. b[ 6] = ONE;
  688. #else
  689. b[ 6] = *(a07 + 6);
  690. #endif
  691. b[ 7] = *(a08 + 6);
  692. b[ 8] = *(a09 + 6);
  693. b[ 9] = *(a10 + 6);
  694. b[ 10] = *(a11 + 6);
  695. b[ 11] = *(a12 + 6);
  696. b[ 12] = *(a13 + 6);
  697. b[ 13] = *(a14 + 6);
  698. b[ 14] = *(a15 + 6);
  699. b[ 15] = *(a16 + 6);
  700. b += 16;
  701. }
  702. if (i >= 8) {
  703. b[ 0] = ZERO;
  704. b[ 1] = ZERO;
  705. b[ 2] = ZERO;
  706. b[ 3] = ZERO;
  707. b[ 4] = ZERO;
  708. b[ 5] = ZERO;
  709. b[ 6] = ZERO;
  710. #ifdef UNIT
  711. b[ 7] = ONE;
  712. #else
  713. b[ 7] = *(a08 + 7);
  714. #endif
  715. b[ 8] = *(a09 + 7);
  716. b[ 9] = *(a10 + 7);
  717. b[ 10] = *(a11 + 7);
  718. b[ 11] = *(a12 + 7);
  719. b[ 12] = *(a13 + 7);
  720. b[ 13] = *(a14 + 7);
  721. b[ 14] = *(a15 + 7);
  722. b[ 15] = *(a16 + 7);
  723. b += 16;
  724. }
  725. if (i >= 9) {
  726. b[ 0] = ZERO;
  727. b[ 1] = ZERO;
  728. b[ 2] = ZERO;
  729. b[ 3] = ZERO;
  730. b[ 4] = ZERO;
  731. b[ 5] = ZERO;
  732. b[ 6] = ZERO;
  733. b[ 7] = ZERO;
  734. #ifdef UNIT
  735. b[ 8] = ONE;
  736. #else
  737. b[ 8] = *(a09 + 8);
  738. #endif
  739. b[ 9] = *(a10 + 8);
  740. b[ 10] = *(a11 + 8);
  741. b[ 11] = *(a12 + 8);
  742. b[ 12] = *(a13 + 8);
  743. b[ 13] = *(a14 + 8);
  744. b[ 14] = *(a15 + 8);
  745. b[ 15] = *(a16 + 8);
  746. b += 16;
  747. }
  748. if (i >= 10) {
  749. b[ 0] = ZERO;
  750. b[ 1] = ZERO;
  751. b[ 2] = ZERO;
  752. b[ 3] = ZERO;
  753. b[ 4] = ZERO;
  754. b[ 5] = ZERO;
  755. b[ 6] = ZERO;
  756. b[ 7] = ZERO;
  757. b[ 8] = ZERO;
  758. #ifdef UNIT
  759. b[ 9] = ONE;
  760. #else
  761. b[ 9] = *(a10 + 9);
  762. #endif
  763. b[ 10] = *(a11 + 9);
  764. b[ 11] = *(a12 + 9);
  765. b[ 12] = *(a13 + 9);
  766. b[ 13] = *(a14 + 9);
  767. b[ 14] = *(a15 + 9);
  768. b[ 15] = *(a16 + 9);
  769. b += 16;
  770. }
  771. if (i >= 11) {
  772. b[ 0] = ZERO;
  773. b[ 1] = ZERO;
  774. b[ 2] = ZERO;
  775. b[ 3] = ZERO;
  776. b[ 4] = ZERO;
  777. b[ 5] = ZERO;
  778. b[ 6] = ZERO;
  779. b[ 7] = ZERO;
  780. b[ 8] = ZERO;
  781. b[ 9] = ZERO;
  782. #ifdef UNIT
  783. b[ 10] = ONE;
  784. #else
  785. b[ 10] = *(a11 + 10);
  786. #endif
  787. b[ 11] = *(a12 + 10);
  788. b[ 12] = *(a13 + 10);
  789. b[ 13] = *(a14 + 10);
  790. b[ 14] = *(a15 + 10);
  791. b[ 15] = *(a16 + 10);
  792. b += 16;
  793. }
  794. if (i >= 12) {
  795. b[ 0] = ZERO;
  796. b[ 1] = ZERO;
  797. b[ 2] = ZERO;
  798. b[ 3] = ZERO;
  799. b[ 4] = ZERO;
  800. b[ 5] = ZERO;
  801. b[ 6] = ZERO;
  802. b[ 7] = ZERO;
  803. b[ 8] = ZERO;
  804. b[ 9] = ZERO;
  805. b[ 10] = ZERO;
  806. #ifdef UNIT
  807. b[ 11] = ONE;
  808. #else
  809. b[ 11] = *(a12 + 11);
  810. #endif
  811. b[ 12] = *(a13 + 11);
  812. b[ 13] = *(a14 + 11);
  813. b[ 14] = *(a15 + 11);
  814. b[ 15] = *(a16 + 11);
  815. b += 16;
  816. }
  817. if (i >= 13) {
  818. b[ 0] = ZERO;
  819. b[ 1] = ZERO;
  820. b[ 2] = ZERO;
  821. b[ 3] = ZERO;
  822. b[ 4] = ZERO;
  823. b[ 5] = ZERO;
  824. b[ 6] = ZERO;
  825. b[ 7] = ZERO;
  826. b[ 8] = ZERO;
  827. b[ 9] = ZERO;
  828. b[ 10] = ZERO;
  829. b[ 11] = ZERO;
  830. #ifdef UNIT
  831. b[ 12] = ONE;
  832. #else
  833. b[ 12] = *(a13 + 12);
  834. #endif
  835. b[ 13] = *(a14 + 12);
  836. b[ 14] = *(a15 + 12);
  837. b[ 15] = *(a16 + 12);
  838. b += 16;
  839. }
  840. if (i >= 14) {
  841. b[ 0] = ZERO;
  842. b[ 1] = ZERO;
  843. b[ 2] = ZERO;
  844. b[ 3] = ZERO;
  845. b[ 4] = ZERO;
  846. b[ 5] = ZERO;
  847. b[ 6] = ZERO;
  848. b[ 7] = ZERO;
  849. b[ 8] = ZERO;
  850. b[ 9] = ZERO;
  851. b[ 10] = ZERO;
  852. b[ 11] = ZERO;
  853. b[ 12] = ZERO;
  854. #ifdef UNIT
  855. b[ 13] = ONE;
  856. #else
  857. b[ 13] = *(a14 + 13);
  858. #endif
  859. b[ 14] = *(a15 + 13);
  860. b[ 15] = *(a16 + 13);
  861. b += 16;
  862. }
  863. if (i >= 15) {
  864. b[ 0] = ZERO;
  865. b[ 1] = ZERO;
  866. b[ 2] = ZERO;
  867. b[ 3] = ZERO;
  868. b[ 4] = ZERO;
  869. b[ 5] = ZERO;
  870. b[ 6] = ZERO;
  871. b[ 7] = ZERO;
  872. b[ 8] = ZERO;
  873. b[ 9] = ZERO;
  874. b[ 10] = ZERO;
  875. b[ 11] = ZERO;
  876. b[ 12] = ZERO;
  877. b[ 13] = ZERO;
  878. #ifdef UNIT
  879. b[ 14] = ONE;
  880. #else
  881. b[ 14] = *(a15 + 14);
  882. #endif
  883. b[ 15] = *(a16 + 14);
  884. b += 16;
  885. }
  886. }
  887. }
  888. posY += 16;
  889. js --;
  890. } while (js > 0);
  891. } /* End of main loop */
  892. if (n & 8){
  893. X = posX;
  894. if (posX <= posY) {
  895. a01 = a + posX + (posY + 0) * lda;
  896. a02 = a + posX + (posY + 1) * lda;
  897. a03 = a + posX + (posY + 2) * lda;
  898. a04 = a + posX + (posY + 3) * lda;
  899. a05 = a + posX + (posY + 4) * lda;
  900. a06 = a + posX + (posY + 5) * lda;
  901. a07 = a + posX + (posY + 6) * lda;
  902. a08 = a + posX + (posY + 7) * lda;
  903. } else {
  904. a01 = a + posY + (posX + 0) * lda;
  905. a02 = a + posY + (posX + 1) * lda;
  906. a03 = a + posY + (posX + 2) * lda;
  907. a04 = a + posY + (posX + 3) * lda;
  908. a05 = a + posY + (posX + 4) * lda;
  909. a06 = a + posY + (posX + 5) * lda;
  910. a07 = a + posY + (posX + 6) * lda;
  911. a08 = a + posY + (posX + 7) * lda;
  912. }
  913. i = (m >> 3);
  914. if (i > 0) {
  915. do {
  916. if (X < posY) {
  917. for (ii = 0; ii < 8; ii++){
  918. b[ 0] = *(a01 + 0);
  919. b[ 1] = *(a02 + 0);
  920. b[ 2] = *(a03 + 0);
  921. b[ 3] = *(a04 + 0);
  922. b[ 4] = *(a05 + 0);
  923. b[ 5] = *(a06 + 0);
  924. b[ 6] = *(a07 + 0);
  925. b[ 7] = *(a08 + 0);
  926. a01 ++;
  927. a02 ++;
  928. a03 ++;
  929. a04 ++;
  930. a05 ++;
  931. a06 ++;
  932. a07 ++;
  933. a08 ++;
  934. b += 8;
  935. }
  936. } else
  937. if (X > posY) {
  938. a01 += 8 * lda;
  939. a02 += 8 * lda;
  940. a03 += 8 * lda;
  941. a04 += 8 * lda;
  942. a05 += 8 * lda;
  943. a06 += 8 * lda;
  944. a07 += 8 * lda;
  945. a08 += 8 * lda;
  946. b += 64;
  947. } else {
  948. #ifdef UNIT
  949. b[ 0] = ONE;
  950. #else
  951. b[ 0] = *(a01 + 0);
  952. #endif
  953. b[ 1] = *(a02 + 0);
  954. b[ 2] = *(a03 + 0);
  955. b[ 3] = *(a04 + 0);
  956. b[ 4] = *(a05 + 0);
  957. b[ 5] = *(a06 + 0);
  958. b[ 6] = *(a07 + 0);
  959. b[ 7] = *(a08 + 0);
  960. b[ 8] = ZERO;
  961. #ifdef UNIT
  962. b[ 9] = ONE;
  963. #else
  964. b[ 9] = *(a02 + 1);
  965. #endif
  966. b[ 10] = *(a03 + 1);
  967. b[ 11] = *(a04 + 1);
  968. b[ 12] = *(a05 + 1);
  969. b[ 13] = *(a06 + 1);
  970. b[ 14] = *(a07 + 1);
  971. b[ 15] = *(a08 + 1);
  972. b[ 16] = ZERO;
  973. b[ 17] = ZERO;
  974. #ifdef UNIT
  975. b[ 18] = ONE;
  976. #else
  977. b[ 18] = *(a03 + 2);
  978. #endif
  979. b[ 19] = *(a04 + 2);
  980. b[ 20] = *(a05 + 2);
  981. b[ 21] = *(a06 + 2);
  982. b[ 22] = *(a07 + 2);
  983. b[ 23] = *(a08 + 2);
  984. b[ 24] = ZERO;
  985. b[ 25] = ZERO;
  986. b[ 26] = ZERO;
  987. #ifdef UNIT
  988. b[ 27] = ONE;
  989. #else
  990. b[ 27] = *(a04 + 3);
  991. #endif
  992. b[ 28] = *(a05 + 3);
  993. b[ 29] = *(a06 + 3);
  994. b[ 30] = *(a07 + 3);
  995. b[ 31] = *(a08 + 3);
  996. b[ 32] = ZERO;
  997. b[ 33] = ZERO;
  998. b[ 34] = ZERO;
  999. b[ 35] = ZERO;
  1000. #ifdef UNIT
  1001. b[ 36] = ONE;
  1002. #else
  1003. b[ 36] = *(a05 + 4);
  1004. #endif
  1005. b[ 37] = *(a06 + 4);
  1006. b[ 38] = *(a07 + 4);
  1007. b[ 39] = *(a08 + 4);
  1008. b[ 40] = ZERO;
  1009. b[ 41] = ZERO;
  1010. b[ 42] = ZERO;
  1011. b[ 43] = ZERO;
  1012. b[ 44] = ZERO;
  1013. #ifdef UNIT
  1014. b[ 45] = ONE;
  1015. #else
  1016. b[ 45] = *(a06 + 5);
  1017. #endif
  1018. b[ 46] = *(a07 + 5);
  1019. b[ 47] = *(a08 + 5);
  1020. b[ 48] = ZERO;
  1021. b[ 49] = ZERO;
  1022. b[ 50] = ZERO;
  1023. b[ 51] = ZERO;
  1024. b[ 52] = ZERO;
  1025. b[ 53] = ZERO;
  1026. #ifdef UNIT
  1027. b[ 54] = ONE;
  1028. #else
  1029. b[ 54] = *(a07 + 6);
  1030. #endif
  1031. b[ 55] = *(a08 + 6);
  1032. b[ 56] = ZERO;
  1033. b[ 57] = ZERO;
  1034. b[ 58] = ZERO;
  1035. b[ 59] = ZERO;
  1036. b[ 60] = ZERO;
  1037. b[ 61] = ZERO;
  1038. b[ 62] = ZERO;
  1039. #ifdef UNIT
  1040. b[ 63] = ONE;
  1041. #else
  1042. b[ 63] = *(a08 + 7);
  1043. #endif
  1044. a01 += 8 * lda;
  1045. a02 += 8 * lda;
  1046. a03 += 8 * lda;
  1047. a04 += 8 * lda;
  1048. a05 += 8 * lda;
  1049. a06 += 8 * lda;
  1050. a07 += 8 * lda;
  1051. a08 += 8 * lda;
  1052. b += 64;
  1053. }
  1054. X += 8;
  1055. i --;
  1056. } while (i > 0);
  1057. }
  1058. i = (m & 7);
  1059. if (i) {
  1060. if (X < posY) {
  1061. for (ii = 0; ii < i; ii++){
  1062. b[ 0] = *(a01 + 0);
  1063. b[ 1] = *(a02 + 0);
  1064. b[ 2] = *(a03 + 0);
  1065. b[ 3] = *(a04 + 0);
  1066. b[ 4] = *(a05 + 0);
  1067. b[ 5] = *(a06 + 0);
  1068. b[ 6] = *(a07 + 0);
  1069. b[ 7] = *(a08 + 0);
  1070. a01 ++;
  1071. a02 ++;
  1072. a03 ++;
  1073. a04 ++;
  1074. a05 ++;
  1075. a06 ++;
  1076. a07 ++;
  1077. a08 ++;
  1078. b += 8;
  1079. }
  1080. } else
  1081. if (X > posY) {
  1082. a01 += i * lda;
  1083. a02 += i * lda;
  1084. a03 += i * lda;
  1085. a04 += i * lda;
  1086. a05 += i * lda;
  1087. a06 += i * lda;
  1088. a07 += i * lda;
  1089. a08 += i * lda;
  1090. b += 8 * i;
  1091. } else {
  1092. #ifdef UNIT
  1093. b[ 0] = ONE;
  1094. #else
  1095. b[ 0] = *(a01 + 0);
  1096. #endif
  1097. b[ 1] = *(a02 + 0);
  1098. b[ 2] = *(a03 + 0);
  1099. b[ 3] = *(a04 + 0);
  1100. b[ 4] = *(a05 + 0);
  1101. b[ 5] = *(a06 + 0);
  1102. b[ 6] = *(a07 + 0);
  1103. b[ 7] = *(a08 + 0);
  1104. b += 8;
  1105. if (i >= 2) {
  1106. b[ 0] = ZERO;
  1107. #ifdef UNIT
  1108. b[ 1] = ONE;
  1109. #else
  1110. b[ 1] = *(a02 + 1);
  1111. #endif
  1112. b[ 2] = *(a03 + 1);
  1113. b[ 3] = *(a04 + 1);
  1114. b[ 4] = *(a05 + 1);
  1115. b[ 5] = *(a06 + 1);
  1116. b[ 6] = *(a07 + 1);
  1117. b[ 7] = *(a08 + 1);
  1118. b += 8;
  1119. }
  1120. if (i >= 3) {
  1121. b[ 0] = ZERO;
  1122. b[ 1] = ZERO;
  1123. #ifdef UNIT
  1124. b[ 2] = ONE;
  1125. #else
  1126. b[ 2] = *(a03 + 2);
  1127. #endif
  1128. b[ 3] = *(a04 + 2);
  1129. b[ 4] = *(a05 + 2);
  1130. b[ 5] = *(a06 + 2);
  1131. b[ 6] = *(a07 + 2);
  1132. b[ 7] = *(a08 + 2);
  1133. b += 8;
  1134. }
  1135. if (i >= 4) {
  1136. b[ 0] = ZERO;
  1137. b[ 1] = ZERO;
  1138. b[ 2] = ZERO;
  1139. #ifdef UNIT
  1140. b[ 3] = ONE;
  1141. #else
  1142. b[ 3] = *(a04 + 3);
  1143. #endif
  1144. b[ 4] = *(a05 + 3);
  1145. b[ 5] = *(a06 + 3);
  1146. b[ 6] = *(a07 + 3);
  1147. b[ 7] = *(a08 + 3);
  1148. b += 8;
  1149. }
  1150. if (i >= 5) {
  1151. b[ 0] = ZERO;
  1152. b[ 1] = ZERO;
  1153. b[ 2] = ZERO;
  1154. b[ 3] = ZERO;
  1155. #ifdef UNIT
  1156. b[ 4] = ONE;
  1157. #else
  1158. b[ 4] = *(a05 + 4);
  1159. #endif
  1160. b[ 5] = *(a06 + 4);
  1161. b[ 6] = *(a07 + 4);
  1162. b[ 7] = *(a08 + 4);
  1163. b += 8;
  1164. }
  1165. if (i >= 6) {
  1166. b[ 0] = ZERO;
  1167. b[ 1] = ZERO;
  1168. b[ 2] = ZERO;
  1169. b[ 3] = ZERO;
  1170. b[ 4] = ZERO;
  1171. #ifdef UNIT
  1172. b[ 5] = ONE;
  1173. #else
  1174. b[ 5] = *(a06 + 5);
  1175. #endif
  1176. b[ 6] = *(a07 + 5);
  1177. b[ 7] = *(a08 + 5);
  1178. b += 8;
  1179. }
  1180. if (i >= 7) {
  1181. b[ 0] = ZERO;
  1182. b[ 1] = ZERO;
  1183. b[ 2] = ZERO;
  1184. b[ 3] = ZERO;
  1185. b[ 4] = ZERO;
  1186. b[ 5] = ZERO;
  1187. #ifdef UNIT
  1188. b[ 6] = ONE;
  1189. #else
  1190. b[ 6] = *(a07 + 6);
  1191. #endif
  1192. b[ 7] = *(a08 + 6);
  1193. b += 8;
  1194. }
  1195. }
  1196. }
  1197. posY += 8;
  1198. }
  1199. if (n & 4){
  1200. X = posX;
  1201. if (posX <= posY) {
  1202. a01 = a + posX + (posY + 0) * lda;
  1203. a02 = a + posX + (posY + 1) * lda;
  1204. a03 = a + posX + (posY + 2) * lda;
  1205. a04 = a + posX + (posY + 3) * lda;
  1206. } else {
  1207. a01 = a + posY + (posX + 0) * lda;
  1208. a02 = a + posY + (posX + 1) * lda;
  1209. a03 = a + posY + (posX + 2) * lda;
  1210. a04 = a + posY + (posX + 3) * lda;
  1211. }
  1212. i = (m >> 2);
  1213. if (i > 0) {
  1214. do {
  1215. if (X < posY) {
  1216. for (ii = 0; ii < 4; ii++){
  1217. b[ 0] = *(a01 + 0);
  1218. b[ 1] = *(a02 + 0);
  1219. b[ 2] = *(a03 + 0);
  1220. b[ 3] = *(a04 + 0);
  1221. a01 ++;
  1222. a02 ++;
  1223. a03 ++;
  1224. a04 ++;
  1225. b += 4;
  1226. }
  1227. } else
  1228. if (X > posY) {
  1229. a01 += 4 * lda;
  1230. a02 += 4 * lda;
  1231. a03 += 4 * lda;
  1232. a04 += 4 * lda;
  1233. b += 16;
  1234. } else {
  1235. #ifdef UNIT
  1236. b[ 0] = ONE;
  1237. #else
  1238. b[ 0] = *(a01 + 0);
  1239. #endif
  1240. b[ 1] = *(a02 + 0);
  1241. b[ 2] = *(a03 + 0);
  1242. b[ 3] = *(a04 + 0);
  1243. b[ 4] = ZERO;
  1244. #ifdef UNIT
  1245. b[ 5] = ONE;
  1246. #else
  1247. b[ 5] = *(a02 + 1);
  1248. #endif
  1249. b[ 6] = *(a03 + 1);
  1250. b[ 7] = *(a04 + 1);
  1251. b[ 8] = ZERO;
  1252. b[ 9] = ZERO;
  1253. #ifdef UNIT
  1254. b[ 10] = ONE;
  1255. #else
  1256. b[ 10] = *(a03 + 2);
  1257. #endif
  1258. b[ 11] = *(a04 + 2);
  1259. b[ 12] = ZERO;
  1260. b[ 13] = ZERO;
  1261. b[ 14] = ZERO;
  1262. #ifdef UNIT
  1263. b[ 15] = ONE;
  1264. #else
  1265. b[ 15] = *(a04 + 3);
  1266. #endif
  1267. a01 += 4 * lda;
  1268. a02 += 4 * lda;
  1269. a03 += 4 * lda;
  1270. a04 += 4 * lda;
  1271. b += 16;
  1272. }
  1273. X += 4;
  1274. i --;
  1275. } while (i > 0);
  1276. }
  1277. i = (m & 3);
  1278. if (i) {
  1279. if (X < posY) {
  1280. for (ii = 0; ii < i; ii++){
  1281. b[ 0] = *(a01 + 0);
  1282. b[ 1] = *(a02 + 0);
  1283. b[ 2] = *(a03 + 0);
  1284. b[ 3] = *(a04 + 0);
  1285. a01 ++;
  1286. a02 ++;
  1287. a03 ++;
  1288. a04 ++;
  1289. b += 4;
  1290. }
  1291. } else
  1292. if (X > posY) {
  1293. a01 += i * lda;
  1294. a02 += i * lda;
  1295. a03 += i * lda;
  1296. a04 += i * lda;
  1297. b += 4 * i;
  1298. } else {
  1299. #ifdef UNIT
  1300. b[ 0] = ONE;
  1301. #else
  1302. b[ 0] = *(a01 + 0);
  1303. #endif
  1304. b[ 1] = *(a02 + 0);
  1305. b[ 2] = *(a03 + 0);
  1306. b[ 3] = *(a04 + 0);
  1307. b += 4;
  1308. if (i >= 2) {
  1309. b[ 0] = ZERO;
  1310. #ifdef UNIT
  1311. b[ 1] = ONE;
  1312. #else
  1313. b[ 1] = *(a02 + 1);
  1314. #endif
  1315. b[ 2] = *(a03 + 1);
  1316. b[ 3] = *(a04 + 1);
  1317. b += 4;
  1318. }
  1319. if (i >= 3) {
  1320. b[ 0] = ZERO;
  1321. b[ 1] = ZERO;
  1322. #ifdef UNIT
  1323. b[ 2] = ONE;
  1324. #else
  1325. b[ 2] = *(a03 + 2);
  1326. #endif
  1327. b[ 3] = *(a04 + 2);
  1328. b += 4;
  1329. }
  1330. }
  1331. }
  1332. posY += 4;
  1333. }
  1334. if (n & 2){
  1335. X = posX;
  1336. if (posX <= posY) {
  1337. a01 = a + posX + (posY + 0) * lda;
  1338. a02 = a + posX + (posY + 1) * lda;
  1339. } else {
  1340. a01 = a + posY + (posX + 0) * lda;
  1341. a02 = a + posY + (posX + 1) * lda;
  1342. }
  1343. i = (m >> 1);
  1344. if (i > 0) {
  1345. do {
  1346. if (X < posY) {
  1347. b[ 0] = *(a01 + 0);
  1348. b[ 1] = *(a02 + 0);
  1349. b[ 2] = *(a01 + 1);
  1350. b[ 3] = *(a02 + 1);
  1351. a01 += 2;
  1352. a02 += 2;
  1353. b += 4;
  1354. } else
  1355. if (X > posY) {
  1356. a01 += 2 * lda;
  1357. a02 += 2 * lda;
  1358. b += 4;
  1359. } else {
  1360. #ifdef UNIT
  1361. b[ 0] = ONE;
  1362. #else
  1363. b[ 0] = *(a01 + 0);
  1364. #endif
  1365. b[ 1] = *(a02 + 0);
  1366. b[ 2] = ZERO;
  1367. #ifdef UNIT
  1368. b[ 3] = ONE;
  1369. #else
  1370. b[ 3] = *(a02 + 1);
  1371. #endif
  1372. a01 += 2 * lda;
  1373. a02 += 2 * lda;
  1374. b += 4;
  1375. }
  1376. X += 2;
  1377. i --;
  1378. } while (i > 0);
  1379. }
  1380. if (m & 1) {
  1381. if (X < posY) {
  1382. b[ 0] = *(a01 + 0);
  1383. b[ 1] = *(a02 + 0);
  1384. a01 ++;
  1385. a02 ++;
  1386. b += 2;
  1387. } else
  1388. if (X > posY) {
  1389. a01 += lda;
  1390. a02 += lda;
  1391. b += 2;
  1392. } else {
  1393. #ifdef UNIT
  1394. b[ 0] = ONE;
  1395. #else
  1396. b[ 0] = *(a01 + 0);
  1397. #endif
  1398. b[ 1] = *(a02 + 0);
  1399. b += 2;
  1400. }
  1401. }
  1402. posY += 2;
  1403. }
  1404. if (n & 1){
  1405. X = posX;
  1406. if (posX <= posY) {
  1407. a01 = a + posX + (posY + 0) * lda;
  1408. } else {
  1409. a01 = a + posY + (posX + 0) * lda;
  1410. }
  1411. i = m;
  1412. if (m > 0) {
  1413. do {
  1414. if (X < posY) {
  1415. b[ 0] = *(a01 + 0);
  1416. a01 += 1;
  1417. b += 1;
  1418. } else
  1419. if (X > posY) {
  1420. a01 += lda;
  1421. b += 1;
  1422. } else {
  1423. #ifdef UNIT
  1424. b[ 0] = ONE;
  1425. #else
  1426. b[ 0] = *(a01 + 0);
  1427. #endif
  1428. b += 1;
  1429. }
  1430. X += 1;
  1431. i --;
  1432. } while (i > 0);
  1433. }
  1434. }
  1435. return 0;
  1436. }