Orange Pi5 kernel

Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards

3 Commits   0 Branches   0 Tags
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   1) // SPDX-License-Identifier: GPL-2.0-or-later
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   3)  * QNAP Turbo NAS Board power off. Can also be used on Synology devices.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   4)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   5)  * Copyright (C) 2012 Andrew Lunn <andrew@lunn.ch>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   6)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   7)  * Based on the code from:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   8)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   9)  * Copyright (C) 2009  Martin Michlmayr <tbm@cyrius.com>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  10)  * Copyright (C) 2008  Byron Bradley <byron.bbradley@gmail.com>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  11)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  12) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  13) #include <linux/kernel.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  14) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  15) #include <linux/platform_device.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  16) #include <linux/serial_reg.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  17) #include <linux/kallsyms.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  18) #include <linux/of.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  19) #include <linux/io.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  20) #include <linux/clk.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  21) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  22) #define UART1_REG(x)	(base + ((UART_##x) << 2))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  23) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  24) struct power_off_cfg {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  25) 	u32 baud;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  26) 	char cmd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  27) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  28) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  29) static const struct power_off_cfg qnap_power_off_cfg = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  30) 	.baud = 19200,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  31) 	.cmd = 'A',
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  32) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  33) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  34) static const struct power_off_cfg synology_power_off_cfg = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  35) 	.baud = 9600,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  36) 	.cmd = '1',
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  37) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  38) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  39) static const struct of_device_id qnap_power_off_of_match_table[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  40) 	{ .compatible = "qnap,power-off",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  41) 	  .data = &qnap_power_off_cfg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  42) 	},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  43) 	{ .compatible = "synology,power-off",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  44) 	  .data = &synology_power_off_cfg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  45) 	},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  46) 	{}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  47) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  48) MODULE_DEVICE_TABLE(of, qnap_power_off_of_match_table);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  49) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  50) static void __iomem *base;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  51) static unsigned long tclk;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  52) static const struct power_off_cfg *cfg;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  53) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  54) static void qnap_power_off(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  55) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  56) 	const unsigned divisor = ((tclk + (8 * cfg->baud)) / (16 * cfg->baud));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  57) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  58) 	pr_err("%s: triggering power-off...\n", __func__);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  59) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  60) 	/* hijack UART1 and reset into sane state */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  61) 	writel(0x83, UART1_REG(LCR));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  62) 	writel(divisor & 0xff, UART1_REG(DLL));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  63) 	writel((divisor >> 8) & 0xff, UART1_REG(DLM));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  64) 	writel(0x03, UART1_REG(LCR));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  65) 	writel(0x00, UART1_REG(IER));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  66) 	writel(0x00, UART1_REG(FCR));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  67) 	writel(0x00, UART1_REG(MCR));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  68) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  69) 	/* send the power-off command to PIC */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  70) 	writel(cfg->cmd, UART1_REG(TX));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  71) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  72) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  73) static int qnap_power_off_probe(struct platform_device *pdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  74) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  75) 	struct device_node *np = pdev->dev.of_node;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  76) 	struct resource *res;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  77) 	struct clk *clk;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  78) 	char symname[KSYM_NAME_LEN];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  79) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  80) 	const struct of_device_id *match =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  81) 		of_match_node(qnap_power_off_of_match_table, np);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  82) 	cfg = match->data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  83) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  84) 	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  85) 	if (!res) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  86) 		dev_err(&pdev->dev, "Missing resource");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  87) 		return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  88) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  89) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  90) 	base = devm_ioremap(&pdev->dev, res->start, resource_size(res));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  91) 	if (!base) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  92) 		dev_err(&pdev->dev, "Unable to map resource");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  93) 		return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  94) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  95) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  96) 	/* We need to know tclk in order to calculate the UART divisor */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  97) 	clk = devm_clk_get(&pdev->dev, NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  98) 	if (IS_ERR(clk)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  99) 		dev_err(&pdev->dev, "Clk missing");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) 		return PTR_ERR(clk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) 	tclk = clk_get_rate(clk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) 	/* Check that nothing else has already setup a handler */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) 	if (pm_power_off) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) 		lookup_symbol_name((ulong)pm_power_off, symname);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) 		dev_err(&pdev->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) 			"pm_power_off already claimed %p %s",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) 			pm_power_off, symname);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) 		return -EBUSY;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) 	pm_power_off = qnap_power_off;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) static int qnap_power_off_remove(struct platform_device *pdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) 	pm_power_off = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) static struct platform_driver qnap_power_off_driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) 	.probe	= qnap_power_off_probe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) 	.remove	= qnap_power_off_remove,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) 	.driver	= {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) 		.name	= "qnap_power_off",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) 		.of_match_table = of_match_ptr(qnap_power_off_of_match_table),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) 	},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) module_platform_driver(qnap_power_off_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) MODULE_AUTHOR("Andrew Lunn <andrew@lunn.ch>");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) MODULE_DESCRIPTION("QNAP Power off driver");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) MODULE_LICENSE("GPL v2");