Jerome Glisse | 771fe6b | 2009-06-05 14:42:42 +0200 | [diff] [blame] | 1 | /* |
| 2 | * Copyright 2009 Red Hat Inc. |
| 3 | * |
| 4 | * Permission is hereby granted, free of charge, to any person obtaining a |
| 5 | * copy of this software and associated documentation files (the "Software"), |
| 6 | * to deal in the Software without restriction, including without limitation |
| 7 | * the rights to use, copy, modify, merge, publish, distribute, sublicense, |
| 8 | * and/or sell copies of the Software, and to permit persons to whom the |
| 9 | * Software is furnished to do so, subject to the following conditions: |
| 10 | * |
| 11 | * The above copyright notice and this permission notice shall be included in |
| 12 | * all copies or substantial portions of the Software. |
| 13 | * |
| 14 | * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR |
| 15 | * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, |
| 16 | * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL |
| 17 | * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR |
| 18 | * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, |
| 19 | * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR |
| 20 | * OTHER DEALINGS IN THE SOFTWARE. |
| 21 | * |
| 22 | * Authors: Dave Airlie |
| 23 | */ |
Ben Skeggs | 68adac5 | 2010-04-28 11:46:42 +1000 | [diff] [blame] | 24 | #ifndef DRM_FIXED_H |
| 25 | #define DRM_FIXED_H |
Jerome Glisse | 771fe6b | 2009-06-05 14:42:42 +0200 | [diff] [blame] | 26 | |
Ben Skeggs | 68adac5 | 2010-04-28 11:46:42 +1000 | [diff] [blame] | 27 | typedef union dfixed { |
Jerome Glisse | 771fe6b | 2009-06-05 14:42:42 +0200 | [diff] [blame] | 28 | u32 full; |
| 29 | } fixed20_12; |
| 30 | |
| 31 | |
Ben Skeggs | 68adac5 | 2010-04-28 11:46:42 +1000 | [diff] [blame] | 32 | #define dfixed_const(A) (u32)(((A) << 12))/* + ((B + 0.000122)*4096)) */ |
| 33 | #define dfixed_const_half(A) (u32)(((A) << 12) + 2048) |
| 34 | #define dfixed_const_666(A) (u32)(((A) << 12) + 2731) |
| 35 | #define dfixed_const_8(A) (u32)(((A) << 12) + 3277) |
| 36 | #define dfixed_mul(A, B) ((u64)((u64)(A).full * (B).full + 2048) >> 12) |
| 37 | #define dfixed_init(A) { .full = dfixed_const((A)) } |
| 38 | #define dfixed_init_half(A) { .full = dfixed_const_half((A)) } |
| 39 | #define dfixed_trunc(A) ((A).full >> 12) |
Robert Morell | f7f6c34 | 2012-04-25 11:45:01 +0200 | [diff] [blame] | 40 | #define dfixed_frac(A) ((A).full & ((1 << 12) - 1)) |
Jerome Glisse | 771fe6b | 2009-06-05 14:42:42 +0200 | [diff] [blame] | 41 | |
Ben Skeggs | 68adac5 | 2010-04-28 11:46:42 +1000 | [diff] [blame] | 42 | static inline u32 dfixed_floor(fixed20_12 A) |
Alex Deucher | 69b3b5e | 2009-12-09 14:40:06 -0500 | [diff] [blame] | 43 | { |
Ben Skeggs | 68adac5 | 2010-04-28 11:46:42 +1000 | [diff] [blame] | 44 | u32 non_frac = dfixed_trunc(A); |
Alex Deucher | 69b3b5e | 2009-12-09 14:40:06 -0500 | [diff] [blame] | 45 | |
Ben Skeggs | 68adac5 | 2010-04-28 11:46:42 +1000 | [diff] [blame] | 46 | return dfixed_const(non_frac); |
Alex Deucher | 69b3b5e | 2009-12-09 14:40:06 -0500 | [diff] [blame] | 47 | } |
| 48 | |
Ben Skeggs | 68adac5 | 2010-04-28 11:46:42 +1000 | [diff] [blame] | 49 | static inline u32 dfixed_ceil(fixed20_12 A) |
Alex Deucher | 69b3b5e | 2009-12-09 14:40:06 -0500 | [diff] [blame] | 50 | { |
Ben Skeggs | 68adac5 | 2010-04-28 11:46:42 +1000 | [diff] [blame] | 51 | u32 non_frac = dfixed_trunc(A); |
Alex Deucher | 69b3b5e | 2009-12-09 14:40:06 -0500 | [diff] [blame] | 52 | |
Ben Skeggs | 68adac5 | 2010-04-28 11:46:42 +1000 | [diff] [blame] | 53 | if (A.full > dfixed_const(non_frac)) |
| 54 | return dfixed_const(non_frac + 1); |
Alex Deucher | 69b3b5e | 2009-12-09 14:40:06 -0500 | [diff] [blame] | 55 | else |
Ben Skeggs | 68adac5 | 2010-04-28 11:46:42 +1000 | [diff] [blame] | 56 | return dfixed_const(non_frac); |
Alex Deucher | 69b3b5e | 2009-12-09 14:40:06 -0500 | [diff] [blame] | 57 | } |
| 58 | |
Ben Skeggs | 68adac5 | 2010-04-28 11:46:42 +1000 | [diff] [blame] | 59 | static inline u32 dfixed_div(fixed20_12 A, fixed20_12 B) |
Jerome Glisse | 771fe6b | 2009-06-05 14:42:42 +0200 | [diff] [blame] | 60 | { |
| 61 | u64 tmp = ((u64)A.full << 13); |
| 62 | |
| 63 | do_div(tmp, B.full); |
| 64 | tmp += 1; |
| 65 | tmp /= 2; |
| 66 | return lower_32_bits(tmp); |
| 67 | } |
| 68 | #endif |