Merge tag 'u-boot-atmel-fixes-2021.01-b' of https://gitlab.denx.de/u-boot/custodians...
[platform/kernel/u-boot.git] / drivers / remoteproc / stm32_copro.c
index 40bba37..dc87cb7 100644 (file)
@@ -7,29 +7,23 @@
 #include <dm.h>
 #include <errno.h>
 #include <fdtdec.h>
-#include <regmap.h>
+#include <log.h>
 #include <remoteproc.h>
 #include <reset.h>
-#include <syscon.h>
 #include <asm/io.h>
-
-#define RCC_GCR_HOLD_BOOT      0
-#define RCC_GCR_RELEASE_BOOT   1
+#include <dm/device_compat.h>
+#include <linux/err.h>
 
 /**
  * struct stm32_copro_privdata - power processor private data
  * @reset_ctl:         reset controller handle
- * @hold_boot_regmap:  regmap for remote processor reset hold boot
- * @hold_boot_offset:  offset of the register controlling the hold boot setting
- * @hold_boot_mask:    bitmask of the register for the hold boot field
- * @is_running:                is the remote processor running
+ * @hold_boot:         hold boot controller handle
+ * @rsc_table_addr:    resource table address
  */
 struct stm32_copro_privdata {
        struct reset_ctl reset_ctl;
-       struct regmap *hold_boot_regmap;
-       uint hold_boot_offset;
-       uint hold_boot_mask;
-       bool is_running;
+       struct reset_ctl hold_boot;
+       ulong rsc_table_addr;
 };
 
 /**
@@ -40,32 +34,19 @@ struct stm32_copro_privdata {
 static int stm32_copro_probe(struct udevice *dev)
 {
        struct stm32_copro_privdata *priv;
-       struct regmap *regmap;
-       const fdt32_t *cell;
-       int len, ret;
+       int ret;
 
        priv = dev_get_priv(dev);
 
-       regmap = syscon_regmap_lookup_by_phandle(dev, "st,syscfg-holdboot");
-       if (IS_ERR(regmap)) {
-               dev_err(dev, "unable to find holdboot regmap (%ld)\n",
-                       PTR_ERR(regmap));
-               return PTR_ERR(regmap);
-       }
-
-       cell = dev_read_prop(dev, "st,syscfg-holdboot", &len);
-       if (len < 3 * sizeof(fdt32_t)) {
-               dev_err(dev, "holdboot offset and mask not available\n");
-               return -EINVAL;
+       ret = reset_get_by_name(dev, "mcu_rst", &priv->reset_ctl);
+       if (ret) {
+               dev_err(dev, "failed to get reset (%d)\n", ret);
+               return ret;
        }
 
-       priv->hold_boot_regmap = regmap;
-       priv->hold_boot_offset = fdtdec_get_number(cell + 1, 1);
-       priv->hold_boot_mask = fdtdec_get_number(cell + 2, 1);
-
-       ret = reset_get_by_index(dev, 0, &priv->reset_ctl);
+       ret = reset_get_by_name(dev, "hold_boot", &priv->hold_boot);
        if (ret) {
-               dev_err(dev, "failed to get reset (%d)\n", ret);
+               dev_err(dev, "failed to get hold boot (%d)\n", ret);
                return ret;
        }
 
@@ -75,35 +56,6 @@ static int stm32_copro_probe(struct udevice *dev)
 }
 
 /**
- * stm32_copro_set_hold_boot() - Hold boot bit management
- * @dev:       corresponding STM32 remote processor device
- * @hold:      hold boot value
- * @return 0 if all went ok, else corresponding -ve error
- */
-static int stm32_copro_set_hold_boot(struct udevice *dev, bool hold)
-{
-       struct stm32_copro_privdata *priv;
-       uint val;
-       int ret;
-
-       priv = dev_get_priv(dev);
-
-       val = hold ? RCC_GCR_HOLD_BOOT : RCC_GCR_RELEASE_BOOT;
-
-       /*
-        * Note: shall run an SMC call (STM32_SMC_RCC) if platform is secured.
-        * To be updated when the code for this SMC service is available which
-        * is not the case for the time being.
-        */
-       ret = regmap_update_bits(priv->hold_boot_regmap, priv->hold_boot_offset,
-                                priv->hold_boot_mask, val);
-       if (ret)
-               dev_err(dev, "failed to set hold boot\n");
-
-       return ret;
-}
-
-/**
  * stm32_copro_device_to_virt() - Convert device address to virtual address
  * @dev:       corresponding STM32 remote processor device
  * @da:                device address
@@ -141,13 +93,16 @@ static void *stm32_copro_device_to_virt(struct udevice *dev, ulong da,
 static int stm32_copro_load(struct udevice *dev, ulong addr, ulong size)
 {
        struct stm32_copro_privdata *priv;
+       ulong rsc_table_size;
        int ret;
 
        priv = dev_get_priv(dev);
 
-       ret = stm32_copro_set_hold_boot(dev, true);
-       if (ret)
+       ret = reset_assert(&priv->hold_boot);
+       if (ret) {
+               dev_err(dev, "Unable to assert hold boot (ret=%d)\n", ret);
                return ret;
+       }
 
        ret = reset_assert(&priv->reset_ctl);
        if (ret) {
@@ -155,6 +110,12 @@ static int stm32_copro_load(struct udevice *dev, ulong addr, ulong size)
                return ret;
        }
 
+       if (rproc_elf32_load_rsc_table(dev, addr, size, &priv->rsc_table_addr,
+                                      &rsc_table_size)) {
+               priv->rsc_table_addr = 0;
+               dev_warn(dev, "No valid resource table for this firmware\n");
+       }
+
        return rproc_elf32_load_image(dev, addr, size);
 }
 
@@ -170,18 +131,26 @@ static int stm32_copro_start(struct udevice *dev)
 
        priv = dev_get_priv(dev);
 
-       /* move hold boot from true to false start the copro */
-       ret = stm32_copro_set_hold_boot(dev, false);
-       if (ret)
+       ret = reset_deassert(&priv->hold_boot);
+       if (ret) {
+               dev_err(dev, "Unable to deassert hold boot (ret=%d)\n", ret);
                return ret;
+       }
 
        /*
         * Once copro running, reset hold boot flag to avoid copro
-        * rebooting autonomously
+        * rebooting autonomously (error should never occur)
         */
-       ret = stm32_copro_set_hold_boot(dev, true);
-       priv->is_running = !ret;
-       return ret;
+       ret = reset_assert(&priv->hold_boot);
+       if (ret)
+               dev_err(dev, "Unable to assert hold boot (ret=%d)\n", ret);
+
+       /* indicates that copro is running */
+       writel(TAMP_COPRO_STATE_CRUN, TAMP_COPRO_STATE);
+       /* Store rsc_address in bkp register */
+       writel(priv->rsc_table_addr, TAMP_COPRO_RSC_TBL_ADDRESS);
+
+       return 0;
 }
 
 /**
@@ -196,9 +165,11 @@ static int stm32_copro_reset(struct udevice *dev)
 
        priv = dev_get_priv(dev);
 
-       ret = stm32_copro_set_hold_boot(dev, true);
-       if (ret)
+       ret = reset_assert(&priv->hold_boot);
+       if (ret) {
+               dev_err(dev, "Unable to assert hold boot (ret=%d)\n", ret);
                return ret;
+       }
 
        ret = reset_assert(&priv->reset_ctl);
        if (ret) {
@@ -206,7 +177,7 @@ static int stm32_copro_reset(struct udevice *dev)
                return ret;
        }
 
-       priv->is_running = false;
+       writel(TAMP_COPRO_STATE_OFF, TAMP_COPRO_STATE);
 
        return 0;
 }
@@ -224,14 +195,11 @@ static int stm32_copro_stop(struct udevice *dev)
 /**
  * stm32_copro_is_running() - Is the STM32 remote processor running
  * @dev:       corresponding STM32 remote processor device
- * @return 1 if the remote processor is running, 0 otherwise
+ * @return 0 if the remote processor is running, 1 otherwise
  */
 static int stm32_copro_is_running(struct udevice *dev)
 {
-       struct stm32_copro_privdata *priv;
-
-       priv = dev_get_priv(dev);
-       return priv->is_running;
+       return (readl(TAMP_COPRO_STATE) == TAMP_COPRO_STATE_OFF);
 }
 
 static const struct dm_rproc_ops stm32_copro_ops = {