1// SPDX-License-Identifier: GPL-2.0+
  2/*
  3 * shmob_drm_kms.c  --  SH Mobile DRM Mode Setting
  4 *
  5 * Copyright (C) 2012 Renesas Electronics Corporation
  6 *
  7 * Laurent Pinchart (laurent.pinchart@ideasonboard.com)
  8 */
  9
 10#include <drm/drm_crtc.h>
 11#include <drm/drm_crtc_helper.h>
 12#include <drm/drm_fb_cma_helper.h>
 13#include <drm/drm_gem_cma_helper.h>
 14#include <drm/drm_gem_framebuffer_helper.h>
 15#include <drm/drm_probe_helper.h>
 16
 17#include "shmob_drm_crtc.h"
 18#include "shmob_drm_drv.h"
 19#include "shmob_drm_kms.h"
 20#include "shmob_drm_regs.h"
 21
 22/* -----------------------------------------------------------------------------
 23 * Format helpers
 24 */
 25
 26static const struct shmob_drm_format_info shmob_drm_format_infos[] = {
 27	{
 28		.fourcc = DRM_FORMAT_RGB565,
 29		.bpp = 16,
 30		.yuv = false,
 31		.lddfr = LDDFR_PKF_RGB16,
 32	}, {
 33		.fourcc = DRM_FORMAT_RGB888,
 34		.bpp = 24,
 35		.yuv = false,
 36		.lddfr = LDDFR_PKF_RGB24,
 37	}, {
 38		.fourcc = DRM_FORMAT_ARGB8888,
 39		.bpp = 32,
 40		.yuv = false,
 41		.lddfr = LDDFR_PKF_ARGB32,
 42	}, {
 43		.fourcc = DRM_FORMAT_NV12,
 44		.bpp = 12,
 45		.yuv = true,
 46		.lddfr = LDDFR_CC | LDDFR_YF_420,
 47	}, {
 48		.fourcc = DRM_FORMAT_NV21,
 49		.bpp = 12,
 50		.yuv = true,
 51		.lddfr = LDDFR_CC | LDDFR_YF_420,
 52	}, {
 53		.fourcc = DRM_FORMAT_NV16,
 54		.bpp = 16,
 55		.yuv = true,
 56		.lddfr = LDDFR_CC | LDDFR_YF_422,
 57	}, {
 58		.fourcc = DRM_FORMAT_NV61,
 59		.bpp = 16,
 60		.yuv = true,
 61		.lddfr = LDDFR_CC | LDDFR_YF_422,
 62	}, {
 63		.fourcc = DRM_FORMAT_NV24,
 64		.bpp = 24,
 65		.yuv = true,
 66		.lddfr = LDDFR_CC | LDDFR_YF_444,
 67	}, {
 68		.fourcc = DRM_FORMAT_NV42,
 69		.bpp = 24,
 70		.yuv = true,
 71		.lddfr = LDDFR_CC | LDDFR_YF_444,
 72	},
 73};
 74
 75const struct shmob_drm_format_info *shmob_drm_format_info(u32 fourcc)
 76{
 77	unsigned int i;
 78
 79	for (i = 0; i < ARRAY_SIZE(shmob_drm_format_infos); ++i) {
 80		if (shmob_drm_format_infos[i].fourcc == fourcc)
 81			return &shmob_drm_format_infos[i];
 82	}
 83
 84	return NULL;
 85}
 86
 87/* -----------------------------------------------------------------------------
 88 * Frame buffer
 89 */
 90
 91static struct drm_framebuffer *
 92shmob_drm_fb_create(struct drm_device *dev, struct drm_file *file_priv,
 93		    const struct drm_mode_fb_cmd2 *mode_cmd)
 94{
 95	const struct shmob_drm_format_info *format;
 96
 97	format = shmob_drm_format_info(mode_cmd->pixel_format);
 98	if (format == NULL) {
 99		dev_dbg(dev->dev, "unsupported pixel format %08x\n",
100			mode_cmd->pixel_format);
101		return ERR_PTR(-EINVAL);
102	}
103
104	if (mode_cmd->pitches[0] & 7 || mode_cmd->pitches[0] >= 65536) {
105		dev_dbg(dev->dev, "invalid pitch value %u\n",
106			mode_cmd->pitches[0]);
107		return ERR_PTR(-EINVAL);
108	}
109
110	if (format->yuv) {
111		unsigned int chroma_cpp = format->bpp == 24 ? 2 : 1;
112
113		if (mode_cmd->pitches[1] != mode_cmd->pitches[0] * chroma_cpp) {
114			dev_dbg(dev->dev,
115				"luma and chroma pitches do not match\n");
116			return ERR_PTR(-EINVAL);
117		}
118	}
119
120	return drm_gem_fb_create(dev, file_priv, mode_cmd);
121}
122
123static const struct drm_mode_config_funcs shmob_drm_mode_config_funcs = {
124	.fb_create = shmob_drm_fb_create,
125};
126
127int shmob_drm_modeset_init(struct shmob_drm_device *sdev)
128{
129	drm_mode_config_init(sdev->ddev);
130
131	shmob_drm_crtc_create(sdev);
132	shmob_drm_encoder_create(sdev);
133	shmob_drm_connector_create(sdev, &sdev->encoder.encoder);
134
135	drm_kms_helper_poll_init(sdev->ddev);
136
137	sdev->ddev->mode_config.min_width = 0;
138	sdev->ddev->mode_config.min_height = 0;
139	sdev->ddev->mode_config.max_width = 4095;
140	sdev->ddev->mode_config.max_height = 4095;
141	sdev->ddev->mode_config.funcs = &shmob_drm_mode_config_funcs;
142
143	drm_helper_disable_unused_functions(sdev->ddev);
144
145	return 0;
146}