drivers/gpu/drm/omapdrm/omap_encoder.c

   1 /*
   2  * drivers/gpu/drm/omapdrm/omap_encoder.c
   3  *
   4  * Copyright (C) 2011 Texas Instruments
   5  * Author: Rob Clark <[email protected]>
   6  *
   7  * This program is free software; you can redistribute it and/or modify it
   8  * under the terms of the GNU General Public License version 2 as published by
   9  * the Free Software Foundation.
  10  *
  11  * This program is distributed in the hope that it will be useful, but WITHOUT
  12  * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  13  * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
  14  * more details.
  15  *
  16  * You should have received a copy of the GNU General Public License along with
  17  * this program.  If not, see <http://www.gnu.org/licenses/>.
  18  */
  19
  20 #include <linux/list.h>
  21
  22 #include <drm/drm_crtc.h>
  23 #include <drm/drm_crtc_helper.h>
  24 #include <drm/drm_edid.h>
  25
  26 #include "omap_drv.h"
  27
  28 /*
  29  * encoder funcs
  30  */
  31
  32 #define to_omap_encoder(x) container_of(x, struct omap_encoder, base)
  33
  34 /* The encoder and connector both map to same dssdev.. the encoder
  35  * handles the 'active' parts, ie. anything the modifies the state
  36  * of the hw, and the connector handles the 'read-only' parts, like
  37  * detecting connection and reading edid.
  38  */
  39 struct omap_encoder {
  40         struct drm_encoder base;
  41         struct omap_dss_device *dssdev;
  42 };
  43
  44 struct omap_dss_device *omap_encoder_get_dssdev(struct drm_encoder *encoder)
  45 {
  46         struct omap_encoder *omap_encoder = to_omap_encoder(encoder);
  47
  48         return omap_encoder->dssdev;
  49 }
  50
  51 static void omap_encoder_destroy(struct drm_encoder *encoder)
  52 {
  53         struct omap_encoder *omap_encoder = to_omap_encoder(encoder);
  54
  55         drm_encoder_cleanup(encoder);
  56         kfree(omap_encoder);
  57 }
  58
  59 static const struct drm_encoder_funcs omap_encoder_funcs = {
  60         .destroy = omap_encoder_destroy,
  61 };
  62
  63 static void omap_encoder_mode_set(struct drm_encoder *encoder,
  64                                 struct drm_display_mode *mode,
  65                                 struct drm_display_mode *adjusted_mode)
  66 {
  67         struct drm_device *dev = encoder->dev;
  68         struct omap_encoder *omap_encoder = to_omap_encoder(encoder);
  69         struct omap_dss_device *dssdev = omap_encoder->dssdev;
  70         struct drm_connector *connector;
  71         bool hdmi_mode;
  72         int r;
  73
  74         hdmi_mode = false;
  75         list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
  76                 if (connector->encoder == encoder) {
  77                         hdmi_mode = omap_connector_get_hdmi_mode(connector);
  78                         break;
  79                 }
  80         }
  81
  82         if (dssdev->driver->set_hdmi_mode)
  83                 dssdev->driver->set_hdmi_mode(dssdev, hdmi_mode);
  84
  85         if (hdmi_mode && dssdev->driver->set_hdmi_infoframe) {
  86                 struct hdmi_avi_infoframe avi;
  87
  88                 r = drm_hdmi_avi_infoframe_from_display_mode(&avi, adjusted_mode,
  89                                                              false);
  90                 if (r == 0)
  91                         dssdev->driver->set_hdmi_infoframe(dssdev, &avi);
  92         }
  93 }
  94
  95 static void omap_encoder_disable(struct drm_encoder *encoder)
  96 {
  97         struct omap_encoder *omap_encoder = to_omap_encoder(encoder);
  98         struct omap_dss_device *dssdev = omap_encoder->dssdev;
  99         struct omap_dss_driver *dssdrv = dssdev->driver;
 100
 101         dssdrv->disable(dssdev);
 102 }
 103
 104 static int omap_encoder_update(struct drm_encoder *encoder,
 105                                enum omap_channel channel,
 106                                struct videomode *vm)
 107 {
 108         struct drm_device *dev = encoder->dev;
 109         struct omap_encoder *omap_encoder = to_omap_encoder(encoder);
 110         struct omap_dss_device *dssdev = omap_encoder->dssdev;
 111         struct omap_dss_driver *dssdrv = dssdev->driver;
 112         int ret;
 113
 114         if (dssdrv->check_timings) {
 115                 ret = dssdrv->check_timings(dssdev, vm);
 116         } else {
 117                 struct videomode t = {0};
 118
 119                 dssdrv->get_timings(dssdev, &t);
 120
 121                 if (memcmp(vm, &t, sizeof(*vm)))
 122                         ret = -EINVAL;
 123                 else
 124                         ret = 0;
 125         }
 126
 127         if (ret) {
 128                 dev_err(dev->dev, "could not set timings: %d\n", ret);
 129                 return ret;
 130         }
 131
 132         if (dssdrv->set_timings)
 133                 dssdrv->set_timings(dssdev, vm);
 134
 135         return 0;
 136 }
 137
 138 static void omap_encoder_enable(struct drm_encoder *encoder)
 139 {
 140         struct omap_encoder *omap_encoder = to_omap_encoder(encoder);
 141         struct omap_dss_device *dssdev = omap_encoder->dssdev;
 142         struct omap_dss_driver *dssdrv = dssdev->driver;
 143         int r;
 144
 145         omap_encoder_update(encoder, omap_crtc_channel(encoder->crtc),
 146                             omap_crtc_timings(encoder->crtc));
 147
 148         r = dssdrv->enable(dssdev);
 149         if (r)
 150                 dev_err(encoder->dev->dev,
 151                         "Failed to enable display '%s': %d\n",
 152                         dssdev->name, r);
 153 }
 154
 155 static int omap_encoder_atomic_check(struct drm_encoder *encoder,
 156                                      struct drm_crtc_state *crtc_state,
 157                                      struct drm_connector_state *conn_state)
 158 {
 159         return 0;
 160 }
 161
 162 static const struct drm_encoder_helper_funcs omap_encoder_helper_funcs = {
 163         .mode_set = omap_encoder_mode_set,
 164         .disable = omap_encoder_disable,
 165         .enable = omap_encoder_enable,
 166         .atomic_check = omap_encoder_atomic_check,
 167 };
 168
 169 /* initialize encoder */
 170 struct drm_encoder *omap_encoder_init(struct drm_device *dev,
 171                 struct omap_dss_device *dssdev)
 172 {
 173         struct drm_encoder *encoder = NULL;
 174         struct omap_encoder *omap_encoder;
 175
 176         omap_encoder = kzalloc(sizeof(*omap_encoder), GFP_KERNEL);
 177         if (!omap_encoder)
 178                 goto fail;
 179
 180         omap_encoder->dssdev = dssdev;
 181
 182         encoder = &omap_encoder->base;
 183
 184         drm_encoder_init(dev, encoder, &omap_encoder_funcs,
 185                          DRM_MODE_ENCODER_TMDS, NULL);
 186         drm_encoder_helper_add(encoder, &omap_encoder_helper_funcs);
 187
 188         return encoder;
 189
 190 fail:
 191         if (encoder)
 192                 omap_encoder_destroy(encoder);
 193
 194         return NULL;
 195 }