drm: zte: add .atomic_disable hook to disable graphic layer

There are a few hardware bits for each graphic layer to control main/aux
channel and clock selection, as well as the layer enabling.  These bits
sit outside the layer block itself, but in VOU control glue block.  We
currently set these bits up at CRTC initialization for once, and do not
support disabling the layer.

This patch creates a pair of functions zx_vou_layer_enable[disable] to
be invoked from plane hooks .atomic_update and .atomic_disable to set up
and tear down the layer.  This is generic for both graphic and video
layers, so it will make the overlay plane support to be added later much
easier.

Signed-off-by: Shawn Guo <shawn.guo@linaro.org>
Reviewed-by: Sean Paul <seanpaul@chromium.org>

diff --git a/drivers/gpu/drm/zte/zx_plane.c b/drivers/gpu/drm/zte/zx_plane.c
index 78d29b1db91cc18149e45c4299cd7b18fca2c49c..5445eebf830f76a330794e94b52e383cdaf5e154 100644 (file)
--- a/drivers/gpu/drm/zte/zx_plane.c
+++ b/drivers/gpu/drm/zte/zx_plane.c
@@ -197,12 +197,27 @@ static void zx_gl_plane_atomic_update(struct drm_plane *plane,
        /* Enable HBSC block */
        zx_writel_mask(hbsc + HBSC_CTRL0, HBSC_CTRL_EN, HBSC_CTRL_EN);
 
+       zx_vou_layer_enable(plane);
+
        zx_gl_set_update(zplane);
 }
 
+static void zx_plane_atomic_disable(struct drm_plane *plane,
+                                   struct drm_plane_state *old_state)
+{
+       struct zx_plane *zplane = to_zx_plane(plane);
+       void __iomem *hbsc = zplane->hbsc;
+
+       zx_vou_layer_disable(plane);
+
+       /* Disable HBSC block */
+       zx_writel_mask(hbsc + HBSC_CTRL0, HBSC_CTRL_EN, 0);
+}
+
 static const struct drm_plane_helper_funcs zx_gl_plane_helper_funcs = {
        .atomic_check = zx_gl_plane_atomic_check,
        .atomic_update = zx_gl_plane_atomic_update,
+       .atomic_disable = zx_plane_atomic_disable,
 };
 
 static void zx_plane_destroy(struct drm_plane *plane)

diff --git a/drivers/gpu/drm/zte/zx_plane.h b/drivers/gpu/drm/zte/zx_plane.h
index 264a92e0b532c95c51a6cf69224c21f44f9620b3..933611ddffd0d20412e5ba590a5f3332b259d047 100644 (file)
--- a/drivers/gpu/drm/zte/zx_plane.h
+++ b/drivers/gpu/drm/zte/zx_plane.h
@@ -18,6 +18,7 @@ struct zx_plane {
        void __iomem *csc;
        void __iomem *hbsc;
        void __iomem *rsz;
+       const struct vou_layer_bits *bits;
 };
 
 #define to_zx_plane(plane) container_of(plane, struct zx_plane, plane)

diff --git a/drivers/gpu/drm/zte/zx_vou.c b/drivers/gpu/drm/zte/zx_vou.c
index 1bc8f8762956f1c444a578449c872fb6582942a6..d299a3528282062786e3a47519ecb849148b1505 100644 (file)
--- a/drivers/gpu/drm/zte/zx_vou.c
+++ b/drivers/gpu/drm/zte/zx_vou.c
@@ -65,7 +65,6 @@ struct zx_crtc_bits {
        u32 polarity_shift;
        u32 int_frame_mask;
        u32 tc_enable;
-       u32 gl_enable;
 };
 
 static const struct zx_crtc_bits main_crtc_bits = {
@@ -73,7 +72,6 @@ static const struct zx_crtc_bits main_crtc_bits = {
        .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 = {
@@ -81,7 +79,6 @@ static const struct zx_crtc_bits aux_crtc_bits = {
        .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 {
@@ -97,6 +94,24 @@ struct zx_crtc {
 
 #define to_zx_crtc(x) container_of(x, struct zx_crtc, crtc)
 
+struct vou_layer_bits {
+       u32 enable;
+       u32 chnsel;
+       u32 clksel;
+};
+
+static const struct vou_layer_bits zx_gl_bits[GL_NUM] = {
+       {
+               .enable = OSD_CTRL0_GL0_EN,
+               .chnsel = OSD_CTRL0_GL0_SEL,
+               .clksel = VOU_CLK_GL0_SEL,
+       }, {
+               .enable = OSD_CTRL0_GL1_EN,
+               .chnsel = OSD_CTRL0_GL1_SEL,
+               .clksel = VOU_CLK_GL1_SEL,
+       },
+};
+
 struct zx_vou_hw {
        struct device *dev;
        void __iomem *osd;
@@ -229,10 +244,6 @@ static void zx_crtc_enable(struct drm_crtc *crtc)
        /* 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);
@@ -256,9 +267,6 @@ static void zx_crtc_disable(struct drm_crtc *crtc)
 
        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);
 
@@ -325,6 +333,7 @@ static int zx_crtc_init(struct drm_device *drm, struct zx_vou_hw *vou,
                zplane->csc = vou->osd + MAIN_CSC_OFFSET;
                zplane->hbsc = vou->osd + MAIN_HBSC_OFFSET;
                zplane->rsz = vou->otfppu + MAIN_RSZ_OFFSET;
+               zplane->bits = &zx_gl_bits[0];
                zcrtc->chnreg = vou->osd + OSD_MAIN_CHN;
                zcrtc->regs = &main_crtc_regs;
                zcrtc->bits = &main_crtc_bits;
@@ -333,6 +342,7 @@ static int zx_crtc_init(struct drm_device *drm, struct zx_vou_hw *vou,
                zplane->csc = vou->osd + AUX_CSC_OFFSET;
                zplane->hbsc = vou->osd + AUX_HBSC_OFFSET;
                zplane->rsz = vou->otfppu + AUX_RSZ_OFFSET;
+               zplane->bits = &zx_gl_bits[1];
                zcrtc->chnreg = vou->osd + OSD_AUX_CHN;
                zcrtc->regs = &aux_crtc_regs;
                zcrtc->bits = &aux_crtc_bits;
@@ -420,6 +430,36 @@ void zx_vou_disable_vblank(struct drm_device *drm, unsigned int pipe)
                       zcrtc->bits->int_frame_mask, 0);
 }
 
+void zx_vou_layer_enable(struct drm_plane *plane)
+{
+       struct zx_crtc *zcrtc = to_zx_crtc(plane->state->crtc);
+       struct zx_vou_hw *vou = zcrtc->vou;
+       struct zx_plane *zplane = to_zx_plane(plane);
+       const struct vou_layer_bits *bits = zplane->bits;
+
+       if (zcrtc->chn_type == VOU_CHN_MAIN) {
+               zx_writel_mask(vou->osd + OSD_CTRL0, bits->chnsel, 0);
+               zx_writel_mask(vou->vouctl + VOU_CLK_SEL, bits->clksel, 0);
+       } else {
+               zx_writel_mask(vou->osd + OSD_CTRL0, bits->chnsel,
+                              bits->chnsel);
+               zx_writel_mask(vou->vouctl + VOU_CLK_SEL, bits->clksel,
+                              bits->clksel);
+       }
+
+       zx_writel_mask(vou->osd + OSD_CTRL0, bits->enable, bits->enable);
+}
+
+void zx_vou_layer_disable(struct drm_plane *plane)
+{
+       struct zx_crtc *zcrtc = to_zx_crtc(plane->crtc);
+       struct zx_vou_hw *vou = zcrtc->vou;
+       struct zx_plane *zplane = to_zx_plane(plane);
+       const struct vou_layer_bits *bits = zplane->bits;
+
+       zx_writel_mask(vou->osd + OSD_CTRL0, bits->enable, 0);
+}
+
 static irqreturn_t vou_irq_handler(int irq, void *dev_id)
 {
        struct zx_vou_hw *vou = dev_id;
@@ -478,19 +518,9 @@ static void vou_dtrc_init(struct zx_vou_hw *vou)
 
 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);
 

diff --git a/drivers/gpu/drm/zte/zx_vou.h b/drivers/gpu/drm/zte/zx_vou.h
index e571b888a3cad3b02d9026339dfc307f9a3e26e5..ace00ce318e539c2da1e450caf204b5599ea1e58 100644 (file)
--- a/drivers/gpu/drm/zte/zx_vou.h
+++ b/drivers/gpu/drm/zte/zx_vou.h
@@ -53,4 +53,7 @@ void vou_inf_disable(const struct vou_inf *inf, struct drm_crtc *crtc);
 int zx_vou_enable_vblank(struct drm_device *drm, unsigned int pipe);
 void zx_vou_disable_vblank(struct drm_device *drm, unsigned int pipe);
 
+void zx_vou_layer_enable(struct drm_plane *plane);
+void zx_vou_layer_disable(struct drm_plane *plane);
+
 #endif /* __ZX_VOU_H__ */