You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
361 lines
12 KiB
361 lines
12 KiB
From a25a9d99959c6508d26d5d48794334b11326bb4c Mon Sep 17 00:00:00 2001
|
|
From: Alexander Aring <alex.aring@gmail.com>
|
|
Date: Wed, 16 Dec 2015 16:26:47 -0800
|
|
Subject: [PATCH] ARM: bcm2835: add rpi power domain driver
|
|
|
|
This patch adds support for several power domains on Raspberry Pi,
|
|
including USB (so it can be enabled even if the bootloader didn't do
|
|
it), and graphics.
|
|
|
|
This patch is the combined work of Eric Anholt (who wrote USB support
|
|
inside of the Raspberry Pi firmware driver, and wrote the non-USB
|
|
domain support) and Alexander Aring (who separated the original USB
|
|
work out from the firmware driver).
|
|
|
|
Signed-off-by: Alexander Aring <alex.aring@gmail.com>
|
|
Signed-off-by: Eric Anholt <eric@anholt.net>
|
|
Reviewed-by: Ulf Hansson <ulf.hansson@linaro.org>
|
|
Reviewed-by: Kevin Hilman <khilman@linaro.org>
|
|
(cherry picked from commit a09cd356586d33f64cbe64ee4f5c1a7c4a6abee5)
|
|
---
|
|
drivers/soc/Kconfig | 1 +
|
|
drivers/soc/Makefile | 1 +
|
|
drivers/soc/bcm/Kconfig | 9 +
|
|
drivers/soc/bcm/Makefile | 1 +
|
|
drivers/soc/bcm/raspberrypi-power.c | 247 ++++++++++++++++++++++++++
|
|
include/dt-bindings/power/raspberrypi-power.h | 41 +++++
|
|
6 files changed, 300 insertions(+)
|
|
create mode 100644 drivers/soc/bcm/Kconfig
|
|
create mode 100644 drivers/soc/bcm/Makefile
|
|
create mode 100644 drivers/soc/bcm/raspberrypi-power.c
|
|
create mode 100644 include/dt-bindings/power/raspberrypi-power.h
|
|
|
|
--- a/drivers/soc/Kconfig
|
|
+++ b/drivers/soc/Kconfig
|
|
@@ -1,5 +1,6 @@
|
|
menu "SOC (System On Chip) specific Drivers"
|
|
|
|
+source "drivers/soc/bcm/Kconfig"
|
|
source "drivers/soc/brcmstb/Kconfig"
|
|
source "drivers/soc/mediatek/Kconfig"
|
|
source "drivers/soc/qcom/Kconfig"
|
|
--- a/drivers/soc/Makefile
|
|
+++ b/drivers/soc/Makefile
|
|
@@ -2,6 +2,7 @@
|
|
# Makefile for the Linux Kernel SOC specific device drivers.
|
|
#
|
|
|
|
+obj-y += bcm/
|
|
obj-$(CONFIG_SOC_BRCMSTB) += brcmstb/
|
|
obj-$(CONFIG_MACH_DOVE) += dove/
|
|
obj-$(CONFIG_ARCH_MEDIATEK) += mediatek/
|
|
--- /dev/null
|
|
+++ b/drivers/soc/bcm/Kconfig
|
|
@@ -0,0 +1,9 @@
|
|
+config RASPBERRYPI_POWER
|
|
+ bool "Raspberry Pi power domain driver"
|
|
+ depends on ARCH_BCM2835 || COMPILE_TEST
|
|
+ depends on RASPBERRYPI_FIRMWARE
|
|
+ select PM_GENERIC_DOMAINS if PM
|
|
+ select PM_GENERIC_DOMAINS_OF if PM
|
|
+ help
|
|
+ This enables support for the RPi power domains which can be enabled
|
|
+ or disabled via the RPi firmware.
|
|
--- /dev/null
|
|
+++ b/drivers/soc/bcm/Makefile
|
|
@@ -0,0 +1 @@
|
|
+obj-$(CONFIG_RASPBERRYPI_POWER) += raspberrypi-power.o
|
|
--- /dev/null
|
|
+++ b/drivers/soc/bcm/raspberrypi-power.c
|
|
@@ -0,0 +1,247 @@
|
|
+/* (C) 2015 Pengutronix, Alexander Aring <aar@pengutronix.de>
|
|
+ *
|
|
+ * This program is free software; you can redistribute it and/or modify
|
|
+ * it under the terms of the GNU General Public License version 2 as
|
|
+ * published by the Free Software Foundation.
|
|
+ *
|
|
+ * Authors:
|
|
+ * Alexander Aring <aar@pengutronix.de>
|
|
+ * Eric Anholt <eric@anholt.net>
|
|
+ */
|
|
+
|
|
+#include <linux/module.h>
|
|
+#include <linux/of_platform.h>
|
|
+#include <linux/platform_device.h>
|
|
+#include <linux/pm_domain.h>
|
|
+#include <dt-bindings/power/raspberrypi-power.h>
|
|
+#include <soc/bcm2835/raspberrypi-firmware.h>
|
|
+
|
|
+/*
|
|
+ * Firmware indices for the old power domains interface. Only a few
|
|
+ * of them were actually implemented.
|
|
+ */
|
|
+#define RPI_OLD_POWER_DOMAIN_USB 3
|
|
+#define RPI_OLD_POWER_DOMAIN_V3D 10
|
|
+
|
|
+struct rpi_power_domain {
|
|
+ u32 domain;
|
|
+ bool enabled;
|
|
+ bool old_interface;
|
|
+ struct generic_pm_domain base;
|
|
+ struct rpi_firmware *fw;
|
|
+};
|
|
+
|
|
+struct rpi_power_domains {
|
|
+ bool has_new_interface;
|
|
+ struct genpd_onecell_data xlate;
|
|
+ struct rpi_firmware *fw;
|
|
+ struct rpi_power_domain domains[RPI_POWER_DOMAIN_COUNT];
|
|
+};
|
|
+
|
|
+/*
|
|
+ * Packet definition used by RPI_FIRMWARE_SET_POWER_STATE and
|
|
+ * RPI_FIRMWARE_SET_DOMAIN_STATE
|
|
+ */
|
|
+struct rpi_power_domain_packet {
|
|
+ u32 domain;
|
|
+ u32 on;
|
|
+} __packet;
|
|
+
|
|
+/*
|
|
+ * Asks the firmware to enable or disable power on a specific power
|
|
+ * domain.
|
|
+ */
|
|
+static int rpi_firmware_set_power(struct rpi_power_domain *rpi_domain, bool on)
|
|
+{
|
|
+ struct rpi_power_domain_packet packet;
|
|
+
|
|
+ packet.domain = rpi_domain->domain;
|
|
+ packet.on = on;
|
|
+ return rpi_firmware_property(rpi_domain->fw,
|
|
+ rpi_domain->old_interface ?
|
|
+ RPI_FIRMWARE_SET_POWER_STATE :
|
|
+ RPI_FIRMWARE_SET_DOMAIN_STATE,
|
|
+ &packet, sizeof(packet));
|
|
+}
|
|
+
|
|
+static int rpi_domain_off(struct generic_pm_domain *domain)
|
|
+{
|
|
+ struct rpi_power_domain *rpi_domain =
|
|
+ container_of(domain, struct rpi_power_domain, base);
|
|
+
|
|
+ return rpi_firmware_set_power(rpi_domain, false);
|
|
+}
|
|
+
|
|
+static int rpi_domain_on(struct generic_pm_domain *domain)
|
|
+{
|
|
+ struct rpi_power_domain *rpi_domain =
|
|
+ container_of(domain, struct rpi_power_domain, base);
|
|
+
|
|
+ return rpi_firmware_set_power(rpi_domain, true);
|
|
+}
|
|
+
|
|
+static void rpi_common_init_power_domain(struct rpi_power_domains *rpi_domains,
|
|
+ int xlate_index, const char *name)
|
|
+{
|
|
+ struct rpi_power_domain *dom = &rpi_domains->domains[xlate_index];
|
|
+
|
|
+ dom->fw = rpi_domains->fw;
|
|
+
|
|
+ dom->base.name = name;
|
|
+ dom->base.power_on = rpi_domain_on;
|
|
+ dom->base.power_off = rpi_domain_off;
|
|
+
|
|
+ /*
|
|
+ * Treat all power domains as off at boot.
|
|
+ *
|
|
+ * The firmware itself may be keeping some domains on, but
|
|
+ * from Linux's perspective all we control is the refcounts
|
|
+ * that we give to the firmware, and we can't ask the firmware
|
|
+ * to turn off something that we haven't ourselves turned on.
|
|
+ */
|
|
+ pm_genpd_init(&dom->base, NULL, true);
|
|
+
|
|
+ rpi_domains->xlate.domains[xlate_index] = &dom->base;
|
|
+}
|
|
+
|
|
+static void rpi_init_power_domain(struct rpi_power_domains *rpi_domains,
|
|
+ int xlate_index, const char *name)
|
|
+{
|
|
+ struct rpi_power_domain *dom = &rpi_domains->domains[xlate_index];
|
|
+
|
|
+ if (!rpi_domains->has_new_interface)
|
|
+ return;
|
|
+
|
|
+ /* The DT binding index is the firmware's domain index minus one. */
|
|
+ dom->domain = xlate_index + 1;
|
|
+
|
|
+ rpi_common_init_power_domain(rpi_domains, xlate_index, name);
|
|
+}
|
|
+
|
|
+static void rpi_init_old_power_domain(struct rpi_power_domains *rpi_domains,
|
|
+ int xlate_index, int domain,
|
|
+ const char *name)
|
|
+{
|
|
+ struct rpi_power_domain *dom = &rpi_domains->domains[xlate_index];
|
|
+
|
|
+ dom->old_interface = true;
|
|
+ dom->domain = domain;
|
|
+
|
|
+ rpi_common_init_power_domain(rpi_domains, xlate_index, name);
|
|
+}
|
|
+
|
|
+/*
|
|
+ * Detects whether the firmware supports the new power domains interface.
|
|
+ *
|
|
+ * The firmware doesn't actually return an error on an unknown tag,
|
|
+ * and just skips over it, so we do the detection by putting an
|
|
+ * unexpected value in the return field and checking if it was
|
|
+ * unchanged.
|
|
+ */
|
|
+static bool
|
|
+rpi_has_new_domain_support(struct rpi_power_domains *rpi_domains)
|
|
+{
|
|
+ struct rpi_power_domain_packet packet;
|
|
+ int ret;
|
|
+
|
|
+ packet.domain = RPI_POWER_DOMAIN_ARM;
|
|
+ packet.on = ~0;
|
|
+
|
|
+ ret = rpi_firmware_property(rpi_domains->fw,
|
|
+ RPI_FIRMWARE_GET_DOMAIN_STATE,
|
|
+ &packet, sizeof(packet));
|
|
+
|
|
+ return ret == 0 && packet.on != ~0;
|
|
+}
|
|
+
|
|
+static int rpi_power_probe(struct platform_device *pdev)
|
|
+{
|
|
+ struct device_node *fw_np;
|
|
+ struct device *dev = &pdev->dev;
|
|
+ struct rpi_power_domains *rpi_domains;
|
|
+
|
|
+ rpi_domains = devm_kzalloc(dev, sizeof(*rpi_domains), GFP_KERNEL);
|
|
+ if (!rpi_domains)
|
|
+ return -ENOMEM;
|
|
+
|
|
+ rpi_domains->xlate.domains =
|
|
+ devm_kzalloc(dev, sizeof(*rpi_domains->xlate.domains) *
|
|
+ RPI_POWER_DOMAIN_COUNT, GFP_KERNEL);
|
|
+ if (!rpi_domains->xlate.domains)
|
|
+ return -ENOMEM;
|
|
+
|
|
+ rpi_domains->xlate.num_domains = RPI_POWER_DOMAIN_COUNT;
|
|
+
|
|
+ fw_np = of_parse_phandle(pdev->dev.of_node, "firmware", 0);
|
|
+ if (!fw_np) {
|
|
+ dev_err(&pdev->dev, "no firmware node\n");
|
|
+ return -ENODEV;
|
|
+ }
|
|
+
|
|
+ rpi_domains->fw = rpi_firmware_get(fw_np);
|
|
+ of_node_put(fw_np);
|
|
+ if (!rpi_domains->fw)
|
|
+ return -EPROBE_DEFER;
|
|
+
|
|
+ rpi_domains->has_new_interface =
|
|
+ rpi_has_new_domain_support(rpi_domains);
|
|
+
|
|
+ rpi_init_power_domain(rpi_domains, RPI_POWER_DOMAIN_I2C0, "I2C0");
|
|
+ rpi_init_power_domain(rpi_domains, RPI_POWER_DOMAIN_I2C1, "I2C1");
|
|
+ rpi_init_power_domain(rpi_domains, RPI_POWER_DOMAIN_I2C2, "I2C2");
|
|
+ rpi_init_power_domain(rpi_domains, RPI_POWER_DOMAIN_VIDEO_SCALER,
|
|
+ "VIDEO_SCALER");
|
|
+ rpi_init_power_domain(rpi_domains, RPI_POWER_DOMAIN_VPU1, "VPU1");
|
|
+ rpi_init_power_domain(rpi_domains, RPI_POWER_DOMAIN_HDMI, "HDMI");
|
|
+
|
|
+ /*
|
|
+ * Use the old firmware interface for USB power, so that we
|
|
+ * can turn it on even if the firmware hasn't been updated.
|
|
+ */
|
|
+ rpi_init_old_power_domain(rpi_domains, RPI_POWER_DOMAIN_USB,
|
|
+ RPI_OLD_POWER_DOMAIN_USB, "USB");
|
|
+
|
|
+ rpi_init_power_domain(rpi_domains, RPI_POWER_DOMAIN_VEC, "VEC");
|
|
+ rpi_init_power_domain(rpi_domains, RPI_POWER_DOMAIN_JPEG, "JPEG");
|
|
+ rpi_init_power_domain(rpi_domains, RPI_POWER_DOMAIN_H264, "H264");
|
|
+ rpi_init_power_domain(rpi_domains, RPI_POWER_DOMAIN_V3D, "V3D");
|
|
+ rpi_init_power_domain(rpi_domains, RPI_POWER_DOMAIN_ISP, "ISP");
|
|
+ rpi_init_power_domain(rpi_domains, RPI_POWER_DOMAIN_UNICAM0, "UNICAM0");
|
|
+ rpi_init_power_domain(rpi_domains, RPI_POWER_DOMAIN_UNICAM1, "UNICAM1");
|
|
+ rpi_init_power_domain(rpi_domains, RPI_POWER_DOMAIN_CCP2RX, "CCP2RX");
|
|
+ rpi_init_power_domain(rpi_domains, RPI_POWER_DOMAIN_CSI2, "CSI2");
|
|
+ rpi_init_power_domain(rpi_domains, RPI_POWER_DOMAIN_CPI, "CPI");
|
|
+ rpi_init_power_domain(rpi_domains, RPI_POWER_DOMAIN_DSI0, "DSI0");
|
|
+ rpi_init_power_domain(rpi_domains, RPI_POWER_DOMAIN_DSI1, "DSI1");
|
|
+ rpi_init_power_domain(rpi_domains, RPI_POWER_DOMAIN_TRANSPOSER,
|
|
+ "TRANSPOSER");
|
|
+ rpi_init_power_domain(rpi_domains, RPI_POWER_DOMAIN_CCP2TX, "CCP2TX");
|
|
+ rpi_init_power_domain(rpi_domains, RPI_POWER_DOMAIN_CDP, "CDP");
|
|
+ rpi_init_power_domain(rpi_domains, RPI_POWER_DOMAIN_ARM, "ARM");
|
|
+
|
|
+ of_genpd_add_provider_onecell(dev->of_node, &rpi_domains->xlate);
|
|
+
|
|
+ platform_set_drvdata(pdev, rpi_domains);
|
|
+
|
|
+ return 0;
|
|
+}
|
|
+
|
|
+static const struct of_device_id rpi_power_of_match[] = {
|
|
+ { .compatible = "raspberrypi,bcm2835-power", },
|
|
+ {},
|
|
+};
|
|
+MODULE_DEVICE_TABLE(of, rpi_power_of_match);
|
|
+
|
|
+static struct platform_driver rpi_power_driver = {
|
|
+ .driver = {
|
|
+ .name = "raspberrypi-power",
|
|
+ .of_match_table = rpi_power_of_match,
|
|
+ },
|
|
+ .probe = rpi_power_probe,
|
|
+};
|
|
+builtin_platform_driver(rpi_power_driver);
|
|
+
|
|
+MODULE_AUTHOR("Alexander Aring <aar@pengutronix.de>");
|
|
+MODULE_AUTHOR("Eric Anholt <eric@anholt.net>");
|
|
+MODULE_DESCRIPTION("Raspberry Pi power domain driver");
|
|
+MODULE_LICENSE("GPL v2");
|
|
--- /dev/null
|
|
+++ b/include/dt-bindings/power/raspberrypi-power.h
|
|
@@ -0,0 +1,41 @@
|
|
+/*
|
|
+ * Copyright © 2015 Broadcom
|
|
+ *
|
|
+ * This program is free software; you can redistribute it and/or modify
|
|
+ * it under the terms of the GNU General Public License version 2 as
|
|
+ * published by the Free Software Foundation.
|
|
+ */
|
|
+
|
|
+#ifndef _DT_BINDINGS_ARM_BCM2835_RPI_POWER_H
|
|
+#define _DT_BINDINGS_ARM_BCM2835_RPI_POWER_H
|
|
+
|
|
+/* These power domain indices are the firmware interface's indices
|
|
+ * minus one.
|
|
+ */
|
|
+#define RPI_POWER_DOMAIN_I2C0 0
|
|
+#define RPI_POWER_DOMAIN_I2C1 1
|
|
+#define RPI_POWER_DOMAIN_I2C2 2
|
|
+#define RPI_POWER_DOMAIN_VIDEO_SCALER 3
|
|
+#define RPI_POWER_DOMAIN_VPU1 4
|
|
+#define RPI_POWER_DOMAIN_HDMI 5
|
|
+#define RPI_POWER_DOMAIN_USB 6
|
|
+#define RPI_POWER_DOMAIN_VEC 7
|
|
+#define RPI_POWER_DOMAIN_JPEG 8
|
|
+#define RPI_POWER_DOMAIN_H264 9
|
|
+#define RPI_POWER_DOMAIN_V3D 10
|
|
+#define RPI_POWER_DOMAIN_ISP 11
|
|
+#define RPI_POWER_DOMAIN_UNICAM0 12
|
|
+#define RPI_POWER_DOMAIN_UNICAM1 13
|
|
+#define RPI_POWER_DOMAIN_CCP2RX 14
|
|
+#define RPI_POWER_DOMAIN_CSI2 15
|
|
+#define RPI_POWER_DOMAIN_CPI 16
|
|
+#define RPI_POWER_DOMAIN_DSI0 17
|
|
+#define RPI_POWER_DOMAIN_DSI1 18
|
|
+#define RPI_POWER_DOMAIN_TRANSPOSER 19
|
|
+#define RPI_POWER_DOMAIN_CCP2TX 20
|
|
+#define RPI_POWER_DOMAIN_CDP 21
|
|
+#define RPI_POWER_DOMAIN_ARM 22
|
|
+
|
|
+#define RPI_POWER_DOMAIN_COUNT 23
|
|
+
|
|
+#endif /* _DT_BINDINGS_ARM_BCM2835_RPI_POWER_H */
|
|
|