1 // SPDX-License-Identifier: GPL-2.0-only 2 /* 3 * Copyright (C) 2012 Avionic Design GmbH 4 * Copyright (C) 2012 NVIDIA CORPORATION. All rights reserved. 5 */ 6 7 #include <drm/drm_atomic_helper.h> 8 #include <drm/drm_panel.h> 9 10 #include "drm.h" 11 #include "dc.h" 12 13 #include <media/cec-notifier.h> 14 15 int tegra_output_connector_get_modes(struct drm_connector *connector) 16 { 17 struct tegra_output *output = connector_to_output(connector); 18 struct edid *edid = NULL; 19 int err = 0; 20 21 /* 22 * If the panel provides one or more modes, use them exclusively and 23 * ignore any other means of obtaining a mode. 24 */ 25 if (output->panel) { 26 err = drm_panel_get_modes(output->panel, connector); 27 if (err > 0) 28 return err; 29 } 30 31 if (output->edid) 32 edid = kmemdup(output->edid, sizeof(*edid), GFP_KERNEL); 33 else if (output->ddc) 34 edid = drm_get_edid(connector, output->ddc); 35 36 cec_notifier_set_phys_addr_from_edid(output->cec, edid); 37 drm_connector_update_edid_property(connector, edid); 38 39 if (edid) { 40 err = drm_add_edid_modes(connector, edid); 41 kfree(edid); 42 } 43 44 return err; 45 } 46 47 enum drm_connector_status 48 tegra_output_connector_detect(struct drm_connector *connector, bool force) 49 { 50 struct tegra_output *output = connector_to_output(connector); 51 enum drm_connector_status status = connector_status_unknown; 52 53 if (output->hpd_gpio) { 54 if (gpiod_get_value(output->hpd_gpio) == 0) 55 status = connector_status_disconnected; 56 else 57 status = connector_status_connected; 58 } else { 59 if (!output->panel) 60 status = connector_status_disconnected; 61 else 62 status = connector_status_connected; 63 } 64 65 if (status != connector_status_connected) 66 cec_notifier_phys_addr_invalidate(output->cec); 67 68 return status; 69 } 70 71 void tegra_output_connector_destroy(struct drm_connector *connector) 72 { 73 struct tegra_output *output = connector_to_output(connector); 74 75 if (output->cec) 76 cec_notifier_conn_unregister(output->cec); 77 78 drm_connector_unregister(connector); 79 drm_connector_cleanup(connector); 80 } 81 82 void tegra_output_encoder_destroy(struct drm_encoder *encoder) 83 { 84 drm_encoder_cleanup(encoder); 85 } 86 87 static irqreturn_t hpd_irq(int irq, void *data) 88 { 89 struct tegra_output *output = data; 90 91 if (output->connector.dev) 92 drm_helper_hpd_irq_event(output->connector.dev); 93 94 return IRQ_HANDLED; 95 } 96 97 int tegra_output_probe(struct tegra_output *output) 98 { 99 struct device_node *ddc, *panel; 100 unsigned long flags; 101 int err, size; 102 103 if (!output->of_node) 104 output->of_node = output->dev->of_node; 105 106 panel = of_parse_phandle(output->of_node, "nvidia,panel", 0); 107 if (panel) { 108 output->panel = of_drm_find_panel(panel); 109 if (IS_ERR(output->panel)) 110 return PTR_ERR(output->panel); 111 112 of_node_put(panel); 113 } 114 115 output->edid = of_get_property(output->of_node, "nvidia,edid", &size); 116 117 ddc = of_parse_phandle(output->of_node, "nvidia,ddc-i2c-bus", 0); 118 if (ddc) { 119 output->ddc = of_find_i2c_adapter_by_node(ddc); 120 if (!output->ddc) { 121 err = -EPROBE_DEFER; 122 of_node_put(ddc); 123 return err; 124 } 125 126 of_node_put(ddc); 127 } 128 129 output->hpd_gpio = devm_gpiod_get_from_of_node(output->dev, 130 output->of_node, 131 "nvidia,hpd-gpio", 0, 132 GPIOD_IN, 133 "HDMI hotplug detect"); 134 if (IS_ERR(output->hpd_gpio)) { 135 if (PTR_ERR(output->hpd_gpio) != -ENOENT) 136 return PTR_ERR(output->hpd_gpio); 137 138 output->hpd_gpio = NULL; 139 } 140 141 if (output->hpd_gpio) { 142 err = gpiod_to_irq(output->hpd_gpio); 143 if (err < 0) { 144 dev_err(output->dev, "gpiod_to_irq(): %d\n", err); 145 return err; 146 } 147 148 output->hpd_irq = err; 149 150 flags = IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING | 151 IRQF_ONESHOT; 152 153 err = request_threaded_irq(output->hpd_irq, NULL, hpd_irq, 154 flags, "hpd", output); 155 if (err < 0) { 156 dev_err(output->dev, "failed to request IRQ#%u: %d\n", 157 output->hpd_irq, err); 158 return err; 159 } 160 161 output->connector.polled = DRM_CONNECTOR_POLL_HPD; 162 163 /* 164 * Disable the interrupt until the connector has been 165 * initialized to avoid a race in the hotplug interrupt 166 * handler. 167 */ 168 disable_irq(output->hpd_irq); 169 } 170 171 return 0; 172 } 173 174 void tegra_output_remove(struct tegra_output *output) 175 { 176 if (output->hpd_gpio) 177 free_irq(output->hpd_irq, output); 178 179 if (output->ddc) 180 put_device(&output->ddc->dev); 181 } 182 183 int tegra_output_init(struct drm_device *drm, struct tegra_output *output) 184 { 185 int connector_type; 186 int err; 187 188 if (output->panel) { 189 err = drm_panel_attach(output->panel, &output->connector); 190 if (err < 0) 191 return err; 192 } 193 194 /* 195 * The connector is now registered and ready to receive hotplug events 196 * so the hotplug interrupt can be enabled. 197 */ 198 if (output->hpd_gpio) 199 enable_irq(output->hpd_irq); 200 201 connector_type = output->connector.connector_type; 202 /* 203 * Create a CEC notifier for HDMI connector. 204 */ 205 if (connector_type == DRM_MODE_CONNECTOR_HDMIA || 206 connector_type == DRM_MODE_CONNECTOR_HDMIB) { 207 struct cec_connector_info conn_info; 208 209 cec_fill_conn_info_from_drm(&conn_info, &output->connector); 210 output->cec = cec_notifier_conn_register(output->dev, NULL, 211 &conn_info); 212 if (!output->cec) 213 return -ENOMEM; 214 } 215 216 return 0; 217 } 218 219 void tegra_output_exit(struct tegra_output *output) 220 { 221 /* 222 * The connector is going away, so the interrupt must be disabled to 223 * prevent the hotplug interrupt handler from potentially crashing. 224 */ 225 if (output->hpd_gpio) 226 disable_irq(output->hpd_irq); 227 228 if (output->panel) 229 drm_panel_detach(output->panel); 230 } 231 232 void tegra_output_find_possible_crtcs(struct tegra_output *output, 233 struct drm_device *drm) 234 { 235 struct device *dev = output->dev; 236 struct drm_crtc *crtc; 237 unsigned int mask = 0; 238 239 drm_for_each_crtc(crtc, drm) { 240 struct tegra_dc *dc = to_tegra_dc(crtc); 241 242 if (tegra_dc_has_output(dc, dev)) 243 mask |= drm_crtc_mask(crtc); 244 } 245 246 if (mask == 0) { 247 dev_warn(dev, "missing output definition for heads in DT\n"); 248 mask = 0x3; 249 } 250 251 output->encoder.possible_crtcs = mask; 252 } 253 254 int tegra_output_suspend(struct tegra_output *output) 255 { 256 if (output->hpd_irq) 257 disable_irq(output->hpd_irq); 258 259 return 0; 260 } 261 262 int tegra_output_resume(struct tegra_output *output) 263 { 264 if (output->hpd_irq) 265 enable_irq(output->hpd_irq); 266 267 return 0; 268 } 269