linux/drivers/gpu/drm/imx/parallel-display.c
<<
>>
Prefs
   1/*
   2 * i.MX drm driver - parallel display implementation
   3 *
   4 * Copyright (C) 2012 Sascha Hauer, Pengutronix
   5 *
   6 * This program is free software; you can redistribute it and/or
   7 * modify it under the terms of the GNU General Public License
   8 * as published by the Free Software Foundation; either version 2
   9 * of the License, or (at your option) any later version.
  10 * This program is distributed in the hope that it will be useful,
  11 * but WITHOUT ANY WARRANTY; without even the implied warranty of
  12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  13 * GNU General Public License for more details.
  14 */
  15
  16#include <linux/component.h>
  17#include <linux/module.h>
  18#include <drm/drmP.h>
  19#include <drm/drm_atomic_helper.h>
  20#include <drm/drm_fb_helper.h>
  21#include <drm/drm_crtc_helper.h>
  22#include <drm/drm_of.h>
  23#include <drm/drm_panel.h>
  24#include <linux/videodev2.h>
  25#include <video/of_display_timing.h>
  26
  27#include "imx-drm.h"
  28
  29struct imx_parallel_display {
  30        struct drm_connector connector;
  31        struct drm_encoder encoder;
  32        struct device *dev;
  33        void *edid;
  34        int edid_len;
  35        u32 bus_format;
  36        u32 bus_flags;
  37        struct drm_display_mode mode;
  38        struct drm_panel *panel;
  39        struct drm_bridge *bridge;
  40};
  41
  42static inline struct imx_parallel_display *con_to_imxpd(struct drm_connector *c)
  43{
  44        return container_of(c, struct imx_parallel_display, connector);
  45}
  46
  47static inline struct imx_parallel_display *enc_to_imxpd(struct drm_encoder *e)
  48{
  49        return container_of(e, struct imx_parallel_display, encoder);
  50}
  51
  52static int imx_pd_connector_get_modes(struct drm_connector *connector)
  53{
  54        struct imx_parallel_display *imxpd = con_to_imxpd(connector);
  55        struct device_node *np = imxpd->dev->of_node;
  56        int num_modes = 0;
  57
  58        if (imxpd->panel && imxpd->panel->funcs &&
  59            imxpd->panel->funcs->get_modes) {
  60                num_modes = imxpd->panel->funcs->get_modes(imxpd->panel);
  61                if (num_modes > 0)
  62                        return num_modes;
  63        }
  64
  65        if (imxpd->edid) {
  66                drm_mode_connector_update_edid_property(connector, imxpd->edid);
  67                num_modes = drm_add_edid_modes(connector, imxpd->edid);
  68        }
  69
  70        if (np) {
  71                struct drm_display_mode *mode = drm_mode_create(connector->dev);
  72                int ret;
  73
  74                if (!mode)
  75                        return -EINVAL;
  76
  77                ret = of_get_drm_display_mode(np, &imxpd->mode,
  78                                              &imxpd->bus_flags,
  79                                              OF_USE_NATIVE_MODE);
  80                if (ret)
  81                        return ret;
  82
  83                drm_mode_copy(mode, &imxpd->mode);
  84                mode->type |= DRM_MODE_TYPE_DRIVER | DRM_MODE_TYPE_PREFERRED,
  85                drm_mode_probed_add(connector, mode);
  86                num_modes++;
  87        }
  88
  89        return num_modes;
  90}
  91
  92static struct drm_encoder *imx_pd_connector_best_encoder(
  93                struct drm_connector *connector)
  94{
  95        struct imx_parallel_display *imxpd = con_to_imxpd(connector);
  96
  97        return &imxpd->encoder;
  98}
  99
 100static void imx_pd_encoder_enable(struct drm_encoder *encoder)
 101{
 102        struct imx_parallel_display *imxpd = enc_to_imxpd(encoder);
 103
 104        drm_panel_prepare(imxpd->panel);
 105        drm_panel_enable(imxpd->panel);
 106}
 107
 108static void imx_pd_encoder_disable(struct drm_encoder *encoder)
 109{
 110        struct imx_parallel_display *imxpd = enc_to_imxpd(encoder);
 111
 112        drm_panel_disable(imxpd->panel);
 113        drm_panel_unprepare(imxpd->panel);
 114}
 115
 116static int imx_pd_encoder_atomic_check(struct drm_encoder *encoder,
 117                                       struct drm_crtc_state *crtc_state,
 118                                       struct drm_connector_state *conn_state)
 119{
 120        struct imx_crtc_state *imx_crtc_state = to_imx_crtc_state(crtc_state);
 121        struct drm_display_info *di = &conn_state->connector->display_info;
 122        struct imx_parallel_display *imxpd = enc_to_imxpd(encoder);
 123
 124        if (!imxpd->bus_format && di->num_bus_formats) {
 125                imx_crtc_state->bus_flags = di->bus_flags;
 126                imx_crtc_state->bus_format = di->bus_formats[0];
 127        } else {
 128                imx_crtc_state->bus_flags = imxpd->bus_flags;
 129                imx_crtc_state->bus_format = imxpd->bus_format;
 130        }
 131        imx_crtc_state->di_hsync_pin = 2;
 132        imx_crtc_state->di_vsync_pin = 3;
 133
 134        return 0;
 135}
 136
 137static const struct drm_connector_funcs imx_pd_connector_funcs = {
 138        .fill_modes = drm_helper_probe_single_connector_modes,
 139        .destroy = imx_drm_connector_destroy,
 140        .reset = drm_atomic_helper_connector_reset,
 141        .atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state,
 142        .atomic_destroy_state = drm_atomic_helper_connector_destroy_state,
 143};
 144
 145static const struct drm_connector_helper_funcs imx_pd_connector_helper_funcs = {
 146        .get_modes = imx_pd_connector_get_modes,
 147        .best_encoder = imx_pd_connector_best_encoder,
 148};
 149
 150static const struct drm_encoder_funcs imx_pd_encoder_funcs = {
 151        .destroy = imx_drm_encoder_destroy,
 152};
 153
 154static const struct drm_encoder_helper_funcs imx_pd_encoder_helper_funcs = {
 155        .enable = imx_pd_encoder_enable,
 156        .disable = imx_pd_encoder_disable,
 157        .atomic_check = imx_pd_encoder_atomic_check,
 158};
 159
 160static int imx_pd_register(struct drm_device *drm,
 161        struct imx_parallel_display *imxpd)
 162{
 163        struct drm_encoder *encoder = &imxpd->encoder;
 164        int ret;
 165
 166        ret = imx_drm_encoder_parse_of(drm, encoder, imxpd->dev->of_node);
 167        if (ret)
 168                return ret;
 169
 170        /* set the connector's dpms to OFF so that
 171         * drm_helper_connector_dpms() won't return
 172         * immediately since the current state is ON
 173         * at this point.
 174         */
 175        imxpd->connector.dpms = DRM_MODE_DPMS_OFF;
 176
 177        drm_encoder_helper_add(encoder, &imx_pd_encoder_helper_funcs);
 178        drm_encoder_init(drm, encoder, &imx_pd_encoder_funcs,
 179                         DRM_MODE_ENCODER_NONE, NULL);
 180
 181        if (!imxpd->bridge) {
 182                drm_connector_helper_add(&imxpd->connector,
 183                                &imx_pd_connector_helper_funcs);
 184                drm_connector_init(drm, &imxpd->connector,
 185                                   &imx_pd_connector_funcs,
 186                                   DRM_MODE_CONNECTOR_VGA);
 187        }
 188
 189        if (imxpd->panel)
 190                drm_panel_attach(imxpd->panel, &imxpd->connector);
 191
 192        if (imxpd->bridge) {
 193                ret = drm_bridge_attach(encoder, imxpd->bridge, NULL);
 194                if (ret < 0) {
 195                        dev_err(imxpd->dev, "failed to attach bridge: %d\n",
 196                                ret);
 197                        return ret;
 198                }
 199        } else {
 200                drm_mode_connector_attach_encoder(&imxpd->connector, encoder);
 201        }
 202
 203        return 0;
 204}
 205
 206static int imx_pd_bind(struct device *dev, struct device *master, void *data)
 207{
 208        struct drm_device *drm = data;
 209        struct device_node *np = dev->of_node;
 210        const u8 *edidp;
 211        struct imx_parallel_display *imxpd;
 212        int ret;
 213        u32 bus_format = 0;
 214        const char *fmt;
 215
 216        imxpd = devm_kzalloc(dev, sizeof(*imxpd), GFP_KERNEL);
 217        if (!imxpd)
 218                return -ENOMEM;
 219
 220        edidp = of_get_property(np, "edid", &imxpd->edid_len);
 221        if (edidp)
 222                imxpd->edid = kmemdup(edidp, imxpd->edid_len, GFP_KERNEL);
 223
 224        ret = of_property_read_string(np, "interface-pix-fmt", &fmt);
 225        if (!ret) {
 226                if (!strcmp(fmt, "rgb24"))
 227                        bus_format = MEDIA_BUS_FMT_RGB888_1X24;
 228                else if (!strcmp(fmt, "rgb565"))
 229                        bus_format = MEDIA_BUS_FMT_RGB565_1X16;
 230                else if (!strcmp(fmt, "bgr666"))
 231                        bus_format = MEDIA_BUS_FMT_RGB666_1X18;
 232                else if (!strcmp(fmt, "lvds666"))
 233                        bus_format = MEDIA_BUS_FMT_RGB666_1X24_CPADHI;
 234        }
 235        imxpd->bus_format = bus_format;
 236
 237        /* port@1 is the output port */
 238        ret = drm_of_find_panel_or_bridge(np, 1, 0, &imxpd->panel, &imxpd->bridge);
 239        if (ret && ret != -ENODEV)
 240                return ret;
 241
 242        imxpd->dev = dev;
 243
 244        ret = imx_pd_register(drm, imxpd);
 245        if (ret)
 246                return ret;
 247
 248        dev_set_drvdata(dev, imxpd);
 249
 250        return 0;
 251}
 252
 253static void imx_pd_unbind(struct device *dev, struct device *master,
 254        void *data)
 255{
 256        struct imx_parallel_display *imxpd = dev_get_drvdata(dev);
 257
 258        if (imxpd->panel)
 259                drm_panel_detach(imxpd->panel);
 260
 261        kfree(imxpd->edid);
 262}
 263
 264static const struct component_ops imx_pd_ops = {
 265        .bind   = imx_pd_bind,
 266        .unbind = imx_pd_unbind,
 267};
 268
 269static int imx_pd_probe(struct platform_device *pdev)
 270{
 271        return component_add(&pdev->dev, &imx_pd_ops);
 272}
 273
 274static int imx_pd_remove(struct platform_device *pdev)
 275{
 276        component_del(&pdev->dev, &imx_pd_ops);
 277
 278        return 0;
 279}
 280
 281static const struct of_device_id imx_pd_dt_ids[] = {
 282        { .compatible = "fsl,imx-parallel-display", },
 283        { /* sentinel */ }
 284};
 285MODULE_DEVICE_TABLE(of, imx_pd_dt_ids);
 286
 287static struct platform_driver imx_pd_driver = {
 288        .probe          = imx_pd_probe,
 289        .remove         = imx_pd_remove,
 290        .driver         = {
 291                .of_match_table = imx_pd_dt_ids,
 292                .name   = "imx-parallel-display",
 293        },
 294};
 295
 296module_platform_driver(imx_pd_driver);
 297
 298MODULE_DESCRIPTION("i.MX parallel display driver");
 299MODULE_AUTHOR("Sascha Hauer, Pengutronix");
 300MODULE_LICENSE("GPL");
 301MODULE_ALIAS("platform:imx-parallel-display");
 302