2 * rcar_du_kms.c -- R-Car Display Unit Mode Setting
4 * Copyright (C) 2013-2014 Renesas Electronics Corporation
6 * Contact: Laurent Pinchart (laurent.pinchart@ideasonboard.com)
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License as published by
10 * the Free Software Foundation; either version 2 of the License, or
11 * (at your option) any later version.
15 #include <drm/drm_crtc.h>
16 #include <drm/drm_crtc_helper.h>
17 #include <drm/drm_fb_cma_helper.h>
18 #include <drm/drm_gem_cma_helper.h>
20 #include <linux/of_graph.h>
22 #include "rcar_du_crtc.h"
23 #include "rcar_du_drv.h"
24 #include "rcar_du_encoder.h"
25 #include "rcar_du_kms.h"
26 #include "rcar_du_lvdsenc.h"
27 #include "rcar_du_regs.h"
29 /* -----------------------------------------------------------------------------
33 static const struct rcar_du_format_info rcar_du_format_infos[] = {
35 .fourcc = DRM_FORMAT_RGB565,
38 .pnmr = PnMR_SPIM_TP | PnMR_DDDF_16BPP,
39 .edf = PnDDCR4_EDF_NONE,
41 .fourcc = DRM_FORMAT_ARGB1555,
44 .pnmr = PnMR_SPIM_ALP | PnMR_DDDF_ARGB,
45 .edf = PnDDCR4_EDF_NONE,
47 .fourcc = DRM_FORMAT_XRGB1555,
50 .pnmr = PnMR_SPIM_ALP | PnMR_DDDF_ARGB,
51 .edf = PnDDCR4_EDF_NONE,
53 .fourcc = DRM_FORMAT_XRGB8888,
56 .pnmr = PnMR_SPIM_TP | PnMR_DDDF_16BPP,
57 .edf = PnDDCR4_EDF_RGB888,
59 .fourcc = DRM_FORMAT_ARGB8888,
62 .pnmr = PnMR_SPIM_ALP | PnMR_DDDF_16BPP,
63 .edf = PnDDCR4_EDF_ARGB8888,
65 .fourcc = DRM_FORMAT_UYVY,
68 .pnmr = PnMR_SPIM_TP_OFF | PnMR_DDDF_YC,
69 .edf = PnDDCR4_EDF_NONE,
71 .fourcc = DRM_FORMAT_YUYV,
74 .pnmr = PnMR_SPIM_TP_OFF | PnMR_DDDF_YC,
75 .edf = PnDDCR4_EDF_NONE,
77 .fourcc = DRM_FORMAT_NV12,
80 .pnmr = PnMR_SPIM_TP_OFF | PnMR_DDDF_YC,
81 .edf = PnDDCR4_EDF_NONE,
83 .fourcc = DRM_FORMAT_NV21,
86 .pnmr = PnMR_SPIM_TP_OFF | PnMR_DDDF_YC,
87 .edf = PnDDCR4_EDF_NONE,
89 /* In YUV 4:2:2, only NV16 is supported (NV61 isn't) */
90 .fourcc = DRM_FORMAT_NV16,
93 .pnmr = PnMR_SPIM_TP_OFF | PnMR_DDDF_YC,
94 .edf = PnDDCR4_EDF_NONE,
98 const struct rcar_du_format_info *rcar_du_format_info(u32 fourcc)
102 for (i = 0; i < ARRAY_SIZE(rcar_du_format_infos); ++i) {
103 if (rcar_du_format_infos[i].fourcc == fourcc)
104 return &rcar_du_format_infos[i];
110 /* -----------------------------------------------------------------------------
114 int rcar_du_dumb_create(struct drm_file *file, struct drm_device *dev,
115 struct drm_mode_create_dumb *args)
117 struct rcar_du_device *rcdu = dev->dev_private;
118 unsigned int min_pitch = DIV_ROUND_UP(args->width * args->bpp, 8);
121 /* The R8A7779 DU requires a 16 pixels pitch alignment as documented,
122 * but the R8A7790 DU seems to require a 128 bytes pitch alignment.
124 if (rcar_du_needs(rcdu, RCAR_DU_QUIRK_ALIGN_128B))
127 align = 16 * args->bpp / 8;
129 args->pitch = roundup(min_pitch, align);
131 return drm_gem_cma_dumb_create_internal(file, dev, args);
134 static struct drm_framebuffer *
135 rcar_du_fb_create(struct drm_device *dev, struct drm_file *file_priv,
136 struct drm_mode_fb_cmd2 *mode_cmd)
138 struct rcar_du_device *rcdu = dev->dev_private;
139 const struct rcar_du_format_info *format;
140 unsigned int max_pitch;
144 format = rcar_du_format_info(mode_cmd->pixel_format);
145 if (format == NULL) {
146 dev_dbg(dev->dev, "unsupported pixel format %08x\n",
147 mode_cmd->pixel_format);
148 return ERR_PTR(-EINVAL);
152 * The pitch and alignment constraints are expressed in pixels on the
153 * hardware side and in bytes in the DRM API.
155 bpp = format->planes == 2 ? 1 : format->bpp / 8;
156 max_pitch = 4096 * bpp;
158 if (rcar_du_needs(rcdu, RCAR_DU_QUIRK_ALIGN_128B))
163 if (mode_cmd->pitches[0] & (align - 1) ||
164 mode_cmd->pitches[0] >= max_pitch) {
165 dev_dbg(dev->dev, "invalid pitch value %u\n",
166 mode_cmd->pitches[0]);
167 return ERR_PTR(-EINVAL);
170 if (format->planes == 2) {
171 if (mode_cmd->pitches[1] != mode_cmd->pitches[0]) {
173 "luma and chroma pitches do not match\n");
174 return ERR_PTR(-EINVAL);
178 return drm_fb_cma_create(dev, file_priv, mode_cmd);
181 static void rcar_du_output_poll_changed(struct drm_device *dev)
183 struct rcar_du_device *rcdu = dev->dev_private;
185 drm_fbdev_cma_hotplug_event(rcdu->fbdev);
188 static const struct drm_mode_config_funcs rcar_du_mode_config_funcs = {
189 .fb_create = rcar_du_fb_create,
190 .output_poll_changed = rcar_du_output_poll_changed,
193 static int rcar_du_encoders_init_one(struct rcar_du_device *rcdu,
194 enum rcar_du_output output,
195 struct of_endpoint *ep)
197 static const struct {
198 const char *compatible;
199 enum rcar_du_encoder_type type;
201 { "adi,adv7123", RCAR_DU_ENCODER_VGA },
202 { "adi,adv7511w", RCAR_DU_ENCODER_HDMI },
203 { "thine,thc63lvdm83d", RCAR_DU_ENCODER_LVDS },
206 enum rcar_du_encoder_type enc_type = RCAR_DU_ENCODER_NONE;
207 struct device_node *connector = NULL;
208 struct device_node *encoder = NULL;
209 struct device_node *prev = NULL;
210 struct device_node *entity_ep_node;
211 struct device_node *entity;
215 * Locate the connected entity and infer its type from the number of
218 entity = of_graph_get_remote_port_parent(ep->local_node);
220 dev_dbg(rcdu->dev, "unconnected endpoint %s, skipping\n",
221 ep->local_node->full_name);
225 entity_ep_node = of_parse_phandle(ep->local_node, "remote-endpoint", 0);
228 struct device_node *ep_node;
230 ep_node = of_graph_get_next_endpoint(entity, prev);
237 if (ep_node == entity_ep_node)
241 * We've found one endpoint other than the input, this must
242 * be an encoder. Locate the connector.
245 connector = of_graph_get_remote_port_parent(ep_node);
246 of_node_put(ep_node);
250 "no connector for encoder %s, skipping\n",
252 of_node_put(entity_ep_node);
253 of_node_put(encoder);
260 of_node_put(entity_ep_node);
264 * If an encoder has been found, get its type based on its
269 for (i = 0; i < ARRAY_SIZE(encoders); ++i) {
270 if (of_device_is_compatible(encoder,
271 encoders[i].compatible)) {
272 enc_type = encoders[i].type;
277 if (i == ARRAY_SIZE(encoders)) {
279 "unknown encoder type for %s, skipping\n",
281 of_node_put(encoder);
282 of_node_put(connector);
287 * If no encoder has been found the entity must be the
293 ret = rcar_du_encoder_init(rcdu, enc_type, output, encoder, connector);
294 of_node_put(encoder);
295 of_node_put(connector);
297 return ret < 0 ? ret : 1;
300 static int rcar_du_encoders_init(struct rcar_du_device *rcdu)
302 struct device_node *np = rcdu->dev->of_node;
303 struct device_node *prev = NULL;
304 unsigned int num_encoders = 0;
307 * Iterate over the endpoints and create one encoder for each output
311 struct device_node *ep_node;
312 enum rcar_du_output output;
313 struct of_endpoint ep;
317 ep_node = of_graph_get_next_endpoint(np, prev);
324 ret = of_graph_parse_endpoint(ep_node, &ep);
326 of_node_put(ep_node);
330 /* Find the output route corresponding to the port number. */
331 for (i = 0; i < RCAR_DU_OUTPUT_MAX; ++i) {
332 if (rcdu->info->routes[i].possible_crtcs &&
333 rcdu->info->routes[i].port == ep.port) {
339 if (i == RCAR_DU_OUTPUT_MAX) {
341 "port %u references unexisting output, skipping\n",
346 /* Process the output pipeline. */
347 ret = rcar_du_encoders_init_one(rcdu, output, &ep);
349 of_node_put(ep_node);
359 int rcar_du_modeset_init(struct rcar_du_device *rcdu)
361 static const unsigned int mmio_offsets[] = {
362 DU0_REG_OFFSET, DU2_REG_OFFSET
365 struct drm_device *dev = rcdu->ddev;
366 struct drm_encoder *encoder;
367 struct drm_fbdev_cma *fbdev;
368 unsigned int num_encoders;
369 unsigned int num_groups;
373 drm_mode_config_init(dev);
375 dev->mode_config.min_width = 0;
376 dev->mode_config.min_height = 0;
377 dev->mode_config.max_width = 4095;
378 dev->mode_config.max_height = 2047;
379 dev->mode_config.funcs = &rcar_du_mode_config_funcs;
381 rcdu->num_crtcs = rcdu->info->num_crtcs;
383 /* Initialize the groups. */
384 num_groups = DIV_ROUND_UP(rcdu->num_crtcs, 2);
386 for (i = 0; i < num_groups; ++i) {
387 struct rcar_du_group *rgrp = &rcdu->groups[i];
390 rgrp->mmio_offset = mmio_offsets[i];
393 ret = rcar_du_planes_init(rgrp);
398 /* Create the CRTCs. */
399 for (i = 0; i < rcdu->num_crtcs; ++i) {
400 struct rcar_du_group *rgrp = &rcdu->groups[i / 2];
402 ret = rcar_du_crtc_create(rgrp, i);
407 /* Initialize the encoders. */
408 ret = rcar_du_lvdsenc_init(rcdu);
412 ret = rcar_du_encoders_init(rcdu);
418 /* Set the possible CRTCs and possible clones. There's always at least
419 * one way for all encoders to clone each other, set all bits in the
420 * possible clones field.
422 list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
423 struct rcar_du_encoder *renc = to_rcar_encoder(encoder);
424 const struct rcar_du_output_routing *route =
425 &rcdu->info->routes[renc->output];
427 encoder->possible_crtcs = route->possible_crtcs;
428 encoder->possible_clones = (1 << num_encoders) - 1;
431 /* Now that the CRTCs have been initialized register the planes. */
432 for (i = 0; i < num_groups; ++i) {
433 ret = rcar_du_planes_register(&rcdu->groups[i]);
438 drm_kms_helper_poll_init(dev);
440 drm_helper_disable_unused_functions(dev);
442 fbdev = drm_fbdev_cma_init(dev, 32, dev->mode_config.num_crtc,
443 dev->mode_config.num_connector);
445 return PTR_ERR(fbdev);
447 #ifndef CONFIG_FRAMEBUFFER_CONSOLE
448 drm_fbdev_cma_restore_mode(fbdev);