2 * Copyright (C) 2015 Free Electrons
3 * Copyright (C) 2015 NextThing Co
5 * Maxime Ripard <maxime.ripard@free-electrons.com>
7 * This program is free software; you can redistribute it and/or
8 * modify it under the terms of the GNU General Public License as
9 * published by the Free Software Foundation; either version 2 of
10 * the License, or (at your option) any later version.
14 #include <drm/drm_atomic_helper.h>
15 #include <drm/drm_crtc.h>
16 #include <drm/drm_crtc_helper.h>
17 #include <drm/drm_modes.h>
19 #include <linux/clk-provider.h>
20 #include <linux/ioport.h>
21 #include <linux/of_address.h>
22 #include <linux/of_graph.h>
23 #include <linux/of_irq.h>
24 #include <linux/regmap.h>
26 #include <video/videomode.h>
28 #include "sun4i_backend.h"
29 #include "sun4i_crtc.h"
30 #include "sun4i_drv.h"
31 #include "sun4i_tcon.h"
33 static void sun4i_crtc_atomic_begin(struct drm_crtc *crtc,
34 struct drm_crtc_state *old_state)
36 struct sun4i_crtc *scrtc = drm_crtc_to_sun4i_crtc(crtc);
37 struct drm_device *dev = crtc->dev;
40 if (crtc->state->event) {
41 WARN_ON(drm_crtc_vblank_get(crtc) != 0);
43 spin_lock_irqsave(&dev->event_lock, flags);
44 scrtc->event = crtc->state->event;
45 spin_unlock_irqrestore(&dev->event_lock, flags);
46 crtc->state->event = NULL;
50 static void sun4i_crtc_atomic_flush(struct drm_crtc *crtc,
51 struct drm_crtc_state *old_state)
53 struct sun4i_crtc *scrtc = drm_crtc_to_sun4i_crtc(crtc);
54 struct sun4i_drv *drv = scrtc->drv;
55 struct drm_pending_vblank_event *event = crtc->state->event;
57 DRM_DEBUG_DRIVER("Committing plane changes\n");
59 sun4i_backend_commit(drv->backend);
62 crtc->state->event = NULL;
64 spin_lock_irq(&crtc->dev->event_lock);
65 if (drm_crtc_vblank_get(crtc) == 0)
66 drm_crtc_arm_vblank_event(crtc, event);
68 drm_crtc_send_vblank_event(crtc, event);
69 spin_unlock_irq(&crtc->dev->event_lock);
73 static void sun4i_crtc_disable(struct drm_crtc *crtc)
75 struct sun4i_crtc *scrtc = drm_crtc_to_sun4i_crtc(crtc);
76 struct sun4i_drv *drv = scrtc->drv;
78 DRM_DEBUG_DRIVER("Disabling the CRTC\n");
80 sun4i_tcon_disable(drv->tcon);
82 if (crtc->state->event && !crtc->state->active) {
83 spin_lock_irq(&crtc->dev->event_lock);
84 drm_crtc_send_vblank_event(crtc, crtc->state->event);
85 spin_unlock_irq(&crtc->dev->event_lock);
87 crtc->state->event = NULL;
91 static void sun4i_crtc_enable(struct drm_crtc *crtc)
93 struct sun4i_crtc *scrtc = drm_crtc_to_sun4i_crtc(crtc);
94 struct sun4i_drv *drv = scrtc->drv;
96 DRM_DEBUG_DRIVER("Enabling the CRTC\n");
98 sun4i_tcon_enable(drv->tcon);
101 static const struct drm_crtc_helper_funcs sun4i_crtc_helper_funcs = {
102 .atomic_begin = sun4i_crtc_atomic_begin,
103 .atomic_flush = sun4i_crtc_atomic_flush,
104 .disable = sun4i_crtc_disable,
105 .enable = sun4i_crtc_enable,
108 static const struct drm_crtc_funcs sun4i_crtc_funcs = {
109 .atomic_destroy_state = drm_atomic_helper_crtc_destroy_state,
110 .atomic_duplicate_state = drm_atomic_helper_crtc_duplicate_state,
111 .destroy = drm_crtc_cleanup,
112 .page_flip = drm_atomic_helper_page_flip,
113 .reset = drm_atomic_helper_crtc_reset,
114 .set_config = drm_atomic_helper_set_config,
117 struct sun4i_crtc *sun4i_crtc_init(struct drm_device *drm)
119 struct sun4i_drv *drv = drm->dev_private;
120 struct sun4i_crtc *scrtc;
123 scrtc = devm_kzalloc(drm->dev, sizeof(*scrtc), GFP_KERNEL);
128 ret = drm_crtc_init_with_planes(drm, &scrtc->crtc,
134 dev_err(drm->dev, "Couldn't init DRM CRTC\n");
138 drm_crtc_helper_add(&scrtc->crtc, &sun4i_crtc_helper_funcs);
140 /* Set crtc.port to output port node of the tcon */
141 scrtc->crtc.port = of_graph_get_port_by_id(drv->tcon->dev->of_node,