h264_deblock.asm 23 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923
  1. ;*****************************************************************************
  2. ;* MMX/SSE2/AVX-optimized H.264 deblocking code
  3. ;*****************************************************************************
  4. ;* Copyright (C) 2005-2011 x264 project
  5. ;*
  6. ;* Authors: Loren Merritt <lorenm@u.washington.edu>
  7. ;* Jason Garrett-Glaser <darkshikari@gmail.com>
  8. ;* Oskar Arvidsson <oskar@irock.se>
  9. ;*
  10. ;* This file is part of FFmpeg.
  11. ;*
  12. ;* FFmpeg is free software; you can redistribute it and/or
  13. ;* modify it under the terms of the GNU Lesser General Public
  14. ;* License as published by the Free Software Foundation; either
  15. ;* version 2.1 of the License, or (at your option) any later version.
  16. ;*
  17. ;* FFmpeg is distributed in the hope that it will be useful,
  18. ;* but WITHOUT ANY WARRANTY; without even the implied warranty of
  19. ;* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
  20. ;* Lesser General Public License for more details.
  21. ;*
  22. ;* You should have received a copy of the GNU Lesser General Public
  23. ;* License along with FFmpeg; if not, write to the Free Software
  24. ;* Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
  25. ;******************************************************************************
  26. %include "libavutil/x86/x86inc.asm"
  27. %include "libavutil/x86/x86util.asm"
  28. SECTION .text
  29. cextern pb_0
  30. cextern pb_1
  31. cextern pb_3
  32. cextern pb_A1
  33. ; expands to [base],...,[base+7*stride]
  34. %define PASS8ROWS(base, base3, stride, stride3) \
  35. [base], [base+stride], [base+stride*2], [base3], \
  36. [base3+stride], [base3+stride*2], [base3+stride3], [base3+stride*4]
  37. %define PASS8ROWS(base, base3, stride, stride3, offset) \
  38. PASS8ROWS(base+offset, base3+offset, stride, stride3)
  39. ; in: 8 rows of 4 bytes in %4..%11
  40. ; out: 4 rows of 8 bytes in m0..m3
  41. %macro TRANSPOSE4x8_LOAD 11
  42. movh m0, %4
  43. movh m2, %5
  44. movh m1, %6
  45. movh m3, %7
  46. punpckl%1 m0, m2
  47. punpckl%1 m1, m3
  48. mova m2, m0
  49. punpckl%2 m0, m1
  50. punpckh%2 m2, m1
  51. movh m4, %8
  52. movh m6, %9
  53. movh m5, %10
  54. movh m7, %11
  55. punpckl%1 m4, m6
  56. punpckl%1 m5, m7
  57. mova m6, m4
  58. punpckl%2 m4, m5
  59. punpckh%2 m6, m5
  60. punpckh%3 m1, m0, m4
  61. punpckh%3 m3, m2, m6
  62. punpckl%3 m0, m4
  63. punpckl%3 m2, m6
  64. %endmacro
  65. ; in: 4 rows of 8 bytes in m0..m3
  66. ; out: 8 rows of 4 bytes in %1..%8
  67. %macro TRANSPOSE8x4B_STORE 8
  68. punpckhdq m4, m0, m0
  69. punpckhdq m5, m1, m1
  70. punpckhdq m6, m2, m2
  71. punpcklbw m0, m1
  72. punpcklbw m2, m3
  73. punpcklwd m1, m0, m2
  74. punpckhwd m0, m2
  75. movh %1, m1
  76. punpckhdq m1, m1
  77. movh %2, m1
  78. movh %3, m0
  79. punpckhdq m0, m0
  80. movh %4, m0
  81. punpckhdq m3, m3
  82. punpcklbw m4, m5
  83. punpcklbw m6, m3
  84. punpcklwd m5, m4, m6
  85. punpckhwd m4, m6
  86. movh %5, m5
  87. punpckhdq m5, m5
  88. movh %6, m5
  89. movh %7, m4
  90. punpckhdq m4, m4
  91. movh %8, m4
  92. %endmacro
  93. %macro TRANSPOSE4x8B_LOAD 8
  94. TRANSPOSE4x8_LOAD bw, wd, dq, %1, %2, %3, %4, %5, %6, %7, %8
  95. %endmacro
  96. %macro SBUTTERFLY3 4
  97. punpckh%1 %4, %2, %3
  98. punpckl%1 %2, %3
  99. %endmacro
  100. ; in: 8 rows of 8 (only the middle 6 pels are used) in %1..%8
  101. ; out: 6 rows of 8 in [%9+0*16] .. [%9+5*16]
  102. %macro TRANSPOSE6x8_MEM 9
  103. RESET_MM_PERMUTATION
  104. movq m0, %1
  105. movq m1, %2
  106. movq m2, %3
  107. movq m3, %4
  108. movq m4, %5
  109. movq m5, %6
  110. movq m6, %7
  111. SBUTTERFLY bw, 0, 1, 7
  112. SBUTTERFLY bw, 2, 3, 7
  113. SBUTTERFLY bw, 4, 5, 7
  114. movq [%9+0x10], m3
  115. SBUTTERFLY3 bw, m6, %8, m7
  116. SBUTTERFLY wd, 0, 2, 3
  117. SBUTTERFLY wd, 4, 6, 3
  118. punpckhdq m0, m4
  119. movq [%9+0x00], m0
  120. SBUTTERFLY3 wd, m1, [%9+0x10], m3
  121. SBUTTERFLY wd, 5, 7, 0
  122. SBUTTERFLY dq, 1, 5, 0
  123. SBUTTERFLY dq, 2, 6, 0
  124. punpckldq m3, m7
  125. movq [%9+0x10], m2
  126. movq [%9+0x20], m6
  127. movq [%9+0x30], m1
  128. movq [%9+0x40], m5
  129. movq [%9+0x50], m3
  130. RESET_MM_PERMUTATION
  131. %endmacro
  132. ; in: 8 rows of 8 in %1..%8
  133. ; out: 8 rows of 8 in %9..%16
  134. %macro TRANSPOSE8x8_MEM 16
  135. RESET_MM_PERMUTATION
  136. movq m0, %1
  137. movq m1, %2
  138. movq m2, %3
  139. movq m3, %4
  140. movq m4, %5
  141. movq m5, %6
  142. movq m6, %7
  143. SBUTTERFLY bw, 0, 1, 7
  144. SBUTTERFLY bw, 2, 3, 7
  145. SBUTTERFLY bw, 4, 5, 7
  146. SBUTTERFLY3 bw, m6, %8, m7
  147. movq %9, m5
  148. SBUTTERFLY wd, 0, 2, 5
  149. SBUTTERFLY wd, 4, 6, 5
  150. SBUTTERFLY wd, 1, 3, 5
  151. movq %11, m6
  152. movq m6, %9
  153. SBUTTERFLY wd, 6, 7, 5
  154. SBUTTERFLY dq, 0, 4, 5
  155. SBUTTERFLY dq, 1, 6, 5
  156. movq %9, m0
  157. movq %10, m4
  158. movq %13, m1
  159. movq %14, m6
  160. SBUTTERFLY3 dq, m2, %11, m0
  161. SBUTTERFLY dq, 3, 7, 4
  162. movq %11, m2
  163. movq %12, m0
  164. movq %15, m3
  165. movq %16, m7
  166. RESET_MM_PERMUTATION
  167. %endmacro
  168. ; out: %4 = |%1-%2|>%3
  169. ; clobbers: %5
  170. %macro DIFF_GT 5
  171. %if avx_enabled == 0
  172. mova %5, %2
  173. mova %4, %1
  174. psubusb %5, %1
  175. psubusb %4, %2
  176. %else
  177. psubusb %5, %2, %1
  178. psubusb %4, %1, %2
  179. %endif
  180. por %4, %5
  181. psubusb %4, %3
  182. %endmacro
  183. ; out: %4 = |%1-%2|>%3
  184. ; clobbers: %5
  185. %macro DIFF_GT2 5
  186. %if ARCH_X86_64
  187. psubusb %5, %2, %1
  188. psubusb %4, %1, %2
  189. %else
  190. mova %5, %2
  191. mova %4, %1
  192. psubusb %5, %1
  193. psubusb %4, %2
  194. %endif
  195. psubusb %5, %3
  196. psubusb %4, %3
  197. pcmpeqb %4, %5
  198. %endmacro
  199. ; in: m0=p1 m1=p0 m2=q0 m3=q1 %1=alpha-1 %2=beta-1
  200. ; out: m5=beta-1, m7=mask, %3=alpha-1
  201. ; clobbers: m4,m6
  202. %macro LOAD_MASK 2-3
  203. movd m4, %1
  204. movd m5, %2
  205. SPLATW m4, m4
  206. SPLATW m5, m5
  207. packuswb m4, m4 ; 16x alpha-1
  208. packuswb m5, m5 ; 16x beta-1
  209. %if %0>2
  210. mova %3, m4
  211. %endif
  212. DIFF_GT m1, m2, m4, m7, m6 ; |p0-q0| > alpha-1
  213. DIFF_GT m0, m1, m5, m4, m6 ; |p1-p0| > beta-1
  214. por m7, m4
  215. DIFF_GT m3, m2, m5, m4, m6 ; |q1-q0| > beta-1
  216. por m7, m4
  217. pxor m6, m6
  218. pcmpeqb m7, m6
  219. %endmacro
  220. ; in: m0=p1 m1=p0 m2=q0 m3=q1 m7=(tc&mask)
  221. ; out: m1=p0' m2=q0'
  222. ; clobbers: m0,3-6
  223. %macro DEBLOCK_P0_Q0 0
  224. pcmpeqb m4, m4
  225. pxor m5, m1, m2 ; p0^q0
  226. pxor m3, m4
  227. pand m5, [pb_1] ; (p0^q0)&1
  228. pavgb m3, m0 ; (p1 - q1 + 256)>>1
  229. pxor m4, m1
  230. pavgb m3, [pb_3] ; (((p1 - q1 + 256)>>1)+4)>>1 = 64+2+(p1-q1)>>2
  231. pavgb m4, m2 ; (q0 - p0 + 256)>>1
  232. pavgb m3, m5
  233. mova m6, [pb_A1]
  234. paddusb m3, m4 ; d+128+33
  235. psubusb m6, m3
  236. psubusb m3, [pb_A1]
  237. pminub m6, m7
  238. pminub m3, m7
  239. psubusb m1, m6
  240. psubusb m2, m3
  241. paddusb m1, m3
  242. paddusb m2, m6
  243. %endmacro
  244. ; in: m1=p0 m2=q0
  245. ; %1=p1 %2=q2 %3=[q2] %4=[q1] %5=tc0 %6=tmp
  246. ; out: [q1] = clip( (q2+((p0+q0+1)>>1))>>1, q1-tc0, q1+tc0 )
  247. ; clobbers: q2, tmp, tc0
  248. %macro LUMA_Q1 6
  249. pavgb %6, m1, m2
  250. pavgb %2, %6 ; avg(p2,avg(p0,q0))
  251. pxor %6, %3
  252. pand %6, [pb_1] ; (p2^avg(p0,q0))&1
  253. psubusb %2, %6 ; (p2+((p0+q0+1)>>1))>>1
  254. psubusb %6, %1, %5
  255. paddusb %5, %1
  256. pmaxub %2, %6
  257. pminub %2, %5
  258. mova %4, %2
  259. %endmacro
  260. %if ARCH_X86_64
  261. ;-----------------------------------------------------------------------------
  262. ; void deblock_v_luma( uint8_t *pix, int stride, int alpha, int beta, int8_t *tc0 )
  263. ;-----------------------------------------------------------------------------
  264. %macro DEBLOCK_LUMA 0
  265. cglobal deblock_v_luma_8, 5,5,10
  266. movd m8, [r4] ; tc0
  267. lea r4, [r1*3]
  268. dec r2d ; alpha-1
  269. neg r4
  270. dec r3d ; beta-1
  271. add r4, r0 ; pix-3*stride
  272. mova m0, [r4+r1] ; p1
  273. mova m1, [r4+2*r1] ; p0
  274. mova m2, [r0] ; q0
  275. mova m3, [r0+r1] ; q1
  276. LOAD_MASK r2d, r3d
  277. punpcklbw m8, m8
  278. punpcklbw m8, m8 ; tc = 4x tc0[3], 4x tc0[2], 4x tc0[1], 4x tc0[0]
  279. pcmpeqb m9, m9
  280. pcmpeqb m9, m8
  281. pandn m9, m7
  282. pand m8, m9
  283. movdqa m3, [r4] ; p2
  284. DIFF_GT2 m1, m3, m5, m6, m7 ; |p2-p0| > beta-1
  285. pand m6, m9
  286. psubb m7, m8, m6
  287. pand m6, m8
  288. LUMA_Q1 m0, m3, [r4], [r4+r1], m6, m4
  289. movdqa m4, [r0+2*r1] ; q2
  290. DIFF_GT2 m2, m4, m5, m6, m3 ; |q2-q0| > beta-1
  291. pand m6, m9
  292. pand m8, m6
  293. psubb m7, m6
  294. mova m3, [r0+r1]
  295. LUMA_Q1 m3, m4, [r0+2*r1], [r0+r1], m8, m6
  296. DEBLOCK_P0_Q0
  297. mova [r4+2*r1], m1
  298. mova [r0], m2
  299. RET
  300. ;-----------------------------------------------------------------------------
  301. ; void deblock_h_luma( uint8_t *pix, int stride, int alpha, int beta, int8_t *tc0 )
  302. ;-----------------------------------------------------------------------------
  303. INIT_MMX cpuname
  304. cglobal deblock_h_luma_8, 5,9
  305. movsxd r7, r1d
  306. lea r8, [r7+r7*2]
  307. lea r6, [r0-4]
  308. lea r5, [r0-4+r8]
  309. %if WIN64
  310. sub rsp, 0x98
  311. %define pix_tmp rsp+0x30
  312. %else
  313. sub rsp, 0x68
  314. %define pix_tmp rsp
  315. %endif
  316. ; transpose 6x16 -> tmp space
  317. TRANSPOSE6x8_MEM PASS8ROWS(r6, r5, r7, r8), pix_tmp
  318. lea r6, [r6+r7*8]
  319. lea r5, [r5+r7*8]
  320. TRANSPOSE6x8_MEM PASS8ROWS(r6, r5, r7, r8), pix_tmp+8
  321. ; vertical filter
  322. ; alpha, beta, tc0 are still in r2d, r3d, r4
  323. ; don't backup r6, r5, r7, r8 because deblock_v_luma_sse2 doesn't use them
  324. lea r0, [pix_tmp+0x30]
  325. mov r1d, 0x10
  326. %if WIN64
  327. mov [rsp+0x20], r4
  328. %endif
  329. call deblock_v_luma_8
  330. ; transpose 16x4 -> original space (only the middle 4 rows were changed by the filter)
  331. add r6, 2
  332. add r5, 2
  333. movq m0, [pix_tmp+0x18]
  334. movq m1, [pix_tmp+0x28]
  335. movq m2, [pix_tmp+0x38]
  336. movq m3, [pix_tmp+0x48]
  337. TRANSPOSE8x4B_STORE PASS8ROWS(r6, r5, r7, r8)
  338. shl r7, 3
  339. sub r6, r7
  340. sub r5, r7
  341. shr r7, 3
  342. movq m0, [pix_tmp+0x10]
  343. movq m1, [pix_tmp+0x20]
  344. movq m2, [pix_tmp+0x30]
  345. movq m3, [pix_tmp+0x40]
  346. TRANSPOSE8x4B_STORE PASS8ROWS(r6, r5, r7, r8)
  347. %if WIN64
  348. add rsp, 0x98
  349. %else
  350. add rsp, 0x68
  351. %endif
  352. RET
  353. %endmacro
  354. INIT_XMM sse2
  355. DEBLOCK_LUMA
  356. %if HAVE_AVX
  357. INIT_XMM avx
  358. DEBLOCK_LUMA
  359. %endif
  360. %else
  361. %macro DEBLOCK_LUMA 2
  362. ;-----------------------------------------------------------------------------
  363. ; void deblock_v8_luma( uint8_t *pix, int stride, int alpha, int beta, int8_t *tc0 )
  364. ;-----------------------------------------------------------------------------
  365. cglobal deblock_%1_luma_8, 5,5
  366. lea r4, [r1*3]
  367. dec r2 ; alpha-1
  368. neg r4
  369. dec r3 ; beta-1
  370. add r4, r0 ; pix-3*stride
  371. %assign pad 2*%2+12-(stack_offset&15)
  372. SUB esp, pad
  373. mova m0, [r4+r1] ; p1
  374. mova m1, [r4+2*r1] ; p0
  375. mova m2, [r0] ; q0
  376. mova m3, [r0+r1] ; q1
  377. LOAD_MASK r2, r3
  378. mov r3, r4mp
  379. pcmpeqb m3, m3
  380. movd m4, [r3] ; tc0
  381. punpcklbw m4, m4
  382. punpcklbw m4, m4 ; tc = 4x tc0[3], 4x tc0[2], 4x tc0[1], 4x tc0[0]
  383. mova [esp+%2], m4 ; tc
  384. pcmpgtb m4, m3
  385. mova m3, [r4] ; p2
  386. pand m4, m7
  387. mova [esp], m4 ; mask
  388. DIFF_GT2 m1, m3, m5, m6, m7 ; |p2-p0| > beta-1
  389. pand m6, m4
  390. pand m4, [esp+%2] ; tc
  391. psubb m7, m4, m6
  392. pand m6, m4
  393. LUMA_Q1 m0, m3, [r4], [r4+r1], m6, m4
  394. mova m4, [r0+2*r1] ; q2
  395. DIFF_GT2 m2, m4, m5, m6, m3 ; |q2-q0| > beta-1
  396. pand m6, [esp] ; mask
  397. mova m5, [esp+%2] ; tc
  398. psubb m7, m6
  399. pand m5, m6
  400. mova m3, [r0+r1]
  401. LUMA_Q1 m3, m4, [r0+2*r1], [r0+r1], m5, m6
  402. DEBLOCK_P0_Q0
  403. mova [r4+2*r1], m1
  404. mova [r0], m2
  405. ADD esp, pad
  406. RET
  407. ;-----------------------------------------------------------------------------
  408. ; void deblock_h_luma( uint8_t *pix, int stride, int alpha, int beta, int8_t *tc0 )
  409. ;-----------------------------------------------------------------------------
  410. INIT_MMX cpuname
  411. cglobal deblock_h_luma_8, 0,5
  412. mov r0, r0mp
  413. mov r3, r1m
  414. lea r4, [r3*3]
  415. sub r0, 4
  416. lea r1, [r0+r4]
  417. %assign pad 0x78-(stack_offset&15)
  418. SUB esp, pad
  419. %define pix_tmp esp+12
  420. ; transpose 6x16 -> tmp space
  421. TRANSPOSE6x8_MEM PASS8ROWS(r0, r1, r3, r4), pix_tmp
  422. lea r0, [r0+r3*8]
  423. lea r1, [r1+r3*8]
  424. TRANSPOSE6x8_MEM PASS8ROWS(r0, r1, r3, r4), pix_tmp+8
  425. ; vertical filter
  426. lea r0, [pix_tmp+0x30]
  427. PUSH dword r4m
  428. PUSH dword r3m
  429. PUSH dword r2m
  430. PUSH dword 16
  431. PUSH dword r0
  432. call deblock_%1_luma_8
  433. %ifidn %1, v8
  434. add dword [esp ], 8 ; pix_tmp+0x38
  435. add dword [esp+16], 2 ; tc0+2
  436. call deblock_%1_luma_8
  437. %endif
  438. ADD esp, 20
  439. ; transpose 16x4 -> original space (only the middle 4 rows were changed by the filter)
  440. mov r0, r0mp
  441. sub r0, 2
  442. movq m0, [pix_tmp+0x10]
  443. movq m1, [pix_tmp+0x20]
  444. lea r1, [r0+r4]
  445. movq m2, [pix_tmp+0x30]
  446. movq m3, [pix_tmp+0x40]
  447. TRANSPOSE8x4B_STORE PASS8ROWS(r0, r1, r3, r4)
  448. lea r0, [r0+r3*8]
  449. lea r1, [r1+r3*8]
  450. movq m0, [pix_tmp+0x18]
  451. movq m1, [pix_tmp+0x28]
  452. movq m2, [pix_tmp+0x38]
  453. movq m3, [pix_tmp+0x48]
  454. TRANSPOSE8x4B_STORE PASS8ROWS(r0, r1, r3, r4)
  455. ADD esp, pad
  456. RET
  457. %endmacro ; DEBLOCK_LUMA
  458. INIT_MMX mmx2
  459. DEBLOCK_LUMA v8, 8
  460. INIT_XMM sse2
  461. DEBLOCK_LUMA v, 16
  462. %if HAVE_AVX
  463. INIT_XMM avx
  464. DEBLOCK_LUMA v, 16
  465. %endif
  466. %endif ; ARCH
  467. %macro LUMA_INTRA_P012 4 ; p0..p3 in memory
  468. %if ARCH_X86_64
  469. pavgb t0, p2, p1
  470. pavgb t1, p0, q0
  471. %else
  472. mova t0, p2
  473. mova t1, p0
  474. pavgb t0, p1
  475. pavgb t1, q0
  476. %endif
  477. pavgb t0, t1 ; ((p2+p1+1)/2 + (p0+q0+1)/2 + 1)/2
  478. mova t5, t1
  479. %if ARCH_X86_64
  480. paddb t2, p2, p1
  481. paddb t3, p0, q0
  482. %else
  483. mova t2, p2
  484. mova t3, p0
  485. paddb t2, p1
  486. paddb t3, q0
  487. %endif
  488. paddb t2, t3
  489. mova t3, t2
  490. mova t4, t2
  491. psrlw t2, 1
  492. pavgb t2, mpb_0
  493. pxor t2, t0
  494. pand t2, mpb_1
  495. psubb t0, t2 ; p1' = (p2+p1+p0+q0+2)/4;
  496. %if ARCH_X86_64
  497. pavgb t1, p2, q1
  498. psubb t2, p2, q1
  499. %else
  500. mova t1, p2
  501. mova t2, p2
  502. pavgb t1, q1
  503. psubb t2, q1
  504. %endif
  505. paddb t3, t3
  506. psubb t3, t2 ; p2+2*p1+2*p0+2*q0+q1
  507. pand t2, mpb_1
  508. psubb t1, t2
  509. pavgb t1, p1
  510. pavgb t1, t5 ; (((p2+q1)/2 + p1+1)/2 + (p0+q0+1)/2 + 1)/2
  511. psrlw t3, 2
  512. pavgb t3, mpb_0
  513. pxor t3, t1
  514. pand t3, mpb_1
  515. psubb t1, t3 ; p0'a = (p2+2*p1+2*p0+2*q0+q1+4)/8
  516. pxor t3, p0, q1
  517. pavgb t2, p0, q1
  518. pand t3, mpb_1
  519. psubb t2, t3
  520. pavgb t2, p1 ; p0'b = (2*p1+p0+q0+2)/4
  521. pxor t1, t2
  522. pxor t2, p0
  523. pand t1, mask1p
  524. pand t2, mask0
  525. pxor t1, t2
  526. pxor t1, p0
  527. mova %1, t1 ; store p0
  528. mova t1, %4 ; p3
  529. paddb t2, t1, p2
  530. pavgb t1, p2
  531. pavgb t1, t0 ; (p3+p2+1)/2 + (p2+p1+p0+q0+2)/4
  532. paddb t2, t2
  533. paddb t2, t4 ; 2*p3+3*p2+p1+p0+q0
  534. psrlw t2, 2
  535. pavgb t2, mpb_0
  536. pxor t2, t1
  537. pand t2, mpb_1
  538. psubb t1, t2 ; p2' = (2*p3+3*p2+p1+p0+q0+4)/8
  539. pxor t0, p1
  540. pxor t1, p2
  541. pand t0, mask1p
  542. pand t1, mask1p
  543. pxor t0, p1
  544. pxor t1, p2
  545. mova %2, t0 ; store p1
  546. mova %3, t1 ; store p2
  547. %endmacro
  548. %macro LUMA_INTRA_SWAP_PQ 0
  549. %define q1 m0
  550. %define q0 m1
  551. %define p0 m2
  552. %define p1 m3
  553. %define p2 q2
  554. %define mask1p mask1q
  555. %endmacro
  556. %macro DEBLOCK_LUMA_INTRA 1
  557. %define p1 m0
  558. %define p0 m1
  559. %define q0 m2
  560. %define q1 m3
  561. %define t0 m4
  562. %define t1 m5
  563. %define t2 m6
  564. %define t3 m7
  565. %if ARCH_X86_64
  566. %define p2 m8
  567. %define q2 m9
  568. %define t4 m10
  569. %define t5 m11
  570. %define mask0 m12
  571. %define mask1p m13
  572. %define mask1q [rsp-24]
  573. %define mpb_0 m14
  574. %define mpb_1 m15
  575. %else
  576. %define spill(x) [esp+16*x+((stack_offset+4)&15)]
  577. %define p2 [r4+r1]
  578. %define q2 [r0+2*r1]
  579. %define t4 spill(0)
  580. %define t5 spill(1)
  581. %define mask0 spill(2)
  582. %define mask1p spill(3)
  583. %define mask1q spill(4)
  584. %define mpb_0 [pb_0]
  585. %define mpb_1 [pb_1]
  586. %endif
  587. ;-----------------------------------------------------------------------------
  588. ; void deblock_v_luma_intra( uint8_t *pix, int stride, int alpha, int beta )
  589. ;-----------------------------------------------------------------------------
  590. cglobal deblock_%1_luma_intra_8, 4,6,16
  591. %if ARCH_X86_64 == 0
  592. sub esp, 0x60
  593. %endif
  594. lea r4, [r1*4]
  595. lea r5, [r1*3] ; 3*stride
  596. dec r2d ; alpha-1
  597. jl .end
  598. neg r4
  599. dec r3d ; beta-1
  600. jl .end
  601. add r4, r0 ; pix-4*stride
  602. mova p1, [r4+2*r1]
  603. mova p0, [r4+r5]
  604. mova q0, [r0]
  605. mova q1, [r0+r1]
  606. %if ARCH_X86_64
  607. pxor mpb_0, mpb_0
  608. mova mpb_1, [pb_1]
  609. LOAD_MASK r2d, r3d, t5 ; m5=beta-1, t5=alpha-1, m7=mask0
  610. SWAP 7, 12 ; m12=mask0
  611. pavgb t5, mpb_0
  612. pavgb t5, mpb_1 ; alpha/4+1
  613. movdqa p2, [r4+r1]
  614. movdqa q2, [r0+2*r1]
  615. DIFF_GT2 p0, q0, t5, t0, t3 ; t0 = |p0-q0| > alpha/4+1
  616. DIFF_GT2 p0, p2, m5, t2, t5 ; mask1 = |p2-p0| > beta-1
  617. DIFF_GT2 q0, q2, m5, t4, t5 ; t4 = |q2-q0| > beta-1
  618. pand t0, mask0
  619. pand t4, t0
  620. pand t2, t0
  621. mova mask1q, t4
  622. mova mask1p, t2
  623. %else
  624. LOAD_MASK r2d, r3d, t5 ; m5=beta-1, t5=alpha-1, m7=mask0
  625. mova m4, t5
  626. mova mask0, m7
  627. pavgb m4, [pb_0]
  628. pavgb m4, [pb_1] ; alpha/4+1
  629. DIFF_GT2 p0, q0, m4, m6, m7 ; m6 = |p0-q0| > alpha/4+1
  630. pand m6, mask0
  631. DIFF_GT2 p0, p2, m5, m4, m7 ; m4 = |p2-p0| > beta-1
  632. pand m4, m6
  633. mova mask1p, m4
  634. DIFF_GT2 q0, q2, m5, m4, m7 ; m4 = |q2-q0| > beta-1
  635. pand m4, m6
  636. mova mask1q, m4
  637. %endif
  638. LUMA_INTRA_P012 [r4+r5], [r4+2*r1], [r4+r1], [r4]
  639. LUMA_INTRA_SWAP_PQ
  640. LUMA_INTRA_P012 [r0], [r0+r1], [r0+2*r1], [r0+r5]
  641. .end:
  642. %if ARCH_X86_64 == 0
  643. add esp, 0x60
  644. %endif
  645. RET
  646. INIT_MMX cpuname
  647. %if ARCH_X86_64
  648. ;-----------------------------------------------------------------------------
  649. ; void deblock_h_luma_intra( uint8_t *pix, int stride, int alpha, int beta )
  650. ;-----------------------------------------------------------------------------
  651. cglobal deblock_h_luma_intra_8, 4,9
  652. movsxd r7, r1d
  653. lea r8, [r7*3]
  654. lea r6, [r0-4]
  655. lea r5, [r0-4+r8]
  656. sub rsp, 0x88
  657. %define pix_tmp rsp
  658. ; transpose 8x16 -> tmp space
  659. TRANSPOSE8x8_MEM PASS8ROWS(r6, r5, r7, r8), PASS8ROWS(pix_tmp, pix_tmp+0x30, 0x10, 0x30)
  660. lea r6, [r6+r7*8]
  661. lea r5, [r5+r7*8]
  662. TRANSPOSE8x8_MEM PASS8ROWS(r6, r5, r7, r8), PASS8ROWS(pix_tmp+8, pix_tmp+0x38, 0x10, 0x30)
  663. lea r0, [pix_tmp+0x40]
  664. mov r1, 0x10
  665. call deblock_v_luma_intra_8
  666. ; transpose 16x6 -> original space (but we can't write only 6 pixels, so really 16x8)
  667. lea r5, [r6+r8]
  668. TRANSPOSE8x8_MEM PASS8ROWS(pix_tmp+8, pix_tmp+0x38, 0x10, 0x30), PASS8ROWS(r6, r5, r7, r8)
  669. shl r7, 3
  670. sub r6, r7
  671. sub r5, r7
  672. shr r7, 3
  673. TRANSPOSE8x8_MEM PASS8ROWS(pix_tmp, pix_tmp+0x30, 0x10, 0x30), PASS8ROWS(r6, r5, r7, r8)
  674. add rsp, 0x88
  675. RET
  676. %else
  677. cglobal deblock_h_luma_intra_8, 2,4
  678. lea r3, [r1*3]
  679. sub r0, 4
  680. lea r2, [r0+r3]
  681. %assign pad 0x8c-(stack_offset&15)
  682. SUB rsp, pad
  683. %define pix_tmp rsp
  684. ; transpose 8x16 -> tmp space
  685. TRANSPOSE8x8_MEM PASS8ROWS(r0, r2, r1, r3), PASS8ROWS(pix_tmp, pix_tmp+0x30, 0x10, 0x30)
  686. lea r0, [r0+r1*8]
  687. lea r2, [r2+r1*8]
  688. TRANSPOSE8x8_MEM PASS8ROWS(r0, r2, r1, r3), PASS8ROWS(pix_tmp+8, pix_tmp+0x38, 0x10, 0x30)
  689. lea r0, [pix_tmp+0x40]
  690. PUSH dword r3m
  691. PUSH dword r2m
  692. PUSH dword 16
  693. PUSH r0
  694. call deblock_%1_luma_intra_8
  695. %ifidn %1, v8
  696. add dword [rsp], 8 ; pix_tmp+8
  697. call deblock_%1_luma_intra_8
  698. %endif
  699. ADD esp, 16
  700. mov r1, r1m
  701. mov r0, r0mp
  702. lea r3, [r1*3]
  703. sub r0, 4
  704. lea r2, [r0+r3]
  705. ; transpose 16x6 -> original space (but we can't write only 6 pixels, so really 16x8)
  706. TRANSPOSE8x8_MEM PASS8ROWS(pix_tmp, pix_tmp+0x30, 0x10, 0x30), PASS8ROWS(r0, r2, r1, r3)
  707. lea r0, [r0+r1*8]
  708. lea r2, [r2+r1*8]
  709. TRANSPOSE8x8_MEM PASS8ROWS(pix_tmp+8, pix_tmp+0x38, 0x10, 0x30), PASS8ROWS(r0, r2, r1, r3)
  710. ADD rsp, pad
  711. RET
  712. %endif ; ARCH_X86_64
  713. %endmacro ; DEBLOCK_LUMA_INTRA
  714. INIT_XMM sse2
  715. DEBLOCK_LUMA_INTRA v
  716. %if HAVE_AVX
  717. INIT_XMM avx
  718. DEBLOCK_LUMA_INTRA v
  719. %endif
  720. %if ARCH_X86_64 == 0
  721. INIT_MMX mmx2
  722. DEBLOCK_LUMA_INTRA v8
  723. %endif
  724. INIT_MMX mmx2
  725. %macro CHROMA_V_START 0
  726. dec r2d ; alpha-1
  727. dec r3d ; beta-1
  728. mov t5, r0
  729. sub t5, r1
  730. sub t5, r1
  731. %endmacro
  732. %macro CHROMA_H_START 0
  733. dec r2d
  734. dec r3d
  735. sub r0, 2
  736. lea t6, [r1*3]
  737. mov t5, r0
  738. add r0, t6
  739. %endmacro
  740. %define t5 r5
  741. %define t6 r6
  742. ;-----------------------------------------------------------------------------
  743. ; void ff_deblock_v_chroma( uint8_t *pix, int stride, int alpha, int beta, int8_t *tc0 )
  744. ;-----------------------------------------------------------------------------
  745. cglobal deblock_v_chroma_8, 5,6
  746. CHROMA_V_START
  747. movq m0, [t5]
  748. movq m1, [t5+r1]
  749. movq m2, [r0]
  750. movq m3, [r0+r1]
  751. call ff_chroma_inter_body_mmx2
  752. movq [t5+r1], m1
  753. movq [r0], m2
  754. RET
  755. ;-----------------------------------------------------------------------------
  756. ; void ff_deblock_h_chroma( uint8_t *pix, int stride, int alpha, int beta, int8_t *tc0 )
  757. ;-----------------------------------------------------------------------------
  758. cglobal deblock_h_chroma_8, 5,7
  759. %if UNIX64
  760. %define buf0 [rsp-24]
  761. %define buf1 [rsp-16]
  762. %elif WIN64
  763. sub rsp, 16
  764. %define buf0 [rsp]
  765. %define buf1 [rsp+8]
  766. %else
  767. %define buf0 r0m
  768. %define buf1 r2m
  769. %endif
  770. CHROMA_H_START
  771. TRANSPOSE4x8_LOAD bw, wd, dq, PASS8ROWS(t5, r0, r1, t6)
  772. movq buf0, m0
  773. movq buf1, m3
  774. LOAD_MASK r2d, r3d
  775. movd m6, [r4] ; tc0
  776. punpcklbw m6, m6
  777. pand m7, m6
  778. DEBLOCK_P0_Q0
  779. movq m0, buf0
  780. movq m3, buf1
  781. TRANSPOSE8x4B_STORE PASS8ROWS(t5, r0, r1, t6)
  782. %if WIN64
  783. add rsp, 16
  784. %endif
  785. RET
  786. ALIGN 16
  787. ff_chroma_inter_body_mmx2:
  788. LOAD_MASK r2d, r3d
  789. movd m6, [r4] ; tc0
  790. punpcklbw m6, m6
  791. pand m7, m6
  792. DEBLOCK_P0_Q0
  793. ret
  794. ; in: %1=p0 %2=p1 %3=q1
  795. ; out: p0 = (p0 + q1 + 2*p1 + 2) >> 2
  796. %macro CHROMA_INTRA_P0 3
  797. movq m4, %1
  798. pxor m4, %3
  799. pand m4, [pb_1] ; m4 = (p0^q1)&1
  800. pavgb %1, %3
  801. psubusb %1, m4
  802. pavgb %1, %2 ; dst = avg(p1, avg(p0,q1) - ((p0^q1)&1))
  803. %endmacro
  804. %define t5 r4
  805. %define t6 r5
  806. ;-----------------------------------------------------------------------------
  807. ; void ff_deblock_v_chroma_intra( uint8_t *pix, int stride, int alpha, int beta )
  808. ;-----------------------------------------------------------------------------
  809. cglobal deblock_v_chroma_intra_8, 4,5
  810. CHROMA_V_START
  811. movq m0, [t5]
  812. movq m1, [t5+r1]
  813. movq m2, [r0]
  814. movq m3, [r0+r1]
  815. call ff_chroma_intra_body_mmx2
  816. movq [t5+r1], m1
  817. movq [r0], m2
  818. RET
  819. ;-----------------------------------------------------------------------------
  820. ; void ff_deblock_h_chroma_intra( uint8_t *pix, int stride, int alpha, int beta )
  821. ;-----------------------------------------------------------------------------
  822. cglobal deblock_h_chroma_intra_8, 4,6
  823. CHROMA_H_START
  824. TRANSPOSE4x8_LOAD bw, wd, dq, PASS8ROWS(t5, r0, r1, t6)
  825. call ff_chroma_intra_body_mmx2
  826. TRANSPOSE8x4B_STORE PASS8ROWS(t5, r0, r1, t6)
  827. RET
  828. ALIGN 16
  829. ff_chroma_intra_body_mmx2:
  830. LOAD_MASK r2d, r3d
  831. movq m5, m1
  832. movq m6, m2
  833. CHROMA_INTRA_P0 m1, m0, m3
  834. CHROMA_INTRA_P0 m2, m3, m0
  835. psubb m1, m5
  836. psubb m2, m6
  837. pand m1, m7
  838. pand m2, m7
  839. paddb m1, m5
  840. paddb m2, m6
  841. ret