linux/drivers/media/usb/dvb-usb/friio-fe.c
<<
>>
Prefs
   1/* DVB USB compliant Linux driver for the Friio USB2.0 ISDB-T receiver.
   2 *
   3 * Copyright (C) 2009 Akihiro Tsukada <tskd2@yahoo.co.jp>
   4 *
   5 * This module is based off the the gl861 and vp702x modules.
   6 *
   7 * This program is free software; you can redistribute it and/or modify it
   8 * under the terms of the GNU General Public License as published by the Free
   9 * Software Foundation, version 2.
  10 *
  11 * see Documentation/dvb/README.dvb-usb for more information
  12 */
  13#include <linux/init.h>
  14#include <linux/string.h>
  15#include <linux/slab.h>
  16
  17#include "friio.h"
  18
  19struct jdvbt90502_state {
  20        struct i2c_adapter *i2c;
  21        struct dvb_frontend frontend;
  22        struct jdvbt90502_config config;
  23};
  24
  25/* NOTE: TC90502 has 16bit register-address? */
  26/* register 0x0100 is used for reading PLL status, so reg is u16 here */
  27static int jdvbt90502_reg_read(struct jdvbt90502_state *state,
  28                               const u16 reg, u8 *buf, const size_t count)
  29{
  30        int ret;
  31        u8 wbuf[3];
  32        struct i2c_msg msg[2];
  33
  34        wbuf[0] = reg & 0xFF;
  35        wbuf[1] = 0;
  36        wbuf[2] = reg >> 8;
  37
  38        msg[0].addr = state->config.demod_address;
  39        msg[0].flags = 0;
  40        msg[0].buf = wbuf;
  41        msg[0].len = sizeof(wbuf);
  42
  43        msg[1].addr = msg[0].addr;
  44        msg[1].flags = I2C_M_RD;
  45        msg[1].buf = buf;
  46        msg[1].len = count;
  47
  48        ret = i2c_transfer(state->i2c, msg, 2);
  49        if (ret != 2) {
  50                deb_fe(" reg read failed.\n");
  51                return -EREMOTEIO;
  52        }
  53        return 0;
  54}
  55
  56/* currently 16bit register-address is not used, so reg is u8 here */
  57static int jdvbt90502_single_reg_write(struct jdvbt90502_state *state,
  58                                       const u8 reg, const u8 val)
  59{
  60        struct i2c_msg msg;
  61        u8 wbuf[2];
  62
  63        wbuf[0] = reg;
  64        wbuf[1] = val;
  65
  66        msg.addr = state->config.demod_address;
  67        msg.flags = 0;
  68        msg.buf = wbuf;
  69        msg.len = sizeof(wbuf);
  70
  71        if (i2c_transfer(state->i2c, &msg, 1) != 1) {
  72                deb_fe(" reg write failed.");
  73                return -EREMOTEIO;
  74        }
  75        return 0;
  76}
  77
  78static int _jdvbt90502_write(struct dvb_frontend *fe, const u8 buf[], int len)
  79{
  80        struct jdvbt90502_state *state = fe->demodulator_priv;
  81        int err, i;
  82        for (i = 0; i < len - 1; i++) {
  83                err = jdvbt90502_single_reg_write(state,
  84                                                  buf[0] + i, buf[i + 1]);
  85                if (err)
  86                        return err;
  87        }
  88
  89        return 0;
  90}
  91
  92/* read pll status byte via the demodulator's I2C register */
  93/* note: Win box reads it by 8B block at the I2C addr 0x30 from reg:0x80 */
  94static int jdvbt90502_pll_read(struct jdvbt90502_state *state, u8 *result)
  95{
  96        int ret;
  97
  98        /* +1 for reading */
  99        u8 pll_addr_byte = (state->config.pll_address << 1) + 1;
 100
 101        *result = 0;
 102
 103        ret = jdvbt90502_single_reg_write(state, JDVBT90502_2ND_I2C_REG,
 104                                          pll_addr_byte);
 105        if (ret)
 106                goto error;
 107
 108        ret = jdvbt90502_reg_read(state, 0x0100, result, 1);
 109        if (ret)
 110                goto error;
 111
 112        deb_fe("PLL read val:%02x\n", *result);
 113        return 0;
 114
 115error:
 116        deb_fe("%s:ret == %d\n", __func__, ret);
 117        return -EREMOTEIO;
 118}
 119
 120
 121/* set pll frequency via the demodulator's I2C register */
 122static int jdvbt90502_pll_set_freq(struct jdvbt90502_state *state, u32 freq)
 123{
 124        int ret;
 125        int retry;
 126        u8 res1;
 127        u8 res2[9];
 128
 129        u8 pll_freq_cmd[PLL_CMD_LEN];
 130        u8 pll_agc_cmd[PLL_CMD_LEN];
 131        struct i2c_msg msg[2];
 132        u32 f;
 133
 134        deb_fe("%s: freq=%d, step=%d\n", __func__, freq,
 135               state->frontend.ops.info.frequency_stepsize);
 136        /* freq -> oscilator frequency conversion. */
 137        /* freq: 473,000,000 + n*6,000,000 [+ 142857 (center freq. shift)] */
 138        f = freq / state->frontend.ops.info.frequency_stepsize;
 139        /* add 399[1/7 MHZ] = 57MHz for the IF  */
 140        f += 399;
 141        /* add center frequency shift if necessary */
 142        if (f % 7 == 0)
 143                f++;
 144        pll_freq_cmd[DEMOD_REDIRECT_REG] = JDVBT90502_2ND_I2C_REG; /* 0xFE */
 145        pll_freq_cmd[ADDRESS_BYTE] = state->config.pll_address << 1;
 146        pll_freq_cmd[DIVIDER_BYTE1] = (f >> 8) & 0x7F;
 147        pll_freq_cmd[DIVIDER_BYTE2] = f & 0xFF;
 148        pll_freq_cmd[CONTROL_BYTE] = 0xB2; /* ref.divider:28, 4MHz/28=1/7MHz */
 149        pll_freq_cmd[BANDSWITCH_BYTE] = 0x08;   /* UHF band */
 150
 151        msg[0].addr = state->config.demod_address;
 152        msg[0].flags = 0;
 153        msg[0].buf = pll_freq_cmd;
 154        msg[0].len = sizeof(pll_freq_cmd);
 155
 156        ret = i2c_transfer(state->i2c, &msg[0], 1);
 157        if (ret != 1)
 158                goto error;
 159
 160        udelay(50);
 161
 162        pll_agc_cmd[DEMOD_REDIRECT_REG] = pll_freq_cmd[DEMOD_REDIRECT_REG];
 163        pll_agc_cmd[ADDRESS_BYTE] = pll_freq_cmd[ADDRESS_BYTE];
 164        pll_agc_cmd[DIVIDER_BYTE1] = pll_freq_cmd[DIVIDER_BYTE1];
 165        pll_agc_cmd[DIVIDER_BYTE2] = pll_freq_cmd[DIVIDER_BYTE2];
 166        pll_agc_cmd[CONTROL_BYTE] = 0x9A; /*  AGC_CTRL instead of BANDSWITCH */
 167        pll_agc_cmd[AGC_CTRL_BYTE] = 0x50;
 168        /* AGC Time Constant 2s, AGC take-over point:103dBuV(lowest) */
 169
 170        msg[1].addr = msg[0].addr;
 171        msg[1].flags = 0;
 172        msg[1].buf = pll_agc_cmd;
 173        msg[1].len = sizeof(pll_agc_cmd);
 174
 175        ret = i2c_transfer(state->i2c, &msg[1], 1);
 176        if (ret != 1)
 177                goto error;
 178
 179        /* I don't know what these cmds are for,  */
 180        /* but the USB log on a windows box contains them */
 181        ret = jdvbt90502_single_reg_write(state, 0x01, 0x40);
 182        ret |= jdvbt90502_single_reg_write(state, 0x01, 0x00);
 183        if (ret)
 184                goto error;
 185        udelay(100);
 186
 187        /* wait for the demod to be ready? */
 188#define RETRY_COUNT 5
 189        for (retry = 0; retry < RETRY_COUNT; retry++) {
 190                ret = jdvbt90502_reg_read(state, 0x0096, &res1, 1);
 191                if (ret)
 192                        goto error;
 193                /* if (res1 != 0x00) goto error; */
 194                ret = jdvbt90502_reg_read(state, 0x00B0, res2, sizeof(res2));
 195                if (ret)
 196                        goto error;
 197                if (res2[0] >= 0xA7)
 198                        break;
 199                msleep(100);
 200        }
 201        if (retry >= RETRY_COUNT) {
 202                deb_fe("%s: FE does not get ready after freq setting.\n",
 203                       __func__);
 204                return -EREMOTEIO;
 205        }
 206
 207        return 0;
 208error:
 209        deb_fe("%s:ret == %d\n", __func__, ret);
 210        return -EREMOTEIO;
 211}
 212
 213static int jdvbt90502_read_status(struct dvb_frontend *fe, fe_status_t *state)
 214{
 215        u8 result;
 216        int ret;
 217
 218        *state = FE_HAS_SIGNAL;
 219
 220        ret = jdvbt90502_pll_read(fe->demodulator_priv, &result);
 221        if (ret) {
 222                deb_fe("%s:ret == %d\n", __func__, ret);
 223                return -EREMOTEIO;
 224        }
 225
 226        *state = FE_HAS_SIGNAL
 227                | FE_HAS_CARRIER
 228                | FE_HAS_VITERBI
 229                | FE_HAS_SYNC;
 230
 231        if (result & PLL_STATUS_LOCKED)
 232                *state |= FE_HAS_LOCK;
 233
 234        return 0;
 235}
 236
 237static int jdvbt90502_read_signal_strength(struct dvb_frontend *fe,
 238                                           u16 *strength)
 239{
 240        int ret;
 241        u8 rbuf[37];
 242
 243        *strength = 0;
 244
 245        /* status register (incl. signal strength) : 0x89  */
 246        /* TODO: read just the necessary registers [0x8B..0x8D]? */
 247        ret = jdvbt90502_reg_read(fe->demodulator_priv, 0x0089,
 248                                  rbuf, sizeof(rbuf));
 249
 250        if (ret) {
 251                deb_fe("%s:ret == %d\n", __func__, ret);
 252                return -EREMOTEIO;
 253        }
 254
 255        /* signal_strength: rbuf[2-4] (24bit BE), use lower 16bit for now. */
 256        *strength = (rbuf[3] << 8) + rbuf[4];
 257        if (rbuf[2])
 258                *strength = 0xffff;
 259
 260        return 0;
 261}
 262
 263
 264/* filter out un-supported properties to notify users */
 265static int jdvbt90502_set_property(struct dvb_frontend *fe,
 266                                   struct dtv_property *tvp)
 267{
 268        int r = 0;
 269
 270        switch (tvp->cmd) {
 271        case DTV_DELIVERY_SYSTEM:
 272                if (tvp->u.data != SYS_ISDBT)
 273                        r = -EINVAL;
 274                break;
 275        case DTV_CLEAR:
 276        case DTV_TUNE:
 277        case DTV_FREQUENCY:
 278                break;
 279        default:
 280                r = -EINVAL;
 281        }
 282        return r;
 283}
 284
 285static int jdvbt90502_get_frontend(struct dvb_frontend *fe)
 286{
 287        struct dtv_frontend_properties *p = &fe->dtv_property_cache;
 288        p->inversion = INVERSION_AUTO;
 289        p->bandwidth_hz = 6000000;
 290        p->code_rate_HP = FEC_AUTO;
 291        p->code_rate_LP = FEC_AUTO;
 292        p->modulation = QAM_64;
 293        p->transmission_mode = TRANSMISSION_MODE_AUTO;
 294        p->guard_interval = GUARD_INTERVAL_AUTO;
 295        p->hierarchy = HIERARCHY_AUTO;
 296        return 0;
 297}
 298
 299static int jdvbt90502_set_frontend(struct dvb_frontend *fe)
 300{
 301        struct dtv_frontend_properties *p = &fe->dtv_property_cache;
 302
 303        /**
 304         * NOTE: ignore all the parameters except frequency.
 305         *       others should be fixed to the proper value for ISDB-T,
 306         *       but don't check here.
 307         */
 308
 309        struct jdvbt90502_state *state = fe->demodulator_priv;
 310        int ret;
 311
 312        deb_fe("%s: Freq:%d\n", __func__, p->frequency);
 313
 314        /* for recovery from DTV_CLEAN */
 315        fe->dtv_property_cache.delivery_system = SYS_ISDBT;
 316
 317        ret = jdvbt90502_pll_set_freq(state, p->frequency);
 318        if (ret) {
 319                deb_fe("%s:ret == %d\n", __func__, ret);
 320                return -EREMOTEIO;
 321        }
 322
 323        return 0;
 324}
 325
 326
 327/**
 328 * (reg, val) commad list to initialize this module.
 329 *  captured on a Windows box.
 330 */
 331static u8 init_code[][2] = {
 332        {0x01, 0x40},
 333        {0x04, 0x38},
 334        {0x05, 0x40},
 335        {0x07, 0x40},
 336        {0x0F, 0x4F},
 337        {0x11, 0x21},
 338        {0x12, 0x0B},
 339        {0x13, 0x2F},
 340        {0x14, 0x31},
 341        {0x16, 0x02},
 342        {0x21, 0xC4},
 343        {0x22, 0x20},
 344        {0x2C, 0x79},
 345        {0x2D, 0x34},
 346        {0x2F, 0x00},
 347        {0x30, 0x28},
 348        {0x31, 0x31},
 349        {0x32, 0xDF},
 350        {0x38, 0x01},
 351        {0x39, 0x78},
 352        {0x3B, 0x33},
 353        {0x3C, 0x33},
 354        {0x48, 0x90},
 355        {0x51, 0x68},
 356        {0x5E, 0x38},
 357        {0x71, 0x00},
 358        {0x72, 0x08},
 359        {0x77, 0x00},
 360        {0xC0, 0x21},
 361        {0xC1, 0x10},
 362        {0xE4, 0x1A},
 363        {0xEA, 0x1F},
 364        {0x77, 0x00},
 365        {0x71, 0x00},
 366        {0x71, 0x00},
 367        {0x76, 0x0C},
 368};
 369
 370static const int init_code_len = sizeof(init_code) / sizeof(u8[2]);
 371
 372static int jdvbt90502_init(struct dvb_frontend *fe)
 373{
 374        int i = -1;
 375        int ret;
 376        struct i2c_msg msg;
 377
 378        struct jdvbt90502_state *state = fe->demodulator_priv;
 379
 380        deb_fe("%s called.\n", __func__);
 381
 382        msg.addr = state->config.demod_address;
 383        msg.flags = 0;
 384        msg.len = 2;
 385        for (i = 0; i < init_code_len; i++) {
 386                msg.buf = init_code[i];
 387                ret = i2c_transfer(state->i2c, &msg, 1);
 388                if (ret != 1)
 389                        goto error;
 390        }
 391        fe->dtv_property_cache.delivery_system = SYS_ISDBT;
 392        msleep(100);
 393
 394        return 0;
 395
 396error:
 397        deb_fe("%s: init_code[%d] failed. ret==%d\n", __func__, i, ret);
 398        return -EREMOTEIO;
 399}
 400
 401
 402static void jdvbt90502_release(struct dvb_frontend *fe)
 403{
 404        struct jdvbt90502_state *state = fe->demodulator_priv;
 405        kfree(state);
 406}
 407
 408
 409static struct dvb_frontend_ops jdvbt90502_ops;
 410
 411struct dvb_frontend *jdvbt90502_attach(struct dvb_usb_device *d)
 412{
 413        struct jdvbt90502_state *state = NULL;
 414
 415        deb_info("%s called.\n", __func__);
 416
 417        /* allocate memory for the internal state */
 418        state = kzalloc(sizeof(struct jdvbt90502_state), GFP_KERNEL);
 419        if (state == NULL)
 420                goto error;
 421
 422        /* setup the state */
 423        state->i2c = &d->i2c_adap;
 424        state->config = friio_fe_config;
 425
 426        /* create dvb_frontend */
 427        state->frontend.ops = jdvbt90502_ops;
 428        state->frontend.demodulator_priv = state;
 429
 430        if (jdvbt90502_init(&state->frontend) < 0)
 431                goto error;
 432
 433        return &state->frontend;
 434
 435error:
 436        kfree(state);
 437        return NULL;
 438}
 439
 440static struct dvb_frontend_ops jdvbt90502_ops = {
 441        .delsys = { SYS_ISDBT },
 442        .info = {
 443                .name                   = "Comtech JDVBT90502 ISDB-T",
 444                .frequency_min          = 473000000, /* UHF 13ch, center */
 445                .frequency_max          = 767142857, /* UHF 62ch, center */
 446                .frequency_stepsize     = JDVBT90502_PLL_CLK / JDVBT90502_PLL_DIVIDER,
 447                .frequency_tolerance    = 0,
 448
 449                /* NOTE: this driver ignores all parameters but frequency. */
 450                .caps = FE_CAN_INVERSION_AUTO |
 451                        FE_CAN_FEC_1_2 | FE_CAN_FEC_2_3 | FE_CAN_FEC_3_4 |
 452                        FE_CAN_FEC_4_5 | FE_CAN_FEC_5_6 | FE_CAN_FEC_6_7 |
 453                        FE_CAN_FEC_7_8 | FE_CAN_FEC_8_9 | FE_CAN_FEC_AUTO |
 454                        FE_CAN_QAM_16 | FE_CAN_QAM_64 | FE_CAN_QAM_AUTO |
 455                        FE_CAN_TRANSMISSION_MODE_AUTO |
 456                        FE_CAN_GUARD_INTERVAL_AUTO |
 457                        FE_CAN_HIERARCHY_AUTO,
 458        },
 459
 460        .release = jdvbt90502_release,
 461
 462        .init = jdvbt90502_init,
 463        .write = _jdvbt90502_write,
 464
 465        .set_property = jdvbt90502_set_property,
 466
 467        .set_frontend = jdvbt90502_set_frontend,
 468        .get_frontend = jdvbt90502_get_frontend,
 469
 470        .read_status = jdvbt90502_read_status,
 471        .read_signal_strength = jdvbt90502_read_signal_strength,
 472};
 473