18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-or-later 28c2ecf20Sopenharmony_ci/* 38c2ecf20Sopenharmony_ci * Copyright (c) 2016, Fuzhou Rockchip Electronics Co., Ltd 48c2ecf20Sopenharmony_ci */ 58c2ecf20Sopenharmony_ci 68c2ecf20Sopenharmony_ci#include <linux/init.h> 78c2ecf20Sopenharmony_ci#include <linux/module.h> 88c2ecf20Sopenharmony_ci#include <linux/kernel.h> 98c2ecf20Sopenharmony_ci#include <linux/of.h> 108c2ecf20Sopenharmony_ci#include <linux/platform_device.h> 118c2ecf20Sopenharmony_ci#include <linux/reboot.h> 128c2ecf20Sopenharmony_ci#include <linux/regmap.h> 138c2ecf20Sopenharmony_ci#include <linux/mfd/syscon.h> 148c2ecf20Sopenharmony_ci#include <linux/reboot-mode.h> 158c2ecf20Sopenharmony_ci 168c2ecf20Sopenharmony_cistruct syscon_reboot_mode { 178c2ecf20Sopenharmony_ci struct regmap *map; 188c2ecf20Sopenharmony_ci struct reboot_mode_driver reboot; 198c2ecf20Sopenharmony_ci u32 offset; 208c2ecf20Sopenharmony_ci u32 mask; 218c2ecf20Sopenharmony_ci}; 228c2ecf20Sopenharmony_ci 238c2ecf20Sopenharmony_cistatic int syscon_reboot_mode_write(struct reboot_mode_driver *reboot, 248c2ecf20Sopenharmony_ci unsigned int magic) 258c2ecf20Sopenharmony_ci{ 268c2ecf20Sopenharmony_ci struct syscon_reboot_mode *syscon_rbm; 278c2ecf20Sopenharmony_ci int ret; 288c2ecf20Sopenharmony_ci 298c2ecf20Sopenharmony_ci syscon_rbm = container_of(reboot, struct syscon_reboot_mode, reboot); 308c2ecf20Sopenharmony_ci 318c2ecf20Sopenharmony_ci ret = regmap_update_bits(syscon_rbm->map, syscon_rbm->offset, 328c2ecf20Sopenharmony_ci syscon_rbm->mask, magic); 338c2ecf20Sopenharmony_ci if (ret < 0) 348c2ecf20Sopenharmony_ci dev_err(reboot->dev, "update reboot mode bits failed\n"); 358c2ecf20Sopenharmony_ci 368c2ecf20Sopenharmony_ci return ret; 378c2ecf20Sopenharmony_ci} 388c2ecf20Sopenharmony_ci 398c2ecf20Sopenharmony_cistatic int syscon_reboot_mode_probe(struct platform_device *pdev) 408c2ecf20Sopenharmony_ci{ 418c2ecf20Sopenharmony_ci int ret; 428c2ecf20Sopenharmony_ci struct syscon_reboot_mode *syscon_rbm; 438c2ecf20Sopenharmony_ci 448c2ecf20Sopenharmony_ci syscon_rbm = devm_kzalloc(&pdev->dev, sizeof(*syscon_rbm), GFP_KERNEL); 458c2ecf20Sopenharmony_ci if (!syscon_rbm) 468c2ecf20Sopenharmony_ci return -ENOMEM; 478c2ecf20Sopenharmony_ci 488c2ecf20Sopenharmony_ci syscon_rbm->reboot.dev = &pdev->dev; 498c2ecf20Sopenharmony_ci syscon_rbm->reboot.write = syscon_reboot_mode_write; 508c2ecf20Sopenharmony_ci syscon_rbm->mask = 0xffffffff; 518c2ecf20Sopenharmony_ci 528c2ecf20Sopenharmony_ci syscon_rbm->map = syscon_node_to_regmap(pdev->dev.parent->of_node); 538c2ecf20Sopenharmony_ci if (IS_ERR(syscon_rbm->map)) 548c2ecf20Sopenharmony_ci return PTR_ERR(syscon_rbm->map); 558c2ecf20Sopenharmony_ci 568c2ecf20Sopenharmony_ci if (of_property_read_u32(pdev->dev.of_node, "offset", 578c2ecf20Sopenharmony_ci &syscon_rbm->offset)) 588c2ecf20Sopenharmony_ci return -EINVAL; 598c2ecf20Sopenharmony_ci 608c2ecf20Sopenharmony_ci of_property_read_u32(pdev->dev.of_node, "mask", &syscon_rbm->mask); 618c2ecf20Sopenharmony_ci 628c2ecf20Sopenharmony_ci ret = devm_reboot_mode_register(&pdev->dev, &syscon_rbm->reboot); 638c2ecf20Sopenharmony_ci if (ret) 648c2ecf20Sopenharmony_ci dev_err(&pdev->dev, "can't register reboot mode\n"); 658c2ecf20Sopenharmony_ci 668c2ecf20Sopenharmony_ci return ret; 678c2ecf20Sopenharmony_ci} 688c2ecf20Sopenharmony_ci 698c2ecf20Sopenharmony_cistatic const struct of_device_id syscon_reboot_mode_of_match[] = { 708c2ecf20Sopenharmony_ci { .compatible = "syscon-reboot-mode" }, 718c2ecf20Sopenharmony_ci {} 728c2ecf20Sopenharmony_ci}; 738c2ecf20Sopenharmony_ciMODULE_DEVICE_TABLE(of, syscon_reboot_mode_of_match); 748c2ecf20Sopenharmony_ci 758c2ecf20Sopenharmony_cistatic struct platform_driver syscon_reboot_mode_driver = { 768c2ecf20Sopenharmony_ci .probe = syscon_reboot_mode_probe, 778c2ecf20Sopenharmony_ci .driver = { 788c2ecf20Sopenharmony_ci .name = "syscon-reboot-mode", 798c2ecf20Sopenharmony_ci .of_match_table = syscon_reboot_mode_of_match, 808c2ecf20Sopenharmony_ci }, 818c2ecf20Sopenharmony_ci}; 828c2ecf20Sopenharmony_cimodule_platform_driver(syscon_reboot_mode_driver); 838c2ecf20Sopenharmony_ci 848c2ecf20Sopenharmony_ciMODULE_AUTHOR("Andy Yan <andy.yan@rock-chips.com"); 858c2ecf20Sopenharmony_ciMODULE_DESCRIPTION("SYSCON reboot mode driver"); 868c2ecf20Sopenharmony_ciMODULE_LICENSE("GPL v2"); 87