linux-imx

/*

 * Core driver for HTC PASIC3 LED/DS1WM chip.

 *

 * Copyright (C) 2006 Philipp Zabel <philipp.zabel@gmail.com>

 *

 * 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; version 2 of the License.

 */

​

#include <linux/init.h>

#include <linux/module.h>

#include <linux/platform_device.h>

​

#include <linux/gpio.h>

#include <linux/io.h>

#include <linux/irq.h>

#include <linux/interrupt.h>

#include <linux/mfd/core.h>

#include <linux/mfd/ds1wm.h>

#include <linux/mfd/htc-pasic3.h>

#include <linux/slab.h>

​

struct pasic3_data {

    void __iomem *mapping;

    unsigned int bus_shift;

};

​

#define REG_ADDR  5

#define REG_DATA  6

​

#define READ_MODE 0x80

​

/*

 * write to a secondary register on the PASIC3

 */

void pasic3_write_register(struct device *dev, u32 reg, u8 val)

{

    struct pasic3_data *asic = dev_get_drvdata(dev);

    int bus_shift = asic->bus_shift;

    void __iomem *addr = asic->mapping + (REG_ADDR << bus_shift);

    void __iomem *data = asic->mapping + (REG_DATA << bus_shift);

​

    __raw_writeb(~READ_MODE & reg, addr);

    __raw_writeb(val, data);

}

EXPORT_SYMBOL(pasic3_write_register); /* for leds-pasic3 */

​

/*

 * read from a secondary register on the PASIC3

 */

u8 pasic3_read_register(struct device *dev, u32 reg)

{

    struct pasic3_data *asic = dev_get_drvdata(dev);

    int bus_shift = asic->bus_shift;

    void __iomem *addr = asic->mapping + (REG_ADDR << bus_shift);

    void __iomem *data = asic->mapping + (REG_DATA << bus_shift);

​

    __raw_writeb(READ_MODE | reg, addr);

    return __raw_readb(data);

}

EXPORT_SYMBOL(pasic3_read_register); /* for leds-pasic3 */

​