summaryrefslogtreecommitdiffstats
path: root/drivers/media/dvb/frontends/mb86a16.c
diff options
context:
space:
mode:
Diffstat (limited to 'drivers/media/dvb/frontends/mb86a16.c')
-rw-r--r--drivers/media/dvb/frontends/mb86a16.c1878
1 files changed, 0 insertions, 1878 deletions
diff --git a/drivers/media/dvb/frontends/mb86a16.c b/drivers/media/dvb/frontends/mb86a16.c
deleted file mode 100644
index 9ae40abfd71a..000000000000
--- a/drivers/media/dvb/frontends/mb86a16.c
+++ /dev/null
@@ -1,1878 +0,0 @@
-/*
- Fujitsu MB86A16 DVB-S/DSS DC Receiver driver
-
- Copyright (C) Manu Abraham (abraham.manu@gmail.com)
-
- 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; either version 2 of the License, or
- (at your option) any later version.
-
- This program is distributed in the hope that it will be useful,
- 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., 675 Mass Ave, Cambridge, MA 02139, USA.
-*/
-
-#include <linux/init.h>
-#include <linux/kernel.h>
-#include <linux/module.h>
-#include <linux/moduleparam.h>
-#include <linux/slab.h>
-
-#include "dvb_frontend.h"
-#include "mb86a16.h"
-#include "mb86a16_priv.h"
-
-unsigned int verbose = 5;
-module_param(verbose, int, 0644);
-
-#define ABS(x) ((x) < 0 ? (-x) : (x))
-
-struct mb86a16_state {
- struct i2c_adapter *i2c_adap;
- const struct mb86a16_config *config;
- struct dvb_frontend frontend;
-
- /* tuning parameters */
- int frequency;
- int srate;
-
- /* Internal stuff */
- int master_clk;
- int deci;
- int csel;
- int rsel;
-};
-
-#define MB86A16_ERROR 0
-#define MB86A16_NOTICE 1
-#define MB86A16_INFO 2
-#define MB86A16_DEBUG 3
-
-#define dprintk(x, y, z, format, arg...) do { \
- if (z) { \
- if ((x > MB86A16_ERROR) && (x > y)) \
- printk(KERN_ERR "%s: " format "\n", __func__, ##arg); \
- else if ((x > MB86A16_NOTICE) && (x > y)) \
- printk(KERN_NOTICE "%s: " format "\n", __func__, ##arg); \
- else if ((x > MB86A16_INFO) && (x > y)) \
- printk(KERN_INFO "%s: " format "\n", __func__, ##arg); \
- else if ((x > MB86A16_DEBUG) && (x > y)) \
- printk(KERN_DEBUG "%s: " format "\n", __func__, ##arg); \
- } else { \
- if (x > y) \
- printk(format, ##arg); \
- } \
-} while (0)
-
-#define TRACE_IN dprintk(verbose, MB86A16_DEBUG, 1, "-->()")
-#define TRACE_OUT dprintk(verbose, MB86A16_DEBUG, 1, "()-->")
-
-static int mb86a16_write(struct mb86a16_state *state, u8 reg, u8 val)
-{
- int ret;
- u8 buf[] = { reg, val };
-
- struct i2c_msg msg = {
- .addr = state->config->demod_address,
- .flags = 0,
- .buf = buf,
- .len = 2
- };
-
- dprintk(verbose, MB86A16_DEBUG, 1,
- "writing to [0x%02x],Reg[0x%02x],Data[0x%02x]",
- state->config->demod_address, buf[0], buf[1]);
-
- ret = i2c_transfer(state->i2c_adap, &msg, 1);
-
- return (ret != 1) ? -EREMOTEIO : 0;
-}
-
-static int mb86a16_read(struct mb86a16_state *state, u8 reg, u8 *val)
-{
- int ret;
- u8 b0[] = { reg };
- u8 b1[] = { 0 };
-
- struct i2c_msg msg[] = {
- {
- .addr = state->config->demod_address,
- .flags = 0,
- .buf = b0,
- .len = 1
- }, {
- .addr = state->config->demod_address,
- .flags = I2C_M_RD,
- .buf = b1,
- .len = 1
- }
- };
- ret = i2c_transfer(state->i2c_adap, msg, 2);
- if (ret != 2) {
- dprintk(verbose, MB86A16_ERROR, 1, "read error(reg=0x%02x, ret=0x%i)",
- reg, ret);
-
- return -EREMOTEIO;
- }
- *val = b1[0];
-
- return ret;
-}
-
-static int CNTM_set(struct mb86a16_state *state,
- unsigned char timint1,
- unsigned char timint2,
- unsigned char cnext)
-{
- unsigned char val;
-
- val = (timint1 << 4) | (timint2 << 2) | cnext;
- if (mb86a16_write(state, MB86A16_CNTMR, val) < 0)
- goto err;
-
- return 0;
-
-err:
- dprintk(verbose, MB86A16_ERROR, 1, "I2C transfer error");
- return -EREMOTEIO;
-}
-
-static int smrt_set(struct mb86a16_state *state, int rate)
-{
- int tmp ;
- int m ;
- unsigned char STOFS0, STOFS1;
-
- m = 1 << state->deci;
- tmp = (8192 * state->master_clk - 2 * m * rate * 8192 + state->master_clk / 2) / state->master_clk;
-
- STOFS0 = tmp & 0x0ff;
- STOFS1 = (tmp & 0xf00) >> 8;
-
- if (mb86a16_write(state, MB86A16_SRATE1, (state->deci << 2) |
- (state->csel << 1) |
- state->rsel) < 0)
- goto err;
- if (mb86a16_write(state, MB86A16_SRATE2, STOFS0) < 0)
- goto err;
- if (mb86a16_write(state, MB86A16_SRATE3, STOFS1) < 0)
- goto err;
-
- return 0;
-err:
- dprintk(verbose, MB86A16_ERROR, 1, "I2C transfer error");
- return -1;
-}
-
-static int srst(struct mb86a16_state *state)
-{
- if (mb86a16_write(state, MB86A16_RESET, 0x04) < 0)
- goto err;
-
- return 0;
-err:
- dprintk(verbose, MB86A16_ERROR, 1, "I2C transfer error");
- return -EREMOTEIO;
-
-}
-
-static int afcex_data_set(struct mb86a16_state *state,
- unsigned char AFCEX_L,
- unsigned char AFCEX_H)
-{
- if (mb86a16_write(state, MB86A16_AFCEXL, AFCEX_L) < 0)
- goto err;
- if (mb86a16_write(state, MB86A16_AFCEXH, AFCEX_H) < 0)
- goto err;
-
- return 0;
-err:
- dprintk(verbose, MB86A16_ERROR, 1, "I2C transfer error");
-
- return -1;
-}
-
-static int afcofs_data_set(struct mb86a16_state *state,
- unsigned char AFCEX_L,
- unsigned char AFCEX_H)
-{
- if (mb86a16_write(state, 0x58, AFCEX_L) < 0)
- goto err;
- if (mb86a16_write(state, 0x59, AFCEX_H) < 0)
- goto err;
-
- return 0;
-err:
- dprintk(verbose, MB86A16_ERROR, 1, "I2C transfer error");
- return -EREMOTEIO;
-}
-
-static int stlp_set(struct mb86a16_state *state,
- unsigned char STRAS,
- unsigned char STRBS)
-{
- if (mb86a16_write(state, MB86A16_STRFILTCOEF1, (STRBS << 3) | (STRAS)) < 0)
- goto err;
-
- return 0;
-err:
- dprintk(verbose, MB86A16_ERROR, 1, "I2C transfer error");
- return -EREMOTEIO;
-}
-
-static int Vi_set(struct mb86a16_state *state, unsigned char ETH, unsigned char VIA)
-{
- if (mb86a16_write(state, MB86A16_VISET2, 0x04) < 0)
- goto err;
- if (mb86a16_write(state, MB86A16_VISET3, 0xf5) < 0)
- goto err;
-
- return 0;
-err:
- dprintk(verbose, MB86A16_ERROR, 1, "I2C transfer error");
- return -EREMOTEIO;
-}
-
-static int initial_set(struct mb86a16_state *state)
-{
- if (stlp_set(state, 5, 7))
- goto err;
-
- udelay(100);
- if (afcex_data_set(state, 0, 0))
- goto err;
-
- udelay(100);
- if (afcofs_data_set(state, 0, 0))
- goto err;
-
- udelay(100);
- if (mb86a16_write(state, MB86A16_CRLFILTCOEF1, 0x16) < 0)
- goto err;
- if (mb86a16_write(state, 0x2f, 0x21) < 0)
- goto err;
- if (mb86a16_write(state, MB86A16_VIMAG, 0x38) < 0)
- goto err;
- if (mb86a16_write(state, MB86A16_FAGCS1, 0x00) < 0)
- goto err;
- if (mb86a16_write(state, MB86A16_FAGCS2, 0x1c) < 0)
- goto err;
- if (mb86a16_write(state, MB86A16_FAGCS3, 0x20) < 0)
- goto err;
- if (mb86a16_write(state, MB86A16_FAGCS4, 0x1e) < 0)
- goto err;
- if (mb86a16_write(state, MB86A16_FAGCS5, 0x23) < 0)
- goto err;
- if (mb86a16_write(state, 0x54, 0xff) < 0)
- goto err;
- if (mb86a16_write(state, MB86A16_TSOUT, 0x00) < 0)
- goto err;
-
- return 0;
-
-err:
- dprintk(verbose, MB86A16_ERROR, 1, "I2C transfer error");
- return -EREMOTEIO;
-}
-
-static int S01T_set(struct mb86a16_state *state,
- unsigned char s1t,
- unsigned s0t)
-{
- if (mb86a16_write(state, 0x33, (s1t << 3) | s0t) < 0)
- goto err;
-
- return 0;
-err:
- dprintk(verbose, MB86A16_ERROR, 1, "I2C transfer error");
- return -EREMOTEIO;
-}
-
-
-static int EN_set(struct mb86a16_state *state,
- int cren,
- int afcen)
-{
- unsigned char val;
-
- val = 0x7a | (cren << 7) | (afcen << 2);
- if (mb86a16_write(state, 0x49, val) < 0)
- goto err;
-
- return 0;
-err:
- dprintk(verbose, MB86A16_ERROR, 1, "I2C transfer error");
- return -EREMOTEIO;
-}
-
-static int AFCEXEN_set(struct mb86a16_state *state,
- int afcexen,
- int smrt)
-{
- unsigned char AFCA ;
-
- if (smrt > 18875)
- AFCA = 4;
- else if (smrt > 9375)
- AFCA = 3;
- else if (smrt > 2250)
- AFCA = 2;
- else
- AFCA = 1;
-
- if (mb86a16_write(state, 0x2a, 0x02 | (afcexen << 5) | (AFCA << 2)) < 0)
- goto err;
-
- return 0;
-
-err:
- dprintk(verbose, MB86A16_ERROR, 1, "I2C transfer error");
- return -EREMOTEIO;
-}
-
-static int DAGC_data_set(struct mb86a16_state *state,
- unsigned char DAGCA,
- unsigned char DAGCW)
-{
- if (mb86a16_write(state, 0x2d, (DAGCA << 3) | DAGCW) < 0)
- goto err;
-
- return 0;
-
-err:
- dprintk(verbose, MB86A16_ERROR, 1, "I2C transfer error");
- return -EREMOTEIO;
-}
-
-static void smrt_info_get(struct mb86a16_state *state, int rate)
-{
- if (rate >= 37501) {
- state->deci = 0; state->csel = 0; state->rsel = 0;
- } else if (rate >= 30001) {
- state->deci = 0; state->csel = 0; state->rsel = 1;
- } else if (rate >= 26251) {
- state->deci = 0; state->csel = 1; state->rsel = 0;
- } else if (rate >= 22501) {
- state->deci = 0; state->csel = 1; state->rsel = 1;
- } else if (rate >= 18751) {
- state->deci = 1; state->csel = 0; state->rsel = 0;
- } else if (rate >= 15001) {
- state->deci = 1; state->csel = 0; state->rsel = 1;
- } else if (rate >= 13126) {
- state->deci = 1; state->csel = 1; state->rsel = 0;
- } else if (rate >= 11251) {
- state->deci = 1; state->csel = 1; state->rsel = 1;
- } else if (rate >= 9376) {
- state->deci = 2; state->csel = 0; state->rsel = 0;
- } else if (rate >= 7501) {
- state->deci = 2; state->csel = 0; state->rsel = 1;
- } else if (rate >= 6563) {
- state->deci = 2; state->csel = 1; state->rsel = 0;
- } else if (rate >= 5626) {
- state->deci = 2; state->csel = 1; state->rsel = 1;
- } else if (rate >= 4688) {
- state->deci = 3; state->csel = 0; state->rsel = 0;
- } else if (rate >= 3751) {
- state->deci = 3; state->csel = 0; state->rsel = 1;
- } else if (rate >= 3282) {
- state->deci = 3; state->csel = 1; state->rsel = 0;
- } else if (rate >= 2814) {
- state->deci = 3; state->csel = 1; state->rsel = 1;
- } else if (rate >= 2344) {
- state->deci = 4; state->csel = 0; state->rsel = 0;
- } else if (rate >= 1876) {
- state->deci = 4; state->csel = 0; state->rsel = 1;
- } else if (rate >= 1641) {
- state->deci = 4; state->csel = 1; state->rsel = 0;
- } else if (rate >= 1407) {
- state->deci = 4; state->csel = 1; state->rsel = 1;
- } else if (rate >= 1172) {
- state->deci = 5; state->csel = 0; state->rsel = 0;
- } else if (rate >= 939) {
- state->deci = 5; state->csel = 0; state->rsel = 1;
- } else if (rate >= 821) {
- state->deci = 5; state->csel = 1; state->rsel = 0;
- } else {
- state->deci = 5; state->csel = 1; state->rsel = 1;
- }
-
- if (state->csel == 0)
- state->master_clk = 92000;
- else
- state->master_clk = 61333;
-
-}
-
-static int signal_det(struct mb86a16_state *state,
- int smrt,
- unsigned char *SIG)
-{
-
- int ret ;
- int smrtd ;
- int wait_sym ;
-
- u32 wait_t;
- unsigned char S[3] ;
- int i ;
-
- if (*SIG > 45) {
- if (CNTM_set(state, 2, 1, 2) < 0) {
- dprintk(verbose, MB86A16_ERROR, 1, "CNTM set Error");
- return -1;
- }
- wait_sym = 40000;
- } else {
- if (CNTM_set(state, 3, 1, 2) < 0) {
- dprintk(verbose, MB86A16_ERROR, 1, "CNTM set Error");
- return -1;
- }
- wait_sym = 80000;
- }
- for (i = 0; i < 3; i++) {
- if (i == 0)
- smrtd = smrt * 98 / 100;
- else if (i == 1)
- smrtd = smrt;
- else
- smrtd = smrt * 102 / 100;
- smrt_info_get(state, smrtd);
- smrt_set(state, smrtd);
- srst(state);
- wait_t = (wait_sym + 99 * smrtd / 100) / smrtd;
- if (wait_t == 0)
- wait_t = 1;
- msleep_interruptible(10);
- if (mb86a16_read(state, 0x37, &(S[i])) != 2) {
- dprintk(verbose, MB86A16_ERROR, 1, "I2C transfer error");
- return -EREMOTEIO;
- }
- }
- if ((S[1] > S[0] * 112 / 100) &&
- (S[1] > S[2] * 112 / 100)) {
-
- ret = 1;
- } else {
- ret = 0;
- }
- *SIG = S[1];
-
- if (CNTM_set(state, 0, 1, 2) < 0) {
- dprintk(verbose, MB86A16_ERROR, 1, "CNTM set Error");
- return -1;
- }
-
- return ret;
-}
-
-static int rf_val_set(struct mb86a16_state *state,
- int f,
- int smrt,
- unsigned char R)
-{
- unsigned char C, F, B;
- int M;
- unsigned char rf_val[5];
- int ack = -1;
-
- if (smrt > 37750)
- C = 1;
- else if (smrt > 18875)
- C = 2;
- else if (smrt > 5500)
- C = 3;
- else
- C = 4;
-
- if (smrt > 30500)
- F = 3;
- else if (smrt > 9375)
- F = 1;
- else if (smrt > 4625)
- F = 0;
- else
- F = 2;
-
- if (f < 1060)
- B = 0;
- else if (f < 1175)
- B = 1;
- else if (f < 1305)
- B = 2;
- else if (f < 1435)
- B = 3;
- else if (f < 1570)
- B = 4;
- else if (f < 1715)
- B = 5;
- else if (f < 1845)
- B = 6;
- else if (f < 1980)
- B = 7;
- else if (f < 2080)
- B = 8;
- else
- B = 9;
-
- M = f * (1 << R) / 2;
-
- rf_val[0] = 0x01 | (C << 3) | (F << 1);
- rf_val[1] = (R << 5) | ((M & 0x1f000) >> 12);
- rf_val[2] = (M & 0x00ff0) >> 4;
- rf_val[3] = ((M & 0x0000f) << 4) | B;
-
- /* Frequency Set */
- if (mb86a16_write(state, 0x21, rf_val[0]) < 0)
- ack = 0;
- if (mb86a16_write(state, 0x22, rf_val[1]) < 0)
- ack = 0;
- if (mb86a16_write(state, 0x23, rf_val[2]) < 0)
- ack = 0;
- if (mb86a16_write(state, 0x24, rf_val[3]) < 0)
- ack = 0;
- if (mb86a16_write(state, 0x25, 0x01) < 0)
- ack = 0;
- if (ack == 0) {
- dprintk(verbose, MB86A16_ERROR, 1, "RF Setup - I2C transfer error");
- return -EREMOTEIO;
- }
-
- return 0;
-}
-
-static int afcerr_chk(struct mb86a16_state *state)
-{
- unsigned char AFCM_L, AFCM_H ;
- int AFCM ;
- int afcm, afcerr ;
-
- if (mb86a16_read(state, 0x0e, &AFCM_L) != 2)
- goto err;
- if (mb86a16_read(state, 0x0f, &AFCM_H) != 2)
- goto err;
-
- AFCM = (AFCM_H << 8) + AFCM_L;
-
- if (AFCM > 2048)
- afcm = AFCM - 4096;
- else
- afcm = AFCM;
- afcerr = afcm * state->master_clk / 8192;
-
- return afcerr;
-
-err:
- dprintk(verbose, MB86A16_ERROR, 1, "I2C transfer error");
- return -EREMOTEIO;
-}
-
-static int dagcm_val_get(struct mb86a16_state *state)
-{
- int DAGCM;
- unsigned char DAGCM_H, DAGCM_L;
-
- if (mb86a16_read(state, 0x45, &DAGCM_L) != 2)
- goto err;
- if (mb86a16_read(state, 0x46, &DAGCM_H) != 2)
- goto err;
-
- DAGCM = (DAGCM_H << 8) + DAGCM_L;
-
- return DAGCM;
-
-err:
- dprintk(verbose, MB86A16_ERROR, 1, "I2C transfer error");
- return -EREMOTEIO;
-}
-
-static int mb86a16_read_status(struct dvb_frontend *fe, fe_status_t *status)
-{
- u8 stat, stat2;
- struct mb86a16_state *state = fe->demodulator_priv;
-
- *status = 0;
-
- if (mb86a16_read(state, MB86A16_SIG1, &stat) != 2)
- goto err;
- if (mb86a16_read(state, MB86A16_SIG2, &stat2) != 2)
- goto err;
- if ((stat > 25) && (stat2 > 25))
- *status |= FE_HAS_SIGNAL;
- if ((stat > 45) && (stat2 > 45))
- *status |= FE_HAS_CARRIER;
-
- if (mb86a16_read(state, MB86A16_STATUS, &stat) != 2)
- goto err;
-
- if (stat & 0x01)
- *status |= FE_HAS_SYNC;
- if (stat & 0x01)
- *status |= FE_HAS_VITERBI;
-
- if (mb86a16_read(state, MB86A16_FRAMESYNC, &stat) != 2)
- goto err;
-
- if ((stat & 0x0f) && (*status & FE_HAS_VITERBI))
- *status |= FE_HAS_LOCK;
-
- return 0;
-
-err:
- dprintk(verbose, MB86A16_ERROR, 1, "I2C transfer error");
- return -EREMOTEIO;
-}
-
-static int sync_chk(struct mb86a16_state *state,
- unsigned char *VIRM)
-{
- unsigned char val;
- int sync;
-
- if (mb86a16_read(state, 0x0d, &val) != 2)
- goto err;
-
- dprintk(verbose, MB86A16_INFO, 1, "Status = %02x,", val);
- sync = val & 0x01;
- *VIRM = (val & 0x1c) >> 2;
-
- return sync;
-err:
- dprintk(verbose, MB86A16_ERROR, 1, "I2C transfer error");
- return -EREMOTEIO;
-
-}
-
-static int freqerr_chk(struct mb86a16_state *state,
- int fTP,
- int smrt,
- int unit)
-{
- unsigned char CRM, AFCML, AFCMH;
- unsigned char temp1, temp2, temp3;
- int crm, afcm, AFCM;
- int crrerr, afcerr; /* kHz */
- int frqerr; /* MHz */
- int afcen, afcexen = 0;
- int R, M, fOSC, fOSC_OFS;
-
- if (mb86a16_read(state, 0x43, &CRM) != 2)
- goto err;
-
- if (CRM > 127)
- crm = CRM - 256;
- else
- crm = CRM;
-
- crrerr = smrt * crm / 256;
- if (mb86a16_read(state, 0x49, &temp1) != 2)
- goto err;
-
- afcen = (temp1 & 0x04) >> 2;
- if (afcen == 0) {
- if (mb86a16_read(state, 0x2a, &temp1) != 2)
- goto err;
- afcexen = (temp1 & 0x20) >> 5;
- }
-
- if (afcen == 1) {
- if (mb86a16_read(state, 0x0e, &AFCML) != 2)
- goto err;
- if (mb86a16_read(state, 0x0f, &AFCMH) != 2)
- goto err;
- } else if (afcexen == 1) {
- if (mb86a16_read(state, 0x2b, &AFCML) != 2)
- goto err;
- if (mb86a16_read(state, 0x2c, &AFCMH) != 2)
- goto err;
- }
- if ((afcen == 1) || (afcexen == 1)) {
- smrt_info_get(state, smrt);
- AFCM = ((AFCMH & 0x01) << 8) + AFCML;
- if (AFCM > 255)
- afcm = AFCM - 512;
- else
- afcm = AFCM;
-
- afcerr = afcm * state->master_clk / 8192;
- } else
- afcerr = 0;
-
- if (mb86a16_read(state, 0x22, &temp1) != 2)
- goto err;
- if (mb86a16_read(state, 0x23, &temp2) != 2)
- goto err;
- if (mb86a16_read(state, 0x24, &temp3) != 2)
- goto err;
-
- R = (temp1 & 0xe0) >> 5;
- M = ((temp1 & 0x1f) << 12) + (temp2 << 4) + (temp3 >> 4);
- if (R == 0)
- fOSC = 2 * M;
- else
- fOSC = M;
-
- fOSC_OFS = fOSC - fTP;
-
- if (unit == 0) { /* MHz */
- if (crrerr + afcerr + fOSC_OFS * 1000 >= 0)
- frqerr = (crrerr + afcerr + fOSC_OFS * 1000 + 500) / 1000;
- else
- frqerr = (crrerr + afcerr + fOSC_OFS * 1000 - 500) / 1000;
- } else { /* kHz */
- frqerr = crrerr + afcerr + fOSC_OFS * 1000;
- }
-
- return frqerr;
-err:
- dprintk(verbose, MB86A16_ERROR, 1, "I2C transfer error");
- return -EREMOTEIO;
-}
-
-static unsigned char vco_dev_get(struct mb86a16_state *state, int smrt)
-{
- unsigned char R;
-
- if (smrt > 9375)
- R = 0;
- else
- R = 1;
-
- return R;
-}
-
-static void swp_info_get(struct mb86a16_state *state,
- int fOSC_start,
- int smrt,
- int v, int R,
- int swp_ofs,
- int *fOSC,
- int *afcex_freq,
- unsigned char *AFCEX_L,
- unsigned char *AFCEX_H)
-{
- int AFCEX ;
- int crnt_swp_freq ;
-
- crnt_swp_freq = fOSC_start * 1000 + v * swp_ofs;
-
- if (R == 0)
- *fOSC = (crnt_swp_freq + 1000) / 2000 * 2;
- else
- *fOSC = (crnt_swp_freq + 500) / 1000;
-
- if (*fOSC >= crnt_swp_freq)
- *afcex_freq = *fOSC * 1000 - crnt_swp_freq;
- else
- *afcex_freq = crnt_swp_freq - *fOSC * 1000;
-
- AFCEX = *afcex_freq * 8192 / state->master_clk;
- *AFCEX_L = AFCEX & 0x00ff;
- *AFCEX_H = (AFCEX & 0x0f00) >> 8;
-}
-
-
-static int swp_freq_calcuation(struct mb86a16_state *state, int i, int v, int *V, int vmax, int vmin,
- int SIGMIN, int fOSC, int afcex_freq, int swp_ofs, unsigned char *SIG1)
-{
- int swp_freq ;
-
- if ((i % 2 == 1) && (v <= vmax)) {
- /* positive v (case 1) */
- if ((v - 1 == vmin) &&
- (*(V + 30 + v) >= 0) &&
- (*(V + 30 + v - 1) >= 0) &&
- (*(V + 30 + v - 1) > *(V + 30 + v)) &&
- (*(V + 30 + v - 1) > SIGMIN)) {
-
- swp_freq = fOSC * 1000 + afcex_freq - swp_ofs;
- *SIG1 = *(V + 30 + v - 1);
- } else if ((v == vmax) &&
- (*(V + 30 + v) >= 0) &&
- (*(V + 30 + v - 1) >= 0) &&
- (*(V + 30 + v) > *(V + 30 + v - 1)) &&
- (*(V + 30 + v) > SIGMIN)) {
- /* (case 2) */
- swp_freq = fOSC * 1000 + afcex_freq;
- *SIG1 = *(V + 30 + v);
- } else if ((*(V + 30 + v) > 0) &&
- (*(V + 30 + v - 1) > 0) &&
- (*(V + 30 + v - 2) > 0) &&
- (*(V + 30 + v - 3) > 0) &&
- (*(V + 30 + v - 1) > *(V + 30 + v)) &&
- (*(V + 30 + v - 2) > *(V + 30 + v - 3)) &&
- ((*(V + 30 + v - 1) > SIGMIN) ||
- (*(V + 30 + v - 2) > SIGMIN))) {
- /* (case 3) */
- if (*(V + 30 + v - 1) >= *(V + 30 + v - 2)) {
- swp_freq = fOSC * 1000 + afcex_freq - swp_ofs;
- *SIG1 = *(V + 30 + v - 1);
- } else {
- swp_freq = fOSC * 1000 + afcex_freq - swp_ofs * 2;
- *SIG1 = *(V + 30 + v - 2);
- }
- } else if ((v == vmax) &&
- (*(V + 30 + v) >= 0) &&
- (*(V + 30 + v - 1) >= 0) &&
- (*(V + 30 + v - 2) >= 0) &&
- (*(V + 30 + v) > *(V + 30 + v - 2)) &&
- (*(V + 30 + v - 1) > *(V + 30 + v - 2)) &&
- ((*(V + 30 + v) > SIGMIN) ||
- (*(V + 30 + v - 1) > SIGMIN))) {
- /* (case 4) */
- if (*(V + 30 + v) >= *(V + 30 + v - 1)) {
- swp_freq = fOSC * 1000 + afcex_freq;
- *SIG1 = *(V + 30 + v);
- } else {
- swp_freq = fOSC * 1000 + afcex_freq - swp_ofs;
- *SIG1 = *(V + 30 + v - 1);
- }
- } else {
- swp_freq = -1 ;
- }
- } else if ((i % 2 == 0) && (v >= vmin)) {
- /* Negative v (case 1) */
- if ((*(V + 30 + v) > 0) &&
- (*(V + 30 + v + 1) > 0) &&
- (*(V + 30 + v + 2) > 0) &&
- (*(V + 30 + v + 1) > *(V + 30 + v)) &&
- (*(V + 30 + v + 1) > *(V + 30 + v + 2)) &&
- (*(V + 30 + v + 1) > SIGMIN)) {
-
- swp_freq = fOSC * 1000 + afcex_freq + swp_ofs;
- *SIG1 = *(V + 30 + v + 1);
- } else if ((v + 1 == vmax) &&
- (*(V + 30 + v) >= 0) &&
- (*(V + 30 + v + 1) >= 0) &&
- (*(V + 30 + v + 1) > *(V + 30 + v)) &&
- (*(V + 30 + v + 1) > SIGMIN)) {
- /* (case 2) */
- swp_freq = fOSC * 1000 + afcex_freq + swp_ofs;
- *SIG1 = *(V + 30 + v);
- } else if ((v == vmin) &&
- (*(V + 30 + v) > 0) &&
- (*(V + 30 + v + 1) > 0) &&
- (*(V + 30 + v + 2) > 0) &&
- (*(V + 30 + v) > *(V + 30 + v + 1)) &&
- (*(V + 30 + v) > *(V + 30 + v + 2)) &&
- (*(V + 30 + v) > SIGMIN)) {
- /* (case 3) */
- swp_freq = fOSC * 1000 + afcex_freq;
- *SIG1 = *(V + 30 + v);
- } else if ((*(V + 30 + v) >= 0) &&
- (*(V + 30 + v + 1) >= 0) &&
- (*(V + 30 + v + 2) >= 0) &&
- (*(V + 30 + v + 3) >= 0) &&
- (*(V + 30 + v + 1) > *(V + 30 + v)) &&
- (*(V + 30 + v + 2) > *(V + 30 + v + 3)) &&
- ((*(V + 30 + v + 1) > SIGMIN) ||
- (*(V + 30 + v + 2) > SIGMIN))) {
- /* (case 4) */
- if (*(V + 30 + v + 1) >= *(V + 30 + v + 2)) {
- swp_freq = fOSC * 1000 + afcex_freq + swp_ofs;
- *SIG1 = *(V + 30 + v + 1);
- } else {
- swp_freq = fOSC * 1000 + afcex_freq + swp_ofs * 2;
- *SIG1 = *(V + 30 + v + 2);
- }
- } else if ((*(V + 30 + v) >= 0) &&
- (*(V + 30 + v + 1) >= 0) &&
- (*(V + 30 + v + 2) >= 0) &&
- (*(V + 30 + v + 3) >= 0) &&
- (*(V + 30 + v) > *(V + 30 + v + 2)) &&
- (*(V + 30 + v + 1) > *(V + 30 + v + 2)) &&
- (*(V + 30 + v) > *(V + 30 + v + 3)) &&
- (*(V + 30 + v + 1) > *(V + 30 + v + 3)) &&
- ((*(V + 30 + v) > SIGMIN) ||
- (*(V + 30 + v + 1) > SIGMIN))) {
- /* (case 5) */
- if (*(V + 30 + v) >= *(V + 30 + v + 1)) {
- swp_freq = fOSC * 1000 + afcex_freq;
- *SIG1 = *(V + 30 + v);
- } else {
- swp_freq = fOSC * 1000 + afcex_freq + swp_ofs;
- *SIG1 = *(V + 30 + v + 1);
- }
- } else if ((v + 2 == vmin) &&
- (*(V + 30 + v) >= 0) &&
- (*(V + 30 + v + 1) >= 0) &&
- (*(V + 30 + v + 2) >= 0) &&
- (*(V + 30 + v + 1) > *(V + 30 + v)) &&
- (*(V + 30 + v + 2) > *(V + 30 + v)) &&
- ((*(V + 30 + v + 1) > SIGMIN) ||
- (*(V + 30 + v + 2) > SIGMIN))) {
- /* (case 6) */
- if (*(V + 30 + v + 1) >= *(V + 30 + v + 2)) {
- swp_freq = fOSC * 1000 + afcex_freq + swp_ofs;
- *SIG1 = *(V + 30 + v + 1);
- } else {
- swp_freq = fOSC * 1000 + afcex_freq + swp_ofs * 2;
- *SIG1 = *(V + 30 + v + 2);
- }
- } else if ((vmax == 0) && (vmin == 0) && (*(V + 30 + v) > SIGMIN)) {
- swp_freq = fOSC * 1000;
- *SIG1 = *(V + 30 + v);
- } else
- swp_freq = -1;
- } else
- swp_freq = -1;
-
- return swp_freq;
-}
-
-static void swp_info_get2(struct mb86a16_state *state,
- int smrt,
- int R,
- int swp_freq,
- int *afcex_freq,
- int *fOSC,
- unsigned char *AFCEX_L,
- unsigned char *AFCEX_H)
-{
- int AFCEX ;
-
- if (R == 0)
- *fOSC = (swp_freq + 1000) / 2000 * 2;
- else
- *fOSC = (swp_freq + 500) / 1000;
-
- if (*fOSC >= swp_freq)
- *afcex_freq = *fOSC * 1000 - swp_freq;
- else
- *afcex_freq = swp_freq - *fOSC * 1000;
-
- AFCEX = *afcex_freq * 8192 / state->master_clk;
- *AFCEX_L = AFCEX & 0x00ff;
- *AFCEX_H = (AFCEX & 0x0f00) >> 8;
-}
-
-static void afcex_info_get(struct mb86a16_state *state,
- int afcex_freq,
- unsigned char *AFCEX_L,
- unsigned char *AFCEX_H)
-{
- int AFCEX ;
-
- AFCEX = afcex_freq * 8192 / state->master_clk;
- *AFCEX_L = AFCEX & 0x00ff;
- *AFCEX_H = (AFCEX & 0x0f00) >> 8;
-}
-
-static int SEQ_set(struct mb86a16_state *state, unsigned char loop)
-{
- /* SLOCK0 = 0 */
- if (mb86a16_write(state, 0x32, 0x02 | (loop << 2)) < 0) {
- dprintk(verbose, MB86A16_ERROR, 1, "I2C transfer error");
- return -EREMOTEIO;
- }
-
- return 0;
-}
-
-static int iq_vt_set(struct mb86a16_state *state, unsigned char IQINV)
-{
- /* Viterbi Rate, IQ Settings */
- if (mb86a16_write(state, 0x06, 0xdf | (IQINV << 5)) < 0) {
- dprintk(verbose, MB86A16_ERROR, 1, "I2C transfer error");
- return -EREMOTEIO;
- }
-
- return 0;
-}
-
-static int FEC_srst(struct mb86a16_state *state)
-{
- if (mb86a16_write(state, MB86A16_RESET, 0x02) < 0) {
- dprintk(verbose, MB86A16_ERROR, 1, "I2C transfer error");
- return -EREMOTEIO;
- }
-
- return 0;
-}
-
-static int S2T_set(struct mb86a16_state *state, unsigned char S2T)
-{
- if (mb86a16_write(state, 0x34, 0x70 | S2T) < 0) {
- dprintk(verbose, MB86A16_ERROR, 1, "I2C transfer error");
- return -EREMOTEIO;
- }
-
- return 0;
-}
-
-static int S45T_set(struct mb86a16_state *state, unsigned char S4T, unsigned char S5T)
-{
- if (mb86a16_write(state, 0x35, 0x00 | (S5T << 4) | S4T) < 0) {
- dprintk(verbose, MB86A16_ERROR, 1, "I2C transfer error");
- return -EREMOTEIO;
- }
-
- return 0;
-}
-
-
-static int mb86a16_set_fe(struct mb86a16_state *state)
-{
- u8 agcval, cnmval;
-
- int i, j;
- int fOSC = 0;
- int fOSC_start = 0;
- int wait_t;
- int fcp;
- int swp_ofs;
- int V[60];
- u8 SIG1MIN;
-
- unsigned char CREN, AFCEN, AFCEXEN;
- unsigned char SIG1;
- unsigned char TIMINT1, TIMINT2, TIMEXT;
- unsigned char S0T, S1T;
- unsigned char S2T;
-/* unsigned char S2T, S3T; */
- unsigned char S4T, S5T;
- unsigned char AFCEX_L, AFCEX_H;
- unsigned char R;
- unsigned char VIRM;
- unsigned char ETH, VIA;
- unsigned char junk;
-
- int loop;
- int ftemp;
- int v, vmax, vmin;
- int vmax_his, vmin_his;
- int swp_freq, prev_swp_freq[20];
- int prev_freq_num;
- int signal_dupl;
- int afcex_freq;
- int signal;
- int afcerr;
- int temp_freq, delta_freq;
- int dagcm[4];
- int smrt_d;
-/* int freq_err; */
- int n;
- int ret = -1;
- int sync;
-
- dprintk(verbose, MB86A16_INFO, 1, "freq=%d Mhz, symbrt=%d Ksps", state->frequency, state->srate);
-
- fcp = 3000;
- swp_ofs = state->srate / 4;
-
- for (i = 0; i < 60; i++)
- V[i] = -1;
-
- for (i = 0; i < 20; i++)
- prev_swp_freq[i] = 0;
-
- SIG1MIN = 25;
-
- for (n = 0; ((n < 3) && (ret == -1)); n++) {
- SEQ_set(state, 0);
- iq_vt_set(state, 0);
-
- CREN = 0;
- AFCEN = 0;
- AFCEXEN = 1;
- TIMINT1 = 0;
- TIMINT2 = 1;
- TIMEXT = 2;
- S1T = 0;
- S0T = 0;
-
- if (initial_set(state) < 0) {
- dprintk(verbose, MB86A16_ERROR, 1, "initial set failed");
- return -1;
- }
- if (DAGC_data_set(state, 3, 2) < 0) {
- dprintk(verbose, MB86A16_ERROR, 1, "DAGC data set error");
- return -1;
- }
- if (EN_set(state, CREN, AFCEN) < 0) {
- dprintk(verbose, MB86A16_ERROR, 1, "EN set error");
- return -1; /* (0, 0) */
- }
- if (AFCEXEN_set(state, AFCEXEN, state->srate) < 0) {
- dprintk(verbose, MB86A16_ERROR, 1, "AFCEXEN set error");
- return -1; /* (1, smrt) = (1, symbolrate) */
- }
- if (CNTM_set(state, TIMINT1, TIMINT2, TIMEXT) < 0) {
- dprintk(verbose, MB86A16_ERROR, 1, "CNTM set error");
- return -1; /* (0, 1, 2) */
- }
- if (S01T_set(state, S1T, S0T) < 0) {
- dprintk(verbose, MB86A16_ERROR, 1, "S01T set error");
- return -1; /* (0, 0) */
- }
- smrt_info_get(state, state->srate);
- if (smrt_set(state, state->srate) < 0) {
- dprintk(verbose, MB86A16_ERROR, 1, "smrt info get error");
- return -1;
- }
-
- R = vco_dev_get(state, state->srate);
- if (R == 1)
- fOSC_start = state->frequency;
-
- else if (R == 0) {
- if (state->frequency % 2 == 0) {
- fOSC_start = state->frequency;
- } else {
- fOSC_start = state->frequency + 1;
- if (fOSC_start > 2150)
- fOSC_start = state->frequency - 1;
- }
- }
- loop = 1;
- ftemp = fOSC_start * 1000;
- vmax = 0 ;
- while (loop == 1) {
- ftemp = ftemp + swp_ofs;
- vmax++;
-
- /* Upper bound */
- if (ftemp > 2150000) {
- loop = 0;
- vmax--;
- } else {
- if ((ftemp == 2150000) ||
- (ftemp - state->frequency * 1000 >= fcp + state->srate / 4))
- loop = 0;
- }
- }
-
- loop = 1;
- ftemp = fOSC_start * 1000;
- vmin = 0 ;
- while (loop == 1) {
- ftemp = ftemp - swp_ofs;
- vmin--;
-
- /* Lower bound */
- if (ftemp < 950000) {
- loop = 0;
- vmin++;
- } else {
- if ((ftemp == 950000) ||
- (state->frequency * 1000 - ftemp >= fcp + state->srate / 4))
- loop = 0;
- }
- }
-
- wait_t = (8000 + state->srate / 2) / state->srate;
- if (wait_t == 0)
- wait_t = 1;
-
- i = 0;
- j = 0;
- prev_freq_num = 0;
- loop = 1;
- signal = 0;
- vmax_his = 0;
- vmin_his = 0;
- v = 0;
-
- while (loop == 1) {
- swp_info_get(state, fOSC_start, state->srate,
- v, R, swp_ofs, &fOSC,
- &afcex_freq, &AFCEX_L, &AFCEX_H);
-
- udelay(100);
- if (rf_val_set(state, fOSC, state->srate, R) < 0) {
- dprintk(verbose, MB86A16_ERROR, 1, "rf val set error");
- return -1;
- }
- udelay(100);
- if (afcex_data_set(state, AFCEX_L, AFCEX_H) < 0) {
- dprintk(verbose, MB86A16_ERROR, 1, "afcex data set error");
- return -1;
- }
- if (srst(state) < 0) {
- dprintk(verbose, MB86A16_ERROR, 1, "srst error");
- return -1;
- }
- msleep_interruptible(wait_t);
-
- if (mb86a16_read(state, 0x37, &SIG1) != 2) {
- dprintk(verbose, MB86A16_ERROR, 1, "I2C transfer error");
- return -1;
- }
- V[30 + v] = SIG1 ;
- swp_freq = swp_freq_calcuation(state, i, v, V, vmax, vmin,
- SIG1MIN, fOSC, afcex_freq,
- swp_ofs, &SIG1); /* changed */
-
- signal_dupl = 0;
- for (j = 0; j < prev_freq_num; j++) {
- if ((ABS(prev_swp_freq[j] - swp_freq)) < (swp_ofs * 3 / 2)) {
- signal_dupl = 1;
- dprintk(verbose, MB86A16_INFO, 1, "Probably Duplicate Signal, j = %d", j);
- }
- }
- if ((signal_dupl == 0) && (swp_freq > 0) && (ABS(swp_freq - state->frequency * 1000) < fcp + state->srate / 6)) {
- dprintk(verbose, MB86A16_DEBUG, 1, "------ Signal detect ------ [swp_freq=[%07d, srate=%05d]]", swp_freq, state->srate);
- prev_swp_freq[prev_freq_num] = swp_freq;
- prev_freq_num++;
- swp_info_get2(state, state->srate, R, swp_freq,
- &afcex_freq, &fOSC,
- &AFCEX_L, &AFCEX_H);
-
- if (rf_val_set(state, fOSC, state->srate, R) < 0) {
- dprintk(verbose, MB86A16_ERROR, 1, "rf val set error");
- return -1;
- }
- if (afcex_data_set(state, AFCEX_L, AFCEX_H) < 0) {
- dprintk(verbose, MB86A16_ERROR, 1, "afcex data set error");</