[media] rtl2832: cleanups and minor changes
[firefly-linux-kernel-4.4.55.git] / drivers / media / dvb-frontends / rtl2832.c
index f86e9ab8b901ebfa2cadb7d3a5686d557f15ea2f..bc3a3589efe2163328d07c136faf191fb2c5a32a 100644 (file)
@@ -19,8 +19,6 @@
  */
 
 #include "rtl2832_priv.h"
-#include "dvb_math.h"
-#include <linux/bitops.h>
 
 #define REG_MASK(b) (BIT(b + 1) - 1)
 
@@ -194,21 +192,14 @@ int rtl2832_bulk_read(struct i2c_client *client, unsigned int reg, void *val,
 static int rtl2832_rd_demod_reg(struct rtl2832_dev *dev, int reg, u32 *val)
 {
        struct i2c_client *client = dev->client;
-       int ret;
-
+       int ret, i;
        u16 reg_start_addr;
-       u8 msb, lsb;
-       u8 reading[4];
-       u32 reading_tmp;
-       int i;
-
-       u8 len;
-       u32 mask;
+       u8 msb, lsb, reading[4], len;
+       u32 reading_tmp, mask;
 
        reg_start_addr = registers[reg].start_address;
        msb = registers[reg].msb;
        lsb = registers[reg].lsb;
-
        len = (msb >> 3) + 1;
        mask = REG_MASK(msb - lsb);
 
@@ -222,38 +213,26 @@ static int rtl2832_rd_demod_reg(struct rtl2832_dev *dev, int reg, u32 *val)
 
        *val = (reading_tmp >> lsb) & mask;
 
-       return ret;
-
+       return 0;
 err:
        dev_dbg(&client->dev, "failed=%d\n", ret);
        return ret;
-
 }
 
 static int rtl2832_wr_demod_reg(struct rtl2832_dev *dev, int reg, u32 val)
 {
        struct i2c_client *client = dev->client;
        int ret, i;
-       u8 len;
        u16 reg_start_addr;
-       u8 msb, lsb;
-       u32 mask;
-
-
-       u8 reading[4];
-       u8 writing[4];
-       u32 reading_tmp;
-       u32 writing_tmp;
-
+       u8 msb, lsb, reading[4], writing[4], len;
+       u32 reading_tmp, writing_tmp, mask;
 
        reg_start_addr = registers[reg].start_address;
        msb = registers[reg].msb;
        lsb = registers[reg].lsb;
-
        len = (msb >> 3) + 1;
        mask = REG_MASK(msb - lsb);
 
-
        ret = rtl2832_bulk_read(client, reg_start_addr, reading, len);
        if (ret)
                goto err;
@@ -265,7 +244,6 @@ static int rtl2832_wr_demod_reg(struct rtl2832_dev *dev, int reg, u32 val)
        writing_tmp = reading_tmp & ~(mask << lsb);
        writing_tmp |= ((val & mask) << lsb);
 
-
        for (i = 0; i < len; i++)
                writing[i] = (writing_tmp >> ((len - 1 - i) * 8)) & 0xff;
 
@@ -273,12 +251,10 @@ static int rtl2832_wr_demod_reg(struct rtl2832_dev *dev, int reg, u32 val)
        if (ret)
                goto err;
 
-       return ret;
-
+       return 0;
 err:
        dev_dbg(&client->dev, "failed=%d\n", ret);
        return ret;
-
 }
 
 static int rtl2832_set_if(struct dvb_frontend *fe, u32 if_freq)
@@ -293,7 +269,6 @@ static int rtl2832_set_if(struct dvb_frontend *fe, u32 if_freq)
        * PSET_IFFREQ = - floor((IfFreqHz % CrystalFreqHz) * pow(2, 22)
        *               / CrystalFreqHz)
        */
-
        pset_iffreq = if_freq % dev->pdata->clk;
        pset_iffreq *= 0x400000;
        pset_iffreq = div_u64(pset_iffreq, dev->pdata->clk);
@@ -304,10 +279,15 @@ static int rtl2832_set_if(struct dvb_frontend *fe, u32 if_freq)
 
        ret = rtl2832_wr_demod_reg(dev, DVBT_EN_BBIN, en_bbin);
        if (ret)
-               return ret;
+               goto err;
 
        ret = rtl2832_wr_demod_reg(dev, DVBT_PSET_IFFREQ, pset_iffreq);
+       if (ret)
+               goto err;
 
+       return 0;
+err:
+       dev_dbg(&client->dev, "failed=%d\n", ret);
        return ret;
 }
 
@@ -419,7 +399,7 @@ static int rtl2832_init(struct dvb_frontend *fe)
        schedule_delayed_work(&dev->stat_work, msecs_to_jiffies(2000));
        dev->sleeping = false;
 
-       return ret;
+       return 0;
 err:
        dev_dbg(&client->dev, "failed=%d\n", ret);
        return ret;
@@ -485,7 +465,6 @@ static int rtl2832_set_frontend(struct dvb_frontend *fe)
                },
        };
 
-
        dev_dbg(&client->dev, "frequency=%u bandwidth_hz=%u inversion=%u\n",
                c->frequency, c->bandwidth_hz, c->inversion);
 
@@ -571,7 +550,7 @@ static int rtl2832_set_frontend(struct dvb_frontend *fe)
        if (ret)
                goto err;
 
-       return ret;
+       return 0;
 err:
        dev_dbg(&client->dev, "failed=%d\n", ret);
        return ret;
@@ -716,7 +695,7 @@ static int rtl2832_read_status(struct dvb_frontend *fe, fe_status_t *status)
        }
 
        dev->fe_status = *status;
-       return ret;
+       return 0;
 err:
        dev_dbg(&client->dev, "failed=%d\n", ret);
        return ret;
@@ -866,7 +845,6 @@ static void rtl2832_i2c_gate_work(struct work_struct *work)
        return;
 err:
        dev_dbg(&client->dev, "failed=%d\n", ret);
-       return;
 }
 
 static int rtl2832_select(struct i2c_adapter *adap, void *mux_priv, u32 chan_id)
@@ -1052,7 +1030,7 @@ static struct dvb_frontend *rtl2832_get_dvb_frontend(struct i2c_client *client)
        return &dev->fe;
 }
 
-static struct i2c_adapter *rtl2832_get_i2c_adapter_(struct i2c_client *client)
+static struct i2c_adapter *rtl2832_get_i2c_adapter(struct i2c_client *client)
 {
        struct rtl2832_dev *dev = i2c_get_clientdata(client);
 
@@ -1060,14 +1038,6 @@ static struct i2c_adapter *rtl2832_get_i2c_adapter_(struct i2c_client *client)
        return dev->i2c_adapter_tuner;
 }
 
-static struct i2c_adapter *rtl2832_get_private_i2c_adapter_(struct i2c_client *client)
-{
-       struct rtl2832_dev *dev = i2c_get_clientdata(client);
-
-       dev_dbg(&client->dev, "\n");
-       return dev->i2c_adapter;
-}
-
 static int rtl2832_enable_slave_ts(struct i2c_client *client)
 {
        struct rtl2832_dev *dev = i2c_get_clientdata(client);
@@ -1233,10 +1203,6 @@ static int rtl2832_probe(struct i2c_client *client,
        i2c_set_clientdata(client, dev);
        dev->client = client;
        dev->pdata = client->dev.platform_data;
-       if (pdata->config) {
-               dev->pdata->clk = pdata->config->xtal;
-               dev->pdata->tuner = pdata->config->tuner;
-       }
        dev->sleeping = true;
        INIT_DELAYED_WORK(&dev->i2c_gate_work, rtl2832_i2c_gate_work);
        INIT_DELAYED_WORK(&dev->stat_work, rtl2832_stat_work);
@@ -1274,11 +1240,13 @@ static int rtl2832_probe(struct i2c_client *client,
 
        /* setup callbacks */
        pdata->get_dvb_frontend = rtl2832_get_dvb_frontend;
-       pdata->get_i2c_adapter = rtl2832_get_i2c_adapter_;
-       pdata->get_private_i2c_adapter = rtl2832_get_private_i2c_adapter_;
+       pdata->get_i2c_adapter = rtl2832_get_i2c_adapter;
        pdata->enable_slave_ts = rtl2832_enable_slave_ts;
        pdata->pid_filter = rtl2832_pid_filter;
        pdata->pid_filter_ctrl = rtl2832_pid_filter_ctrl;
+       pdata->bulk_read = rtl2832_bulk_read;
+       pdata->bulk_write = rtl2832_bulk_write;
+       pdata->update_bits = rtl2832_update_bits;
 
        dev_info(&client->dev, "Realtek RTL2832 successfully attached\n");
        return 0;
@@ -1333,4 +1301,3 @@ module_i2c_driver(rtl2832_driver);
 MODULE_AUTHOR("Thomas Mair <mair.thomas86@gmail.com>");
 MODULE_DESCRIPTION("Realtek RTL2832 DVB-T demodulator driver");
 MODULE_LICENSE("GPL");
-MODULE_VERSION("0.5");