^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) * Generic Syscon Reboot Driver
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) * Copyright (c) 2013, Applied Micro Circuits Corporation
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) * Author: Feng Kan <fkan@apm.com>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8) #include <linux/delay.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9) #include <linux/io.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) #include <linux/notifier.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) #include <linux/mfd/syscon.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) #include <linux/of_address.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) #include <linux/of_device.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) #include <linux/platform_device.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) #include <linux/reboot.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) #include <linux/regmap.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) struct syscon_reboot_context {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) struct regmap *map;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) u32 offset;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) u32 value;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) u32 mask;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) struct notifier_block restart_handler;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) static int syscon_restart_handle(struct notifier_block *this,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) unsigned long mode, void *cmd)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) struct syscon_reboot_context *ctx =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) container_of(this, struct syscon_reboot_context,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) restart_handler);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) /* Issue the reboot */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) regmap_update_bits(ctx->map, ctx->offset, ctx->mask, ctx->value);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) mdelay(1000);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) pr_emerg("Unable to restart system\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) return NOTIFY_DONE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) static int syscon_reboot_probe(struct platform_device *pdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) struct syscon_reboot_context *ctx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) struct device *dev = &pdev->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) int mask_err, value_err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) ctx = devm_kzalloc(&pdev->dev, sizeof(*ctx), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) if (!ctx)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) ctx->map = syscon_regmap_lookup_by_phandle(dev->of_node, "regmap");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) if (IS_ERR(ctx->map)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) ctx->map = syscon_node_to_regmap(dev->parent->of_node);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) if (IS_ERR(ctx->map))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) return PTR_ERR(ctx->map);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) if (of_property_read_u32(pdev->dev.of_node, "offset", &ctx->offset))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) value_err = of_property_read_u32(pdev->dev.of_node, "value", &ctx->value);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) mask_err = of_property_read_u32(pdev->dev.of_node, "mask", &ctx->mask);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) if (value_err && mask_err) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) dev_err(dev, "unable to read 'value' and 'mask'");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) if (value_err) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) /* support old binding */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) ctx->value = ctx->mask;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) ctx->mask = 0xFFFFFFFF;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) } else if (mask_err) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) /* support value without mask*/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) ctx->mask = 0xFFFFFFFF;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) ctx->restart_handler.notifier_call = syscon_restart_handle;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) ctx->restart_handler.priority = 192;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) err = register_restart_handler(&ctx->restart_handler);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) if (err)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) dev_err(dev, "can't register restart notifier (err=%d)\n", err);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) static const struct of_device_id syscon_reboot_of_match[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) { .compatible = "syscon-reboot" },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) {}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) static struct platform_driver syscon_reboot_driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) .probe = syscon_reboot_probe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) .driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96) .name = "syscon-reboot",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97) .of_match_table = syscon_reboot_of_match,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) builtin_platform_driver(syscon_reboot_driver);
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags