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.

622 lines
20KB

  1. /*
  2. * Copyright (c) 2009 Mans Rullgard <mans@mansr.com>
  3. *
  4. * This file is part of Libav.
  5. *
  6. * Libav is free software; you can redistribute it and/or
  7. * modify it under the terms of the GNU Lesser General Public
  8. * License as published by the Free Software Foundation; either
  9. * version 2.1 of the License, or (at your option) any later version.
  10. *
  11. * Libav is distributed in the hope that it will be useful,
  12. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  13. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
  14. * Lesser General Public License for more details.
  15. *
  16. * You should have received a copy of the GNU Lesser General Public
  17. * License along with Libav; if not, write to the Free Software
  18. * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
  19. */
  20. #include "libavutil/arm/asm.S"
  21. preserve8
  22. .macro call_2x_pixels type, subp
  23. function ff_\type\()_pixels16\subp\()_armv6, export=1
  24. push {r0-r3, lr}
  25. bl ff_\type\()_pixels8\subp\()_armv6
  26. pop {r0-r3, lr}
  27. add r0, r0, #8
  28. add r1, r1, #8
  29. b ff_\type\()_pixels8\subp\()_armv6
  30. endfunc
  31. .endm
  32. call_2x_pixels avg
  33. call_2x_pixels put, _x2
  34. call_2x_pixels put, _y2
  35. call_2x_pixels put, _x2_no_rnd
  36. call_2x_pixels put, _y2_no_rnd
  37. function ff_put_pixels16_armv6, export=1
  38. push {r4-r11}
  39. 1:
  40. ldr r5, [r1, #4]
  41. ldr r6, [r1, #8]
  42. ldr r7, [r1, #12]
  43. ldr_post r4, r1, r2
  44. strd r6, r7, [r0, #8]
  45. ldr r9, [r1, #4]
  46. strd_post r4, r5, r0, r2
  47. ldr r10, [r1, #8]
  48. ldr r11, [r1, #12]
  49. ldr_post r8, r1, r2
  50. strd r10, r11, [r0, #8]
  51. subs r3, r3, #2
  52. strd_post r8, r9, r0, r2
  53. bne 1b
  54. pop {r4-r11}
  55. bx lr
  56. endfunc
  57. function ff_put_pixels8_armv6, export=1
  58. push {r4-r7}
  59. 1:
  60. ldr r5, [r1, #4]
  61. ldr_post r4, r1, r2
  62. ldr r7, [r1, #4]
  63. strd_post r4, r5, r0, r2
  64. ldr_post r6, r1, r2
  65. subs r3, r3, #2
  66. strd_post r6, r7, r0, r2
  67. bne 1b
  68. pop {r4-r7}
  69. bx lr
  70. endfunc
  71. function ff_put_pixels8_x2_armv6, export=1
  72. push {r4-r11, lr}
  73. mov r12, #1
  74. orr r12, r12, r12, lsl #8
  75. orr r12, r12, r12, lsl #16
  76. 1:
  77. ldr r4, [r1]
  78. subs r3, r3, #2
  79. ldr r5, [r1, #4]
  80. ldr r7, [r1, #5]
  81. lsr r6, r4, #8
  82. ldr_pre r8, r1, r2
  83. orr r6, r6, r5, lsl #24
  84. ldr r9, [r1, #4]
  85. ldr r11, [r1, #5]
  86. lsr r10, r8, #8
  87. add r1, r1, r2
  88. orr r10, r10, r9, lsl #24
  89. eor r14, r4, r6
  90. uhadd8 r4, r4, r6
  91. eor r6, r5, r7
  92. uhadd8 r5, r5, r7
  93. and r14, r14, r12
  94. and r6, r6, r12
  95. uadd8 r4, r4, r14
  96. eor r14, r8, r10
  97. uadd8 r5, r5, r6
  98. eor r6, r9, r11
  99. uhadd8 r8, r8, r10
  100. and r14, r14, r12
  101. uhadd8 r9, r9, r11
  102. and r6, r6, r12
  103. uadd8 r8, r8, r14
  104. strd_post r4, r5, r0, r2
  105. uadd8 r9, r9, r6
  106. strd_post r8, r9, r0, r2
  107. bne 1b
  108. pop {r4-r11, pc}
  109. endfunc
  110. function ff_put_pixels8_y2_armv6, export=1
  111. push {r4-r11}
  112. mov r12, #1
  113. orr r12, r12, r12, lsl #8
  114. orr r12, r12, r12, lsl #16
  115. ldr r4, [r1]
  116. ldr r5, [r1, #4]
  117. ldr_pre r6, r1, r2
  118. ldr r7, [r1, #4]
  119. 1:
  120. subs r3, r3, #2
  121. uhadd8 r8, r4, r6
  122. eor r10, r4, r6
  123. uhadd8 r9, r5, r7
  124. eor r11, r5, r7
  125. and r10, r10, r12
  126. ldr_pre r4, r1, r2
  127. uadd8 r8, r8, r10
  128. and r11, r11, r12
  129. uadd8 r9, r9, r11
  130. ldr r5, [r1, #4]
  131. uhadd8 r10, r4, r6
  132. eor r6, r4, r6
  133. uhadd8 r11, r5, r7
  134. and r6, r6, r12
  135. eor r7, r5, r7
  136. uadd8 r10, r10, r6
  137. and r7, r7, r12
  138. ldr_pre r6, r1, r2
  139. uadd8 r11, r11, r7
  140. strd_post r8, r9, r0, r2
  141. ldr r7, [r1, #4]
  142. strd_post r10, r11, r0, r2
  143. bne 1b
  144. pop {r4-r11}
  145. bx lr
  146. endfunc
  147. function ff_put_pixels8_x2_no_rnd_armv6, export=1
  148. push {r4-r9, lr}
  149. 1:
  150. subs r3, r3, #2
  151. ldr r4, [r1]
  152. ldr r5, [r1, #4]
  153. ldr r7, [r1, #5]
  154. ldr_pre r8, r1, r2
  155. ldr r9, [r1, #4]
  156. ldr r14, [r1, #5]
  157. add r1, r1, r2
  158. lsr r6, r4, #8
  159. orr r6, r6, r5, lsl #24
  160. lsr r12, r8, #8
  161. orr r12, r12, r9, lsl #24
  162. uhadd8 r4, r4, r6
  163. uhadd8 r5, r5, r7
  164. uhadd8 r8, r8, r12
  165. uhadd8 r9, r9, r14
  166. stm r0, {r4,r5}
  167. add r0, r0, r2
  168. stm r0, {r8,r9}
  169. add r0, r0, r2
  170. bne 1b
  171. pop {r4-r9, pc}
  172. endfunc
  173. function ff_put_pixels8_y2_no_rnd_armv6, export=1
  174. push {r4-r9, lr}
  175. ldr r4, [r1]
  176. ldr r5, [r1, #4]
  177. ldr_pre r6, r1, r2
  178. ldr r7, [r1, #4]
  179. 1:
  180. subs r3, r3, #2
  181. uhadd8 r8, r4, r6
  182. ldr_pre r4, r1, r2
  183. uhadd8 r9, r5, r7
  184. ldr r5, [r1, #4]
  185. uhadd8 r12, r4, r6
  186. ldr_pre r6, r1, r2
  187. uhadd8 r14, r5, r7
  188. ldr r7, [r1, #4]
  189. stm r0, {r8,r9}
  190. add r0, r0, r2
  191. stm r0, {r12,r14}
  192. add r0, r0, r2
  193. bne 1b
  194. pop {r4-r9, pc}
  195. endfunc
  196. function ff_avg_pixels8_armv6, export=1
  197. pld [r1, r2]
  198. push {r4-r10, lr}
  199. mov lr, #1
  200. orr lr, lr, lr, lsl #8
  201. orr lr, lr, lr, lsl #16
  202. ldrd r4, r5, [r0]
  203. ldr r10, [r1, #4]
  204. ldr_post r9, r1, r2
  205. subs r3, r3, #2
  206. 1:
  207. pld [r1, r2]
  208. eor r8, r4, r9
  209. uhadd8 r4, r4, r9
  210. eor r12, r5, r10
  211. ldrd_reg r6, r7, r0, r2
  212. uhadd8 r5, r5, r10
  213. and r8, r8, lr
  214. ldr r10, [r1, #4]
  215. and r12, r12, lr
  216. uadd8 r4, r4, r8
  217. ldr_post r9, r1, r2
  218. eor r8, r6, r9
  219. uadd8 r5, r5, r12
  220. pld [r1, r2, lsl #1]
  221. eor r12, r7, r10
  222. uhadd8 r6, r6, r9
  223. strd_post r4, r5, r0, r2
  224. uhadd8 r7, r7, r10
  225. beq 2f
  226. and r8, r8, lr
  227. ldrd_reg r4, r5, r0, r2
  228. uadd8 r6, r6, r8
  229. ldr r10, [r1, #4]
  230. and r12, r12, lr
  231. subs r3, r3, #2
  232. uadd8 r7, r7, r12
  233. ldr_post r9, r1, r2
  234. strd_post r6, r7, r0, r2
  235. b 1b
  236. 2:
  237. and r8, r8, lr
  238. and r12, r12, lr
  239. uadd8 r6, r6, r8
  240. uadd8 r7, r7, r12
  241. strd_post r6, r7, r0, r2
  242. pop {r4-r10, pc}
  243. endfunc
  244. function ff_add_pixels_clamped_armv6, export=1
  245. push {r4-r8,lr}
  246. mov r3, #8
  247. 1:
  248. ldm r0!, {r4,r5,r12,lr}
  249. ldrd r6, r7, [r1]
  250. pkhbt r8, r4, r5, lsl #16
  251. pkhtb r5, r5, r4, asr #16
  252. pkhbt r4, r12, lr, lsl #16
  253. pkhtb lr, lr, r12, asr #16
  254. pld [r1, r2]
  255. uxtab16 r8, r8, r6
  256. uxtab16 r5, r5, r6, ror #8
  257. uxtab16 r4, r4, r7
  258. uxtab16 lr, lr, r7, ror #8
  259. usat16 r8, #8, r8
  260. usat16 r5, #8, r5
  261. usat16 r4, #8, r4
  262. usat16 lr, #8, lr
  263. orr r6, r8, r5, lsl #8
  264. orr r7, r4, lr, lsl #8
  265. subs r3, r3, #1
  266. strd_post r6, r7, r1, r2
  267. bgt 1b
  268. pop {r4-r8,pc}
  269. endfunc
  270. function ff_get_pixels_armv6, export=1
  271. pld [r1, r2]
  272. push {r4-r8, lr}
  273. mov lr, #8
  274. 1:
  275. ldrd_post r4, r5, r1, r2
  276. subs lr, lr, #1
  277. uxtb16 r6, r4
  278. uxtb16 r4, r4, ror #8
  279. uxtb16 r12, r5
  280. uxtb16 r8, r5, ror #8
  281. pld [r1, r2]
  282. pkhbt r5, r6, r4, lsl #16
  283. pkhtb r6, r4, r6, asr #16
  284. pkhbt r7, r12, r8, lsl #16
  285. pkhtb r12, r8, r12, asr #16
  286. stm r0!, {r5,r6,r7,r12}
  287. bgt 1b
  288. pop {r4-r8, pc}
  289. endfunc
  290. function ff_diff_pixels_armv6, export=1
  291. pld [r1, r3]
  292. pld [r2, r3]
  293. push {r4-r9, lr}
  294. mov lr, #8
  295. 1:
  296. ldrd_post r4, r5, r1, r3
  297. ldrd_post r6, r7, r2, r3
  298. uxtb16 r8, r4
  299. uxtb16 r4, r4, ror #8
  300. uxtb16 r9, r6
  301. uxtb16 r6, r6, ror #8
  302. pld [r1, r3]
  303. ssub16 r9, r8, r9
  304. ssub16 r6, r4, r6
  305. uxtb16 r8, r5
  306. uxtb16 r5, r5, ror #8
  307. pld [r2, r3]
  308. pkhbt r4, r9, r6, lsl #16
  309. pkhtb r6, r6, r9, asr #16
  310. uxtb16 r9, r7
  311. uxtb16 r7, r7, ror #8
  312. ssub16 r9, r8, r9
  313. ssub16 r5, r5, r7
  314. subs lr, lr, #1
  315. pkhbt r8, r9, r5, lsl #16
  316. pkhtb r9, r5, r9, asr #16
  317. stm r0!, {r4,r6,r8,r9}
  318. bgt 1b
  319. pop {r4-r9, pc}
  320. endfunc
  321. function ff_pix_abs16_armv6, export=1
  322. ldr r0, [sp]
  323. push {r4-r9, lr}
  324. mov r12, #0
  325. mov lr, #0
  326. ldm r1, {r4-r7}
  327. ldr r8, [r2]
  328. 1:
  329. ldr r9, [r2, #4]
  330. pld [r1, r3]
  331. usada8 r12, r4, r8, r12
  332. ldr r8, [r2, #8]
  333. pld [r2, r3]
  334. usada8 lr, r5, r9, lr
  335. ldr r9, [r2, #12]
  336. usada8 r12, r6, r8, r12
  337. subs r0, r0, #1
  338. usada8 lr, r7, r9, lr
  339. beq 2f
  340. add r1, r1, r3
  341. ldm r1, {r4-r7}
  342. add r2, r2, r3
  343. ldr r8, [r2]
  344. b 1b
  345. 2:
  346. add r0, r12, lr
  347. pop {r4-r9, pc}
  348. endfunc
  349. function ff_pix_abs16_x2_armv6, export=1
  350. ldr r12, [sp]
  351. push {r4-r11, lr}
  352. mov r0, #0
  353. mov lr, #1
  354. orr lr, lr, lr, lsl #8
  355. orr lr, lr, lr, lsl #16
  356. 1:
  357. ldr r8, [r2]
  358. ldr r9, [r2, #4]
  359. lsr r10, r8, #8
  360. ldr r4, [r1]
  361. lsr r6, r9, #8
  362. orr r10, r10, r9, lsl #24
  363. ldr r5, [r2, #8]
  364. eor r11, r8, r10
  365. uhadd8 r7, r8, r10
  366. orr r6, r6, r5, lsl #24
  367. and r11, r11, lr
  368. uadd8 r7, r7, r11
  369. ldr r8, [r1, #4]
  370. usada8 r0, r4, r7, r0
  371. eor r7, r9, r6
  372. lsr r10, r5, #8
  373. and r7, r7, lr
  374. uhadd8 r4, r9, r6
  375. ldr r6, [r2, #12]
  376. uadd8 r4, r4, r7
  377. pld [r1, r3]
  378. orr r10, r10, r6, lsl #24
  379. usada8 r0, r8, r4, r0
  380. ldr r4, [r1, #8]
  381. eor r11, r5, r10
  382. ldrb r7, [r2, #16]
  383. and r11, r11, lr
  384. uhadd8 r8, r5, r10
  385. ldr r5, [r1, #12]
  386. uadd8 r8, r8, r11
  387. pld [r2, r3]
  388. lsr r10, r6, #8
  389. usada8 r0, r4, r8, r0
  390. orr r10, r10, r7, lsl #24
  391. subs r12, r12, #1
  392. eor r11, r6, r10
  393. add r1, r1, r3
  394. uhadd8 r9, r6, r10
  395. and r11, r11, lr
  396. uadd8 r9, r9, r11
  397. add r2, r2, r3
  398. usada8 r0, r5, r9, r0
  399. bgt 1b
  400. pop {r4-r11, pc}
  401. endfunc
  402. .macro usad_y2 p0, p1, p2, p3, n0, n1, n2, n3
  403. ldr \n0, [r2]
  404. eor \n1, \p0, \n0
  405. uhadd8 \p0, \p0, \n0
  406. and \n1, \n1, lr
  407. ldr \n2, [r1]
  408. uadd8 \p0, \p0, \n1
  409. ldr \n1, [r2, #4]
  410. usada8 r0, \p0, \n2, r0
  411. pld [r1, r3]
  412. eor \n3, \p1, \n1
  413. uhadd8 \p1, \p1, \n1
  414. and \n3, \n3, lr
  415. ldr \p0, [r1, #4]
  416. uadd8 \p1, \p1, \n3
  417. ldr \n2, [r2, #8]
  418. usada8 r0, \p1, \p0, r0
  419. pld [r2, r3]
  420. eor \p0, \p2, \n2
  421. uhadd8 \p2, \p2, \n2
  422. and \p0, \p0, lr
  423. ldr \p1, [r1, #8]
  424. uadd8 \p2, \p2, \p0
  425. ldr \n3, [r2, #12]
  426. usada8 r0, \p2, \p1, r0
  427. eor \p1, \p3, \n3
  428. uhadd8 \p3, \p3, \n3
  429. and \p1, \p1, lr
  430. ldr \p0, [r1, #12]
  431. uadd8 \p3, \p3, \p1
  432. add r1, r1, r3
  433. usada8 r0, \p3, \p0, r0
  434. add r2, r2, r3
  435. .endm
  436. function ff_pix_abs16_y2_armv6, export=1
  437. pld [r1]
  438. pld [r2]
  439. ldr r12, [sp]
  440. push {r4-r11, lr}
  441. mov r0, #0
  442. mov lr, #1
  443. orr lr, lr, lr, lsl #8
  444. orr lr, lr, lr, lsl #16
  445. ldr r4, [r2]
  446. ldr r5, [r2, #4]
  447. ldr r6, [r2, #8]
  448. ldr r7, [r2, #12]
  449. add r2, r2, r3
  450. 1:
  451. usad_y2 r4, r5, r6, r7, r8, r9, r10, r11
  452. subs r12, r12, #2
  453. usad_y2 r8, r9, r10, r11, r4, r5, r6, r7
  454. bgt 1b
  455. pop {r4-r11, pc}
  456. endfunc
  457. function ff_pix_abs8_armv6, export=1
  458. pld [r2, r3]
  459. ldr r12, [sp]
  460. push {r4-r9, lr}
  461. mov r0, #0
  462. mov lr, #0
  463. ldrd_post r4, r5, r1, r3
  464. 1:
  465. subs r12, r12, #2
  466. ldr r7, [r2, #4]
  467. ldr_post r6, r2, r3
  468. ldrd_post r8, r9, r1, r3
  469. usada8 r0, r4, r6, r0
  470. pld [r2, r3]
  471. usada8 lr, r5, r7, lr
  472. ldr r7, [r2, #4]
  473. ldr_post r6, r2, r3
  474. beq 2f
  475. ldrd_post r4, r5, r1, r3
  476. usada8 r0, r8, r6, r0
  477. pld [r2, r3]
  478. usada8 lr, r9, r7, lr
  479. b 1b
  480. 2:
  481. usada8 r0, r8, r6, r0
  482. usada8 lr, r9, r7, lr
  483. add r0, r0, lr
  484. pop {r4-r9, pc}
  485. endfunc
  486. function ff_sse16_armv6, export=1
  487. ldr r12, [sp]
  488. push {r4-r9, lr}
  489. mov r0, #0
  490. 1:
  491. ldrd r4, r5, [r1]
  492. ldr r8, [r2]
  493. uxtb16 lr, r4
  494. uxtb16 r4, r4, ror #8
  495. uxtb16 r9, r8
  496. uxtb16 r8, r8, ror #8
  497. ldr r7, [r2, #4]
  498. usub16 lr, lr, r9
  499. usub16 r4, r4, r8
  500. smlad r0, lr, lr, r0
  501. uxtb16 r6, r5
  502. uxtb16 lr, r5, ror #8
  503. uxtb16 r8, r7
  504. uxtb16 r9, r7, ror #8
  505. smlad r0, r4, r4, r0
  506. ldrd r4, r5, [r1, #8]
  507. usub16 r6, r6, r8
  508. usub16 r8, lr, r9
  509. ldr r7, [r2, #8]
  510. smlad r0, r6, r6, r0
  511. uxtb16 lr, r4
  512. uxtb16 r4, r4, ror #8
  513. uxtb16 r9, r7
  514. uxtb16 r7, r7, ror #8
  515. smlad r0, r8, r8, r0
  516. ldr r8, [r2, #12]
  517. usub16 lr, lr, r9
  518. usub16 r4, r4, r7
  519. smlad r0, lr, lr, r0
  520. uxtb16 r6, r5
  521. uxtb16 r5, r5, ror #8
  522. uxtb16 r9, r8
  523. uxtb16 r8, r8, ror #8
  524. smlad r0, r4, r4, r0
  525. usub16 r6, r6, r9
  526. usub16 r5, r5, r8
  527. smlad r0, r6, r6, r0
  528. add r1, r1, r3
  529. add r2, r2, r3
  530. subs r12, r12, #1
  531. smlad r0, r5, r5, r0
  532. bgt 1b
  533. pop {r4-r9, pc}
  534. endfunc
  535. function ff_pix_norm1_armv6, export=1
  536. push {r4-r6, lr}
  537. mov r12, #16
  538. mov lr, #0
  539. 1:
  540. ldm r0, {r2-r5}
  541. uxtb16 r6, r2
  542. uxtb16 r2, r2, ror #8
  543. smlad lr, r6, r6, lr
  544. uxtb16 r6, r3
  545. smlad lr, r2, r2, lr
  546. uxtb16 r3, r3, ror #8
  547. smlad lr, r6, r6, lr
  548. uxtb16 r6, r4
  549. smlad lr, r3, r3, lr
  550. uxtb16 r4, r4, ror #8
  551. smlad lr, r6, r6, lr
  552. uxtb16 r6, r5
  553. smlad lr, r4, r4, lr
  554. uxtb16 r5, r5, ror #8
  555. smlad lr, r6, r6, lr
  556. subs r12, r12, #1
  557. add r0, r0, r1
  558. smlad lr, r5, r5, lr
  559. bgt 1b
  560. mov r0, lr
  561. pop {r4-r6, pc}
  562. endfunc
  563. function ff_pix_sum_armv6, export=1
  564. push {r4-r7, lr}
  565. mov r12, #16
  566. mov r2, #0
  567. mov r3, #0
  568. mov lr, #0
  569. ldr r4, [r0]
  570. 1:
  571. subs r12, r12, #1
  572. ldr r5, [r0, #4]
  573. usada8 r2, r4, lr, r2
  574. ldr r6, [r0, #8]
  575. usada8 r3, r5, lr, r3
  576. ldr r7, [r0, #12]
  577. usada8 r2, r6, lr, r2
  578. beq 2f
  579. ldr_pre r4, r0, r1
  580. usada8 r3, r7, lr, r3
  581. bgt 1b
  582. 2:
  583. usada8 r3, r7, lr, r3
  584. add r0, r2, r3
  585. pop {r4-r7, pc}
  586. endfunc