drivers/gpu/drm/imx/ipuv3/parallel-display.c

   1 // SPDX-License-Identifier: GPL-2.0+
   2 /*
   3  * i.MX drm driver - parallel display implementation
   4  *
   5  * Copyright (C) 2012 Sascha Hauer, Pengutronix
   6  */
   7
   8 #include <linux/component.h>
   9 #include <linux/media-bus-format.h>
  10 #include <linux/module.h>
  11 #include <linux/of.h>
  12 #include <linux/platform_device.h>
  13 #include <linux/videodev2.h>
  14
  15 #include <drm/drm_atomic_helper.h>
  16 #include <drm/drm_bridge.h>
  17 #include <drm/drm_bridge_connector.h>
  18 #include <drm/drm_managed.h>
  19 #include <drm/drm_of.h>
  20 #include <drm/drm_probe_helper.h>
  21 #include <drm/drm_simple_kms_helper.h>
  22 #include <drm/bridge/imx.h>
  23
  24 #include "imx-drm.h"
  25
  26 struct imx_parallel_display_encoder {
  27         struct drm_encoder encoder;
  28         struct drm_bridge bridge;
  29         struct imx_parallel_display *pd;
  30 };
  31
  32 struct imx_parallel_display {
  33         struct device *dev;
  34         u32 bus_format;
  35         struct drm_bridge *next_bridge;
  36 };
  37
  38 static inline struct imx_parallel_display *bridge_to_imxpd(struct drm_bridge *b)
  39 {
  40         return container_of(b, struct imx_parallel_display_encoder, bridge)->pd;
  41 }
  42
  43 static const u32 imx_pd_bus_fmts[] = {
  44         MEDIA_BUS_FMT_RGB888_1X24,
  45         MEDIA_BUS_FMT_BGR888_1X24,
  46         MEDIA_BUS_FMT_GBR888_1X24,
  47         MEDIA_BUS_FMT_RGB666_1X18,
  48         MEDIA_BUS_FMT_RGB666_1X24_CPADHI,
  49         MEDIA_BUS_FMT_RGB565_1X16,
  50 };
  51
  52 static u32 *
  53 imx_pd_bridge_atomic_get_output_bus_fmts(struct drm_bridge *bridge,
  54                                          struct drm_bridge_state *bridge_state,
  55                                          struct drm_crtc_state *crtc_state,
  56                                          struct drm_connector_state *conn_state,
  57                                          unsigned int *num_output_fmts)
  58 {
  59         struct drm_display_info *di = &conn_state->connector->display_info;
  60         struct imx_parallel_display *imxpd = bridge_to_imxpd(bridge);
  61         u32 *output_fmts;
  62
  63         if (!imxpd->bus_format && !di->num_bus_formats) {
  64                 *num_output_fmts = ARRAY_SIZE(imx_pd_bus_fmts);
  65                 return kmemdup(imx_pd_bus_fmts, sizeof(imx_pd_bus_fmts),
  66                                GFP_KERNEL);
  67         }
  68
  69         *num_output_fmts = 1;
  70         output_fmts = kmalloc(sizeof(*output_fmts), GFP_KERNEL);
  71         if (!output_fmts)
  72                 return NULL;
  73
  74         if (!imxpd->bus_format && di->num_bus_formats)
  75                 output_fmts[0] = di->bus_formats[0];
  76         else
  77                 output_fmts[0] = imxpd->bus_format;
  78
  79         return output_fmts;
  80 }
  81
  82 static bool imx_pd_format_supported(u32 output_fmt)
  83 {
  84         unsigned int i;
  85
  86         for (i = 0; i < ARRAY_SIZE(imx_pd_bus_fmts); i++) {
  87                 if (imx_pd_bus_fmts[i] == output_fmt)
  88                         return true;
  89         }
  90
  91         return false;
  92 }
  93
  94 static u32 *
  95 imx_pd_bridge_atomic_get_input_bus_fmts(struct drm_bridge *bridge,
  96                                         struct drm_bridge_state *bridge_state,
  97                                         struct drm_crtc_state *crtc_state,
  98                                         struct drm_connector_state *conn_state,
  99                                         u32 output_fmt,
 100                                         unsigned int *num_input_fmts)
 101 {
 102         struct imx_parallel_display *imxpd = bridge_to_imxpd(bridge);
 103         u32 *input_fmts;
 104
 105         /*
 106          * If the next bridge does not support bus format negotiation, let's
 107          * use the static bus format definition (imxpd->bus_format) if it's
 108          * specified, RGB888 when it's not.
 109          */
 110         if (output_fmt == MEDIA_BUS_FMT_FIXED)
 111                 output_fmt = imxpd->bus_format ? : MEDIA_BUS_FMT_RGB888_1X24;
 112
 113         /* Now make sure the requested output format is supported. */
 114         if ((imxpd->bus_format && imxpd->bus_format != output_fmt) ||
 115             !imx_pd_format_supported(output_fmt)) {
 116                 *num_input_fmts = 0;
 117                 return NULL;
 118         }
 119
 120         *num_input_fmts = 1;
 121         input_fmts = kmalloc(sizeof(*input_fmts), GFP_KERNEL);
 122         if (!input_fmts)
 123                 return NULL;
 124
 125         input_fmts[0] = output_fmt;
 126         return input_fmts;
 127 }
 128
 129 static int imx_pd_bridge_atomic_check(struct drm_bridge *bridge,
 130                                       struct drm_bridge_state *bridge_state,
 131                                       struct drm_crtc_state *crtc_state,
 132                                       struct drm_connector_state *conn_state)
 133 {
 134         struct imx_crtc_state *imx_crtc_state = to_imx_crtc_state(crtc_state);
 135         struct drm_display_info *di = &conn_state->connector->display_info;
 136         struct drm_bridge_state *next_bridge_state = NULL;
 137         struct drm_bridge *next_bridge;
 138         u32 bus_flags, bus_fmt;
 139
 140         next_bridge = drm_bridge_get_next_bridge(bridge);
 141         if (next_bridge)
 142                 next_bridge_state = drm_atomic_get_new_bridge_state(crtc_state->state,
 143                                                                     next_bridge);
 144
 145         if (next_bridge_state)
 146                 bus_flags = next_bridge_state->input_bus_cfg.flags;
 147         else
 148                 bus_flags = di->bus_flags;
 149
 150         bus_fmt = bridge_state->input_bus_cfg.format;
 151         if (!imx_pd_format_supported(bus_fmt))
 152                 return -EINVAL;
 153
 154         bridge_state->output_bus_cfg.flags = bus_flags;
 155         bridge_state->input_bus_cfg.flags = bus_flags;
 156         imx_crtc_state->bus_flags = bus_flags;
 157         imx_crtc_state->bus_format = bridge_state->input_bus_cfg.format;
 158         imx_crtc_state->di_hsync_pin = 2;
 159         imx_crtc_state->di_vsync_pin = 3;
 160
 161         return 0;
 162 }
 163
 164 static int imx_pd_bridge_attach(struct drm_bridge *bridge,
 165                                 enum drm_bridge_attach_flags flags)
 166 {
 167         struct imx_parallel_display *imxpd = bridge_to_imxpd(bridge);
 168
 169         return drm_bridge_attach(bridge->encoder, imxpd->next_bridge, bridge, flags);
 170 }
 171
 172 static const struct drm_bridge_funcs imx_pd_bridge_funcs = {
 173         .attach = imx_pd_bridge_attach,
 174         .atomic_reset = drm_atomic_helper_bridge_reset,
 175         .atomic_duplicate_state = drm_atomic_helper_bridge_duplicate_state,
 176         .atomic_destroy_state = drm_atomic_helper_bridge_destroy_state,
 177         .atomic_check = imx_pd_bridge_atomic_check,
 178         .atomic_get_input_bus_fmts = imx_pd_bridge_atomic_get_input_bus_fmts,
 179         .atomic_get_output_bus_fmts = imx_pd_bridge_atomic_get_output_bus_fmts,
 180 };
 181
 182 static int imx_pd_bind(struct device *dev, struct device *master, void *data)
 183 {
 184         struct drm_device *drm = data;
 185         struct imx_parallel_display *imxpd = dev_get_drvdata(dev);
 186         struct imx_parallel_display_encoder *imxpd_encoder;
 187         struct drm_connector *connector;
 188         struct drm_encoder *encoder;
 189         struct drm_bridge *bridge;
 190         int ret;
 191
 192         imxpd_encoder = drmm_simple_encoder_alloc(drm, struct imx_parallel_display_encoder,
 193                                                   encoder, DRM_MODE_ENCODER_NONE);
 194         if (IS_ERR(imxpd_encoder))
 195                 return PTR_ERR(imxpd_encoder);
 196
 197         imxpd_encoder->pd = imxpd;
 198         encoder = &imxpd_encoder->encoder;
 199         bridge = &imxpd_encoder->bridge;
 200
 201         ret = imx_drm_encoder_parse_of(drm, encoder, imxpd->dev->of_node);
 202         if (ret)
 203                 return ret;
 204
 205         bridge->funcs = &imx_pd_bridge_funcs;
 206         drm_bridge_attach(encoder, bridge, NULL, DRM_BRIDGE_ATTACH_NO_CONNECTOR);
 207
 208         connector = drm_bridge_connector_init(drm, encoder);
 209         if (IS_ERR(connector))
 210                 return PTR_ERR(connector);
 211
 212         drm_connector_attach_encoder(connector, encoder);
 213
 214         return 0;
 215 }
 216
 217 static const struct component_ops imx_pd_ops = {
 218         .bind   = imx_pd_bind,
 219 };
 220
 221 static int imx_pd_probe(struct platform_device *pdev)
 222 {
 223         struct device *dev = &pdev->dev;
 224         struct device_node *np = dev->of_node;
 225         struct imx_parallel_display *imxpd;
 226         int ret;
 227         u32 bus_format = 0;
 228         const char *fmt;
 229
 230         imxpd = devm_kzalloc(dev, sizeof(*imxpd), GFP_KERNEL);
 231         if (!imxpd)
 232                 return -ENOMEM;
 233
 234         /* port@1 is the output port */
 235         imxpd->next_bridge = devm_drm_of_get_bridge(dev, np, 1, 0);
 236         if (imxpd->next_bridge == ERR_PTR(-ENODEV))
 237                 imxpd->next_bridge = devm_imx_drm_legacy_bridge(dev, np, DRM_MODE_CONNECTOR_DPI);
 238         if (IS_ERR(imxpd->next_bridge)) {
 239                 ret = PTR_ERR(imxpd->next_bridge);
 240                 return ret;
 241         }
 242
 243         ret = of_property_read_string(np, "interface-pix-fmt", &fmt);
 244         if (!ret) {
 245                 if (!strcmp(fmt, "rgb24"))
 246                         bus_format = MEDIA_BUS_FMT_RGB888_1X24;
 247                 else if (!strcmp(fmt, "rgb565"))
 248                         bus_format = MEDIA_BUS_FMT_RGB565_1X16;
 249                 else if (!strcmp(fmt, "bgr666"))
 250                         bus_format = MEDIA_BUS_FMT_RGB666_1X18;
 251                 else if (!strcmp(fmt, "lvds666"))
 252                         bus_format = MEDIA_BUS_FMT_RGB666_1X24_CPADHI;
 253         }
 254         imxpd->bus_format = bus_format;
 255
 256         imxpd->dev = dev;
 257
 258         platform_set_drvdata(pdev, imxpd);
 259
 260         return component_add(dev, &imx_pd_ops);
 261 }
 262
 263 static void imx_pd_remove(struct platform_device *pdev)
 264 {
 265         component_del(&pdev->dev, &imx_pd_ops);
 266 }
 267
 268 static const struct of_device_id imx_pd_dt_ids[] = {
 269         { .compatible = "fsl,imx-parallel-display", },
 270         { /* sentinel */ }
 271 };
 272 MODULE_DEVICE_TABLE(of, imx_pd_dt_ids);
 273
 274 static struct platform_driver imx_pd_driver = {
 275         .probe          = imx_pd_probe,
 276         .remove         = imx_pd_remove,
 277         .driver         = {
 278                 .of_match_table = imx_pd_dt_ids,
 279                 .name   = "imx-parallel-display",
 280         },
 281 };
 282
 283 module_platform_driver(imx_pd_driver);
 284
 285 MODULE_DESCRIPTION("i.MX parallel display driver");
 286 MODULE_AUTHOR("Sascha Hauer, Pengutronix");
 287 MODULE_LICENSE("GPL");
 288 MODULE_ALIAS("platform:imx-parallel-display");