mirror of
https://github.com/AuxXxilium/linux_dsm_epyc7002.git
synced 2024-12-20 12:59:33 +07:00
0a886f5952
It adds the initial ZTE VOU display controller DRM driver. There are still some features to be added, like overlay plane, scaling, and more output devices support. But it's already useful with dual CRTCs and HDMI monitor working. Signed-off-by: Shawn Guo <shawn.guo@linaro.org>
662 lines
17 KiB
C
662 lines
17 KiB
C
/*
|
|
* Copyright 2016 Linaro Ltd.
|
|
* Copyright 2016 ZTE Corporation.
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License version 2 as
|
|
* published by the Free Software Foundation.
|
|
*
|
|
*/
|
|
|
|
#include <linux/clk.h>
|
|
#include <linux/component.h>
|
|
#include <linux/of_address.h>
|
|
#include <video/videomode.h>
|
|
|
|
#include <drm/drm_atomic_helper.h>
|
|
#include <drm/drm_crtc.h>
|
|
#include <drm/drm_crtc_helper.h>
|
|
#include <drm/drm_fb_cma_helper.h>
|
|
#include <drm/drm_fb_helper.h>
|
|
#include <drm/drm_gem_cma_helper.h>
|
|
#include <drm/drm_of.h>
|
|
#include <drm/drm_plane_helper.h>
|
|
#include <drm/drmP.h>
|
|
|
|
#include "zx_drm_drv.h"
|
|
#include "zx_plane.h"
|
|
#include "zx_vou.h"
|
|
#include "zx_vou_regs.h"
|
|
|
|
#define GL_NUM 2
|
|
#define VL_NUM 3
|
|
|
|
enum vou_chn_type {
|
|
VOU_CHN_MAIN,
|
|
VOU_CHN_AUX,
|
|
};
|
|
|
|
struct zx_crtc_regs {
|
|
u32 fir_active;
|
|
u32 fir_htiming;
|
|
u32 fir_vtiming;
|
|
u32 timing_shift;
|
|
u32 timing_pi_shift;
|
|
};
|
|
|
|
static const struct zx_crtc_regs main_crtc_regs = {
|
|
.fir_active = FIR_MAIN_ACTIVE,
|
|
.fir_htiming = FIR_MAIN_H_TIMING,
|
|
.fir_vtiming = FIR_MAIN_V_TIMING,
|
|
.timing_shift = TIMING_MAIN_SHIFT,
|
|
.timing_pi_shift = TIMING_MAIN_PI_SHIFT,
|
|
};
|
|
|
|
static const struct zx_crtc_regs aux_crtc_regs = {
|
|
.fir_active = FIR_AUX_ACTIVE,
|
|
.fir_htiming = FIR_AUX_H_TIMING,
|
|
.fir_vtiming = FIR_AUX_V_TIMING,
|
|
.timing_shift = TIMING_AUX_SHIFT,
|
|
.timing_pi_shift = TIMING_AUX_PI_SHIFT,
|
|
};
|
|
|
|
struct zx_crtc_bits {
|
|
u32 polarity_mask;
|
|
u32 polarity_shift;
|
|
u32 int_frame_mask;
|
|
u32 tc_enable;
|
|
u32 gl_enable;
|
|
};
|
|
|
|
static const struct zx_crtc_bits main_crtc_bits = {
|
|
.polarity_mask = MAIN_POL_MASK,
|
|
.polarity_shift = MAIN_POL_SHIFT,
|
|
.int_frame_mask = TIMING_INT_MAIN_FRAME,
|
|
.tc_enable = MAIN_TC_EN,
|
|
.gl_enable = OSD_CTRL0_GL0_EN,
|
|
};
|
|
|
|
static const struct zx_crtc_bits aux_crtc_bits = {
|
|
.polarity_mask = AUX_POL_MASK,
|
|
.polarity_shift = AUX_POL_SHIFT,
|
|
.int_frame_mask = TIMING_INT_AUX_FRAME,
|
|
.tc_enable = AUX_TC_EN,
|
|
.gl_enable = OSD_CTRL0_GL1_EN,
|
|
};
|
|
|
|
struct zx_crtc {
|
|
struct drm_crtc crtc;
|
|
struct drm_plane *primary;
|
|
struct zx_vou_hw *vou;
|
|
void __iomem *chnreg;
|
|
const struct zx_crtc_regs *regs;
|
|
const struct zx_crtc_bits *bits;
|
|
enum vou_chn_type chn_type;
|
|
struct clk *pixclk;
|
|
};
|
|
|
|
#define to_zx_crtc(x) container_of(x, struct zx_crtc, crtc)
|
|
|
|
struct zx_vou_hw {
|
|
struct device *dev;
|
|
void __iomem *osd;
|
|
void __iomem *timing;
|
|
void __iomem *vouctl;
|
|
void __iomem *otfppu;
|
|
void __iomem *dtrc;
|
|
struct clk *axi_clk;
|
|
struct clk *ppu_clk;
|
|
struct clk *main_clk;
|
|
struct clk *aux_clk;
|
|
struct zx_crtc *main_crtc;
|
|
struct zx_crtc *aux_crtc;
|
|
};
|
|
|
|
static inline struct zx_vou_hw *crtc_to_vou(struct drm_crtc *crtc)
|
|
{
|
|
struct zx_crtc *zcrtc = to_zx_crtc(crtc);
|
|
|
|
return zcrtc->vou;
|
|
}
|
|
|
|
void vou_inf_enable(const struct vou_inf *inf, struct drm_crtc *crtc)
|
|
{
|
|
struct zx_crtc *zcrtc = to_zx_crtc(crtc);
|
|
struct zx_vou_hw *vou = zcrtc->vou;
|
|
bool is_main = zcrtc->chn_type == VOU_CHN_MAIN;
|
|
u32 data_sel_shift = inf->id << 1;
|
|
|
|
/* Select data format */
|
|
zx_writel_mask(vou->vouctl + VOU_INF_DATA_SEL, 0x3 << data_sel_shift,
|
|
inf->data_sel << data_sel_shift);
|
|
|
|
/* Select channel */
|
|
zx_writel_mask(vou->vouctl + VOU_INF_CH_SEL, 0x1 << inf->id,
|
|
zcrtc->chn_type << inf->id);
|
|
|
|
/* Select interface clocks */
|
|
zx_writel_mask(vou->vouctl + VOU_CLK_SEL, inf->clocks_sel_bits,
|
|
is_main ? 0 : inf->clocks_sel_bits);
|
|
|
|
/* Enable interface clocks */
|
|
zx_writel_mask(vou->vouctl + VOU_CLK_EN, inf->clocks_en_bits,
|
|
inf->clocks_en_bits);
|
|
|
|
/* Enable the device */
|
|
zx_writel_mask(vou->vouctl + VOU_INF_EN, 1 << inf->id, 1 << inf->id);
|
|
}
|
|
|
|
void vou_inf_disable(const struct vou_inf *inf, struct drm_crtc *crtc)
|
|
{
|
|
struct zx_vou_hw *vou = crtc_to_vou(crtc);
|
|
|
|
/* Disable the device */
|
|
zx_writel_mask(vou->vouctl + VOU_INF_EN, 1 << inf->id, 0);
|
|
|
|
/* Disable interface clocks */
|
|
zx_writel_mask(vou->vouctl + VOU_CLK_EN, inf->clocks_en_bits, 0);
|
|
}
|
|
|
|
static inline void vou_chn_set_update(struct zx_crtc *zcrtc)
|
|
{
|
|
zx_writel(zcrtc->chnreg + CHN_UPDATE, 1);
|
|
}
|
|
|
|
static void zx_crtc_enable(struct drm_crtc *crtc)
|
|
{
|
|
struct drm_display_mode *mode = &crtc->state->adjusted_mode;
|
|
struct zx_crtc *zcrtc = to_zx_crtc(crtc);
|
|
struct zx_vou_hw *vou = zcrtc->vou;
|
|
const struct zx_crtc_regs *regs = zcrtc->regs;
|
|
const struct zx_crtc_bits *bits = zcrtc->bits;
|
|
struct videomode vm;
|
|
u32 pol = 0;
|
|
u32 val;
|
|
int ret;
|
|
|
|
drm_display_mode_to_videomode(mode, &vm);
|
|
|
|
/* Set up timing parameters */
|
|
val = V_ACTIVE(vm.vactive - 1);
|
|
val |= H_ACTIVE(vm.hactive - 1);
|
|
zx_writel(vou->timing + regs->fir_active, val);
|
|
|
|
val = SYNC_WIDE(vm.hsync_len - 1);
|
|
val |= BACK_PORCH(vm.hback_porch - 1);
|
|
val |= FRONT_PORCH(vm.hfront_porch - 1);
|
|
zx_writel(vou->timing + regs->fir_htiming, val);
|
|
|
|
val = SYNC_WIDE(vm.vsync_len - 1);
|
|
val |= BACK_PORCH(vm.vback_porch - 1);
|
|
val |= FRONT_PORCH(vm.vfront_porch - 1);
|
|
zx_writel(vou->timing + regs->fir_vtiming, val);
|
|
|
|
/* Set up polarities */
|
|
if (vm.flags & DISPLAY_FLAGS_VSYNC_LOW)
|
|
pol |= 1 << POL_VSYNC_SHIFT;
|
|
if (vm.flags & DISPLAY_FLAGS_HSYNC_LOW)
|
|
pol |= 1 << POL_HSYNC_SHIFT;
|
|
|
|
zx_writel_mask(vou->timing + TIMING_CTRL, bits->polarity_mask,
|
|
pol << bits->polarity_shift);
|
|
|
|
/* Setup SHIFT register by following what ZTE BSP does */
|
|
zx_writel(vou->timing + regs->timing_shift, H_SHIFT_VAL);
|
|
zx_writel(vou->timing + regs->timing_pi_shift, H_PI_SHIFT_VAL);
|
|
|
|
/* Enable TIMING_CTRL */
|
|
zx_writel_mask(vou->timing + TIMING_TC_ENABLE, bits->tc_enable,
|
|
bits->tc_enable);
|
|
|
|
/* Configure channel screen size */
|
|
zx_writel_mask(zcrtc->chnreg + CHN_CTRL1, CHN_SCREEN_W_MASK,
|
|
vm.hactive << CHN_SCREEN_W_SHIFT);
|
|
zx_writel_mask(zcrtc->chnreg + CHN_CTRL1, CHN_SCREEN_H_MASK,
|
|
vm.vactive << CHN_SCREEN_H_SHIFT);
|
|
|
|
/* Update channel */
|
|
vou_chn_set_update(zcrtc);
|
|
|
|
/* Enable channel */
|
|
zx_writel_mask(zcrtc->chnreg + CHN_CTRL0, CHN_ENABLE, CHN_ENABLE);
|
|
|
|
/* Enable Graphic Layer */
|
|
zx_writel_mask(vou->osd + OSD_CTRL0, bits->gl_enable,
|
|
bits->gl_enable);
|
|
|
|
drm_crtc_vblank_on(crtc);
|
|
|
|
ret = clk_set_rate(zcrtc->pixclk, mode->clock * 1000);
|
|
if (ret) {
|
|
DRM_DEV_ERROR(vou->dev, "failed to set pixclk rate: %d\n", ret);
|
|
return;
|
|
}
|
|
|
|
ret = clk_prepare_enable(zcrtc->pixclk);
|
|
if (ret)
|
|
DRM_DEV_ERROR(vou->dev, "failed to enable pixclk: %d\n", ret);
|
|
}
|
|
|
|
static void zx_crtc_disable(struct drm_crtc *crtc)
|
|
{
|
|
struct zx_crtc *zcrtc = to_zx_crtc(crtc);
|
|
const struct zx_crtc_bits *bits = zcrtc->bits;
|
|
struct zx_vou_hw *vou = zcrtc->vou;
|
|
|
|
clk_disable_unprepare(zcrtc->pixclk);
|
|
|
|
drm_crtc_vblank_off(crtc);
|
|
|
|
/* Disable Graphic Layer */
|
|
zx_writel_mask(vou->osd + OSD_CTRL0, bits->gl_enable, 0);
|
|
|
|
/* Disable channel */
|
|
zx_writel_mask(zcrtc->chnreg + CHN_CTRL0, CHN_ENABLE, 0);
|
|
|
|
/* Disable TIMING_CTRL */
|
|
zx_writel_mask(vou->timing + TIMING_TC_ENABLE, bits->tc_enable, 0);
|
|
}
|
|
|
|
static void zx_crtc_atomic_flush(struct drm_crtc *crtc,
|
|
struct drm_crtc_state *old_state)
|
|
{
|
|
struct drm_pending_vblank_event *event = crtc->state->event;
|
|
|
|
if (!event)
|
|
return;
|
|
|
|
crtc->state->event = NULL;
|
|
|
|
spin_lock_irq(&crtc->dev->event_lock);
|
|
if (drm_crtc_vblank_get(crtc) == 0)
|
|
drm_crtc_arm_vblank_event(crtc, event);
|
|
else
|
|
drm_crtc_send_vblank_event(crtc, event);
|
|
spin_unlock_irq(&crtc->dev->event_lock);
|
|
}
|
|
|
|
static const struct drm_crtc_helper_funcs zx_crtc_helper_funcs = {
|
|
.enable = zx_crtc_enable,
|
|
.disable = zx_crtc_disable,
|
|
.atomic_flush = zx_crtc_atomic_flush,
|
|
};
|
|
|
|
static const struct drm_crtc_funcs zx_crtc_funcs = {
|
|
.destroy = drm_crtc_cleanup,
|
|
.set_config = drm_atomic_helper_set_config,
|
|
.page_flip = drm_atomic_helper_page_flip,
|
|
.reset = drm_atomic_helper_crtc_reset,
|
|
.atomic_duplicate_state = drm_atomic_helper_crtc_duplicate_state,
|
|
.atomic_destroy_state = drm_atomic_helper_crtc_destroy_state,
|
|
};
|
|
|
|
static int zx_crtc_init(struct drm_device *drm, struct zx_vou_hw *vou,
|
|
enum vou_chn_type chn_type)
|
|
{
|
|
struct device *dev = vou->dev;
|
|
struct zx_layer_data data;
|
|
struct zx_crtc *zcrtc;
|
|
int ret;
|
|
|
|
zcrtc = devm_kzalloc(dev, sizeof(*zcrtc), GFP_KERNEL);
|
|
if (!zcrtc)
|
|
return -ENOMEM;
|
|
|
|
zcrtc->vou = vou;
|
|
zcrtc->chn_type = chn_type;
|
|
|
|
if (chn_type == VOU_CHN_MAIN) {
|
|
data.layer = vou->osd + MAIN_GL_OFFSET;
|
|
data.csc = vou->osd + MAIN_CSC_OFFSET;
|
|
data.hbsc = vou->osd + MAIN_HBSC_OFFSET;
|
|
data.rsz = vou->otfppu + MAIN_RSZ_OFFSET;
|
|
zcrtc->chnreg = vou->osd + OSD_MAIN_CHN;
|
|
zcrtc->regs = &main_crtc_regs;
|
|
zcrtc->bits = &main_crtc_bits;
|
|
} else {
|
|
data.layer = vou->osd + AUX_GL_OFFSET;
|
|
data.csc = vou->osd + AUX_CSC_OFFSET;
|
|
data.hbsc = vou->osd + AUX_HBSC_OFFSET;
|
|
data.rsz = vou->otfppu + AUX_RSZ_OFFSET;
|
|
zcrtc->chnreg = vou->osd + OSD_AUX_CHN;
|
|
zcrtc->regs = &aux_crtc_regs;
|
|
zcrtc->bits = &aux_crtc_bits;
|
|
}
|
|
|
|
zcrtc->pixclk = devm_clk_get(dev, (chn_type == VOU_CHN_MAIN) ?
|
|
"main_wclk" : "aux_wclk");
|
|
if (IS_ERR(zcrtc->pixclk)) {
|
|
ret = PTR_ERR(zcrtc->pixclk);
|
|
DRM_DEV_ERROR(dev, "failed to get pix clk: %d\n", ret);
|
|
return ret;
|
|
}
|
|
|
|
zcrtc->primary = zx_plane_init(drm, dev, &data, DRM_PLANE_TYPE_PRIMARY);
|
|
if (IS_ERR(zcrtc->primary)) {
|
|
ret = PTR_ERR(zcrtc->primary);
|
|
DRM_DEV_ERROR(dev, "failed to init primary plane: %d\n", ret);
|
|
return ret;
|
|
}
|
|
|
|
ret = drm_crtc_init_with_planes(drm, &zcrtc->crtc, zcrtc->primary, NULL,
|
|
&zx_crtc_funcs, NULL);
|
|
if (ret) {
|
|
DRM_DEV_ERROR(dev, "failed to init drm crtc: %d\n", ret);
|
|
return ret;
|
|
}
|
|
|
|
drm_crtc_helper_add(&zcrtc->crtc, &zx_crtc_helper_funcs);
|
|
|
|
if (chn_type == VOU_CHN_MAIN)
|
|
vou->main_crtc = zcrtc;
|
|
else
|
|
vou->aux_crtc = zcrtc;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static inline struct drm_crtc *zx_find_crtc(struct drm_device *drm, int pipe)
|
|
{
|
|
struct drm_crtc *crtc;
|
|
|
|
list_for_each_entry(crtc, &drm->mode_config.crtc_list, head)
|
|
if (crtc->index == pipe)
|
|
return crtc;
|
|
|
|
return NULL;
|
|
}
|
|
|
|
int zx_vou_enable_vblank(struct drm_device *drm, unsigned int pipe)
|
|
{
|
|
struct drm_crtc *crtc;
|
|
struct zx_crtc *zcrtc;
|
|
struct zx_vou_hw *vou;
|
|
u32 int_frame_mask;
|
|
|
|
crtc = zx_find_crtc(drm, pipe);
|
|
if (!crtc)
|
|
return 0;
|
|
|
|
vou = crtc_to_vou(crtc);
|
|
zcrtc = to_zx_crtc(crtc);
|
|
int_frame_mask = zcrtc->bits->int_frame_mask;
|
|
|
|
zx_writel_mask(vou->timing + TIMING_INT_CTRL, int_frame_mask,
|
|
int_frame_mask);
|
|
|
|
return 0;
|
|
}
|
|
|
|
void zx_vou_disable_vblank(struct drm_device *drm, unsigned int pipe)
|
|
{
|
|
struct drm_crtc *crtc;
|
|
struct zx_crtc *zcrtc;
|
|
struct zx_vou_hw *vou;
|
|
|
|
crtc = zx_find_crtc(drm, pipe);
|
|
if (!crtc)
|
|
return;
|
|
|
|
vou = crtc_to_vou(crtc);
|
|
zcrtc = to_zx_crtc(crtc);
|
|
|
|
zx_writel_mask(vou->timing + TIMING_INT_CTRL,
|
|
zcrtc->bits->int_frame_mask, 0);
|
|
}
|
|
|
|
static irqreturn_t vou_irq_handler(int irq, void *dev_id)
|
|
{
|
|
struct zx_vou_hw *vou = dev_id;
|
|
u32 state;
|
|
|
|
/* Handle TIMING_CTRL frame interrupts */
|
|
state = zx_readl(vou->timing + TIMING_INT_STATE);
|
|
zx_writel(vou->timing + TIMING_INT_STATE, state);
|
|
|
|
if (state & TIMING_INT_MAIN_FRAME)
|
|
drm_crtc_handle_vblank(&vou->main_crtc->crtc);
|
|
|
|
if (state & TIMING_INT_AUX_FRAME)
|
|
drm_crtc_handle_vblank(&vou->aux_crtc->crtc);
|
|
|
|
/* Handle OSD interrupts */
|
|
state = zx_readl(vou->osd + OSD_INT_STA);
|
|
zx_writel(vou->osd + OSD_INT_CLRSTA, state);
|
|
|
|
if (state & OSD_INT_MAIN_UPT) {
|
|
vou_chn_set_update(vou->main_crtc);
|
|
zx_plane_set_update(vou->main_crtc->primary);
|
|
}
|
|
|
|
if (state & OSD_INT_AUX_UPT) {
|
|
vou_chn_set_update(vou->aux_crtc);
|
|
zx_plane_set_update(vou->aux_crtc->primary);
|
|
}
|
|
|
|
if (state & OSD_INT_ERROR)
|
|
DRM_DEV_ERROR(vou->dev, "OSD ERROR: 0x%08x!\n", state);
|
|
|
|
return IRQ_HANDLED;
|
|
}
|
|
|
|
static void vou_dtrc_init(struct zx_vou_hw *vou)
|
|
{
|
|
/* Clear bit for bypass by ID */
|
|
zx_writel_mask(vou->dtrc + DTRC_DETILE_CTRL,
|
|
TILE2RASTESCAN_BYPASS_MODE, 0);
|
|
|
|
/* Select ARIDR mode */
|
|
zx_writel_mask(vou->dtrc + DTRC_DETILE_CTRL, DETILE_ARIDR_MODE_MASK,
|
|
DETILE_ARID_IN_ARIDR);
|
|
|
|
/* Bypass decompression for both frames */
|
|
zx_writel_mask(vou->dtrc + DTRC_F0_CTRL, DTRC_DECOMPRESS_BYPASS,
|
|
DTRC_DECOMPRESS_BYPASS);
|
|
zx_writel_mask(vou->dtrc + DTRC_F1_CTRL, DTRC_DECOMPRESS_BYPASS,
|
|
DTRC_DECOMPRESS_BYPASS);
|
|
|
|
/* Set up ARID register */
|
|
zx_writel(vou->dtrc + DTRC_ARID, DTRC_ARID3(0xf) | DTRC_ARID2(0xe) |
|
|
DTRC_ARID1(0xf) | DTRC_ARID0(0xe));
|
|
}
|
|
|
|
static void vou_hw_init(struct zx_vou_hw *vou)
|
|
{
|
|
/* Set GL0 to main channel and GL1 to aux channel */
|
|
zx_writel_mask(vou->osd + OSD_CTRL0, OSD_CTRL0_GL0_SEL, 0);
|
|
zx_writel_mask(vou->osd + OSD_CTRL0, OSD_CTRL0_GL1_SEL,
|
|
OSD_CTRL0_GL1_SEL);
|
|
|
|
/* Release reset for all VOU modules */
|
|
zx_writel(vou->vouctl + VOU_SOFT_RST, ~0);
|
|
|
|
/* Select main clock for GL0 and aux clock for GL1 module */
|
|
zx_writel_mask(vou->vouctl + VOU_CLK_SEL, VOU_CLK_GL0_SEL, 0);
|
|
zx_writel_mask(vou->vouctl + VOU_CLK_SEL, VOU_CLK_GL1_SEL,
|
|
VOU_CLK_GL1_SEL);
|
|
|
|
/* Enable clock auto-gating for all VOU modules */
|
|
zx_writel(vou->vouctl + VOU_CLK_REQEN, ~0);
|
|
|
|
/* Enable all VOU module clocks */
|
|
zx_writel(vou->vouctl + VOU_CLK_EN, ~0);
|
|
|
|
/* Clear both OSD and TIMING_CTRL interrupt state */
|
|
zx_writel(vou->osd + OSD_INT_CLRSTA, ~0);
|
|
zx_writel(vou->timing + TIMING_INT_STATE, ~0);
|
|
|
|
/* Enable OSD and TIMING_CTRL interrrupts */
|
|
zx_writel(vou->osd + OSD_INT_MSK, OSD_INT_ENABLE);
|
|
zx_writel(vou->timing + TIMING_INT_CTRL, TIMING_INT_ENABLE);
|
|
|
|
/* Select GPC as input to gl/vl scaler as a sane default setting */
|
|
zx_writel(vou->otfppu + OTFPPU_RSZ_DATA_SOURCE, 0x2a);
|
|
|
|
/*
|
|
* Needs to reset channel and layer logic per frame when frame starts
|
|
* to get VOU work properly.
|
|
*/
|
|
zx_writel_mask(vou->osd + OSD_RST_CLR, RST_PER_FRAME, RST_PER_FRAME);
|
|
|
|
vou_dtrc_init(vou);
|
|
}
|
|
|
|
static int zx_crtc_bind(struct device *dev, struct device *master, void *data)
|
|
{
|
|
struct platform_device *pdev = to_platform_device(dev);
|
|
struct drm_device *drm = data;
|
|
struct zx_vou_hw *vou;
|
|
struct resource *res;
|
|
int irq;
|
|
int ret;
|
|
|
|
vou = devm_kzalloc(dev, sizeof(*vou), GFP_KERNEL);
|
|
if (!vou)
|
|
return -ENOMEM;
|
|
|
|
res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "osd");
|
|
vou->osd = devm_ioremap_resource(dev, res);
|
|
if (IS_ERR(vou->osd)) {
|
|
ret = PTR_ERR(vou->osd);
|
|
DRM_DEV_ERROR(dev, "failed to remap osd region: %d\n", ret);
|
|
return ret;
|
|
}
|
|
|
|
res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "timing_ctrl");
|
|
vou->timing = devm_ioremap_resource(dev, res);
|
|
if (IS_ERR(vou->timing)) {
|
|
ret = PTR_ERR(vou->timing);
|
|
DRM_DEV_ERROR(dev, "failed to remap timing_ctrl region: %d\n",
|
|
ret);
|
|
return ret;
|
|
}
|
|
|
|
res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "dtrc");
|
|
vou->dtrc = devm_ioremap_resource(dev, res);
|
|
if (IS_ERR(vou->dtrc)) {
|
|
ret = PTR_ERR(vou->dtrc);
|
|
DRM_DEV_ERROR(dev, "failed to remap dtrc region: %d\n", ret);
|
|
return ret;
|
|
}
|
|
|
|
res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "vou_ctrl");
|
|
vou->vouctl = devm_ioremap_resource(dev, res);
|
|
if (IS_ERR(vou->vouctl)) {
|
|
ret = PTR_ERR(vou->vouctl);
|
|
DRM_DEV_ERROR(dev, "failed to remap vou_ctrl region: %d\n",
|
|
ret);
|
|
return ret;
|
|
}
|
|
|
|
res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "otfppu");
|
|
vou->otfppu = devm_ioremap_resource(dev, res);
|
|
if (IS_ERR(vou->otfppu)) {
|
|
ret = PTR_ERR(vou->otfppu);
|
|
DRM_DEV_ERROR(dev, "failed to remap otfppu region: %d\n", ret);
|
|
return ret;
|
|
}
|
|
|
|
irq = platform_get_irq(pdev, 0);
|
|
if (irq < 0)
|
|
return irq;
|
|
|
|
vou->axi_clk = devm_clk_get(dev, "aclk");
|
|
if (IS_ERR(vou->axi_clk)) {
|
|
ret = PTR_ERR(vou->axi_clk);
|
|
DRM_DEV_ERROR(dev, "failed to get axi_clk: %d\n", ret);
|
|
return ret;
|
|
}
|
|
|
|
vou->ppu_clk = devm_clk_get(dev, "ppu_wclk");
|
|
if (IS_ERR(vou->ppu_clk)) {
|
|
ret = PTR_ERR(vou->ppu_clk);
|
|
DRM_DEV_ERROR(dev, "failed to get ppu_clk: %d\n", ret);
|
|
return ret;
|
|
}
|
|
|
|
ret = clk_prepare_enable(vou->axi_clk);
|
|
if (ret) {
|
|
DRM_DEV_ERROR(dev, "failed to enable axi_clk: %d\n", ret);
|
|
return ret;
|
|
}
|
|
|
|
clk_prepare_enable(vou->ppu_clk);
|
|
if (ret) {
|
|
DRM_DEV_ERROR(dev, "failed to enable ppu_clk: %d\n", ret);
|
|
goto disable_axi_clk;
|
|
}
|
|
|
|
vou->dev = dev;
|
|
dev_set_drvdata(dev, vou);
|
|
|
|
vou_hw_init(vou);
|
|
|
|
ret = devm_request_irq(dev, irq, vou_irq_handler, 0, "zx_vou", vou);
|
|
if (ret < 0) {
|
|
DRM_DEV_ERROR(dev, "failed to request vou irq: %d\n", ret);
|
|
goto disable_ppu_clk;
|
|
}
|
|
|
|
ret = zx_crtc_init(drm, vou, VOU_CHN_MAIN);
|
|
if (ret) {
|
|
DRM_DEV_ERROR(dev, "failed to init main channel crtc: %d\n",
|
|
ret);
|
|
goto disable_ppu_clk;
|
|
}
|
|
|
|
ret = zx_crtc_init(drm, vou, VOU_CHN_AUX);
|
|
if (ret) {
|
|
DRM_DEV_ERROR(dev, "failed to init aux channel crtc: %d\n",
|
|
ret);
|
|
goto disable_ppu_clk;
|
|
}
|
|
|
|
return 0;
|
|
|
|
disable_ppu_clk:
|
|
clk_disable_unprepare(vou->ppu_clk);
|
|
disable_axi_clk:
|
|
clk_disable_unprepare(vou->axi_clk);
|
|
return ret;
|
|
}
|
|
|
|
static void zx_crtc_unbind(struct device *dev, struct device *master,
|
|
void *data)
|
|
{
|
|
struct zx_vou_hw *vou = dev_get_drvdata(dev);
|
|
|
|
clk_disable_unprepare(vou->axi_clk);
|
|
clk_disable_unprepare(vou->ppu_clk);
|
|
}
|
|
|
|
static const struct component_ops zx_crtc_component_ops = {
|
|
.bind = zx_crtc_bind,
|
|
.unbind = zx_crtc_unbind,
|
|
};
|
|
|
|
static int zx_crtc_probe(struct platform_device *pdev)
|
|
{
|
|
return component_add(&pdev->dev, &zx_crtc_component_ops);
|
|
}
|
|
|
|
static int zx_crtc_remove(struct platform_device *pdev)
|
|
{
|
|
component_del(&pdev->dev, &zx_crtc_component_ops);
|
|
return 0;
|
|
}
|
|
|
|
static const struct of_device_id zx_crtc_of_match[] = {
|
|
{ .compatible = "zte,zx296718-dpc", },
|
|
{ /* end */ },
|
|
};
|
|
MODULE_DEVICE_TABLE(of, zx_crtc_of_match);
|
|
|
|
struct platform_driver zx_crtc_driver = {
|
|
.probe = zx_crtc_probe,
|
|
.remove = zx_crtc_remove,
|
|
.driver = {
|
|
.name = "zx-crtc",
|
|
.of_match_table = zx_crtc_of_match,
|
|
},
|
|
};
|