2012-10-18 20:58:47 +04:00
|
|
|
/*
|
|
|
|
* This program is free software; you can redistribute it and/or modify
|
|
|
|
* it under the terms of the GNU General Public License version 2 as
|
|
|
|
* published by the Free Software Foundation.
|
|
|
|
*
|
|
|
|
* 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.
|
|
|
|
*
|
|
|
|
* Copyright (C) 2012 ARM Limited
|
|
|
|
*/
|
|
|
|
|
2014-04-24 20:19:30 +04:00
|
|
|
#include <linux/delay.h>
|
2014-09-30 21:48:27 +04:00
|
|
|
#include <linux/notifier.h>
|
2012-10-18 20:58:47 +04:00
|
|
|
#include <linux/of.h>
|
|
|
|
#include <linux/of_device.h>
|
|
|
|
#include <linux/platform_device.h>
|
2014-09-30 21:48:27 +04:00
|
|
|
#include <linux/reboot.h>
|
2012-10-18 20:58:47 +04:00
|
|
|
#include <linux/stat.h>
|
|
|
|
#include <linux/vexpress.h>
|
|
|
|
|
|
|
|
static void vexpress_reset_do(struct device *dev, const char *what)
|
|
|
|
{
|
|
|
|
int err = -ENOENT;
|
mfd: vexpress: Convert custom func API to regmap
Components of the Versatile Express platform (configuration
microcontrollers on motherboard and daughterboards in particular)
talk to each other over a custom configuration bus. They
provide miscellaneous functions (from clock generator control
to energy sensors) which are represented as platform devices
(and Device Tree nodes). The transactions on the bus can
be generated by different "bridges" in the system, some
of which are universal for the whole platform (for the price
of high transfer latencies), others restricted to a subsystem
(but much faster).
Until now drivers for such functions were using custom "func"
API, which is being replaced in this patch by regmap calls.
This required:
* a rework (and move to drivers/bus directory, as suggested
by Samuel and Arnd) of the config bus core, which is much
simpler now and uses device model infrastructure (class)
to keep track of the bridges; non-DT case (soon to be
retired anyway) is simply covered by a special device
registration function
* the new config-bus driver also takes over device population,
so there is no need for special matching table for
of_platform_populate nor "simple-bus" hack in the arm64
model dtsi file (relevant bindings documentation has
been updated); this allows all the vexpress devices
fit into normal device model, making it possible
to remove plenty of early inits and other hacks in
the near future
* adaptation of the syscfg bridge implementation in the
sysreg driver, again making it much simpler; there is
a special case of the "energy" function spanning two
registers, where they should be both defined in the tree
now, but backward compatibility is maintained in the code
* modification of the relevant drivers:
* hwmon - just a straight-forward API change
* power/reset driver - API change
* regulator - API change plus error handling
simplification
* osc clock driver - this one required larger rework
in order to turn in into a standard platform driver
Signed-off-by: Pawel Moll <pawel.moll@arm.com>
Acked-by: Mark Brown <broonie@linaro.org>
Acked-by: Lee Jones <lee.jones@linaro.org>
Acked-by: Guenter Roeck <linux@roeck-us.net>
Acked-by: Mike Turquette <mturquette@linaro.org>
2014-04-30 19:46:29 +04:00
|
|
|
struct regmap *reg = dev_get_drvdata(dev);
|
2012-10-18 20:58:47 +04:00
|
|
|
|
mfd: vexpress: Convert custom func API to regmap
Components of the Versatile Express platform (configuration
microcontrollers on motherboard and daughterboards in particular)
talk to each other over a custom configuration bus. They
provide miscellaneous functions (from clock generator control
to energy sensors) which are represented as platform devices
(and Device Tree nodes). The transactions on the bus can
be generated by different "bridges" in the system, some
of which are universal for the whole platform (for the price
of high transfer latencies), others restricted to a subsystem
(but much faster).
Until now drivers for such functions were using custom "func"
API, which is being replaced in this patch by regmap calls.
This required:
* a rework (and move to drivers/bus directory, as suggested
by Samuel and Arnd) of the config bus core, which is much
simpler now and uses device model infrastructure (class)
to keep track of the bridges; non-DT case (soon to be
retired anyway) is simply covered by a special device
registration function
* the new config-bus driver also takes over device population,
so there is no need for special matching table for
of_platform_populate nor "simple-bus" hack in the arm64
model dtsi file (relevant bindings documentation has
been updated); this allows all the vexpress devices
fit into normal device model, making it possible
to remove plenty of early inits and other hacks in
the near future
* adaptation of the syscfg bridge implementation in the
sysreg driver, again making it much simpler; there is
a special case of the "energy" function spanning two
registers, where they should be both defined in the tree
now, but backward compatibility is maintained in the code
* modification of the relevant drivers:
* hwmon - just a straight-forward API change
* power/reset driver - API change
* regulator - API change plus error handling
simplification
* osc clock driver - this one required larger rework
in order to turn in into a standard platform driver
Signed-off-by: Pawel Moll <pawel.moll@arm.com>
Acked-by: Mark Brown <broonie@linaro.org>
Acked-by: Lee Jones <lee.jones@linaro.org>
Acked-by: Guenter Roeck <linux@roeck-us.net>
Acked-by: Mike Turquette <mturquette@linaro.org>
2014-04-30 19:46:29 +04:00
|
|
|
if (reg) {
|
|
|
|
err = regmap_write(reg, 0, 0);
|
2014-04-24 20:19:30 +04:00
|
|
|
if (!err)
|
|
|
|
mdelay(1000);
|
2012-10-18 20:58:47 +04:00
|
|
|
}
|
|
|
|
|
|
|
|
dev_emerg(dev, "Unable to %s (%d)\n", what, err);
|
|
|
|
}
|
|
|
|
|
|
|
|
static struct device *vexpress_power_off_device;
|
2018-06-18 18:54:32 +03:00
|
|
|
static atomic_t vexpress_restart_nb_refcnt = ATOMIC_INIT(0);
|
2012-10-18 20:58:47 +04:00
|
|
|
|
2013-02-28 20:43:19 +04:00
|
|
|
static void vexpress_power_off(void)
|
2012-10-18 20:58:47 +04:00
|
|
|
{
|
|
|
|
vexpress_reset_do(vexpress_power_off_device, "power off");
|
|
|
|
}
|
|
|
|
|
|
|
|
static struct device *vexpress_restart_device;
|
|
|
|
|
2014-09-30 21:48:27 +04:00
|
|
|
static int vexpress_restart(struct notifier_block *this, unsigned long mode,
|
|
|
|
void *cmd)
|
2012-10-18 20:58:47 +04:00
|
|
|
{
|
|
|
|
vexpress_reset_do(vexpress_restart_device, "restart");
|
2014-09-30 21:48:27 +04:00
|
|
|
|
|
|
|
return NOTIFY_DONE;
|
2012-10-18 20:58:47 +04:00
|
|
|
}
|
|
|
|
|
2014-09-30 21:48:27 +04:00
|
|
|
static struct notifier_block vexpress_restart_nb = {
|
|
|
|
.notifier_call = vexpress_restart,
|
|
|
|
.priority = 128,
|
|
|
|
};
|
|
|
|
|
2012-10-18 20:58:47 +04:00
|
|
|
static ssize_t vexpress_reset_active_show(struct device *dev,
|
|
|
|
struct device_attribute *attr, char *buf)
|
|
|
|
{
|
|
|
|
return sprintf(buf, "%d\n", vexpress_restart_device == dev);
|
|
|
|
}
|
|
|
|
|
|
|
|
static ssize_t vexpress_reset_active_store(struct device *dev,
|
|
|
|
struct device_attribute *attr, const char *buf, size_t count)
|
|
|
|
{
|
|
|
|
long value;
|
|
|
|
int err = kstrtol(buf, 0, &value);
|
|
|
|
|
|
|
|
if (!err && value)
|
|
|
|
vexpress_restart_device = dev;
|
|
|
|
|
|
|
|
return err ? err : count;
|
|
|
|
}
|
|
|
|
|
2016-06-08 21:26:31 +03:00
|
|
|
static DEVICE_ATTR(active, S_IRUGO | S_IWUSR, vexpress_reset_active_show,
|
|
|
|
vexpress_reset_active_store);
|
2012-10-18 20:58:47 +04:00
|
|
|
|
|
|
|
|
|
|
|
enum vexpress_reset_func { FUNC_RESET, FUNC_SHUTDOWN, FUNC_REBOOT };
|
|
|
|
|
2015-03-16 22:17:12 +03:00
|
|
|
static const struct of_device_id vexpress_reset_of_match[] = {
|
2012-10-18 20:58:47 +04:00
|
|
|
{
|
|
|
|
.compatible = "arm,vexpress-reset",
|
|
|
|
.data = (void *)FUNC_RESET,
|
|
|
|
}, {
|
|
|
|
.compatible = "arm,vexpress-shutdown",
|
|
|
|
.data = (void *)FUNC_SHUTDOWN
|
|
|
|
}, {
|
|
|
|
.compatible = "arm,vexpress-reboot",
|
|
|
|
.data = (void *)FUNC_REBOOT
|
|
|
|
},
|
|
|
|
{}
|
|
|
|
};
|
|
|
|
|
2014-09-30 21:48:27 +04:00
|
|
|
static int _vexpress_register_restart_handler(struct device *dev)
|
|
|
|
{
|
|
|
|
int err;
|
|
|
|
|
|
|
|
vexpress_restart_device = dev;
|
2018-06-18 18:54:32 +03:00
|
|
|
if (atomic_inc_return(&vexpress_restart_nb_refcnt) == 1) {
|
|
|
|
err = register_restart_handler(&vexpress_restart_nb);
|
|
|
|
if (err) {
|
|
|
|
dev_err(dev, "cannot register restart handler (err=%d)\n", err);
|
|
|
|
atomic_dec(&vexpress_restart_nb_refcnt);
|
|
|
|
return err;
|
|
|
|
}
|
2014-09-30 21:48:27 +04:00
|
|
|
}
|
|
|
|
device_create_file(dev, &dev_attr_active);
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2012-10-18 20:58:47 +04:00
|
|
|
static int vexpress_reset_probe(struct platform_device *pdev)
|
|
|
|
{
|
|
|
|
const struct of_device_id *match =
|
|
|
|
of_match_device(vexpress_reset_of_match, &pdev->dev);
|
mfd: vexpress: Convert custom func API to regmap
Components of the Versatile Express platform (configuration
microcontrollers on motherboard and daughterboards in particular)
talk to each other over a custom configuration bus. They
provide miscellaneous functions (from clock generator control
to energy sensors) which are represented as platform devices
(and Device Tree nodes). The transactions on the bus can
be generated by different "bridges" in the system, some
of which are universal for the whole platform (for the price
of high transfer latencies), others restricted to a subsystem
(but much faster).
Until now drivers for such functions were using custom "func"
API, which is being replaced in this patch by regmap calls.
This required:
* a rework (and move to drivers/bus directory, as suggested
by Samuel and Arnd) of the config bus core, which is much
simpler now and uses device model infrastructure (class)
to keep track of the bridges; non-DT case (soon to be
retired anyway) is simply covered by a special device
registration function
* the new config-bus driver also takes over device population,
so there is no need for special matching table for
of_platform_populate nor "simple-bus" hack in the arm64
model dtsi file (relevant bindings documentation has
been updated); this allows all the vexpress devices
fit into normal device model, making it possible
to remove plenty of early inits and other hacks in
the near future
* adaptation of the syscfg bridge implementation in the
sysreg driver, again making it much simpler; there is
a special case of the "energy" function spanning two
registers, where they should be both defined in the tree
now, but backward compatibility is maintained in the code
* modification of the relevant drivers:
* hwmon - just a straight-forward API change
* power/reset driver - API change
* regulator - API change plus error handling
simplification
* osc clock driver - this one required larger rework
in order to turn in into a standard platform driver
Signed-off-by: Pawel Moll <pawel.moll@arm.com>
Acked-by: Mark Brown <broonie@linaro.org>
Acked-by: Lee Jones <lee.jones@linaro.org>
Acked-by: Guenter Roeck <linux@roeck-us.net>
Acked-by: Mike Turquette <mturquette@linaro.org>
2014-04-30 19:46:29 +04:00
|
|
|
struct regmap *regmap;
|
2014-09-30 21:48:27 +04:00
|
|
|
int ret = 0;
|
2012-10-18 20:58:47 +04:00
|
|
|
|
2015-01-20 20:24:02 +03:00
|
|
|
if (!match)
|
|
|
|
return -EINVAL;
|
2012-10-18 20:58:47 +04:00
|
|
|
|
mfd: vexpress: Convert custom func API to regmap
Components of the Versatile Express platform (configuration
microcontrollers on motherboard and daughterboards in particular)
talk to each other over a custom configuration bus. They
provide miscellaneous functions (from clock generator control
to energy sensors) which are represented as platform devices
(and Device Tree nodes). The transactions on the bus can
be generated by different "bridges" in the system, some
of which are universal for the whole platform (for the price
of high transfer latencies), others restricted to a subsystem
(but much faster).
Until now drivers for such functions were using custom "func"
API, which is being replaced in this patch by regmap calls.
This required:
* a rework (and move to drivers/bus directory, as suggested
by Samuel and Arnd) of the config bus core, which is much
simpler now and uses device model infrastructure (class)
to keep track of the bridges; non-DT case (soon to be
retired anyway) is simply covered by a special device
registration function
* the new config-bus driver also takes over device population,
so there is no need for special matching table for
of_platform_populate nor "simple-bus" hack in the arm64
model dtsi file (relevant bindings documentation has
been updated); this allows all the vexpress devices
fit into normal device model, making it possible
to remove plenty of early inits and other hacks in
the near future
* adaptation of the syscfg bridge implementation in the
sysreg driver, again making it much simpler; there is
a special case of the "energy" function spanning two
registers, where they should be both defined in the tree
now, but backward compatibility is maintained in the code
* modification of the relevant drivers:
* hwmon - just a straight-forward API change
* power/reset driver - API change
* regulator - API change plus error handling
simplification
* osc clock driver - this one required larger rework
in order to turn in into a standard platform driver
Signed-off-by: Pawel Moll <pawel.moll@arm.com>
Acked-by: Mark Brown <broonie@linaro.org>
Acked-by: Lee Jones <lee.jones@linaro.org>
Acked-by: Guenter Roeck <linux@roeck-us.net>
Acked-by: Mike Turquette <mturquette@linaro.org>
2014-04-30 19:46:29 +04:00
|
|
|
regmap = devm_regmap_init_vexpress_config(&pdev->dev);
|
|
|
|
if (IS_ERR(regmap))
|
|
|
|
return PTR_ERR(regmap);
|
|
|
|
dev_set_drvdata(&pdev->dev, regmap);
|
2014-04-24 20:19:30 +04:00
|
|
|
|
2015-01-20 20:24:02 +03:00
|
|
|
switch ((enum vexpress_reset_func)match->data) {
|
2012-10-18 20:58:47 +04:00
|
|
|
case FUNC_SHUTDOWN:
|
|
|
|
vexpress_power_off_device = &pdev->dev;
|
2013-02-28 20:43:19 +04:00
|
|
|
pm_power_off = vexpress_power_off;
|
2012-10-18 20:58:47 +04:00
|
|
|
break;
|
|
|
|
case FUNC_RESET:
|
|
|
|
if (!vexpress_restart_device)
|
2014-09-30 21:48:27 +04:00
|
|
|
ret = _vexpress_register_restart_handler(&pdev->dev);
|
2012-10-18 20:58:47 +04:00
|
|
|
break;
|
|
|
|
case FUNC_REBOOT:
|
2014-09-30 21:48:27 +04:00
|
|
|
ret = _vexpress_register_restart_handler(&pdev->dev);
|
2012-10-18 20:58:47 +04:00
|
|
|
break;
|
|
|
|
};
|
|
|
|
|
2014-09-30 21:48:27 +04:00
|
|
|
return ret;
|
2012-10-18 20:58:47 +04:00
|
|
|
}
|
|
|
|
|
|
|
|
static struct platform_driver vexpress_reset_driver = {
|
|
|
|
.probe = vexpress_reset_probe,
|
|
|
|
.driver = {
|
|
|
|
.name = "vexpress-reset",
|
|
|
|
.of_match_table = vexpress_reset_of_match,
|
|
|
|
},
|
|
|
|
};
|
|
|
|
|
|
|
|
static int __init vexpress_reset_init(void)
|
|
|
|
{
|
|
|
|
return platform_driver_register(&vexpress_reset_driver);
|
|
|
|
}
|
|
|
|
device_initcall(vexpress_reset_init);
|