forked from luck/tmp_suning_uos_patched
bad76991d7
Now the MFD API is Device Tree aware we can use it for platform registration again, even when booting with DT enabled. To aid in Device Node pointer allocation we provide each cell with the associative compatible string. Signed-off-by: Lee Jones <lee.jones@linaro.org> Signed-off-by: Samuel Ortiz <sameo@linux.intel.com>
82 lines
1.8 KiB
C
82 lines
1.8 KiB
C
/*
|
|
* Copyright (C) ST-Ericsson SA 2010
|
|
* Author: Mattias Nilsson <mattias.i.nilsson@stericsson.com> for ST Ericsson.
|
|
* License terms: GNU General Public License (GPL) version 2
|
|
*/
|
|
|
|
#include <linux/err.h>
|
|
#include <linux/module.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/mfd/abx500.h>
|
|
#include <linux/mfd/abx500/ab8500.h>
|
|
#include <linux/mfd/abx500/ab8500-sysctrl.h>
|
|
|
|
static struct device *sysctrl_dev;
|
|
|
|
static inline bool valid_bank(u8 bank)
|
|
{
|
|
return ((bank == AB8500_SYS_CTRL1_BLOCK) ||
|
|
(bank == AB8500_SYS_CTRL2_BLOCK));
|
|
}
|
|
|
|
int ab8500_sysctrl_read(u16 reg, u8 *value)
|
|
{
|
|
u8 bank;
|
|
|
|
if (sysctrl_dev == NULL)
|
|
return -EAGAIN;
|
|
|
|
bank = (reg >> 8);
|
|
if (!valid_bank(bank))
|
|
return -EINVAL;
|
|
|
|
return abx500_get_register_interruptible(sysctrl_dev, bank,
|
|
(u8)(reg & 0xFF), value);
|
|
}
|
|
|
|
int ab8500_sysctrl_write(u16 reg, u8 mask, u8 value)
|
|
{
|
|
u8 bank;
|
|
|
|
if (sysctrl_dev == NULL)
|
|
return -EAGAIN;
|
|
|
|
bank = (reg >> 8);
|
|
if (!valid_bank(bank))
|
|
return -EINVAL;
|
|
|
|
return abx500_mask_and_set_register_interruptible(sysctrl_dev, bank,
|
|
(u8)(reg & 0xFF), mask, value);
|
|
}
|
|
|
|
static int __devinit ab8500_sysctrl_probe(struct platform_device *pdev)
|
|
{
|
|
sysctrl_dev = &pdev->dev;
|
|
return 0;
|
|
}
|
|
|
|
static int __devexit ab8500_sysctrl_remove(struct platform_device *pdev)
|
|
{
|
|
sysctrl_dev = NULL;
|
|
return 0;
|
|
}
|
|
|
|
static struct platform_driver ab8500_sysctrl_driver = {
|
|
.driver = {
|
|
.name = "ab8500-sysctrl",
|
|
.owner = THIS_MODULE,
|
|
},
|
|
.probe = ab8500_sysctrl_probe,
|
|
.remove = __devexit_p(ab8500_sysctrl_remove),
|
|
};
|
|
|
|
static int __init ab8500_sysctrl_init(void)
|
|
{
|
|
return platform_driver_register(&ab8500_sysctrl_driver);
|
|
}
|
|
subsys_initcall(ab8500_sysctrl_init);
|
|
|
|
MODULE_AUTHOR("Mattias Nilsson <mattias.i.nilsson@stericsson.com");
|
|
MODULE_DESCRIPTION("AB8500 system control driver");
|
|
MODULE_LICENSE("GPL v2");
|