drivers/gpu/drm/omapdrm/omap_encoder.c

   1 // SPDX-License-Identifier: GPL-2.0-only
   2 /*
   3  * Copyright (C) 2011 Texas Instruments Incorporated - http://www.ti.com/
   4  * Author: Rob Clark <rob@ti.com>
   5  */
   6
   7 #include <linux/list.h>
   8
   9 #include <drm/drm_crtc.h>
  10 #include <drm/drm_modeset_helper_vtables.h>
  11 #include <drm/drm_edid.h>
  12 #include <drm/drm_panel.h>
  13
  14 #include "omap_drv.h"
  15
  16 /*
  17  * encoder funcs
  18  */
  19
  20 #define to_omap_encoder(x) container_of(x, struct omap_encoder, base)
  21
  22 /* The encoder and connector both map to same dssdev.. the encoder
  23  * handles the 'active' parts, ie. anything the modifies the state
  24  * of the hw, and the connector handles the 'read-only' parts, like
  25  * detecting connection and reading edid.
  26  */
  27 struct omap_encoder {
  28         struct drm_encoder base;
  29         struct omap_dss_device *output;
  30 };
  31
  32 static void omap_encoder_destroy(struct drm_encoder *encoder)
  33 {
  34         struct omap_encoder *omap_encoder = to_omap_encoder(encoder);
  35
  36         drm_encoder_cleanup(encoder);
  37         kfree(omap_encoder);
  38 }
  39
  40 static const struct drm_encoder_funcs omap_encoder_funcs = {
  41         .destroy = omap_encoder_destroy,
  42 };
  43
  44 static void omap_encoder_update_videomode_flags(struct videomode *vm,
  45                                                 u32 bus_flags)
  46 {
  47         if (!(vm->flags & (DISPLAY_FLAGS_DE_LOW |
  48                            DISPLAY_FLAGS_DE_HIGH))) {
  49                 if (bus_flags & DRM_BUS_FLAG_DE_LOW)
  50                         vm->flags |= DISPLAY_FLAGS_DE_LOW;
  51                 else if (bus_flags & DRM_BUS_FLAG_DE_HIGH)
  52                         vm->flags |= DISPLAY_FLAGS_DE_HIGH;
  53         }
  54
  55         if (!(vm->flags & (DISPLAY_FLAGS_PIXDATA_POSEDGE |
  56                            DISPLAY_FLAGS_PIXDATA_NEGEDGE))) {
  57                 if (bus_flags & DRM_BUS_FLAG_PIXDATA_DRIVE_POSEDGE)
  58                         vm->flags |= DISPLAY_FLAGS_PIXDATA_POSEDGE;
  59                 else if (bus_flags & DRM_BUS_FLAG_PIXDATA_DRIVE_NEGEDGE)
  60                         vm->flags |= DISPLAY_FLAGS_PIXDATA_NEGEDGE;
  61         }
  62
  63         if (!(vm->flags & (DISPLAY_FLAGS_SYNC_POSEDGE |
  64                            DISPLAY_FLAGS_SYNC_NEGEDGE))) {
  65                 if (bus_flags & DRM_BUS_FLAG_SYNC_DRIVE_POSEDGE)
  66                         vm->flags |= DISPLAY_FLAGS_SYNC_POSEDGE;
  67                 else if (bus_flags & DRM_BUS_FLAG_SYNC_DRIVE_NEGEDGE)
  68                         vm->flags |= DISPLAY_FLAGS_SYNC_NEGEDGE;
  69         }
  70 }
  71
  72 static void omap_encoder_hdmi_mode_set(struct drm_connector *connector,
  73                                        struct drm_encoder *encoder,
  74                                        struct drm_display_mode *adjusted_mode)
  75 {
  76         struct omap_encoder *omap_encoder = to_omap_encoder(encoder);
  77         struct omap_dss_device *dssdev = omap_encoder->output;
  78         bool hdmi_mode;
  79
  80         hdmi_mode = omap_connector_get_hdmi_mode(connector);
  81
  82         if (dssdev->ops->hdmi.set_hdmi_mode)
  83                 dssdev->ops->hdmi.set_hdmi_mode(dssdev, hdmi_mode);
  84
  85         if (hdmi_mode && dssdev->ops->hdmi.set_infoframe) {
  86                 struct hdmi_avi_infoframe avi;
  87                 int r;
  88
  89                 r = drm_hdmi_avi_infoframe_from_display_mode(&avi, connector,
  90                                                              adjusted_mode);
  91                 if (r == 0)
  92                         dssdev->ops->hdmi.set_infoframe(dssdev, &avi);
  93         }
  94 }
  95
  96 static void omap_encoder_mode_set(struct drm_encoder *encoder,
  97                                   struct drm_display_mode *mode,
  98                                   struct drm_display_mode *adjusted_mode)
  99 {
 100         struct omap_encoder *omap_encoder = to_omap_encoder(encoder);
 101         struct omap_dss_device *output = omap_encoder->output;
 102         struct omap_dss_device *dssdev;
 103         struct drm_device *dev = encoder->dev;
 104         struct drm_connector *connector;
 105         struct drm_bridge *bridge;
 106         struct videomode vm = { 0 };
 107         u32 bus_flags;
 108
 109         list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
 110                 if (connector->encoder == encoder)
 111                         break;
 112         }
 113
 114         drm_display_mode_to_videomode(adjusted_mode, &vm);
 115
 116         /*
 117          * HACK: This fixes the vm flags.
 118          * struct drm_display_mode does not contain the VSYNC/HSYNC/DE flags and
 119          * they get lost when converting back and forth between struct
 120          * drm_display_mode and struct videomode. The hack below goes and
 121          * fetches the missing flags.
 122          *
 123          * A better solution is to use DRM's bus-flags through the whole driver.
 124          */
 125         for (dssdev = output; dssdev; dssdev = dssdev->next)
 126                 omap_encoder_update_videomode_flags(&vm, dssdev->bus_flags);
 127
 128         for (bridge = output->bridge; bridge; bridge = bridge->next) {
 129                 if (!bridge->timings)
 130                         continue;
 131
 132                 bus_flags = bridge->timings->input_bus_flags;
 133                 omap_encoder_update_videomode_flags(&vm, bus_flags);
 134         }
 135
 136         bus_flags = connector->display_info.bus_flags;
 137         omap_encoder_update_videomode_flags(&vm, bus_flags);
 138
 139         /* Set timings for all devices in the display pipeline. */
 140         dss_mgr_set_timings(output, &vm);
 141
 142         for (dssdev = output; dssdev; dssdev = dssdev->next) {
 143                 if (dssdev->ops->set_timings)
 144                         dssdev->ops->set_timings(dssdev, adjusted_mode);
 145         }
 146
 147         /* Set the HDMI mode and HDMI infoframe if applicable. */
 148         if (output->type == OMAP_DISPLAY_TYPE_HDMI)
 149                 omap_encoder_hdmi_mode_set(connector, encoder, adjusted_mode);
 150 }
 151
 152 static void omap_encoder_disable(struct drm_encoder *encoder)
 153 {
 154         struct omap_encoder *omap_encoder = to_omap_encoder(encoder);
 155         struct omap_dss_device *dssdev = omap_encoder->output;
 156         struct drm_device *dev = encoder->dev;
 157
 158         dev_dbg(dev->dev, "disable(%s)\n", dssdev->name);
 159
 160         /* Disable the panel if present. */
 161         if (dssdev->panel) {
 162                 drm_panel_disable(dssdev->panel);
 163                 drm_panel_unprepare(dssdev->panel);
 164         }
 165
 166         /*
 167          * Disable the chain of external devices, starting at the one at the
 168          * internal encoder's output.
 169          */
 170         omapdss_device_disable(dssdev->next);
 171
 172         /*
 173          * Disable the internal encoder. This will disable the DSS output. The
 174          * DSI is treated as an exception as DSI pipelines still use the legacy
 175          * flow where the pipeline output controls the encoder.
 176          */
 177         if (dssdev->type != OMAP_DISPLAY_TYPE_DSI) {
 178                 dssdev->ops->disable(dssdev);
 179                 dssdev->state = OMAP_DSS_DISPLAY_DISABLED;
 180         }
 181
 182         /*
 183          * Perform the post-disable operations on the chain of external devices
 184          * to complete the display pipeline disable.
 185          */
 186         omapdss_device_post_disable(dssdev->next);
 187 }
 188
 189 static void omap_encoder_enable(struct drm_encoder *encoder)
 190 {
 191         struct omap_encoder *omap_encoder = to_omap_encoder(encoder);
 192         struct omap_dss_device *dssdev = omap_encoder->output;
 193         struct drm_device *dev = encoder->dev;
 194
 195         dev_dbg(dev->dev, "enable(%s)\n", dssdev->name);
 196
 197         /* Prepare the chain of external devices for pipeline enable. */
 198         omapdss_device_pre_enable(dssdev->next);
 199
 200         /*
 201          * Enable the internal encoder. This will enable the DSS output. The
 202          * DSI is treated as an exception as DSI pipelines still use the legacy
 203          * flow where the pipeline output controls the encoder.
 204          */
 205         if (dssdev->type != OMAP_DISPLAY_TYPE_DSI) {
 206                 dssdev->ops->enable(dssdev);
 207                 dssdev->state = OMAP_DSS_DISPLAY_ACTIVE;
 208         }
 209
 210         /*
 211          * Enable the chain of external devices, starting at the one at the
 212          * internal encoder's output.
 213          */
 214         omapdss_device_enable(dssdev->next);
 215
 216         /* Enable the panel if present. */
 217         if (dssdev->panel) {
 218                 drm_panel_prepare(dssdev->panel);
 219                 drm_panel_enable(dssdev->panel);
 220         }
 221 }
 222
 223 static int omap_encoder_atomic_check(struct drm_encoder *encoder,
 224                                      struct drm_crtc_state *crtc_state,
 225                                      struct drm_connector_state *conn_state)
 226 {
 227         struct omap_encoder *omap_encoder = to_omap_encoder(encoder);
 228         enum drm_mode_status status;
 229
 230         status = omap_connector_mode_fixup(omap_encoder->output,
 231                                            &crtc_state->mode,
 232                                            &crtc_state->adjusted_mode);
 233         if (status != MODE_OK) {
 234                 dev_err(encoder->dev->dev, "invalid timings: %d\n", status);
 235                 return -EINVAL;
 236         }
 237
 238         return 0;
 239 }
 240
 241 static const struct drm_encoder_helper_funcs omap_encoder_helper_funcs = {
 242         .mode_set = omap_encoder_mode_set,
 243         .disable = omap_encoder_disable,
 244         .enable = omap_encoder_enable,
 245         .atomic_check = omap_encoder_atomic_check,
 246 };
 247
 248 /* initialize encoder */
 249 struct drm_encoder *omap_encoder_init(struct drm_device *dev,
 250                                       struct omap_dss_device *output)
 251 {
 252         struct drm_encoder *encoder = NULL;
 253         struct omap_encoder *omap_encoder;
 254
 255         omap_encoder = kzalloc(sizeof(*omap_encoder), GFP_KERNEL);
 256         if (!omap_encoder)
 257                 goto fail;
 258
 259         omap_encoder->output = output;
 260
 261         encoder = &omap_encoder->base;
 262
 263         drm_encoder_init(dev, encoder, &omap_encoder_funcs,
 264                          DRM_MODE_ENCODER_TMDS, NULL);
 265         drm_encoder_helper_add(encoder, &omap_encoder_helper_funcs);
 266
 267         return encoder;
 268
 269 fail:
 270         if (encoder)
 271                 omap_encoder_destroy(encoder);
 272
 273         return NULL;
 274 }