diff --git a/drivers/power/reset/Kconfig b/drivers/power/reset/Kconfig index 4b563db3ab3ec0..11a626d5efee42 100644 --- a/drivers/power/reset/Kconfig +++ b/drivers/power/reset/Kconfig @@ -9,6 +9,13 @@ menuconfig POWER_RESET if POWER_RESET +config POWER_RESET_ODROID + bool "odroid reboot/power-off driver" + depends on ARCH_MESON + help + This driver supports restart / power off board for amlogic + g12a/g12b/sm1 SoCs + config POWER_RESET_AS3722 bool "ams AS3722 power-off driver" depends on MFD_AS3722 diff --git a/drivers/power/reset/Makefile b/drivers/power/reset/Makefile index f606a2f6053958..9d3afae8e18292 100644 --- a/drivers/power/reset/Makefile +++ b/drivers/power/reset/Makefile @@ -1,4 +1,5 @@ # SPDX-License-Identifier: GPL-2.0 +obj-$(CONFIG_POWER_RESET_ODROID) += odroid-reboot.o obj-$(CONFIG_POWER_RESET_AS3722) += as3722-poweroff.o obj-$(CONFIG_POWER_RESET_AT91_POWEROFF) += at91-poweroff.o obj-$(CONFIG_POWER_RESET_AT91_RESET) += at91-reset.o diff --git a/drivers/power/reset/odroid-reboot.c b/drivers/power/reset/odroid-reboot.c new file mode 100644 index 00000000000000..68092141fbbbb5 --- /dev/null +++ b/drivers/power/reset/odroid-reboot.c @@ -0,0 +1,181 @@ +/* + * drivers/power/reset/odroid-reboot.c + * + * Copyright (C) 2017 Amlogic, Inc. All rights reserved. + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License as published by + * the Free Software Foundation; either version 2 of the License, or + * (at your option) any later version. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include + +#include +#include +#include + +#include +#include + +int sd_vqsw; +int sd_vmmc; +int sd_vqen; + +static u32 psci_function_id_restart; +static u32 psci_function_id_poweroff; + +#define CHECK_RET(ret) { \ + if (ret) \ + pr_err("[%s] gpio op failed(%d) at line %d\n",\ + __func__, ret, __LINE__); \ +} + +static noinline int __invoke_psci_fn_smc(u64 function_id, u64 arg0, u64 arg1, + u64 arg2) +{ + struct arm_smccc_res res; + + arm_smccc_smc((unsigned long)function_id, + (unsigned long)arg0, + (unsigned long)arg1, + (unsigned long)arg2, + 0, 0, 0, 0, &res); + return res.a0; +} + +void odroid_card_reset(void) +{ + int ret = 0; + + if ((sd_vqsw == 0) && (sd_vmmc == 0)) + return; + + if (sd_vqen == 0) { + gpio_free(sd_vqsw); + gpio_free(sd_vmmc); + ret = gpio_request_one(sd_vqsw, + GPIOF_OUT_INIT_LOW, "REBOOT"); + CHECK_RET(ret); + mdelay(10); + ret = gpio_direction_output(sd_vqsw, 1); + CHECK_RET(ret); + ret = gpio_request_one(sd_vmmc, + GPIOF_OUT_INIT_LOW, "REBOOT"); + CHECK_RET(ret); + mdelay(10); + ret = gpio_direction_output(sd_vqsw, 0); + CHECK_RET(ret); + ret = gpio_direction_output(sd_vmmc, 1); + CHECK_RET(ret); + mdelay(5); + gpio_free(sd_vqsw); + gpio_free(sd_vmmc); + } else { + gpio_free(sd_vqsw); + gpio_free(sd_vqen); + gpio_free(sd_vmmc); + + ret = gpio_request_one(sd_vqsw, + GPIOF_OUT_INIT_LOW, "REBOOT"); + CHECK_RET(ret); + ret = gpio_request_one(sd_vqen, + GPIOF_OUT_INIT_LOW, "REBOOT"); + CHECK_RET(ret); + ret = gpio_request_one(sd_vmmc, + GPIOF_OUT_INIT_LOW, "REBOOT"); + CHECK_RET(ret); + mdelay(100); + ret = gpio_direction_input(sd_vqen); + CHECK_RET(ret); + ret = gpio_direction_input(sd_vmmc); + CHECK_RET(ret); + ret = gpio_direction_input(sd_vqsw); + CHECK_RET(ret); + mdelay(5); + gpio_free(sd_vqen); + gpio_free(sd_vmmc); + gpio_free(sd_vqsw); + } +} + +static void do_odroid_restart(enum reboot_mode reboot_mode, const char *cmd) +{ + odroid_card_reset(); + __invoke_psci_fn_smc(psci_function_id_restart, + 0, 0, 0); +} + +static void do_odroid_poweroff(void) +{ + odroid_card_reset(); + + __invoke_psci_fn_smc(0x82000042, 1, 0, 0); + __invoke_psci_fn_smc(psci_function_id_poweroff, + 0, 0, 0); +} + +static int odroid_restart_probe(struct platform_device *pdev) +{ + struct device_node *of_node; + u32 id; + + if (!of_property_read_u32(pdev->dev.of_node, "sys_reset", &id)) { + psci_function_id_restart = id; + arm_pm_restart = do_odroid_restart; + } + + if (!of_property_read_u32(pdev->dev.of_node, "sys_poweroff", &id)) { + psci_function_id_poweroff = id; + pm_power_off = do_odroid_poweroff; + } + + of_node = pdev->dev.of_node; + + sd_vqsw = of_get_named_gpio(of_node, "sd-vqsw", 0); + if (!gpio_is_valid(sd_vqsw)) sd_vqsw = 0; + + sd_vmmc = of_get_named_gpio(of_node, "sd-vmmc", 0); + if (!gpio_is_valid(sd_vmmc)) sd_vmmc = 0; + + sd_vqen = of_get_named_gpio(of_node, "sd-vqen", 0); + if (!gpio_is_valid(sd_vqen)) sd_vqen = 0; + + return 0; +} + +static const struct of_device_id of_odroid_restart_match[] = { + { .compatible = "odroid,reboot", }, + {}, +}; +MODULE_DEVICE_TABLE(of, of_odroid_restart_match); + +static struct platform_driver odroid_restart_driver = { + .probe = odroid_restart_probe, + .driver = { + .name = "odroid-restart", + .of_match_table = of_match_ptr(of_odroid_restart_match), + }, +}; + +static int __init odroid_restart_init(void) +{ + return platform_driver_register(&odroid_restart_driver); +} +device_initcall(odroid_restart_init);