1 | /* |
2 | * Copyright (C) 2017 Jernej Skrabec <jernej.skrabec@siol.net> |
3 | * |
4 | * Coefficients are taken from BSP driver, which is: |
5 | * Copyright (C) 2014-2015 Allwinner |
6 | * |
7 | * This file is licensed under the terms of the GNU General Public |
8 | * License version 2. This program is licensed "as is" without any |
9 | * warranty of any kind, whether express or implied. |
10 | */ |
11 | |
12 | #include "sun8i_ui_scaler.h" |
13 | #include "sun8i_vi_scaler.h" |
14 | |
15 | static const u32 lan2coefftab16[240] = { |
16 | 0x00004000, 0x00033ffe, 0x00063efc, 0x000a3bfb, |
17 | 0xff0f37fb, 0xfe1433fb, 0xfd192ffb, 0xfd1f29fb, |
18 | 0xfc2424fc, 0xfb291ffd, 0xfb2f19fd, 0xfb3314fe, |
19 | 0xfb370fff, 0xfb3b0a00, 0xfc3e0600, 0xfe3f0300, |
20 | |
21 | 0xff053804, 0xff083801, 0xff0a3700, 0xff0e34ff, |
22 | 0xff1232fd, 0xfe162ffd, 0xfd1b2cfc, 0xfd1f28fc, |
23 | 0xfd2323fd, 0xfc281ffd, 0xfc2c1bfd, 0xfd2f16fe, |
24 | 0xfd3212ff, 0xff340eff, 0x00360a00, 0x02370700, |
25 | |
26 | 0xff083207, 0xff0a3205, 0xff0d3103, 0xfe113001, |
27 | 0xfe142e00, 0xfe182bff, 0xfe1b29fe, 0xfe1f25fe, |
28 | 0xfe2222fe, 0xfe251ffe, 0xfe291bfe, 0xff2b18fe, |
29 | 0x002e14fe, 0x013010ff, 0x03310dff, 0x05310a00, |
30 | |
31 | 0xff0a2e09, 0xff0c2e07, 0xff0f2d05, 0xff122c03, |
32 | 0xfe152b02, 0xfe182901, 0xfe1b2700, 0xff1e24ff, |
33 | 0xff2121ff, 0xff241eff, 0x00261bff, 0x012818ff, |
34 | 0x022a15ff, 0x032c12ff, 0x052d0fff, 0x072d0c00, |
35 | |
36 | 0xff0c2a0b, 0xff0e2a09, 0xff102a07, 0xff132905, |
37 | 0xff162803, 0xff182702, 0xff1b2501, 0xff1e2300, |
38 | 0x00202000, 0x01221d00, 0x01251bff, 0x032618ff, |
39 | 0x042815ff, 0x052913ff, 0x072a10ff, 0x092a0d00, |
40 | |
41 | 0xff0d280c, 0xff0f280a, 0xff112808, 0xff142706, |
42 | 0xff162605, 0xff192503, 0x001b2302, 0x001d2201, |
43 | 0x011f1f01, 0x01221d00, 0x02231b00, 0x04241800, |
44 | 0x052616ff, 0x072713ff, 0x08271100, 0x0a280e00, |
45 | |
46 | 0xff0e260d, 0xff10260b, 0xff122609, 0xff142508, |
47 | 0x00152506, 0x00182305, 0x001b2203, 0x011d2002, |
48 | 0x011f1f01, 0x02201d01, 0x03221b00, 0x04231801, |
49 | 0x06241600, 0x08251300, 0x09261100, 0x0b260f00, |
50 | |
51 | 0xff0e250e, 0xff10250c, 0x0011250a, 0x00142408, |
52 | 0x00162307, 0x00182206, 0x011a2104, 0x011c2003, |
53 | 0x021e1e02, 0x03201c01, 0x04211a01, 0x05221801, |
54 | 0x07231600, 0x08241400, 0x0a241200, 0x0c241000, |
55 | |
56 | 0x000e240e, 0x0010240c, 0x0013230a, 0x00142309, |
57 | 0x00162208, 0x01182106, 0x011a2005, 0x021b1f04, |
58 | 0x031d1d03, 0x041e1c02, 0x05201a01, 0x06211801, |
59 | 0x07221601, 0x09231400, 0x0a231300, 0x0c231100, |
60 | |
61 | 0x000f220f, 0x0011220d, 0x0013220b, 0x0015210a, |
62 | 0x01162108, 0x01182007, 0x02191f06, 0x031a1e05, |
63 | 0x041c1c04, 0x051d1b03, 0x061f1902, 0x07201801, |
64 | 0x08211601, 0x0a211500, 0x0b221300, 0x0d221100, |
65 | |
66 | 0x0010210f, 0x0011210e, 0x0013210c, 0x0114200b, |
67 | 0x01161f0a, 0x02171f08, 0x03181e07, 0x031a1d06, |
68 | 0x041c1c04, 0x051d1a04, 0x071d1903, 0x081e1802, |
69 | 0x091f1602, 0x0b1f1501, 0x0c211300, 0x0e201200, |
70 | |
71 | 0x00102010, 0x0012200e, 0x0013200d, 0x01151f0b, |
72 | 0x01161f0a, 0x02171e09, 0x03191d07, 0x041a1c06, |
73 | 0x051b1b05, 0x061c1a04, 0x071d1903, 0x081e1703, |
74 | 0x0a1f1601, 0x0b1f1501, 0x0d201300, 0x0e201200, |
75 | |
76 | 0x00102010, 0x00121f0f, 0x00141f0d, 0x01141f0c, |
77 | 0x02161e0a, 0x03171d09, 0x03181d08, 0x041a1c06, |
78 | 0x051b1b05, 0x061c1a04, 0x081c1903, 0x091d1703, |
79 | 0x0a1e1602, 0x0c1e1501, 0x0d1f1400, 0x0e1f1201, |
80 | |
81 | 0x00111e11, 0x00131e0f, 0x01131e0e, 0x02151d0c, |
82 | 0x02161d0b, 0x03171c0a, 0x04181b09, 0x05191b07, |
83 | 0x061a1a06, 0x071b1905, 0x091b1804, 0x0a1c1703, |
84 | 0x0b1d1602, 0x0c1d1502, 0x0e1d1401, 0x0f1e1300, |
85 | |
86 | 0x00111e11, 0x00131d10, 0x01141d0e, 0x02151c0d, |
87 | 0x03161c0b, 0x04171b0a, 0x05171b09, 0x06181a08, |
88 | 0x07191907, 0x081a1806, 0x091a1805, 0x0a1b1704, |
89 | 0x0b1c1603, 0x0d1c1502, 0x0e1d1401, 0x0f1d1301, |
90 | }; |
91 | |
92 | static u32 sun8i_ui_scaler_base(struct sun8i_mixer *mixer, int channel) |
93 | { |
94 | int vi_num = mixer->cfg->vi_num; |
95 | |
96 | if (mixer->cfg->is_de3) |
97 | return DE3_VI_SCALER_UNIT_BASE + |
98 | DE3_VI_SCALER_UNIT_SIZE * vi_num + |
99 | DE3_UI_SCALER_UNIT_SIZE * (channel - vi_num); |
100 | else |
101 | return DE2_VI_SCALER_UNIT_BASE + |
102 | DE2_VI_SCALER_UNIT_SIZE * vi_num + |
103 | DE2_UI_SCALER_UNIT_SIZE * (channel - vi_num); |
104 | } |
105 | |
106 | static int sun8i_ui_scaler_coef_index(unsigned int step) |
107 | { |
108 | unsigned int scale, int_part, float_part; |
109 | |
110 | scale = step >> (SUN8I_UI_SCALER_SCALE_FRAC - 3); |
111 | int_part = scale >> 3; |
112 | float_part = scale & 0x7; |
113 | |
114 | switch (int_part) { |
115 | case 0: |
116 | return 0; |
117 | case 1: |
118 | return float_part; |
119 | case 2: |
120 | return 8 + (float_part >> 1); |
121 | case 3: |
122 | return 12; |
123 | case 4: |
124 | return 13; |
125 | default: |
126 | return 14; |
127 | } |
128 | } |
129 | |
130 | void sun8i_ui_scaler_enable(struct sun8i_mixer *mixer, int layer, bool enable) |
131 | { |
132 | u32 val, base; |
133 | |
134 | if (WARN_ON(layer < mixer->cfg->vi_num)) |
135 | return; |
136 | |
137 | base = sun8i_ui_scaler_base(mixer, channel: layer); |
138 | |
139 | if (enable) |
140 | val = SUN8I_SCALER_GSU_CTRL_EN | |
141 | SUN8I_SCALER_GSU_CTRL_COEFF_RDY; |
142 | else |
143 | val = 0; |
144 | |
145 | regmap_write(map: mixer->engine.regs, SUN8I_SCALER_GSU_CTRL(base), val); |
146 | } |
147 | |
148 | void sun8i_ui_scaler_setup(struct sun8i_mixer *mixer, int layer, |
149 | u32 src_w, u32 src_h, u32 dst_w, u32 dst_h, |
150 | u32 hscale, u32 vscale, u32 hphase, u32 vphase) |
151 | { |
152 | u32 insize, outsize; |
153 | int i, offset; |
154 | u32 base; |
155 | |
156 | if (WARN_ON(layer < mixer->cfg->vi_num)) |
157 | return; |
158 | |
159 | base = sun8i_ui_scaler_base(mixer, channel: layer); |
160 | |
161 | hphase <<= SUN8I_UI_SCALER_PHASE_FRAC - 16; |
162 | vphase <<= SUN8I_UI_SCALER_PHASE_FRAC - 16; |
163 | hscale <<= SUN8I_UI_SCALER_SCALE_FRAC - 16; |
164 | vscale <<= SUN8I_UI_SCALER_SCALE_FRAC - 16; |
165 | |
166 | insize = SUN8I_UI_SCALER_SIZE(src_w, src_h); |
167 | outsize = SUN8I_UI_SCALER_SIZE(dst_w, dst_h); |
168 | |
169 | regmap_write(map: mixer->engine.regs, |
170 | SUN8I_SCALER_GSU_OUTSIZE(base), val: outsize); |
171 | regmap_write(map: mixer->engine.regs, |
172 | SUN8I_SCALER_GSU_INSIZE(base), val: insize); |
173 | regmap_write(map: mixer->engine.regs, |
174 | SUN8I_SCALER_GSU_HSTEP(base), val: hscale); |
175 | regmap_write(map: mixer->engine.regs, |
176 | SUN8I_SCALER_GSU_VSTEP(base), val: vscale); |
177 | regmap_write(map: mixer->engine.regs, |
178 | SUN8I_SCALER_GSU_HPHASE(base), val: hphase); |
179 | regmap_write(map: mixer->engine.regs, |
180 | SUN8I_SCALER_GSU_VPHASE(base), val: vphase); |
181 | offset = sun8i_ui_scaler_coef_index(step: hscale) * |
182 | SUN8I_UI_SCALER_COEFF_COUNT; |
183 | for (i = 0; i < SUN8I_UI_SCALER_COEFF_COUNT; i++) |
184 | regmap_write(map: mixer->engine.regs, |
185 | SUN8I_SCALER_GSU_HCOEFF(base, i), |
186 | val: lan2coefftab16[offset + i]); |
187 | } |
188 | |