This source file includes following definitions.
- rcar_du_group_read
- rcar_du_group_write
- rcar_du_group_setup_pins
- rcar_du_group_setup_defr8
- rcar_du_group_setup_didsr
- rcar_du_group_setup
- rcar_du_group_get
- rcar_du_group_put
- __rcar_du_group_start_stop
- rcar_du_group_start_stop
- rcar_du_group_restart
- rcar_du_set_dpad0_vsp1_routing
- rcar_du_group_set_dpad_levels
- rcar_du_group_set_routing
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26 #include <linux/clk.h>
27 #include <linux/io.h>
28
29 #include "rcar_du_drv.h"
30 #include "rcar_du_group.h"
31 #include "rcar_du_regs.h"
32
33 u32 rcar_du_group_read(struct rcar_du_group *rgrp, u32 reg)
34 {
35 return rcar_du_read(rgrp->dev, rgrp->mmio_offset + reg);
36 }
37
38 void rcar_du_group_write(struct rcar_du_group *rgrp, u32 reg, u32 data)
39 {
40 rcar_du_write(rgrp->dev, rgrp->mmio_offset + reg, data);
41 }
42
43 static void rcar_du_group_setup_pins(struct rcar_du_group *rgrp)
44 {
45 u32 defr6 = DEFR6_CODE;
46
47 if (rgrp->channels_mask & BIT(0))
48 defr6 |= DEFR6_ODPM02_DISP;
49
50 if (rgrp->channels_mask & BIT(1))
51 defr6 |= DEFR6_ODPM12_DISP;
52
53 rcar_du_group_write(rgrp, DEFR6, defr6);
54 }
55
56 static void rcar_du_group_setup_defr8(struct rcar_du_group *rgrp)
57 {
58 struct rcar_du_device *rcdu = rgrp->dev;
59 u32 defr8 = DEFR8_CODE;
60
61 if (rcdu->info->gen < 3) {
62 defr8 |= DEFR8_DEFE8;
63
64
65
66
67
68
69 if (rgrp->index == 0) {
70 defr8 |= DEFR8_DRGBS_DU(rcdu->dpad0_source);
71 if (rgrp->dev->vspd1_sink == 2)
72 defr8 |= DEFR8_VSCS;
73 }
74 } else {
75
76
77
78
79
80 if (rgrp->index == rcdu->dpad0_source / 2)
81 defr8 |= DEFR8_DRGBS_DU(rcdu->dpad0_source);
82 }
83
84 rcar_du_group_write(rgrp, DEFR8, defr8);
85 }
86
87 static void rcar_du_group_setup_didsr(struct rcar_du_group *rgrp)
88 {
89 struct rcar_du_device *rcdu = rgrp->dev;
90 struct rcar_du_crtc *rcrtc;
91 unsigned int num_crtcs = 0;
92 unsigned int i;
93 u32 didsr;
94
95
96
97
98
99
100
101
102
103 if (rcdu->info->gen < 3 && rgrp->index == 0) {
104
105
106
107
108 rcrtc = rcdu->crtcs;
109 num_crtcs = rcdu->num_crtcs;
110 } else if (rcdu->info->gen == 3 && rgrp->num_crtcs > 1) {
111
112
113
114
115 rcrtc = &rcdu->crtcs[rgrp->index * 2];
116 num_crtcs = rgrp->num_crtcs;
117 }
118
119 if (!num_crtcs)
120 return;
121
122 didsr = DIDSR_CODE;
123 for (i = 0; i < num_crtcs; ++i, ++rcrtc) {
124 if (rcdu->info->lvds_clk_mask & BIT(rcrtc->index))
125 didsr |= DIDSR_LCDS_LVDS0(i)
126 | DIDSR_PDCS_CLK(i, 0);
127 else
128 didsr |= DIDSR_LCDS_DCLKIN(i)
129 | DIDSR_PDCS_CLK(i, 0);
130 }
131
132 rcar_du_group_write(rgrp, DIDSR, didsr);
133 }
134
135 static void rcar_du_group_setup(struct rcar_du_group *rgrp)
136 {
137 struct rcar_du_device *rcdu = rgrp->dev;
138
139
140 rcar_du_group_write(rgrp, DEFR, DEFR_CODE | DEFR_DEFE);
141 if (rcdu->info->gen < 3) {
142 rcar_du_group_write(rgrp, DEFR2, DEFR2_CODE | DEFR2_DEFE2G);
143 rcar_du_group_write(rgrp, DEFR3, DEFR3_CODE | DEFR3_DEFE3);
144 rcar_du_group_write(rgrp, DEFR4, DEFR4_CODE);
145 }
146 rcar_du_group_write(rgrp, DEFR5, DEFR5_CODE | DEFR5_DEFE5);
147
148 rcar_du_group_setup_pins(rgrp);
149
150 if (rcdu->info->gen >= 2) {
151 rcar_du_group_setup_defr8(rgrp);
152 rcar_du_group_setup_didsr(rgrp);
153 }
154
155 if (rcdu->info->gen >= 3)
156 rcar_du_group_write(rgrp, DEFR10, DEFR10_CODE | DEFR10_DEFE10);
157
158
159
160
161
162 rcar_du_group_write(rgrp, DORCR, DORCR_PG1D_DS1 | DORCR_DPRS);
163
164
165 mutex_lock(&rgrp->lock);
166 rcar_du_group_write(rgrp, DPTSR, (rgrp->dptsr_planes << 16) |
167 rgrp->dptsr_planes);
168 mutex_unlock(&rgrp->lock);
169 }
170
171
172
173
174
175
176
177
178
179
180
181 int rcar_du_group_get(struct rcar_du_group *rgrp)
182 {
183 if (rgrp->use_count)
184 goto done;
185
186 rcar_du_group_setup(rgrp);
187
188 done:
189 rgrp->use_count++;
190 return 0;
191 }
192
193
194
195
196
197
198 void rcar_du_group_put(struct rcar_du_group *rgrp)
199 {
200 --rgrp->use_count;
201 }
202
203 static void __rcar_du_group_start_stop(struct rcar_du_group *rgrp, bool start)
204 {
205 struct rcar_du_device *rcdu = rgrp->dev;
206
207
208
209
210
211
212
213
214
215 if (rcdu->info->channels_mask & BIT(rgrp->index * 2)) {
216 struct rcar_du_crtc *rcrtc = &rgrp->dev->crtcs[rgrp->index * 2];
217
218 rcar_du_crtc_dsysr_clr_set(rcrtc, DSYSR_DRES | DSYSR_DEN,
219 start ? DSYSR_DEN : DSYSR_DRES);
220 } else {
221 rcar_du_group_write(rgrp, DSYSR,
222 start ? DSYSR_DEN : DSYSR_DRES);
223 }
224 }
225
226 void rcar_du_group_start_stop(struct rcar_du_group *rgrp, bool start)
227 {
228
229
230
231
232
233
234
235
236
237
238
239
240 if (start) {
241 if (rgrp->used_crtcs++ != 0)
242 __rcar_du_group_start_stop(rgrp, false);
243 __rcar_du_group_start_stop(rgrp, true);
244 } else {
245 if (--rgrp->used_crtcs == 0)
246 __rcar_du_group_start_stop(rgrp, false);
247 }
248 }
249
250 void rcar_du_group_restart(struct rcar_du_group *rgrp)
251 {
252 rgrp->need_restart = false;
253
254 __rcar_du_group_start_stop(rgrp, false);
255 __rcar_du_group_start_stop(rgrp, true);
256 }
257
258 int rcar_du_set_dpad0_vsp1_routing(struct rcar_du_device *rcdu)
259 {
260 struct rcar_du_group *rgrp;
261 struct rcar_du_crtc *crtc;
262 unsigned int index;
263 int ret;
264
265 if (rcdu->info->gen < 2)
266 return 0;
267
268
269
270
271
272
273
274
275 index = rcdu->info->gen < 3 ? 0 : DIV_ROUND_UP(rcdu->num_crtcs, 2) - 1;
276 rgrp = &rcdu->groups[index];
277 crtc = &rcdu->crtcs[index * 2];
278
279 ret = clk_prepare_enable(crtc->clock);
280 if (ret < 0)
281 return ret;
282
283 rcar_du_group_setup_defr8(rgrp);
284
285 clk_disable_unprepare(crtc->clock);
286
287 return 0;
288 }
289
290 static void rcar_du_group_set_dpad_levels(struct rcar_du_group *rgrp)
291 {
292 static const u32 doflr_values[2] = {
293 DOFLR_HSYCFL0 | DOFLR_VSYCFL0 | DOFLR_ODDFL0 |
294 DOFLR_DISPFL0 | DOFLR_CDEFL0 | DOFLR_RGBFL0,
295 DOFLR_HSYCFL1 | DOFLR_VSYCFL1 | DOFLR_ODDFL1 |
296 DOFLR_DISPFL1 | DOFLR_CDEFL1 | DOFLR_RGBFL1,
297 };
298 static const u32 dpad_mask = BIT(RCAR_DU_OUTPUT_DPAD1)
299 | BIT(RCAR_DU_OUTPUT_DPAD0);
300 struct rcar_du_device *rcdu = rgrp->dev;
301 u32 doflr = DOFLR_CODE;
302 unsigned int i;
303
304 if (rcdu->info->gen < 2)
305 return;
306
307
308
309
310
311
312
313
314
315
316
317 for (i = 0; i < rgrp->num_crtcs; ++i) {
318 struct rcar_du_crtc_state *rstate;
319 struct rcar_du_crtc *rcrtc;
320
321 rcrtc = &rcdu->crtcs[rgrp->index * 2 + i];
322 rstate = to_rcar_crtc_state(rcrtc->crtc.state);
323
324 if (!(rstate->outputs & dpad_mask))
325 doflr |= doflr_values[i];
326 }
327
328 rcar_du_group_write(rgrp, DOFLR, doflr);
329 }
330
331 int rcar_du_group_set_routing(struct rcar_du_group *rgrp)
332 {
333 struct rcar_du_device *rcdu = rgrp->dev;
334 u32 dorcr = rcar_du_group_read(rgrp, DORCR);
335
336 dorcr &= ~(DORCR_PG2T | DORCR_DK2S | DORCR_PG2D_MASK);
337
338
339
340
341
342
343 if (rcdu->dpad1_source == rgrp->index * 2)
344 dorcr |= DORCR_PG2D_DS1;
345 else
346 dorcr |= DORCR_PG2T | DORCR_DK2S | DORCR_PG2D_DS2;
347
348 rcar_du_group_write(rgrp, DORCR, dorcr);
349
350 rcar_du_group_set_dpad_levels(rgrp);
351
352 return rcar_du_set_dpad0_vsp1_routing(rgrp->dev);
353 }