ARM: Layerscape: Add PPA firmware support

The "Primary Protected Application" (PPA) is a PSCI compliant firmware
distributed by NXP. It is needed to start the secondary cores on
Layerscape SoCs. Without it Linux will be started in EL3 and doesn't
work properly. The precompiled firmware images can be found on
https://github.com/NXP/qoriq-ppa-binary and are not included in
barebox.

Signed-off-by: Sascha Hauer <s.hauer@pengutronix.de>

1 files changed, 118 insertions, 0 deletions

diff --git a/arch/arm/mach-layerscape/ppa.c b/arch/arm/mach-layerscape/ppa.c
new file mode 100644
index 0000000000..6070451020
--- /dev/null
+++ b/arch/arm/mach-layerscape/ppa.c
@@ -0,0 +1,118 @@
+// SPDX-License-Identifier: GPL-2.0
+
+#define pr_fmt(fmt) "ppa: " fmt
+
+#include <common.h>
+#include <init.h>
+#include <firmware.h>
+#include <memory.h>
+#include <linux/sizes.h>
+#include <linux/arm-smccc.h>
+#include <asm/mmu.h>
+#include <soc/fsl/immap_lsch2.h>
+#include <asm/system.h>
+#include <image-fit.h>
+#include <asm/psci.h>
+#include <mach/layerscape.h>
+
+int ppa_entry(const void *, u32 *, u32 *);
+void dma_flush_range(void *ptr, size_t size);
+
+static int of_psci_do_fixup(struct device_node *root, void *unused)
+{
+	unsigned long psci_version;
+	struct arm_smccc_res res = {};
+
+	arm_smccc_smc(ARM_PSCI_0_2_FN_PSCI_VERSION, 0, 0, 0, 0, 0, 0, 0, &res);
+	psci_version = res.a0;
+
+	return of_psci_fixup(root, psci_version);
+}
+
+static int ppa_init(void *ppa, size_t ppa_size, void *sec_firmware_addr)
+{
+	int ret;
+	u32 *boot_loc_ptr_l, *boot_loc_ptr_h;
+	struct ccsr_scfg __iomem *scfg = (void *)(LSCH2_SCFG_ADDR);
+	int el = current_el();
+	struct fit_handle *fit;
+	void *conf;
+	const void *buf;
+	unsigned long firmware_size;
+
+	if (el < 3) {
+		printf("EL%d, skip ppa init\n", el);
+		return 0;
+	}
+
+	boot_loc_ptr_l = &scfg->scratchrw[1];
+	boot_loc_ptr_h = &scfg->scratchrw[0];
+
+	fit = fit_open_buf(ppa, ppa_size, false, BOOTM_VERIFY_AVAILABLE);
+	if (IS_ERR(fit)) {
+		pr_err("Cannot open ppa FIT image: %s\n", strerrorp(fit));
+		return PTR_ERR(fit);
+	}
+
+	conf = fit_open_configuration(fit, NULL);
+	if (IS_ERR(conf)) {
+		pr_err("Cannot open default config in ppa FIT image: %s\n",
+		       strerrorp(conf));
+		fit_close(fit);
+		return PTR_ERR(fit);
+	}
+
+
+	ret = fit_open_image(fit, conf, "firmware", &buf, &firmware_size);
+	if (ret) {
+		pr_err("Cannot open firmware image in ppa FIT image: %s\n",
+		       strerror(-ret));
+		ret = PTR_ERR(fit);
+		goto err;
+	}
+
+	/* Copy the secure firmware to secure memory */
+	memcpy(sec_firmware_addr, buf, firmware_size);
+	dma_flush_range(sec_firmware_addr, ppa_size);
+
+	ret = ppa_entry(sec_firmware_addr, boot_loc_ptr_l, boot_loc_ptr_h);
+	if (ret) {
+		pr_err("Couldn't install PPA firmware: %s\n", strerror(-ret));
+		goto err;
+	}
+
+	pr_info("PPA firmware installed at 0x%p, now in EL%d\n",
+		sec_firmware_addr, current_el());
+
+	of_register_fixup(of_psci_do_fixup, NULL);
+err:
+	fit_close(fit);
+
+	return 0;
+}
+
+int ls1046a_ppa_init(resource_size_t ppa_start, resource_size_t ppa_size)
+{
+	resource_size_t ppa_end = ppa_start + ppa_size - 1;
+	struct resource *res;
+	void *ppa_fw;
+	size_t ppa_fw_size;
+	int ret;
+
+	res = request_sdram_region("ppa", ppa_start, ppa_size);
+	if (!res) {
+		pr_err("Cannot request SDRAM region %pa - %pa\n",
+		       &ppa_start, &ppa_end);
+		return -EINVAL;
+	}
+
+	get_builtin_firmware(ppa_ls1046a_bin, &ppa_fw, &ppa_fw_size);
+
+	ret = ppa_init(ppa_fw, ppa_fw_size, (void *)ppa_start);
+	if (ret)
+		return ret;
+
+	of_add_reserve_entry(ppa_start, ppa_end);
+
+	return 0;
+}