linux-imx

/*

 * MFD driver for wl1273 FM radio and audio codec submodules.

 *

 * Copyright (C) 2011 Nokia Corporation

 * Author: Matti Aaltonen <matti.j.aaltonen@nokia.com>

 *

 * This program is free software; you can redistribute it and/or modify

 * it under the terms of the GNU General Public License version 2 as

 * published by the Free Software Foundation.

 *

 * This program is distributed in the hope that it will be useful, but

 * WITHOUT ANY WARRANTY; without even the implied warranty of

 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU

 * General Public License for more details.

 *

 * You should have received a copy of the GNU General Public License

 * along with this program; if not, write to the Free Software

 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA

 * 02110-1301 USA

 *

 */

​

#include <linux/mfd/wl1273-core.h>

#include <linux/slab.h>

#include <linux/module.h>

​

#define DRIVER_DESC "WL1273 FM Radio Core"

​

static const struct i2c_device_id wl1273_driver_id_table[] = {

    { WL1273_FM_DRIVER_NAME, 0 },

    { }

};

MODULE_DEVICE_TABLE(i2c, wl1273_driver_id_table);

​

static int wl1273_fm_read_reg(struct wl1273_core *core, u8 reg, u16 *value)

{

    struct i2c_client *client = core->client;

    u8 b[2];

    int r;

​

    r = i2c_smbus_read_i2c_block_data(client, reg, sizeof(b), b);

    if (r != 2) {

        dev_err(&client->dev, "%s: Read: %d fails.\n", __func__, reg);

        return -EREMOTEIO;

    }

​

    *value = (u16)b[0] << 8 | b[1];

​

    return 0;

}

​

static int wl1273_fm_write_cmd(struct wl1273_core *core, u8 cmd, u16 param)

{

    struct i2c_client *client = core->client;

    u8 buf[] = { (param >> 8) & 0xff, param & 0xff };

    int r;

​

    r = i2c_smbus_write_i2c_block_data(client, cmd, sizeof(buf), buf);

    if (r) {

        dev_err(&client->dev, "%s: Cmd: %d fails.\n", __func__, cmd);

        return r;

    }

​

    return 0;

}

​

static int wl1273_fm_write_data(struct wl1273_core *core, u8 *data, u16 len)

{

    struct i2c_client *client = core->client;

    struct i2c_msg msg;

    int r;

​

    msg.addr = client->addr;

    msg.flags = 0;

    msg.buf = data;

    msg.len = len;

​

    r = i2c_transfer(client->adapter, &msg, 1);

    if (r != 1) {

        dev_err(&client->dev, "%s: write error.\n", __func__);

        return -EREMOTEIO;

    }

​

    return 0;

}

​

/**

 * wl1273_fm_set_audio() -  Set audio mode.

 * @core:           A pointer to the device struct.

 * @new_mode:           The new audio mode.

 *

 * Audio modes are WL1273_AUDIO_DIGITAL and WL1273_AUDIO_ANALOG.