ARM: add ARMv6 optimised av_clip_uintp2
[ffmpeg.git] / libavutil / arm / intmath.h
1 /*
2  * Copyright (c) 2010 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
21 #ifndef AVUTIL_ARM_INTMATH_H
22 #define AVUTIL_ARM_INTMATH_H
23
24 #include <stdint.h>
25
26 #include "config.h"
27 #include "libavutil/attributes.h"
28
29 #if HAVE_INLINE_ASM
30
31 #if HAVE_ARMV6
32
33 #define FASTDIV FASTDIV
34 static av_always_inline av_const int FASTDIV(int a, int b)
35 {
36     int r, t;
37     __asm__ ("cmp     %3, #2               \n\t"
38              "ldr     %1, [%4, %3, lsl #2] \n\t"
39              "lsrle   %0, %2, #1           \n\t"
40              "smmulgt %0, %1, %2           \n\t"
41              : "=&r"(r), "=&r"(t) : "r"(a), "r"(b), "r"(ff_inverse));
42     return r;
43 }
44
45 #define av_clip_uint8 av_clip_uint8_arm
46 static av_always_inline av_const uint8_t av_clip_uint8_arm(int a)
47 {
48     unsigned x;
49     __asm__ ("usat %0, #8,  %1" : "=r"(x) : "r"(a));
50     return x;
51 }
52
53 #define av_clip_int8 av_clip_int8_arm
54 static av_always_inline av_const uint8_t av_clip_int8_arm(int a)
55 {
56     unsigned x;
57     __asm__ ("ssat %0, #8,  %1" : "=r"(x) : "r"(a));
58     return x;
59 }
60
61 #define av_clip_uint16 av_clip_uint16_arm
62 static av_always_inline av_const uint16_t av_clip_uint16_arm(int a)
63 {
64     unsigned x;
65     __asm__ ("usat %0, #16, %1" : "=r"(x) : "r"(a));
66     return x;
67 }
68
69 #define av_clip_int16 av_clip_int16_arm
70 static av_always_inline av_const int16_t av_clip_int16_arm(int a)
71 {
72     int x;
73     __asm__ ("ssat %0, #16, %1" : "=r"(x) : "r"(a));
74     return x;
75 }
76
77 #define av_clip_uintp2 av_clip_uintp2_arm
78 static av_always_inline av_const unsigned av_clip_uintp2_arm(int a, int p)
79 {
80     unsigned x;
81     __asm__ ("usat %0, %2, %1" : "=r"(x) : "r"(a), "i"(p));
82     return x;
83 }
84
85
86 #else /* HAVE_ARMV6 */
87
88 #define FASTDIV FASTDIV
89 static av_always_inline av_const int FASTDIV(int a, int b)
90 {
91     int r, t;
92     __asm__ ("umull %1, %0, %2, %3"
93              : "=&r"(r), "=&r"(t) : "r"(a), "r"(ff_inverse[b]));
94     return r;
95 }
96
97 #endif /* HAVE_ARMV6 */
98
99 #define av_clipl_int32 av_clipl_int32_arm
100 static av_always_inline av_const int32_t av_clipl_int32_arm(int64_t a)
101 {
102     int x, y;
103     __asm__ ("adds   %1, %R2, %Q2, lsr #31  \n\t"
104              "mvnne  %1, #1<<31             \n\t"
105              "moveq  %0, %Q2                \n\t"
106              "eorne  %0, %1,  %R2, asr #31  \n\t"
107              : "=r"(x), "=&r"(y) : "r"(a));
108     return x;
109 }
110
111 #endif /* HAVE_INLINE_ASM */
112
113 #endif /* AVUTIL_ARM_INTMATH_H */