drm/panfrost: add init stubs for ip blocks

Signed-off-by: Marty E. Plummer <hanetzer@startmail.com>

drivers/gpu/drm/panfrost/Makefile

 panfrost-y := \
 	panfrost_drv.o \
-	panfrost_device.o
+	panfrost_device.o \
+	panfrost_gpu.o \
+	panfrost_job.o \
+	panfrost_mmu.o
 
 obj-$(CONFIG_DRM_PANFROST) += panfrost.o

drivers/gpu/drm/panfrost/panfrost_device.c

 // SPDX-License-Identifier:	GPL-2.0
 /* Copyright 2018 Panfrost Team */
 
+#include <linux/clk.h>
+#include <linux/regulator/consumer.h>
+
 #include "panfrost_device.h"
 
+struct panfrost_ip_desc {
+	char *name;
+	char *irq_name;
+	int offset;
+	int (*init)(struct panfrost_ip *);
+	void (*fini)(struct panfrost_ip *);
+};
+
+#define PANFROST_IP_DESC(ipname, off, func, irq) \
+	[panfrost_ip_##ipname] = { \
+		.name = #ipname, \
+		.irq_name = irq, \
+		.offset = off, \
+		.init = panfrost_##func##_init, \
+		.fini = panfrost_##func##_fini, \
+	}
+
+static struct panfrost_ip_desc panfrost_ip_desc[panfrost_ip_num] = {
+	/* PANFROST_IP_DESC(ipname, off, func, irq) */
+	PANFROST_IP_DESC(gpu, 0x0000, gpu, "gpu"),
+	PANFROST_IP_DESC(job, 0x1000, job, "job"),
+	PANFROST_IP_DESC(mmu, 0x2000, mmu, "mmu"),
+};
+
+const char *panfrost_ip_name(struct panfrost_ip *ip)
+{
+	return panfrost_ip_desc[ip->id].name;
+}
+
+static int panfrost_clk_init(struct panfrost_device *pfdev)
+{
+	int err;
+	unsigned long rate;
+
+	pfdev->clock = devm_clk_get(pfdev->dev, NULL);
+	if (IS_ERR(pfdev->clock)) {
+		dev_err(pfdev->dev, "get clock failed %ld\n", PTR_ERR(pfdev->clock));
+		return PTR_ERR(pfdev->clock);
+	}
+
+	rate = clk_get_rate(pfdev->clock);
+	dev_info(pfdev->dev, "clock rate = %lu\n", rate);
+
+	if ((err = clk_prepare_enable(pfdev->clock)))
+		return err;
+
+	return 0;
+}
+
+static void panfrost_clk_fini(struct panfrost_device *pfdev)
+{
+	clk_disable_unprepare(pfdev->clock);
+}
+
+static int panfrost_regulator_init(struct panfrost_device *pfdev)
+{
+	int ret;
+	pfdev->regulator = devm_regulator_get_optional(pfdev->dev, "mali");
+	if (IS_ERR(pfdev->regulator)) {
+		ret = PTR_ERR(pfdev->regulator);
+		pfdev->regulator = NULL;
+		if (ret == -ENODEV)
+			return 0;
+		dev_err(pfdev->dev, "failed to get regulator: %ld\n", PTR_ERR(pfdev->regulator));
+		return ret;
+	}
+
+	ret = regulator_enable(pfdev->regulator);
+	if (ret < 0) {
+		dev_err(pfdev->dev, "failed to enable regulator: %d\n", ret);
+		return ret;
+	}
+
+	return 0;
+}
+
+static void panfrost_regulator_fini(struct panfrost_device *pfdev)
+{
+	if (pfdev->regulator)
+		regulator_disable(pfdev->regulator);
+}
+
+static int panfrost_init_ip(struct panfrost_device *pfdev, int index)
+{
+	struct panfrost_ip_desc *desc = panfrost_ip_desc + index;
+	struct panfrost_ip *ip = pfdev->ip + index;
+	int offset = desc->offset;
+	int err;
+
+	if (offset < 0)
+		return 0;
+
+	ip->pfdev = pfdev;
+	ip->id = index;
+	ip->iomem = pfdev->iomem + offset;
+	if (desc->irq_name) {
+		err = platform_get_irq_byname(pfdev->pdev, desc->irq_name);
+		if (err < 0)
+			return err;
+		ip->irq = err;
+	}
+
+	err = desc->init(ip);
+	if (!err) {
+		ip->present = true;
+		return 0;
+	}
+
+	return err;
+}
+
+static void panfrost_fini_ip(struct panfrost_device *pfdev, int index)
+{
+	struct panfrost_ip_desc *desc = panfrost_ip_desc + index;
+	struct panfrost_ip *ip = pfdev->ip + index;
+
+	if (ip->present)
+		desc->fini(ip);
+}
+
 int panfrost_device_init(struct panfrost_device *pfdev)
 {
-	pfdev->id = panfrost_gpu_malit760;
+	int err, i;
+	struct resource *res;
+
+	err = panfrost_clk_init(pfdev);
+	if (err) {
+		dev_err(pfdev->dev, "clk init failed %d\n", err);
+		return err;
+	}
+
+	if ((err = panfrost_regulator_init(pfdev))) {
+		dev_err(pfdev->dev, "regulator init failed %d\n", err);
+		goto err_out0;
+	}
+
+	res = platform_get_resource(pfdev->pdev, IORESOURCE_MEM, 0);
+	pfdev->iomem = devm_ioremap_resource(pfdev->dev, res);
+	if (IS_ERR(pfdev->iomem)) {
+		dev_err(pfdev->dev, "failed to ioremap iomem\n");
+		err = PTR_ERR(pfdev->iomem);
+		goto err_out1;
+	}
+
+	for (i = 0; i < panfrost_ip_num; i++) {
+		err = panfrost_init_ip(pfdev, i);
+		if (err)
+			goto err_out2;
+	}
 
 	return 0;
+err_out2:
+	while (--i >= 0)
+		panfrost_fini_ip(pfdev, i);
+err_out1:
+	panfrost_regulator_fini(pfdev);
+err_out0:
+	panfrost_clk_fini(pfdev);
+	return err;
 }
 
 void panfrost_device_fini(struct panfrost_device *pfdev)
 {
+	int i;
+
+	for (i = panfrost_ip_num -1; i >= 0; i--)
+		panfrost_fini_ip(pfdev, i);
+
+	panfrost_regulator_fini(pfdev);
 
+	panfrost_clk_fini(pfdev);
 }

drivers/gpu/drm/panfrost/panfrost_device.h

@@ -4,6 +4,7 @@
 #ifndef __PANFROST_DEVICE_H__
 #define __PANFROST_DEVICE_H__
 
+#include <drm/drm_device.h>
 #include <drm/drmP.h>
 
 enum panfrost_gpu_id {
@@ -11,15 +12,48 @@ enum panfrost_gpu_id {
 	panfrost_gpu_num,
 };
 
+enum panfrost_ip_id {
+	panfrost_ip_gpu,
+	panfrost_ip_job,
+	panfrost_ip_mmu,
+	panfrost_ip_num,
+};
+
+struct panfrost_device;
+
+struct panfrost_ip {
+	struct panfrost_device *pfdev;
+	enum panfrost_ip_id id;
+	bool present;
+
+	void __iomem *iomem;
+	int irq;
+};
+
 struct panfrost_device {
 	struct device *dev;
 	struct drm_device *ddev;
 	struct platform_device *pdev;
 
 	enum panfrost_gpu_id id;
+
+	void __iomem *iomem;
+	struct clk *clock;
+	struct regulator *regulator;
+
+	struct panfrost_ip ip[panfrost_ip_num];
 };
 
 int panfrost_device_init(struct panfrost_device *pfdev);
 void panfrost_device_fini(struct panfrost_device *pfdev);
 
+int panfrost_gpu_init(struct panfrost_ip *ip);
+void panfrost_gpu_fini(struct panfrost_ip *ip);
+
+int panfrost_job_init(struct panfrost_ip *ip);
+void panfrost_job_fini(struct panfrost_ip *ip);
+
+int panfrost_mmu_init(struct panfrost_ip *ip);
+void panfrost_mmu_fini(struct panfrost_ip *ip);
+
 #endif

drivers/gpu/drm/panfrost/panfrost_gpu.c

+// SPDX-License-Identifier:	GPL-2.0
+/* Copyright 2018 Panfrost Team */
+
+#include "panfrost_device.h"
+
+int panfrost_gpu_init(struct panfrost_ip *ip)
+{
+	return 0;
+}
+
+void panfrost_gpu_fini(struct panfrost_ip *ip)
+{
+
+}

drivers/gpu/drm/panfrost/panfrost_job.c

+// SPDX-License-Identifier:	GPL-2.0
+/* Copyright 2018 Panfrost Team */
+
+#include "panfrost_device.h"
+
+int panfrost_job_init(struct panfrost_ip *ip)
+{
+	return 0;
+}
+
+void panfrost_job_fini(struct panfrost_ip *ip)
+{
+
+}

drivers/gpu/drm/panfrost/panfrost_mmu.c

+// SPDX-License-Identifier:	GPL-2.0
+/* Copyright 2018 Panfrost Team */
+
+#include "panfrost_device.h"
+
+int panfrost_mmu_init(struct panfrost_ip *ip)
+{
+	return 0;
+}
+
+void panfrost_mmu_fini(struct panfrost_ip *ip)
+{
+
+}