189 lines · c
1// SPDX-License-Identifier: GPL-2.0+2/*3 * shmob_drm_kms.c -- SH Mobile DRM Mode Setting4 *5 * Copyright (C) 2012 Renesas Electronics Corporation6 *7 * Laurent Pinchart (laurent.pinchart@ideasonboard.com)8 */9 10#include <drm/drm_atomic_helper.h>11#include <drm/drm_crtc.h>12#include <drm/drm_crtc_helper.h>13#include <drm/drm_fourcc.h>14#include <drm/drm_gem_dma_helper.h>15#include <drm/drm_gem_framebuffer_helper.h>16#include <drm/drm_probe_helper.h>17 18#include "shmob_drm_crtc.h"19#include "shmob_drm_drv.h"20#include "shmob_drm_kms.h"21#include "shmob_drm_plane.h"22#include "shmob_drm_regs.h"23 24/* -----------------------------------------------------------------------------25 * Format helpers26 */27 28static const struct shmob_drm_format_info shmob_drm_format_infos[] = {29 {30 .fourcc = DRM_FORMAT_RGB565,31 .bpp = 16,32 .lddfr = LDDFR_PKF_RGB16,33 .ldddsr = LDDDSR_LS | LDDDSR_WS,34 .ldbbsifr = LDBBSIFR_AL_1 | LDBBSIFR_SWPL | LDBBSIFR_SWPW |35 LDBBSIFR_RY | LDBBSIFR_RPKF_RGB16,36 }, {37 .fourcc = DRM_FORMAT_RGB888,38 .bpp = 24,39 .lddfr = LDDFR_PKF_RGB24,40 .ldddsr = LDDDSR_LS | LDDDSR_WS | LDDDSR_BS,41 .ldbbsifr = LDBBSIFR_AL_1 | LDBBSIFR_SWPL | LDBBSIFR_SWPW |42 LDBBSIFR_SWPB | LDBBSIFR_RY | LDBBSIFR_RPKF_RGB24,43 }, {44 .fourcc = DRM_FORMAT_ARGB8888,45 .bpp = 32,46 .lddfr = LDDFR_PKF_ARGB32,47 .ldddsr = LDDDSR_LS,48 .ldbbsifr = LDBBSIFR_AL_PK | LDBBSIFR_SWPL | LDBBSIFR_RY |49 LDBBSIFR_RPKF_ARGB32,50 }, {51 .fourcc = DRM_FORMAT_XRGB8888,52 .bpp = 32,53 .lddfr = LDDFR_PKF_ARGB32,54 .ldddsr = LDDDSR_LS,55 .ldbbsifr = LDBBSIFR_AL_1 | LDBBSIFR_SWPL | LDBBSIFR_RY |56 LDBBSIFR_RPKF_ARGB32,57 }, {58 .fourcc = DRM_FORMAT_NV12,59 .bpp = 12,60 .lddfr = LDDFR_CC | LDDFR_YF_420,61 .ldddsr = LDDDSR_LS | LDDDSR_WS | LDDDSR_BS,62 .ldbbsifr = LDBBSIFR_AL_1 | LDBBSIFR_SWPL | LDBBSIFR_SWPW |63 LDBBSIFR_SWPB | LDBBSIFR_CHRR_420,64 }, {65 .fourcc = DRM_FORMAT_NV21,66 .bpp = 12,67 .lddfr = LDDFR_CC | LDDFR_YF_420,68 .ldddsr = LDDDSR_LS | LDDDSR_WS,69 .ldbbsifr = LDBBSIFR_AL_1 | LDBBSIFR_SWPL | LDBBSIFR_SWPW |70 LDBBSIFR_CHRR_420,71 }, {72 .fourcc = DRM_FORMAT_NV16,73 .bpp = 16,74 .lddfr = LDDFR_CC | LDDFR_YF_422,75 .ldddsr = LDDDSR_LS | LDDDSR_WS | LDDDSR_BS,76 .ldbbsifr = LDBBSIFR_AL_1 | LDBBSIFR_SWPL | LDBBSIFR_SWPW |77 LDBBSIFR_SWPB | LDBBSIFR_CHRR_422,78 }, {79 .fourcc = DRM_FORMAT_NV61,80 .bpp = 16,81 .lddfr = LDDFR_CC | LDDFR_YF_422,82 .ldddsr = LDDDSR_LS | LDDDSR_WS,83 .ldbbsifr = LDBBSIFR_AL_1 | LDBBSIFR_SWPL | LDBBSIFR_SWPW |84 LDBBSIFR_CHRR_422,85 }, {86 .fourcc = DRM_FORMAT_NV24,87 .bpp = 24,88 .lddfr = LDDFR_CC | LDDFR_YF_444,89 .ldddsr = LDDDSR_LS | LDDDSR_WS | LDDDSR_BS,90 .ldbbsifr = LDBBSIFR_AL_1 | LDBBSIFR_SWPL | LDBBSIFR_SWPW |91 LDBBSIFR_SWPB | LDBBSIFR_CHRR_444,92 }, {93 .fourcc = DRM_FORMAT_NV42,94 .bpp = 24,95 .lddfr = LDDFR_CC | LDDFR_YF_444,96 .ldddsr = LDDDSR_LS | LDDDSR_WS,97 .ldbbsifr = LDBBSIFR_AL_1 | LDBBSIFR_SWPL | LDBBSIFR_SWPW |98 LDBBSIFR_CHRR_444,99 },100};101 102const struct shmob_drm_format_info *shmob_drm_format_info(u32 fourcc)103{104 unsigned int i;105 106 for (i = 0; i < ARRAY_SIZE(shmob_drm_format_infos); ++i) {107 if (shmob_drm_format_infos[i].fourcc == fourcc)108 return &shmob_drm_format_infos[i];109 }110 111 return NULL;112}113 114/* -----------------------------------------------------------------------------115 * Frame buffer116 */117 118static struct drm_framebuffer *119shmob_drm_fb_create(struct drm_device *dev, struct drm_file *file_priv,120 const struct drm_mode_fb_cmd2 *mode_cmd)121{122 const struct shmob_drm_format_info *format;123 124 format = shmob_drm_format_info(mode_cmd->pixel_format);125 if (format == NULL) {126 dev_dbg(dev->dev, "unsupported pixel format %p4cc\n",127 &mode_cmd->pixel_format);128 return ERR_PTR(-EINVAL);129 }130 131 if (mode_cmd->pitches[0] & 7 || mode_cmd->pitches[0] >= 65536) {132 dev_dbg(dev->dev, "invalid pitch value %u\n",133 mode_cmd->pitches[0]);134 return ERR_PTR(-EINVAL);135 }136 137 if (shmob_drm_format_is_yuv(format)) {138 unsigned int chroma_cpp = format->bpp == 24 ? 2 : 1;139 140 if (mode_cmd->pitches[1] != mode_cmd->pitches[0] * chroma_cpp) {141 dev_dbg(dev->dev,142 "luma and chroma pitches do not match\n");143 return ERR_PTR(-EINVAL);144 }145 }146 147 return drm_gem_fb_create(dev, file_priv, mode_cmd);148}149 150static const struct drm_mode_config_funcs shmob_drm_mode_config_funcs = {151 .fb_create = shmob_drm_fb_create,152 .atomic_check = drm_atomic_helper_check,153 .atomic_commit = drm_atomic_helper_commit,154};155 156int shmob_drm_modeset_init(struct shmob_drm_device *sdev)157{158 struct drm_device *dev = &sdev->ddev;159 int ret;160 161 ret = drmm_mode_config_init(dev);162 if (ret)163 return ret;164 165 ret = shmob_drm_crtc_create(sdev);166 if (ret < 0)167 return ret;168 169 ret = shmob_drm_encoder_create(sdev);170 if (ret < 0)171 return ret;172 173 ret = shmob_drm_connector_create(sdev, &sdev->encoder);174 if (ret < 0)175 return ret;176 177 drm_mode_config_reset(dev);178 179 drm_kms_helper_poll_init(dev);180 181 sdev->ddev.mode_config.min_width = 0;182 sdev->ddev.mode_config.min_height = 0;183 sdev->ddev.mode_config.max_width = 4095;184 sdev->ddev.mode_config.max_height = 4095;185 sdev->ddev.mode_config.funcs = &shmob_drm_mode_config_funcs;186 187 return 0;188}189