[PATCH 01/05] Hack FCP driver to poke at FCPCS and VDPB during probe

[Magnus Damm]

From: Magnus Damm <damm+rene...@opensource.se>

Hack up the FCP driver to test the power domains and dump registers.

This prototype level code is not intended for upstream merge.

Not-Signed-off-by: Magnus Damm <damm+rene...@opensource.se>
---

 drivers/media/platform/rcar-fcp.c |   42 ++++++++++++++++++++++++++++++++++++-
 drivers/soc/renesas/rcar-sysc.c   |    1 
 2 files changed, 42 insertions(+), 1 deletion(-)

--- 0002/drivers/media/platform/rcar-fcp.c
+++ work/drivers/media/platform/rcar-fcp.c      2018-11-21 18:32:58.792603934 
+0900
@@ -8,10 +8,12 @@
  */
 
 #include <linux/device.h>
+#include <linux/io.h>
 #include <linux/list.h>
 #include <linux/module.h>
 #include <linux/mod_devicetable.h>
 #include <linux/mutex.h>
+#include <linux/of_device.h>
 #include <linux/platform_device.h>
 #include <linux/pm_runtime.h>
 #include <linux/slab.h>
@@ -26,6 +28,8 @@ struct rcar_fcp_device {
 static LIST_HEAD(fcp_devices);
 static DEFINE_MUTEX(fcp_lock);
 
+#define FCP_VCR 0 /* Version register at offset 0 */
+
 /* 
-----------------------------------------------------------------------------
  * Public API
  */
@@ -118,7 +122,7 @@ EXPORT_SYMBOL_GPL(rcar_fcp_enable);
 void rcar_fcp_disable(struct rcar_fcp_device *fcp)
 {
        if (fcp)
-               pm_runtime_put(fcp->dev);
+               pm_runtime_put_sync(fcp->dev);
 }
 EXPORT_SYMBOL_GPL(rcar_fcp_disable);
 
@@ -144,6 +148,41 @@ static int rcar_fcp_probe(struct platfor
 
        platform_set_drvdata(pdev, fcp);
 
+       /* self-test VCPCS on ->probe() */
+       if (of_device_get_match_data(&pdev->dev)) {
+               struct resource *io;
+               void __iomem *mmio, *mmio2;
+
+               printk("Enabling FCPCS device (Runtime PM on)\n");
+               rcar_fcp_enable(fcp);
+
+               io = platform_get_resource(pdev, IORESOURCE_MEM, 0);
+               mmio = devm_ioremap_resource(&pdev->dev, io);
+               if (!IS_ERR(mmio))
+                       printk("Power-on FCPCS version is 0x%08lx\n",
+                              (unsigned long) ioread32(mmio + FCP_VCR));
+
+               io = platform_get_resource(pdev, IORESOURCE_MEM, 1);
+               mmio2 = devm_ioremap_resource(&pdev->dev, io);
+
+               if (!IS_ERR(mmio2))
+                       printk("Power-on VDPB read at offset 0x200 is 
0x%08lx\n",
+                              (unsigned long) ioread32(mmio2 + 0x200));
+
+               printk("Disabling FCPCS device (Runtime PM off)\n");
+               rcar_fcp_disable(fcp);
+
+#ifdef IOREAD_POWER_OFF_TEST
+               if (!IS_ERR(mmio))
+                       printk("Power-off FCPCS version is 0x%08lx\n",
+                              (unsigned long) ioread32(mmio + FCP_VCR));
+
+               if (!IS_ERR(mmio2))
+                       printk("Power-off VDPB read at offset 0x200 is 
0x%08lx\n",
+                              (unsigned long) ioread32(mmio2 + 0x200));
+#endif
+       }
+
        return 0;
 }
 
@@ -163,6 +202,7 @@ static int rcar_fcp_remove(struct platfo
 static const struct of_device_id rcar_fcp_of_match[] = {
        { .compatible = "renesas,fcpf" },
        { .compatible = "renesas,fcpv" },
+       { .compatible = "renesas,fcpc", .data = &rcar_fcp_of_match[0] },
        { },
 };
 MODULE_DEVICE_TABLE(of, rcar_fcp_of_match);
--- 0002/drivers/soc/renesas/rcar-sysc.c
+++ work/drivers/soc/renesas/rcar-sysc.c        2018-11-21 17:16:50.411091041 
+0900
@@ -6,6 +6,7 @@
  * Copyright (C) 2015-2017 Glider bvba
  */
 
+#define DEBUG
 #include <linux/clk/renesas.h>
 #include <linux/delay.h>
 #include <linux/err.h>