V4L/DVB: AZ6027: Initial import of the driver
Adams Xu [Sun, 14 Feb 2010 17:34:07 +0000 (14:34 -0300)]
Signed-off-by: Manu Abaraham <manu@linuxtv.org>
Signed-off-by: Mauro Carvalho Chehab <mchehab@redhat.com>

drivers/media/dvb/dvb-usb/az6027.c [new file with mode: 0644]
drivers/media/dvb/dvb-usb/az6027.h [new file with mode: 0644]

diff --git a/drivers/media/dvb/dvb-usb/az6027.c b/drivers/media/dvb/dvb-usb/az6027.c
new file mode 100644 (file)
index 0000000..3865c92
--- /dev/null
@@ -0,0 +1,1130 @@
+/* DVB USB compliant Linux driver for the AZUREWAVE DVB-S/S2 USB2.0 (AZ6027)
+ * receiver.
+ *
+ * Copyright (C) 2009 Adams.Xu <adams.xu@azwave.com.cn>
+ *
+ *     This program is free software; you can redistribute it and/or modify it
+ *     under the terms of the GNU General Public License as published by the Free
+ *     Software Foundation, version 2.
+ *
+ * see Documentation/dvb/README.dvb-usb for more information
+ */
+#include "az6027.h"
+/* Demodulator */
+#include "stb0899_drv.h"
+#include "stb0899_reg.h"
+#include "stb0899_cfg.h"
+/* Tuner */
+#include "stb6100.h"
+#include "stb6100_cfg.h"
+#include "dvb_ca_en50221.h"
+
+/* debug */
+int dvb_usb_az6027_debug;
+module_param_named(debug,dvb_usb_az6027_debug, int, 0644);
+MODULE_PARM_DESC(debug, "set debugging level (1=info,xfer=2,rc=4 (or-able))." DVB_USB_DEBUG_STATUS);
+
+DVB_DEFINE_MOD_OPT_ADAPTER_NR(adapter_nr);
+
+struct az6027_device_state {
+       struct dvb_ca_en50221 ca;
+       struct mutex ca_mutex;
+       u8 power_state;
+};
+
+static const struct stb0899_s1_reg az6027_stb0899_s1_init_1[] = {
+
+//      0x0000000b ,   /* SYSREG */
+       { STB0899_DEV_ID                , 0x30 },
+       { STB0899_DISCNTRL1             , 0x32 },
+       { STB0899_DISCNTRL2             , 0x80 },
+       { STB0899_DISRX_ST0             , 0x04 },
+       { STB0899_DISRX_ST1             , 0x00 },
+       { STB0899_DISPARITY             , 0x00 },
+       { STB0899_DISFIFO               , 0x00 },
+       { STB0899_DISSTATUS             , 0x20 },
+       { STB0899_DISF22                , 0x99 },
+       { STB0899_DISF22RX              , 0xa8 },
+       //SYSREG ?
+       { STB0899_ACRPRESC              , 0x11 },
+       { STB0899_ACRDIV1               , 0x0a },
+       { STB0899_ACRDIV2               , 0x05 },
+       { STB0899_DACR1                 , 0x00 },
+       { STB0899_DACR2                 , 0x00 },
+       { STB0899_OUTCFG                , 0x00 },
+       { STB0899_MODECFG               , 0x00 },
+       { STB0899_IRQSTATUS_3           , 0xfe },
+       { STB0899_IRQSTATUS_2           , 0x03 },
+       { STB0899_IRQSTATUS_1           , 0x7c },
+       { STB0899_IRQSTATUS_0           , 0xf4 },
+       { STB0899_IRQMSK_3              , 0xf3 },
+       { STB0899_IRQMSK_2              , 0xfc },
+       { STB0899_IRQMSK_1              , 0xff },
+       { STB0899_IRQMSK_0              , 0xff },
+       { STB0899_IRQCFG                , 0x00 },
+       { STB0899_I2CCFG                , 0x88 },
+       { STB0899_I2CRPT                , 0x58 },
+       { STB0899_IOPVALUE5             , 0x00 },
+       { STB0899_IOPVALUE4             , 0x33 },
+       { STB0899_IOPVALUE3             , 0x6d },
+       { STB0899_IOPVALUE2             , 0x90 },
+       { STB0899_IOPVALUE1             , 0x60 },
+       { STB0899_IOPVALUE0             , 0x00 },
+       { STB0899_GPIO00CFG             , 0x82 },
+       { STB0899_GPIO01CFG             , 0x82 },
+       { STB0899_GPIO02CFG             , 0x82 },
+       { STB0899_GPIO03CFG             , 0x82 },
+       { STB0899_GPIO04CFG             , 0x82 },
+       { STB0899_GPIO05CFG             , 0x82 },
+       { STB0899_GPIO06CFG             , 0x82 },
+       { STB0899_GPIO07CFG             , 0x82 },
+       { STB0899_GPIO08CFG             , 0x82 },
+       { STB0899_GPIO09CFG             , 0x82 },
+       { STB0899_GPIO10CFG             , 0x82 },
+       { STB0899_GPIO11CFG             , 0x82 },
+       { STB0899_GPIO12CFG             , 0x82 },
+       { STB0899_GPIO13CFG             , 0x82 },
+       { STB0899_GPIO14CFG             , 0x82 },
+       { STB0899_GPIO15CFG             , 0x82 },
+       { STB0899_GPIO16CFG             , 0x82 },
+       { STB0899_GPIO17CFG             , 0x82 },
+       { STB0899_GPIO18CFG             , 0x82 },
+       { STB0899_GPIO19CFG             , 0x82 },
+       { STB0899_GPIO20CFG             , 0x82 },
+       { STB0899_SDATCFG               , 0xb8 },
+       { STB0899_SCLTCFG               , 0xba },
+       { STB0899_AGCRFCFG              , 0x1c }, /* 0x11 */
+       { STB0899_GPIO22                , 0x82 }, /* AGCBB2CFG */
+       { STB0899_GPIO21                , 0x91 }, /* AGCBB1CFG */
+       { STB0899_DIRCLKCFG             , 0x82 },
+       { STB0899_CLKOUT27CFG           , 0x7e },
+       { STB0899_STDBYCFG              , 0x82 },
+       { STB0899_CS0CFG                , 0x82 },
+       { STB0899_CS1CFG                , 0x82 },
+       { STB0899_DISEQCOCFG            , 0x20 },
+       { STB0899_GPIO32CFG             , 0x82 },
+       { STB0899_GPIO33CFG             , 0x82 },
+       { STB0899_GPIO34CFG             , 0x82 },
+       { STB0899_GPIO35CFG             , 0x82 },
+       { STB0899_GPIO36CFG             , 0x82 },
+       { STB0899_GPIO37CFG             , 0x82 },
+       { STB0899_GPIO38CFG             , 0x82 },
+       { STB0899_GPIO39CFG             , 0x82 },
+       { STB0899_NCOARSE               , 0x17 }, /* 0x15 = 27 Mhz Clock, F/3 = 198MHz, F/6 = 99MHz */
+       { STB0899_SYNTCTRL              , 0x02 }, /* 0x00 = CLK from CLKI, 0x02 = CLK from XTALI */
+       { STB0899_FILTCTRL              , 0x00 },
+       { STB0899_SYSCTRL               , 0x01 },
+       { STB0899_STOPCLK1              , 0x20 },
+       { STB0899_STOPCLK2              , 0x00 },
+       { STB0899_INTBUFSTATUS          , 0x00 },
+       { STB0899_INTBUFCTRL            , 0x0a },
+       { 0xffff                        , 0xff },
+};
+
+static const struct stb0899_s1_reg az6027_stb0899_s1_init_3[] = {
+       { STB0899_DEMOD                 , 0x00 },
+       { STB0899_RCOMPC                , 0xc9 },
+       { STB0899_AGC1CN                , 0x01 },
+       { STB0899_AGC1REF               , 0x10 },
+       { STB0899_RTC                   , 0x23 },
+       { STB0899_TMGCFG                , 0x4e },
+       { STB0899_AGC2REF               , 0x34 },
+       { STB0899_TLSR                  , 0x84 },
+       { STB0899_CFD                   , 0xf7 },
+       { STB0899_ACLC                  , 0x87 },
+       { STB0899_BCLC                  , 0x94 },
+       { STB0899_EQON                  , 0x41 },
+       { STB0899_LDT                   , 0xf1 },
+       { STB0899_LDT2                  , 0xe3 },
+       { STB0899_EQUALREF              , 0xb4 },
+       { STB0899_TMGRAMP               , 0x10 },
+       { STB0899_TMGTHD                , 0x30 },
+       { STB0899_IDCCOMP               , 0xfd },
+       { STB0899_QDCCOMP               , 0xff },
+       { STB0899_POWERI                , 0x0c },
+       { STB0899_POWERQ                , 0x0f },
+       { STB0899_RCOMP                 , 0x6c },
+       { STB0899_AGCIQIN               , 0x80 },
+       { STB0899_AGC2I1                , 0x06 },
+       { STB0899_AGC2I2                , 0x00 },
+       { STB0899_TLIR                  , 0x30 },
+       { STB0899_RTF                   , 0x7f },
+       { STB0899_DSTATUS               , 0x00 },
+       { STB0899_LDI                   , 0xbc },
+       { STB0899_CFRM                  , 0xea },
+       { STB0899_CFRL                  , 0x31 },
+       { STB0899_NIRM                  , 0x2b },
+       { STB0899_NIRL                  , 0x80 },
+       { STB0899_ISYMB                 , 0x1d },
+       { STB0899_QSYMB                 , 0xa6 },
+       { STB0899_SFRH                  , 0x2f },
+       { STB0899_SFRM                  , 0x68 },
+       { STB0899_SFRL                  , 0x40 },
+       { STB0899_SFRUPH                , 0x2f },
+       { STB0899_SFRUPM                , 0x68 },
+       { STB0899_SFRUPL                , 0x40 },
+       { STB0899_EQUAI1                , 0x02 },
+       { STB0899_EQUAQ1                , 0xff },
+       { STB0899_EQUAI2                , 0x04 },
+       { STB0899_EQUAQ2                , 0x05 },
+       { STB0899_EQUAI3                , 0x02 },
+       { STB0899_EQUAQ3                , 0xfd },
+       { STB0899_EQUAI4                , 0x03 },
+       { STB0899_EQUAQ4                , 0x07 },
+       { STB0899_EQUAI5                , 0x08 },
+       { STB0899_EQUAQ5                , 0xf5 },
+       { STB0899_DSTATUS2              , 0x00 },
+       { STB0899_VSTATUS               , 0x00 },
+       { STB0899_VERROR                , 0x86 },
+       { STB0899_IQSWAP                , 0x2a },
+       { STB0899_ECNT1M                , 0x00 },
+       { STB0899_ECNT1L                , 0x00 },
+       { STB0899_ECNT2M                , 0x00 },
+       { STB0899_ECNT2L                , 0x00 },
+       { STB0899_ECNT3M                , 0x0a },
+       { STB0899_ECNT3L                , 0xad },
+       { STB0899_FECAUTO1              , 0x06 },
+       { STB0899_FECM                  , 0x01 },
+       { STB0899_VTH12                 , 0xb0 },
+       { STB0899_VTH23                 , 0x7a },
+       { STB0899_VTH34                 , 0x58 },
+       { STB0899_VTH56                 , 0x38 },
+       { STB0899_VTH67                 , 0x34 },
+       { STB0899_VTH78                 , 0x24 },
+       { STB0899_PRVIT                 , 0xff },
+       { STB0899_VITSYNC               , 0x19 },
+       { STB0899_RSULC                 , 0xb1 }, /* DVB = 0xb1, DSS = 0xa1 */
+       { STB0899_TSULC                 , 0x42 },
+       { STB0899_RSLLC                 , 0x41 },
+       { STB0899_TSLPL                 , 0x12 },
+       { STB0899_TSCFGH                , 0x0c },
+       { STB0899_TSCFGM                , 0x00 },
+       { STB0899_TSCFGL                , 0x00 },
+       { STB0899_TSOUT                 , 0x69 }, /* 0x0d for CAM */
+       { STB0899_RSSYNCDEL             , 0x00 },
+       { STB0899_TSINHDELH             , 0x02 },
+       { STB0899_TSINHDELM             , 0x00 },
+       { STB0899_TSINHDELL             , 0x00 },
+       { STB0899_TSLLSTKM              , 0x1b },
+       { STB0899_TSLLSTKL              , 0xb3 },
+       { STB0899_TSULSTKM              , 0x00 },
+       { STB0899_TSULSTKL              , 0x00 },
+       { STB0899_PCKLENUL              , 0xbc },
+       { STB0899_PCKLENLL              , 0xcc },
+       { STB0899_RSPCKLEN              , 0xbd },
+       { STB0899_TSSTATUS              , 0x90 },
+       { STB0899_ERRCTRL1              , 0xb6 },
+       { STB0899_ERRCTRL2              , 0x95 },
+       { STB0899_ERRCTRL3              , 0x8d },
+       { STB0899_DMONMSK1              , 0x27 },
+       { STB0899_DMONMSK0              , 0x03 },
+       { STB0899_DEMAPVIT              , 0x5c },
+       { STB0899_PLPARM                , 0x19 },
+       { STB0899_PDELCTRL              , 0x48 },
+       { STB0899_PDELCTRL2             , 0x00 },
+       { STB0899_BBHCTRL1              , 0x00 },
+       { STB0899_BBHCTRL2              , 0x00 },
+       { STB0899_HYSTTHRESH            , 0x77 },
+       { STB0899_MATCSTM               , 0x00 },
+       { STB0899_MATCSTL               , 0x00 },
+       { STB0899_UPLCSTM               , 0x00 },
+       { STB0899_UPLCSTL               , 0x00 },
+       { STB0899_DFLCSTM               , 0x00 },
+       { STB0899_DFLCSTL               , 0x00 },
+       { STB0899_SYNCCST               , 0x00 },
+       { STB0899_SYNCDCSTM             , 0x00 },
+       { STB0899_SYNCDCSTL             , 0x00 },
+       { STB0899_ISI_ENTRY             , 0x00 },
+       { STB0899_ISI_BIT_EN            , 0x00 },
+       { STB0899_MATSTRM               , 0xf0 },
+       { STB0899_MATSTRL               , 0x02 },
+       { STB0899_UPLSTRM               , 0x45 },
+       { STB0899_UPLSTRL               , 0x60 },
+       { STB0899_DFLSTRM               , 0xe3 },
+       { STB0899_DFLSTRL               , 0x00 },
+       { STB0899_SYNCSTR               , 0x47 },
+       { STB0899_SYNCDSTRM             , 0x05 },
+       { STB0899_SYNCDSTRL             , 0x18 },
+       { STB0899_CFGPDELSTATUS1        , 0x19 },
+       { STB0899_CFGPDELSTATUS2        , 0x2b },
+       { STB0899_BBFERRORM             , 0x00 },
+       { STB0899_BBFERRORL             , 0x01 },
+       { STB0899_UPKTERRORM            , 0x00 },
+       { STB0899_UPKTERRORL            , 0x00 },
+       { 0xffff                        , 0xff },
+};
+
+
+
+struct stb0899_config az6027_stb0899_config = {
+       .init_dev               = az6027_stb0899_s1_init_1,
+       .init_s2_demod          = stb0899_s2_init_2,
+       .init_s1_demod          = az6027_stb0899_s1_init_3,
+       .init_s2_fec            = stb0899_s2_init_4,
+       .init_tst               = stb0899_s1_init_5,
+
+       .demod_address          = 0xd0,//0x68, /*  0xd0 >> 1 */
+
+       .xtal_freq              = 27000000,
+       .inversion              = IQ_SWAP_ON, /* 1 */
+
+       .lo_clk                 = 76500000,
+       .hi_clk                 = 99000000,
+
+       .esno_ave               = STB0899_DVBS2_ESNO_AVE,
+       .esno_quant             = STB0899_DVBS2_ESNO_QUANT,
+       .avframes_coarse        = STB0899_DVBS2_AVFRAMES_COARSE,
+       .avframes_fine          = STB0899_DVBS2_AVFRAMES_FINE,
+       .miss_threshold         = STB0899_DVBS2_MISS_THRESHOLD,
+       .uwp_threshold_acq      = STB0899_DVBS2_UWP_THRESHOLD_ACQ,
+       .uwp_threshold_track    = STB0899_DVBS2_UWP_THRESHOLD_TRACK,
+       .uwp_threshold_sof      = STB0899_DVBS2_UWP_THRESHOLD_SOF,
+       .sof_search_timeout     = STB0899_DVBS2_SOF_SEARCH_TIMEOUT,
+
+       .btr_nco_bits           = STB0899_DVBS2_BTR_NCO_BITS,
+       .btr_gain_shift_offset  = STB0899_DVBS2_BTR_GAIN_SHIFT_OFFSET,
+       .crl_nco_bits           = STB0899_DVBS2_CRL_NCO_BITS,
+       .ldpc_max_iter          = STB0899_DVBS2_LDPC_MAX_ITER,
+
+       .tuner_get_frequency    = stb6100_get_frequency,
+       .tuner_set_frequency    = stb6100_set_frequency,
+       .tuner_set_bandwidth    = stb6100_set_bandwidth,
+       .tuner_get_bandwidth    = stb6100_get_bandwidth,
+       .tuner_set_rfsiggain    = NULL,
+};
+
+struct stb6100_config az6027_stb6100_config = {
+       .tuner_address  = 0xc0,
+       .refclock       = 27000000,
+};
+
+
+/* check for mutex FIXME */
+int az6027_usb_in_op(struct dvb_usb_device *d, u8 req, u16 value, u16 index, u8 *b, int blen)
+{
+       int ret = -1;
+       if(mutex_lock_interruptible(&d->usb_mutex)) {
+               return -EAGAIN;
+       }
+       ret = usb_control_msg(d->udev,
+               usb_rcvctrlpipe(d->udev,0),
+               req,
+               USB_TYPE_VENDOR | USB_DIR_IN,
+               value,index,b,blen,
+               2000);
+
+       if (ret < 0) {
+               warn("usb in operation failed. (%d)", ret);
+               ret = -EIO;
+       } else
+               ret = 0;
+
+
+       deb_xfer("in: req. %02x, val: %04x, ind: %04x, buffer: ",req,value,index);
+       debug_dump(b,blen,deb_xfer);
+       mutex_unlock(&d->usb_mutex);
+       return ret;
+}
+
+static int az6027_usb_out_op(struct dvb_usb_device *d, u8 req, u16 value,
+                            u16 index, u8 *b, int blen)
+{
+       int ret;
+       deb_xfer("out: req. %02x, val: %04x, ind: %04x, buffer: ",req,value,index);
+       debug_dump(b,blen,deb_xfer);
+       if(mutex_lock_interruptible(&d->usb_mutex)) {
+               return -EAGAIN;
+       }
+
+       if ((ret = usb_control_msg(d->udev,
+                       usb_sndctrlpipe(d->udev,0),
+                       req,
+                       USB_TYPE_VENDOR | USB_DIR_OUT,
+                       value,index,b,blen,
+                       2000)) != blen) {
+               warn("usb out operation failed. (%d)",ret);
+               mutex_unlock(&d->usb_mutex);
+               return -EIO;
+       } else{
+               mutex_unlock(&d->usb_mutex);
+               return 0;
+       }
+}
+
+static int az6027_streaming_ctrl(struct dvb_usb_adapter *adap, int onoff)
+{
+       int ret;
+       u8 req;
+       u16 value;
+       u16 index;
+       int blen;
+       deb_info("%s %d",__func__,onoff);
+       req = 0xBC;
+       value = onoff;
+       index = 0;
+       blen =0;
+       if((ret = az6027_usb_out_op(adap->dev,req,value,index,NULL,blen)) != 0) {
+               warn("usb out operation failed. (%d)",ret);
+       }
+       
+       //info("write CA
+       return ret;
+}
+
+/* keys for the enclosed remote control */
+static struct dvb_usb_rc_key az6027_rc_keys[] = {
+       { 0x00, 0x01, KEY_1 },
+       { 0x00, 0x02, KEY_2 },
+};
+
+/* remote control stuff (does not work with my box) */
+static int az6027_rc_query(struct dvb_usb_device *d, u32 *event, int *state)
+{
+       return 0;
+}
+
+/*
+int az6027_power_ctrl(struct dvb_usb_device *d, int onoff)
+{
+       u8 v = onoff;
+       return az6027_usb_out_op(d,0xBC,v,3,NULL,1);
+}
+*/
+
+static int az6027_ci_read_attribute_mem(struct dvb_ca_en50221 *ca,
+                                int                    slot,
+                                int                    address)
+{
+       struct dvb_usb_device *d = (struct dvb_usb_device *)ca->data;
+       struct az6027_device_state *state = (struct az6027_device_state *)d->priv;
+
+       int ret;
+       u8 req;
+       u16 value;
+       u16 index;
+       int blen;
+       u8 b[12];       
+       
+       //info ("%s %d", __func__, slot);
+       if (0 != slot)
+               return -EINVAL;
+       mutex_lock (&state->ca_mutex);
+
+       req = 0xC1;
+       value = address;
+       index = 0;
+       blen = 1;
+       ret = az6027_usb_in_op(d,req,value,index,b,blen);
+       if (ret < 0) {
+               warn("usb in operation failed. (%d)", ret);
+               ret = -EINVAL;
+       } else{
+               ret = b[0];
+               //info("CI MEM 0x%x = %x",address,b[0]);
+       }
+       //mdelay(10);
+       mutex_unlock (&state->ca_mutex);
+       return ret;
+}
+
+static int az6027_ci_write_attribute_mem(struct dvb_ca_en50221 *ca,
+                                int                    slot,
+                                int                    address,
+                                u8                     value)
+{
+       struct dvb_usb_device *d = (struct dvb_usb_device *)ca->data;
+       struct az6027_device_state *state = (struct az6027_device_state *)d->priv;
+       int ret;
+       u8 req;
+       u16 value1;
+       u16 index;
+       int blen;
+
+       deb_info ("%s %d", __func__, slot);
+       if (0 != slot)
+               return -EINVAL;
+       
+       mutex_lock (&state->ca_mutex);
+       req = 0xC2;
+       value1 = address;
+       index = value;
+       blen =0;
+       if((ret = az6027_usb_out_op(d,req,value1,index,NULL,blen)) != 0) {
+               warn("usb out operation failed. (%d)",ret);
+       }
+       //mdelay(10);
+       mutex_unlock (&state->ca_mutex);
+
+       return ret;
+}
+
+static int az6027_ci_read_cam_control(struct dvb_ca_en50221 *ca,
+                                int                    slot,
+                                u8                     address)
+{
+       struct dvb_usb_device *d = (struct dvb_usb_device *)ca->data;
+       struct az6027_device_state *state = (struct az6027_device_state *)d->priv;
+
+       int ret;
+       u8 req;
+       u16 value;
+       u16 index;
+       int blen;
+       u8 b[12];       
+       
+       //info ("%s %d", __func__, slot);
+       if (0 != slot)
+               return -EINVAL;
+       mutex_lock (&state->ca_mutex);
+
+       req = 0xC3;
+       value = address;
+       index = 0;
+       blen = 2;
+       ret = az6027_usb_in_op(d,req,value,index,b,blen);
+       if (ret < 0) {
+               warn("usb in operation failed. (%d)", ret);
+               ret = -EINVAL;
+       } else{
+               if(b[0] == 0)
+                       warn("Read CI IO error");
+               ret = b[1];
+               deb_info("read cam data = %x from 0x%x",b[1],value);
+       }
+       //udelay(350);
+       mutex_unlock (&state->ca_mutex);
+       return ret;
+}
+
+static int az6027_ci_write_cam_control(struct dvb_ca_en50221 *ca,
+                                int                    slot,
+                                u8                     address,
+                                u8                     value)
+{
+       struct dvb_usb_device *d = (struct dvb_usb_device *)ca->data;
+       struct az6027_device_state *state = (struct az6027_device_state *)d->priv;
+       int ret;
+       u8 req;
+       u16 value1;
+       u16 index;
+       int blen;
+
+       //info ("%s %d", __func__, slot);
+       if (0 != slot)
+               return -EINVAL;
+       
+       mutex_lock (&state->ca_mutex);
+       req = 0xC4;
+       value1 = address;
+       index = value;
+       blen =0;
+       if((ret = az6027_usb_out_op(d,req,value1,index,NULL,blen)) != 0) {
+               warn("usb out operation failed. (%d)",ret);
+               goto failed;
+       }
+       //info("write CAM data(%x) to 0x%x ",index, value1);
+       //udelay(350);
+ failed:
+       mutex_unlock (&state->ca_mutex);
+       return ret;
+}
+
+static int CI_CamReady(struct dvb_ca_en50221 *ca,
+                                int                    slot)
+{
+       struct dvb_usb_device *d = (struct dvb_usb_device *)ca->data;
+       int ret;
+       u8 req;
+       u16 value;
+       u16 index;
+       int blen;
+       u8 b[12];       
+
+       req = 0xC8;
+       value = 0;
+       index = 0;
+       blen = 1;
+       ret = az6027_usb_in_op(d,req,value,index,b,blen);
+       if (ret < 0) {
+               warn("usb in operation failed. (%d)", ret);
+               ret = -EIO;
+       } else{
+               ret = b[0];
+       }
+       return ret;
+}
+
+static int az6027_ci_slot_reset(struct dvb_ca_en50221 *ca,
+                                int                    slot)
+{
+       struct dvb_usb_device *d = (struct dvb_usb_device *)ca->data;
+       struct az6027_device_state *state = (struct az6027_device_state *)d->priv;
+       int ret,i;
+       u8 req;
+       u16 value;
+       u16 index;
+       int blen;
+
+       mutex_lock (&state->ca_mutex);
+       
+       req = 0xC6;
+       value = 1;
+       index = 0;
+       blen =0;
+       if((ret = az6027_usb_out_op(d,req,value,index,NULL,blen)) != 0) {
+               warn("usb out operation failed. (%d)",ret);
+               goto failed;
+       }
+       msleep (500);
+       req = 0xC6;
+       value = 0;
+       index = 0;
+       blen =0;
+       if((ret = az6027_usb_out_op(d,req,value,index,NULL,blen)) != 0) {
+               warn("usb out operation failed. (%d)",ret);
+               goto failed;
+       }
+
+       for(i = 0;i < 15;i++)
+       {
+               msleep(100);
+               if(CI_CamReady(ca,slot))
+               {
+                       deb_info("CAM Ready");
+                       break;
+               }
+       }
+       msleep(5000);
+
+ failed:
+       mutex_unlock (&state->ca_mutex);
+
+       return ret;
+}
+
+static int az6027_ci_slot_shutdown(struct dvb_ca_en50221 *ca,
+                                int                    slot)
+{
+       // do nothing here.
+       return 0;
+}
+
+static int az6027_ci_slot_ts_enable(struct dvb_ca_en50221 *ca,
+                                int                    slot)
+{
+       struct dvb_usb_device *d = (struct dvb_usb_device *)ca->data;
+       struct az6027_device_state *state = (struct az6027_device_state *)d->priv;
+       int ret;
+       u8 req;
+       u16 value;
+       u16 index;
+       int blen;
+       deb_info("%s", __func__);
+       mutex_lock (&state->ca_mutex);
+       req = 0xC7;
+       value = 1;
+       index = 0;
+       blen =0;
+       if((ret = az6027_usb_out_op(d,req,value,index,NULL,blen)) != 0)
+       {
+               warn("usb out operation failed. (%d)",ret);
+               goto failed;
+       }
+ failed:
+       mutex_unlock (&state->ca_mutex);
+
+       return ret;
+}
+
+static int az6027_ci_poll_slot_status(struct dvb_ca_en50221 *ca,
+                                int                    slot,
+                                int                    open)
+{
+       struct dvb_usb_device *d = (struct dvb_usb_device *)ca->data;
+       struct az6027_device_state *state = (struct az6027_device_state *)d->priv;
+       int ret;
+       u8 req;
+       u16 value;
+       u16 index;
+       int blen;
+       u8 b[12];       
+       
+       mutex_lock (&state->ca_mutex);
+
+       req = 0xC5;
+       value = 0;
+       index = 0;
+       blen = 1;
+       ret = az6027_usb_in_op(d,req,value,index,b,blen);
+       if (ret < 0) {
+               warn("usb in operation failed. (%d)", ret);
+               ret = -EIO;
+       } else
+               ret = 0;
+       if(b[0] == 0)
+               ret = 0;
+       else if(b[0] == 1){
+               ret = (DVB_CA_EN50221_POLL_CAM_PRESENT |
+                       DVB_CA_EN50221_POLL_CAM_READY);
+               //info("CAM IN slot = %d", slot);
+       }
+
+       mutex_unlock (&state->ca_mutex);
+       return ret;
+}
+
+
+static void az6027_ci_uninit(struct dvb_usb_device *d)
+{
+       struct az6027_device_state *state;
+
+       deb_info("%s", __func__);
+
+       if (NULL == d)
+               return;
+
+       state = (struct az6027_device_state *)d->priv;
+       if (NULL == state)
+               return;
+
+       if (NULL == state->ca.data)
+               return;
+
+       dvb_ca_en50221_release(&state->ca);
+
+       memset(&state->ca, 0, sizeof(state->ca));
+}
+
+
+static int az6027_ci_init(struct dvb_usb_adapter *a)
+{
+       struct dvb_usb_device *d = a->dev;
+       struct az6027_device_state *state = (struct az6027_device_state *)d->priv;
+       int ret;
+
+       deb_info ("%s", __func__);
+
+       mutex_init(&state->ca_mutex);
+
+       state->ca.owner = THIS_MODULE;
+       state->ca.read_attribute_mem = az6027_ci_read_attribute_mem;
+       state->ca.write_attribute_mem = az6027_ci_write_attribute_mem;
+       state->ca.read_cam_control = az6027_ci_read_cam_control;
+       state->ca.write_cam_control = az6027_ci_write_cam_control;
+       state->ca.slot_reset = az6027_ci_slot_reset;
+       state->ca.slot_shutdown = az6027_ci_slot_shutdown;
+       state->ca.slot_ts_enable = az6027_ci_slot_ts_enable;
+       state->ca.poll_slot_status = az6027_ci_poll_slot_status;
+       state->ca.data = d;
+
+       ret = dvb_ca_en50221_init (&a->dvb_adap,
+                                  &state->ca,
+                                  /* flags */ 0,
+                                  /* n_slots */ 1);
+       if (0 != ret) {
+               err ("Cannot initialize CI: Error %d.", ret);
+               memset (&state->ca, 0, sizeof (state->ca));
+               return ret;
+       }
+
+       deb_info ("CI initialized.");
+
+       return 0;
+}
+
+
+static int az6027_read_mac_addr(struct dvb_usb_device *d,u8 mac[6])
+{
+       az6027_usb_in_op(d, 0xb7, 6, 0, &mac[0], 6);
+       return 0;
+}
+
+
+static int az6027_set_voltage(struct dvb_frontend *fe, fe_sec_voltage_t voltage)
+{
+       
+       struct dvb_usb_adapter *adap = fe->dvb->priv;
+       u8 buf;
+       struct i2c_msg i2c_msg = {
+               .addr   = 0x99,
+               .flags  = 0,
+               .buf    = &buf,
+               .len    = 1
+       };
+       int ret;
+       switch (voltage) {
+       case SEC_VOLTAGE_13:
+               buf = 1;// 2   --18v          1   --13v             0   --off
+               ret = i2c_transfer(&adap->dev->i2c_adap, &i2c_msg, 1);
+               break;
+       case SEC_VOLTAGE_18:
+               buf = 2;// 2   --18v          1   --13v             0   --off
+               ret = i2c_transfer(&adap->dev->i2c_adap, &i2c_msg, 1);
+               break;
+       case SEC_VOLTAGE_OFF:
+               buf = 0;// 2   --18v          1   --13v             0   --off
+               ret = i2c_transfer(&adap->dev->i2c_adap, &i2c_msg, 1);
+               break;
+       default:
+               return -EINVAL;
+       }
+       return 0;
+}
+
+
+static int az6027_frontend_poweron(struct dvb_usb_adapter *adap)
+{
+       int ret;
+       u8 req;
+       u16 value;
+       u16 index;
+       int blen;
+
+       req = 0xBC;
+       value = 1;//power on
+       index = 3;
+       blen =0;
+
+       if((ret = az6027_usb_out_op(adap->dev,req,value,index,NULL,blen)) != 0)
+                  return -EIO;
+       return 0;
+}
+static int az6027_frontend_reset(struct dvb_usb_adapter *adap)
+{
+       int ret;
+       u8 req;
+       u16 value;
+       u16 index;
+       int blen;
+
+       //reset demodulator
+       req = 0xC0;
+       value = 1;//high
+       index = 3;
+       blen =0;
+
+       if((ret = az6027_usb_out_op(adap->dev,req,value,index,NULL,blen)) != 0)
+                  return -EIO;
+       
+       req = 0xC0;
+       value = 0;//low
+       index = 3;
+       blen =0;
+       msleep_interruptible(200);
+       if((ret = az6027_usb_out_op(adap->dev,req,value,index,NULL,blen)) != 0)
+                  return -EIO;
+       msleep_interruptible(200);
+       req = 0xC0;
+       value = 1;//high
+       index = 3;
+       blen =0;
+
+       if((ret = az6027_usb_out_op(adap->dev,req,value,index,NULL,blen)) != 0)
+                  return -EIO;
+       msleep_interruptible(200);
+       return 0;
+}
+
+static int az6027_frontend_tsbypass(struct dvb_usb_adapter *adap,int onoff)
+{
+       int ret;
+       u8 req;
+       u16 value;
+       u16 index;
+       int blen;
+       //TS through
+       req = 0xC7;
+       value = onoff;
+       index = 0;
+       blen =0;
+
+       if((ret = az6027_usb_out_op(adap->dev,req,value,index,NULL,blen)) != 0)
+                  return -EIO;
+       return 0;
+}
+
+static int az6027_frontend_attach(struct dvb_usb_adapter *adap)
+{
+
+       az6027_frontend_poweron(adap);
+       az6027_frontend_reset(adap);
+       deb_info("adap = %p,dev = %p\n",adap, adap->dev);
+       adap->fe = stb0899_attach(&az6027_stb0899_config, &adap->dev->i2c_adap);
+       if (adap->fe) {
+               deb_info("found STB0899 DVB-S/DVB-S2 frontend @0x%02x",az6027_stb0899_config.demod_address);
+               if (stb6100_attach(adap->fe, &az6027_stb6100_config, &adap->dev->i2c_adap)) {
+                       deb_info("found STB6100 DVB-S/DVB-S2 frontend @0x%02x",az6027_stb6100_config.tuner_address);
+                       adap->fe->ops.set_voltage = az6027_set_voltage;
+                       az6027_ci_init(adap);
+               } else {
+                       adap->fe = NULL;
+               }
+       }
+       else
+               warn("no front-end attached\n");
+
+
+       az6027_frontend_tsbypass(adap,0);
+
+       return 0;
+}
+
+static struct dvb_usb_device_properties az6027_properties;
+
+static void
+az6027_usb_disconnect(struct usb_interface *intf)
+{
+       struct dvb_usb_device *d = usb_get_intfdata (intf);
+       az6027_ci_uninit (d);
+       dvb_usb_device_exit (intf);
+}
+
+
+static int az6027_usb_probe(struct usb_interface *intf,
+               const struct usb_device_id *id)
+{
+       return dvb_usb_device_init(intf, &az6027_properties,
+                                  THIS_MODULE, NULL, adapter_nr);
+}
+
+/* I2C */
+static int az6027_i2c_xfer(struct i2c_adapter *adap,struct i2c_msg msg[],int num)
+{
+       struct dvb_usb_device *d = i2c_get_adapdata(adap);
+       int i=0,j=0,len=0;
+       int ret;
+       u16 index;
+       u16 value;
+       int length;
+       u8 req;
+       u8 data[256];
+       
+       if (mutex_lock_interruptible(&d->i2c_mutex) < 0)
+               return -EAGAIN;
+       //err("i2c func called\n");
+       if (num > 2)
+               warn("more than 2 i2c messages at a time is not handled yet. TODO.");
+
+       for (i = 0; i < num; i++) {
+               if(msg[i].addr == 0x99) {
+                       req = 0xBE;
+                       index = 0;
+                       value = msg[i].buf[0] & 0x00ff;
+                       length = 1;
+                       az6027_usb_out_op(d,req,value,index,data,length);
+               }
+               if(msg[i].addr == 0xd0){
+                       /* write/read request */
+                       if (i+1 < num && (msg[i+1].flags & I2C_M_RD)) {
+/*                             
+                               err("i2c read ");
+                               err("addr0 = 0x%x",msg[i].addr);
+                               err("buf0 = 0x%02x  0x%02x",msg[i].buf[0],msg[i].buf[1]);
+                               err("len0 = %d",msg[i].len);
+                               err("addr1 = 0x%x",msg[i+1].addr);
+                               err("buf1 = 0x%02x 0x%02x",msg[i+1].buf[0],  *msg[i+1].buf);
+                               err("len1 = %d",msg[i+1].len);  
+       
+*/
+                               req = 0xB9;
+                               index = (((msg[i].buf[0] << 8) & 0xff00) | (msg[i].buf[1] & 0x00ff));
+                               value = msg[i].addr + (msg[i].len << 8);
+                               length = msg[i+1].len + 6;
+                               //err("in: req. %02x, val: %04x, ind: %04x\n",req,value,index);
+                               ret = az6027_usb_in_op(d,req,value,index,data,length);
+                               //err("ret = %d data = %02x %02x",ret,data[5],data[6]);
+                               len = msg[i+1].len;
+                               for (j=0; j<len; j++)
+                               {
+                                       msg[i+1].buf[j] = data[j+5];    
+                               }
+                               i++;
+                               //err("11111");
+                       }
+                       else
+                       {
+                               //err("i2c write ");
+                               //err("addr = 0x%x\n",msg[i].addr);
+                               //err("buf = 0x%02x  0x%02x\n",msg[i].buf[0],msg[i].buf[1]);
+                               //err("len = %d",msg[i].len);
+                               if(msg[i].addr == 0xd0)//demod 16bit addr
+                               {
+                                       req = 0xBD;
+                                       index = (((msg[i].buf[0] << 8) & 0xff00) | (msg[i].buf[1] & 0x00ff));//(msg[i].buf[0]<< 8) + msg[i].buf[1];
+                                       value = msg[i].addr + (2 << 8);
+                                       length = msg[i].len - 2;
+                                       len = msg[i].len - 2;
+                                       for(j=0;j<len;j++)
+                                       {
+                                               data[j] = msg[i].buf[j+2];
+                                       }
+                               }
+                               //err("out: req. %02x, val: %04x, ind: %04x\n",req,value,index);
+                               az6027_usb_out_op(d,req,value,index,data,length);
+                               //err("22222");
+                       }
+               }
+               if(msg[i].addr == 0xc0){
+                       if (msg[i].flags & I2C_M_RD) {
+                               
+                               //err("i2c read ");
+                               //err("addr0 = 0x%x",msg[i].addr);
+                               //err("len0 = %d",msg[i].len);
+                               
+                               req = 0xB9;
+                               index = 0x0;
+                               value = msg[i].addr ;//+ (1 << 8);
+                               length = msg[i].len + 6;
+                               //err("in: req. %02x, val: %04x, ind: %04x\n",req,value,index);
+                               ret = az6027_usb_in_op(d,req,value,index,data,length);
+                               //err("ret = %d data = %02x %02x",ret,data[5],data[6]);
+                               len = msg[i].len;
+                               for (j=0; j<len; j++)
+                               {
+                                       msg[i].buf[j] = data[j+5];      
+                               }
+                       }
+                       else{
+                               //err("i2c write ");
+                               //err("addr0 = 0x%x",msg[i].addr);
+                               //err("buf0 = 0x%x",msg[i].buf[0]);
+                               //err("len0 = %d",msg[i].len);
+                               
+                               req = 0xBD;
+                               index = msg[i].buf[0] & 0x00FF;
+                               value = msg[i].addr + (1 << 8);
+                               length = msg[i].len - 1;
+                               len = msg[i].len - 1;
+                               for(j=0;j<len;j++)
+                               {
+                                       data[j] = msg[i].buf[j+1];
+                               }
+                               //err("out: req. %02x, val: %04x, ind: %04x\n",req,value,index);
+                               az6027_usb_out_op(d,req,value,index,data,length);
+                       }
+               }
+       }       
+       mutex_unlock(&d->i2c_mutex);
+       
+       return i;
+}
+
+
+static u32 az6027_i2c_func(struct i2c_adapter *adapter)
+{
+       return I2C_FUNC_I2C;
+}
+
+static struct i2c_algorithm az6027_i2c_algo = {
+       .master_xfer   = az6027_i2c_xfer,
+       .functionality = az6027_i2c_func,
+};
+
+
+int az6027_identify_state(struct usb_device *udev, struct dvb_usb_device_properties *props,
+                       struct dvb_usb_device_description **desc, int *cold)
+{
+       u8 b[16];
+       s16 ret = usb_control_msg(udev, usb_rcvctrlpipe(udev,0),
+               0xb7, USB_TYPE_VENDOR | USB_DIR_IN, 6, 0, b, 6, USB_CTRL_GET_TIMEOUT);
+
+       //info("FW GET_VERSION length: %d\n",ret);
+
+       *cold = ret <= 0;
+
+       deb_info("cold: %d\n", *cold);
+       return 0;
+}
+
+
+static struct usb_device_id az6027_usb_table [] = {
+            { USB_DEVICE(USB_VID_TERRATEC, USB_PID_AZUREWAVE_AZ6027) },
+         // { USB_DEVICE(0x0fd9, 0x002a) },
+           { 0 },
+};
+
+MODULE_DEVICE_TABLE(usb, az6027_usb_table);
+
+static struct dvb_usb_device_properties az6027_properties = {
+       .caps = DVB_USB_IS_AN_I2C_ADAPTER,
+       .usb_ctrl = CYPRESS_FX2,
+       //.download_firmware = az6027_download_firmware,
+       .firmware            = "dvb-usb-az6027-03.fw",
+       .no_reconnect        = 1,
+
+       .size_of_priv     = sizeof(struct az6027_device_state),
+       .identify_state         = az6027_identify_state,
+       .num_adapters = 1,
+       .adapter = {
+               {
+                       //.caps             = DVB_USB_ADAP_RECEIVES_204_BYTE_TS,
+
+                       .streaming_ctrl   = az6027_streaming_ctrl,
+                       .frontend_attach  = az6027_frontend_attach,
+
+                       /* parameter for the MPEG2-data transfer */
+                       .stream = {
+                               .type = USB_BULK,
+                               .count = 10,
+                               .endpoint = 0x02,
+                               .u = {
+                                       .bulk = {
+                                               .buffersize = 4096,
+                                       }
+                               }
+                       },
+               }
+       },
+       //.power_ctrl       = az6027_power_ctrl,
+       //.read_mac_address = az6027_read_mac_addr,
+
+       .rc_key_map       = az6027_rc_keys,
+       .rc_key_map_size  = ARRAY_SIZE(az6027_rc_keys),
+       .rc_interval      = 400,
+       .rc_query         = az6027_rc_query,
+       .i2c_algo         = &az6027_i2c_algo,
+
+       .num_device_descs = 1,
+       .devices = {
+               { .name = "AZUREWAVE DVB-S/S2 USB2.0 (AZ6027)",
+                 .cold_ids = { &az6027_usb_table[0], NULL },
+                 .warm_ids = { NULL },
+               },
+               { NULL },
+       }
+};
+
+/* usb specific object needed to register this driver with the usb subsystem */
+static struct usb_driver az6027_usb_driver = {
+       .name           = "dvb_usb_az6027",
+       .probe          = az6027_usb_probe,
+       //.disconnect = dvb_usb_device_exit,
+       .disconnect     = az6027_usb_disconnect,
+       .id_table       = az6027_usb_table,
+};
+
+/* module stuff */
+static int __init az6027_usb_module_init(void)
+{
+       int result;
+       if ((result = usb_register(&az6027_usb_driver))) {
+               err("usb_register failed. (%d)",result);
+               return result;
+       }
+
+       return 0;
+}
+
+static void __exit az6027_usb_module_exit(void)
+{
+       /* deregister this driver from the USB subsystem */
+       usb_deregister(&az6027_usb_driver);
+}
+
+module_init(az6027_usb_module_init);
+module_exit(az6027_usb_module_exit);
+
+MODULE_AUTHOR("Adams Xu <Adams.xu@azwave.com.cn>");
+MODULE_DESCRIPTION("Driver for AZUREWAVE DVB-S/S2 USB2.0 (AZ6027)");
+MODULE_VERSION("1.0");
+MODULE_LICENSE("GPL");
diff --git a/drivers/media/dvb/dvb-usb/az6027.h b/drivers/media/dvb/dvb-usb/az6027.h
new file mode 100644 (file)
index 0000000..76bd28c
--- /dev/null
@@ -0,0 +1,14 @@
+#ifndef _DVB_USB_VP6027_H_
+#define _DVB_USB_VP6027_H_
+
+#define DVB_USB_LOG_PREFIX "az6027"
+#include "dvb-usb.h"
+
+
+extern int dvb_usb_az6027_debug;
+#define deb_info(args...) dprintk(dvb_usb_az6027_debug,0x01,args)
+#define deb_xfer(args...) dprintk(dvb_usb_az6027_debug,0x02,args)
+#define deb_rc(args...)   dprintk(dvb_usb_az6027_debug,0x04,args)
+#define deb_fe(args...)   dprintk(dvb_usb_az6027_debug,0x08,args)
+
+#endif