^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2) * Copyright 2009 Red Hat Inc.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) * Permission is hereby granted, free of charge, to any person obtaining a
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) * copy of this software and associated documentation files (the "Software"),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) * to deal in the Software without restriction, including without limitation
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) * the rights to use, copy, modify, merge, publish, distribute, sublicense,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8) * and/or sell copies of the Software, and to permit persons to whom the
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9) * Software is furnished to do so, subject to the following conditions:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) * The above copyright notice and this permission notice shall be included in
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) * all copies or substantial portions of the Software.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) * OTHER DEALINGS IN THE SOFTWARE.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) * Authors: Dave Airlie
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) * Christian König
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) #ifndef DRM_FIXED_H
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) #define DRM_FIXED_H
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) #include <linux/math64.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) typedef union dfixed {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) u32 full;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) } fixed20_12;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) #define dfixed_const(A) (u32)(((A) << 12))/* + ((B + 0.000122)*4096)) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) #define dfixed_const_half(A) (u32)(((A) << 12) + 2048)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) #define dfixed_const_666(A) (u32)(((A) << 12) + 2731)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) #define dfixed_const_8(A) (u32)(((A) << 12) + 3277)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) #define dfixed_mul(A, B) ((u64)((u64)(A).full * (B).full + 2048) >> 12)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) #define dfixed_init(A) { .full = dfixed_const((A)) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) #define dfixed_init_half(A) { .full = dfixed_const_half((A)) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) #define dfixed_trunc(A) ((A).full >> 12)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) #define dfixed_frac(A) ((A).full & ((1 << 12) - 1))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) static inline u32 dfixed_floor(fixed20_12 A)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) u32 non_frac = dfixed_trunc(A);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) return dfixed_const(non_frac);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) static inline u32 dfixed_ceil(fixed20_12 A)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) u32 non_frac = dfixed_trunc(A);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) if (A.full > dfixed_const(non_frac))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) return dfixed_const(non_frac + 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) return dfixed_const(non_frac);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) static inline u32 dfixed_div(fixed20_12 A, fixed20_12 B)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) u64 tmp = ((u64)A.full << 13);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) do_div(tmp, B.full);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) tmp += 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) tmp /= 2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) return lower_32_bits(tmp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) #define DRM_FIXED_POINT 32
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) #define DRM_FIXED_ONE (1ULL << DRM_FIXED_POINT)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) #define DRM_FIXED_DECIMAL_MASK (DRM_FIXED_ONE - 1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) #define DRM_FIXED_DIGITS_MASK (~DRM_FIXED_DECIMAL_MASK)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) #define DRM_FIXED_EPSILON 1LL
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) #define DRM_FIXED_ALMOST_ONE (DRM_FIXED_ONE - DRM_FIXED_EPSILON)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) static inline s64 drm_int2fixp(int a)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) return ((s64)a) << DRM_FIXED_POINT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) static inline int drm_fixp2int(s64 a)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) return ((s64)a) >> DRM_FIXED_POINT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) static inline int drm_fixp2int_ceil(s64 a)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) if (a > 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92) return drm_fixp2int(a + DRM_FIXED_ALMOST_ONE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) return drm_fixp2int(a - DRM_FIXED_ALMOST_ONE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97) static inline unsigned drm_fixp_msbset(s64 a)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99) unsigned shift, sign = (a >> 63) & 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) for (shift = 62; shift > 0; --shift)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) if (((a >> shift) & 1) != sign)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) return shift;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) static inline s64 drm_fixp_mul(s64 a, s64 b)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) unsigned shift = drm_fixp_msbset(a) + drm_fixp_msbset(b);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) s64 result;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) if (shift > 61) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) shift = shift - 61;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) a >>= (shift >> 1) + (shift & 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) b >>= shift >> 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) } else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) shift = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) result = a * b;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) if (shift > DRM_FIXED_POINT)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) return result << (shift - DRM_FIXED_POINT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) if (shift < DRM_FIXED_POINT)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) return result >> (DRM_FIXED_POINT - shift);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) return result;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) static inline s64 drm_fixp_div(s64 a, s64 b)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) unsigned shift = 62 - drm_fixp_msbset(a);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) s64 result;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) a <<= shift;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) if (shift < DRM_FIXED_POINT)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) b >>= (DRM_FIXED_POINT - shift);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) result = div64_s64(a, b);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) if (shift > DRM_FIXED_POINT)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) return result >> (shift - DRM_FIXED_POINT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) return result;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) static inline s64 drm_fixp_from_fraction(s64 a, s64 b)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) s64 res;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) bool a_neg = a < 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) bool b_neg = b < 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) u64 a_abs = a_neg ? -a : a;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) u64 b_abs = b_neg ? -b : b;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) u64 rem;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) /* determine integer part */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) u64 res_abs = div64_u64_rem(a_abs, b_abs, &rem);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) /* determine fractional part */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) u32 i = DRM_FIXED_POINT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) do {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) rem <<= 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) res_abs <<= 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) if (rem >= b_abs) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) res_abs |= 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) rem -= b_abs;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) } while (--i != 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) /* round up LSB */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) u64 summand = (rem << 1) >= b_abs;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) res_abs += summand;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) res = (s64) res_abs;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) if (a_neg ^ b_neg)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) res = -res;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) return res;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) static inline s64 drm_fixp_exp(s64 x)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) s64 tolerance = div64_s64(DRM_FIXED_ONE, 1000000);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) s64 sum = DRM_FIXED_ONE, term, y = x;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) u64 count = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) if (x < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) y = -1 * x;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) term = y;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) while (term >= tolerance) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) sum = sum + term;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) count = count + 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) term = drm_fixp_mul(term, div64_s64(y, count));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) if (x < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) sum = drm_fixp_div(DRM_FIXED_ONE, sum);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) return sum;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) #endif
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags