90550d1903
This adds a pretty straight-forward system control driver for the AB8500. This driver will be used from the core platform, e.g the clock tree implementation in the machine code, and is by nature singleton. There are a few simple functions to read, write, set and clear registers so that the machine code can control its own foundation. Cc: Mattias Wallin <mattias.wallin@stericsson.com> Signed-off-by: Mattias Nilsson <mattias.i.nilsson@stericsson.com> Signed-off-by: Linus Walleij <linus.walleij@linaro.org> Signed-off-by: Samuel Ortiz <sameo@linux.intel.com>
80 lines
1.7 KiB
C
80 lines
1.7 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/platform_device.h>
|
|
#include <linux/mfd/ab8500.h>
|
|
#include <linux/mfd/abx500.h>
|
|
#include <linux/mfd/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");
|