]> git.kernelconcepts.de Git - karo-tx-linux.git/blobdiff - drivers/media/dvb/frontends/cxd2820r_core.c
Merge tag 'for-3.3-rc3' of git://git.kernel.org/pub/scm/linux/kernel/git/balbi/usb...
[karo-tx-linux.git] / drivers / media / dvb / frontends / cxd2820r_core.c
index 036480f967b7b73c21a42004e17e1a8d2bc018ef..5c7c2aaf9bf58583eb52ed6f3ba7b4d48df6d29b 100644 (file)
@@ -240,422 +240,239 @@ error:
        return ret;
 }
 
-/* lock FE */
-static int cxd2820r_lock(struct cxd2820r_priv *priv, int active_fe)
-{
-       int ret = 0;
-       dbg("%s: active_fe=%d", __func__, active_fe);
-
-       mutex_lock(&priv->fe_lock);
-
-       /* -1=NONE, 0=DVB-T/T2, 1=DVB-C */
-       if (priv->active_fe == active_fe)
-               ;
-       else if (priv->active_fe == -1)
-               priv->active_fe = active_fe;
-       else
-               ret = -EBUSY;
-
-       mutex_unlock(&priv->fe_lock);
-
-       return ret;
-}
-
-/* unlock FE */
-static void cxd2820r_unlock(struct cxd2820r_priv *priv, int active_fe)
-{
-       dbg("%s: active_fe=%d", __func__, active_fe);
-
-       mutex_lock(&priv->fe_lock);
-
-       /* -1=NONE, 0=DVB-T/T2, 1=DVB-C */
-       if (priv->active_fe == active_fe)
-               priv->active_fe = -1;
-
-       mutex_unlock(&priv->fe_lock);
-
-       return;
-}
-
 /* 64 bit div with round closest, like DIV_ROUND_CLOSEST but 64 bit */
 u32 cxd2820r_div_u64_round_closest(u64 dividend, u32 divisor)
 {
        return div_u64(dividend + (divisor / 2), divisor);
 }
 
-static int cxd2820r_set_frontend(struct dvb_frontend *fe,
-       struct dvb_frontend_parameters *p)
+static int cxd2820r_set_frontend(struct dvb_frontend *fe)
 {
-       struct cxd2820r_priv *priv = fe->demodulator_priv;
        struct dtv_frontend_properties *c = &fe->dtv_property_cache;
        int ret;
-       dbg("%s: delsys=%d", __func__, fe->dtv_property_cache.delivery_system);
-
-       if (fe->ops.info.type == FE_OFDM) {
-               /* DVB-T/T2 */
-               ret = cxd2820r_lock(priv, 0);
-               if (ret)
-                       return ret;
-
-               switch (priv->delivery_system) {
-               case SYS_UNDEFINED:
-                       if (c->delivery_system == SYS_DVBT) {
-                               /* SLEEP => DVB-T */
-                               ret = cxd2820r_set_frontend_t(fe, p);
-                       } else {
-                               /* SLEEP => DVB-T2 */
-                               ret = cxd2820r_set_frontend_t2(fe, p);
-                       }
-                       break;
-               case SYS_DVBT:
-                       if (c->delivery_system == SYS_DVBT) {
-                               /* DVB-T => DVB-T */
-                               ret = cxd2820r_set_frontend_t(fe, p);
-                       } else if (c->delivery_system == SYS_DVBT2) {
-                               /* DVB-T => DVB-T2 */
-                               ret = cxd2820r_sleep_t(fe);
-                               if (ret)
-                                       break;
-                               ret = cxd2820r_set_frontend_t2(fe, p);
-                       }
-                       break;
-               case SYS_DVBT2:
-                       if (c->delivery_system == SYS_DVBT2) {
-                               /* DVB-T2 => DVB-T2 */
-                               ret = cxd2820r_set_frontend_t2(fe, p);
-                       } else if (c->delivery_system == SYS_DVBT) {
-                               /* DVB-T2 => DVB-T */
-                               ret = cxd2820r_sleep_t2(fe);
-                               if (ret)
-                                       break;
-                               ret = cxd2820r_set_frontend_t(fe, p);
-                       }
-                       break;
-               default:
-                       dbg("%s: error state=%d", __func__,
-                               priv->delivery_system);
-                       ret = -EINVAL;
-               }
-       } else {
-               /* DVB-C */
-               ret = cxd2820r_lock(priv, 1);
-               if (ret)
-                       return ret;
 
-               ret = cxd2820r_set_frontend_c(fe, p);
+       dbg("%s: delsys=%d", __func__, fe->dtv_property_cache.delivery_system);
+       switch (c->delivery_system) {
+       case SYS_DVBT:
+               ret = cxd2820r_init_t(fe);
+               if (ret < 0)
+                       goto err;
+               ret = cxd2820r_set_frontend_t(fe);
+               if (ret < 0)
+                       goto err;
+               break;
+       case SYS_DVBT2:
+               ret = cxd2820r_init_t(fe);
+               if (ret < 0)
+                       goto err;
+               ret = cxd2820r_set_frontend_t2(fe);
+               if (ret < 0)
+                       goto err;
+               break;
+       case SYS_DVBC_ANNEX_A:
+               ret = cxd2820r_init_c(fe);
+               if (ret < 0)
+                       goto err;
+               ret = cxd2820r_set_frontend_c(fe);
+               if (ret < 0)
+                       goto err;
+               break;
+       default:
+               dbg("%s: error state=%d", __func__, fe->dtv_property_cache.delivery_system);
+               ret = -EINVAL;
+               break;
        }
-
+err:
        return ret;
 }
-
 static int cxd2820r_read_status(struct dvb_frontend *fe, fe_status_t *status)
 {
-       struct cxd2820r_priv *priv = fe->demodulator_priv;
        int ret;
-       dbg("%s: delsys=%d", __func__, fe->dtv_property_cache.delivery_system);
-
-       if (fe->ops.info.type == FE_OFDM) {
-               /* DVB-T/T2 */
-               ret = cxd2820r_lock(priv, 0);
-               if (ret)
-                       return ret;
-
-               switch (fe->dtv_property_cache.delivery_system) {
-               case SYS_DVBT:
-                       ret = cxd2820r_read_status_t(fe, status);
-                       break;
-               case SYS_DVBT2:
-                       ret = cxd2820r_read_status_t2(fe, status);
-                       break;
-               default:
-                       ret = -EINVAL;
-               }
-       } else {
-               /* DVB-C */
-               ret = cxd2820r_lock(priv, 1);
-               if (ret)
-                       return ret;
 
+       dbg("%s: delsys=%d", __func__, fe->dtv_property_cache.delivery_system);
+       switch (fe->dtv_property_cache.delivery_system) {
+       case SYS_DVBT:
+               ret = cxd2820r_read_status_t(fe, status);
+               break;
+       case SYS_DVBT2:
+               ret = cxd2820r_read_status_t2(fe, status);
+               break;
+       case SYS_DVBC_ANNEX_A:
                ret = cxd2820r_read_status_c(fe, status);
+               break;
+       default:
+               ret = -EINVAL;
+               break;
        }
-
        return ret;
 }
 
-static int cxd2820r_get_frontend(struct dvb_frontend *fe,
-       struct dvb_frontend_parameters *p)
+static int cxd2820r_get_frontend(struct dvb_frontend *fe)
 {
        struct cxd2820r_priv *priv = fe->demodulator_priv;
        int ret;
-       dbg("%s: delsys=%d", __func__, fe->dtv_property_cache.delivery_system);
 
-       if (fe->ops.info.type == FE_OFDM) {
-               /* DVB-T/T2 */
-               ret = cxd2820r_lock(priv, 0);
-               if (ret)
-                       return ret;
+       dbg("%s: delsys=%d", __func__, fe->dtv_property_cache.delivery_system);
 
-               switch (fe->dtv_property_cache.delivery_system) {
-               case SYS_DVBT:
-                       ret = cxd2820r_get_frontend_t(fe, p);
-                       break;
-               case SYS_DVBT2:
-                       ret = cxd2820r_get_frontend_t2(fe, p);
-                       break;
-               default:
-                       ret = -EINVAL;
-               }
-       } else {
-               /* DVB-C */
-               ret = cxd2820r_lock(priv, 1);
-               if (ret)
-                       return ret;
+       if (priv->delivery_system == SYS_UNDEFINED)
+               return 0;
 
-               ret = cxd2820r_get_frontend_c(fe, p);
+       switch (fe->dtv_property_cache.delivery_system) {
+       case SYS_DVBT:
+               ret = cxd2820r_get_frontend_t(fe);
+               break;
+       case SYS_DVBT2:
+               ret = cxd2820r_get_frontend_t2(fe);
+               break;
+       case SYS_DVBC_ANNEX_A:
+               ret = cxd2820r_get_frontend_c(fe);
+               break;
+       default:
+               ret = -EINVAL;
+               break;
        }
-
        return ret;
 }
 
 static int cxd2820r_read_ber(struct dvb_frontend *fe, u32 *ber)
 {
-       struct cxd2820r_priv *priv = fe->demodulator_priv;
        int ret;
-       dbg("%s: delsys=%d", __func__, fe->dtv_property_cache.delivery_system);
-
-       if (fe->ops.info.type == FE_OFDM) {
-               /* DVB-T/T2 */
-               ret = cxd2820r_lock(priv, 0);
-               if (ret)
-                       return ret;
-
-               switch (fe->dtv_property_cache.delivery_system) {
-               case SYS_DVBT:
-                       ret = cxd2820r_read_ber_t(fe, ber);
-                       break;
-               case SYS_DVBT2:
-                       ret = cxd2820r_read_ber_t2(fe, ber);
-                       break;
-               default:
-                       ret = -EINVAL;
-               }
-       } else {
-               /* DVB-C */
-               ret = cxd2820r_lock(priv, 1);
-               if (ret)
-                       return ret;
 
+       dbg("%s: delsys=%d", __func__, fe->dtv_property_cache.delivery_system);
+       switch (fe->dtv_property_cache.delivery_system) {
+       case SYS_DVBT:
+               ret = cxd2820r_read_ber_t(fe, ber);
+               break;
+       case SYS_DVBT2:
+               ret = cxd2820r_read_ber_t2(fe, ber);
+               break;
+       case SYS_DVBC_ANNEX_A:
                ret = cxd2820r_read_ber_c(fe, ber);
+               break;
+       default:
+               ret = -EINVAL;
+               break;
        }
-
        return ret;
 }
 
 static int cxd2820r_read_signal_strength(struct dvb_frontend *fe, u16 *strength)
 {
-       struct cxd2820r_priv *priv = fe->demodulator_priv;
        int ret;
-       dbg("%s: delsys=%d", __func__, fe->dtv_property_cache.delivery_system);
-
-       if (fe->ops.info.type == FE_OFDM) {
-               /* DVB-T/T2 */
-               ret = cxd2820r_lock(priv, 0);
-               if (ret)
-                       return ret;
-
-               switch (fe->dtv_property_cache.delivery_system) {
-               case SYS_DVBT:
-                       ret = cxd2820r_read_signal_strength_t(fe, strength);
-                       break;
-               case SYS_DVBT2:
-                       ret = cxd2820r_read_signal_strength_t2(fe, strength);
-                       break;
-               default:
-                       ret = -EINVAL;
-               }
-       } else {
-               /* DVB-C */
-               ret = cxd2820r_lock(priv, 1);
-               if (ret)
-                       return ret;
 
+       dbg("%s: delsys=%d", __func__, fe->dtv_property_cache.delivery_system);
+       switch (fe->dtv_property_cache.delivery_system) {
+       case SYS_DVBT:
+               ret = cxd2820r_read_signal_strength_t(fe, strength);
+               break;
+       case SYS_DVBT2:
+               ret = cxd2820r_read_signal_strength_t2(fe, strength);
+               break;
+       case SYS_DVBC_ANNEX_A:
                ret = cxd2820r_read_signal_strength_c(fe, strength);
+               break;
+       default:
+               ret = -EINVAL;
+               break;
        }
-
        return ret;
 }
 
 static int cxd2820r_read_snr(struct dvb_frontend *fe, u16 *snr)
 {
-       struct cxd2820r_priv *priv = fe->demodulator_priv;
        int ret;
-       dbg("%s: delsys=%d", __func__, fe->dtv_property_cache.delivery_system);
-
-       if (fe->ops.info.type == FE_OFDM) {
-               /* DVB-T/T2 */
-               ret = cxd2820r_lock(priv, 0);
-               if (ret)
-                       return ret;
-
-               switch (fe->dtv_property_cache.delivery_system) {
-               case SYS_DVBT:
-                       ret = cxd2820r_read_snr_t(fe, snr);
-                       break;
-               case SYS_DVBT2:
-                       ret = cxd2820r_read_snr_t2(fe, snr);
-                       break;
-               default:
-                       ret = -EINVAL;
-               }
-       } else {
-               /* DVB-C */
-               ret = cxd2820r_lock(priv, 1);
-               if (ret)
-                       return ret;
 
+       dbg("%s: delsys=%d", __func__, fe->dtv_property_cache.delivery_system);
+       switch (fe->dtv_property_cache.delivery_system) {
+       case SYS_DVBT:
+               ret = cxd2820r_read_snr_t(fe, snr);
+               break;
+       case SYS_DVBT2:
+               ret = cxd2820r_read_snr_t2(fe, snr);
+               break;
+       case SYS_DVBC_ANNEX_A:
                ret = cxd2820r_read_snr_c(fe, snr);
+               break;
+       default:
+               ret = -EINVAL;
+               break;
        }
-
        return ret;
 }
 
 static int cxd2820r_read_ucblocks(struct dvb_frontend *fe, u32 *ucblocks)
 {
-       struct cxd2820r_priv *priv = fe->demodulator_priv;
        int ret;
-       dbg("%s: delsys=%d", __func__, fe->dtv_property_cache.delivery_system);
-
-       if (fe->ops.info.type == FE_OFDM) {
-               /* DVB-T/T2 */
-               ret = cxd2820r_lock(priv, 0);
-               if (ret)
-                       return ret;
-
-               switch (fe->dtv_property_cache.delivery_system) {
-               case SYS_DVBT:
-                       ret = cxd2820r_read_ucblocks_t(fe, ucblocks);
-                       break;
-               case SYS_DVBT2:
-                       ret = cxd2820r_read_ucblocks_t2(fe, ucblocks);
-                       break;
-               default:
-                       ret = -EINVAL;
-               }
-       } else {
-               /* DVB-C */
-               ret = cxd2820r_lock(priv, 1);
-               if (ret)
-                       return ret;
 
+       dbg("%s: delsys=%d", __func__, fe->dtv_property_cache.delivery_system);
+       switch (fe->dtv_property_cache.delivery_system) {
+       case SYS_DVBT:
+               ret = cxd2820r_read_ucblocks_t(fe, ucblocks);
+               break;
+       case SYS_DVBT2:
+               ret = cxd2820r_read_ucblocks_t2(fe, ucblocks);
+               break;
+       case SYS_DVBC_ANNEX_A:
                ret = cxd2820r_read_ucblocks_c(fe, ucblocks);
+               break;
+       default:
+               ret = -EINVAL;
+               break;
        }
-
        return ret;
 }
 
 static int cxd2820r_init(struct dvb_frontend *fe)
 {
-       struct cxd2820r_priv *priv = fe->demodulator_priv;
-       int ret;
-       dbg("%s: delsys=%d", __func__, fe->dtv_property_cache.delivery_system);
-
-       priv->delivery_system = SYS_UNDEFINED;
-       /* delivery system is unknown at that (init) phase */
-
-       if (fe->ops.info.type == FE_OFDM) {
-               /* DVB-T/T2 */
-               ret = cxd2820r_lock(priv, 0);
-               if (ret)
-                       return ret;
-
-               ret = cxd2820r_init_t(fe);
-       } else {
-               /* DVB-C */
-               ret = cxd2820r_lock(priv, 1);
-               if (ret)
-                       return ret;
-
-               ret = cxd2820r_init_c(fe);
-       }
-
-       return ret;
+       return 0;
 }
 
 static int cxd2820r_sleep(struct dvb_frontend *fe)
 {
-       struct cxd2820r_priv *priv = fe->demodulator_priv;
        int ret;
-       dbg("%s: delsys=%d", __func__, fe->dtv_property_cache.delivery_system);
-
-       if (fe->ops.info.type == FE_OFDM) {
-               /* DVB-T/T2 */
-               ret = cxd2820r_lock(priv, 0);
-               if (ret)
-                       return ret;
-
-               switch (fe->dtv_property_cache.delivery_system) {
-               case SYS_DVBT:
-                       ret = cxd2820r_sleep_t(fe);
-                       break;
-               case SYS_DVBT2:
-                       ret = cxd2820r_sleep_t2(fe);
-                       break;
-               default:
-                       ret = -EINVAL;
-               }
-
-               cxd2820r_unlock(priv, 0);
-       } else {
-               /* DVB-C */
-               ret = cxd2820r_lock(priv, 1);
-               if (ret)
-                       return ret;
 
+       dbg("%s: delsys=%d", __func__, fe->dtv_property_cache.delivery_system);
+       switch (fe->dtv_property_cache.delivery_system) {
+       case SYS_DVBT:
+               ret = cxd2820r_sleep_t(fe);
+               break;
+       case SYS_DVBT2:
+               ret = cxd2820r_sleep_t2(fe);
+               break;
+       case SYS_DVBC_ANNEX_A:
                ret = cxd2820r_sleep_c(fe);
-
-               cxd2820r_unlock(priv, 1);
+               break;
+       default:
+               ret = -EINVAL;
+               break;
        }
-
        return ret;
 }
 
 static int cxd2820r_get_tune_settings(struct dvb_frontend *fe,
-       struct dvb_frontend_tune_settings *s)
+                                     struct dvb_frontend_tune_settings *s)
 {
-       struct cxd2820r_priv *priv = fe->demodulator_priv;
        int ret;
-       dbg("%s: delsys=%d", __func__, fe->dtv_property_cache.delivery_system);
-
-       if (fe->ops.info.type == FE_OFDM) {
-               /* DVB-T/T2 */
-               ret = cxd2820r_lock(priv, 0);
-               if (ret)
-                       return ret;
-
-               switch (fe->dtv_property_cache.delivery_system) {
-               case SYS_DVBT:
-                       ret = cxd2820r_get_tune_settings_t(fe, s);
-                       break;
-               case SYS_DVBT2:
-                       ret = cxd2820r_get_tune_settings_t2(fe, s);
-                       break;
-               default:
-                       ret = -EINVAL;
-               }
-       } else {
-               /* DVB-C */
-               ret = cxd2820r_lock(priv, 1);
-               if (ret)
-                       return ret;
 
+       dbg("%s: delsys=%d", __func__, fe->dtv_property_cache.delivery_system);
+       switch (fe->dtv_property_cache.delivery_system) {
+       case SYS_DVBT:
+               ret = cxd2820r_get_tune_settings_t(fe, s);
+               break;
+       case SYS_DVBT2:
+               ret = cxd2820r_get_tune_settings_t2(fe, s);
+               break;
+       case SYS_DVBC_ANNEX_A:
                ret = cxd2820r_get_tune_settings_c(fe, s);
+               break;
+       default:
+               ret = -EINVAL;
+               break;
        }
-
        return ret;
 }
 
-static enum dvbfe_search cxd2820r_search(struct dvb_frontend *fe,
-       struct dvb_frontend_parameters *p)
+static enum dvbfe_search cxd2820r_search(struct dvb_frontend *fe)
 {
        struct cxd2820r_priv *priv = fe->demodulator_priv;
        struct dtv_frontend_properties *c = &fe->dtv_property_cache;
@@ -665,14 +482,23 @@ static enum dvbfe_search cxd2820r_search(struct dvb_frontend *fe,
 
        /* switch between DVB-T and DVB-T2 when tune fails */
        if (priv->last_tune_failed) {
-               if (priv->delivery_system == SYS_DVBT)
+               if (priv->delivery_system == SYS_DVBT) {
+                       ret = cxd2820r_sleep_t(fe);
+                       if (ret)
+                               goto error;
+
                        c->delivery_system = SYS_DVBT2;
-               else
+               } else if (priv->delivery_system == SYS_DVBT2) {
+                       ret = cxd2820r_sleep_t2(fe);
+                       if (ret)
+                               goto error;
+
                        c->delivery_system = SYS_DVBT;
+               }
        }
 
        /* set frontend */
-       ret = cxd2820r_set_frontend(fe, p);
+       ret = cxd2820r_set_frontend(fe);
        if (ret)
                goto error;
 
@@ -680,6 +506,7 @@ static enum dvbfe_search cxd2820r_search(struct dvb_frontend *fe,
        /* frontend lock wait loop count */
        switch (priv->delivery_system) {
        case SYS_DVBT:
+       case SYS_DVBC_ANNEX_A:
                i = 20;
                break;
        case SYS_DVBT2:
@@ -727,9 +554,7 @@ static void cxd2820r_release(struct dvb_frontend *fe)
        struct cxd2820r_priv *priv = fe->demodulator_priv;
        dbg("%s", __func__);
 
-       if (fe->ops.info.type == FE_OFDM)
-               kfree(priv);
-
+       kfree(priv);
        return;
 }
 
@@ -742,128 +567,80 @@ static int cxd2820r_i2c_gate_ctrl(struct dvb_frontend *fe, int enable)
        return cxd2820r_wr_reg_mask(priv, 0xdb, enable ? 1 : 0, 0x1);
 }
 
-static const struct dvb_frontend_ops cxd2820r_ops[2];
+static const struct dvb_frontend_ops cxd2820r_ops = {
+       .delsys = { SYS_DVBT, SYS_DVBT2, SYS_DVBC_ANNEX_A },
+       /* default: DVB-T/T2 */
+       .info = {
+               .name = "Sony CXD2820R",
+
+               .caps = FE_CAN_FEC_1_2                  |
+                       FE_CAN_FEC_2_3                  |
+                       FE_CAN_FEC_3_4                  |
+                       FE_CAN_FEC_5_6                  |
+                       FE_CAN_FEC_7_8                  |
+                       FE_CAN_FEC_AUTO                 |
+                       FE_CAN_QPSK                     |
+                       FE_CAN_QAM_16                   |
+                       FE_CAN_QAM_32                   |
+                       FE_CAN_QAM_64                   |
+                       FE_CAN_QAM_128                  |
+                       FE_CAN_QAM_256                  |
+                       FE_CAN_QAM_AUTO                 |
+                       FE_CAN_TRANSMISSION_MODE_AUTO   |
+                       FE_CAN_GUARD_INTERVAL_AUTO      |
+                       FE_CAN_HIERARCHY_AUTO           |
+                       FE_CAN_MUTE_TS                  |
+                       FE_CAN_2G_MODULATION
+               },
 
-struct dvb_frontend *cxd2820r_attach(const struct cxd2820r_config *cfg,
-       struct i2c_adapter *i2c, struct dvb_frontend *fe)
-{
-       int ret;
-       struct cxd2820r_priv *priv = NULL;
-       u8 tmp;
+       .release                = cxd2820r_release,
+       .init                   = cxd2820r_init,
+       .sleep                  = cxd2820r_sleep,
 
-       if (fe == NULL) {
-               /* FE0 */
-               /* allocate memory for the internal priv */
-               priv = kzalloc(sizeof(struct cxd2820r_priv), GFP_KERNEL);
-               if (priv == NULL)
-                       goto error;
+       .get_tune_settings      = cxd2820r_get_tune_settings,
+       .i2c_gate_ctrl          = cxd2820r_i2c_gate_ctrl,
 
-               /* setup the priv */
-               priv->i2c = i2c;
-               memcpy(&priv->cfg, cfg, sizeof(struct cxd2820r_config));
-               mutex_init(&priv->fe_lock);
+       .get_frontend           = cxd2820r_get_frontend,
 
-               priv->active_fe = -1; /* NONE */
+       .get_frontend_algo      = cxd2820r_get_frontend_algo,
+       .search                 = cxd2820r_search,
 
-               /* check if the demod is there */
-               priv->bank[0] = priv->bank[1] = 0xff;
-               ret = cxd2820r_rd_reg(priv, 0x000fd, &tmp);
-               dbg("%s: chip id=%02x", __func__, tmp);
-               if (ret || tmp != 0xe1)
-                       goto error;
+       .read_status            = cxd2820r_read_status,
+       .read_snr               = cxd2820r_read_snr,
+       .read_ber               = cxd2820r_read_ber,
+       .read_ucblocks          = cxd2820r_read_ucblocks,
+       .read_signal_strength   = cxd2820r_read_signal_strength,
+};
 
-               /* create frontends */
-               memcpy(&priv->fe[0].ops, &cxd2820r_ops[0],
-                       sizeof(struct dvb_frontend_ops));
-               memcpy(&priv->fe[1].ops, &cxd2820r_ops[1],
-                       sizeof(struct dvb_frontend_ops));
+struct dvb_frontend *cxd2820r_attach(const struct cxd2820r_config *cfg,
+               struct i2c_adapter *i2c)
+{
+       struct cxd2820r_priv *priv = NULL;
+       int ret;
+       u8 tmp;
 
-               priv->fe[0].demodulator_priv = priv;
-               priv->fe[1].demodulator_priv = priv;
+       priv = kzalloc(sizeof (struct cxd2820r_priv), GFP_KERNEL);
+       if (!priv)
+               goto error;
 
-               return &priv->fe[0];
+       priv->i2c = i2c;
+       memcpy(&priv->cfg, cfg, sizeof (struct cxd2820r_config));
 
-       } else {
-               /* FE1: FE0 given as pointer, just return FE1 we have
-                * already created */
-               priv = fe->demodulator_priv;
-               return &priv->fe[1];
-       }
+       priv->bank[0] = priv->bank[1] = 0xff;
+       ret = cxd2820r_rd_reg(priv, 0x000fd, &tmp);
+       dbg("%s: chip id=%02x", __func__, tmp);
+       if (ret || tmp != 0xe1)
+               goto error;
 
+       memcpy(&priv->fe.ops, &cxd2820r_ops, sizeof (struct dvb_frontend_ops));
+       priv->fe.demodulator_priv = priv;
+       return &priv->fe;
 error:
        kfree(priv);
        return NULL;
 }
 EXPORT_SYMBOL(cxd2820r_attach);
 
-static const struct dvb_frontend_ops cxd2820r_ops[2] = {
-       {
-               /* DVB-T/T2 */
-               .info = {
-                       .name = "Sony CXD2820R (DVB-T/T2)",
-                       .type = FE_OFDM,
-                       .caps =
-                               FE_CAN_FEC_1_2 | FE_CAN_FEC_2_3 |
-                               FE_CAN_FEC_3_4 | FE_CAN_FEC_5_6 |
-                               FE_CAN_FEC_7_8 | FE_CAN_FEC_AUTO |
-                               FE_CAN_QPSK | FE_CAN_QAM_16 |
-                               FE_CAN_QAM_64 | FE_CAN_QAM_256 |
-                               FE_CAN_QAM_AUTO |
-                               FE_CAN_TRANSMISSION_MODE_AUTO |
-                               FE_CAN_GUARD_INTERVAL_AUTO |
-                               FE_CAN_HIERARCHY_AUTO |
-                               FE_CAN_MUTE_TS |
-                               FE_CAN_2G_MODULATION
-               },
-
-               .release = cxd2820r_release,
-               .init = cxd2820r_init,
-               .sleep = cxd2820r_sleep,
-
-               .get_tune_settings = cxd2820r_get_tune_settings,
-               .i2c_gate_ctrl = cxd2820r_i2c_gate_ctrl,
-
-               .get_frontend = cxd2820r_get_frontend,
-
-               .get_frontend_algo = cxd2820r_get_frontend_algo,
-               .search = cxd2820r_search,
-
-               .read_status = cxd2820r_read_status,
-               .read_snr = cxd2820r_read_snr,
-               .read_ber = cxd2820r_read_ber,
-               .read_ucblocks = cxd2820r_read_ucblocks,
-               .read_signal_strength = cxd2820r_read_signal_strength,
-       },
-       {
-               /* DVB-C */
-               .info = {
-                       .name = "Sony CXD2820R (DVB-C)",
-                       .type = FE_QAM,
-                       .caps =
-                               FE_CAN_QAM_16 | FE_CAN_QAM_32 | FE_CAN_QAM_64 |
-                               FE_CAN_QAM_128 | FE_CAN_QAM_256 |
-                               FE_CAN_FEC_AUTO
-               },
-
-               .release = cxd2820r_release,
-               .init = cxd2820r_init,
-               .sleep = cxd2820r_sleep,
-
-               .get_tune_settings = cxd2820r_get_tune_settings,
-               .i2c_gate_ctrl = cxd2820r_i2c_gate_ctrl,
-
-               .set_frontend = cxd2820r_set_frontend,
-               .get_frontend = cxd2820r_get_frontend,
-
-               .read_status = cxd2820r_read_status,
-               .read_snr = cxd2820r_read_snr,
-               .read_ber = cxd2820r_read_ber,
-               .read_ucblocks = cxd2820r_read_ucblocks,
-               .read_signal_strength = cxd2820r_read_signal_strength,
-       },
-};
-
-
 MODULE_AUTHOR("Antti Palosaari <crope@iki.fi>");
 MODULE_DESCRIPTION("Sony CXD2820R demodulator driver");
 MODULE_LICENSE("GPL");