]> git.proxmox.com Git - mirror_ubuntu-artful-kernel.git/blobdiff - drivers/media/dvb-frontends/af9033.c
Merge branches 'for-4.11/upstream-fixes', 'for-4.12/accutouch', 'for-4.12/cp2112...
[mirror_ubuntu-artful-kernel.git] / drivers / media / dvb-frontends / af9033.c
index 765d05a4f478a9ce8b4a322edbae5c009ba12f0d..aaed7cfe5f6660d608084607c8d5d2afa5f1848e 100644 (file)
  *    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 Street, Fifth Floor, Boston, MA 02110-1301 USA.
  */
 
 #include "af9033_priv.h"
@@ -41,18 +37,19 @@ struct af9033_dev {
        u64 total_block_count;
 };
 
-/* write reg val table using reg addr auto increment */
+/* Write reg val table using reg addr auto increment */
 static int af9033_wr_reg_val_tab(struct af9033_dev *dev,
-               const struct reg_val *tab, int tab_len)
+                                const struct reg_val *tab, int tab_len)
 {
+       struct i2c_client *client = dev->client;
 #define MAX_TAB_LEN 212
        int ret, i, j;
        u8 buf[1 + MAX_TAB_LEN];
 
-       dev_dbg(&dev->client->dev, "tab_len=%d\n", tab_len);
+       dev_dbg(&client->dev, "tab_len=%d\n", tab_len);
 
        if (tab_len > sizeof(buf)) {
-               dev_warn(&dev->client->dev, "tab len %d is too big\n", tab_len);
+               dev_warn(&client->dev, "tab len %d is too big\n", tab_len);
                return -EINVAL;
        }
 
@@ -72,16 +69,15 @@ static int af9033_wr_reg_val_tab(struct af9033_dev *dev,
        }
 
        return 0;
-
 err:
-       dev_dbg(&dev->client->dev, "failed=%d\n", ret);
-
+       dev_dbg(&client->dev, "failed=%d\n", ret);
        return ret;
 }
 
 static int af9033_init(struct dvb_frontend *fe)
 {
        struct af9033_dev *dev = fe->demodulator_priv;
+       struct i2c_client *client = dev->client;
        struct dtv_frontend_properties *c = &fe->dtv_property_cache;
        int ret, i, len;
        unsigned int utmp;
@@ -116,7 +112,9 @@ static int af9033_init(struct dvb_frontend *fe)
                { 0x800045, dev->cfg.adc_multiplier, 0xff },
        };
 
-       /* program clock control */
+       dev_dbg(&client->dev, "\n");
+
+       /* Main clk control */
        utmp = div_u64((u64)dev->cfg.clock * 0x80000, 1000000);
        buf[0] = (utmp >>  0) & 0xff;
        buf[1] = (utmp >>  8) & 0xff;
@@ -126,17 +124,15 @@ static int af9033_init(struct dvb_frontend *fe)
        if (ret)
                goto err;
 
-       dev_dbg(&dev->client->dev, "clk=%u clk_cw=%08x\n",
-               dev->cfg.clock, utmp);
+       dev_dbg(&client->dev, "clk=%u clk_cw=%08x\n", dev->cfg.clock, utmp);
 
-       /* program ADC control */
+       /* ADC clk control */
        for (i = 0; i < ARRAY_SIZE(clock_adc_lut); i++) {
                if (clock_adc_lut[i].clock == dev->cfg.clock)
                        break;
        }
        if (i == ARRAY_SIZE(clock_adc_lut)) {
-               dev_err(&dev->client->dev,
-                       "Couldn't find ADC config for clock=%d\n",
+               dev_err(&client->dev, "Couldn't find ADC config for clock %d\n",
                        dev->cfg.clock);
                goto err;
        }
@@ -149,10 +145,10 @@ static int af9033_init(struct dvb_frontend *fe)
        if (ret)
                goto err;
 
-       dev_dbg(&dev->client->dev, "adc=%u adc_cw=%06x\n",
+       dev_dbg(&client->dev, "adc=%u adc_cw=%06x\n",
                clock_adc_lut[i].adc, utmp);
 
-       /* program register table */
+       /* Config register table */
        for (i = 0; i < ARRAY_SIZE(tab); i++) {
                ret = regmap_update_bits(dev->regmap, tab[i].reg, tab[i].mask,
                                         tab[i].val);
@@ -160,14 +156,14 @@ static int af9033_init(struct dvb_frontend *fe)
                        goto err;
        }
 
-       /* clock output */
+       /* Demod clk output */
        if (dev->cfg.dyn0_clk) {
                ret = regmap_write(dev->regmap, 0x80fba8, 0x00);
                if (ret)
                        goto err;
        }
 
-       /* settings for TS interface */
+       /* TS interface */
        if (dev->cfg.ts_mode == AF9033_TS_MODE_USB) {
                ret = regmap_update_bits(dev->regmap, 0x80f9a5, 0x01, 0x00);
                if (ret)
@@ -184,8 +180,8 @@ static int af9033_init(struct dvb_frontend *fe)
                        goto err;
        }
 
-       /* load OFSM settings */
-       dev_dbg(&dev->client->dev, "load ofsm settings\n");
+       /* Demod core settings */
+       dev_dbg(&client->dev, "load ofsm settings\n");
        switch (dev->cfg.tuner) {
        case AF9033_TUNER_IT9135_38:
        case AF9033_TUNER_IT9135_51:
@@ -209,8 +205,8 @@ static int af9033_init(struct dvb_frontend *fe)
        if (ret)
                goto err;
 
-       /* load tuner specific settings */
-       dev_dbg(&dev->client->dev, "load tuner specific settings\n");
+       /* Demod tuner specific settings */
+       dev_dbg(&client->dev, "load tuner specific settings\n");
        switch (dev->cfg.tuner) {
        case AF9033_TUNER_TUA9001:
                len = ARRAY_SIZE(tuner_init_tua9001);
@@ -261,8 +257,8 @@ static int af9033_init(struct dvb_frontend *fe)
                init = tuner_init_it9135_62;
                break;
        default:
-               dev_dbg(&dev->client->dev, "unsupported tuner ID=%d\n",
-                               dev->cfg.tuner);
+               dev_dbg(&client->dev, "unsupported tuner ID=%d\n",
+                       dev->cfg.tuner);
                ret = -ENODEV;
                goto err;
        }
@@ -292,8 +288,8 @@ static int af9033_init(struct dvb_frontend *fe)
                        goto err;
        }
 
-       dev->bandwidth_hz = 0; /* force to program all parameters */
-       /* init stats here in order signal app which stats are supported */
+       dev->bandwidth_hz = 0; /* Force to program all parameters */
+       /* Init stats here in order signal app which stats are supported */
        c->strength.len = 1;
        c->strength.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
        c->cnr.len = 1;
@@ -308,19 +304,20 @@ static int af9033_init(struct dvb_frontend *fe)
        c->post_bit_error.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
 
        return 0;
-
 err:
-       dev_dbg(&dev->client->dev, "failed=%d\n", ret);
-
+       dev_dbg(&client->dev, "failed=%d\n", ret);
        return ret;
 }
 
 static int af9033_sleep(struct dvb_frontend *fe)
 {
        struct af9033_dev *dev = fe->demodulator_priv;
+       struct i2c_client *client = dev->client;
        int ret;
        unsigned int utmp;
 
+       dev_dbg(&client->dev, "\n");
+
        ret = regmap_write(dev->regmap, 0x80004c, 0x01);
        if (ret)
                goto err;
@@ -335,9 +332,9 @@ static int af9033_sleep(struct dvb_frontend *fe)
        if (ret)
                goto err;
 
-       /* prevent current leak (?) */
+       /* Prevent current leak by setting TS interface to parallel mode */
        if (dev->cfg.ts_mode == AF9033_TS_MODE_SERIAL) {
-               /* enable parallel TS */
+               /* Enable parallel TS */
                ret = regmap_update_bits(dev->regmap, 0x00d917, 0x01, 0x00);
                if (ret)
                        goto err;
@@ -347,15 +344,13 @@ static int af9033_sleep(struct dvb_frontend *fe)
        }
 
        return 0;
-
 err:
-       dev_dbg(&dev->client->dev, "failed=%d\n", ret);
-
+       dev_dbg(&client->dev, "failed=%d\n", ret);
        return ret;
 }
 
 static int af9033_get_tune_settings(struct dvb_frontend *fe,
-               struct dvb_frontend_tune_settings *fesettings)
+                                   struct dvb_frontend_tune_settings *fesettings)
 {
        /* 800 => 2000 because IT9135 v2 is slow to gain lock */
        fesettings->min_delay_ms = 2000;
@@ -368,16 +363,17 @@ static int af9033_get_tune_settings(struct dvb_frontend *fe,
 static int af9033_set_frontend(struct dvb_frontend *fe)
 {
        struct af9033_dev *dev = fe->demodulator_priv;
+       struct i2c_client *client = dev->client;
        struct dtv_frontend_properties *c = &fe->dtv_property_cache;
        int ret, i;
        unsigned int utmp, adc_freq;
        u8 tmp, buf[3], bandwidth_reg_val;
        u32 if_frequency;
 
-       dev_dbg(&dev->client->dev, "frequency=%d bandwidth_hz=%d\n",
-                       c->frequency, c->bandwidth_hz);
+       dev_dbg(&client->dev, "frequency=%u bandwidth_hz=%u\n",
+               c->frequency, c->bandwidth_hz);
 
-       /* check bandwidth */
+       /* Check bandwidth */
        switch (c->bandwidth_hz) {
        case 6000000:
                bandwidth_reg_val = 0x00;
@@ -389,26 +385,26 @@ static int af9033_set_frontend(struct dvb_frontend *fe)
                bandwidth_reg_val = 0x02;
                break;
        default:
-               dev_dbg(&dev->client->dev, "invalid bandwidth_hz\n");
+               dev_dbg(&client->dev, "invalid bandwidth_hz\n");
                ret = -EINVAL;
                goto err;
        }
 
-       /* program tuner */
+       /* Program tuner */
        if (fe->ops.tuner_ops.set_params)
                fe->ops.tuner_ops.set_params(fe);
 
-       /* program CFOE coefficients */
+       /* Coefficients */
        if (c->bandwidth_hz != dev->bandwidth_hz) {
                for (i = 0; i < ARRAY_SIZE(coeff_lut); i++) {
                        if (coeff_lut[i].clock == dev->cfg.clock &&
-                               coeff_lut[i].bandwidth_hz == c->bandwidth_hz) {
+                           coeff_lut[i].bandwidth_hz == c->bandwidth_hz) {
                                break;
                        }
                }
                if (i == ARRAY_SIZE(coeff_lut)) {
-                       dev_err(&dev->client->dev,
-                               "Couldn't find LUT config for clock=%d\n",
+                       dev_err(&client->dev,
+                               "Couldn't find config for clock %u\n",
                                dev->cfg.clock);
                        ret = -EINVAL;
                        goto err;
@@ -420,15 +416,15 @@ static int af9033_set_frontend(struct dvb_frontend *fe)
                        goto err;
        }
 
-       /* program frequency control */
+       /* IF frequency control */
        if (c->bandwidth_hz != dev->bandwidth_hz) {
                for (i = 0; i < ARRAY_SIZE(clock_adc_lut); i++) {
                        if (clock_adc_lut[i].clock == dev->cfg.clock)
                                break;
                }
                if (i == ARRAY_SIZE(clock_adc_lut)) {
-                       dev_err(&dev->client->dev,
-                               "Couldn't find ADC clock for clock=%d\n",
+                       dev_err(&client->dev,
+                               "Couldn't find ADC clock for clock %u\n",
                                dev->cfg.clock);
                        ret = -EINVAL;
                        goto err;
@@ -438,7 +434,7 @@ static int af9033_set_frontend(struct dvb_frontend *fe)
                if (dev->cfg.adc_multiplier == AF9033_ADC_MULTIPLIER_2X)
                        adc_freq = 2 * adc_freq;
 
-               /* get used IF frequency */
+               /* Get used IF frequency */
                if (fe->ops.tuner_ops.get_if_frequency)
                        fe->ops.tuner_ops.get_if_frequency(fe, &if_frequency);
                else
@@ -457,7 +453,7 @@ static int af9033_set_frontend(struct dvb_frontend *fe)
                if (ret)
                        goto err;
 
-               dev_dbg(&dev->client->dev, "if_frequency_cw=%06x\n", utmp);
+               dev_dbg(&client->dev, "if_frequency_cw=%06x\n", utmp);
 
                dev->bandwidth_hz = c->bandwidth_hz;
        }
@@ -484,15 +480,14 @@ static int af9033_set_frontend(struct dvb_frontend *fe)
        ret = regmap_write(dev->regmap, 0x80004b, tmp);
        if (ret)
                goto err;
+       /* Reset FSM */
        ret = regmap_write(dev->regmap, 0x800000, 0x00);
        if (ret)
                goto err;
 
        return 0;
-
 err:
-       dev_dbg(&dev->client->dev, "failed=%d\n", ret);
-
+       dev_dbg(&client->dev, "failed=%d\n", ret);
        return ret;
 }
 
@@ -500,12 +495,13 @@ static int af9033_get_frontend(struct dvb_frontend *fe,
                               struct dtv_frontend_properties *c)
 {
        struct af9033_dev *dev = fe->demodulator_priv;
+       struct i2c_client *client = dev->client;
        int ret;
        u8 buf[8];
 
-       dev_dbg(&dev->client->dev, "\n");
+       dev_dbg(&client->dev, "\n");
 
-       /* read all needed registers */
+       /* Read all needed TPS registers */
        ret = regmap_bulk_read(dev->regmap, 0x80f900, buf, 8);
        if (ret)
                goto err;
@@ -616,31 +612,30 @@ static int af9033_get_frontend(struct dvb_frontend *fe,
        }
 
        return 0;
-
 err:
-       dev_dbg(&dev->client->dev, "failed=%d\n", ret);
-
+       dev_dbg(&client->dev, "failed=%d\n", ret);
        return ret;
 }
 
 static int af9033_read_status(struct dvb_frontend *fe, enum fe_status *status)
 {
        struct af9033_dev *dev = fe->demodulator_priv;
+       struct i2c_client *client = dev->client;
        struct dtv_frontend_properties *c = &fe->dtv_property_cache;
-       int ret, i, tmp = 0;
+       int ret, tmp = 0;
        u8 buf[7];
-       unsigned int utmp;
+       unsigned int utmp, utmp1;
 
-       dev_dbg(&dev->client->dev, "\n");
+       dev_dbg(&client->dev, "\n");
 
        *status = 0;
 
-       /* radio channel status, 0=no result, 1=has signal, 2=no signal */
+       /* Radio channel status: 0=no result, 1=has signal, 2=no signal */
        ret = regmap_read(dev->regmap, 0x800047, &utmp);
        if (ret)
                goto err;
 
-       /* has signal */
+       /* Has signal */
        if (utmp == 0x01)
                *status |= FE_HAS_SIGNAL;
 
@@ -654,7 +649,7 @@ static int af9033_read_status(struct dvb_frontend *fe, enum fe_status *status)
                        *status |= FE_HAS_SIGNAL | FE_HAS_CARRIER |
                                        FE_HAS_VITERBI;
 
-               /* full lock */
+               /* Full lock */
                ret = regmap_read(dev->regmap, 0x80f999, &utmp);
                if (ret)
                        goto err;
@@ -667,7 +662,7 @@ static int af9033_read_status(struct dvb_frontend *fe, enum fe_status *status)
 
        dev->fe_status = *status;
 
-       /* signal strength */
+       /* Signal strength */
        if (dev->fe_status & FE_HAS_SIGNAL) {
                if (dev->is_af9035) {
                        ret = regmap_read(dev->regmap, 0x80004a, &utmp);
@@ -691,87 +686,101 @@ static int af9033_read_status(struct dvb_frontend *fe, enum fe_status *status)
 
        /* CNR */
        if (dev->fe_status & FE_HAS_VITERBI) {
-               u32 snr_val, snr_lut_size;
-               const struct val_snr *snr_lut = NULL;
-
-               /* read value */
+               /* Read raw SNR value */
                ret = regmap_bulk_read(dev->regmap, 0x80002c, buf, 3);
                if (ret)
                        goto err;
 
-               snr_val = (buf[2] << 16) | (buf[1] << 8) | (buf[0] << 0);
+               utmp1 = buf[2] << 16 | buf[1] << 8 | buf[0] << 0;
 
-               /* read superframe number */
+               /* Read superframe number */
                ret = regmap_read(dev->regmap, 0x80f78b, &utmp);
                if (ret)
                        goto err;
 
                if (utmp)
-                       snr_val /= utmp;
+                       utmp1 /= utmp;
 
-               /* read current transmission mode */
+               /* Read current transmission mode */
                ret = regmap_read(dev->regmap, 0x80f900, &utmp);
                if (ret)
                        goto err;
 
                switch ((utmp >> 0) & 3) {
                case 0:
-                       snr_val *= 4;
+                       /* 2k */
+                       utmp1 *= 4;
                        break;
                case 1:
-                       snr_val *= 1;
+                       /* 8k */
+                       utmp1 *= 1;
                        break;
                case 2:
-                       snr_val *= 2;
+                       /* 4k */
+                       utmp1 *= 2;
                        break;
                default:
-                       snr_val *= 0;
+                       utmp1 *= 0;
                        break;
                }
 
-               /* read current modulation */
+               /* Read current modulation */
                ret = regmap_read(dev->regmap, 0x80f903, &utmp);
                if (ret)
                        goto err;
 
                switch ((utmp >> 0) & 3) {
                case 0:
-                       snr_lut_size = ARRAY_SIZE(qpsk_snr_lut);
-                       snr_lut = qpsk_snr_lut;
+                       /*
+                        * QPSK
+                        * CNR[dB] 13 * -log10((1690000 - value) / value) + 2.6
+                        * value [653799, 1689999], 2.6 / 13 = 3355443
+                        */
+                       utmp1 = clamp(utmp1, 653799U, 1689999U);
+                       utmp1 = ((u64)(intlog10(utmp1)
+                                - intlog10(1690000 - utmp1)
+                                + 3355443) * 13 * 1000) >> 24;
                        break;
                case 1:
-                       snr_lut_size = ARRAY_SIZE(qam16_snr_lut);
-                       snr_lut = qam16_snr_lut;
+                       /*
+                        * QAM-16
+                        * CNR[dB] 6 * log10((value - 370000) / (828000 - value)) + 15.7
+                        * value [371105, 827999], 15.7 / 6 = 43900382
+                        */
+                       utmp1 = clamp(utmp1, 371105U, 827999U);
+                       utmp1 = ((u64)(intlog10(utmp1 - 370000)
+                                - intlog10(828000 - utmp1)
+                                + 43900382) * 6 * 1000) >> 24;
                        break;
                case 2:
-                       snr_lut_size = ARRAY_SIZE(qam64_snr_lut);
-                       snr_lut = qam64_snr_lut;
+                       /*
+                        * QAM-64
+                        * CNR[dB] 8 * log10((value - 193000) / (425000 - value)) + 23.8
+                        * value [193246, 424999], 23.8 / 8 = 49912218
+                        */
+                       utmp1 = clamp(utmp1, 193246U, 424999U);
+                       utmp1 = ((u64)(intlog10(utmp1 - 193000)
+                                - intlog10(425000 - utmp1)
+                                + 49912218) * 8 * 1000) >> 24;
                        break;
                default:
-                       snr_lut_size = 0;
-                       tmp = 0;
+                       utmp1 = 0;
                        break;
                }
 
-               for (i = 0; i < snr_lut_size; i++) {
-                       tmp = snr_lut[i].snr * 1000;
-                       if (snr_val < snr_lut[i].val)
-                               break;
-               }
+               dev_dbg(&client->dev, "cnr=%u\n", utmp1);
 
-               c->cnr.len = 1;
                c->cnr.stat[0].scale = FE_SCALE_DECIBEL;
-               c->cnr.stat[0].svalue = tmp;
+               c->cnr.stat[0].svalue = utmp1;
        } else {
-               c->cnr.len = 1;
                c->cnr.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
        }
 
        /* UCB/PER/BER */
        if (dev->fe_status & FE_HAS_LOCK) {
-               /* outer FEC, 204 byte packets */
+               /* Outer FEC, 204 byte packets */
                u16 abort_packet_count, rsd_packet_count;
-               /* inner FEC, bits */
+               /* Inner FEC, bits */
                u32 rsd_bit_err_count;
 
                /*
@@ -810,21 +819,22 @@ static int af9033_read_status(struct dvb_frontend *fe, enum fe_status *status)
        }
 
        return 0;
-
 err:
-       dev_dbg(&dev->client->dev, "failed=%d\n", ret);
-
+       dev_dbg(&client->dev, "failed=%d\n", ret);
        return ret;
 }
 
 static int af9033_read_snr(struct dvb_frontend *fe, u16 *snr)
 {
        struct af9033_dev *dev = fe->demodulator_priv;
+       struct i2c_client *client = dev->client;
        struct dtv_frontend_properties *c = &dev->fe.dtv_property_cache;
        int ret;
        unsigned int utmp;
 
-       /* use DVBv5 CNR */
+       dev_dbg(&client->dev, "\n");
+
+       /* Use DVBv5 CNR */
        if (c->cnr.stat[0].scale == FE_SCALE_DECIBEL) {
                /* Return 0.1 dB for AF9030 and 0-0xffff for IT9130. */
                if (dev->is_af9035) {
@@ -834,7 +844,7 @@ static int af9033_read_snr(struct dvb_frontend *fe, u16 *snr)
                        /* 1000x => 1x (1 dB) */
                        *snr = div_s64(c->cnr.stat[0].svalue, 1000);
 
-                       /* read current modulation */
+                       /* Read current modulation */
                        ret = regmap_read(dev->regmap, 0x80f903, &utmp);
                        if (ret)
                                goto err;
@@ -859,28 +869,29 @@ static int af9033_read_snr(struct dvb_frontend *fe, u16 *snr)
        }
 
        return 0;
-
 err:
-       dev_dbg(&dev->client->dev, "failed=%d\n", ret);
-
+       dev_dbg(&client->dev, "failed=%d\n", ret);
        return ret;
 }
 
 static int af9033_read_signal_strength(struct dvb_frontend *fe, u16 *strength)
 {
        struct af9033_dev *dev = fe->demodulator_priv;
+       struct i2c_client *client = dev->client;
        struct dtv_frontend_properties *c = &dev->fe.dtv_property_cache;
        int ret, tmp, power_real;
        unsigned int utmp;
        u8 gain_offset, buf[7];
 
+       dev_dbg(&client->dev, "\n");
+
        if (dev->is_af9035) {
-               /* read signal strength of 0-100 scale */
+               /* Read signal strength of 0-100 scale */
                ret = regmap_read(dev->regmap, 0x800048, &utmp);
                if (ret)
                        goto err;
 
-               /* scale value to 0x0000-0xffff */
+               /* Scale value to 0x0000-0xffff */
                *strength = utmp * 0xffff / 100;
        } else {
                ret = regmap_read(dev->regmap, 0x8000f7, &utmp);
@@ -910,15 +921,13 @@ static int af9033_read_signal_strength(struct dvb_frontend *fe, u16 *strength)
                else
                        tmp = 100;
 
-               /* scale value to 0x0000-0xffff */
+               /* Scale value to 0x0000-0xffff */
                *strength = tmp * 0xffff / 100;
        }
 
        return 0;
-
 err:
-       dev_dbg(&dev->client->dev, "failed=%d\n", ret);
-
+       dev_dbg(&client->dev, "failed=%d\n", ret);
        return ret;
 }
 
@@ -937,56 +946,56 @@ static int af9033_read_ucblocks(struct dvb_frontend *fe, u32 *ucblocks)
        struct af9033_dev *dev = fe->demodulator_priv;
 
        *ucblocks = dev->error_block_count;
+
        return 0;
 }
 
 static int af9033_i2c_gate_ctrl(struct dvb_frontend *fe, int enable)
 {
        struct af9033_dev *dev = fe->demodulator_priv;
+       struct i2c_client *client = dev->client;
        int ret;
 
-       dev_dbg(&dev->client->dev, "enable=%d\n", enable);
+       dev_dbg(&client->dev, "enable=%d\n", enable);
 
        ret = regmap_update_bits(dev->regmap, 0x00fa04, 0x01, enable);
        if (ret)
                goto err;
 
        return 0;
-
 err:
-       dev_dbg(&dev->client->dev, "failed=%d\n", ret);
-
+       dev_dbg(&client->dev, "failed=%d\n", ret);
        return ret;
 }
 
 static int af9033_pid_filter_ctrl(struct dvb_frontend *fe, int onoff)
 {
        struct af9033_dev *dev = fe->demodulator_priv;
+       struct i2c_client *client = dev->client;
        int ret;
 
-       dev_dbg(&dev->client->dev, "onoff=%d\n", onoff);
+       dev_dbg(&client->dev, "onoff=%d\n", onoff);
 
        ret = regmap_update_bits(dev->regmap, 0x80f993, 0x01, onoff);
        if (ret)
                goto err;
 
        return 0;
-
 err:
-       dev_dbg(&dev->client->dev, "failed=%d\n", ret);
-
+       dev_dbg(&client->dev, "failed=%d\n", ret);
        return ret;
 }
 
 static int af9033_pid_filter(struct dvb_frontend *fe, int index, u16 pid,
-               int onoff)
+                            int onoff)
 {
        struct af9033_dev *dev = fe->demodulator_priv;
+       struct i2c_client *client = dev->client;
        int ret;
        u8 wbuf[2] = {(pid >> 0) & 0xff, (pid >> 8) & 0xff};
 
-       dev_dbg(&dev->client->dev, "index=%d pid=%04x onoff=%d\n",
-                       index, pid, onoff);
+       dev_dbg(&client->dev, "index=%d pid=%04x onoff=%d\n",
+               index, pid, onoff);
 
        if (pid > 0x1fff)
                return 0;
@@ -1002,15 +1011,13 @@ static int af9033_pid_filter(struct dvb_frontend *fe, int index, u16 pid,
                goto err;
 
        return 0;
-
 err:
-       dev_dbg(&dev->client->dev, "failed=%d\n", ret);
-
+       dev_dbg(&client->dev, "failed=%d\n", ret);
        return ret;
 }
 
 static const struct dvb_frontend_ops af9033_ops = {
-       .delsys = { SYS_DVBT },
+       .delsys = {SYS_DVBT},
        .info = {
                .name = "Afatech AF9033 (DVB-T)",
                .frequency_min = 174000000,
@@ -1051,7 +1058,7 @@ static const struct dvb_frontend_ops af9033_ops = {
 };
 
 static int af9033_probe(struct i2c_client *client,
-               const struct i2c_device_id *id)
+                       const struct i2c_device_id *id)
 {
        struct af9033_config *cfg = client->dev.platform_data;
        struct af9033_dev *dev;
@@ -1063,24 +1070,34 @@ static int af9033_probe(struct i2c_client *client,
                .val_bits    =  8,
        };
 
-
-       /* allocate memory for the internal state */
-       dev = kzalloc(sizeof(struct af9033_dev), GFP_KERNEL);
-       if (dev == NULL) {
+       /* Allocate memory for the internal state */
+       dev = kzalloc(sizeof(*dev), GFP_KERNEL);
+       if (!dev) {
                ret = -ENOMEM;
-               dev_err(&client->dev, "Could not allocate memory for state\n");
                goto err;
        }
 
-       /* setup the state */
+       /* Setup the state */
        dev->client = client;
-       memcpy(&dev->cfg, cfg, sizeof(struct af9033_config));
+       memcpy(&dev->cfg, cfg, sizeof(dev->cfg));
+       switch (dev->cfg.ts_mode) {
+       case AF9033_TS_MODE_PARALLEL:
+               dev->ts_mode_parallel = true;
+               break;
+       case AF9033_TS_MODE_SERIAL:
+               dev->ts_mode_serial = true;
+               break;
+       case AF9033_TS_MODE_USB:
+               /* USB mode for AF9035 */
+       default:
+               break;
+       }
 
        if (dev->cfg.clock != 12000000) {
                ret = -ENODEV;
-               dev_err(&dev->client->dev,
-                               "unsupported clock %d Hz, only 12000000 Hz is supported currently\n",
-                               dev->cfg.clock);
+               dev_err(&client->dev,
+                       "Unsupported clock %u Hz. Only 12000000 Hz is supported currently\n",
+                       dev->cfg.clock);
                goto err_kfree;
        }
 
@@ -1091,7 +1108,7 @@ static int af9033_probe(struct i2c_client *client,
                goto err_kfree;
        }
 
-       /* firmware version */
+       /* Firmware version */
        switch (dev->cfg.tuner) {
        case AF9033_TUNER_IT9135_38:
        case AF9033_TUNER_IT9135_51:
@@ -1115,12 +1132,12 @@ static int af9033_probe(struct i2c_client *client,
        if (ret)
                goto err_regmap_exit;
 
-       dev_info(&dev->client->dev,
-                       "firmware version: LINK %d.%d.%d.%d - OFDM %d.%d.%d.%d\n",
-                       buf[0], buf[1], buf[2], buf[3], buf[4], buf[5], buf[6],
-                       buf[7]);
+       dev_info(&client->dev,
+                "firmware version: LINK %d.%d.%d.%d - OFDM %d.%d.%d.%d\n",
+                buf[0], buf[1], buf[2], buf[3],
+                buf[4], buf[5], buf[6], buf[7]);
 
-       /* sleep */
+       /* Sleep as chip seems to be partly active by default */
        switch (dev->cfg.tuner) {
        case AF9033_TUNER_IT9135_38:
        case AF9033_TUNER_IT9135_51:
@@ -1139,31 +1156,19 @@ static int af9033_probe(struct i2c_client *client,
                        goto err_regmap_exit;
        }
 
-       /* configure internal TS mode */
-       switch (dev->cfg.ts_mode) {
-       case AF9033_TS_MODE_PARALLEL:
-               dev->ts_mode_parallel = true;
-               break;
-       case AF9033_TS_MODE_SERIAL:
-               dev->ts_mode_serial = true;
-               break;
-       case AF9033_TS_MODE_USB:
-               /* usb mode for AF9035 */
-       default:
-               break;
-       }
-
-       /* create dvb_frontend */
-       memcpy(&dev->fe.ops, &af9033_ops, sizeof(struct dvb_frontend_ops));
+       /* Create dvb frontend */
+       memcpy(&dev->fe.ops, &af9033_ops, sizeof(dev->fe.ops));
        dev->fe.demodulator_priv = dev;
        *cfg->fe = &dev->fe;
        if (cfg->ops) {
                cfg->ops->pid_filter = af9033_pid_filter;
                cfg->ops->pid_filter_ctrl = af9033_pid_filter_ctrl;
        }
+       cfg->regmap = dev->regmap;
        i2c_set_clientdata(client, dev);
 
-       dev_info(&dev->client->dev, "Afatech AF9033 successfully attached\n");
+       dev_info(&client->dev, "Afatech AF9033 successfully attached\n");
+
        return 0;
 err_regmap_exit:
        regmap_exit(dev->regmap);
@@ -1178,12 +1183,9 @@ static int af9033_remove(struct i2c_client *client)
 {
        struct af9033_dev *dev = i2c_get_clientdata(client);
 
-       dev_dbg(&dev->client->dev, "\n");
+       dev_dbg(&client->dev, "\n");
 
        regmap_exit(dev->regmap);
-
-       dev->fe.ops.release = NULL;
-       dev->fe.demodulator_priv = NULL;
        kfree(dev);
 
        return 0;