ENGR00285283 PXP: make pxp driver compatible for G2D

Use stride to set AS and PS pitch by default, if stride is 0, then use
width to set AS and PS pitch instead. This will make PXP driver both
work for PXP kernel users and G2D applications.

Signed-off-by: Fancy Fang <B47543@freescale.com>

diff --git a/drivers/dma/pxp/pxp_dma_v2.c b/drivers/dma/pxp/pxp_dma_v2.c
index e72886ecbf3dd543000a25d3150c6906d2a3dfbf..0df4200d24810eab3a0451538620e11df2aa6362 100644 (file)
--- a/drivers/dma/pxp/pxp_dma_v2.c
+++ b/drivers/dma/pxp/pxp_dma_v2.c
@@ -478,6 +478,8 @@ static void pxp_set_oln(int layer_no, struct pxps *pxp)
        struct pxp_layer_param *olparams_data = &pxp_conf->ol_param[layer_no];
        dma_addr_t phys_addr = olparams_data->paddr;
        __raw_writel(phys_addr, pxp->base + HW_PXP_AS_BUF);
+       u32 pitch = olparams_data->stride ? olparams_data->stride :
+                                           olparams_data->width;
 
        /* Fixme */
        if (olparams_data->width == 0 && olparams_data->height == 0) {
@@ -505,10 +507,10 @@ static void pxp_set_oln(int layer_no, struct pxps *pxp)
 
        if ((olparams_data->pixel_fmt == PXP_PIX_FMT_BGRA32) |
                 (olparams_data->pixel_fmt == PXP_PIX_FMT_RGB32)) {
-               __raw_writel(olparams_data->width << 2,
+               __raw_writel(pitch << 2,
                                pxp->base + HW_PXP_AS_PITCH);
        } else if (olparams_data->pixel_fmt == PXP_PIX_FMT_RGB565) {
-               __raw_writel(olparams_data->width << 1,
+               __raw_writel(pitch << 1,
                                pxp->base + HW_PXP_AS_PITCH);
        } else {
                __raw_writel(0, pxp->base + HW_PXP_AS_PITCH);
@@ -886,6 +888,8 @@ static void pxp_set_s0buf(struct pxps *pxp)
        dma_addr_t Y, U, V;
        dma_addr_t Y1, U1, V1;
        u32 offset, bpp = 1;
+       u32 pitch = s0_params->stride ? s0_params->stride :
+                                       s0_params->width;
 
        Y = s0_params->paddr;
 
@@ -937,22 +941,22 @@ static void pxp_set_s0buf(struct pxps *pxp)
            s0_params->pixel_fmt == PXP_PIX_FMT_NV21 ||
            s0_params->pixel_fmt == PXP_PIX_FMT_NV16 ||
            s0_params->pixel_fmt == PXP_PIX_FMT_NV61) {
-               __raw_writel(s0_params->width, pxp->base + HW_PXP_PS_PITCH);
+               __raw_writel(pitch, pxp->base + HW_PXP_PS_PITCH);
        }
        else if (s0_params->pixel_fmt == PXP_PIX_FMT_GY04)
-               __raw_writel(s0_params->width >> 1,
+               __raw_writel(pitch >> 1,
                                pxp->base + HW_PXP_PS_PITCH);
        else if (s0_params->pixel_fmt == PXP_PIX_FMT_RGB32)
-               __raw_writel(s0_params->width << 2,
+               __raw_writel(pitch << 2,
                                pxp->base + HW_PXP_PS_PITCH);
        else if (s0_params->pixel_fmt == PXP_PIX_FMT_UYVY ||
                 s0_params->pixel_fmt == PXP_PIX_FMT_YUYV ||
                 s0_params->pixel_fmt == PXP_PIX_FMT_VYUY ||
                 s0_params->pixel_fmt == PXP_PIX_FMT_YVYU)
-               __raw_writel(s0_params->width << 1,
+               __raw_writel(pitch << 1,
                                pxp->base + HW_PXP_PS_PITCH);
        else if (s0_params->pixel_fmt == PXP_PIX_FMT_RGB565)
-               __raw_writel(s0_params->width << 1,
+               __raw_writel(pitch << 1,
                                pxp->base + HW_PXP_PS_PITCH);
        else
                __raw_writel(0, pxp->base + HW_PXP_PS_PITCH);