media: imx-pxp: detect PXP version

Different versions of the Pixel Pipeline have different blocks and their
routing may be different. Read the PXP_HW_VERSION register to determine
the version of the PXP and print it to the log for debugging purposes.

Signed-off-by: Michael Tretter <m.tretter@pengutronix.de>
Reviewed-by: Philipp Zabel <p.zabel@pengutronix.de>
Signed-off-by: Laurent Pinchart <laurent.pinchart@ideasonboard.com>
Signed-off-by: Mauro Carvalho Chehab <mchehab@kernel.org>

diff --git a/drivers/media/platform/nxp/imx-pxp.c b/drivers/media/platform/nxp/imx-pxp.c
index 689ae5e..20fff1e 100644 (file)
--- a/drivers/media/platform/nxp/imx-pxp.c
+++ b/drivers/media/platform/nxp/imx-pxp.c
@@ -10,6 +10,7 @@
  * Pawel Osciak, <pawel@osciak.com>
  * Marek Szyprowski, <m.szyprowski@samsung.com>
  */
+#include <linux/bitfield.h>
 #include <linux/clk.h>
 #include <linux/delay.h>
 #include <linux/dma-mapping.h>
@@ -52,6 +53,11 @@ MODULE_PARM_DESC(debug, "activates debug info");
 #define MEM2MEM_HFLIP  (1 << 0)
 #define MEM2MEM_VFLIP  (1 << 1)
 
+#define PXP_VERSION_MAJOR(version) \
+       FIELD_GET(BM_PXP_VERSION_MAJOR, version)
+#define PXP_VERSION_MINOR(version) \
+       FIELD_GET(BM_PXP_VERSION_MINOR, version)
+
 #define dprintk(dev, fmt, arg...) \
        v4l2_dbg(1, debug, &dev->v4l2_dev, "%s: " fmt, __func__, ## arg)
 
@@ -1664,6 +1670,7 @@ static int pxp_probe(struct platform_device *pdev)
 {
        struct pxp_dev *dev;
        struct video_device *vfd;
+       u32 hw_version;
        int irq;
        int ret;
 
@@ -1705,6 +1712,10 @@ static int pxp_probe(struct platform_device *pdev)
                goto err_clk;
        }
 
+       hw_version = readl(dev->mmio + HW_PXP_VERSION);
+       dev_dbg(&pdev->dev, "PXP Version %u.%u\n",
+               PXP_VERSION_MAJOR(hw_version), PXP_VERSION_MINOR(hw_version));
+
        ret = v4l2_device_register(&pdev->dev, &dev->v4l2_dev);
        if (ret)
                goto err_clk;