387 lines
11 KiB
C
387 lines
11 KiB
C
// SPDX-License-Identifier: GPL-2.0-only
|
|
/* Copyright (c) 2015-2018, The Linux Foundation. All rights reserved.
|
|
*/
|
|
|
|
#define pr_fmt(fmt) "[drm:%s:%d] " fmt, __func__, __LINE__
|
|
|
|
#include <uapi/drm/drm_fourcc.h>
|
|
#include <drm/drm_framebuffer.h>
|
|
|
|
#include "msm_media_info.h"
|
|
#include "dpu_kms.h"
|
|
#include "dpu_formats.h"
|
|
|
|
#define DPU_UBWC_PLANE_SIZE_ALIGNMENT 4096
|
|
|
|
/*
|
|
* struct dpu_media_color_map - maps drm format to media format
|
|
* @format: DRM base pixel format
|
|
* @color: Media API color related to DRM format
|
|
*/
|
|
struct dpu_media_color_map {
|
|
uint32_t format;
|
|
uint32_t color;
|
|
};
|
|
|
|
/* _dpu_get_v_h_subsample_rate - Get subsample rates for all formats we support
|
|
* Note: Not using the drm_format_*_subsampling since we have formats
|
|
*/
|
|
static void _dpu_get_v_h_subsample_rate(
|
|
enum mdp_chroma_samp_type chroma_sample,
|
|
uint32_t *v_sample,
|
|
uint32_t *h_sample)
|
|
{
|
|
if (!v_sample || !h_sample)
|
|
return;
|
|
|
|
switch (chroma_sample) {
|
|
case CHROMA_H2V1:
|
|
*v_sample = 1;
|
|
*h_sample = 2;
|
|
break;
|
|
case CHROMA_H1V2:
|
|
*v_sample = 2;
|
|
*h_sample = 1;
|
|
break;
|
|
case CHROMA_420:
|
|
*v_sample = 2;
|
|
*h_sample = 2;
|
|
break;
|
|
default:
|
|
*v_sample = 1;
|
|
*h_sample = 1;
|
|
break;
|
|
}
|
|
}
|
|
|
|
static int _dpu_format_get_media_color_ubwc(const struct msm_format *fmt)
|
|
{
|
|
static const struct dpu_media_color_map dpu_media_ubwc_map[] = {
|
|
{DRM_FORMAT_ABGR8888, COLOR_FMT_RGBA8888_UBWC},
|
|
{DRM_FORMAT_ARGB8888, COLOR_FMT_RGBA8888_UBWC},
|
|
{DRM_FORMAT_XBGR8888, COLOR_FMT_RGBA8888_UBWC},
|
|
{DRM_FORMAT_XRGB8888, COLOR_FMT_RGBA8888_UBWC},
|
|
{DRM_FORMAT_ABGR2101010, COLOR_FMT_RGBA1010102_UBWC},
|
|
{DRM_FORMAT_ARGB2101010, COLOR_FMT_RGBA1010102_UBWC},
|
|
{DRM_FORMAT_XRGB2101010, COLOR_FMT_RGBA1010102_UBWC},
|
|
{DRM_FORMAT_XBGR2101010, COLOR_FMT_RGBA1010102_UBWC},
|
|
{DRM_FORMAT_BGR565, COLOR_FMT_RGB565_UBWC},
|
|
};
|
|
int color_fmt = -1;
|
|
int i;
|
|
|
|
if (fmt->pixel_format == DRM_FORMAT_NV12 ||
|
|
fmt->pixel_format == DRM_FORMAT_P010) {
|
|
if (MSM_FORMAT_IS_DX(fmt)) {
|
|
if (fmt->flags & MSM_FORMAT_FLAG_UNPACK_TIGHT)
|
|
color_fmt = COLOR_FMT_NV12_BPP10_UBWC;
|
|
else
|
|
color_fmt = COLOR_FMT_P010_UBWC;
|
|
} else
|
|
color_fmt = COLOR_FMT_NV12_UBWC;
|
|
return color_fmt;
|
|
}
|
|
|
|
for (i = 0; i < ARRAY_SIZE(dpu_media_ubwc_map); ++i)
|
|
if (fmt->pixel_format == dpu_media_ubwc_map[i].format) {
|
|
color_fmt = dpu_media_ubwc_map[i].color;
|
|
break;
|
|
}
|
|
return color_fmt;
|
|
}
|
|
|
|
static int _dpu_format_populate_plane_sizes_ubwc(
|
|
const struct msm_format *fmt,
|
|
struct drm_framebuffer *fb,
|
|
struct dpu_hw_fmt_layout *layout)
|
|
{
|
|
int i;
|
|
int color;
|
|
bool meta = MSM_FORMAT_IS_UBWC(fmt);
|
|
|
|
memset(layout, 0, sizeof(struct dpu_hw_fmt_layout));
|
|
layout->width = fb->width;
|
|
layout->height = fb->height;
|
|
layout->num_planes = fmt->num_planes;
|
|
|
|
color = _dpu_format_get_media_color_ubwc(fmt);
|
|
if (color < 0) {
|
|
DRM_ERROR("UBWC format not supported for fmt: %p4cc\n",
|
|
&fmt->pixel_format);
|
|
return -EINVAL;
|
|
}
|
|
|
|
if (MSM_FORMAT_IS_YUV(fmt)) {
|
|
uint32_t y_sclines, uv_sclines;
|
|
uint32_t y_meta_scanlines = 0;
|
|
uint32_t uv_meta_scanlines = 0;
|
|
|
|
layout->num_planes = 2;
|
|
layout->plane_pitch[0] = VENUS_Y_STRIDE(color, fb->width);
|
|
y_sclines = VENUS_Y_SCANLINES(color, fb->height);
|
|
layout->plane_size[0] = MSM_MEDIA_ALIGN(layout->plane_pitch[0] *
|
|
y_sclines, DPU_UBWC_PLANE_SIZE_ALIGNMENT);
|
|
|
|
layout->plane_pitch[1] = VENUS_UV_STRIDE(color, fb->width);
|
|
uv_sclines = VENUS_UV_SCANLINES(color, fb->height);
|
|
layout->plane_size[1] = MSM_MEDIA_ALIGN(layout->plane_pitch[1] *
|
|
uv_sclines, DPU_UBWC_PLANE_SIZE_ALIGNMENT);
|
|
|
|
if (!meta)
|
|
goto done;
|
|
|
|
layout->num_planes += 2;
|
|
layout->plane_pitch[2] = VENUS_Y_META_STRIDE(color, fb->width);
|
|
y_meta_scanlines = VENUS_Y_META_SCANLINES(color, fb->height);
|
|
layout->plane_size[2] = MSM_MEDIA_ALIGN(layout->plane_pitch[2] *
|
|
y_meta_scanlines, DPU_UBWC_PLANE_SIZE_ALIGNMENT);
|
|
|
|
layout->plane_pitch[3] = VENUS_UV_META_STRIDE(color, fb->width);
|
|
uv_meta_scanlines = VENUS_UV_META_SCANLINES(color, fb->height);
|
|
layout->plane_size[3] = MSM_MEDIA_ALIGN(layout->plane_pitch[3] *
|
|
uv_meta_scanlines, DPU_UBWC_PLANE_SIZE_ALIGNMENT);
|
|
|
|
} else {
|
|
uint32_t rgb_scanlines, rgb_meta_scanlines;
|
|
|
|
layout->num_planes = 1;
|
|
|
|
layout->plane_pitch[0] = VENUS_RGB_STRIDE(color, fb->width);
|
|
rgb_scanlines = VENUS_RGB_SCANLINES(color, fb->height);
|
|
layout->plane_size[0] = MSM_MEDIA_ALIGN(layout->plane_pitch[0] *
|
|
rgb_scanlines, DPU_UBWC_PLANE_SIZE_ALIGNMENT);
|
|
|
|
if (!meta)
|
|
goto done;
|
|
layout->num_planes += 2;
|
|
layout->plane_pitch[2] = VENUS_RGB_META_STRIDE(color, fb->width);
|
|
rgb_meta_scanlines = VENUS_RGB_META_SCANLINES(color, fb->height);
|
|
layout->plane_size[2] = MSM_MEDIA_ALIGN(layout->plane_pitch[2] *
|
|
rgb_meta_scanlines, DPU_UBWC_PLANE_SIZE_ALIGNMENT);
|
|
}
|
|
|
|
done:
|
|
for (i = 0; i < DPU_MAX_PLANES; i++)
|
|
layout->total_size += layout->plane_size[i];
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int _dpu_format_populate_plane_sizes_linear(
|
|
const struct msm_format *fmt,
|
|
struct drm_framebuffer *fb,
|
|
struct dpu_hw_fmt_layout *layout)
|
|
{
|
|
int i;
|
|
|
|
memset(layout, 0, sizeof(struct dpu_hw_fmt_layout));
|
|
layout->width = fb->width;
|
|
layout->height = fb->height;
|
|
layout->num_planes = fmt->num_planes;
|
|
|
|
/* Due to memset above, only need to set planes of interest */
|
|
if (fmt->fetch_type == MDP_PLANE_INTERLEAVED) {
|
|
layout->num_planes = 1;
|
|
layout->plane_size[0] = fb->width * fb->height * fmt->bpp;
|
|
layout->plane_pitch[0] = fb->width * fmt->bpp;
|
|
} else {
|
|
uint32_t v_subsample, h_subsample;
|
|
uint32_t chroma_samp;
|
|
uint32_t bpp = 1;
|
|
|
|
chroma_samp = fmt->chroma_sample;
|
|
_dpu_get_v_h_subsample_rate(chroma_samp, &v_subsample,
|
|
&h_subsample);
|
|
|
|
if (fb->width % h_subsample || fb->height % v_subsample) {
|
|
DRM_ERROR("mismatch in subsample vs dimensions\n");
|
|
return -EINVAL;
|
|
}
|
|
|
|
if ((fmt->pixel_format == DRM_FORMAT_NV12) &&
|
|
(MSM_FORMAT_IS_DX(fmt)))
|
|
bpp = 2;
|
|
layout->plane_pitch[0] = fb->width * bpp;
|
|
layout->plane_pitch[1] = layout->plane_pitch[0] / h_subsample;
|
|
layout->plane_size[0] = layout->plane_pitch[0] * fb->height;
|
|
layout->plane_size[1] = layout->plane_pitch[1] *
|
|
(fb->height / v_subsample);
|
|
|
|
if (fmt->fetch_type == MDP_PLANE_PSEUDO_PLANAR) {
|
|
layout->num_planes = 2;
|
|
layout->plane_size[1] *= 2;
|
|
layout->plane_pitch[1] *= 2;
|
|
} else {
|
|
/* planar */
|
|
layout->num_planes = 3;
|
|
layout->plane_size[2] = layout->plane_size[1];
|
|
layout->plane_pitch[2] = layout->plane_pitch[1];
|
|
}
|
|
}
|
|
|
|
/*
|
|
* linear format: allow user allocated pitches if they are greater than
|
|
* the requirement.
|
|
* ubwc format: pitch values are computed uniformly across
|
|
* all the components based on ubwc specifications.
|
|
*/
|
|
for (i = 0; i < layout->num_planes && i < DPU_MAX_PLANES; ++i) {
|
|
if (layout->plane_pitch[i] <= fb->pitches[i]) {
|
|
layout->plane_pitch[i] = fb->pitches[i];
|
|
} else {
|
|
DRM_DEBUG("plane %u expected pitch %u, fb %u\n",
|
|
i, layout->plane_pitch[i], fb->pitches[i]);
|
|
return -EINVAL;
|
|
}
|
|
}
|
|
|
|
for (i = 0; i < DPU_MAX_PLANES; i++)
|
|
layout->total_size += layout->plane_size[i];
|
|
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* dpu_format_populate_plane_sizes - populate non-address part of the layout based on
|
|
* fb, and format found in the fb
|
|
* @fb: framebuffer pointer
|
|
* @layout: format layout structure to populate
|
|
*
|
|
* Return: error code on failure or 0 if new addresses were populated
|
|
*/
|
|
int dpu_format_populate_plane_sizes(
|
|
struct drm_framebuffer *fb,
|
|
struct dpu_hw_fmt_layout *layout)
|
|
{
|
|
const struct msm_format *fmt;
|
|
|
|
if (!layout || !fb) {
|
|
DRM_ERROR("invalid pointer\n");
|
|
return -EINVAL;
|
|
}
|
|
|
|
if (fb->width > DPU_MAX_IMG_WIDTH ||
|
|
fb->height > DPU_MAX_IMG_HEIGHT) {
|
|
DRM_ERROR("image dimensions outside max range\n");
|
|
return -ERANGE;
|
|
}
|
|
|
|
fmt = msm_framebuffer_format(fb);
|
|
|
|
if (MSM_FORMAT_IS_UBWC(fmt) || MSM_FORMAT_IS_TILE(fmt))
|
|
return _dpu_format_populate_plane_sizes_ubwc(fmt, fb, layout);
|
|
|
|
return _dpu_format_populate_plane_sizes_linear(fmt, fb, layout);
|
|
}
|
|
|
|
static void _dpu_format_populate_addrs_ubwc(struct drm_framebuffer *fb,
|
|
struct dpu_hw_fmt_layout *layout)
|
|
{
|
|
const struct msm_format *fmt;
|
|
uint32_t base_addr = 0;
|
|
bool meta;
|
|
|
|
base_addr = msm_framebuffer_iova(fb, 0);
|
|
|
|
fmt = msm_framebuffer_format(fb);
|
|
meta = MSM_FORMAT_IS_UBWC(fmt);
|
|
|
|
/* Per-format logic for verifying active planes */
|
|
if (MSM_FORMAT_IS_YUV(fmt)) {
|
|
/************************************************/
|
|
/* UBWC ** */
|
|
/* buffer ** DPU PLANE */
|
|
/* format ** */
|
|
/************************************************/
|
|
/* ------------------- ** -------------------- */
|
|
/* | Y meta | ** | Y bitstream | */
|
|
/* | data | ** | plane | */
|
|
/* ------------------- ** -------------------- */
|
|
/* | Y bitstream | ** | CbCr bitstream | */
|
|
/* | data | ** | plane | */
|
|
/* ------------------- ** -------------------- */
|
|
/* | Cbcr metadata | ** | Y meta | */
|
|
/* | data | ** | plane | */
|
|
/* ------------------- ** -------------------- */
|
|
/* | CbCr bitstream | ** | CbCr meta | */
|
|
/* | data | ** | plane | */
|
|
/* ------------------- ** -------------------- */
|
|
/************************************************/
|
|
|
|
/* configure Y bitstream plane */
|
|
layout->plane_addr[0] = base_addr + layout->plane_size[2];
|
|
|
|
/* configure CbCr bitstream plane */
|
|
layout->plane_addr[1] = base_addr + layout->plane_size[0]
|
|
+ layout->plane_size[2] + layout->plane_size[3];
|
|
|
|
if (!meta)
|
|
return;
|
|
|
|
/* configure Y metadata plane */
|
|
layout->plane_addr[2] = base_addr;
|
|
|
|
/* configure CbCr metadata plane */
|
|
layout->plane_addr[3] = base_addr + layout->plane_size[0]
|
|
+ layout->plane_size[2];
|
|
|
|
} else {
|
|
/************************************************/
|
|
/* UBWC ** */
|
|
/* buffer ** DPU PLANE */
|
|
/* format ** */
|
|
/************************************************/
|
|
/* ------------------- ** -------------------- */
|
|
/* | RGB meta | ** | RGB bitstream | */
|
|
/* | data | ** | plane | */
|
|
/* ------------------- ** -------------------- */
|
|
/* | RGB bitstream | ** | NONE | */
|
|
/* | data | ** | | */
|
|
/* ------------------- ** -------------------- */
|
|
/* ** | RGB meta | */
|
|
/* ** | plane | */
|
|
/* ** -------------------- */
|
|
/************************************************/
|
|
|
|
layout->plane_addr[0] = base_addr + layout->plane_size[2];
|
|
layout->plane_addr[1] = 0;
|
|
|
|
if (!meta)
|
|
return;
|
|
|
|
layout->plane_addr[2] = base_addr;
|
|
layout->plane_addr[3] = 0;
|
|
}
|
|
}
|
|
|
|
static void _dpu_format_populate_addrs_linear(struct drm_framebuffer *fb,
|
|
struct dpu_hw_fmt_layout *layout)
|
|
{
|
|
unsigned int i;
|
|
|
|
/* Populate addresses for simple formats here */
|
|
for (i = 0; i < layout->num_planes; ++i)
|
|
layout->plane_addr[i] = msm_framebuffer_iova(fb, i);
|
|
}
|
|
|
|
/**
|
|
* dpu_format_populate_addrs - populate buffer addresses based on
|
|
* mmu, fb, and format found in the fb
|
|
* @fb: framebuffer pointer
|
|
* @layout: format layout structure to populate
|
|
*/
|
|
void dpu_format_populate_addrs(struct drm_framebuffer *fb,
|
|
struct dpu_hw_fmt_layout *layout)
|
|
{
|
|
const struct msm_format *fmt;
|
|
|
|
fmt = msm_framebuffer_format(fb);
|
|
|
|
/* Populate the addresses given the fb */
|
|
if (MSM_FORMAT_IS_UBWC(fmt) ||
|
|
MSM_FORMAT_IS_TILE(fmt))
|
|
_dpu_format_populate_addrs_ubwc(fb, layout);
|
|
else
|
|
_dpu_format_populate_addrs_linear(fb, layout);
|
|
}
|