drivers/gpu/drm/tegra/output.c

   1 /*
   2  * Copyright (C) 2012 Avionic Design GmbH
   3  * Copyright (C) 2012 NVIDIA CORPORATION.  All rights reserved.
   4  *
   5  * This program is free software; you can redistribute it and/or modify
   6  * it under the terms of the GNU General Public License version 2 as
   7  * published by the Free Software Foundation.
   8  */
   9
  10 #include <linux/of_gpio.h>
  11
  12 #include <drm/drm_panel.h>
  13 #include "drm.h"
  14
  15 static int tegra_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         if (output->panel)
  22                 return output->panel->funcs->get_modes(output->panel);
  23
  24         if (output->edid)
  25                 edid = kmemdup(output->edid, sizeof(*edid), GFP_KERNEL);
  26         else if (output->ddc)
  27                 edid = drm_get_edid(connector, output->ddc);
  28
  29         drm_mode_connector_update_edid_property(connector, edid);
  30
  31         if (edid) {
  32                 err = drm_add_edid_modes(connector, edid);
  33                 kfree(edid);
  34         }
  35
  36         return err;
  37 }
  38
  39 static int tegra_connector_mode_valid(struct drm_connector *connector,
  40                                       struct drm_display_mode *mode)
  41 {
  42         struct tegra_output *output = connector_to_output(connector);
  43         enum drm_mode_status status = MODE_OK;
  44         int err;
  45
  46         err = tegra_output_check_mode(output, mode, &status);
  47         if (err < 0)
  48                 return MODE_ERROR;
  49
  50         return status;
  51 }
  52
  53 static struct drm_encoder *
  54 tegra_connector_best_encoder(struct drm_connector *connector)
  55 {
  56         struct tegra_output *output = connector_to_output(connector);
  57
  58         return &output->encoder;
  59 }
  60
  61 static const struct drm_connector_helper_funcs connector_helper_funcs = {
  62         .get_modes = tegra_connector_get_modes,
  63         .mode_valid = tegra_connector_mode_valid,
  64         .best_encoder = tegra_connector_best_encoder,
  65 };
  66
  67 static enum drm_connector_status
  68 tegra_connector_detect(struct drm_connector *connector, bool force)
  69 {
  70         struct tegra_output *output = connector_to_output(connector);
  71         enum drm_connector_status status = connector_status_unknown;
  72
  73         if (gpio_is_valid(output->hpd_gpio)) {
  74                 if (gpio_get_value(output->hpd_gpio) == 0)
  75                         status = connector_status_disconnected;
  76                 else
  77                         status = connector_status_connected;
  78         } else {
  79                 if (output->panel)
  80                         status = connector_status_connected;
  81
  82                 if (connector->connector_type == DRM_MODE_CONNECTOR_LVDS)
  83                         status = connector_status_connected;
  84         }
  85
  86         return status;
  87 }
  88
  89 static void drm_connector_clear(struct drm_connector *connector)
  90 {
  91         memset(connector, 0, sizeof(*connector));
  92 }
  93
  94 static void tegra_connector_destroy(struct drm_connector *connector)
  95 {
  96         drm_sysfs_connector_remove(connector);
  97         drm_connector_cleanup(connector);
  98         drm_connector_clear(connector);
  99 }
 100
 101 static const struct drm_connector_funcs connector_funcs = {
 102         .dpms = drm_helper_connector_dpms,
 103         .detect = tegra_connector_detect,
 104         .fill_modes = drm_helper_probe_single_connector_modes,
 105         .destroy = tegra_connector_destroy,
 106 };
 107
 108 static void drm_encoder_clear(struct drm_encoder *encoder)
 109 {
 110         memset(encoder, 0, sizeof(*encoder));
 111 }
 112
 113 static void tegra_encoder_destroy(struct drm_encoder *encoder)
 114 {
 115         drm_encoder_cleanup(encoder);
 116         drm_encoder_clear(encoder);
 117 }
 118
 119 static const struct drm_encoder_funcs encoder_funcs = {
 120         .destroy = tegra_encoder_destroy,
 121 };
 122
 123 static void tegra_encoder_dpms(struct drm_encoder *encoder, int mode)
 124 {
 125         struct tegra_output *output = encoder_to_output(encoder);
 126         struct drm_panel *panel = output->panel;
 127
 128         if (panel && panel->funcs) {
 129                 if (mode != DRM_MODE_DPMS_ON)
 130                         drm_panel_disable(panel);
 131                 else
 132                         drm_panel_enable(panel);
 133         }
 134 }
 135
 136 static bool tegra_encoder_mode_fixup(struct drm_encoder *encoder,
 137                                      const struct drm_display_mode *mode,
 138                                      struct drm_display_mode *adjusted)
 139 {
 140         return true;
 141 }
 142
 143 static void tegra_encoder_prepare(struct drm_encoder *encoder)
 144 {
 145 }
 146
 147 static void tegra_encoder_commit(struct drm_encoder *encoder)
 148 {
 149 }
 150
 151 static void tegra_encoder_mode_set(struct drm_encoder *encoder,
 152                                    struct drm_display_mode *mode,
 153                                    struct drm_display_mode *adjusted)
 154 {
 155         struct tegra_output *output = encoder_to_output(encoder);
 156         int err;
 157
 158         err = tegra_output_enable(output);
 159         if (err < 0)
 160                 dev_err(encoder->dev->dev, "tegra_output_enable(): %d\n", err);
 161 }
 162
 163 static const struct drm_encoder_helper_funcs encoder_helper_funcs = {
 164         .dpms = tegra_encoder_dpms,
 165         .mode_fixup = tegra_encoder_mode_fixup,
 166         .prepare = tegra_encoder_prepare,
 167         .commit = tegra_encoder_commit,
 168         .mode_set = tegra_encoder_mode_set,
 169 };
 170
 171 static irqreturn_t hpd_irq(int irq, void *data)
 172 {
 173         struct tegra_output *output = data;
 174
 175         drm_helper_hpd_irq_event(output->connector.dev);
 176
 177         return IRQ_HANDLED;
 178 }
 179
 180 int tegra_output_probe(struct tegra_output *output)
 181 {
 182         struct device_node *ddc, *panel;
 183         enum of_gpio_flags flags;
 184         size_t size;
 185         int err;
 186
 187         if (!output->of_node)
 188                 output->of_node = output->dev->of_node;
 189
 190         panel = of_parse_phandle(output->of_node, "nvidia,panel", 0);
 191         if (panel) {
 192                 output->panel = of_drm_find_panel(panel);
 193                 if (!output->panel)
 194                         return -EPROBE_DEFER;
 195
 196                 of_node_put(panel);
 197         }
 198
 199         output->edid = of_get_property(output->of_node, "nvidia,edid", &size);
 200
 201         ddc = of_parse_phandle(output->of_node, "nvidia,ddc-i2c-bus", 0);
 202         if (ddc) {
 203                 output->ddc = of_find_i2c_adapter_by_node(ddc);
 204                 if (!output->ddc) {
 205                         err = -EPROBE_DEFER;
 206                         of_node_put(ddc);
 207                         return err;
 208                 }
 209
 210                 of_node_put(ddc);
 211         }
 212
 213         if (!output->panel && !output->edid && !output->ddc)
 214                 return -ENODEV;
 215
 216         output->hpd_gpio = of_get_named_gpio_flags(output->of_node,
 217                                                    "nvidia,hpd-gpio", 0,
 218                                                    &flags);
 219         if (gpio_is_valid(output->hpd_gpio)) {
 220                 unsigned long flags;
 221
 222                 err = gpio_request_one(output->hpd_gpio, GPIOF_DIR_IN,
 223                                        "HDMI hotplug detect");
 224                 if (err < 0) {
 225                         dev_err(output->dev, "gpio_request_one(): %d\n", err);
 226                         return err;
 227                 }
 228
 229                 err = gpio_to_irq(output->hpd_gpio);
 230                 if (err < 0) {
 231                         dev_err(output->dev, "gpio_to_irq(): %d\n", err);
 232                         gpio_free(output->hpd_gpio);
 233                         return err;
 234                 }
 235
 236                 output->hpd_irq = err;
 237
 238                 flags = IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING |
 239                         IRQF_ONESHOT;
 240
 241                 err = request_threaded_irq(output->hpd_irq, NULL, hpd_irq,
 242                                            flags, "hpd", output);
 243                 if (err < 0) {
 244                         dev_err(output->dev, "failed to request IRQ#%u: %d\n",
 245                                 output->hpd_irq, err);
 246                         gpio_free(output->hpd_gpio);
 247                         return err;
 248                 }
 249
 250                 output->connector.polled = DRM_CONNECTOR_POLL_HPD;
 251         }
 252
 253         return 0;
 254 }
 255
 256 int tegra_output_remove(struct tegra_output *output)
 257 {
 258         if (gpio_is_valid(output->hpd_gpio)) {
 259                 free_irq(output->hpd_irq, output);
 260                 gpio_free(output->hpd_gpio);
 261         }
 262
 263         if (output->ddc)
 264                 put_device(&output->ddc->dev);
 265
 266         return 0;
 267 }
 268
 269 int tegra_output_init(struct drm_device *drm, struct tegra_output *output)
 270 {
 271         int connector, encoder;
 272
 273         switch (output->type) {
 274         case TEGRA_OUTPUT_RGB:
 275                 connector = DRM_MODE_CONNECTOR_LVDS;
 276                 encoder = DRM_MODE_ENCODER_LVDS;
 277                 break;
 278
 279         case TEGRA_OUTPUT_HDMI:
 280                 connector = DRM_MODE_CONNECTOR_HDMIA;
 281                 encoder = DRM_MODE_ENCODER_TMDS;
 282                 break;
 283
 284         default:
 285                 connector = DRM_MODE_CONNECTOR_Unknown;
 286                 encoder = DRM_MODE_ENCODER_NONE;
 287                 break;
 288         }
 289
 290         drm_connector_init(drm, &output->connector, &connector_funcs,
 291                            connector);
 292         drm_connector_helper_add(&output->connector, &connector_helper_funcs);
 293
 294         if (output->panel)
 295                 drm_panel_attach(output->panel, &output->connector);
 296
 297         drm_encoder_init(drm, &output->encoder, &encoder_funcs, encoder);
 298         drm_encoder_helper_add(&output->encoder, &encoder_helper_funcs);
 299
 300         drm_mode_connector_attach_encoder(&output->connector, &output->encoder);
 301         drm_sysfs_connector_add(&output->connector);
 302
 303         output->encoder.possible_crtcs = 0x3;
 304
 305         return 0;
 306 }
 307
 308 int tegra_output_exit(struct tegra_output *output)
 309 {
 310         return 0;
 311 }