linux-imx

/*

 *  Driver for Freescale MC44S803 Low Power CMOS Broadband Tuner

 *

 *  Copyright (c) 2009 Jochen Friedrich <jochen@scram.de>

 *

 *  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.

 *

 *  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.

 */

​

#include <linux/module.h>

#include <linux/delay.h>

#include <linux/dvb/frontend.h>

#include <linux/i2c.h>

#include <linux/slab.h>

​

#include <media/dvb_frontend.h>

​

#include "mc44s803.h"

#include "mc44s803_priv.h"

​

#define mc_printk(level, format, arg...)    \

    printk(level "mc44s803: " format , ## arg)

​

/* Writes a single register */

static int mc44s803_writereg(struct mc44s803_priv *priv, u32 val)

{

    u8 buf[3];

    struct i2c_msg msg = {

        .addr = priv->cfg->i2c_address, .flags = 0, .buf = buf, .len = 3

    };

​

    buf[0] = (val & 0xff0000) >> 16;

    buf[1] = (val & 0xff00) >> 8;

    buf[2] = (val & 0xff);

​

    if (i2c_transfer(priv->i2c, &msg, 1) != 1) {

        mc_printk(KERN_WARNING, "I2C write failed\n");

        return -EREMOTEIO;

    }

    return 0;

}

​

/* Reads a single register */

static int mc44s803_readreg(struct mc44s803_priv *priv, u8 reg, u32 *val)

{

    u32 wval;

    u8 buf[3];

    int ret;

    struct i2c_msg msg[] = {

        { .addr = priv->cfg->i2c_address, .flags = I2C_M_RD,

          .buf = buf, .len = 3 },

    };

​

    wval = MC44S803_REG_SM(MC44S803_REG_DATAREG, MC44S803_ADDR) |

           MC44S803_REG_SM(reg, MC44S803_D);

​

    ret = mc44s803_writereg(priv, wval);

    if (ret)

        return ret;

​

    if (i2c_transfer(priv->i2c, msg, 1) != 1) {

        mc_printk(KERN_WARNING, "I2C read failed\n");

        return -EREMOTEIO;

    }

​

    *val = (buf[0] << 16) | (buf[1] << 8) | buf[2];

​

    return 0;

}

​

static void mc44s803_release(struct dvb_frontend *fe)

{

    struct mc44s803_priv *priv = fe->tuner_priv;

​

    fe->tuner_priv = NULL;

    kfree(priv);

}

​

static int mc44s803_init(struct dvb_frontend *fe)

{

    struct mc44s803_priv *priv = fe->tuner_priv;

    u32 val;

    int err;

​