336 lines
10 KiB
C
336 lines
10 KiB
C
|
/*
|
||
|
|
* Copyright (C) 2016 BayLibre, SAS
|
||
|
|
* Author: Neil Armstrong <narmstrong@baylibre.com>
|
||
|
|
* Copyright (C) 2015 Amlogic, Inc. All rights reserved.
|
||
|
|
* Copyright (C) 2014 Endless Mobile
|
||
|
|
*
|
||
|
|
* This program is free software; you can redistribute it and/or
|
||
|
|
* modify it under the terms of the GNU General Public License as
|
||
|
|
* published by the Free Software Foundation; either version 2 of the
|
||
|
|
* License, or (at your option) any later version.
|
||
|
|
*
|
||
|
|
* This program is distributed in the hope that it will be useful, but
|
||
|
|
* WITHOUT ANY WARRANTY; without even the implied warranty of
|
||
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
||
|
|
* General Public License for more details.
|
||
|
|
*
|
||
|
|
* You should have received a copy of the GNU General Public License
|
||
|
|
* along with this program; if not, see <http://www.gnu.org/licenses/>.
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include <linux/kernel.h>
|
||
|
|
#include <linux/module.h>
|
||
|
|
#include <drm/drmP.h>
|
||
|
|
#include "meson_drv.h"
|
||
|
|
#include "meson_viu.h"
|
||
|
|
#include "meson_vpp.h"
|
||
|
|
#include "meson_venc.h"
|
||
|
|
#include "meson_canvas.h"
|
||
|
|
#include "meson_registers.h"
|
||
|
|
|
||
|
|
/**
|
||
|
|
* DOC: Video Input Unit
|
||
|
|
*
|
||
|
|
* VIU Handles the Pixel scanout and the basic Colorspace conversions
|
||
|
|
* We handle the following features :
|
||
|
|
*
|
||
|
|
* - OSD1 RGB565/RGB888/xRGB8888 scanout
|
||
|
|
* - RGB conversion to x/cb/cr
|
||
|
|
* - Progressive or Interlace buffer scanout
|
||
|
|
* - OSD1 Commit on Vsync
|
||
|
|
* - HDR OSD matrix for GXL/GXM
|
||
|
|
*
|
||
|
|
* What is missing :
|
||
|
|
*
|
||
|
|
* - BGR888/xBGR8888/BGRx8888/BGRx8888 modes
|
||
|
|
* - YUV4:2:2 Y0CbY1Cr scanout
|
||
|
|
* - Conversion to YUV 4:4:4 from 4:2:2 input
|
||
|
|
* - Colorkey Alpha matching
|
||
|
|
* - Big endian scanout
|
||
|
|
* - X/Y reverse scanout
|
||
|
|
* - Global alpha setup
|
||
|
|
* - OSD2 support, would need interlace switching on vsync
|
||
|
|
* - OSD1 full scaling to support TV overscan
|
||
|
|
*/
|
||
|
|
|
||
|
|
/* OSD csc defines */
|
||
|
|
|
||
|
|
enum viu_matrix_sel_e {
|
||
|
|
VIU_MATRIX_OSD_EOTF = 0,
|
||
|
|
VIU_MATRIX_OSD,
|
||
|
|
};
|
||
|
|
|
||
|
|
enum viu_lut_sel_e {
|
||
|
|
VIU_LUT_OSD_EOTF = 0,
|
||
|
|
VIU_LUT_OSD_OETF,
|
||
|
|
};
|
||
|
|
|
||
|
|
#define COEFF_NORM(a) ((int)((((a) * 2048.0) + 1) / 2))
|
||
|
|
#define MATRIX_5X3_COEF_SIZE 24
|
||
|
|
|
||
|
|
#define EOTF_COEFF_NORM(a) ((int)((((a) * 4096.0) + 1) / 2))
|
||
|
|
#define EOTF_COEFF_SIZE 10
|
||
|
|
#define EOTF_COEFF_RIGHTSHIFT 1
|
||
|
|
|
||
|
|
static int RGB709_to_YUV709l_coeff[MATRIX_5X3_COEF_SIZE] = {
|
||
|
|
0, 0, 0, /* pre offset */
|
||
|
|
COEFF_NORM(0.181873), COEFF_NORM(0.611831), COEFF_NORM(0.061765),
|
||
|
|
COEFF_NORM(-0.100251), COEFF_NORM(-0.337249), COEFF_NORM(0.437500),
|
||
|
|
COEFF_NORM(0.437500), COEFF_NORM(-0.397384), COEFF_NORM(-0.040116),
|
||
|
|
0, 0, 0, /* 10'/11'/12' */
|
||
|
|
0, 0, 0, /* 20'/21'/22' */
|
||
|
|
64, 512, 512, /* offset */
|
||
|
|
0, 0, 0 /* mode, right_shift, clip_en */
|
||
|
|
};
|
||
|
|
|
||
|
|
/* eotf matrix: bypass */
|
||
|
|
static int eotf_bypass_coeff[EOTF_COEFF_SIZE] = {
|
||
|
|
EOTF_COEFF_NORM(1.0), EOTF_COEFF_NORM(0.0), EOTF_COEFF_NORM(0.0),
|
||
|
|
EOTF_COEFF_NORM(0.0), EOTF_COEFF_NORM(1.0), EOTF_COEFF_NORM(0.0),
|
||
|
|
EOTF_COEFF_NORM(0.0), EOTF_COEFF_NORM(0.0), EOTF_COEFF_NORM(1.0),
|
||
|
|
EOTF_COEFF_RIGHTSHIFT /* right shift */
|
||
|
|
};
|
||
|
|
|
||
|
|
void meson_viu_set_osd_matrix(struct meson_drm *priv,
|
||
|
|
enum viu_matrix_sel_e m_select,
|
||
|
|
int *m, bool csc_on)
|
||
|
|
{
|
||
|
|
if (m_select == VIU_MATRIX_OSD) {
|
||
|
|
/* osd matrix, VIU_MATRIX_0 */
|
||
|
|
writel(((m[0] & 0xfff) << 16) | (m[1] & 0xfff),
|
||
|
|
priv->io_base + _REG(VIU_OSD1_MATRIX_PRE_OFFSET0_1));
|
||
|
|
writel(m[2] & 0xfff,
|
||
|
|
priv->io_base + _REG(VIU_OSD1_MATRIX_PRE_OFFSET2));
|
||
|
|
writel(((m[3] & 0x1fff) << 16) | (m[4] & 0x1fff),
|
||
|
|
priv->io_base + _REG(VIU_OSD1_MATRIX_COEF00_01));
|
||
|
|
writel(((m[5] & 0x1fff) << 16) | (m[6] & 0x1fff),
|
||
|
|
priv->io_base + _REG(VIU_OSD1_MATRIX_COEF02_10));
|
||
|
|
writel(((m[7] & 0x1fff) << 16) | (m[8] & 0x1fff),
|
||
|
|
priv->io_base + _REG(VIU_OSD1_MATRIX_COEF11_12));
|
||
|
|
writel(((m[9] & 0x1fff) << 16) | (m[10] & 0x1fff),
|
||
|
|
priv->io_base + _REG(VIU_OSD1_MATRIX_COEF20_21));
|
||
|
|
|
||
|
|
if (m[21]) {
|
||
|
|
writel(((m[11] & 0x1fff) << 16) | (m[12] & 0x1fff),
|
||
|
|
priv->io_base +
|
||
|
|
_REG(VIU_OSD1_MATRIX_COEF22_30));
|
||
|
|
writel(((m[13] & 0x1fff) << 16) | (m[14] & 0x1fff),
|
||
|
|
priv->io_base +
|
||
|
|
_REG(VIU_OSD1_MATRIX_COEF31_32));
|
||
|
|
writel(((m[15] & 0x1fff) << 16) | (m[16] & 0x1fff),
|
||
|
|
priv->io_base +
|
||
|
|
_REG(VIU_OSD1_MATRIX_COEF40_41));
|
||
|
|
writel(m[17] & 0x1fff, priv->io_base +
|
||
|
|
_REG(VIU_OSD1_MATRIX_COLMOD_COEF42));
|
||
|
|
} else
|
||
|
|
writel((m[11] & 0x1fff) << 16, priv->io_base +
|
||
|
|
_REG(VIU_OSD1_MATRIX_COEF22_30));
|
||
|
|
|
||
|
|
writel(((m[18] & 0xfff) << 16) | (m[19] & 0xfff),
|
||
|
|
priv->io_base + _REG(VIU_OSD1_MATRIX_OFFSET0_1));
|
||
|
|
writel(m[20] & 0xfff,
|
||
|
|
priv->io_base + _REG(VIU_OSD1_MATRIX_OFFSET2));
|
||
|
|
|
||
|
|
writel_bits_relaxed(3 << 30, m[21] << 30,
|
||
|
|
priv->io_base + _REG(VIU_OSD1_MATRIX_COLMOD_COEF42));
|
||
|
|
writel_bits_relaxed(7 << 16, m[22] << 16,
|
||
|
|
priv->io_base + _REG(VIU_OSD1_MATRIX_COLMOD_COEF42));
|
||
|
|
|
||
|
|
/* 23 reserved for clipping control */
|
||
|
|
writel_bits_relaxed(BIT(0), csc_on ? BIT(0) : 0,
|
||
|
|
priv->io_base + _REG(VIU_OSD1_MATRIX_CTRL));
|
||
|
|
writel_bits_relaxed(BIT(1), 0,
|
||
|
|
priv->io_base + _REG(VIU_OSD1_MATRIX_CTRL));
|
||
|
|
} else if (m_select == VIU_MATRIX_OSD_EOTF) {
|
||
|
|
int i;
|
||
|
|
|
||
|
|
/* osd eotf matrix, VIU_MATRIX_OSD_EOTF */
|
||
|
|
for (i = 0; i < 5; i++)
|
||
|
|
writel(((m[i * 2] & 0x1fff) << 16) |
|
||
|
|
(m[i * 2 + 1] & 0x1fff), priv->io_base +
|
||
|
|
_REG(VIU_OSD1_EOTF_CTL + i + 1));
|
||
|
|
|
||
|
|
writel_bits_relaxed(BIT(30), csc_on ? BIT(30) : 0,
|
||
|
|
priv->io_base + _REG(VIU_OSD1_EOTF_CTL));
|
||
|
|
writel_bits_relaxed(BIT(31), csc_on ? BIT(31) : 0,
|
||
|
|
priv->io_base + _REG(VIU_OSD1_EOTF_CTL));
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
#define OSD_EOTF_LUT_SIZE 33
|
||
|
|
#define OSD_OETF_LUT_SIZE 41
|
||
|
|
|
||
|
|
void meson_viu_set_osd_lut(struct meson_drm *priv, enum viu_lut_sel_e lut_sel,
|
||
|
|
unsigned int *r_map, unsigned int *g_map,
|
||
|
|
unsigned int *b_map,
|
||
|
|
bool csc_on)
|
||
|
|
{
|
||
|
|
unsigned int addr_port;
|
||
|
|
unsigned int data_port;
|
||
|
|
unsigned int ctrl_port;
|
||
|
|
int i;
|
||
|
|
|
||
|
|
if (lut_sel == VIU_LUT_OSD_EOTF) {
|
||
|
|
addr_port = VIU_OSD1_EOTF_LUT_ADDR_PORT;
|
||
|
|
data_port = VIU_OSD1_EOTF_LUT_DATA_PORT;
|
||
|
|
ctrl_port = VIU_OSD1_EOTF_CTL;
|
||
|
|
} else if (lut_sel == VIU_LUT_OSD_OETF) {
|
||
|
|
addr_port = VIU_OSD1_OETF_LUT_ADDR_PORT;
|
||
|
|
data_port = VIU_OSD1_OETF_LUT_DATA_PORT;
|
||
|
|
ctrl_port = VIU_OSD1_OETF_CTL;
|
||
|
|
} else
|
||
|
|
return;
|
||
|
|
|
||
|
|
if (lut_sel == VIU_LUT_OSD_OETF) {
|
||
|
|
writel(0, priv->io_base + _REG(addr_port));
|
||
|
|
|
||
|
|
for (i = 0; i < (OSD_OETF_LUT_SIZE / 2); i++)
|
||
|
|
writel(r_map[i * 2] | (r_map[i * 2 + 1] << 16),
|
||
|
|
priv->io_base + _REG(data_port));
|
||
|
|
|
||
|
|
writel(r_map[OSD_OETF_LUT_SIZE - 1] | (g_map[0] << 16),
|
||
|
|
priv->io_base + _REG(data_port));
|
||
|
|
|
||
|
|
for (i = 0; i < (OSD_OETF_LUT_SIZE / 2); i++)
|
||
|
|
writel(g_map[i * 2 + 1] | (g_map[i * 2 + 2] << 16),
|
||
|
|
priv->io_base + _REG(data_port));
|
||
|
|
|
||
|
|
for (i = 0; i < (OSD_OETF_LUT_SIZE / 2); i++)
|
||
|
|
writel(b_map[i * 2] | (b_map[i * 2 + 1] << 16),
|
||
|
|
priv->io_base + _REG(data_port));
|
||
|
|
|
||
|
|
writel(b_map[OSD_OETF_LUT_SIZE - 1],
|
||
|
|
priv->io_base + _REG(data_port));
|
||
|
|
|
||
|
|
if (csc_on)
|
||
|
|
writel_bits_relaxed(0x7 << 29, 7 << 29,
|
||
|
|
priv->io_base + _REG(ctrl_port));
|
||
|
|
else
|
||
|
|
writel_bits_relaxed(0x7 << 29, 0,
|
||
|
|
priv->io_base + _REG(ctrl_port));
|
||
|
|
} else if (lut_sel == VIU_LUT_OSD_EOTF) {
|
||
|
|
writel(0, priv->io_base + _REG(addr_port));
|
||
|
|
|
||
|
|
for (i = 0; i < (OSD_EOTF_LUT_SIZE / 2); i++)
|
||
|
|
writel(r_map[i * 2] | (r_map[i * 2 + 1] << 16),
|
||
|
|
priv->io_base + _REG(data_port));
|
||
|
|
|
||
|
|
writel(r_map[OSD_EOTF_LUT_SIZE - 1] | (g_map[0] << 16),
|
||
|
|
priv->io_base + _REG(data_port));
|
||
|
|
|
||
|
|
for (i = 0; i < (OSD_EOTF_LUT_SIZE / 2); i++)
|
||
|
|
writel(g_map[i * 2 + 1] | (g_map[i * 2 + 2] << 16),
|
||
|
|
priv->io_base + _REG(data_port));
|
||
|
|
|
||
|
|
for (i = 0; i < (OSD_EOTF_LUT_SIZE / 2); i++)
|
||
|
|
writel(b_map[i * 2] | (b_map[i * 2 + 1] << 16),
|
||
|
|
priv->io_base + _REG(data_port));
|
||
|
|
|
||
|
|
writel(b_map[OSD_EOTF_LUT_SIZE - 1],
|
||
|
|
priv->io_base + _REG(data_port));
|
||
|
|
|
||
|
|
if (csc_on)
|
||
|
|
writel_bits_relaxed(7 << 27, 7 << 27,
|
||
|
|
priv->io_base + _REG(ctrl_port));
|
||
|
|
else
|
||
|
|
writel_bits_relaxed(7 << 27, 0,
|
||
|
|
priv->io_base + _REG(ctrl_port));
|
||
|
|
|
||
|
|
writel_bits_relaxed(BIT(31), BIT(31),
|
||
|
|
priv->io_base + _REG(ctrl_port));
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
/* eotf lut: linear */
|
||
|
|
static unsigned int eotf_33_linear_mapping[OSD_EOTF_LUT_SIZE] = {
|
||
|
|
0x0000, 0x0200, 0x0400, 0x0600,
|
||
|
|
0x0800, 0x0a00, 0x0c00, 0x0e00,
|
||
|
|
0x1000, 0x1200, 0x1400, 0x1600,
|
||
|
|
0x1800, 0x1a00, 0x1c00, 0x1e00,
|
||
|
|
0x2000, 0x2200, 0x2400, 0x2600,
|
||
|
|
0x2800, 0x2a00, 0x2c00, 0x2e00,
|
||
|
|
0x3000, 0x3200, 0x3400, 0x3600,
|
||
|
|
0x3800, 0x3a00, 0x3c00, 0x3e00,
|
||
|
|
0x4000
|
||
|
|
};
|
||
|
|
|
||
|
|
/* osd oetf lut: linear */
|
||
|
|
static unsigned int oetf_41_linear_mapping[OSD_OETF_LUT_SIZE] = {
|
||
|
|
0, 0, 0, 0,
|
||
|
|
0, 32, 64, 96,
|
||
|
|
128, 160, 196, 224,
|
||
|
|
256, 288, 320, 352,
|
||
|
|
384, 416, 448, 480,
|
||
|
|
512, 544, 576, 608,
|
||
|
|
640, 672, 704, 736,
|
||
|
|
768, 800, 832, 864,
|
||
|
|
896, 928, 960, 992,
|
||
|
|
1023, 1023, 1023, 1023,
|
||
|
|
1023
|
||
|
|
};
|
||
|
|
|
||
|
|
static void meson_viu_load_matrix(struct meson_drm *priv)
|
||
|
|
{
|
||
|
|
/* eotf lut bypass */
|
||
|
|
meson_viu_set_osd_lut(priv, VIU_LUT_OSD_EOTF,
|
||
|
|
eotf_33_linear_mapping, /* R */
|
||
|
|
eotf_33_linear_mapping, /* G */
|
||
|
|
eotf_33_linear_mapping, /* B */
|
||
|
|
false);
|
||
|
|
|
||
|
|
/* eotf matrix bypass */
|
||
|
|
meson_viu_set_osd_matrix(priv, VIU_MATRIX_OSD_EOTF,
|
||
|
|
eotf_bypass_coeff,
|
||
|
|
false);
|
||
|
|
|
||
|
|
/* oetf lut bypass */
|
||
|
|
meson_viu_set_osd_lut(priv, VIU_LUT_OSD_OETF,
|
||
|
|
oetf_41_linear_mapping, /* R */
|
||
|
|
oetf_41_linear_mapping, /* G */
|
||
|
|
oetf_41_linear_mapping, /* B */
|
||
|
|
false);
|
||
|
|
|
||
|
|
/* osd matrix RGB709 to YUV709 limit */
|
||
|
|
meson_viu_set_osd_matrix(priv, VIU_MATRIX_OSD,
|
||
|
|
RGB709_to_YUV709l_coeff,
|
||
|
|
true);
|
||
|
|
}
|
||
|
|
|
||
|
|
void meson_viu_init(struct meson_drm *priv)
|
||
|
|
{
|
||
|
|
uint32_t reg;
|
||
|
|
|
||
|
|
/* Disable OSDs */
|
||
|
|
writel_bits_relaxed(BIT(0) | BIT(21), 0,
|
||
|
|
priv->io_base + _REG(VIU_OSD1_CTRL_STAT));
|
||
|
|
writel_bits_relaxed(BIT(0) | BIT(21), 0,
|
||
|
|
priv->io_base + _REG(VIU_OSD2_CTRL_STAT));
|
||
|
|
|
||
|
|
/* On GXL/GXM, Use the 10bit HDR conversion matrix */
|
||
|
|
if (meson_vpu_is_compatible(priv, "amlogic,meson-gxm-vpu") ||
|
||
|
|
meson_vpu_is_compatible(priv, "amlogic,meson-gxl-vpu"))
|
||
|
|
meson_viu_load_matrix(priv);
|
||
|
|
|
||
|
|
/* Initialize OSD1 fifo control register */
|
||
|
|
reg = BIT(0) | /* Urgent DDR request priority */
|
||
|
|
(4 << 5) | /* hold_fifo_lines */
|
||
|
|
(3 << 10) | /* burst length 64 */
|
||
|
|
(32 << 12) | /* fifo_depth_val: 32*8=256 */
|
||
|
|
(2 << 22) | /* 4 words in 1 burst */
|
||
|
|
(2 << 24);
|
||
|
|
writel_relaxed(reg, priv->io_base + _REG(VIU_OSD1_FIFO_CTRL_STAT));
|
||
|
|
writel_relaxed(reg, priv->io_base + _REG(VIU_OSD2_FIFO_CTRL_STAT));
|
||
|
|
|
||
|
|
/* Set OSD alpha replace value */
|
||
|
|
writel_bits_relaxed(0xff << OSD_REPLACE_SHIFT,
|
||
|
|
0xff << OSD_REPLACE_SHIFT,
|
||
|
|
priv->io_base + _REG(VIU_OSD1_CTRL_STAT2));
|
||
|
|
writel_bits_relaxed(0xff << OSD_REPLACE_SHIFT,
|
||
|
|
0xff << OSD_REPLACE_SHIFT,
|
||
|
|
priv->io_base + _REG(VIU_OSD2_CTRL_STAT2));
|
||
|
|
|
||
|
|
priv->viu.osd1_enabled = false;
|
||
|
|
priv->viu.osd1_commit = false;
|
||
|
|
priv->viu.osd1_interlace = false;
|
||
|
|
}
|