linux-imx

/*

 * Copyright (c) 2016, Fuzhou Rockchip Electronics Co., Ltd

 *

 * 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.

 */

​

#include <linux/init.h>

#include <linux/module.h>

#include <linux/kernel.h>

#include <linux/of.h>

#include <linux/platform_device.h>

#include <linux/reboot.h>

#include <linux/regmap.h>

#include <linux/mfd/syscon.h>

#include <linux/reboot-mode.h>

​

struct syscon_reboot_mode {

    struct regmap *map;

    struct reboot_mode_driver reboot;

    u32 offset;

    u32 mask;

};

​

static int syscon_reboot_mode_write(struct reboot_mode_driver *reboot,

                    unsigned int magic)

{

    struct syscon_reboot_mode *syscon_rbm;

    int ret;

​

    syscon_rbm = container_of(reboot, struct syscon_reboot_mode, reboot);

​

    ret = regmap_update_bits(syscon_rbm->map, syscon_rbm->offset,

                 syscon_rbm->mask, magic);

    if (ret < 0)

        dev_err(reboot->dev, "update reboot mode bits failed\n");

​

    return ret;

}

​

static int syscon_reboot_mode_probe(struct platform_device *pdev)

{

    int ret;

    struct syscon_reboot_mode *syscon_rbm;

​

    syscon_rbm = devm_kzalloc(&pdev->dev, sizeof(*syscon_rbm), GFP_KERNEL);

    if (!syscon_rbm)

        return -ENOMEM;

​

    syscon_rbm->reboot.dev = &pdev->dev;

    syscon_rbm->reboot.write = syscon_reboot_mode_write;

    syscon_rbm->mask = 0xffffffff;

​

    syscon_rbm->map = syscon_node_to_regmap(pdev->dev.parent->of_node);

    if (IS_ERR(syscon_rbm->map))

        return PTR_ERR(syscon_rbm->map);

​

    if (of_property_read_u32(pdev->dev.of_node, "offset",

        &syscon_rbm->offset))

        return -EINVAL;

​