[media] m88ds3103: implement BER
Implement read_ber for BER estimate. Signed-off-by: Antti Palosaari <crope@iki.fi> Signed-off-by: Mauro Carvalho Chehab <m.chehab@samsung.com>
This commit is contained in:
parent
3ae266f80c
commit
4423a2ba80
|
@ -926,6 +926,86 @@ err:
|
|||
return ret;
|
||||
}
|
||||
|
||||
static int m88ds3103_read_ber(struct dvb_frontend *fe, u32 *ber)
|
||||
{
|
||||
struct m88ds3103_priv *priv = fe->demodulator_priv;
|
||||
struct dtv_frontend_properties *c = &fe->dtv_property_cache;
|
||||
int ret;
|
||||
unsigned int utmp;
|
||||
u8 buf[3], u8tmp;
|
||||
dev_dbg(&priv->i2c->dev, "%s:\n", __func__);
|
||||
|
||||
switch (c->delivery_system) {
|
||||
case SYS_DVBS:
|
||||
ret = m88ds3103_wr_reg(priv, 0xf9, 0x04);
|
||||
if (ret)
|
||||
goto err;
|
||||
|
||||
ret = m88ds3103_rd_reg(priv, 0xf8, &u8tmp);
|
||||
if (ret)
|
||||
goto err;
|
||||
|
||||
if (!(u8tmp & 0x10)) {
|
||||
u8tmp |= 0x10;
|
||||
|
||||
ret = m88ds3103_rd_regs(priv, 0xf6, buf, 2);
|
||||
if (ret)
|
||||
goto err;
|
||||
|
||||
priv->ber = (buf[1] << 8) | (buf[0] << 0);
|
||||
|
||||
/* restart counters */
|
||||
ret = m88ds3103_wr_reg(priv, 0xf8, u8tmp);
|
||||
if (ret)
|
||||
goto err;
|
||||
}
|
||||
break;
|
||||
case SYS_DVBS2:
|
||||
ret = m88ds3103_rd_regs(priv, 0xd5, buf, 3);
|
||||
if (ret)
|
||||
goto err;
|
||||
|
||||
utmp = (buf[2] << 16) | (buf[1] << 8) | (buf[0] << 0);
|
||||
|
||||
if (utmp > 3000) {
|
||||
ret = m88ds3103_rd_regs(priv, 0xf7, buf, 2);
|
||||
if (ret)
|
||||
goto err;
|
||||
|
||||
priv->ber = (buf[1] << 8) | (buf[0] << 0);
|
||||
|
||||
/* restart counters */
|
||||
ret = m88ds3103_wr_reg(priv, 0xd1, 0x01);
|
||||
if (ret)
|
||||
goto err;
|
||||
|
||||
ret = m88ds3103_wr_reg(priv, 0xf9, 0x01);
|
||||
if (ret)
|
||||
goto err;
|
||||
|
||||
ret = m88ds3103_wr_reg(priv, 0xf9, 0x00);
|
||||
if (ret)
|
||||
goto err;
|
||||
|
||||
ret = m88ds3103_wr_reg(priv, 0xd1, 0x00);
|
||||
if (ret)
|
||||
goto err;
|
||||
}
|
||||
break;
|
||||
default:
|
||||
dev_dbg(&priv->i2c->dev, "%s: invalid delivery_system\n",
|
||||
__func__);
|
||||
ret = -EINVAL;
|
||||
goto err;
|
||||
}
|
||||
|
||||
*ber = priv->ber;
|
||||
|
||||
return 0;
|
||||
err:
|
||||
dev_dbg(&priv->i2c->dev, "%s: failed=%d\n", __func__, ret);
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int m88ds3103_set_tone(struct dvb_frontend *fe,
|
||||
fe_sec_tone_mode_t fe_sec_tone_mode)
|
||||
|
@ -1284,6 +1364,7 @@ static struct dvb_frontend_ops m88ds3103_ops = {
|
|||
|
||||
.read_status = m88ds3103_read_status,
|
||||
.read_snr = m88ds3103_read_snr,
|
||||
.read_ber = m88ds3103_read_ber,
|
||||
|
||||
.diseqc_send_master_cmd = m88ds3103_diseqc_send_master_cmd,
|
||||
.diseqc_send_burst = m88ds3103_diseqc_send_burst,
|
||||
|
|
|
@ -35,6 +35,7 @@ struct m88ds3103_priv {
|
|||
struct dvb_frontend fe;
|
||||
fe_delivery_system_t delivery_system;
|
||||
fe_status_t fe_status;
|
||||
u32 ber;
|
||||
bool warm; /* FW running */
|
||||
struct i2c_adapter *i2c_adapter;
|
||||
};
|
||||
|
|
Loading…
Reference in New Issue