git.oblomov.eu Git - linux-2.6/blob - drivers/media/dvb/dvb-usb/dvb-usb-i2c.c

   1 /* dvb-usb-i2c.c is part of the DVB USB library.
   2  *
   3  * Copyright (C) 2004-5 Patrick Boettcher (patrick.boettcher@desy.de)
   4  * see dvb-usb-init.c for copyright information.
   5  *
   6  * This file contains functions for (de-)initializing an I2C adapter.
   7  */
   8 #include "dvb-usb-common.h"
   9
  10 int dvb_usb_i2c_init(struct dvb_usb_device *d)
  11 {
  12         int ret = 0;
  13
  14         if (!(d->props.caps & DVB_USB_IS_AN_I2C_ADAPTER))
  15                 return 0;
  16
  17         if (d->props.i2c_algo == NULL) {
  18                 err("no i2c algorithm specified");
  19                 return -EINVAL;
  20         }
  21
  22         strncpy(d->i2c_adap.name,d->desc->name,I2C_NAME_SIZE);
  23 #ifdef I2C_ADAP_CLASS_TV_DIGITAL
  24         d->i2c_adap.class = I2C_ADAP_CLASS_TV_DIGITAL,
  25 #else
  26         d->i2c_adap.class = I2C_CLASS_TV_DIGITAL,
  27 #endif
  28         d->i2c_adap.algo      = d->props.i2c_algo;
  29         d->i2c_adap.algo_data = NULL;
  30
  31         i2c_set_adapdata(&d->i2c_adap, d);
  32
  33         if ((ret = i2c_add_adapter(&d->i2c_adap)) < 0)
  34                 err("could not add i2c adapter");
  35
  36         d->state |= DVB_USB_STATE_I2C;
  37
  38         return ret;
  39 }
  40
  41 int dvb_usb_i2c_exit(struct dvb_usb_device *d)
  42 {
  43         if (d->state & DVB_USB_STATE_I2C)
  44                 i2c_del_adapter(&d->i2c_adap);
  45         d->state &= ~DVB_USB_STATE_I2C;
  46         return 0;
  47 }
  48
  49 int dvb_usb_tuner_init_i2c(struct dvb_frontend *fe)
  50 {
  51         struct dvb_usb_device *d = fe->dvb->priv;
  52         struct i2c_msg msg = { .addr = d->pll_addr, .flags = 0, .buf = d->pll_init, .len = 4 };
  53         int ret = 0;
  54
  55         /* if pll_desc is not used */
  56         if (d->pll_desc == NULL)
  57                 return 0;
  58
  59         if (d->tuner_pass_ctrl)
  60                 d->tuner_pass_ctrl(fe,1,d->pll_addr);
  61
  62         deb_pll("pll init: %x\n",d->pll_addr);
  63         deb_pll("pll-buf: %x %x %x %x\n",d->pll_init[0],d->pll_init[1],
  64                         d->pll_init[2],d->pll_init[3]);
  65
  66         if (fe->ops.i2c_gate_ctrl)
  67                 fe->ops.i2c_gate_ctrl(fe, 1);
  68         if (i2c_transfer (&d->i2c_adap, &msg, 1) != 1) {
  69                 err("tuner i2c write failed for pll_init.");
  70                 ret = -EREMOTEIO;
  71         }
  72         msleep(1);
  73
  74         if (d->tuner_pass_ctrl)
  75                 d->tuner_pass_ctrl(fe,0,d->pll_addr);
  76         return ret;
  77 }
  78 EXPORT_SYMBOL(dvb_usb_tuner_init_i2c);
  79
  80 int dvb_usb_tuner_calc_regs(struct dvb_frontend *fe, struct dvb_frontend_parameters *fep, u8 *b, int buf_len)
  81 {
  82         struct dvb_usb_device *d = fe->dvb->priv;
  83
  84         if (buf_len != 5)
  85                 return -EINVAL;
  86         if (d->pll_desc == NULL)
  87                 return 0;
  88
  89         deb_pll("pll addr: %x, freq: %d %p\n",d->pll_addr,fep->frequency,d->pll_desc);
  90
  91         b[0] = d->pll_addr;
  92         dvb_pll_configure(d->pll_desc,&b[1],fep->frequency,fep->u.ofdm.bandwidth);
  93
  94         deb_pll("pll-buf: %x %x %x %x %x\n",b[0],b[1],b[2],b[3],b[4]);
  95
  96         return 5;
  97 }
  98 EXPORT_SYMBOL(dvb_usb_tuner_calc_regs);
  99
 100 int dvb_usb_tuner_set_params_i2c(struct dvb_frontend *fe, struct dvb_frontend_parameters *fep)
 101 {
 102         struct dvb_usb_device *d = fe->dvb->priv;
 103         int ret = 0;
 104         u8 b[5];
 105         struct i2c_msg msg = { .addr = d->pll_addr, .flags = 0, .buf = &b[1], .len = 4 };
 106
 107         dvb_usb_tuner_calc_regs(fe,fep,b,5);
 108
 109         if (d->tuner_pass_ctrl)
 110                 d->tuner_pass_ctrl(fe,1,d->pll_addr);
 111
 112         if (fe->ops.i2c_gate_ctrl)
 113                 fe->ops.i2c_gate_ctrl(fe, 1);
 114         if (i2c_transfer (&d->i2c_adap, &msg, 1) != 1) {
 115                 err("tuner i2c write failed for pll_set.");
 116                 ret = -EREMOTEIO;
 117         }
 118         msleep(1);
 119
 120         if (d->tuner_pass_ctrl)
 121                 d->tuner_pass_ctrl(fe,0,d->pll_addr);
 122
 123         return ret;
 124 }
 125 EXPORT_SYMBOL(dvb_usb_tuner_set_params_i2c);