forked from Minki/linux
1874 lines
52 KiB
C
1874 lines
52 KiB
C
|
/*
|
||
|
* Driver for the MaxLinear MxL5xx family of tuners/demods
|
||
|
*
|
||
|
* Copyright (C) 2014-2015 Ralph Metzler <rjkm@metzlerbros.de>
|
||
|
* Marcus Metzler <mocm@metzlerbros.de>
|
||
|
* developed for Digital Devices GmbH
|
||
|
*
|
||
|
* based on code:
|
||
|
* Copyright (c) 2011-2013 MaxLinear, Inc. All rights reserved
|
||
|
* which was released under GPL V2
|
||
|
*
|
||
|
* This program is free software; you can redistribute it and/or
|
||
|
* modify it under the terms of the GNU General Public License
|
||
|
* version 2, as published by the Free Software Foundation.
|
||
|
*
|
||
|
* 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.
|
||
|
*
|
||
|
*/
|
||
|
|
||
|
#include <linux/kernel.h>
|
||
|
#include <linux/module.h>
|
||
|
#include <linux/moduleparam.h>
|
||
|
#include <linux/init.h>
|
||
|
#include <linux/delay.h>
|
||
|
#include <linux/firmware.h>
|
||
|
#include <linux/i2c.h>
|
||
|
#include <linux/version.h>
|
||
|
#include <linux/mutex.h>
|
||
|
#include <linux/vmalloc.h>
|
||
|
#include <asm/div64.h>
|
||
|
#include <asm/unaligned.h>
|
||
|
|
||
|
#include "dvb_frontend.h"
|
||
|
#include "mxl5xx.h"
|
||
|
#include "mxl5xx_regs.h"
|
||
|
#include "mxl5xx_defs.h"
|
||
|
|
||
|
#define BYTE0(v) ((v >> 0) & 0xff)
|
||
|
#define BYTE1(v) ((v >> 8) & 0xff)
|
||
|
#define BYTE2(v) ((v >> 16) & 0xff)
|
||
|
#define BYTE3(v) ((v >> 24) & 0xff)
|
||
|
|
||
|
LIST_HEAD(mxllist);
|
||
|
|
||
|
struct mxl_base {
|
||
|
struct list_head mxllist;
|
||
|
struct list_head mxls;
|
||
|
|
||
|
u8 adr;
|
||
|
struct i2c_adapter *i2c;
|
||
|
|
||
|
u32 count;
|
||
|
u32 type;
|
||
|
u32 sku_type;
|
||
|
u32 chipversion;
|
||
|
u32 clock;
|
||
|
u32 fwversion;
|
||
|
|
||
|
u8 *ts_map;
|
||
|
u8 can_clkout;
|
||
|
u8 chan_bond;
|
||
|
u8 demod_num;
|
||
|
u8 tuner_num;
|
||
|
|
||
|
unsigned long next_tune;
|
||
|
|
||
|
struct mutex i2c_lock;
|
||
|
struct mutex status_lock;
|
||
|
struct mutex tune_lock;
|
||
|
|
||
|
u8 buf[MXL_HYDRA_OEM_MAX_CMD_BUFF_LEN];
|
||
|
|
||
|
u32 cmd_size;
|
||
|
u8 cmd_data[MAX_CMD_DATA];
|
||
|
};
|
||
|
|
||
|
struct mxl {
|
||
|
struct list_head mxl;
|
||
|
|
||
|
struct mxl_base *base;
|
||
|
struct dvb_frontend fe;
|
||
|
struct device *i2cdev;
|
||
|
u32 demod;
|
||
|
u32 tuner;
|
||
|
u32 tuner_in_use;
|
||
|
u8 xbar[3];
|
||
|
|
||
|
unsigned long tune_time;
|
||
|
};
|
||
|
|
||
|
static void convert_endian(u8 flag, u32 size, u8 *d)
|
||
|
{
|
||
|
u32 i;
|
||
|
|
||
|
if (!flag)
|
||
|
return;
|
||
|
for (i = 0; i < (size & ~3); i += 4) {
|
||
|
d[i + 0] ^= d[i + 3];
|
||
|
d[i + 3] ^= d[i + 0];
|
||
|
d[i + 0] ^= d[i + 3];
|
||
|
|
||
|
d[i + 1] ^= d[i + 2];
|
||
|
d[i + 2] ^= d[i + 1];
|
||
|
d[i + 1] ^= d[i + 2];
|
||
|
}
|
||
|
|
||
|
switch (size & 3) {
|
||
|
case 0:
|
||
|
case 1:
|
||
|
/* do nothing */
|
||
|
break;
|
||
|
case 2:
|
||
|
d[i + 0] ^= d[i + 1];
|
||
|
d[i + 1] ^= d[i + 0];
|
||
|
d[i + 0] ^= d[i + 1];
|
||
|
break;
|
||
|
|
||
|
case 3:
|
||
|
d[i + 0] ^= d[i + 2];
|
||
|
d[i + 2] ^= d[i + 0];
|
||
|
d[i + 0] ^= d[i + 2];
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
}
|
||
|
|
||
|
static int i2c_write(struct i2c_adapter *adap, u8 adr,
|
||
|
u8 *data, u32 len)
|
||
|
{
|
||
|
struct i2c_msg msg = {.addr = adr, .flags = 0,
|
||
|
.buf = data, .len = len};
|
||
|
|
||
|
return (i2c_transfer(adap, &msg, 1) == 1) ? 0 : -1;
|
||
|
}
|
||
|
|
||
|
static int i2c_read(struct i2c_adapter *adap, u8 adr,
|
||
|
u8 *data, u32 len)
|
||
|
{
|
||
|
struct i2c_msg msg = {.addr = adr, .flags = I2C_M_RD,
|
||
|
.buf = data, .len = len};
|
||
|
|
||
|
return (i2c_transfer(adap, &msg, 1) == 1) ? 0 : -1;
|
||
|
}
|
||
|
|
||
|
static int i2cread(struct mxl *state, u8 *data, int len)
|
||
|
{
|
||
|
return i2c_read(state->base->i2c, state->base->adr, data, len);
|
||
|
}
|
||
|
|
||
|
static int i2cwrite(struct mxl *state, u8 *data, int len)
|
||
|
{
|
||
|
return i2c_write(state->base->i2c, state->base->adr, data, len);
|
||
|
}
|
||
|
|
||
|
static int read_register_unlocked(struct mxl *state, u32 reg, u32 *val)
|
||
|
{
|
||
|
int stat;
|
||
|
u8 data[MXL_HYDRA_REG_SIZE_IN_BYTES + MXL_HYDRA_I2C_HDR_SIZE] = {
|
||
|
MXL_HYDRA_PLID_REG_READ, 0x04,
|
||
|
GET_BYTE(reg, 0), GET_BYTE(reg, 1),
|
||
|
GET_BYTE(reg, 2), GET_BYTE(reg, 3),
|
||
|
};
|
||
|
|
||
|
stat = i2cwrite(state, data,
|
||
|
MXL_HYDRA_REG_SIZE_IN_BYTES + MXL_HYDRA_I2C_HDR_SIZE);
|
||
|
if (stat)
|
||
|
dev_err(state->i2cdev, "i2c read error 1\n");
|
||
|
if (!stat)
|
||
|
stat = i2cread(state, (u8 *) val,
|
||
|
MXL_HYDRA_REG_SIZE_IN_BYTES);
|
||
|
le32_to_cpus(val);
|
||
|
if (stat)
|
||
|
dev_err(state->i2cdev, "i2c read error 2\n");
|
||
|
return stat;
|
||
|
}
|
||
|
|
||
|
#define DMA_I2C_INTERRUPT_ADDR 0x8000011C
|
||
|
#define DMA_INTR_PROT_WR_CMP 0x08
|
||
|
|
||
|
static int send_command(struct mxl *state, u32 size, u8 *buf)
|
||
|
{
|
||
|
int stat;
|
||
|
u32 val, count = 10;
|
||
|
|
||
|
mutex_lock(&state->base->i2c_lock);
|
||
|
if (state->base->fwversion > 0x02010109) {
|
||
|
read_register_unlocked(state, DMA_I2C_INTERRUPT_ADDR, &val);
|
||
|
if (DMA_INTR_PROT_WR_CMP & val)
|
||
|
dev_info(state->i2cdev, "%s busy\n", __func__);
|
||
|
while ((DMA_INTR_PROT_WR_CMP & val) && --count) {
|
||
|
mutex_unlock(&state->base->i2c_lock);
|
||
|
usleep_range(1000, 2000);
|
||
|
mutex_lock(&state->base->i2c_lock);
|
||
|
read_register_unlocked(state, DMA_I2C_INTERRUPT_ADDR,
|
||
|
&val);
|
||
|
}
|
||
|
if (!count) {
|
||
|
dev_info(state->i2cdev, "%s busy\n", __func__);
|
||
|
mutex_unlock(&state->base->i2c_lock);
|
||
|
return -EBUSY;
|
||
|
}
|
||
|
}
|
||
|
stat = i2cwrite(state, buf, size);
|
||
|
mutex_unlock(&state->base->i2c_lock);
|
||
|
return stat;
|
||
|
}
|
||
|
|
||
|
static int write_register(struct mxl *state, u32 reg, u32 val)
|
||
|
{
|
||
|
int stat;
|
||
|
u8 data[MXL_HYDRA_REG_WRITE_LEN] = {
|
||
|
MXL_HYDRA_PLID_REG_WRITE, 0x08,
|
||
|
BYTE0(reg), BYTE1(reg), BYTE2(reg), BYTE3(reg),
|
||
|
BYTE0(val), BYTE1(val), BYTE2(val), BYTE3(val),
|
||
|
};
|
||
|
mutex_lock(&state->base->i2c_lock);
|
||
|
stat = i2cwrite(state, data, sizeof(data));
|
||
|
mutex_unlock(&state->base->i2c_lock);
|
||
|
if (stat)
|
||
|
dev_err(state->i2cdev, "i2c write error\n");
|
||
|
return stat;
|
||
|
}
|
||
|
|
||
|
static int write_firmware_block(struct mxl *state,
|
||
|
u32 reg, u32 size, u8 *reg_data_ptr)
|
||
|
{
|
||
|
int stat;
|
||
|
u8 *buf = state->base->buf;
|
||
|
|
||
|
mutex_lock(&state->base->i2c_lock);
|
||
|
buf[0] = MXL_HYDRA_PLID_REG_WRITE;
|
||
|
buf[1] = size + 4;
|
||
|
buf[2] = GET_BYTE(reg, 0);
|
||
|
buf[3] = GET_BYTE(reg, 1);
|
||
|
buf[4] = GET_BYTE(reg, 2);
|
||
|
buf[5] = GET_BYTE(reg, 3);
|
||
|
memcpy(&buf[6], reg_data_ptr, size);
|
||
|
stat = i2cwrite(state, buf,
|
||
|
MXL_HYDRA_I2C_HDR_SIZE +
|
||
|
MXL_HYDRA_REG_SIZE_IN_BYTES + size);
|
||
|
mutex_unlock(&state->base->i2c_lock);
|
||
|
if (stat)
|
||
|
dev_err(state->i2cdev, "fw block write failed\n");
|
||
|
return stat;
|
||
|
}
|
||
|
|
||
|
static int read_register(struct mxl *state, u32 reg, u32 *val)
|
||
|
{
|
||
|
int stat;
|
||
|
u8 data[MXL_HYDRA_REG_SIZE_IN_BYTES + MXL_HYDRA_I2C_HDR_SIZE] = {
|
||
|
MXL_HYDRA_PLID_REG_READ, 0x04,
|
||
|
GET_BYTE(reg, 0), GET_BYTE(reg, 1),
|
||
|
GET_BYTE(reg, 2), GET_BYTE(reg, 3),
|
||
|
};
|
||
|
|
||
|
mutex_lock(&state->base->i2c_lock);
|
||
|
stat = i2cwrite(state, data,
|
||
|
MXL_HYDRA_REG_SIZE_IN_BYTES + MXL_HYDRA_I2C_HDR_SIZE);
|
||
|
if (stat)
|
||
|
dev_err(state->i2cdev, "i2c read error 1\n");
|
||
|
if (!stat)
|
||
|
stat = i2cread(state, (u8 *) val,
|
||
|
MXL_HYDRA_REG_SIZE_IN_BYTES);
|
||
|
mutex_unlock(&state->base->i2c_lock);
|
||
|
le32_to_cpus(val);
|
||
|
if (stat)
|
||
|
dev_err(state->i2cdev, "i2c read error 2\n");
|
||
|
return stat;
|
||
|
}
|
||
|
|
||
|
static int read_register_block(struct mxl *state, u32 reg, u32 size, u8 *data)
|
||
|
{
|
||
|
int stat;
|
||
|
u8 *buf = state->base->buf;
|
||
|
|
||
|
mutex_lock(&state->base->i2c_lock);
|
||
|
|
||
|
buf[0] = MXL_HYDRA_PLID_REG_READ;
|
||
|
buf[1] = size + 4;
|
||
|
buf[2] = GET_BYTE(reg, 0);
|
||
|
buf[3] = GET_BYTE(reg, 1);
|
||
|
buf[4] = GET_BYTE(reg, 2);
|
||
|
buf[5] = GET_BYTE(reg, 3);
|
||
|
stat = i2cwrite(state, buf,
|
||
|
MXL_HYDRA_I2C_HDR_SIZE + MXL_HYDRA_REG_SIZE_IN_BYTES);
|
||
|
if (!stat) {
|
||
|
stat = i2cread(state, data, size);
|
||
|
convert_endian(MXL_ENABLE_BIG_ENDIAN, size, data);
|
||
|
}
|
||
|
mutex_unlock(&state->base->i2c_lock);
|
||
|
return stat;
|
||
|
}
|
||
|
|
||
|
static int read_by_mnemonic(struct mxl *state,
|
||
|
u32 reg, u8 lsbloc, u8 numofbits, u32 *val)
|
||
|
{
|
||
|
u32 data = 0, mask = 0;
|
||
|
int stat;
|
||
|
|
||
|
stat = read_register(state, reg, &data);
|
||
|
if (stat)
|
||
|
return stat;
|
||
|
mask = MXL_GET_REG_MASK_32(lsbloc, numofbits);
|
||
|
data &= mask;
|
||
|
data >>= lsbloc;
|
||
|
*val = data;
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
|
||
|
static int update_by_mnemonic(struct mxl *state,
|
||
|
u32 reg, u8 lsbloc, u8 numofbits, u32 val)
|
||
|
{
|
||
|
u32 data, mask;
|
||
|
int stat;
|
||
|
|
||
|
stat = read_register(state, reg, &data);
|
||
|
if (stat)
|
||
|
return stat;
|
||
|
mask = MXL_GET_REG_MASK_32(lsbloc, numofbits);
|
||
|
data = (data & ~mask) | ((val << lsbloc) & mask);
|
||
|
stat = write_register(state, reg, data);
|
||
|
return stat;
|
||
|
}
|
||
|
|
||
|
static int firmware_is_alive(struct mxl *state)
|
||
|
{
|
||
|
u32 hb0, hb1;
|
||
|
|
||
|
if (read_register(state, HYDRA_HEAR_BEAT, &hb0))
|
||
|
return 0;
|
||
|
msleep(20);
|
||
|
if (read_register(state, HYDRA_HEAR_BEAT, &hb1))
|
||
|
return 0;
|
||
|
if (hb1 == hb0)
|
||
|
return 0;
|
||
|
return 1;
|
||
|
}
|
||
|
|
||
|
static int init(struct dvb_frontend *fe)
|
||
|
{
|
||
|
struct dtv_frontend_properties *p = &fe->dtv_property_cache;
|
||
|
|
||
|
/* init fe stats */
|
||
|
p->strength.len = 1;
|
||
|
p->strength.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
|
||
|
p->cnr.len = 1;
|
||
|
p->cnr.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
|
||
|
p->pre_bit_error.len = 1;
|
||
|
p->pre_bit_error.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
|
||
|
p->pre_bit_count.len = 1;
|
||
|
p->pre_bit_count.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
|
||
|
p->post_bit_error.len = 1;
|
||
|
p->post_bit_error.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
|
||
|
p->post_bit_count.len = 1;
|
||
|
p->post_bit_count.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static void release(struct dvb_frontend *fe)
|
||
|
{
|
||
|
struct mxl *state = fe->demodulator_priv;
|
||
|
|
||
|
list_del(&state->mxl);
|
||
|
/* Release one frontend, two more shall take its place! */
|
||
|
state->base->count--;
|
||
|
if (state->base->count == 0) {
|
||
|
list_del(&state->base->mxllist);
|
||
|
kfree(state->base);
|
||
|
}
|
||
|
kfree(state);
|
||
|
}
|
||
|
|
||
|
static int get_algo(struct dvb_frontend *fe)
|
||
|
{
|
||
|
return DVBFE_ALGO_HW;
|
||
|
}
|
||
|
|
||
|
static int cfg_demod_abort_tune(struct mxl *state)
|
||
|
{
|
||
|
struct MXL_HYDRA_DEMOD_ABORT_TUNE_T abort_tune_cmd;
|
||
|
u8 cmd_size = sizeof(abort_tune_cmd);
|
||
|
u8 cmd_buff[MXL_HYDRA_OEM_MAX_CMD_BUFF_LEN];
|
||
|
|
||
|
abort_tune_cmd.demod_id = state->demod;
|
||
|
BUILD_HYDRA_CMD(MXL_HYDRA_ABORT_TUNE_CMD, MXL_CMD_WRITE,
|
||
|
cmd_size, &abort_tune_cmd, cmd_buff);
|
||
|
return send_command(state, cmd_size + MXL_HYDRA_CMD_HEADER_SIZE,
|
||
|
&cmd_buff[0]);
|
||
|
}
|
||
|
|
||
|
static int send_master_cmd(struct dvb_frontend *fe,
|
||
|
struct dvb_diseqc_master_cmd *cmd)
|
||
|
{
|
||
|
/*struct mxl *state = fe->demodulator_priv;*/
|
||
|
|
||
|
return 0; /*CfgDemodAbortTune(state);*/
|
||
|
}
|
||
|
|
||
|
static int set_parameters(struct dvb_frontend *fe)
|
||
|
{
|
||
|
struct mxl *state = fe->demodulator_priv;
|
||
|
struct dtv_frontend_properties *p = &fe->dtv_property_cache;
|
||
|
struct MXL_HYDRA_DEMOD_PARAM_T demod_chan_cfg;
|
||
|
u8 cmd_size = sizeof(demod_chan_cfg);
|
||
|
u8 cmd_buff[MXL_HYDRA_OEM_MAX_CMD_BUFF_LEN];
|
||
|
u32 srange = 10;
|
||
|
int stat;
|
||
|
|
||
|
if (p->frequency < 950000 || p->frequency > 2150000)
|
||
|
return -EINVAL;
|
||
|
if (p->symbol_rate < 1000000 || p->symbol_rate > 45000000)
|
||
|
return -EINVAL;
|
||
|
|
||
|
/* CfgDemodAbortTune(state); */
|
||
|
|
||
|
switch (p->delivery_system) {
|
||
|
case SYS_DSS:
|
||
|
demod_chan_cfg.standard = MXL_HYDRA_DSS;
|
||
|
demod_chan_cfg.roll_off = MXL_HYDRA_ROLLOFF_AUTO;
|
||
|
break;
|
||
|
case SYS_DVBS:
|
||
|
srange = p->symbol_rate / 1000000;
|
||
|
if (srange > 10)
|
||
|
srange = 10;
|
||
|
demod_chan_cfg.standard = MXL_HYDRA_DVBS;
|
||
|
demod_chan_cfg.roll_off = MXL_HYDRA_ROLLOFF_0_35;
|
||
|
demod_chan_cfg.modulation_scheme = MXL_HYDRA_MOD_QPSK;
|
||
|
demod_chan_cfg.pilots = MXL_HYDRA_PILOTS_OFF;
|
||
|
break;
|
||
|
case SYS_DVBS2:
|
||
|
demod_chan_cfg.standard = MXL_HYDRA_DVBS2;
|
||
|
demod_chan_cfg.roll_off = MXL_HYDRA_ROLLOFF_AUTO;
|
||
|
demod_chan_cfg.modulation_scheme = MXL_HYDRA_MOD_AUTO;
|
||
|
demod_chan_cfg.pilots = MXL_HYDRA_PILOTS_AUTO;
|
||
|
/* cfg_scrambler(state); */
|
||
|
break;
|
||
|
default:
|
||
|
return -EINVAL;
|
||
|
}
|
||
|
demod_chan_cfg.tuner_index = state->tuner;
|
||
|
demod_chan_cfg.demod_index = state->demod;
|
||
|
demod_chan_cfg.frequency_in_hz = p->frequency * 1000;
|
||
|
demod_chan_cfg.symbol_rate_in_hz = p->symbol_rate;
|
||
|
demod_chan_cfg.max_carrier_offset_in_mhz = srange;
|
||
|
demod_chan_cfg.spectrum_inversion = MXL_HYDRA_SPECTRUM_AUTO;
|
||
|
demod_chan_cfg.fec_code_rate = MXL_HYDRA_FEC_AUTO;
|
||
|
|
||
|
mutex_lock(&state->base->tune_lock);
|
||
|
if (time_after(jiffies + msecs_to_jiffies(200),
|
||
|
state->base->next_tune))
|
||
|
while (time_before(jiffies, state->base->next_tune))
|
||
|
usleep_range(10000, 11000);
|
||
|
state->base->next_tune = jiffies + msecs_to_jiffies(100);
|
||
|
state->tuner_in_use = state->tuner;
|
||
|
BUILD_HYDRA_CMD(MXL_HYDRA_DEMOD_SET_PARAM_CMD, MXL_CMD_WRITE,
|
||
|
cmd_size, &demod_chan_cfg, cmd_buff);
|
||
|
stat = send_command(state, cmd_size + MXL_HYDRA_CMD_HEADER_SIZE,
|
||
|
&cmd_buff[0]);
|
||
|
mutex_unlock(&state->base->tune_lock);
|
||
|
return stat;
|
||
|
}
|
||
|
|
||
|
static int enable_tuner(struct mxl *state, u32 tuner, u32 enable);
|
||
|
|
||
|
static int sleep(struct dvb_frontend *fe)
|
||
|
{
|
||
|
struct mxl *state = fe->demodulator_priv;
|
||
|
struct mxl *p;
|
||
|
|
||
|
cfg_demod_abort_tune(state);
|
||
|
if (state->tuner_in_use != 0xffffffff) {
|
||
|
mutex_lock(&state->base->tune_lock);
|
||
|
state->tuner_in_use = 0xffffffff;
|
||
|
list_for_each_entry(p, &state->base->mxls, mxl) {
|
||
|
if (p->tuner_in_use == state->tuner)
|
||
|
break;
|
||
|
}
|
||
|
if (&p->mxl == &state->base->mxls)
|
||
|
enable_tuner(state, state->tuner, 0);
|
||
|
mutex_unlock(&state->base->tune_lock);
|
||
|
}
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int read_snr(struct dvb_frontend *fe)
|
||
|
{
|
||
|
struct mxl *state = fe->demodulator_priv;
|
||
|
int stat;
|
||
|
u32 reg_data = 0;
|
||
|
struct dtv_frontend_properties *p = &fe->dtv_property_cache;
|
||
|
|
||
|
mutex_lock(&state->base->status_lock);
|
||
|
HYDRA_DEMOD_STATUS_LOCK(state, state->demod);
|
||
|
stat = read_register(state, (HYDRA_DMD_SNR_ADDR_OFFSET +
|
||
|
HYDRA_DMD_STATUS_OFFSET(state->demod)),
|
||
|
®_data);
|
||
|
HYDRA_DEMOD_STATUS_UNLOCK(state, state->demod);
|
||
|
mutex_unlock(&state->base->status_lock);
|
||
|
|
||
|
p->cnr.stat[0].scale = FE_SCALE_DECIBEL;
|
||
|
p->cnr.stat[0].svalue = (s16)reg_data * 10;
|
||
|
|
||
|
return stat;
|
||
|
}
|
||
|
|
||
|
static int read_ber(struct dvb_frontend *fe)
|
||
|
{
|
||
|
struct mxl *state = fe->demodulator_priv;
|
||
|
struct dtv_frontend_properties *p = &fe->dtv_property_cache;
|
||
|
u32 reg[8];
|
||
|
|
||
|
mutex_lock(&state->base->status_lock);
|
||
|
HYDRA_DEMOD_STATUS_LOCK(state, state->demod);
|
||
|
read_register_block(state,
|
||
|
(HYDRA_DMD_DVBS_1ST_CORR_RS_ERRORS_ADDR_OFFSET +
|
||
|
HYDRA_DMD_STATUS_OFFSET(state->demod)),
|
||
|
(4 * sizeof(u32)),
|
||
|
(u8 *) ®[0]);
|
||
|
HYDRA_DEMOD_STATUS_UNLOCK(state, state->demod);
|
||
|
|
||
|
switch (p->delivery_system) {
|
||
|
case SYS_DSS:
|
||
|
case SYS_DVBS:
|
||
|
p->pre_bit_error.stat[0].scale = FE_SCALE_COUNTER;
|
||
|
p->pre_bit_error.stat[0].uvalue = reg[2];
|
||
|
p->pre_bit_count.stat[0].scale = FE_SCALE_COUNTER;
|
||
|
p->pre_bit_count.stat[0].uvalue = reg[3];
|
||
|
break;
|
||
|
default:
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
read_register_block(state,
|
||
|
(HYDRA_DMD_DVBS2_CRC_ERRORS_ADDR_OFFSET +
|
||
|
HYDRA_DMD_STATUS_OFFSET(state->demod)),
|
||
|
(7 * sizeof(u32)),
|
||
|
(u8 *) ®[0]);
|
||
|
|
||
|
switch (p->delivery_system) {
|
||
|
case SYS_DSS:
|
||
|
case SYS_DVBS:
|
||
|
p->post_bit_error.stat[0].scale = FE_SCALE_COUNTER;
|
||
|
p->post_bit_error.stat[0].uvalue = reg[5];
|
||
|
p->post_bit_count.stat[0].scale = FE_SCALE_COUNTER;
|
||
|
p->post_bit_count.stat[0].uvalue = reg[6];
|
||
|
break;
|
||
|
case SYS_DVBS2:
|
||
|
p->post_bit_error.stat[0].scale = FE_SCALE_COUNTER;
|
||
|
p->post_bit_error.stat[0].uvalue = reg[1];
|
||
|
p->post_bit_count.stat[0].scale = FE_SCALE_COUNTER;
|
||
|
p->post_bit_count.stat[0].uvalue = reg[2];
|
||
|
break;
|
||
|
default:
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
mutex_unlock(&state->base->status_lock);
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int read_signal_strength(struct dvb_frontend *fe)
|
||
|
{
|
||
|
struct mxl *state = fe->demodulator_priv;
|
||
|
struct dtv_frontend_properties *p = &fe->dtv_property_cache;
|
||
|
int stat;
|
||
|
u32 reg_data = 0;
|
||
|
|
||
|
mutex_lock(&state->base->status_lock);
|
||
|
HYDRA_DEMOD_STATUS_LOCK(state, state->demod);
|
||
|
stat = read_register(state, (HYDRA_DMD_STATUS_INPUT_POWER_ADDR +
|
||
|
HYDRA_DMD_STATUS_OFFSET(state->demod)),
|
||
|
®_data);
|
||
|
HYDRA_DEMOD_STATUS_UNLOCK(state, state->demod);
|
||
|
mutex_unlock(&state->base->status_lock);
|
||
|
|
||
|
p->strength.stat[0].scale = FE_SCALE_DECIBEL;
|
||
|
p->strength.stat[0].svalue = (s16) reg_data * 10; /* fix scale */
|
||
|
|
||
|
return stat;
|
||
|
}
|
||
|
|
||
|
static int read_status(struct dvb_frontend *fe, enum fe_status *status)
|
||
|
{
|
||
|
struct mxl *state = fe->demodulator_priv;
|
||
|
struct dtv_frontend_properties *p = &fe->dtv_property_cache;
|
||
|
u32 reg_data = 0;
|
||
|
|
||
|
mutex_lock(&state->base->status_lock);
|
||
|
HYDRA_DEMOD_STATUS_LOCK(state, state->demod);
|
||
|
read_register(state, (HYDRA_DMD_LOCK_STATUS_ADDR_OFFSET +
|
||
|
HYDRA_DMD_STATUS_OFFSET(state->demod)),
|
||
|
®_data);
|
||
|
HYDRA_DEMOD_STATUS_UNLOCK(state, state->demod);
|
||
|
mutex_unlock(&state->base->status_lock);
|
||
|
|
||
|
*status = (reg_data == 1) ? 0x1f : 0;
|
||
|
|
||
|
/* signal statistics */
|
||
|
|
||
|
/* signal strength is always available */
|
||
|
read_signal_strength(fe);
|
||
|
|
||
|
if (*status & FE_HAS_CARRIER)
|
||
|
read_snr(fe);
|
||
|
else
|
||
|
p->cnr.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
|
||
|
|
||
|
if (*status & FE_HAS_SYNC)
|
||
|
read_ber(fe);
|
||
|
else {
|
||
|
p->pre_bit_error.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
|
||
|
p->pre_bit_count.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
|
||
|
p->post_bit_error.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
|
||
|
p->post_bit_count.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
|
||
|
}
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int tune(struct dvb_frontend *fe, bool re_tune,
|
||
|
unsigned int mode_flags,
|
||
|
unsigned int *delay, enum fe_status *status)
|
||
|
{
|
||
|
struct mxl *state = fe->demodulator_priv;
|
||
|
int r = 0;
|
||
|
|
||
|
*delay = HZ / 2;
|
||
|
if (re_tune) {
|
||
|
r = set_parameters(fe);
|
||
|
if (r)
|
||
|
return r;
|
||
|
state->tune_time = jiffies;
|
||
|
return 0;
|
||
|
}
|
||
|
if (*status & FE_HAS_LOCK)
|
||
|
return 0;
|
||
|
|
||
|
r = read_status(fe, status);
|
||
|
if (r)
|
||
|
return r;
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static enum fe_code_rate conv_fec(enum MXL_HYDRA_FEC_E fec)
|
||
|
{
|
||
|
enum fe_code_rate fec2fec[11] = {
|
||
|
FEC_NONE, FEC_1_2, FEC_3_5, FEC_2_3,
|
||
|
FEC_3_4, FEC_4_5, FEC_5_6, FEC_6_7,
|
||
|
FEC_7_8, FEC_8_9, FEC_9_10
|
||
|
};
|
||
|
|
||
|
if (fec > MXL_HYDRA_FEC_9_10)
|
||
|
return FEC_NONE;
|
||
|
return fec2fec[fec];
|
||
|
}
|
||
|
|
||
|
static int get_frontend(struct dvb_frontend *fe,
|
||
|
struct dtv_frontend_properties *p)
|
||
|
{
|
||
|
struct mxl *state = fe->demodulator_priv;
|
||
|
u32 reg_data[MXL_DEMOD_CHAN_PARAMS_BUFF_SIZE];
|
||
|
u32 freq;
|
||
|
|
||
|
mutex_lock(&state->base->status_lock);
|
||
|
HYDRA_DEMOD_STATUS_LOCK(state, state->demod);
|
||
|
read_register_block(state,
|
||
|
(HYDRA_DMD_STANDARD_ADDR_OFFSET +
|
||
|
HYDRA_DMD_STATUS_OFFSET(state->demod)),
|
||
|
(MXL_DEMOD_CHAN_PARAMS_BUFF_SIZE * 4), /* 25 * 4 bytes */
|
||
|
(u8 *) ®_data[0]);
|
||
|
/* read demod channel parameters */
|
||
|
read_register_block(state,
|
||
|
(HYDRA_DMD_STATUS_CENTER_FREQ_IN_KHZ_ADDR +
|
||
|
HYDRA_DMD_STATUS_OFFSET(state->demod)),
|
||
|
(4), /* 4 bytes */
|
||
|
(u8 *) &freq);
|
||
|
HYDRA_DEMOD_STATUS_UNLOCK(state, state->demod);
|
||
|
mutex_unlock(&state->base->status_lock);
|
||
|
|
||
|
dev_dbg(state->i2cdev, "freq=%u delsys=%u srate=%u\n",
|
||
|
freq * 1000, reg_data[DMD_STANDARD_ADDR],
|
||
|
reg_data[DMD_SYMBOL_RATE_ADDR]);
|
||
|
p->symbol_rate = reg_data[DMD_SYMBOL_RATE_ADDR];
|
||
|
p->frequency = freq;
|
||
|
/*
|
||
|
* p->delivery_system =
|
||
|
* (MXL_HYDRA_BCAST_STD_E) regData[DMD_STANDARD_ADDR];
|
||
|
* p->inversion =
|
||
|
* (MXL_HYDRA_SPECTRUM_E) regData[DMD_SPECTRUM_INVERSION_ADDR];
|
||
|
* freqSearchRangeKHz =
|
||
|
* (regData[DMD_FREQ_SEARCH_RANGE_IN_KHZ_ADDR]);
|
||
|
*/
|
||
|
|
||
|
p->fec_inner = conv_fec(reg_data[DMD_FEC_CODE_RATE_ADDR]);
|
||
|
switch (p->delivery_system) {
|
||
|
case SYS_DSS:
|
||
|
break;
|
||
|
case SYS_DVBS2:
|
||
|
switch ((enum MXL_HYDRA_PILOTS_E)
|
||
|
reg_data[DMD_DVBS2_PILOT_ON_OFF_ADDR]) {
|
||
|
case MXL_HYDRA_PILOTS_OFF:
|
||
|
p->pilot = PILOT_OFF;
|
||
|
break;
|
||
|
case MXL_HYDRA_PILOTS_ON:
|
||
|
p->pilot = PILOT_ON;
|
||
|
break;
|
||
|
default:
|
||
|
break;
|
||
|
}
|
||
|
case SYS_DVBS:
|
||
|
switch ((enum MXL_HYDRA_MODULATION_E)
|
||
|
reg_data[DMD_MODULATION_SCHEME_ADDR]) {
|
||
|
case MXL_HYDRA_MOD_QPSK:
|
||
|
p->modulation = QPSK;
|
||
|
break;
|
||
|
case MXL_HYDRA_MOD_8PSK:
|
||
|
p->modulation = PSK_8;
|
||
|
break;
|
||
|
default:
|
||
|
break;
|
||
|
}
|
||
|
switch ((enum MXL_HYDRA_ROLLOFF_E)
|
||
|
reg_data[DMD_SPECTRUM_ROLL_OFF_ADDR]) {
|
||
|
case MXL_HYDRA_ROLLOFF_0_20:
|
||
|
p->rolloff = ROLLOFF_20;
|
||
|
break;
|
||
|
case MXL_HYDRA_ROLLOFF_0_35:
|
||
|
p->rolloff = ROLLOFF_35;
|
||
|
break;
|
||
|
case MXL_HYDRA_ROLLOFF_0_25:
|
||
|
p->rolloff = ROLLOFF_25;
|
||
|
break;
|
||
|
default:
|
||
|
break;
|
||
|
}
|
||
|
break;
|
||
|
default:
|
||
|
return -EINVAL;
|
||
|
}
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int set_input(struct dvb_frontend *fe, int input)
|
||
|
{
|
||
|
struct mxl *state = fe->demodulator_priv;
|
||
|
|
||
|
state->tuner = input;
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static struct dvb_frontend_ops mxl_ops = {
|
||
|
.delsys = { SYS_DVBS, SYS_DVBS2, SYS_DSS },
|
||
|
.info = {
|
||
|
.name = "MaxLinear MxL5xx DVB-S/S2 tuner-demodulator",
|
||
|
.frequency_min = 300000,
|
||
|
.frequency_max = 2350000,
|
||
|
.frequency_stepsize = 0,
|
||
|
.frequency_tolerance = 0,
|
||
|
.symbol_rate_min = 1000000,
|
||
|
.symbol_rate_max = 45000000,
|
||
|
.caps = FE_CAN_INVERSION_AUTO |
|
||
|
FE_CAN_FEC_AUTO |
|
||
|
FE_CAN_QPSK |
|
||
|
FE_CAN_2G_MODULATION
|
||
|
},
|
||
|
.init = init,
|
||
|
.release = release,
|
||
|
.get_frontend_algo = get_algo,
|
||
|
.tune = tune,
|
||
|
.read_status = read_status,
|
||
|
.sleep = sleep,
|
||
|
.get_frontend = get_frontend,
|
||
|
.diseqc_send_master_cmd = send_master_cmd,
|
||
|
};
|
||
|
|
||
|
static struct mxl_base *match_base(struct i2c_adapter *i2c, u8 adr)
|
||
|
{
|
||
|
struct mxl_base *p;
|
||
|
|
||
|
list_for_each_entry(p, &mxllist, mxllist)
|
||
|
if (p->i2c == i2c && p->adr == adr)
|
||
|
return p;
|
||
|
return NULL;
|
||
|
}
|
||
|
|
||
|
static void cfg_dev_xtal(struct mxl *state, u32 freq, u32 cap, u32 enable)
|
||
|
{
|
||
|
if (state->base->can_clkout || !enable)
|
||
|
update_by_mnemonic(state, 0x90200054, 23, 1, enable);
|
||
|
|
||
|
if (freq == 24000000)
|
||
|
write_register(state, HYDRA_CRYSTAL_SETTING, 0);
|
||
|
else
|
||
|
write_register(state, HYDRA_CRYSTAL_SETTING, 1);
|
||
|
|
||
|
write_register(state, HYDRA_CRYSTAL_CAP, cap);
|
||
|
}
|
||
|
|
||
|
static u32 get_big_endian(u8 num_of_bits, const u8 buf[])
|
||
|
{
|
||
|
u32 ret_value = 0;
|
||
|
|
||
|
switch (num_of_bits) {
|
||
|
case 24:
|
||
|
ret_value = (((u32) buf[0]) << 16) |
|
||
|
(((u32) buf[1]) << 8) | buf[2];
|
||
|
break;
|
||
|
case 32:
|
||
|
ret_value = (((u32) buf[0]) << 24) |
|
||
|
(((u32) buf[1]) << 16) |
|
||
|
(((u32) buf[2]) << 8) | buf[3];
|
||
|
break;
|
||
|
default:
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
return ret_value;
|
||
|
}
|
||
|
|
||
|
static int write_fw_segment(struct mxl *state,
|
||
|
u32 mem_addr, u32 total_size, u8 *data_ptr)
|
||
|
{
|
||
|
int status;
|
||
|
u32 data_count = 0;
|
||
|
u32 size = 0;
|
||
|
u32 orig_size = 0;
|
||
|
u8 *w_buf_ptr = NULL;
|
||
|
u32 block_size = ((MXL_HYDRA_OEM_MAX_BLOCK_WRITE_LENGTH -
|
||
|
(MXL_HYDRA_I2C_HDR_SIZE +
|
||
|
MXL_HYDRA_REG_SIZE_IN_BYTES)) / 4) * 4;
|
||
|
u8 w_msg_buffer[MXL_HYDRA_OEM_MAX_BLOCK_WRITE_LENGTH -
|
||
|
(MXL_HYDRA_I2C_HDR_SIZE + MXL_HYDRA_REG_SIZE_IN_BYTES)];
|
||
|
|
||
|
do {
|
||
|
size = orig_size = (((u32)(data_count + block_size)) > total_size) ?
|
||
|
(total_size - data_count) : block_size;
|
||
|
|
||
|
if (orig_size & 3)
|
||
|
size = (orig_size + 4) & ~3;
|
||
|
w_buf_ptr = &w_msg_buffer[0];
|
||
|
memset((void *) w_buf_ptr, 0, size);
|
||
|
memcpy((void *) w_buf_ptr, (void *) data_ptr, orig_size);
|
||
|
convert_endian(1, size, w_buf_ptr);
|
||
|
status = write_firmware_block(state, mem_addr, size, w_buf_ptr);
|
||
|
if (status)
|
||
|
return status;
|
||
|
data_count += size;
|
||
|
mem_addr += size;
|
||
|
data_ptr += size;
|
||
|
} while (data_count < total_size);
|
||
|
|
||
|
return status;
|
||
|
}
|
||
|
|
||
|
static int do_firmware_download(struct mxl *state, u8 *mbin_buffer_ptr,
|
||
|
u32 mbin_buffer_size)
|
||
|
|
||
|
{
|
||
|
int status;
|
||
|
u32 index = 0;
|
||
|
u32 seg_length = 0;
|
||
|
u32 seg_address = 0;
|
||
|
struct MBIN_FILE_T *mbin_ptr = (struct MBIN_FILE_T *)mbin_buffer_ptr;
|
||
|
struct MBIN_SEGMENT_T *segment_ptr;
|
||
|
enum MXL_BOOL_E xcpu_fw_flag = MXL_FALSE;
|
||
|
|
||
|
if (mbin_ptr->header.id != MBIN_FILE_HEADER_ID) {
|
||
|
dev_err(state->i2cdev, "%s: Invalid file header ID (%c)\n",
|
||
|
__func__, mbin_ptr->header.id);
|
||
|
return -EINVAL;
|
||
|
}
|
||
|
status = write_register(state, FW_DL_SIGN_ADDR, 0);
|
||
|
if (status)
|
||
|
return status;
|
||
|
segment_ptr = (struct MBIN_SEGMENT_T *) (&mbin_ptr->data[0]);
|
||
|
for (index = 0; index < mbin_ptr->header.num_segments; index++) {
|
||
|
if (segment_ptr->header.id != MBIN_SEGMENT_HEADER_ID) {
|
||
|
dev_err(state->i2cdev, "%s: Invalid segment header ID (%c)\n",
|
||
|
__func__, segment_ptr->header.id);
|
||
|
return -EINVAL;
|
||
|
}
|
||
|
seg_length = get_big_endian(24,
|
||
|
&(segment_ptr->header.len24[0]));
|
||
|
seg_address = get_big_endian(32,
|
||
|
&(segment_ptr->header.address[0]));
|
||
|
|
||
|
if (state->base->type == MXL_HYDRA_DEVICE_568) {
|
||
|
if ((((seg_address & 0x90760000) == 0x90760000) ||
|
||
|
((seg_address & 0x90740000) == 0x90740000)) &&
|
||
|
(xcpu_fw_flag == MXL_FALSE)) {
|
||
|
update_by_mnemonic(state, 0x8003003C, 0, 1, 1);
|
||
|
msleep(200);
|
||
|
write_register(state, 0x90720000, 0);
|
||
|
usleep_range(10000, 11000);
|
||
|
xcpu_fw_flag = MXL_TRUE;
|
||
|
}
|
||
|
status = write_fw_segment(state, seg_address,
|
||
|
seg_length,
|
||
|
(u8 *) segment_ptr->data);
|
||
|
} else {
|
||
|
if (((seg_address & 0x90760000) != 0x90760000) &&
|
||
|
((seg_address & 0x90740000) != 0x90740000))
|
||
|
status = write_fw_segment(state, seg_address,
|
||
|
seg_length, (u8 *) segment_ptr->data);
|
||
|
}
|
||
|
if (status)
|
||
|
return status;
|
||
|
segment_ptr = (struct MBIN_SEGMENT_T *)
|
||
|
&(segment_ptr->data[((seg_length + 3) / 4) * 4]);
|
||
|
}
|
||
|
return status;
|
||
|
}
|
||
|
|
||
|
static int check_fw(struct mxl *state, u8 *mbin, u32 mbin_len)
|
||
|
{
|
||
|
struct MBIN_FILE_HEADER_T *fh = (struct MBIN_FILE_HEADER_T *) mbin;
|
||
|
u32 flen = (fh->image_size24[0] << 16) |
|
||
|
(fh->image_size24[1] << 8) | fh->image_size24[2];
|
||
|
u8 *fw, cs = 0;
|
||
|
u32 i;
|
||
|
|
||
|
if (fh->id != 'M' || fh->fmt_version != '1' || flen > 0x3FFF0) {
|
||
|
dev_info(state->i2cdev, "Invalid FW Header\n");
|
||
|
return -1;
|
||
|
}
|
||
|
fw = mbin + sizeof(struct MBIN_FILE_HEADER_T);
|
||
|
for (i = 0; i < flen; i += 1)
|
||
|
cs += fw[i];
|
||
|
if (cs != fh->image_checksum) {
|
||
|
dev_info(state->i2cdev, "Invalid FW Checksum\n");
|
||
|
return -1;
|
||
|
}
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int firmware_download(struct mxl *state, u8 *mbin, u32 mbin_len)
|
||
|
{
|
||
|
int status;
|
||
|
u32 reg_data = 0;
|
||
|
struct MXL_HYDRA_SKU_COMMAND_T dev_sku_cfg;
|
||
|
u8 cmd_size = sizeof(struct MXL_HYDRA_SKU_COMMAND_T);
|
||
|
u8 cmd_buff[sizeof(struct MXL_HYDRA_SKU_COMMAND_T) + 6];
|
||
|
|
||
|
if (check_fw(state, mbin, mbin_len))
|
||
|
return -1;
|
||
|
|
||
|
/* put CPU into reset */
|
||
|
status = update_by_mnemonic(state, 0x8003003C, 0, 1, 0);
|
||
|
if (status)
|
||
|
return status;
|
||
|
usleep_range(1000, 2000);
|
||
|
|
||
|
/* Reset TX FIFO's, BBAND, XBAR */
|
||
|
status = write_register(state, HYDRA_RESET_TRANSPORT_FIFO_REG,
|
||
|
HYDRA_RESET_TRANSPORT_FIFO_DATA);
|
||
|
if (status)
|
||
|
return status;
|
||
|
status = write_register(state, HYDRA_RESET_BBAND_REG,
|
||
|
HYDRA_RESET_BBAND_DATA);
|
||
|
if (status)
|
||
|
return status;
|
||
|
status = write_register(state, HYDRA_RESET_XBAR_REG,
|
||
|
HYDRA_RESET_XBAR_DATA);
|
||
|
if (status)
|
||
|
return status;
|
||
|
|
||
|
/* Disable clock to Baseband, Wideband, SerDes,
|
||
|
* Alias ext & Transport modules
|
||
|
*/
|
||
|
status = write_register(state, HYDRA_MODULES_CLK_2_REG,
|
||
|
HYDRA_DISABLE_CLK_2);
|
||
|
if (status)
|
||
|
return status;
|
||
|
/* Clear Software & Host interrupt status - (Clear on read) */
|
||
|
status = read_register(state, HYDRA_PRCM_ROOT_CLK_REG, ®_data);
|
||
|
if (status)
|
||
|
return status;
|
||
|
status = do_firmware_download(state, mbin, mbin_len);
|
||
|
if (status)
|
||
|
return status;
|
||
|
|
||
|
if (state->base->type == MXL_HYDRA_DEVICE_568) {
|
||
|
usleep_range(10000, 11000);
|
||
|
|
||
|
/* bring XCPU out of reset */
|
||
|
status = write_register(state, 0x90720000, 1);
|
||
|
if (status)
|
||
|
return status;
|
||
|
msleep(500);
|
||
|
|
||
|
/* Enable XCPU UART message processing in MCPU */
|
||
|
status = write_register(state, 0x9076B510, 1);
|
||
|
if (status)
|
||
|
return status;
|
||
|
} else {
|
||
|
/* Bring CPU out of reset */
|
||
|
status = update_by_mnemonic(state, 0x8003003C, 0, 1, 1);
|
||
|
if (status)
|
||
|
return status;
|
||
|
/* Wait until FW boots */
|
||
|
msleep(150);
|
||
|
}
|
||
|
|
||
|
/* Initialize XPT XBAR */
|
||
|
status = write_register(state, XPT_DMD0_BASEADDR, 0x76543210);
|
||
|
if (status)
|
||
|
return status;
|
||
|
|
||
|
if (!firmware_is_alive(state))
|
||
|
return -1;
|
||
|
|
||
|
dev_info(state->i2cdev, "Hydra FW alive. Hail!\n");
|
||
|
|
||
|
/* sometimes register values are wrong shortly
|
||
|
* after first heart beats
|
||
|
*/
|
||
|
msleep(50);
|
||
|
|
||
|
dev_sku_cfg.sku_type = state->base->sku_type;
|
||
|
BUILD_HYDRA_CMD(MXL_HYDRA_DEV_CFG_SKU_CMD, MXL_CMD_WRITE,
|
||
|
cmd_size, &dev_sku_cfg, cmd_buff);
|
||
|
status = send_command(state, cmd_size + MXL_HYDRA_CMD_HEADER_SIZE,
|
||
|
&cmd_buff[0]);
|
||
|
|
||
|
return status;
|
||
|
}
|
||
|
|
||
|
static int cfg_ts_pad_mux(struct mxl *state, enum MXL_BOOL_E enable_serial_ts)
|
||
|
{
|
||
|
int status = 0;
|
||
|
u32 pad_mux_value = 0;
|
||
|
|
||
|
if (enable_serial_ts == MXL_TRUE) {
|
||
|
pad_mux_value = 0;
|
||
|
if ((state->base->type == MXL_HYDRA_DEVICE_541) ||
|
||
|
(state->base->type == MXL_HYDRA_DEVICE_541S))
|
||
|
pad_mux_value = 2;
|
||
|
} else {
|
||
|
if ((state->base->type == MXL_HYDRA_DEVICE_581) ||
|
||
|
(state->base->type == MXL_HYDRA_DEVICE_581S))
|
||
|
pad_mux_value = 2;
|
||
|
else
|
||
|
pad_mux_value = 3;
|
||
|
}
|
||
|
|
||
|
switch (state->base->type) {
|
||
|
case MXL_HYDRA_DEVICE_561:
|
||
|
case MXL_HYDRA_DEVICE_581:
|
||
|
case MXL_HYDRA_DEVICE_541:
|
||
|
case MXL_HYDRA_DEVICE_541S:
|
||
|
case MXL_HYDRA_DEVICE_561S:
|
||
|
case MXL_HYDRA_DEVICE_581S:
|
||
|
status |= update_by_mnemonic(state, 0x90000170, 24, 3,
|
||
|
pad_mux_value);
|
||
|
status |= update_by_mnemonic(state, 0x90000170, 28, 3,
|
||
|
pad_mux_value);
|
||
|
status |= update_by_mnemonic(state, 0x90000174, 0, 3,
|
||
|
pad_mux_value);
|
||
|
status |= update_by_mnemonic(state, 0x90000174, 4, 3,
|
||
|
pad_mux_value);
|
||
|
status |= update_by_mnemonic(state, 0x90000174, 8, 3,
|
||
|
pad_mux_value);
|
||
|
status |= update_by_mnemonic(state, 0x90000174, 12, 3,
|
||
|
pad_mux_value);
|
||
|
status |= update_by_mnemonic(state, 0x90000174, 16, 3,
|
||
|
pad_mux_value);
|
||
|
status |= update_by_mnemonic(state, 0x90000174, 20, 3,
|
||
|
pad_mux_value);
|
||
|
status |= update_by_mnemonic(state, 0x90000174, 24, 3,
|
||
|
pad_mux_value);
|
||
|
status |= update_by_mnemonic(state, 0x90000174, 28, 3,
|
||
|
pad_mux_value);
|
||
|
status |= update_by_mnemonic(state, 0x90000178, 0, 3,
|
||
|
pad_mux_value);
|
||
|
status |= update_by_mnemonic(state, 0x90000178, 4, 3,
|
||
|
pad_mux_value);
|
||
|
status |= update_by_mnemonic(state, 0x90000178, 8, 3,
|
||
|
pad_mux_value);
|
||
|
break;
|
||
|
|
||
|
case MXL_HYDRA_DEVICE_544:
|
||
|
case MXL_HYDRA_DEVICE_542:
|
||
|
status |= update_by_mnemonic(state, 0x9000016C, 4, 3, 1);
|
||
|
status |= update_by_mnemonic(state, 0x9000016C, 8, 3, 0);
|
||
|
status |= update_by_mnemonic(state, 0x9000016C, 12, 3, 0);
|
||
|
status |= update_by_mnemonic(state, 0x9000016C, 16, 3, 0);
|
||
|
status |= update_by_mnemonic(state, 0x90000170, 0, 3, 0);
|
||
|
status |= update_by_mnemonic(state, 0x90000178, 12, 3, 1);
|
||
|
status |= update_by_mnemonic(state, 0x90000178, 16, 3, 1);
|
||
|
status |= update_by_mnemonic(state, 0x90000178, 20, 3, 1);
|
||
|
status |= update_by_mnemonic(state, 0x90000178, 24, 3, 1);
|
||
|
status |= update_by_mnemonic(state, 0x9000017C, 0, 3, 1);
|
||
|
status |= update_by_mnemonic(state, 0x9000017C, 4, 3, 1);
|
||
|
if (enable_serial_ts == MXL_ENABLE) {
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000170, 4, 3, 0);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000170, 8, 3, 0);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000170, 12, 3, 0);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000170, 16, 3, 0);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000170, 20, 3, 1);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000170, 24, 3, 1);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000170, 28, 3, 2);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000174, 0, 3, 2);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000174, 4, 3, 2);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000174, 8, 3, 2);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000174, 12, 3, 2);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000174, 16, 3, 2);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000174, 20, 3, 2);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000174, 24, 3, 2);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000174, 28, 3, 2);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000178, 0, 3, 2);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000178, 4, 3, 2);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000178, 8, 3, 2);
|
||
|
} else {
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000170, 4, 3, 3);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000170, 8, 3, 3);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000170, 12, 3, 3);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000170, 16, 3, 3);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000170, 20, 3, 3);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000170, 24, 3, 3);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000170, 28, 3, 3);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000174, 0, 3, 3);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000174, 4, 3, 3);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000174, 8, 3, 3);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000174, 12, 3, 3);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000174, 16, 3, 3);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000174, 20, 3, 1);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000174, 24, 3, 1);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000174, 28, 3, 1);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000178, 0, 3, 1);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000178, 4, 3, 1);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000178, 8, 3, 1);
|
||
|
}
|
||
|
break;
|
||
|
|
||
|
case MXL_HYDRA_DEVICE_568:
|
||
|
if (enable_serial_ts == MXL_FALSE) {
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x9000016C, 8, 3, 5);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x9000016C, 12, 3, 5);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x9000016C, 16, 3, 5);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x9000016C, 20, 3, 5);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x9000016C, 24, 3, 5);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x9000016C, 28, 3, 5);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000170, 0, 3, 5);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000170, 4, 3, 5);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000170, 8, 3, 5);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000170, 12, 3, 5);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000170, 16, 3, 5);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000170, 20, 3, 5);
|
||
|
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000170, 24, 3, pad_mux_value);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000174, 0, 3, pad_mux_value);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000174, 4, 3, pad_mux_value);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000174, 8, 3, pad_mux_value);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000174, 12, 3, pad_mux_value);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000174, 16, 3, pad_mux_value);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000174, 20, 3, pad_mux_value);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000174, 24, 3, pad_mux_value);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000174, 28, 3, pad_mux_value);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000178, 0, 3, pad_mux_value);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000178, 4, 3, pad_mux_value);
|
||
|
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000178, 8, 3, 5);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000178, 12, 3, 5);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000178, 16, 3, 5);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000178, 20, 3, 5);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000178, 24, 3, 5);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000178, 28, 3, 5);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x9000017C, 0, 3, 5);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x9000017C, 4, 3, 5);
|
||
|
} else {
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000170, 4, 3, pad_mux_value);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000170, 8, 3, pad_mux_value);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000170, 12, 3, pad_mux_value);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000170, 16, 3, pad_mux_value);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000170, 20, 3, pad_mux_value);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000170, 24, 3, pad_mux_value);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000170, 28, 3, pad_mux_value);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000174, 0, 3, pad_mux_value);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000174, 4, 3, pad_mux_value);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000174, 8, 3, pad_mux_value);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000174, 12, 3, pad_mux_value);
|
||
|
}
|
||
|
break;
|
||
|
|
||
|
|
||
|
case MXL_HYDRA_DEVICE_584:
|
||
|
default:
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000170, 4, 3, pad_mux_value);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000170, 8, 3, pad_mux_value);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000170, 12, 3, pad_mux_value);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000170, 16, 3, pad_mux_value);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000170, 20, 3, pad_mux_value);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000170, 24, 3, pad_mux_value);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000170, 28, 3, pad_mux_value);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000174, 0, 3, pad_mux_value);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000174, 4, 3, pad_mux_value);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000174, 8, 3, pad_mux_value);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
0x90000174, 12, 3, pad_mux_value);
|
||
|
break;
|
||
|
}
|
||
|
return status;
|
||
|
}
|
||
|
|
||
|
static int set_drive_strength(struct mxl *state,
|
||
|
enum MXL_HYDRA_TS_DRIVE_STRENGTH_E ts_drive_strength)
|
||
|
{
|
||
|
int stat = 0;
|
||
|
u32 val;
|
||
|
|
||
|
read_register(state, 0x90000194, &val);
|
||
|
dev_info(state->i2cdev, "DIGIO = %08x\n", val);
|
||
|
dev_info(state->i2cdev, "set drive_strength = %u\n", ts_drive_strength);
|
||
|
|
||
|
|
||
|
stat |= update_by_mnemonic(state, 0x90000194, 0, 3, ts_drive_strength);
|
||
|
stat |= update_by_mnemonic(state, 0x90000194, 20, 3, ts_drive_strength);
|
||
|
stat |= update_by_mnemonic(state, 0x90000194, 24, 3, ts_drive_strength);
|
||
|
stat |= update_by_mnemonic(state, 0x90000198, 12, 3, ts_drive_strength);
|
||
|
stat |= update_by_mnemonic(state, 0x90000198, 16, 3, ts_drive_strength);
|
||
|
stat |= update_by_mnemonic(state, 0x90000198, 20, 3, ts_drive_strength);
|
||
|
stat |= update_by_mnemonic(state, 0x90000198, 24, 3, ts_drive_strength);
|
||
|
stat |= update_by_mnemonic(state, 0x9000019C, 0, 3, ts_drive_strength);
|
||
|
stat |= update_by_mnemonic(state, 0x9000019C, 4, 3, ts_drive_strength);
|
||
|
stat |= update_by_mnemonic(state, 0x9000019C, 8, 3, ts_drive_strength);
|
||
|
stat |= update_by_mnemonic(state, 0x9000019C, 24, 3, ts_drive_strength);
|
||
|
stat |= update_by_mnemonic(state, 0x9000019C, 28, 3, ts_drive_strength);
|
||
|
stat |= update_by_mnemonic(state, 0x900001A0, 0, 3, ts_drive_strength);
|
||
|
stat |= update_by_mnemonic(state, 0x900001A0, 4, 3, ts_drive_strength);
|
||
|
stat |= update_by_mnemonic(state, 0x900001A0, 20, 3, ts_drive_strength);
|
||
|
stat |= update_by_mnemonic(state, 0x900001A0, 24, 3, ts_drive_strength);
|
||
|
stat |= update_by_mnemonic(state, 0x900001A0, 28, 3, ts_drive_strength);
|
||
|
|
||
|
return stat;
|
||
|
}
|
||
|
|
||
|
static int enable_tuner(struct mxl *state, u32 tuner, u32 enable)
|
||
|
{
|
||
|
int stat = 0;
|
||
|
struct MXL_HYDRA_TUNER_CMD ctrl_tuner_cmd;
|
||
|
u8 cmd_size = sizeof(ctrl_tuner_cmd);
|
||
|
u8 cmd_buff[MXL_HYDRA_OEM_MAX_CMD_BUFF_LEN];
|
||
|
u32 val, count = 10;
|
||
|
|
||
|
ctrl_tuner_cmd.tuner_id = tuner;
|
||
|
ctrl_tuner_cmd.enable = enable;
|
||
|
BUILD_HYDRA_CMD(MXL_HYDRA_TUNER_ACTIVATE_CMD, MXL_CMD_WRITE,
|
||
|
cmd_size, &ctrl_tuner_cmd, cmd_buff);
|
||
|
stat = send_command(state, cmd_size + MXL_HYDRA_CMD_HEADER_SIZE,
|
||
|
&cmd_buff[0]);
|
||
|
if (stat)
|
||
|
return stat;
|
||
|
read_register(state, HYDRA_TUNER_ENABLE_COMPLETE, &val);
|
||
|
while (--count && ((val >> tuner) & 1) != enable) {
|
||
|
msleep(20);
|
||
|
read_register(state, HYDRA_TUNER_ENABLE_COMPLETE, &val);
|
||
|
}
|
||
|
if (!count)
|
||
|
return -1;
|
||
|
read_register(state, HYDRA_TUNER_ENABLE_COMPLETE, &val);
|
||
|
dev_dbg(state->i2cdev, "tuner %u ready = %u\n",
|
||
|
tuner, (val >> tuner) & 1);
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
|
||
|
static int config_ts(struct mxl *state, enum MXL_HYDRA_DEMOD_ID_E demod_id,
|
||
|
struct MXL_HYDRA_MPEGOUT_PARAM_T *mpeg_out_param_ptr)
|
||
|
{
|
||
|
int status = 0;
|
||
|
u32 nco_count_min = 0;
|
||
|
u32 clk_type = 0;
|
||
|
|
||
|
struct MXL_REG_FIELD_T xpt_sync_polarity[MXL_HYDRA_DEMOD_MAX] = {
|
||
|
{0x90700010, 8, 1}, {0x90700010, 9, 1},
|
||
|
{0x90700010, 10, 1}, {0x90700010, 11, 1},
|
||
|
{0x90700010, 12, 1}, {0x90700010, 13, 1},
|
||
|
{0x90700010, 14, 1}, {0x90700010, 15, 1} };
|
||
|
struct MXL_REG_FIELD_T xpt_clock_polarity[MXL_HYDRA_DEMOD_MAX] = {
|
||
|
{0x90700010, 16, 1}, {0x90700010, 17, 1},
|
||
|
{0x90700010, 18, 1}, {0x90700010, 19, 1},
|
||
|
{0x90700010, 20, 1}, {0x90700010, 21, 1},
|
||
|
{0x90700010, 22, 1}, {0x90700010, 23, 1} };
|
||
|
struct MXL_REG_FIELD_T xpt_valid_polarity[MXL_HYDRA_DEMOD_MAX] = {
|
||
|
{0x90700014, 0, 1}, {0x90700014, 1, 1},
|
||
|
{0x90700014, 2, 1}, {0x90700014, 3, 1},
|
||
|
{0x90700014, 4, 1}, {0x90700014, 5, 1},
|
||
|
{0x90700014, 6, 1}, {0x90700014, 7, 1} };
|
||
|
struct MXL_REG_FIELD_T xpt_ts_clock_phase[MXL_HYDRA_DEMOD_MAX] = {
|
||
|
{0x90700018, 0, 3}, {0x90700018, 4, 3},
|
||
|
{0x90700018, 8, 3}, {0x90700018, 12, 3},
|
||
|
{0x90700018, 16, 3}, {0x90700018, 20, 3},
|
||
|
{0x90700018, 24, 3}, {0x90700018, 28, 3} };
|
||
|
struct MXL_REG_FIELD_T xpt_lsb_first[MXL_HYDRA_DEMOD_MAX] = {
|
||
|
{0x9070000C, 16, 1}, {0x9070000C, 17, 1},
|
||
|
{0x9070000C, 18, 1}, {0x9070000C, 19, 1},
|
||
|
{0x9070000C, 20, 1}, {0x9070000C, 21, 1},
|
||
|
{0x9070000C, 22, 1}, {0x9070000C, 23, 1} };
|
||
|
struct MXL_REG_FIELD_T xpt_sync_byte[MXL_HYDRA_DEMOD_MAX] = {
|
||
|
{0x90700010, 0, 1}, {0x90700010, 1, 1},
|
||
|
{0x90700010, 2, 1}, {0x90700010, 3, 1},
|
||
|
{0x90700010, 4, 1}, {0x90700010, 5, 1},
|
||
|
{0x90700010, 6, 1}, {0x90700010, 7, 1} };
|
||
|
struct MXL_REG_FIELD_T xpt_enable_output[MXL_HYDRA_DEMOD_MAX] = {
|
||
|
{0x9070000C, 0, 1}, {0x9070000C, 1, 1},
|
||
|
{0x9070000C, 2, 1}, {0x9070000C, 3, 1},
|
||
|
{0x9070000C, 4, 1}, {0x9070000C, 5, 1},
|
||
|
{0x9070000C, 6, 1}, {0x9070000C, 7, 1} };
|
||
|
struct MXL_REG_FIELD_T xpt_err_replace_sync[MXL_HYDRA_DEMOD_MAX] = {
|
||
|
{0x9070000C, 24, 1}, {0x9070000C, 25, 1},
|
||
|
{0x9070000C, 26, 1}, {0x9070000C, 27, 1},
|
||
|
{0x9070000C, 28, 1}, {0x9070000C, 29, 1},
|
||
|
{0x9070000C, 30, 1}, {0x9070000C, 31, 1} };
|
||
|
struct MXL_REG_FIELD_T xpt_err_replace_valid[MXL_HYDRA_DEMOD_MAX] = {
|
||
|
{0x90700014, 8, 1}, {0x90700014, 9, 1},
|
||
|
{0x90700014, 10, 1}, {0x90700014, 11, 1},
|
||
|
{0x90700014, 12, 1}, {0x90700014, 13, 1},
|
||
|
{0x90700014, 14, 1}, {0x90700014, 15, 1} };
|
||
|
struct MXL_REG_FIELD_T xpt_continuous_clock[MXL_HYDRA_DEMOD_MAX] = {
|
||
|
{0x907001D4, 0, 1}, {0x907001D4, 1, 1},
|
||
|
{0x907001D4, 2, 1}, {0x907001D4, 3, 1},
|
||
|
{0x907001D4, 4, 1}, {0x907001D4, 5, 1},
|
||
|
{0x907001D4, 6, 1}, {0x907001D4, 7, 1} };
|
||
|
struct MXL_REG_FIELD_T xpt_nco_clock_rate[MXL_HYDRA_DEMOD_MAX] = {
|
||
|
{0x90700044, 16, 80}, {0x90700044, 16, 81},
|
||
|
{0x90700044, 16, 82}, {0x90700044, 16, 83},
|
||
|
{0x90700044, 16, 84}, {0x90700044, 16, 85},
|
||
|
{0x90700044, 16, 86}, {0x90700044, 16, 87} };
|
||
|
|
||
|
demod_id = state->base->ts_map[demod_id];
|
||
|
|
||
|
if (mpeg_out_param_ptr->enable == MXL_ENABLE) {
|
||
|
if (mpeg_out_param_ptr->mpeg_mode ==
|
||
|
MXL_HYDRA_MPEG_MODE_PARALLEL) {
|
||
|
} else {
|
||
|
cfg_ts_pad_mux(state, MXL_TRUE);
|
||
|
update_by_mnemonic(state,
|
||
|
0x90700010, 27, 1, MXL_FALSE);
|
||
|
}
|
||
|
}
|
||
|
|
||
|
nco_count_min =
|
||
|
(u32)(MXL_HYDRA_NCO_CLK / mpeg_out_param_ptr->max_mpeg_clk_rate);
|
||
|
|
||
|
if (state->base->chipversion >= 2) {
|
||
|
status |= update_by_mnemonic(state,
|
||
|
xpt_nco_clock_rate[demod_id].reg_addr, /* Reg Addr */
|
||
|
xpt_nco_clock_rate[demod_id].lsb_pos, /* LSB pos */
|
||
|
xpt_nco_clock_rate[demod_id].num_of_bits, /* Num of bits */
|
||
|
nco_count_min); /* Data */
|
||
|
} else
|
||
|
update_by_mnemonic(state, 0x90700044, 16, 8, nco_count_min);
|
||
|
|
||
|
if (mpeg_out_param_ptr->mpeg_clk_type == MXL_HYDRA_MPEG_CLK_CONTINUOUS)
|
||
|
clk_type = 1;
|
||
|
|
||
|
if (mpeg_out_param_ptr->mpeg_mode < MXL_HYDRA_MPEG_MODE_PARALLEL) {
|
||
|
status |= update_by_mnemonic(state,
|
||
|
xpt_continuous_clock[demod_id].reg_addr,
|
||
|
xpt_continuous_clock[demod_id].lsb_pos,
|
||
|
xpt_continuous_clock[demod_id].num_of_bits,
|
||
|
clk_type);
|
||
|
} else
|
||
|
update_by_mnemonic(state, 0x907001D4, 8, 1, clk_type);
|
||
|
|
||
|
status |= update_by_mnemonic(state,
|
||
|
xpt_sync_polarity[demod_id].reg_addr,
|
||
|
xpt_sync_polarity[demod_id].lsb_pos,
|
||
|
xpt_sync_polarity[demod_id].num_of_bits,
|
||
|
mpeg_out_param_ptr->mpeg_sync_pol);
|
||
|
|
||
|
status |= update_by_mnemonic(state,
|
||
|
xpt_valid_polarity[demod_id].reg_addr,
|
||
|
xpt_valid_polarity[demod_id].lsb_pos,
|
||
|
xpt_valid_polarity[demod_id].num_of_bits,
|
||
|
mpeg_out_param_ptr->mpeg_valid_pol);
|
||
|
|
||
|
status |= update_by_mnemonic(state,
|
||
|
xpt_clock_polarity[demod_id].reg_addr,
|
||
|
xpt_clock_polarity[demod_id].lsb_pos,
|
||
|
xpt_clock_polarity[demod_id].num_of_bits,
|
||
|
mpeg_out_param_ptr->mpeg_clk_pol);
|
||
|
|
||
|
status |= update_by_mnemonic(state,
|
||
|
xpt_sync_byte[demod_id].reg_addr,
|
||
|
xpt_sync_byte[demod_id].lsb_pos,
|
||
|
xpt_sync_byte[demod_id].num_of_bits,
|
||
|
mpeg_out_param_ptr->mpeg_sync_pulse_width);
|
||
|
|
||
|
status |= update_by_mnemonic(state,
|
||
|
xpt_ts_clock_phase[demod_id].reg_addr,
|
||
|
xpt_ts_clock_phase[demod_id].lsb_pos,
|
||
|
xpt_ts_clock_phase[demod_id].num_of_bits,
|
||
|
mpeg_out_param_ptr->mpeg_clk_phase);
|
||
|
|
||
|
status |= update_by_mnemonic(state,
|
||
|
xpt_lsb_first[demod_id].reg_addr,
|
||
|
xpt_lsb_first[demod_id].lsb_pos,
|
||
|
xpt_lsb_first[demod_id].num_of_bits,
|
||
|
mpeg_out_param_ptr->lsb_or_msb_first);
|
||
|
|
||
|
switch (mpeg_out_param_ptr->mpeg_error_indication) {
|
||
|
case MXL_HYDRA_MPEG_ERR_REPLACE_SYNC:
|
||
|
status |= update_by_mnemonic(state,
|
||
|
xpt_err_replace_sync[demod_id].reg_addr,
|
||
|
xpt_err_replace_sync[demod_id].lsb_pos,
|
||
|
xpt_err_replace_sync[demod_id].num_of_bits,
|
||
|
MXL_TRUE);
|
||
|
status |= update_by_mnemonic(state,
|
||
|
xpt_err_replace_valid[demod_id].reg_addr,
|
||
|
xpt_err_replace_valid[demod_id].lsb_pos,
|
||
|
xpt_err_replace_valid[demod_id].num_of_bits,
|
||
|
MXL_FALSE);
|
||
|
break;
|
||
|
|
||
|
case MXL_HYDRA_MPEG_ERR_REPLACE_VALID:
|
||
|
status |= update_by_mnemonic(state,
|
||
|
xpt_err_replace_sync[demod_id].reg_addr,
|
||
|
xpt_err_replace_sync[demod_id].lsb_pos,
|
||
|
xpt_err_replace_sync[demod_id].num_of_bits,
|
||
|
MXL_FALSE);
|
||
|
|
||
|
status |= update_by_mnemonic(state,
|
||
|
xpt_err_replace_valid[demod_id].reg_addr,
|
||
|
xpt_err_replace_valid[demod_id].lsb_pos,
|
||
|
xpt_err_replace_valid[demod_id].num_of_bits,
|
||
|
MXL_TRUE);
|
||
|
break;
|
||
|
|
||
|
case MXL_HYDRA_MPEG_ERR_INDICATION_DISABLED:
|
||
|
default:
|
||
|
status |= update_by_mnemonic(state,
|
||
|
xpt_err_replace_sync[demod_id].reg_addr,
|
||
|
xpt_err_replace_sync[demod_id].lsb_pos,
|
||
|
xpt_err_replace_sync[demod_id].num_of_bits,
|
||
|
MXL_FALSE);
|
||
|
|
||
|
status |= update_by_mnemonic(state,
|
||
|
xpt_err_replace_valid[demod_id].reg_addr,
|
||
|
xpt_err_replace_valid[demod_id].lsb_pos,
|
||
|
xpt_err_replace_valid[demod_id].num_of_bits,
|
||
|
MXL_FALSE);
|
||
|
|
||
|
break;
|
||
|
|
||
|
}
|
||
|
|
||
|
if (mpeg_out_param_ptr->mpeg_mode != MXL_HYDRA_MPEG_MODE_PARALLEL) {
|
||
|
status |= update_by_mnemonic(state,
|
||
|
xpt_enable_output[demod_id].reg_addr,
|
||
|
xpt_enable_output[demod_id].lsb_pos,
|
||
|
xpt_enable_output[demod_id].num_of_bits,
|
||
|
mpeg_out_param_ptr->enable);
|
||
|
}
|
||
|
return status;
|
||
|
}
|
||
|
|
||
|
static int config_mux(struct mxl *state)
|
||
|
{
|
||
|
update_by_mnemonic(state, 0x9070000C, 0, 1, 0);
|
||
|
update_by_mnemonic(state, 0x9070000C, 1, 1, 0);
|
||
|
update_by_mnemonic(state, 0x9070000C, 2, 1, 0);
|
||
|
update_by_mnemonic(state, 0x9070000C, 3, 1, 0);
|
||
|
update_by_mnemonic(state, 0x9070000C, 4, 1, 0);
|
||
|
update_by_mnemonic(state, 0x9070000C, 5, 1, 0);
|
||
|
update_by_mnemonic(state, 0x9070000C, 6, 1, 0);
|
||
|
update_by_mnemonic(state, 0x9070000C, 7, 1, 0);
|
||
|
update_by_mnemonic(state, 0x90700008, 0, 2, 1);
|
||
|
update_by_mnemonic(state, 0x90700008, 2, 2, 1);
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int load_fw(struct mxl *state, struct mxl5xx_cfg *cfg)
|
||
|
{
|
||
|
int stat = 0;
|
||
|
u8 *buf;
|
||
|
|
||
|
if (cfg->fw)
|
||
|
return firmware_download(state, cfg->fw, cfg->fw_len);
|
||
|
|
||
|
if (!cfg->fw_read)
|
||
|
return -1;
|
||
|
|
||
|
buf = vmalloc(0x40000);
|
||
|
if (!buf)
|
||
|
return -ENOMEM;
|
||
|
|
||
|
cfg->fw_read(cfg->fw_priv, buf, 0x40000);
|
||
|
stat = firmware_download(state, buf, 0x40000);
|
||
|
vfree(buf);
|
||
|
|
||
|
return stat;
|
||
|
}
|
||
|
|
||
|
static int validate_sku(struct mxl *state)
|
||
|
{
|
||
|
u32 pad_mux_bond = 0, prcm_chip_id = 0, prcm_so_cid = 0;
|
||
|
int status;
|
||
|
u32 type = state->base->type;
|
||
|
|
||
|
status = read_by_mnemonic(state, 0x90000190, 0, 3, &pad_mux_bond);
|
||
|
status |= read_by_mnemonic(state, 0x80030000, 0, 12, &prcm_chip_id);
|
||
|
status |= read_by_mnemonic(state, 0x80030004, 24, 8, &prcm_so_cid);
|
||
|
if (status)
|
||
|
return -1;
|
||
|
|
||
|
dev_info(state->i2cdev, "padMuxBond=%08x, prcmChipId=%08x, prcmSoCId=%08x\n",
|
||
|
pad_mux_bond, prcm_chip_id, prcm_so_cid);
|
||
|
|
||
|
if (prcm_chip_id != 0x560) {
|
||
|
switch (pad_mux_bond) {
|
||
|
case MXL_HYDRA_SKU_ID_581:
|
||
|
if (type == MXL_HYDRA_DEVICE_581)
|
||
|
return 0;
|
||
|
if (type == MXL_HYDRA_DEVICE_581S) {
|
||
|
state->base->type = MXL_HYDRA_DEVICE_581;
|
||
|
return 0;
|
||
|
}
|
||
|
break;
|
||
|
case MXL_HYDRA_SKU_ID_584:
|
||
|
if (type == MXL_HYDRA_DEVICE_584)
|
||
|
return 0;
|
||
|
break;
|
||
|
case MXL_HYDRA_SKU_ID_544:
|
||
|
if (type == MXL_HYDRA_DEVICE_544)
|
||
|
return 0;
|
||
|
if (type == MXL_HYDRA_DEVICE_542)
|
||
|
return 0;
|
||
|
break;
|
||
|
case MXL_HYDRA_SKU_ID_582:
|
||
|
if (type == MXL_HYDRA_DEVICE_582)
|
||
|
return 0;
|
||
|
break;
|
||
|
default:
|
||
|
return -1;
|
||
|
}
|
||
|
} else {
|
||
|
|
||
|
}
|
||
|
return -1;
|
||
|
}
|
||
|
|
||
|
static int get_fwinfo(struct mxl *state)
|
||
|
{
|
||
|
int status;
|
||
|
u32 val = 0;
|
||
|
|
||
|
status = read_by_mnemonic(state, 0x90000190, 0, 3, &val);
|
||
|
if (status)
|
||
|
return status;
|
||
|
dev_info(state->i2cdev, "chipID=%08x\n", val);
|
||
|
|
||
|
status = read_by_mnemonic(state, 0x80030004, 8, 8, &val);
|
||
|
if (status)
|
||
|
return status;
|
||
|
dev_info(state->i2cdev, "chipVer=%08x\n", val);
|
||
|
|
||
|
status = read_register(state, HYDRA_FIRMWARE_VERSION, &val);
|
||
|
if (status)
|
||
|
return status;
|
||
|
dev_info(state->i2cdev, "FWVer=%08x\n", val);
|
||
|
|
||
|
state->base->fwversion = val;
|
||
|
return status;
|
||
|
}
|
||
|
|
||
|
|
||
|
static u8 ts_map1_to_1[MXL_HYDRA_DEMOD_MAX] = {
|
||
|
MXL_HYDRA_DEMOD_ID_0,
|
||
|
MXL_HYDRA_DEMOD_ID_1,
|
||
|
MXL_HYDRA_DEMOD_ID_2,
|
||
|
MXL_HYDRA_DEMOD_ID_3,
|
||
|
MXL_HYDRA_DEMOD_ID_4,
|
||
|
MXL_HYDRA_DEMOD_ID_5,
|
||
|
MXL_HYDRA_DEMOD_ID_6,
|
||
|
MXL_HYDRA_DEMOD_ID_7,
|
||
|
};
|
||
|
|
||
|
static u8 ts_map54x[MXL_HYDRA_DEMOD_MAX] = {
|
||
|
MXL_HYDRA_DEMOD_ID_2,
|
||
|
MXL_HYDRA_DEMOD_ID_3,
|
||
|
MXL_HYDRA_DEMOD_ID_4,
|
||
|
MXL_HYDRA_DEMOD_ID_5,
|
||
|
MXL_HYDRA_DEMOD_MAX,
|
||
|
MXL_HYDRA_DEMOD_MAX,
|
||
|
MXL_HYDRA_DEMOD_MAX,
|
||
|
MXL_HYDRA_DEMOD_MAX,
|
||
|
};
|
||
|
|
||
|
static int probe(struct mxl *state, struct mxl5xx_cfg *cfg)
|
||
|
{
|
||
|
u32 chipver;
|
||
|
int fw, status, j;
|
||
|
struct MXL_HYDRA_MPEGOUT_PARAM_T mpeg_interface_cfg;
|
||
|
|
||
|
state->base->ts_map = ts_map1_to_1;
|
||
|
|
||
|
switch (state->base->type) {
|
||
|
case MXL_HYDRA_DEVICE_581:
|
||
|
case MXL_HYDRA_DEVICE_581S:
|
||
|
state->base->can_clkout = 1;
|
||
|
state->base->demod_num = 8;
|
||
|
state->base->tuner_num = 1;
|
||
|
state->base->sku_type = MXL_HYDRA_SKU_TYPE_581;
|
||
|
break;
|
||
|
case MXL_HYDRA_DEVICE_582:
|
||
|
state->base->can_clkout = 1;
|
||
|
state->base->demod_num = 8;
|
||
|
state->base->tuner_num = 3;
|
||
|
state->base->sku_type = MXL_HYDRA_SKU_TYPE_582;
|
||
|
break;
|
||
|
case MXL_HYDRA_DEVICE_585:
|
||
|
state->base->can_clkout = 0;
|
||
|
state->base->demod_num = 8;
|
||
|
state->base->tuner_num = 4;
|
||
|
state->base->sku_type = MXL_HYDRA_SKU_TYPE_585;
|
||
|
break;
|
||
|
case MXL_HYDRA_DEVICE_544:
|
||
|
state->base->can_clkout = 0;
|
||
|
state->base->demod_num = 4;
|
||
|
state->base->tuner_num = 4;
|
||
|
state->base->sku_type = MXL_HYDRA_SKU_TYPE_544;
|
||
|
state->base->ts_map = ts_map54x;
|
||
|
break;
|
||
|
case MXL_HYDRA_DEVICE_541:
|
||
|
case MXL_HYDRA_DEVICE_541S:
|
||
|
state->base->can_clkout = 0;
|
||
|
state->base->demod_num = 4;
|
||
|
state->base->tuner_num = 1;
|
||
|
state->base->sku_type = MXL_HYDRA_SKU_TYPE_541;
|
||
|
state->base->ts_map = ts_map54x;
|
||
|
break;
|
||
|
case MXL_HYDRA_DEVICE_561:
|
||
|
case MXL_HYDRA_DEVICE_561S:
|
||
|
state->base->can_clkout = 0;
|
||
|
state->base->demod_num = 6;
|
||
|
state->base->tuner_num = 1;
|
||
|
state->base->sku_type = MXL_HYDRA_SKU_TYPE_561;
|
||
|
break;
|
||
|
case MXL_HYDRA_DEVICE_568:
|
||
|
state->base->can_clkout = 0;
|
||
|
state->base->demod_num = 8;
|
||
|
state->base->tuner_num = 1;
|
||
|
state->base->chan_bond = 1;
|
||
|
state->base->sku_type = MXL_HYDRA_SKU_TYPE_568;
|
||
|
break;
|
||
|
case MXL_HYDRA_DEVICE_542:
|
||
|
state->base->can_clkout = 1;
|
||
|
state->base->demod_num = 4;
|
||
|
state->base->tuner_num = 3;
|
||
|
state->base->sku_type = MXL_HYDRA_SKU_TYPE_542;
|
||
|
state->base->ts_map = ts_map54x;
|
||
|
break;
|
||
|
case MXL_HYDRA_DEVICE_TEST:
|
||
|
case MXL_HYDRA_DEVICE_584:
|
||
|
default:
|
||
|
state->base->can_clkout = 0;
|
||
|
state->base->demod_num = 8;
|
||
|
state->base->tuner_num = 4;
|
||
|
state->base->sku_type = MXL_HYDRA_SKU_TYPE_584;
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
status = validate_sku(state);
|
||
|
if (status)
|
||
|
return status;
|
||
|
|
||
|
update_by_mnemonic(state, 0x80030014, 9, 1, 1);
|
||
|
update_by_mnemonic(state, 0x8003003C, 12, 1, 1);
|
||
|
status = read_by_mnemonic(state, 0x80030000, 12, 4, &chipver);
|
||
|
if (status)
|
||
|
state->base->chipversion = 0;
|
||
|
else
|
||
|
state->base->chipversion = (chipver == 2) ? 2 : 1;
|
||
|
dev_info(state->i2cdev, "Hydra chip version %u\n",
|
||
|
state->base->chipversion);
|
||
|
|
||
|
cfg_dev_xtal(state, cfg->clk, cfg->cap, 0);
|
||
|
|
||
|
fw = firmware_is_alive(state);
|
||
|
if (!fw) {
|
||
|
status = load_fw(state, cfg);
|
||
|
if (status)
|
||
|
return status;
|
||
|
}
|
||
|
get_fwinfo(state);
|
||
|
|
||
|
config_mux(state);
|
||
|
mpeg_interface_cfg.enable = MXL_ENABLE;
|
||
|
mpeg_interface_cfg.lsb_or_msb_first = MXL_HYDRA_MPEG_SERIAL_MSB_1ST;
|
||
|
/* supports only (0-104&139)MHz */
|
||
|
if (cfg->ts_clk)
|
||
|
mpeg_interface_cfg.max_mpeg_clk_rate = cfg->ts_clk;
|
||
|
else
|
||
|
mpeg_interface_cfg.max_mpeg_clk_rate = 69; /* 139; */
|
||
|
mpeg_interface_cfg.mpeg_clk_phase = MXL_HYDRA_MPEG_CLK_PHASE_SHIFT_0_DEG;
|
||
|
mpeg_interface_cfg.mpeg_clk_pol = MXL_HYDRA_MPEG_CLK_IN_PHASE;
|
||
|
/* MXL_HYDRA_MPEG_CLK_GAPPED; */
|
||
|
mpeg_interface_cfg.mpeg_clk_type = MXL_HYDRA_MPEG_CLK_CONTINUOUS;
|
||
|
mpeg_interface_cfg.mpeg_error_indication =
|
||
|
MXL_HYDRA_MPEG_ERR_INDICATION_DISABLED;
|
||
|
mpeg_interface_cfg.mpeg_mode = MXL_HYDRA_MPEG_MODE_SERIAL_3_WIRE;
|
||
|
mpeg_interface_cfg.mpeg_sync_pol = MXL_HYDRA_MPEG_ACTIVE_HIGH;
|
||
|
mpeg_interface_cfg.mpeg_sync_pulse_width = MXL_HYDRA_MPEG_SYNC_WIDTH_BIT;
|
||
|
mpeg_interface_cfg.mpeg_valid_pol = MXL_HYDRA_MPEG_ACTIVE_HIGH;
|
||
|
|
||
|
for (j = 0; j < state->base->demod_num; j++) {
|
||
|
status = config_ts(state, (enum MXL_HYDRA_DEMOD_ID_E) j,
|
||
|
&mpeg_interface_cfg);
|
||
|
if (status)
|
||
|
return status;
|
||
|
}
|
||
|
set_drive_strength(state, 1);
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
struct dvb_frontend *mxl5xx_attach(struct i2c_adapter *i2c,
|
||
|
struct mxl5xx_cfg *cfg, u32 demod, u32 tuner,
|
||
|
int (**fn_set_input)(struct dvb_frontend *, int))
|
||
|
{
|
||
|
struct mxl *state;
|
||
|
struct mxl_base *base;
|
||
|
|
||
|
state = kzalloc(sizeof(struct mxl), GFP_KERNEL);
|
||
|
if (!state)
|
||
|
return NULL;
|
||
|
|
||
|
state->demod = demod;
|
||
|
state->tuner = tuner;
|
||
|
state->tuner_in_use = 0xffffffff;
|
||
|
state->i2cdev = &i2c->dev;
|
||
|
|
||
|
base = match_base(i2c, cfg->adr);
|
||
|
if (base) {
|
||
|
base->count++;
|
||
|
if (base->count > base->demod_num)
|
||
|
goto fail;
|
||
|
state->base = base;
|
||
|
} else {
|
||
|
base = kzalloc(sizeof(struct mxl_base), GFP_KERNEL);
|
||
|
if (!base)
|
||
|
goto fail;
|
||
|
base->i2c = i2c;
|
||
|
base->adr = cfg->adr;
|
||
|
base->type = cfg->type;
|
||
|
base->count = 1;
|
||
|
mutex_init(&base->i2c_lock);
|
||
|
mutex_init(&base->status_lock);
|
||
|
mutex_init(&base->tune_lock);
|
||
|
INIT_LIST_HEAD(&base->mxls);
|
||
|
|
||
|
state->base = base;
|
||
|
if (probe(state, cfg) < 0) {
|
||
|
kfree(base);
|
||
|
goto fail;
|
||
|
}
|
||
|
list_add(&base->mxllist, &mxllist);
|
||
|
}
|
||
|
state->fe.ops = mxl_ops;
|
||
|
state->xbar[0] = 4;
|
||
|
state->xbar[1] = demod;
|
||
|
state->xbar[2] = 8;
|
||
|
state->fe.demodulator_priv = state;
|
||
|
*fn_set_input = set_input;
|
||
|
|
||
|
list_add(&state->mxl, &base->mxls);
|
||
|
return &state->fe;
|
||
|
|
||
|
fail:
|
||
|
kfree(state);
|
||
|
return NULL;
|
||
|
}
|
||
|
EXPORT_SYMBOL_GPL(mxl5xx_attach);
|
||
|
|
||
|
MODULE_DESCRIPTION("MaxLinear MxL5xx DVB-S/S2 tuner-demodulator driver");
|
||
|
MODULE_AUTHOR("Ralph and Marcus Metzler, Metzler Brothers Systementwicklung GbR");
|
||
|
MODULE_LICENSE("GPL");
|