1
2
3
4
5
6
7#include <linux/clk.h>
8#include <linux/component.h>
9#include <linux/module.h>
10#include <linux/of_device.h>
11#include <linux/platform_device.h>
12#include <linux/pm_runtime.h>
13#include <linux/regmap.h>
14#include <linux/reset.h>
15
16#include <drm/drm_device.h>
17#include <drm/drm_fb_cma_helper.h>
18#include <drm/drm_fourcc.h>
19#include <drm/drm_framebuffer.h>
20#include <drm/drm_gem_cma_helper.h>
21#include <drm/drm_plane.h>
22
23#include "sun4i_drv.h"
24#include "sun4i_frontend.h"
25
26static const u32 sun4i_frontend_vert_coef[32] = {
27 0x00004000, 0x000140ff, 0x00033ffe, 0x00043ffd,
28 0x00063efc, 0xff083dfc, 0x000a3bfb, 0xff0d39fb,
29 0xff0f37fb, 0xff1136fa, 0xfe1433fb, 0xfe1631fb,
30 0xfd192ffb, 0xfd1c2cfb, 0xfd1f29fb, 0xfc2127fc,
31 0xfc2424fc, 0xfc2721fc, 0xfb291ffd, 0xfb2c1cfd,
32 0xfb2f19fd, 0xfb3116fe, 0xfb3314fe, 0xfa3611ff,
33 0xfb370fff, 0xfb390dff, 0xfb3b0a00, 0xfc3d08ff,
34 0xfc3e0600, 0xfd3f0400, 0xfe3f0300, 0xff400100,
35};
36
37static const u32 sun4i_frontend_horz_coef[64] = {
38 0x40000000, 0x00000000, 0x40fe0000, 0x0000ff03,
39 0x3ffd0000, 0x0000ff05, 0x3ffc0000, 0x0000ff06,
40 0x3efb0000, 0x0000ff08, 0x3dfb0000, 0x0000ff09,
41 0x3bfa0000, 0x0000fe0d, 0x39fa0000, 0x0000fe0f,
42 0x38fa0000, 0x0000fe10, 0x36fa0000, 0x0000fe12,
43 0x33fa0000, 0x0000fd16, 0x31fa0000, 0x0000fd18,
44 0x2ffa0000, 0x0000fd1a, 0x2cfa0000, 0x0000fc1e,
45 0x29fa0000, 0x0000fc21, 0x27fb0000, 0x0000fb23,
46 0x24fb0000, 0x0000fb26, 0x21fb0000, 0x0000fb29,
47 0x1ffc0000, 0x0000fa2b, 0x1cfc0000, 0x0000fa2e,
48 0x19fd0000, 0x0000fa30, 0x16fd0000, 0x0000fa33,
49 0x14fd0000, 0x0000fa35, 0x11fe0000, 0x0000fa37,
50 0x0ffe0000, 0x0000fa39, 0x0dfe0000, 0x0000fa3b,
51 0x0afe0000, 0x0000fa3e, 0x08ff0000, 0x0000fb3e,
52 0x06ff0000, 0x0000fb40, 0x05ff0000, 0x0000fc40,
53 0x03ff0000, 0x0000fd41, 0x01ff0000, 0x0000fe42,
54};
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72const u32 sunxi_bt601_yuv2rgb_coef[12] = {
73 0x000004a7, 0x00001e6f, 0x00001cbf, 0x00000877,
74 0x000004a7, 0x00000000, 0x00000662, 0x00003211,
75 0x000004a7, 0x00000812, 0x00000000, 0x00002eb1,
76};
77EXPORT_SYMBOL(sunxi_bt601_yuv2rgb_coef);
78
79static void sun4i_frontend_scaler_init(struct sun4i_frontend *frontend)
80{
81 int i;
82
83 if (frontend->data->has_coef_access_ctrl)
84 regmap_write_bits(frontend->regs, SUN4I_FRONTEND_FRM_CTRL_REG,
85 SUN4I_FRONTEND_FRM_CTRL_COEF_ACCESS_CTRL,
86 SUN4I_FRONTEND_FRM_CTRL_COEF_ACCESS_CTRL);
87
88 for (i = 0; i < 32; i++) {
89 regmap_write(frontend->regs, SUN4I_FRONTEND_CH0_HORZCOEF0_REG(i),
90 sun4i_frontend_horz_coef[2 * i]);
91 regmap_write(frontend->regs, SUN4I_FRONTEND_CH1_HORZCOEF0_REG(i),
92 sun4i_frontend_horz_coef[2 * i]);
93 regmap_write(frontend->regs, SUN4I_FRONTEND_CH0_HORZCOEF1_REG(i),
94 sun4i_frontend_horz_coef[2 * i + 1]);
95 regmap_write(frontend->regs, SUN4I_FRONTEND_CH1_HORZCOEF1_REG(i),
96 sun4i_frontend_horz_coef[2 * i + 1]);
97 regmap_write(frontend->regs, SUN4I_FRONTEND_CH0_VERTCOEF_REG(i),
98 sun4i_frontend_vert_coef[i]);
99 regmap_write(frontend->regs, SUN4I_FRONTEND_CH1_VERTCOEF_REG(i),
100 sun4i_frontend_vert_coef[i]);
101 }
102
103 if (frontend->data->has_coef_rdy)
104 regmap_write_bits(frontend->regs,
105 SUN4I_FRONTEND_FRM_CTRL_REG,
106 SUN4I_FRONTEND_FRM_CTRL_COEF_RDY,
107 SUN4I_FRONTEND_FRM_CTRL_COEF_RDY);
108}
109
110int sun4i_frontend_init(struct sun4i_frontend *frontend)
111{
112 return pm_runtime_get_sync(frontend->dev);
113}
114EXPORT_SYMBOL(sun4i_frontend_init);
115
116void sun4i_frontend_exit(struct sun4i_frontend *frontend)
117{
118 pm_runtime_put(frontend->dev);
119}
120EXPORT_SYMBOL(sun4i_frontend_exit);
121
122static bool sun4i_frontend_format_chroma_requires_swap(uint32_t fmt)
123{
124 switch (fmt) {
125 case DRM_FORMAT_YVU411:
126 case DRM_FORMAT_YVU420:
127 case DRM_FORMAT_YVU422:
128 case DRM_FORMAT_YVU444:
129 return true;
130
131 default:
132 return false;
133 }
134}
135
136static bool sun4i_frontend_format_supports_tiling(uint32_t fmt)
137{
138 switch (fmt) {
139 case DRM_FORMAT_NV12:
140 case DRM_FORMAT_NV16:
141 case DRM_FORMAT_NV21:
142 case DRM_FORMAT_NV61:
143 case DRM_FORMAT_YUV411:
144 case DRM_FORMAT_YUV420:
145 case DRM_FORMAT_YUV422:
146 case DRM_FORMAT_YVU420:
147 case DRM_FORMAT_YVU422:
148 case DRM_FORMAT_YVU411:
149 return true;
150
151 default:
152 return false;
153 }
154}
155
156void sun4i_frontend_update_buffer(struct sun4i_frontend *frontend,
157 struct drm_plane *plane)
158{
159 struct drm_plane_state *state = plane->state;
160 struct drm_framebuffer *fb = state->fb;
161 unsigned int strides[3] = {};
162
163 dma_addr_t paddr;
164 bool swap;
165
166 if (fb->modifier == DRM_FORMAT_MOD_ALLWINNER_TILED) {
167 unsigned int width = state->src_w >> 16;
168 unsigned int offset;
169
170 strides[0] = SUN4I_FRONTEND_LINESTRD_TILED(fb->pitches[0]);
171
172
173
174
175
176
177 offset = (width - 1) & (32 - 1);
178
179 regmap_write(frontend->regs, SUN4I_FRONTEND_TB_OFF0_REG,
180 SUN4I_FRONTEND_TB_OFF_X1(offset));
181
182 if (fb->format->num_planes > 1) {
183 strides[1] =
184 SUN4I_FRONTEND_LINESTRD_TILED(fb->pitches[1]);
185
186 regmap_write(frontend->regs, SUN4I_FRONTEND_TB_OFF1_REG,
187 SUN4I_FRONTEND_TB_OFF_X1(offset));
188 }
189
190 if (fb->format->num_planes > 2) {
191 strides[2] =
192 SUN4I_FRONTEND_LINESTRD_TILED(fb->pitches[2]);
193
194 regmap_write(frontend->regs, SUN4I_FRONTEND_TB_OFF2_REG,
195 SUN4I_FRONTEND_TB_OFF_X1(offset));
196 }
197 } else {
198 strides[0] = fb->pitches[0];
199
200 if (fb->format->num_planes > 1)
201 strides[1] = fb->pitches[1];
202
203 if (fb->format->num_planes > 2)
204 strides[2] = fb->pitches[2];
205 }
206
207
208 DRM_DEBUG_DRIVER("Frontend stride: %d bytes\n", fb->pitches[0]);
209 regmap_write(frontend->regs, SUN4I_FRONTEND_LINESTRD0_REG,
210 strides[0]);
211
212 if (fb->format->num_planes > 1)
213 regmap_write(frontend->regs, SUN4I_FRONTEND_LINESTRD1_REG,
214 strides[1]);
215
216 if (fb->format->num_planes > 2)
217 regmap_write(frontend->regs, SUN4I_FRONTEND_LINESTRD2_REG,
218 strides[2]);
219
220
221 swap = sun4i_frontend_format_chroma_requires_swap(fb->format->format);
222
223
224 paddr = drm_fb_cma_get_gem_addr(fb, state, 0);
225 paddr -= PHYS_OFFSET;
226 DRM_DEBUG_DRIVER("Setting buffer #0 address to %pad\n", &paddr);
227 regmap_write(frontend->regs, SUN4I_FRONTEND_BUF_ADDR0_REG, paddr);
228
229 if (fb->format->num_planes > 1) {
230 paddr = drm_fb_cma_get_gem_addr(fb, state, swap ? 2 : 1);
231 paddr -= PHYS_OFFSET;
232 DRM_DEBUG_DRIVER("Setting buffer #1 address to %pad\n", &paddr);
233 regmap_write(frontend->regs, SUN4I_FRONTEND_BUF_ADDR1_REG,
234 paddr);
235 }
236
237 if (fb->format->num_planes > 2) {
238 paddr = drm_fb_cma_get_gem_addr(fb, state, swap ? 1 : 2);
239 paddr -= PHYS_OFFSET;
240 DRM_DEBUG_DRIVER("Setting buffer #2 address to %pad\n", &paddr);
241 regmap_write(frontend->regs, SUN4I_FRONTEND_BUF_ADDR2_REG,
242 paddr);
243 }
244}
245EXPORT_SYMBOL(sun4i_frontend_update_buffer);
246
247static int
248sun4i_frontend_drm_format_to_input_fmt(const struct drm_format_info *format,
249 u32 *val)
250{
251 if (!format->is_yuv)
252 *val = SUN4I_FRONTEND_INPUT_FMT_DATA_FMT_RGB;
253 else if (drm_format_info_is_yuv_sampling_411(format))
254 *val = SUN4I_FRONTEND_INPUT_FMT_DATA_FMT_YUV411;
255 else if (drm_format_info_is_yuv_sampling_420(format))
256 *val = SUN4I_FRONTEND_INPUT_FMT_DATA_FMT_YUV420;
257 else if (drm_format_info_is_yuv_sampling_422(format))
258 *val = SUN4I_FRONTEND_INPUT_FMT_DATA_FMT_YUV422;
259 else if (drm_format_info_is_yuv_sampling_444(format))
260 *val = SUN4I_FRONTEND_INPUT_FMT_DATA_FMT_YUV444;
261 else
262 return -EINVAL;
263
264 return 0;
265}
266
267static int
268sun4i_frontend_drm_format_to_input_mode(const struct drm_format_info *format,
269 uint64_t modifier, u32 *val)
270{
271 bool tiled = (modifier == DRM_FORMAT_MOD_ALLWINNER_TILED);
272
273 switch (format->num_planes) {
274 case 1:
275 *val = SUN4I_FRONTEND_INPUT_FMT_DATA_MOD_PACKED;
276 return 0;
277
278 case 2:
279 *val = tiled ? SUN4I_FRONTEND_INPUT_FMT_DATA_MOD_MB32_SEMIPLANAR
280 : SUN4I_FRONTEND_INPUT_FMT_DATA_MOD_SEMIPLANAR;
281 return 0;
282
283 case 3:
284 *val = tiled ? SUN4I_FRONTEND_INPUT_FMT_DATA_MOD_MB32_PLANAR
285 : SUN4I_FRONTEND_INPUT_FMT_DATA_MOD_PLANAR;
286 return 0;
287
288 default:
289 return -EINVAL;
290 }
291}
292
293static int
294sun4i_frontend_drm_format_to_input_sequence(const struct drm_format_info *format,
295 u32 *val)
296{
297
298 if (drm_format_info_is_yuv_planar(format)) {
299 *val = 0;
300 return 0;
301 }
302
303 switch (format->format) {
304 case DRM_FORMAT_BGRX8888:
305 *val = SUN4I_FRONTEND_INPUT_FMT_DATA_PS_BGRX;
306 return 0;
307
308 case DRM_FORMAT_NV12:
309 *val = SUN4I_FRONTEND_INPUT_FMT_DATA_PS_UV;
310 return 0;
311
312 case DRM_FORMAT_NV16:
313 *val = SUN4I_FRONTEND_INPUT_FMT_DATA_PS_UV;
314 return 0;
315
316 case DRM_FORMAT_NV21:
317 *val = SUN4I_FRONTEND_INPUT_FMT_DATA_PS_VU;
318 return 0;
319
320 case DRM_FORMAT_NV61:
321 *val = SUN4I_FRONTEND_INPUT_FMT_DATA_PS_VU;
322 return 0;
323
324 case DRM_FORMAT_UYVY:
325 *val = SUN4I_FRONTEND_INPUT_FMT_DATA_PS_UYVY;
326 return 0;
327
328 case DRM_FORMAT_VYUY:
329 *val = SUN4I_FRONTEND_INPUT_FMT_DATA_PS_VYUY;
330 return 0;
331
332 case DRM_FORMAT_XRGB8888:
333 *val = SUN4I_FRONTEND_INPUT_FMT_DATA_PS_XRGB;
334 return 0;
335
336 case DRM_FORMAT_YUYV:
337 *val = SUN4I_FRONTEND_INPUT_FMT_DATA_PS_YUYV;
338 return 0;
339
340 case DRM_FORMAT_YVYU:
341 *val = SUN4I_FRONTEND_INPUT_FMT_DATA_PS_YVYU;
342 return 0;
343
344 default:
345 return -EINVAL;
346 }
347}
348
349static int sun4i_frontend_drm_format_to_output_fmt(uint32_t fmt, u32 *val)
350{
351 switch (fmt) {
352 case DRM_FORMAT_BGRX8888:
353 *val = SUN4I_FRONTEND_OUTPUT_FMT_DATA_FMT_BGRX8888;
354 return 0;
355
356 case DRM_FORMAT_XRGB8888:
357 *val = SUN4I_FRONTEND_OUTPUT_FMT_DATA_FMT_XRGB8888;
358 return 0;
359
360 default:
361 return -EINVAL;
362 }
363}
364
365static const uint32_t sun4i_frontend_formats[] = {
366 DRM_FORMAT_BGRX8888,
367 DRM_FORMAT_NV12,
368 DRM_FORMAT_NV16,
369 DRM_FORMAT_NV21,
370 DRM_FORMAT_NV61,
371 DRM_FORMAT_UYVY,
372 DRM_FORMAT_VYUY,
373 DRM_FORMAT_XRGB8888,
374 DRM_FORMAT_YUV411,
375 DRM_FORMAT_YUV420,
376 DRM_FORMAT_YUV422,
377 DRM_FORMAT_YUV444,
378 DRM_FORMAT_YUYV,
379 DRM_FORMAT_YVU411,
380 DRM_FORMAT_YVU420,
381 DRM_FORMAT_YVU422,
382 DRM_FORMAT_YVU444,
383 DRM_FORMAT_YVYU,
384};
385
386bool sun4i_frontend_format_is_supported(uint32_t fmt, uint64_t modifier)
387{
388 unsigned int i;
389
390 if (modifier == DRM_FORMAT_MOD_ALLWINNER_TILED)
391 return sun4i_frontend_format_supports_tiling(fmt);
392 else if (modifier != DRM_FORMAT_MOD_LINEAR)
393 return false;
394
395 for (i = 0; i < ARRAY_SIZE(sun4i_frontend_formats); i++)
396 if (sun4i_frontend_formats[i] == fmt)
397 return true;
398
399 return false;
400}
401EXPORT_SYMBOL(sun4i_frontend_format_is_supported);
402
403int sun4i_frontend_update_formats(struct sun4i_frontend *frontend,
404 struct drm_plane *plane, uint32_t out_fmt)
405{
406 struct drm_plane_state *state = plane->state;
407 struct drm_framebuffer *fb = state->fb;
408 const struct drm_format_info *format = fb->format;
409 uint64_t modifier = fb->modifier;
410 unsigned int ch1_phase_idx;
411 u32 out_fmt_val;
412 u32 in_fmt_val, in_mod_val, in_ps_val;
413 unsigned int i;
414 u32 bypass;
415 int ret;
416
417 ret = sun4i_frontend_drm_format_to_input_fmt(format, &in_fmt_val);
418 if (ret) {
419 DRM_DEBUG_DRIVER("Invalid input format\n");
420 return ret;
421 }
422
423 ret = sun4i_frontend_drm_format_to_input_mode(format, modifier,
424 &in_mod_val);
425 if (ret) {
426 DRM_DEBUG_DRIVER("Invalid input mode\n");
427 return ret;
428 }
429
430 ret = sun4i_frontend_drm_format_to_input_sequence(format, &in_ps_val);
431 if (ret) {
432 DRM_DEBUG_DRIVER("Invalid pixel sequence\n");
433 return ret;
434 }
435
436 ret = sun4i_frontend_drm_format_to_output_fmt(out_fmt, &out_fmt_val);
437 if (ret) {
438 DRM_DEBUG_DRIVER("Invalid output format\n");
439 return ret;
440 }
441
442
443
444
445
446 ch1_phase_idx = (format->num_planes > 1) ? 1 : 0;
447 regmap_write(frontend->regs, SUN4I_FRONTEND_CH0_HORZPHASE_REG,
448 frontend->data->ch_phase[0]);
449 regmap_write(frontend->regs, SUN4I_FRONTEND_CH1_HORZPHASE_REG,
450 frontend->data->ch_phase[ch1_phase_idx]);
451 regmap_write(frontend->regs, SUN4I_FRONTEND_CH0_VERTPHASE0_REG,
452 frontend->data->ch_phase[0]);
453 regmap_write(frontend->regs, SUN4I_FRONTEND_CH1_VERTPHASE0_REG,
454 frontend->data->ch_phase[ch1_phase_idx]);
455 regmap_write(frontend->regs, SUN4I_FRONTEND_CH0_VERTPHASE1_REG,
456 frontend->data->ch_phase[0]);
457 regmap_write(frontend->regs, SUN4I_FRONTEND_CH1_VERTPHASE1_REG,
458 frontend->data->ch_phase[ch1_phase_idx]);
459
460
461
462
463
464
465
466 if (format->is_yuv) {
467
468 bypass = 0;
469
470 for (i = 0; i < ARRAY_SIZE(sunxi_bt601_yuv2rgb_coef); i++)
471 regmap_write(frontend->regs,
472 SUN4I_FRONTEND_CSC_COEF_REG(i),
473 sunxi_bt601_yuv2rgb_coef[i]);
474 } else {
475 bypass = SUN4I_FRONTEND_BYPASS_CSC_EN;
476 }
477
478 regmap_update_bits(frontend->regs, SUN4I_FRONTEND_BYPASS_REG,
479 SUN4I_FRONTEND_BYPASS_CSC_EN, bypass);
480
481 regmap_write(frontend->regs, SUN4I_FRONTEND_INPUT_FMT_REG,
482 in_mod_val | in_fmt_val | in_ps_val);
483
484
485
486
487
488
489 regmap_write(frontend->regs, SUN4I_FRONTEND_OUTPUT_FMT_REG,
490 out_fmt_val);
491
492 return 0;
493}
494EXPORT_SYMBOL(sun4i_frontend_update_formats);
495
496void sun4i_frontend_update_coord(struct sun4i_frontend *frontend,
497 struct drm_plane *plane)
498{
499 struct drm_plane_state *state = plane->state;
500 struct drm_framebuffer *fb = state->fb;
501 uint32_t luma_width, luma_height;
502 uint32_t chroma_width, chroma_height;
503
504
505 DRM_DEBUG_DRIVER("Frontend size W: %u H: %u\n",
506 state->crtc_w, state->crtc_h);
507
508 luma_width = state->src_w >> 16;
509 luma_height = state->src_h >> 16;
510
511 chroma_width = DIV_ROUND_UP(luma_width, fb->format->hsub);
512 chroma_height = DIV_ROUND_UP(luma_height, fb->format->vsub);
513
514 regmap_write(frontend->regs, SUN4I_FRONTEND_CH0_INSIZE_REG,
515 SUN4I_FRONTEND_INSIZE(luma_height, luma_width));
516 regmap_write(frontend->regs, SUN4I_FRONTEND_CH1_INSIZE_REG,
517 SUN4I_FRONTEND_INSIZE(chroma_height, chroma_width));
518
519 regmap_write(frontend->regs, SUN4I_FRONTEND_CH0_OUTSIZE_REG,
520 SUN4I_FRONTEND_OUTSIZE(state->crtc_h, state->crtc_w));
521 regmap_write(frontend->regs, SUN4I_FRONTEND_CH1_OUTSIZE_REG,
522 SUN4I_FRONTEND_OUTSIZE(state->crtc_h, state->crtc_w));
523
524 regmap_write(frontend->regs, SUN4I_FRONTEND_CH0_HORZFACT_REG,
525 (luma_width << 16) / state->crtc_w);
526 regmap_write(frontend->regs, SUN4I_FRONTEND_CH1_HORZFACT_REG,
527 (chroma_width << 16) / state->crtc_w);
528
529 regmap_write(frontend->regs, SUN4I_FRONTEND_CH0_VERTFACT_REG,
530 (luma_height << 16) / state->crtc_h);
531 regmap_write(frontend->regs, SUN4I_FRONTEND_CH1_VERTFACT_REG,
532 (chroma_height << 16) / state->crtc_h);
533
534 regmap_write_bits(frontend->regs, SUN4I_FRONTEND_FRM_CTRL_REG,
535 SUN4I_FRONTEND_FRM_CTRL_REG_RDY,
536 SUN4I_FRONTEND_FRM_CTRL_REG_RDY);
537}
538EXPORT_SYMBOL(sun4i_frontend_update_coord);
539
540int sun4i_frontend_enable(struct sun4i_frontend *frontend)
541{
542 regmap_write_bits(frontend->regs, SUN4I_FRONTEND_FRM_CTRL_REG,
543 SUN4I_FRONTEND_FRM_CTRL_FRM_START,
544 SUN4I_FRONTEND_FRM_CTRL_FRM_START);
545
546 return 0;
547}
548EXPORT_SYMBOL(sun4i_frontend_enable);
549
550static const struct regmap_config sun4i_frontend_regmap_config = {
551 .reg_bits = 32,
552 .val_bits = 32,
553 .reg_stride = 4,
554 .max_register = 0x0a14,
555};
556
557static int sun4i_frontend_bind(struct device *dev, struct device *master,
558 void *data)
559{
560 struct platform_device *pdev = to_platform_device(dev);
561 struct sun4i_frontend *frontend;
562 struct drm_device *drm = data;
563 struct sun4i_drv *drv = drm->dev_private;
564 struct resource *res;
565 void __iomem *regs;
566
567 frontend = devm_kzalloc(dev, sizeof(*frontend), GFP_KERNEL);
568 if (!frontend)
569 return -ENOMEM;
570
571 dev_set_drvdata(dev, frontend);
572 frontend->dev = dev;
573 frontend->node = dev->of_node;
574
575 frontend->data = of_device_get_match_data(dev);
576 if (!frontend->data)
577 return -ENODEV;
578
579 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
580 regs = devm_ioremap_resource(dev, res);
581 if (IS_ERR(regs))
582 return PTR_ERR(regs);
583
584 frontend->regs = devm_regmap_init_mmio(dev, regs,
585 &sun4i_frontend_regmap_config);
586 if (IS_ERR(frontend->regs)) {
587 dev_err(dev, "Couldn't create the frontend regmap\n");
588 return PTR_ERR(frontend->regs);
589 }
590
591 frontend->reset = devm_reset_control_get(dev, NULL);
592 if (IS_ERR(frontend->reset)) {
593 dev_err(dev, "Couldn't get our reset line\n");
594 return PTR_ERR(frontend->reset);
595 }
596
597 frontend->bus_clk = devm_clk_get(dev, "ahb");
598 if (IS_ERR(frontend->bus_clk)) {
599 dev_err(dev, "Couldn't get our bus clock\n");
600 return PTR_ERR(frontend->bus_clk);
601 }
602
603 frontend->mod_clk = devm_clk_get(dev, "mod");
604 if (IS_ERR(frontend->mod_clk)) {
605 dev_err(dev, "Couldn't get our mod clock\n");
606 return PTR_ERR(frontend->mod_clk);
607 }
608
609 frontend->ram_clk = devm_clk_get(dev, "ram");
610 if (IS_ERR(frontend->ram_clk)) {
611 dev_err(dev, "Couldn't get our ram clock\n");
612 return PTR_ERR(frontend->ram_clk);
613 }
614
615 list_add_tail(&frontend->list, &drv->frontend_list);
616 pm_runtime_enable(dev);
617
618 return 0;
619}
620
621static void sun4i_frontend_unbind(struct device *dev, struct device *master,
622 void *data)
623{
624 struct sun4i_frontend *frontend = dev_get_drvdata(dev);
625
626 list_del(&frontend->list);
627 pm_runtime_force_suspend(dev);
628}
629
630static const struct component_ops sun4i_frontend_ops = {
631 .bind = sun4i_frontend_bind,
632 .unbind = sun4i_frontend_unbind,
633};
634
635static int sun4i_frontend_probe(struct platform_device *pdev)
636{
637 return component_add(&pdev->dev, &sun4i_frontend_ops);
638}
639
640static int sun4i_frontend_remove(struct platform_device *pdev)
641{
642 component_del(&pdev->dev, &sun4i_frontend_ops);
643
644 return 0;
645}
646
647static int sun4i_frontend_runtime_resume(struct device *dev)
648{
649 struct sun4i_frontend *frontend = dev_get_drvdata(dev);
650 int ret;
651
652 clk_set_rate(frontend->mod_clk, 300000000);
653
654 clk_prepare_enable(frontend->bus_clk);
655 clk_prepare_enable(frontend->mod_clk);
656 clk_prepare_enable(frontend->ram_clk);
657
658 ret = reset_control_reset(frontend->reset);
659 if (ret) {
660 dev_err(dev, "Couldn't reset our device\n");
661 return ret;
662 }
663
664 regmap_update_bits(frontend->regs, SUN4I_FRONTEND_EN_REG,
665 SUN4I_FRONTEND_EN_EN,
666 SUN4I_FRONTEND_EN_EN);
667
668 sun4i_frontend_scaler_init(frontend);
669
670 return 0;
671}
672
673static int sun4i_frontend_runtime_suspend(struct device *dev)
674{
675 struct sun4i_frontend *frontend = dev_get_drvdata(dev);
676
677 clk_disable_unprepare(frontend->ram_clk);
678 clk_disable_unprepare(frontend->mod_clk);
679 clk_disable_unprepare(frontend->bus_clk);
680
681 reset_control_assert(frontend->reset);
682
683 return 0;
684}
685
686static const struct dev_pm_ops sun4i_frontend_pm_ops = {
687 .runtime_resume = sun4i_frontend_runtime_resume,
688 .runtime_suspend = sun4i_frontend_runtime_suspend,
689};
690
691static const struct sun4i_frontend_data sun4i_a10_frontend = {
692 .ch_phase = { 0x000, 0xfc000 },
693 .has_coef_rdy = true,
694};
695
696static const struct sun4i_frontend_data sun8i_a33_frontend = {
697 .ch_phase = { 0x400, 0xfc400 },
698 .has_coef_access_ctrl = true,
699};
700
701const struct of_device_id sun4i_frontend_of_table[] = {
702 {
703 .compatible = "allwinner,sun4i-a10-display-frontend",
704 .data = &sun4i_a10_frontend
705 },
706 {
707 .compatible = "allwinner,sun7i-a20-display-frontend",
708 .data = &sun4i_a10_frontend
709 },
710 {
711 .compatible = "allwinner,sun8i-a23-display-frontend",
712 .data = &sun8i_a33_frontend
713 },
714 {
715 .compatible = "allwinner,sun8i-a33-display-frontend",
716 .data = &sun8i_a33_frontend
717 },
718 { }
719};
720EXPORT_SYMBOL(sun4i_frontend_of_table);
721MODULE_DEVICE_TABLE(of, sun4i_frontend_of_table);
722
723static struct platform_driver sun4i_frontend_driver = {
724 .probe = sun4i_frontend_probe,
725 .remove = sun4i_frontend_remove,
726 .driver = {
727 .name = "sun4i-frontend",
728 .of_match_table = sun4i_frontend_of_table,
729 .pm = &sun4i_frontend_pm_ops,
730 },
731};
732module_platform_driver(sun4i_frontend_driver);
733
734MODULE_AUTHOR("Maxime Ripard <maxime.ripard@free-electrons.com>");
735MODULE_DESCRIPTION("Allwinner A10 Display Engine Frontend Driver");
736MODULE_LICENSE("GPL");
737
