1cabdff1aSopenharmony_ci/*
2cabdff1aSopenharmony_ci * QNS functions are compiled 3 times for MMX/3DNOW/SSSE3
3cabdff1aSopenharmony_ci * Copyright (c) 2004 Michael Niedermayer
4cabdff1aSopenharmony_ci *
5cabdff1aSopenharmony_ci * MMX optimization by Michael Niedermayer <michaelni@gmx.at>
6cabdff1aSopenharmony_ci * 3DNow! and SSSE3 optimization by Zuxy Meng <zuxy.meng@gmail.com>
7cabdff1aSopenharmony_ci *
8cabdff1aSopenharmony_ci * This file is part of FFmpeg.
9cabdff1aSopenharmony_ci *
10cabdff1aSopenharmony_ci * FFmpeg is free software; you can redistribute it and/or
11cabdff1aSopenharmony_ci * modify it under the terms of the GNU Lesser General Public
12cabdff1aSopenharmony_ci * License as published by the Free Software Foundation; either
13cabdff1aSopenharmony_ci * version 2.1 of the License, or (at your option) any later version.
14cabdff1aSopenharmony_ci *
15cabdff1aSopenharmony_ci * FFmpeg is distributed in the hope that it will be useful,
16cabdff1aSopenharmony_ci * but WITHOUT ANY WARRANTY; without even the implied warranty of
17cabdff1aSopenharmony_ci * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
18cabdff1aSopenharmony_ci * Lesser General Public License for more details.
19cabdff1aSopenharmony_ci *
20cabdff1aSopenharmony_ci * You should have received a copy of the GNU Lesser General Public
21cabdff1aSopenharmony_ci * License along with FFmpeg; if not, write to the Free Software
22cabdff1aSopenharmony_ci * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
23cabdff1aSopenharmony_ci */
24cabdff1aSopenharmony_ci
25cabdff1aSopenharmony_ci#include <stdint.h>
26cabdff1aSopenharmony_ci
27cabdff1aSopenharmony_ci#include "libavutil/avassert.h"
28cabdff1aSopenharmony_ci#include "libavutil/common.h"
29cabdff1aSopenharmony_ci#include "libavutil/x86/asm.h"
30cabdff1aSopenharmony_ci
31cabdff1aSopenharmony_ci#include "inline_asm.h"
32cabdff1aSopenharmony_ci
33cabdff1aSopenharmony_ci#define MAX_ABS (512 >> (SCALE_OFFSET>0 ? SCALE_OFFSET : 0))
34cabdff1aSopenharmony_ci
35cabdff1aSopenharmony_cistatic int DEF(try_8x8basis)(int16_t rem[64], int16_t weight[64], int16_t basis[64], int scale)
36cabdff1aSopenharmony_ci{
37cabdff1aSopenharmony_ci    x86_reg i=0;
38cabdff1aSopenharmony_ci
39cabdff1aSopenharmony_ci    av_assert2(FFABS(scale) < MAX_ABS);
40cabdff1aSopenharmony_ci    scale<<= 16 + SCALE_OFFSET - BASIS_SHIFT + RECON_SHIFT;
41cabdff1aSopenharmony_ci
42cabdff1aSopenharmony_ci    SET_RND(mm6);
43cabdff1aSopenharmony_ci    __asm__ volatile(
44cabdff1aSopenharmony_ci        "pxor %%mm7, %%mm7              \n\t"
45cabdff1aSopenharmony_ci        "movd  %4, %%mm5                \n\t"
46cabdff1aSopenharmony_ci        "punpcklwd %%mm5, %%mm5         \n\t"
47cabdff1aSopenharmony_ci        "punpcklwd %%mm5, %%mm5         \n\t"
48cabdff1aSopenharmony_ci        ".p2align 4                     \n\t"
49cabdff1aSopenharmony_ci        "1:                             \n\t"
50cabdff1aSopenharmony_ci        "movq  (%1, %0), %%mm0          \n\t"
51cabdff1aSopenharmony_ci        "movq  8(%1, %0), %%mm1         \n\t"
52cabdff1aSopenharmony_ci        PMULHRW(%%mm0, %%mm1, %%mm5, %%mm6)
53cabdff1aSopenharmony_ci        "paddw (%2, %0), %%mm0          \n\t"
54cabdff1aSopenharmony_ci        "paddw 8(%2, %0), %%mm1         \n\t"
55cabdff1aSopenharmony_ci        "psraw $6, %%mm0                \n\t"
56cabdff1aSopenharmony_ci        "psraw $6, %%mm1                \n\t"
57cabdff1aSopenharmony_ci        "pmullw (%3, %0), %%mm0         \n\t"
58cabdff1aSopenharmony_ci        "pmullw 8(%3, %0), %%mm1        \n\t"
59cabdff1aSopenharmony_ci        "pmaddwd %%mm0, %%mm0           \n\t"
60cabdff1aSopenharmony_ci        "pmaddwd %%mm1, %%mm1           \n\t"
61cabdff1aSopenharmony_ci        "paddd %%mm1, %%mm0             \n\t"
62cabdff1aSopenharmony_ci        "psrld $4, %%mm0                \n\t"
63cabdff1aSopenharmony_ci        "paddd %%mm0, %%mm7             \n\t"
64cabdff1aSopenharmony_ci        "add $16, %0                    \n\t"
65cabdff1aSopenharmony_ci        "cmp $128, %0                   \n\t" //FIXME optimize & bench
66cabdff1aSopenharmony_ci        " jb 1b                         \n\t"
67cabdff1aSopenharmony_ci        PHADDD(%%mm7, %%mm6)
68cabdff1aSopenharmony_ci        "psrld $2, %%mm7                \n\t"
69cabdff1aSopenharmony_ci        "movd %%mm7, %0                 \n\t"
70cabdff1aSopenharmony_ci
71cabdff1aSopenharmony_ci        : "+r" (i)
72cabdff1aSopenharmony_ci        : "r"(basis), "r"(rem), "r"(weight), "g"(scale)
73cabdff1aSopenharmony_ci    );
74cabdff1aSopenharmony_ci    return i;
75cabdff1aSopenharmony_ci}
76cabdff1aSopenharmony_ci
77cabdff1aSopenharmony_cistatic void DEF(add_8x8basis)(int16_t rem[64], int16_t basis[64], int scale)
78cabdff1aSopenharmony_ci{
79cabdff1aSopenharmony_ci    x86_reg i=0;
80cabdff1aSopenharmony_ci
81cabdff1aSopenharmony_ci    if(FFABS(scale) < MAX_ABS){
82cabdff1aSopenharmony_ci        scale<<= 16 + SCALE_OFFSET - BASIS_SHIFT + RECON_SHIFT;
83cabdff1aSopenharmony_ci        SET_RND(mm6);
84cabdff1aSopenharmony_ci        __asm__ volatile(
85cabdff1aSopenharmony_ci                "movd  %3, %%mm5        \n\t"
86cabdff1aSopenharmony_ci                "punpcklwd %%mm5, %%mm5 \n\t"
87cabdff1aSopenharmony_ci                "punpcklwd %%mm5, %%mm5 \n\t"
88cabdff1aSopenharmony_ci                ".p2align 4             \n\t"
89cabdff1aSopenharmony_ci                "1:                     \n\t"
90cabdff1aSopenharmony_ci                "movq  (%1, %0), %%mm0  \n\t"
91cabdff1aSopenharmony_ci                "movq  8(%1, %0), %%mm1 \n\t"
92cabdff1aSopenharmony_ci                PMULHRW(%%mm0, %%mm1, %%mm5, %%mm6)
93cabdff1aSopenharmony_ci                "paddw (%2, %0), %%mm0  \n\t"
94cabdff1aSopenharmony_ci                "paddw 8(%2, %0), %%mm1 \n\t"
95cabdff1aSopenharmony_ci                "movq %%mm0, (%2, %0)   \n\t"
96cabdff1aSopenharmony_ci                "movq %%mm1, 8(%2, %0)  \n\t"
97cabdff1aSopenharmony_ci                "add $16, %0            \n\t"
98cabdff1aSopenharmony_ci                "cmp $128, %0           \n\t" // FIXME optimize & bench
99cabdff1aSopenharmony_ci                " jb 1b                 \n\t"
100cabdff1aSopenharmony_ci
101cabdff1aSopenharmony_ci                : "+r" (i)
102cabdff1aSopenharmony_ci                : "r"(basis), "r"(rem), "g"(scale)
103cabdff1aSopenharmony_ci        );
104cabdff1aSopenharmony_ci    }else{
105cabdff1aSopenharmony_ci        for(i=0; i<8*8; i++){
106cabdff1aSopenharmony_ci            rem[i] += (basis[i]*scale + (1<<(BASIS_SHIFT - RECON_SHIFT-1)))>>(BASIS_SHIFT - RECON_SHIFT);
107cabdff1aSopenharmony_ci        }
108cabdff1aSopenharmony_ci    }
109cabdff1aSopenharmony_ci}
110