]>
Commit | Line | Data |
---|---|---|
109eee2f JW |
1 | /* |
2 | * Copyright 2015 Freescale Semiconductor, Inc. | |
3 | * | |
4 | * Freescale DCU drm device driver | |
5 | * | |
6 | * This program is free software; you can redistribute it and/or modify | |
7 | * it under the terms of the GNU General Public License as published by | |
8 | * the Free Software Foundation; either version 2 of the License, or | |
9 | * (at your option) any later version. | |
10 | */ | |
11 | ||
12 | #include <linux/backlight.h> | |
13 | ||
14 | #include <drm/drmP.h> | |
15 | #include <drm/drm_atomic_helper.h> | |
16 | #include <drm/drm_crtc_helper.h> | |
17 | #include <drm/drm_panel.h> | |
18 | ||
19 | #include "fsl_dcu_drm_drv.h" | |
fb127b79 | 20 | #include "fsl_tcon.h" |
109eee2f JW |
21 | |
22 | static int | |
23 | fsl_dcu_drm_encoder_atomic_check(struct drm_encoder *encoder, | |
24 | struct drm_crtc_state *crtc_state, | |
25 | struct drm_connector_state *conn_state) | |
26 | { | |
27 | return 0; | |
28 | } | |
29 | ||
30 | static void fsl_dcu_drm_encoder_disable(struct drm_encoder *encoder) | |
31 | { | |
fb127b79 SA |
32 | struct drm_device *dev = encoder->dev; |
33 | struct fsl_dcu_drm_device *fsl_dev = dev->dev_private; | |
34 | ||
35 | if (fsl_dev->tcon) | |
36 | fsl_tcon_bypass_disable(fsl_dev->tcon); | |
109eee2f JW |
37 | } |
38 | ||
39 | static void fsl_dcu_drm_encoder_enable(struct drm_encoder *encoder) | |
40 | { | |
fb127b79 SA |
41 | struct drm_device *dev = encoder->dev; |
42 | struct fsl_dcu_drm_device *fsl_dev = dev->dev_private; | |
43 | ||
44 | if (fsl_dev->tcon) | |
45 | fsl_tcon_bypass_enable(fsl_dev->tcon); | |
109eee2f JW |
46 | } |
47 | ||
48 | static const struct drm_encoder_helper_funcs encoder_helper_funcs = { | |
49 | .atomic_check = fsl_dcu_drm_encoder_atomic_check, | |
50 | .disable = fsl_dcu_drm_encoder_disable, | |
51 | .enable = fsl_dcu_drm_encoder_enable, | |
52 | }; | |
53 | ||
54 | static void fsl_dcu_drm_encoder_destroy(struct drm_encoder *encoder) | |
55 | { | |
56 | drm_encoder_cleanup(encoder); | |
57 | } | |
58 | ||
59 | static const struct drm_encoder_funcs encoder_funcs = { | |
60 | .destroy = fsl_dcu_drm_encoder_destroy, | |
61 | }; | |
62 | ||
63 | int fsl_dcu_drm_encoder_create(struct fsl_dcu_drm_device *fsl_dev, | |
64 | struct drm_crtc *crtc) | |
65 | { | |
66 | struct drm_encoder *encoder = &fsl_dev->encoder; | |
67 | int ret; | |
68 | ||
69 | encoder->possible_crtcs = 1; | |
70 | ret = drm_encoder_init(fsl_dev->drm, encoder, &encoder_funcs, | |
13a3d91f | 71 | DRM_MODE_ENCODER_LVDS, NULL); |
109eee2f JW |
72 | if (ret < 0) |
73 | return ret; | |
74 | ||
75 | drm_encoder_helper_add(encoder, &encoder_helper_funcs); | |
76 | ||
77 | return 0; | |
78 | } | |
79 | ||
80 | static void fsl_dcu_drm_connector_destroy(struct drm_connector *connector) | |
81 | { | |
a109f66f SA |
82 | struct fsl_dcu_drm_connector *fsl_con = to_fsl_dcu_connector(connector); |
83 | ||
109eee2f | 84 | drm_connector_unregister(connector); |
a109f66f | 85 | drm_panel_detach(fsl_con->panel); |
109eee2f JW |
86 | drm_connector_cleanup(connector); |
87 | } | |
88 | ||
89 | static enum drm_connector_status | |
90 | fsl_dcu_drm_connector_detect(struct drm_connector *connector, bool force) | |
91 | { | |
92 | return connector_status_connected; | |
93 | } | |
94 | ||
95 | static const struct drm_connector_funcs fsl_dcu_drm_connector_funcs = { | |
96 | .atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state, | |
97 | .atomic_destroy_state = drm_atomic_helper_connector_destroy_state, | |
98 | .destroy = fsl_dcu_drm_connector_destroy, | |
99 | .detect = fsl_dcu_drm_connector_detect, | |
100 | .dpms = drm_atomic_helper_connector_dpms, | |
101 | .fill_modes = drm_helper_probe_single_connector_modes, | |
102 | .reset = drm_atomic_helper_connector_reset, | |
103 | }; | |
104 | ||
109eee2f JW |
105 | static int fsl_dcu_drm_connector_get_modes(struct drm_connector *connector) |
106 | { | |
107 | struct fsl_dcu_drm_connector *fsl_connector; | |
108 | int (*get_modes)(struct drm_panel *panel); | |
109 | int num_modes = 0; | |
110 | ||
111 | fsl_connector = to_fsl_dcu_connector(connector); | |
112 | if (fsl_connector->panel && fsl_connector->panel->funcs && | |
113 | fsl_connector->panel->funcs->get_modes) { | |
114 | get_modes = fsl_connector->panel->funcs->get_modes; | |
115 | num_modes = get_modes(fsl_connector->panel); | |
116 | } | |
117 | ||
118 | return num_modes; | |
119 | } | |
120 | ||
121 | static int fsl_dcu_drm_connector_mode_valid(struct drm_connector *connector, | |
122 | struct drm_display_mode *mode) | |
123 | { | |
124 | if (mode->hdisplay & 0xf) | |
125 | return MODE_ERROR; | |
126 | ||
127 | return MODE_OK; | |
128 | } | |
129 | ||
130 | static const struct drm_connector_helper_funcs connector_helper_funcs = { | |
109eee2f JW |
131 | .get_modes = fsl_dcu_drm_connector_get_modes, |
132 | .mode_valid = fsl_dcu_drm_connector_mode_valid, | |
133 | }; | |
134 | ||
135 | int fsl_dcu_drm_connector_create(struct fsl_dcu_drm_device *fsl_dev, | |
136 | struct drm_encoder *encoder) | |
137 | { | |
138 | struct drm_connector *connector = &fsl_dev->connector.base; | |
a5dab991 | 139 | struct drm_mode_config *mode_config = &fsl_dev->drm->mode_config; |
109eee2f JW |
140 | struct device_node *panel_node; |
141 | int ret; | |
142 | ||
143 | fsl_dev->connector.encoder = encoder; | |
144 | ||
145 | ret = drm_connector_init(fsl_dev->drm, connector, | |
146 | &fsl_dcu_drm_connector_funcs, | |
147 | DRM_MODE_CONNECTOR_LVDS); | |
148 | if (ret < 0) | |
149 | return ret; | |
150 | ||
151 | drm_connector_helper_add(connector, &connector_helper_funcs); | |
152 | ret = drm_connector_register(connector); | |
153 | if (ret < 0) | |
154 | goto err_cleanup; | |
155 | ||
156 | ret = drm_mode_connector_attach_encoder(connector, encoder); | |
157 | if (ret < 0) | |
158 | goto err_sysfs; | |
159 | ||
160 | drm_object_property_set_value(&connector->base, | |
a5dab991 | 161 | mode_config->dpms_property, |
109eee2f JW |
162 | DRM_MODE_DPMS_OFF); |
163 | ||
164 | panel_node = of_parse_phandle(fsl_dev->np, "fsl,panel", 0); | |
b7d11305 SA |
165 | if (!panel_node) { |
166 | dev_err(fsl_dev->dev, "fsl,panel property not found\n"); | |
167 | ret = -ENODEV; | |
168 | goto err_sysfs; | |
169 | } | |
170 | ||
171 | fsl_dev->connector.panel = of_drm_find_panel(panel_node); | |
172 | if (!fsl_dev->connector.panel) { | |
173 | ret = -EPROBE_DEFER; | |
174 | goto err_panel; | |
109eee2f | 175 | } |
b7d11305 | 176 | of_node_put(panel_node); |
109eee2f JW |
177 | |
178 | ret = drm_panel_attach(fsl_dev->connector.panel, connector); | |
179 | if (ret) { | |
180 | dev_err(fsl_dev->dev, "failed to attach panel\n"); | |
181 | goto err_sysfs; | |
182 | } | |
183 | ||
184 | return 0; | |
185 | ||
b7d11305 SA |
186 | err_panel: |
187 | of_node_put(panel_node); | |
109eee2f JW |
188 | err_sysfs: |
189 | drm_connector_unregister(connector); | |
190 | err_cleanup: | |
191 | drm_connector_cleanup(connector); | |
192 | return ret; | |
193 | } |