forked from luck/tmp_suning_uos_patched
0cb3fcd72c
To get rid of port expanders, the free GPIOs of ab8500 can be used. There are 42 GPIO pins. Out of which 16 are interrupt capable.This patch implements 16 virtual IRQ mapped to 16 interrupt capable AB8500 GPIOs. Signed-off-by: Bibek Basu <bibek.basu@stericsson.com> Acked-by: Grant Likely <grant.likely@secretlab.ca> [Renamed header file as per MFD structure] Signed-off-by: Linus Walleij <linus.walleij@linaro.org>
106 lines
2.2 KiB
C
106 lines
2.2 KiB
C
/*
|
|
* Copyright (C) ST-Ericsson SA 2010
|
|
* Author: Mattias Wallin <mattias.wallin@stericsson.com> for ST-Ericsson.
|
|
* License Terms: GNU General Public License v2
|
|
* This file was based on drivers/mfd/ab8500-spi.c
|
|
*/
|
|
|
|
#include <linux/kernel.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/init.h>
|
|
#include <linux/module.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/mfd/ab8500.h>
|
|
|
|
#include <mach/prcmu.h>
|
|
|
|
static int ab8500_i2c_write(struct ab8500 *ab8500, u16 addr, u8 data)
|
|
{
|
|
int ret;
|
|
|
|
ret = prcmu_abb_write((u8)(addr >> 8), (u8)(addr & 0xFF), &data, 1);
|
|
if (ret < 0)
|
|
dev_err(ab8500->dev, "prcmu i2c error %d\n", ret);
|
|
return ret;
|
|
}
|
|
|
|
static int ab8500_i2c_read(struct ab8500 *ab8500, u16 addr)
|
|
{
|
|
int ret;
|
|
u8 data;
|
|
|
|
ret = prcmu_abb_read((u8)(addr >> 8), (u8)(addr & 0xFF), &data, 1);
|
|
if (ret < 0) {
|
|
dev_err(ab8500->dev, "prcmu i2c error %d\n", ret);
|
|
return ret;
|
|
}
|
|
return (int)data;
|
|
}
|
|
|
|
static int __devinit ab8500_i2c_probe(struct platform_device *plf)
|
|
{
|
|
struct ab8500 *ab8500;
|
|
struct resource *resource;
|
|
int ret;
|
|
|
|
ab8500 = kzalloc(sizeof *ab8500, GFP_KERNEL);
|
|
if (!ab8500)
|
|
return -ENOMEM;
|
|
|
|
ab8500->dev = &plf->dev;
|
|
|
|
resource = platform_get_resource(plf, IORESOURCE_IRQ, 0);
|
|
if (!resource) {
|
|
kfree(ab8500);
|
|
return -ENODEV;
|
|
}
|
|
|
|
ab8500->irq = resource->start;
|
|
|
|
ab8500->read = ab8500_i2c_read;
|
|
ab8500->write = ab8500_i2c_write;
|
|
|
|
platform_set_drvdata(plf, ab8500);
|
|
|
|
ret = ab8500_init(ab8500);
|
|
if (ret)
|
|
kfree(ab8500);
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int __devexit ab8500_i2c_remove(struct platform_device *plf)
|
|
{
|
|
struct ab8500 *ab8500 = platform_get_drvdata(plf);
|
|
|
|
ab8500_exit(ab8500);
|
|
kfree(ab8500);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static struct platform_driver ab8500_i2c_driver = {
|
|
.driver = {
|
|
.name = "ab8500-i2c",
|
|
.owner = THIS_MODULE,
|
|
},
|
|
.probe = ab8500_i2c_probe,
|
|
.remove = __devexit_p(ab8500_i2c_remove)
|
|
};
|
|
|
|
static int __init ab8500_i2c_init(void)
|
|
{
|
|
return platform_driver_register(&ab8500_i2c_driver);
|
|
}
|
|
|
|
static void __exit ab8500_i2c_exit(void)
|
|
{
|
|
platform_driver_unregister(&ab8500_i2c_driver);
|
|
}
|
|
arch_initcall(ab8500_i2c_init);
|
|
module_exit(ab8500_i2c_exit);
|
|
|
|
MODULE_AUTHOR("Mattias WALLIN <mattias.wallin@stericsson.com");
|
|
MODULE_DESCRIPTION("AB8500 Core access via PRCMU I2C");
|
|
MODULE_LICENSE("GPL v2");
|