1 // SPDX-License-Identifier: GPL-2.0+
3 * shmob_drm_kms.c -- SH Mobile DRM Mode Setting
5 * Copyright (C) 2012 Renesas Electronics Corporation
7 * Laurent Pinchart (laurent.pinchart@ideasonboard.com)
11 #include <drm/drm_crtc.h>
12 #include <drm/drm_crtc_helper.h>
13 #include <drm/drm_fb_cma_helper.h>
14 #include <drm/drm_gem_cma_helper.h>
15 #include <drm/drm_gem_framebuffer_helper.h>
16 #include <drm/drm_probe_helper.h>
18 #include "shmob_drm_crtc.h"
19 #include "shmob_drm_drv.h"
20 #include "shmob_drm_kms.h"
21 #include "shmob_drm_regs.h"
23 /* -----------------------------------------------------------------------------
27 static const struct shmob_drm_format_info shmob_drm_format_infos[] = {
29 .fourcc = DRM_FORMAT_RGB565,
32 .lddfr = LDDFR_PKF_RGB16,
34 .fourcc = DRM_FORMAT_RGB888,
37 .lddfr = LDDFR_PKF_RGB24,
39 .fourcc = DRM_FORMAT_ARGB8888,
42 .lddfr = LDDFR_PKF_ARGB32,
44 .fourcc = DRM_FORMAT_NV12,
47 .lddfr = LDDFR_CC | LDDFR_YF_420,
49 .fourcc = DRM_FORMAT_NV21,
52 .lddfr = LDDFR_CC | LDDFR_YF_420,
54 .fourcc = DRM_FORMAT_NV16,
57 .lddfr = LDDFR_CC | LDDFR_YF_422,
59 .fourcc = DRM_FORMAT_NV61,
62 .lddfr = LDDFR_CC | LDDFR_YF_422,
64 .fourcc = DRM_FORMAT_NV24,
67 .lddfr = LDDFR_CC | LDDFR_YF_444,
69 .fourcc = DRM_FORMAT_NV42,
72 .lddfr = LDDFR_CC | LDDFR_YF_444,
76 const struct shmob_drm_format_info *shmob_drm_format_info(u32 fourcc)
80 for (i = 0; i < ARRAY_SIZE(shmob_drm_format_infos); ++i) {
81 if (shmob_drm_format_infos[i].fourcc == fourcc)
82 return &shmob_drm_format_infos[i];
88 /* -----------------------------------------------------------------------------
92 static struct drm_framebuffer *
93 shmob_drm_fb_create(struct drm_device *dev, struct drm_file *file_priv,
94 const struct drm_mode_fb_cmd2 *mode_cmd)
96 const struct shmob_drm_format_info *format;
98 format = shmob_drm_format_info(mode_cmd->pixel_format);
100 dev_dbg(dev->dev, "unsupported pixel format %08x\n",
101 mode_cmd->pixel_format);
102 return ERR_PTR(-EINVAL);
105 if (mode_cmd->pitches[0] & 7 || mode_cmd->pitches[0] >= 65536) {
106 dev_dbg(dev->dev, "invalid pitch value %u\n",
107 mode_cmd->pitches[0]);
108 return ERR_PTR(-EINVAL);
112 unsigned int chroma_cpp = format->bpp == 24 ? 2 : 1;
114 if (mode_cmd->pitches[1] != mode_cmd->pitches[0] * chroma_cpp) {
116 "luma and chroma pitches do not match\n");
117 return ERR_PTR(-EINVAL);
121 return drm_gem_fb_create(dev, file_priv, mode_cmd);
124 static const struct drm_mode_config_funcs shmob_drm_mode_config_funcs = {
125 .fb_create = shmob_drm_fb_create,
128 int shmob_drm_modeset_init(struct shmob_drm_device *sdev)
130 drm_mode_config_init(sdev->ddev);
132 shmob_drm_crtc_create(sdev);
133 shmob_drm_encoder_create(sdev);
134 shmob_drm_connector_create(sdev, &sdev->encoder.encoder);
136 drm_kms_helper_poll_init(sdev->ddev);
138 sdev->ddev->mode_config.min_width = 0;
139 sdev->ddev->mode_config.min_height = 0;
140 sdev->ddev->mode_config.max_width = 4095;
141 sdev->ddev->mode_config.max_height = 4095;
142 sdev->ddev->mode_config.funcs = &shmob_drm_mode_config_funcs;
144 drm_helper_disable_unused_functions(sdev->ddev);