162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-or-later 262306a36Sopenharmony_ci/* 362306a36Sopenharmony_ci * Copyright (c) 2016, Fuzhou Rockchip Electronics Co., Ltd 462306a36Sopenharmony_ci */ 562306a36Sopenharmony_ci 662306a36Sopenharmony_ci#include <linux/init.h> 762306a36Sopenharmony_ci#include <linux/module.h> 862306a36Sopenharmony_ci#include <linux/kernel.h> 962306a36Sopenharmony_ci#include <linux/of.h> 1062306a36Sopenharmony_ci#include <linux/platform_device.h> 1162306a36Sopenharmony_ci#include <linux/reboot.h> 1262306a36Sopenharmony_ci#include <linux/regmap.h> 1362306a36Sopenharmony_ci#include <linux/mfd/syscon.h> 1462306a36Sopenharmony_ci#include <linux/reboot-mode.h> 1562306a36Sopenharmony_ci 1662306a36Sopenharmony_cistruct syscon_reboot_mode { 1762306a36Sopenharmony_ci struct regmap *map; 1862306a36Sopenharmony_ci struct reboot_mode_driver reboot; 1962306a36Sopenharmony_ci u32 offset; 2062306a36Sopenharmony_ci u32 mask; 2162306a36Sopenharmony_ci}; 2262306a36Sopenharmony_ci 2362306a36Sopenharmony_cistatic int syscon_reboot_mode_write(struct reboot_mode_driver *reboot, 2462306a36Sopenharmony_ci unsigned int magic) 2562306a36Sopenharmony_ci{ 2662306a36Sopenharmony_ci struct syscon_reboot_mode *syscon_rbm; 2762306a36Sopenharmony_ci int ret; 2862306a36Sopenharmony_ci 2962306a36Sopenharmony_ci syscon_rbm = container_of(reboot, struct syscon_reboot_mode, reboot); 3062306a36Sopenharmony_ci 3162306a36Sopenharmony_ci ret = regmap_update_bits(syscon_rbm->map, syscon_rbm->offset, 3262306a36Sopenharmony_ci syscon_rbm->mask, magic); 3362306a36Sopenharmony_ci if (ret < 0) 3462306a36Sopenharmony_ci dev_err(reboot->dev, "update reboot mode bits failed\n"); 3562306a36Sopenharmony_ci 3662306a36Sopenharmony_ci return ret; 3762306a36Sopenharmony_ci} 3862306a36Sopenharmony_ci 3962306a36Sopenharmony_cistatic int syscon_reboot_mode_probe(struct platform_device *pdev) 4062306a36Sopenharmony_ci{ 4162306a36Sopenharmony_ci int ret; 4262306a36Sopenharmony_ci struct syscon_reboot_mode *syscon_rbm; 4362306a36Sopenharmony_ci 4462306a36Sopenharmony_ci syscon_rbm = devm_kzalloc(&pdev->dev, sizeof(*syscon_rbm), GFP_KERNEL); 4562306a36Sopenharmony_ci if (!syscon_rbm) 4662306a36Sopenharmony_ci return -ENOMEM; 4762306a36Sopenharmony_ci 4862306a36Sopenharmony_ci syscon_rbm->reboot.dev = &pdev->dev; 4962306a36Sopenharmony_ci syscon_rbm->reboot.write = syscon_reboot_mode_write; 5062306a36Sopenharmony_ci syscon_rbm->mask = 0xffffffff; 5162306a36Sopenharmony_ci 5262306a36Sopenharmony_ci syscon_rbm->map = syscon_node_to_regmap(pdev->dev.parent->of_node); 5362306a36Sopenharmony_ci if (IS_ERR(syscon_rbm->map)) 5462306a36Sopenharmony_ci return PTR_ERR(syscon_rbm->map); 5562306a36Sopenharmony_ci 5662306a36Sopenharmony_ci if (of_property_read_u32(pdev->dev.of_node, "offset", 5762306a36Sopenharmony_ci &syscon_rbm->offset)) 5862306a36Sopenharmony_ci return -EINVAL; 5962306a36Sopenharmony_ci 6062306a36Sopenharmony_ci of_property_read_u32(pdev->dev.of_node, "mask", &syscon_rbm->mask); 6162306a36Sopenharmony_ci 6262306a36Sopenharmony_ci ret = devm_reboot_mode_register(&pdev->dev, &syscon_rbm->reboot); 6362306a36Sopenharmony_ci if (ret) 6462306a36Sopenharmony_ci dev_err(&pdev->dev, "can't register reboot mode\n"); 6562306a36Sopenharmony_ci 6662306a36Sopenharmony_ci return ret; 6762306a36Sopenharmony_ci} 6862306a36Sopenharmony_ci 6962306a36Sopenharmony_cistatic const struct of_device_id syscon_reboot_mode_of_match[] = { 7062306a36Sopenharmony_ci { .compatible = "syscon-reboot-mode" }, 7162306a36Sopenharmony_ci {} 7262306a36Sopenharmony_ci}; 7362306a36Sopenharmony_ciMODULE_DEVICE_TABLE(of, syscon_reboot_mode_of_match); 7462306a36Sopenharmony_ci 7562306a36Sopenharmony_cistatic struct platform_driver syscon_reboot_mode_driver = { 7662306a36Sopenharmony_ci .probe = syscon_reboot_mode_probe, 7762306a36Sopenharmony_ci .driver = { 7862306a36Sopenharmony_ci .name = "syscon-reboot-mode", 7962306a36Sopenharmony_ci .of_match_table = syscon_reboot_mode_of_match, 8062306a36Sopenharmony_ci }, 8162306a36Sopenharmony_ci}; 8262306a36Sopenharmony_cimodule_platform_driver(syscon_reboot_mode_driver); 8362306a36Sopenharmony_ci 8462306a36Sopenharmony_ciMODULE_AUTHOR("Andy Yan <andy.yan@rock-chips.com"); 8562306a36Sopenharmony_ciMODULE_DESCRIPTION("SYSCON reboot mode driver"); 8662306a36Sopenharmony_ciMODULE_LICENSE("GPL v2"); 87