[media] tda10071: implement DVBv5 statistics
Implement DVBv5 CNR, signal strength, BER and block errors. Wrap legacy DVBv3 statistics to DVBv5 internally. Signed-off-by: Antti Palosaari <crope@iki.fi> Signed-off-by: Mauro Carvalho Chehab <mchehab@osg.samsung.com>
This commit is contained in:
Antti Palosaari
Mauro Carvalho Chehab
parent
4c4acb7a7e
commit
267897a470
|
|
@ -377,8 +377,11 @@ static int tda10071_read_status(struct dvb_frontend *fe, enum fe_status *status)
|
|||
{
|
||||
struct tda10071_dev *dev = fe->demodulator_priv;
|
||||
struct i2c_client *client = dev->client;
|
||||
struct dtv_frontend_properties *c = &fe->dtv_property_cache;
|
||||
struct tda10071_cmd cmd;
|
||||
int ret;
|
||||
unsigned int uitmp;
|
||||
u8 buf[8];
|
||||
|
||||
*status = 0;
|
||||
|
||||
|
|
@ -401,6 +404,106 @@ static int tda10071_read_status(struct dvb_frontend *fe, enum fe_status *status)
|
|||
|
||||
dev->fe_status = *status;
|
||||
|
||||
/* signal strength */
|
||||
if (dev->fe_status & FE_HAS_SIGNAL) {
|
||||
cmd.args[0] = CMD_GET_AGCACC;
|
||||
cmd.args[1] = 0;
|
||||
cmd.len = 2;
|
||||
ret = tda10071_cmd_execute(dev, &cmd);
|
||||
if (ret)
|
||||
goto error;
|
||||
|
||||
/* input power estimate dBm */
|
||||
ret = regmap_read(dev->regmap, 0x50, &uitmp);
|
||||
if (ret)
|
||||
goto error;
|
||||
|
||||
c->strength.stat[0].scale = FE_SCALE_DECIBEL;
|
||||
c->strength.stat[0].svalue = (int) (uitmp - 256) * 1000;
|
||||
} else {
|
||||
c->strength.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
|
||||
}
|
||||
|
||||
/* CNR */
|
||||
if (dev->fe_status & FE_HAS_VITERBI) {
|
||||
/* Es/No */
|
||||
ret = regmap_bulk_read(dev->regmap, 0x3a, buf, 2);
|
||||
if (ret)
|
||||
goto error;
|
||||
|
||||
c->cnr.stat[0].scale = FE_SCALE_DECIBEL;
|
||||
c->cnr.stat[0].svalue = (buf[0] << 8 | buf[1] << 0) * 100;
|
||||
} else {
|
||||
c->cnr.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
|
||||
}
|
||||
|
||||
/* UCB/PER/BER */
|
||||
if (dev->fe_status & FE_HAS_LOCK) {
|
||||
/* TODO: report total bits/packets */
|
||||
u8 delivery_system, reg, len;
|
||||
|
||||
switch (dev->delivery_system) {
|
||||
case SYS_DVBS:
|
||||
reg = 0x4c;
|
||||
len = 8;
|
||||
delivery_system = 1;
|
||||
break;
|
||||
case SYS_DVBS2:
|
||||
reg = 0x4d;
|
||||
len = 4;
|
||||
delivery_system = 0;
|
||||
break;
|
||||
default:
|
||||
ret = -EINVAL;
|
||||
goto error;
|
||||
}
|
||||
|
||||
ret = regmap_read(dev->regmap, reg, &uitmp);
|
||||
if (ret)
|
||||
goto error;
|
||||
|
||||
if (dev->meas_count == uitmp) {
|
||||
dev_dbg(&client->dev, "meas not ready=%02x\n", uitmp);
|
||||
ret = 0;
|
||||
goto error;
|
||||
} else {
|
||||
dev->meas_count = uitmp;
|
||||
}
|
||||
|
||||
cmd.args[0] = CMD_BER_UPDATE_COUNTERS;
|
||||
cmd.args[1] = 0;
|
||||
cmd.args[2] = delivery_system;
|
||||
cmd.len = 3;
|
||||
ret = tda10071_cmd_execute(dev, &cmd);
|
||||
if (ret)
|
||||
goto error;
|
||||
|
||||
ret = regmap_bulk_read(dev->regmap, cmd.len, buf, len);
|
||||
if (ret)
|
||||
goto error;
|
||||
|
||||
if (dev->delivery_system == SYS_DVBS) {
|
||||
dev->dvbv3_ber = buf[0] << 24 | buf[1] << 16 |
|
||||
buf[2] << 8 | buf[3] << 0;
|
||||
dev->post_bit_error += buf[0] << 24 | buf[1] << 16 |
|
||||
buf[2] << 8 | buf[3] << 0;
|
||||
c->post_bit_error.stat[0].scale = FE_SCALE_COUNTER;
|
||||
c->post_bit_error.stat[0].uvalue = dev->post_bit_error;
|
||||
dev->block_error += buf[4] << 8 | buf[5] << 0;
|
||||
c->block_error.stat[0].scale = FE_SCALE_COUNTER;
|
||||
c->block_error.stat[0].uvalue = dev->block_error;
|
||||
} else {
|
||||
dev->dvbv3_ber = buf[0] << 8 | buf[1] << 0;
|
||||
dev->post_bit_error += buf[0] << 8 | buf[1] << 0;
|
||||
c->post_bit_error.stat[0].scale = FE_SCALE_COUNTER;
|
||||
c->post_bit_error.stat[0].uvalue = dev->post_bit_error;
|
||||
c->block_error.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
|
||||
}
|
||||
} else {
|
||||
c->post_bit_error.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
|
||||
c->block_error.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
|
||||
}
|
||||
|
||||
return ret;
|
||||
error:
|
||||
dev_dbg(&client->dev, "failed=%d\n", ret);
|
||||
|
|
@ -409,158 +512,48 @@ error:
|
|||
|
||||
static int tda10071_read_snr(struct dvb_frontend *fe, u16 *snr)
|
||||
{
|
||||
struct tda10071_dev *dev = fe->demodulator_priv;
|
||||
struct i2c_client *client = dev->client;
|
||||
int ret;
|
||||
u8 buf[2];
|
||||
struct dtv_frontend_properties *c = &fe->dtv_property_cache;
|
||||
|
||||
if (!dev->warm || !(dev->fe_status & FE_HAS_LOCK)) {
|
||||
if (c->cnr.stat[0].scale == FE_SCALE_DECIBEL)
|
||||
*snr = div_s64(c->cnr.stat[0].svalue, 100);
|
||||
else
|
||||
*snr = 0;
|
||||
ret = 0;
|
||||
goto error;
|
||||
}
|
||||
|
||||
ret = regmap_bulk_read(dev->regmap, 0x3a, buf, 2);
|
||||
if (ret)
|
||||
goto error;
|
||||
|
||||
/* Es/No dBx10 */
|
||||
*snr = buf[0] << 8 | buf[1];
|
||||
|
||||
return ret;
|
||||
error:
|
||||
dev_dbg(&client->dev, "failed=%d\n", ret);
|
||||
return ret;
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int tda10071_read_signal_strength(struct dvb_frontend *fe, u16 *strength)
|
||||
{
|
||||
struct tda10071_dev *dev = fe->demodulator_priv;
|
||||
struct i2c_client *client = dev->client;
|
||||
struct tda10071_cmd cmd;
|
||||
int ret;
|
||||
struct dtv_frontend_properties *c = &fe->dtv_property_cache;
|
||||
unsigned int uitmp;
|
||||
|
||||
if (!dev->warm || !(dev->fe_status & FE_HAS_LOCK)) {
|
||||
if (c->strength.stat[0].scale == FE_SCALE_DECIBEL) {
|
||||
uitmp = c->strength.stat[0].svalue / 1000 + 256;
|
||||
uitmp = clamp(uitmp, 181U, 236U); /* -75dBm - -20dBm */
|
||||
/* scale value to 0x0000-0xffff */
|
||||
*strength = (uitmp-181) * 0xffff / (236-181);
|
||||
} else {
|
||||
*strength = 0;
|
||||
ret = 0;
|
||||
goto error;
|
||||
}
|
||||
|
||||
cmd.args[0] = CMD_GET_AGCACC;
|
||||
cmd.args[1] = 0;
|
||||
cmd.len = 2;
|
||||
ret = tda10071_cmd_execute(dev, &cmd);
|
||||
if (ret)
|
||||
goto error;
|
||||
|
||||
/* input power estimate dBm */
|
||||
ret = regmap_read(dev->regmap, 0x50, &uitmp);
|
||||
if (ret)
|
||||
goto error;
|
||||
|
||||
if (uitmp < 181)
|
||||
uitmp = 181; /* -75 dBm */
|
||||
else if (uitmp > 236)
|
||||
uitmp = 236; /* -20 dBm */
|
||||
|
||||
/* scale value to 0x0000-0xffff */
|
||||
*strength = (uitmp-181) * 0xffff / (236-181);
|
||||
|
||||
return ret;
|
||||
error:
|
||||
dev_dbg(&client->dev, "failed=%d\n", ret);
|
||||
return ret;
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int tda10071_read_ber(struct dvb_frontend *fe, u32 *ber)
|
||||
{
|
||||
struct tda10071_dev *dev = fe->demodulator_priv;
|
||||
struct i2c_client *client = dev->client;
|
||||
struct tda10071_cmd cmd;
|
||||
int ret, i, len;
|
||||
unsigned int uitmp;
|
||||
u8 reg, buf[8];
|
||||
|
||||
if (!dev->warm || !(dev->fe_status & FE_HAS_LOCK)) {
|
||||
*ber = dev->ber = 0;
|
||||
ret = 0;
|
||||
goto error;
|
||||
}
|
||||
|
||||
switch (dev->delivery_system) {
|
||||
case SYS_DVBS:
|
||||
reg = 0x4c;
|
||||
len = 8;
|
||||
i = 1;
|
||||
break;
|
||||
case SYS_DVBS2:
|
||||
reg = 0x4d;
|
||||
len = 4;
|
||||
i = 0;
|
||||
break;
|
||||
default:
|
||||
*ber = dev->ber = 0;
|
||||
return 0;
|
||||
}
|
||||
|
||||
ret = regmap_read(dev->regmap, reg, &uitmp);
|
||||
if (ret)
|
||||
goto error;
|
||||
|
||||
if (dev->meas_count[i] == uitmp) {
|
||||
dev_dbg(&client->dev, "meas not ready=%02x\n", uitmp);
|
||||
*ber = dev->ber;
|
||||
return 0;
|
||||
} else {
|
||||
dev->meas_count[i] = uitmp;
|
||||
}
|
||||
|
||||
cmd.args[0] = CMD_BER_UPDATE_COUNTERS;
|
||||
cmd.args[1] = 0;
|
||||
cmd.args[2] = i;
|
||||
cmd.len = 3;
|
||||
ret = tda10071_cmd_execute(dev, &cmd);
|
||||
if (ret)
|
||||
goto error;
|
||||
|
||||
ret = regmap_bulk_read(dev->regmap, cmd.len, buf, len);
|
||||
if (ret)
|
||||
goto error;
|
||||
|
||||
if (dev->delivery_system == SYS_DVBS) {
|
||||
*ber = (buf[0] << 24) | (buf[1] << 16) | (buf[2] << 8) | buf[3];
|
||||
dev->ucb += (buf[4] << 8) | buf[5];
|
||||
} else {
|
||||
*ber = (buf[0] << 8) | buf[1];
|
||||
}
|
||||
dev->ber = *ber;
|
||||
|
||||
return ret;
|
||||
error:
|
||||
dev_dbg(&client->dev, "failed=%d\n", ret);
|
||||
return ret;
|
||||
*ber = dev->dvbv3_ber;
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int tda10071_read_ucblocks(struct dvb_frontend *fe, u32 *ucblocks)
|
||||
{
|
||||
struct tda10071_dev *dev = fe->demodulator_priv;
|
||||
struct i2c_client *client = dev->client;
|
||||
int ret = 0;
|
||||
struct dtv_frontend_properties *c = &fe->dtv_property_cache;
|
||||
|
||||
if (!dev->warm || !(dev->fe_status & FE_HAS_LOCK)) {
|
||||
if (c->block_error.stat[0].scale == FE_SCALE_COUNTER)
|
||||
*ucblocks = c->block_error.stat[0].uvalue;
|
||||
else
|
||||
*ucblocks = 0;
|
||||
goto error;
|
||||
}
|
||||
|
||||
/* UCB is updated when BER is read. Assume BER is read anyway. */
|
||||
|
||||
*ucblocks = dev->ucb;
|
||||
|
||||
return ret;
|
||||
error:
|
||||
dev_dbg(&client->dev, "failed=%d\n", ret);
|
||||
return ret;
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int tda10071_set_frontend(struct dvb_frontend *fe)
|
||||
|
|
@ -770,6 +763,7 @@ static int tda10071_init(struct dvb_frontend *fe)
|
|||
{
|
||||
struct tda10071_dev *dev = fe->demodulator_priv;
|
||||
struct i2c_client *client = dev->client;
|
||||
struct dtv_frontend_properties *c = &fe->dtv_property_cache;
|
||||
struct tda10071_cmd cmd;
|
||||
int ret, i, len, remaining, fw_size;
|
||||
unsigned int uitmp;
|
||||
|
|
@ -1035,6 +1029,16 @@ static int tda10071_init(struct dvb_frontend *fe)
|
|||
goto error;
|
||||
}
|
||||
|
||||
/* init stats here in order signal app which stats are supported */
|
||||
c->strength.len = 1;
|
||||
c->strength.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
|
||||
c->cnr.len = 1;
|
||||
c->cnr.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
|
||||
c->post_bit_error.len = 1;
|
||||
c->post_bit_error.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
|
||||
c->block_error.len = 1;
|
||||
c->block_error.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
|
||||
|
||||
return ret;
|
||||
error_release_firmware:
|
||||
release_firmware(fw);
|
||||
|
|
|
|||
|
|
@ -38,12 +38,13 @@ struct tda10071_dev {
|
|||
u8 pll_multiplier;
|
||||
u8 tuner_i2c_addr;
|
||||
|
||||
u8 meas_count[2];
|
||||
u32 ber;
|
||||
u32 ucb;
|
||||
u8 meas_count;
|
||||
u32 dvbv3_ber;
|
||||
enum fe_status fe_status;
|
||||
enum fe_delivery_system delivery_system;
|
||||
bool warm; /* FW running */
|
||||
u64 post_bit_error;
|
||||
u64 block_error;
|
||||
};
|
||||
|
||||
static struct tda10071_modcod {
|
||||
|
|
|
|||
Loading…
Reference in New Issue