linux-imx

/*

 * DA9150 Core MFD Driver

 *

 * Copyright (c) 2014 Dialog Semiconductor

 *

 * Author: Adam Thomson <Adam.Thomson.Opensource@diasemi.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;  either version 2 of the  License, or (at your

 * option) any later version.

 */

​

#include <linux/kernel.h>

#include <linux/module.h>

#include <linux/platform_device.h>

#include <linux/i2c.h>

#include <linux/regmap.h>

#include <linux/slab.h>

#include <linux/irq.h>

#include <linux/interrupt.h>

#include <linux/mfd/core.h>

#include <linux/mfd/da9150/core.h>

#include <linux/mfd/da9150/registers.h>

​

/* Raw device access, used for QIF */

static int da9150_i2c_read_device(struct i2c_client *client, u8 addr, int count,

                  u8 *buf)

{

    struct i2c_msg xfer;

    int ret;

​

    /*

     * Read is split into two transfers as device expects STOP/START rather

     * than repeated start to carry out this kind of access.

     */

​

    /* Write address */

    xfer.addr = client->addr;

    xfer.flags = 0;

    xfer.len = 1;

    xfer.buf = &addr;

​

    ret = i2c_transfer(client->adapter, &xfer, 1);

    if (ret != 1) {

        if (ret < 0)

            return ret;

        else

            return -EIO;

    }

​

    /* Read data */

    xfer.addr = client->addr;

    xfer.flags = I2C_M_RD;

    xfer.len = count;

    xfer.buf = buf;

​

    ret = i2c_transfer(client->adapter, &xfer, 1);

    if (ret == 1)

        return 0;

    else if (ret < 0)

        return ret;

    else

        return -EIO;

}

​

static int da9150_i2c_write_device(struct i2c_client *client, u8 addr,

                   int count, const u8 *buf)

{

    struct i2c_msg xfer;

    u8 *reg_data;

    int ret;

​

    reg_data = kzalloc(1 + count, GFP_KERNEL);

    if (!reg_data)

        return -ENOMEM;

​

    reg_data[0] = addr;

    memcpy(&reg_data[1], buf, count);

​

    /* Write address & data */

    xfer.addr = client->addr;

    xfer.flags = 0;

    xfer.len = 1 + count;

    xfer.buf = reg_data;

​

    ret = i2c_transfer(client->adapter, &xfer, 1);

    kfree(reg_data);

    if (ret == 1)

        return 0;

    else if (ret < 0)

        return ret;