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

1082 lines
28KB

  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 Libav.
  11. ;*
  12. ;* Libav 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. ;* Libav 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 Libav; if not, write to the Free Software
  24. ;* Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
  25. ;******************************************************************************
  26. %include "x86inc.asm"
  27. %include "x86util.asm"
  28. SECTION_RODATA
  29. pb_3_1: times 4 db 3, 1
  30. SECTION .text
  31. cextern pb_0
  32. cextern pb_1
  33. cextern pb_3
  34. cextern pb_A1
  35. ; expands to [base],...,[base+7*stride]
  36. %define PASS8ROWS(base, base3, stride, stride3) \
  37. [base], [base+stride], [base+stride*2], [base3], \
  38. [base3+stride], [base3+stride*2], [base3+stride3], [base3+stride*4]
  39. %define PASS8ROWS(base, base3, stride, stride3, offset) \
  40. PASS8ROWS(base+offset, base3+offset, stride, stride3)
  41. ; in: 8 rows of 4 bytes in %4..%11
  42. ; out: 4 rows of 8 bytes in m0..m3
  43. %macro TRANSPOSE4x8_LOAD 11
  44. movh m0, %4
  45. movh m2, %5
  46. movh m1, %6
  47. movh m3, %7
  48. punpckl%1 m0, m2
  49. punpckl%1 m1, m3
  50. mova m2, m0
  51. punpckl%2 m0, m1
  52. punpckh%2 m2, m1
  53. movh m4, %8
  54. movh m6, %9
  55. movh m5, %10
  56. movh m7, %11
  57. punpckl%1 m4, m6
  58. punpckl%1 m5, m7
  59. mova m6, m4
  60. punpckl%2 m4, m5
  61. punpckh%2 m6, m5
  62. punpckh%3 m1, m0, m4
  63. punpckh%3 m3, m2, m6
  64. punpckl%3 m0, m4
  65. punpckl%3 m2, m6
  66. %endmacro
  67. ; in: 4 rows of 8 bytes in m0..m3
  68. ; out: 8 rows of 4 bytes in %1..%8
  69. %macro TRANSPOSE8x4B_STORE 8
  70. punpckhdq m4, m0, m0
  71. punpckhdq m5, m1, m1
  72. punpckhdq m6, m2, m2
  73. punpcklbw m0, m1
  74. punpcklbw m2, m3
  75. punpcklwd m1, m0, m2
  76. punpckhwd m0, m2
  77. movh %1, m1
  78. punpckhdq m1, m1
  79. movh %2, m1
  80. movh %3, m0
  81. punpckhdq m0, m0
  82. movh %4, m0
  83. punpckhdq m3, m3
  84. punpcklbw m4, m5
  85. punpcklbw m6, m3
  86. punpcklwd m5, m4, m6
  87. punpckhwd m4, m6
  88. movh %5, m5
  89. punpckhdq m5, m5
  90. movh %6, m5
  91. movh %7, m4
  92. punpckhdq m4, m4
  93. movh %8, m4
  94. %endmacro
  95. %macro TRANSPOSE4x8B_LOAD 8
  96. TRANSPOSE4x8_LOAD bw, wd, dq, %1, %2, %3, %4, %5, %6, %7, %8
  97. %endmacro
  98. %macro SBUTTERFLY3 4
  99. punpckh%1 %4, %2, %3
  100. punpckl%1 %2, %3
  101. %endmacro
  102. ; in: 8 rows of 8 (only the middle 6 pels are used) in %1..%8
  103. ; out: 6 rows of 8 in [%9+0*16] .. [%9+5*16]
  104. %macro TRANSPOSE6x8_MEM 9
  105. RESET_MM_PERMUTATION
  106. movq m0, %1
  107. movq m1, %2
  108. movq m2, %3
  109. movq m3, %4
  110. movq m4, %5
  111. movq m5, %6
  112. movq m6, %7
  113. SBUTTERFLY bw, 0, 1, 7
  114. SBUTTERFLY bw, 2, 3, 7
  115. SBUTTERFLY bw, 4, 5, 7
  116. movq [%9+0x10], m3
  117. SBUTTERFLY3 bw, m6, %8, m7
  118. SBUTTERFLY wd, 0, 2, 3
  119. SBUTTERFLY wd, 4, 6, 3
  120. punpckhdq m0, m4
  121. movq [%9+0x00], m0
  122. SBUTTERFLY3 wd, m1, [%9+0x10], m3
  123. SBUTTERFLY wd, 5, 7, 0
  124. SBUTTERFLY dq, 1, 5, 0
  125. SBUTTERFLY dq, 2, 6, 0
  126. punpckldq m3, m7
  127. movq [%9+0x10], m2
  128. movq [%9+0x20], m6
  129. movq [%9+0x30], m1
  130. movq [%9+0x40], m5
  131. movq [%9+0x50], m3
  132. RESET_MM_PERMUTATION
  133. %endmacro
  134. ; in: 8 rows of 8 in %1..%8
  135. ; out: 8 rows of 8 in %9..%16
  136. %macro TRANSPOSE8x8_MEM 16
  137. RESET_MM_PERMUTATION
  138. movq m0, %1
  139. movq m1, %2
  140. movq m2, %3
  141. movq m3, %4
  142. movq m4, %5
  143. movq m5, %6
  144. movq m6, %7
  145. SBUTTERFLY bw, 0, 1, 7
  146. SBUTTERFLY bw, 2, 3, 7
  147. SBUTTERFLY bw, 4, 5, 7
  148. SBUTTERFLY3 bw, m6, %8, m7
  149. movq %9, m5
  150. SBUTTERFLY wd, 0, 2, 5
  151. SBUTTERFLY wd, 4, 6, 5
  152. SBUTTERFLY wd, 1, 3, 5
  153. movq %11, m6
  154. movq m6, %9
  155. SBUTTERFLY wd, 6, 7, 5
  156. SBUTTERFLY dq, 0, 4, 5
  157. SBUTTERFLY dq, 1, 6, 5
  158. movq %9, m0
  159. movq %10, m4
  160. movq %13, m1
  161. movq %14, m6
  162. SBUTTERFLY3 dq, m2, %11, m0
  163. SBUTTERFLY dq, 3, 7, 4
  164. movq %11, m2
  165. movq %12, m0
  166. movq %15, m3
  167. movq %16, m7
  168. RESET_MM_PERMUTATION
  169. %endmacro
  170. ; out: %4 = |%1-%2|>%3
  171. ; clobbers: %5
  172. %macro DIFF_GT 5
  173. %if avx_enabled == 0
  174. mova %5, %2
  175. mova %4, %1
  176. psubusb %5, %1
  177. psubusb %4, %2
  178. %else
  179. psubusb %5, %2, %1
  180. psubusb %4, %1, %2
  181. %endif
  182. por %4, %5
  183. psubusb %4, %3
  184. %endmacro
  185. ; out: %4 = |%1-%2|>%3
  186. ; clobbers: %5
  187. %macro DIFF_GT2 5
  188. %if ARCH_X86_64
  189. psubusb %5, %2, %1
  190. psubusb %4, %1, %2
  191. %else
  192. mova %5, %2
  193. mova %4, %1
  194. psubusb %5, %1
  195. psubusb %4, %2
  196. %endif
  197. psubusb %5, %3
  198. psubusb %4, %3
  199. pcmpeqb %4, %5
  200. %endmacro
  201. ; in: m0=p1 m1=p0 m2=q0 m3=q1 %1=alpha-1 %2=beta-1
  202. ; out: m5=beta-1, m7=mask, %3=alpha-1
  203. ; clobbers: m4,m6
  204. %macro LOAD_MASK 2-3
  205. movd m4, %1
  206. movd m5, %2
  207. SPLATW m4, m4
  208. SPLATW m5, m5
  209. packuswb m4, m4 ; 16x alpha-1
  210. packuswb m5, m5 ; 16x beta-1
  211. %if %0>2
  212. mova %3, m4
  213. %endif
  214. DIFF_GT m1, m2, m4, m7, m6 ; |p0-q0| > alpha-1
  215. DIFF_GT m0, m1, m5, m4, m6 ; |p1-p0| > beta-1
  216. por m7, m4
  217. DIFF_GT m3, m2, m5, m4, m6 ; |q1-q0| > beta-1
  218. por m7, m4
  219. pxor m6, m6
  220. pcmpeqb m7, m6
  221. %endmacro
  222. ; in: m0=p1 m1=p0 m2=q0 m3=q1 m7=(tc&mask)
  223. ; out: m1=p0' m2=q0'
  224. ; clobbers: m0,3-6
  225. %macro DEBLOCK_P0_Q0 0
  226. pcmpeqb m4, m4
  227. pxor m5, m1, m2 ; p0^q0
  228. pxor m3, m4
  229. pand m5, [pb_1] ; (p0^q0)&1
  230. pavgb m3, m0 ; (p1 - q1 + 256)>>1
  231. pxor m4, m1
  232. pavgb m3, [pb_3] ; (((p1 - q1 + 256)>>1)+4)>>1 = 64+2+(p1-q1)>>2
  233. pavgb m4, m2 ; (q0 - p0 + 256)>>1
  234. pavgb m3, m5
  235. mova m6, [pb_A1]
  236. paddusb m3, m4 ; d+128+33
  237. psubusb m6, m3
  238. psubusb m3, [pb_A1]
  239. pminub m6, m7
  240. pminub m3, m7
  241. psubusb m1, m6
  242. psubusb m2, m3
  243. paddusb m1, m3
  244. paddusb m2, m6
  245. %endmacro
  246. ; in: m1=p0 m2=q0
  247. ; %1=p1 %2=q2 %3=[q2] %4=[q1] %5=tc0 %6=tmp
  248. ; out: [q1] = clip( (q2+((p0+q0+1)>>1))>>1, q1-tc0, q1+tc0 )
  249. ; clobbers: q2, tmp, tc0
  250. %macro LUMA_Q1 6
  251. pavgb %6, m1, m2
  252. pavgb %2, %6 ; avg(p2,avg(p0,q0))
  253. pxor %6, %3
  254. pand %6, [pb_1] ; (p2^avg(p0,q0))&1
  255. psubusb %2, %6 ; (p2+((p0+q0+1)>>1))>>1
  256. psubusb %6, %1, %5
  257. paddusb %5, %1
  258. pmaxub %2, %6
  259. pminub %2, %5
  260. mova %4, %2
  261. %endmacro
  262. %if ARCH_X86_64
  263. ;-----------------------------------------------------------------------------
  264. ; void deblock_v_luma( uint8_t *pix, int stride, int alpha, int beta, int8_t *tc0 )
  265. ;-----------------------------------------------------------------------------
  266. %macro DEBLOCK_LUMA 0
  267. cglobal deblock_v_luma_8, 5,5,10
  268. movd m8, [r4] ; tc0
  269. lea r4, [r1*3]
  270. dec r2d ; alpha-1
  271. neg r4
  272. dec r3d ; beta-1
  273. add r4, r0 ; pix-3*stride
  274. mova m0, [r4+r1] ; p1
  275. mova m1, [r4+2*r1] ; p0
  276. mova m2, [r0] ; q0
  277. mova m3, [r0+r1] ; q1
  278. LOAD_MASK r2d, r3d
  279. punpcklbw m8, m8
  280. punpcklbw m8, m8 ; tc = 4x tc0[3], 4x tc0[2], 4x tc0[1], 4x tc0[0]
  281. pcmpeqb m9, m9
  282. pcmpeqb m9, m8
  283. pandn m9, m7
  284. pand m8, m9
  285. movdqa m3, [r4] ; p2
  286. DIFF_GT2 m1, m3, m5, m6, m7 ; |p2-p0| > beta-1
  287. pand m6, m9
  288. psubb m7, m8, m6
  289. pand m6, m8
  290. LUMA_Q1 m0, m3, [r4], [r4+r1], m6, m4
  291. movdqa m4, [r0+2*r1] ; q2
  292. DIFF_GT2 m2, m4, m5, m6, m3 ; |q2-q0| > beta-1
  293. pand m6, m9
  294. pand m8, m6
  295. psubb m7, m6
  296. mova m3, [r0+r1]
  297. LUMA_Q1 m3, m4, [r0+2*r1], [r0+r1], m8, m6
  298. DEBLOCK_P0_Q0
  299. mova [r4+2*r1], m1
  300. mova [r0], m2
  301. RET
  302. ;-----------------------------------------------------------------------------
  303. ; void deblock_h_luma( uint8_t *pix, int stride, int alpha, int beta, int8_t *tc0 )
  304. ;-----------------------------------------------------------------------------
  305. INIT_MMX cpuname
  306. cglobal deblock_h_luma_8, 5,9
  307. movsxd r7, r1d
  308. lea r8, [r7+r7*2]
  309. lea r6, [r0-4]
  310. lea r5, [r0-4+r8]
  311. %if WIN64
  312. sub rsp, 0x98
  313. %define pix_tmp rsp+0x30
  314. %else
  315. sub rsp, 0x68
  316. %define pix_tmp rsp
  317. %endif
  318. ; transpose 6x16 -> tmp space
  319. TRANSPOSE6x8_MEM PASS8ROWS(r6, r5, r7, r8), pix_tmp
  320. lea r6, [r6+r7*8]
  321. lea r5, [r5+r7*8]
  322. TRANSPOSE6x8_MEM PASS8ROWS(r6, r5, r7, r8), pix_tmp+8
  323. ; vertical filter
  324. ; alpha, beta, tc0 are still in r2d, r3d, r4
  325. ; don't backup r6, r5, r7, r8 because deblock_v_luma_sse2 doesn't use them
  326. lea r0, [pix_tmp+0x30]
  327. mov r1d, 0x10
  328. %if WIN64
  329. mov [rsp+0x20], r4
  330. %endif
  331. call deblock_v_luma_8
  332. ; transpose 16x4 -> original space (only the middle 4 rows were changed by the filter)
  333. add r6, 2
  334. add r5, 2
  335. movq m0, [pix_tmp+0x18]
  336. movq m1, [pix_tmp+0x28]
  337. movq m2, [pix_tmp+0x38]
  338. movq m3, [pix_tmp+0x48]
  339. TRANSPOSE8x4B_STORE PASS8ROWS(r6, r5, r7, r8)
  340. shl r7, 3
  341. sub r6, r7
  342. sub r5, r7
  343. shr r7, 3
  344. movq m0, [pix_tmp+0x10]
  345. movq m1, [pix_tmp+0x20]
  346. movq m2, [pix_tmp+0x30]
  347. movq m3, [pix_tmp+0x40]
  348. TRANSPOSE8x4B_STORE PASS8ROWS(r6, r5, r7, r8)
  349. %if WIN64
  350. add rsp, 0x98
  351. %else
  352. add rsp, 0x68
  353. %endif
  354. RET
  355. %endmacro
  356. INIT_XMM sse2
  357. DEBLOCK_LUMA
  358. INIT_XMM avx
  359. DEBLOCK_LUMA
  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. INIT_XMM avx
  463. DEBLOCK_LUMA v, 16
  464. %endif ; ARCH
  465. %macro LUMA_INTRA_P012 4 ; p0..p3 in memory
  466. %if ARCH_X86_64
  467. pavgb t0, p2, p1
  468. pavgb t1, p0, q0
  469. %else
  470. mova t0, p2
  471. mova t1, p0
  472. pavgb t0, p1
  473. pavgb t1, q0
  474. %endif
  475. pavgb t0, t1 ; ((p2+p1+1)/2 + (p0+q0+1)/2 + 1)/2
  476. mova t5, t1
  477. %if ARCH_X86_64
  478. paddb t2, p2, p1
  479. paddb t3, p0, q0
  480. %else
  481. mova t2, p2
  482. mova t3, p0
  483. paddb t2, p1
  484. paddb t3, q0
  485. %endif
  486. paddb t2, t3
  487. mova t3, t2
  488. mova t4, t2
  489. psrlw t2, 1
  490. pavgb t2, mpb_0
  491. pxor t2, t0
  492. pand t2, mpb_1
  493. psubb t0, t2 ; p1' = (p2+p1+p0+q0+2)/4;
  494. %if ARCH_X86_64
  495. pavgb t1, p2, q1
  496. psubb t2, p2, q1
  497. %else
  498. mova t1, p2
  499. mova t2, p2
  500. pavgb t1, q1
  501. psubb t2, q1
  502. %endif
  503. paddb t3, t3
  504. psubb t3, t2 ; p2+2*p1+2*p0+2*q0+q1
  505. pand t2, mpb_1
  506. psubb t1, t2
  507. pavgb t1, p1
  508. pavgb t1, t5 ; (((p2+q1)/2 + p1+1)/2 + (p0+q0+1)/2 + 1)/2
  509. psrlw t3, 2
  510. pavgb t3, mpb_0
  511. pxor t3, t1
  512. pand t3, mpb_1
  513. psubb t1, t3 ; p0'a = (p2+2*p1+2*p0+2*q0+q1+4)/8
  514. pxor t3, p0, q1
  515. pavgb t2, p0, q1
  516. pand t3, mpb_1
  517. psubb t2, t3
  518. pavgb t2, p1 ; p0'b = (2*p1+p0+q0+2)/4
  519. pxor t1, t2
  520. pxor t2, p0
  521. pand t1, mask1p
  522. pand t2, mask0
  523. pxor t1, t2
  524. pxor t1, p0
  525. mova %1, t1 ; store p0
  526. mova t1, %4 ; p3
  527. paddb t2, t1, p2
  528. pavgb t1, p2
  529. pavgb t1, t0 ; (p3+p2+1)/2 + (p2+p1+p0+q0+2)/4
  530. paddb t2, t2
  531. paddb t2, t4 ; 2*p3+3*p2+p1+p0+q0
  532. psrlw t2, 2
  533. pavgb t2, mpb_0
  534. pxor t2, t1
  535. pand t2, mpb_1
  536. psubb t1, t2 ; p2' = (2*p3+3*p2+p1+p0+q0+4)/8
  537. pxor t0, p1
  538. pxor t1, p2
  539. pand t0, mask1p
  540. pand t1, mask1p
  541. pxor t0, p1
  542. pxor t1, p2
  543. mova %2, t0 ; store p1
  544. mova %3, t1 ; store p2
  545. %endmacro
  546. %macro LUMA_INTRA_SWAP_PQ 0
  547. %define q1 m0
  548. %define q0 m1
  549. %define p0 m2
  550. %define p1 m3
  551. %define p2 q2
  552. %define mask1p mask1q
  553. %endmacro
  554. %macro DEBLOCK_LUMA_INTRA 1
  555. %define p1 m0
  556. %define p0 m1
  557. %define q0 m2
  558. %define q1 m3
  559. %define t0 m4
  560. %define t1 m5
  561. %define t2 m6
  562. %define t3 m7
  563. %if ARCH_X86_64
  564. %define p2 m8
  565. %define q2 m9
  566. %define t4 m10
  567. %define t5 m11
  568. %define mask0 m12
  569. %define mask1p m13
  570. %define mask1q [rsp-24]
  571. %define mpb_0 m14
  572. %define mpb_1 m15
  573. %else
  574. %define spill(x) [esp+16*x+((stack_offset+4)&15)]
  575. %define p2 [r4+r1]
  576. %define q2 [r0+2*r1]
  577. %define t4 spill(0)
  578. %define t5 spill(1)
  579. %define mask0 spill(2)
  580. %define mask1p spill(3)
  581. %define mask1q spill(4)
  582. %define mpb_0 [pb_0]
  583. %define mpb_1 [pb_1]
  584. %endif
  585. ;-----------------------------------------------------------------------------
  586. ; void deblock_v_luma_intra( uint8_t *pix, int stride, int alpha, int beta )
  587. ;-----------------------------------------------------------------------------
  588. cglobal deblock_%1_luma_intra_8, 4,6,16
  589. %if ARCH_X86_64 == 0
  590. sub esp, 0x60
  591. %endif
  592. lea r4, [r1*4]
  593. lea r5, [r1*3] ; 3*stride
  594. dec r2d ; alpha-1
  595. jl .end
  596. neg r4
  597. dec r3d ; beta-1
  598. jl .end
  599. add r4, r0 ; pix-4*stride
  600. mova p1, [r4+2*r1]
  601. mova p0, [r4+r5]
  602. mova q0, [r0]
  603. mova q1, [r0+r1]
  604. %if ARCH_X86_64
  605. pxor mpb_0, mpb_0
  606. mova mpb_1, [pb_1]
  607. LOAD_MASK r2d, r3d, t5 ; m5=beta-1, t5=alpha-1, m7=mask0
  608. SWAP 7, 12 ; m12=mask0
  609. pavgb t5, mpb_0
  610. pavgb t5, mpb_1 ; alpha/4+1
  611. movdqa p2, [r4+r1]
  612. movdqa q2, [r0+2*r1]
  613. DIFF_GT2 p0, q0, t5, t0, t3 ; t0 = |p0-q0| > alpha/4+1
  614. DIFF_GT2 p0, p2, m5, t2, t5 ; mask1 = |p2-p0| > beta-1
  615. DIFF_GT2 q0, q2, m5, t4, t5 ; t4 = |q2-q0| > beta-1
  616. pand t0, mask0
  617. pand t4, t0
  618. pand t2, t0
  619. mova mask1q, t4
  620. mova mask1p, t2
  621. %else
  622. LOAD_MASK r2d, r3d, t5 ; m5=beta-1, t5=alpha-1, m7=mask0
  623. mova m4, t5
  624. mova mask0, m7
  625. pavgb m4, [pb_0]
  626. pavgb m4, [pb_1] ; alpha/4+1
  627. DIFF_GT2 p0, q0, m4, m6, m7 ; m6 = |p0-q0| > alpha/4+1
  628. pand m6, mask0
  629. DIFF_GT2 p0, p2, m5, m4, m7 ; m4 = |p2-p0| > beta-1
  630. pand m4, m6
  631. mova mask1p, m4
  632. DIFF_GT2 q0, q2, m5, m4, m7 ; m4 = |q2-q0| > beta-1
  633. pand m4, m6
  634. mova mask1q, m4
  635. %endif
  636. LUMA_INTRA_P012 [r4+r5], [r4+2*r1], [r4+r1], [r4]
  637. LUMA_INTRA_SWAP_PQ
  638. LUMA_INTRA_P012 [r0], [r0+r1], [r0+2*r1], [r0+r5]
  639. .end:
  640. %if ARCH_X86_64 == 0
  641. add esp, 0x60
  642. %endif
  643. RET
  644. INIT_MMX cpuname
  645. %if ARCH_X86_64
  646. ;-----------------------------------------------------------------------------
  647. ; void deblock_h_luma_intra( uint8_t *pix, int stride, int alpha, int beta )
  648. ;-----------------------------------------------------------------------------
  649. cglobal deblock_h_luma_intra_8, 4,9
  650. movsxd r7, r1d
  651. lea r8, [r7*3]
  652. lea r6, [r0-4]
  653. lea r5, [r0-4+r8]
  654. sub rsp, 0x88
  655. %define pix_tmp rsp
  656. ; transpose 8x16 -> tmp space
  657. TRANSPOSE8x8_MEM PASS8ROWS(r6, r5, r7, r8), PASS8ROWS(pix_tmp, pix_tmp+0x30, 0x10, 0x30)
  658. lea r6, [r6+r7*8]
  659. lea r5, [r5+r7*8]
  660. TRANSPOSE8x8_MEM PASS8ROWS(r6, r5, r7, r8), PASS8ROWS(pix_tmp+8, pix_tmp+0x38, 0x10, 0x30)
  661. lea r0, [pix_tmp+0x40]
  662. mov r1, 0x10
  663. call deblock_v_luma_intra_8
  664. ; transpose 16x6 -> original space (but we can't write only 6 pixels, so really 16x8)
  665. lea r5, [r6+r8]
  666. TRANSPOSE8x8_MEM PASS8ROWS(pix_tmp+8, pix_tmp+0x38, 0x10, 0x30), PASS8ROWS(r6, r5, r7, r8)
  667. shl r7, 3
  668. sub r6, r7
  669. sub r5, r7
  670. shr r7, 3
  671. TRANSPOSE8x8_MEM PASS8ROWS(pix_tmp, pix_tmp+0x30, 0x10, 0x30), PASS8ROWS(r6, r5, r7, r8)
  672. add rsp, 0x88
  673. RET
  674. %else
  675. cglobal deblock_h_luma_intra_8, 2,4
  676. lea r3, [r1*3]
  677. sub r0, 4
  678. lea r2, [r0+r3]
  679. %assign pad 0x8c-(stack_offset&15)
  680. SUB rsp, pad
  681. %define pix_tmp rsp
  682. ; transpose 8x16 -> tmp space
  683. TRANSPOSE8x8_MEM PASS8ROWS(r0, r2, r1, r3), PASS8ROWS(pix_tmp, pix_tmp+0x30, 0x10, 0x30)
  684. lea r0, [r0+r1*8]
  685. lea r2, [r2+r1*8]
  686. TRANSPOSE8x8_MEM PASS8ROWS(r0, r2, r1, r3), PASS8ROWS(pix_tmp+8, pix_tmp+0x38, 0x10, 0x30)
  687. lea r0, [pix_tmp+0x40]
  688. PUSH dword r3m
  689. PUSH dword r2m
  690. PUSH dword 16
  691. PUSH r0
  692. call deblock_%1_luma_intra_8
  693. %ifidn %1, v8
  694. add dword [rsp], 8 ; pix_tmp+8
  695. call deblock_%1_luma_intra_8
  696. %endif
  697. ADD esp, 16
  698. mov r1, r1m
  699. mov r0, r0mp
  700. lea r3, [r1*3]
  701. sub r0, 4
  702. lea r2, [r0+r3]
  703. ; transpose 16x6 -> original space (but we can't write only 6 pixels, so really 16x8)
  704. TRANSPOSE8x8_MEM PASS8ROWS(pix_tmp, pix_tmp+0x30, 0x10, 0x30), PASS8ROWS(r0, r2, r1, r3)
  705. lea r0, [r0+r1*8]
  706. lea r2, [r2+r1*8]
  707. TRANSPOSE8x8_MEM PASS8ROWS(pix_tmp+8, pix_tmp+0x38, 0x10, 0x30), PASS8ROWS(r0, r2, r1, r3)
  708. ADD rsp, pad
  709. RET
  710. %endif ; ARCH_X86_64
  711. %endmacro ; DEBLOCK_LUMA_INTRA
  712. INIT_XMM sse2
  713. DEBLOCK_LUMA_INTRA v
  714. INIT_XMM avx
  715. DEBLOCK_LUMA_INTRA v
  716. %if ARCH_X86_64 == 0
  717. INIT_MMX mmx2
  718. DEBLOCK_LUMA_INTRA v8
  719. %endif
  720. INIT_MMX mmx2
  721. %macro CHROMA_V_START 0
  722. dec r2d ; alpha-1
  723. dec r3d ; beta-1
  724. mov t5, r0
  725. sub t5, r1
  726. sub t5, r1
  727. %endmacro
  728. %macro CHROMA_H_START 0
  729. dec r2d
  730. dec r3d
  731. sub r0, 2
  732. lea t6, [r1*3]
  733. mov t5, r0
  734. add r0, t6
  735. %endmacro
  736. %define t5 r5
  737. %define t6 r6
  738. ;-----------------------------------------------------------------------------
  739. ; void ff_deblock_v_chroma( uint8_t *pix, int stride, int alpha, int beta, int8_t *tc0 )
  740. ;-----------------------------------------------------------------------------
  741. cglobal deblock_v_chroma_8, 5,6
  742. CHROMA_V_START
  743. movq m0, [t5]
  744. movq m1, [t5+r1]
  745. movq m2, [r0]
  746. movq m3, [r0+r1]
  747. call ff_chroma_inter_body_mmx2
  748. movq [t5+r1], m1
  749. movq [r0], m2
  750. RET
  751. ;-----------------------------------------------------------------------------
  752. ; void ff_deblock_h_chroma( uint8_t *pix, int stride, int alpha, int beta, int8_t *tc0 )
  753. ;-----------------------------------------------------------------------------
  754. cglobal deblock_h_chroma_8, 5,7
  755. %if UNIX64
  756. %define buf0 [rsp-24]
  757. %define buf1 [rsp-16]
  758. %elif WIN64
  759. sub rsp, 16
  760. %define buf0 [rsp]
  761. %define buf1 [rsp+8]
  762. %else
  763. %define buf0 r0m
  764. %define buf1 r2m
  765. %endif
  766. CHROMA_H_START
  767. TRANSPOSE4x8_LOAD bw, wd, dq, PASS8ROWS(t5, r0, r1, t6)
  768. movq buf0, m0
  769. movq buf1, m3
  770. call ff_chroma_inter_body_mmx2
  771. movq m0, buf0
  772. movq m3, buf1
  773. TRANSPOSE8x4B_STORE PASS8ROWS(t5, r0, r1, t6)
  774. %if WIN64
  775. add rsp, 16
  776. %endif
  777. RET
  778. ALIGN 16
  779. ff_chroma_inter_body_mmx2:
  780. LOAD_MASK r2d, r3d
  781. movd m6, [r4] ; tc0
  782. punpcklbw m6, m6
  783. pand m7, m6
  784. DEBLOCK_P0_Q0
  785. ret
  786. ; in: %1=p0 %2=p1 %3=q1
  787. ; out: p0 = (p0 + q1 + 2*p1 + 2) >> 2
  788. %macro CHROMA_INTRA_P0 3
  789. movq m4, %1
  790. pxor m4, %3
  791. pand m4, [pb_1] ; m4 = (p0^q1)&1
  792. pavgb %1, %3
  793. psubusb %1, m4
  794. pavgb %1, %2 ; dst = avg(p1, avg(p0,q1) - ((p0^q1)&1))
  795. %endmacro
  796. %define t5 r4
  797. %define t6 r5
  798. ;-----------------------------------------------------------------------------
  799. ; void ff_deblock_v_chroma_intra( uint8_t *pix, int stride, int alpha, int beta )
  800. ;-----------------------------------------------------------------------------
  801. cglobal deblock_v_chroma_intra_8, 4,5
  802. CHROMA_V_START
  803. movq m0, [t5]
  804. movq m1, [t5+r1]
  805. movq m2, [r0]
  806. movq m3, [r0+r1]
  807. call ff_chroma_intra_body_mmx2
  808. movq [t5+r1], m1
  809. movq [r0], m2
  810. RET
  811. ;-----------------------------------------------------------------------------
  812. ; void ff_deblock_h_chroma_intra( uint8_t *pix, int stride, int alpha, int beta )
  813. ;-----------------------------------------------------------------------------
  814. cglobal deblock_h_chroma_intra_8, 4,6
  815. CHROMA_H_START
  816. TRANSPOSE4x8_LOAD bw, wd, dq, PASS8ROWS(t5, r0, r1, t6)
  817. call ff_chroma_intra_body_mmx2
  818. TRANSPOSE8x4B_STORE PASS8ROWS(t5, r0, r1, t6)
  819. RET
  820. ALIGN 16
  821. ff_chroma_intra_body_mmx2:
  822. LOAD_MASK r2d, r3d
  823. movq m5, m1
  824. movq m6, m2
  825. CHROMA_INTRA_P0 m1, m0, m3
  826. CHROMA_INTRA_P0 m2, m3, m0
  827. psubb m1, m5
  828. psubb m2, m6
  829. pand m1, m7
  830. pand m2, m7
  831. paddb m1, m5
  832. paddb m2, m6
  833. ret
  834. ;-----------------------------------------------------------------------------
  835. ; void h264_loop_filter_strength(int16_t bs[2][4][4], uint8_t nnz[40],
  836. ; int8_t ref[2][40], int16_t mv[2][40][2],
  837. ; int bidir, int edges, int step,
  838. ; int mask_mv0, int mask_mv1, int field);
  839. ;
  840. ; bidir is 0 or 1
  841. ; edges is 1 or 4
  842. ; step is 1 or 2
  843. ; mask_mv0 is 0 or 3
  844. ; mask_mv1 is 0 or 1
  845. ; field is 0 or 1
  846. ;-----------------------------------------------------------------------------
  847. %macro loop_filter_strength_iteration 7 ; edges, step, mask_mv,
  848. ; dir, d_idx, mask_dir, bidir
  849. %define edgesd %1
  850. %define stepd %2
  851. %define mask_mvd %3
  852. %define dir %4
  853. %define d_idx %5
  854. %define mask_dir %6
  855. %define bidir %7
  856. xor b_idxd, b_idxd ; for (b_idx = 0; b_idx < edges; b_idx += step)
  857. %%.b_idx_loop:
  858. %if mask_dir == 0
  859. pxor m0, m0
  860. %endif
  861. test b_idxd, dword mask_mvd
  862. jnz %%.skip_loop_iter ; if (!(b_idx & mask_mv))
  863. %if bidir == 1
  864. movd m2, [refq+b_idxq+d_idx+12] ; { ref0[bn] }
  865. punpckldq m2, [refq+b_idxq+d_idx+52] ; { ref0[bn], ref1[bn] }
  866. pshufw m0, [refq+b_idxq+12], 0x44 ; { ref0[b], ref0[b] }
  867. pshufw m1, [refq+b_idxq+52], 0x44 ; { ref1[b], ref1[b] }
  868. pshufw m3, m2, 0x4E ; { ref1[bn], ref0[bn] }
  869. psubb m0, m2 ; { ref0[b] != ref0[bn],
  870. ; ref0[b] != ref1[bn] }
  871. psubb m1, m3 ; { ref1[b] != ref1[bn],
  872. ; ref1[b] != ref0[bn] }
  873. por m0, m1
  874. mova m1, [mvq+b_idxq*4+(d_idx+12)*4]
  875. mova m2, [mvq+b_idxq*4+(d_idx+12)*4+mmsize]
  876. mova m3, m1
  877. mova m4, m2
  878. psubw m1, [mvq+b_idxq*4+12*4]
  879. psubw m2, [mvq+b_idxq*4+12*4+mmsize]
  880. psubw m3, [mvq+b_idxq*4+52*4]
  881. psubw m4, [mvq+b_idxq*4+52*4+mmsize]
  882. packsswb m1, m2
  883. packsswb m3, m4
  884. paddb m1, m6
  885. paddb m3, m6
  886. psubusb m1, m5 ; abs(mv[b] - mv[bn]) >= limit
  887. psubusb m3, m5
  888. packsswb m1, m3
  889. por m0, m1
  890. mova m1, [mvq+b_idxq*4+(d_idx+52)*4]
  891. mova m2, [mvq+b_idxq*4+(d_idx+52)*4+mmsize]
  892. mova m3, m1
  893. mova m4, m2
  894. psubw m1, [mvq+b_idxq*4+12*4]
  895. psubw m2, [mvq+b_idxq*4+12*4+mmsize]
  896. psubw m3, [mvq+b_idxq*4+52*4]
  897. psubw m4, [mvq+b_idxq*4+52*4+mmsize]
  898. packsswb m1, m2
  899. packsswb m3, m4
  900. paddb m1, m6
  901. paddb m3, m6
  902. psubusb m1, m5 ; abs(mv[b] - mv[bn]) >= limit
  903. psubusb m3, m5
  904. packsswb m1, m3
  905. pshufw m1, m1, 0x4E
  906. por m0, m1
  907. pshufw m1, m0, 0x4E
  908. pminub m0, m1
  909. %else ; bidir == 0
  910. movd m0, [refq+b_idxq+12]
  911. psubb m0, [refq+b_idxq+d_idx+12] ; ref[b] != ref[bn]
  912. mova m1, [mvq+b_idxq*4+12*4]
  913. mova m2, [mvq+b_idxq*4+12*4+mmsize]
  914. psubw m1, [mvq+b_idxq*4+(d_idx+12)*4]
  915. psubw m2, [mvq+b_idxq*4+(d_idx+12)*4+mmsize]
  916. packsswb m1, m2
  917. paddb m1, m6
  918. psubusb m1, m5 ; abs(mv[b] - mv[bn]) >= limit
  919. packsswb m1, m1
  920. por m0, m1
  921. %endif ; bidir == 1/0
  922. %%.skip_loop_iter:
  923. movd m1, [nnzq+b_idxq+12]
  924. por m1, [nnzq+b_idxq+d_idx+12] ; nnz[b] || nnz[bn]
  925. pminub m1, m7
  926. pminub m0, m7
  927. psllw m1, 1
  928. pxor m2, m2
  929. pmaxub m1, m0
  930. punpcklbw m1, m2
  931. movq [bsq+b_idxq+32*dir], m1
  932. add b_idxd, dword stepd
  933. cmp b_idxd, dword edgesd
  934. jl %%.b_idx_loop
  935. %endmacro
  936. INIT_MMX mmx2
  937. cglobal h264_loop_filter_strength, 9, 9, 0, bs, nnz, ref, mv, bidir, edges, \
  938. step, mask_mv0, mask_mv1, field
  939. %define b_idxq bidirq
  940. %define b_idxd bidird
  941. cmp dword fieldm, 0
  942. mova m7, [pb_1]
  943. mova m5, [pb_3]
  944. je .nofield
  945. mova m5, [pb_3_1]
  946. .nofield:
  947. mova m6, m5
  948. paddb m5, m5
  949. shl dword stepd, 3
  950. shl dword edgesd, 3
  951. %if ARCH_X86_32
  952. %define mask_mv0d mask_mv0m
  953. %define mask_mv1d mask_mv1m
  954. %endif
  955. shl dword mask_mv1d, 3
  956. shl dword mask_mv0d, 3
  957. cmp dword bidird, 0
  958. jne .bidir
  959. loop_filter_strength_iteration edgesd, stepd, mask_mv1d, 1, -8, 0, 0
  960. loop_filter_strength_iteration 32, 8, mask_mv0d, 0, -1, -1, 0
  961. mova m0, [bsq+mmsize*0]
  962. mova m1, [bsq+mmsize*1]
  963. mova m2, [bsq+mmsize*2]
  964. mova m3, [bsq+mmsize*3]
  965. TRANSPOSE4x4W 0, 1, 2, 3, 4
  966. mova [bsq+mmsize*0], m0
  967. mova [bsq+mmsize*1], m1
  968. mova [bsq+mmsize*2], m2
  969. mova [bsq+mmsize*3], m3
  970. RET
  971. .bidir:
  972. loop_filter_strength_iteration edgesd, stepd, mask_mv1d, 1, -8, 0, 1
  973. loop_filter_strength_iteration 32, 8, mask_mv0d, 0, -1, -1, 1
  974. mova m0, [bsq+mmsize*0]
  975. mova m1, [bsq+mmsize*1]
  976. mova m2, [bsq+mmsize*2]
  977. mova m3, [bsq+mmsize*3]
  978. TRANSPOSE4x4W 0, 1, 2, 3, 4
  979. mova [bsq+mmsize*0], m0
  980. mova [bsq+mmsize*1], m1
  981. mova [bsq+mmsize*2], m2
  982. mova [bsq+mmsize*3], m3
  983. RET