media: af9013: dvbv5 ber and per
Implement dvbv5 ber and per. Signed-off-by: Antti Palosaari <crope@iki.fi> Signed-off-by: Mauro Carvalho Chehab <mchehab@s-opensource.com>
This commit is contained in:
parent
f3bb7e22b1
commit
233f3ef71c
|
@ -47,6 +47,7 @@ struct af9013_state {
|
|||
unsigned long read_status_jiffies;
|
||||
unsigned long strength_jiffies;
|
||||
unsigned long cnr_jiffies;
|
||||
unsigned long ber_ucb_jiffies;
|
||||
bool first_tune;
|
||||
bool i2c_gate_state;
|
||||
unsigned int statistics_step:3;
|
||||
|
@ -754,7 +755,7 @@ static int af9013_read_status(struct dvb_frontend *fe, enum fe_status *status)
|
|||
struct dtv_frontend_properties *c = &fe->dtv_property_cache;
|
||||
int ret, stmp1;
|
||||
unsigned int utmp, utmp1, utmp2, utmp3, utmp4;
|
||||
u8 buf[3];
|
||||
u8 buf[7];
|
||||
|
||||
dev_dbg(&client->dev, "\n");
|
||||
|
||||
|
@ -947,6 +948,72 @@ static int af9013_read_status(struct dvb_frontend *fe, enum fe_status *status)
|
|||
break;
|
||||
}
|
||||
|
||||
/* BER / PER */
|
||||
switch (state->fe_status & FE_HAS_SYNC) {
|
||||
case FE_HAS_SYNC:
|
||||
if (time_is_after_jiffies(state->ber_ucb_jiffies + msecs_to_jiffies(2000)))
|
||||
break;
|
||||
|
||||
/* Check if ber / ucb is ready */
|
||||
ret = regmap_read(state->regmap, 0xd391, &utmp);
|
||||
if (ret)
|
||||
goto err;
|
||||
|
||||
if (!((utmp >> 4) & 0x01)) {
|
||||
dev_dbg(&client->dev, "ber not ready\n");
|
||||
break;
|
||||
}
|
||||
|
||||
/* Read value */
|
||||
ret = regmap_bulk_read(state->regmap, 0xd385, buf, 7);
|
||||
if (ret)
|
||||
goto err;
|
||||
|
||||
utmp1 = buf[4] << 16 | buf[3] << 8 | buf[2] << 0;
|
||||
utmp2 = (buf[1] << 8 | buf[0] << 0) * 204 * 8;
|
||||
utmp3 = buf[6] << 8 | buf[5] << 0;
|
||||
utmp4 = buf[1] << 8 | buf[0] << 0;
|
||||
|
||||
/* Use 10000 TS packets for measure */
|
||||
if (utmp4 != 10000) {
|
||||
buf[0] = (10000 >> 0) & 0xff;
|
||||
buf[1] = (10000 >> 8) & 0xff;
|
||||
ret = regmap_bulk_write(state->regmap, 0xd385, buf, 2);
|
||||
if (ret)
|
||||
goto err;
|
||||
}
|
||||
|
||||
/* Reset ber / ucb counter */
|
||||
ret = regmap_update_bits(state->regmap, 0xd391, 0x20, 0x20);
|
||||
if (ret)
|
||||
goto err;
|
||||
|
||||
dev_dbg(&client->dev, "post_bit_error %u, post_bit_count %u\n",
|
||||
utmp1, utmp2);
|
||||
dev_dbg(&client->dev, "block_error %u, block_count %u\n",
|
||||
utmp3, utmp4);
|
||||
|
||||
state->ber_ucb_jiffies = jiffies;
|
||||
|
||||
c->post_bit_error.stat[0].scale = FE_SCALE_COUNTER;
|
||||
c->post_bit_error.stat[0].uvalue += utmp1;
|
||||
c->post_bit_count.stat[0].scale = FE_SCALE_COUNTER;
|
||||
c->post_bit_count.stat[0].uvalue += utmp2;
|
||||
|
||||
c->block_error.stat[0].scale = FE_SCALE_COUNTER;
|
||||
c->block_error.stat[0].uvalue += utmp3;
|
||||
c->block_count.stat[0].scale = FE_SCALE_COUNTER;
|
||||
c->block_count.stat[0].uvalue += utmp4;
|
||||
break;
|
||||
default:
|
||||
c->post_bit_error.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
|
||||
c->post_bit_count.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
|
||||
|
||||
c->block_error.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
|
||||
c->block_count.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
|
||||
break;
|
||||
}
|
||||
|
||||
return 0;
|
||||
err:
|
||||
dev_dbg(&client->dev, "failed %d\n", ret);
|
||||
|
@ -1670,6 +1737,10 @@ static int af9013_probe(struct i2c_client *client,
|
|||
c = &state->fe.dtv_property_cache;
|
||||
c->strength.len = 1;
|
||||
c->cnr.len = 1;
|
||||
c->post_bit_error.len = 1;
|
||||
c->post_bit_count.len = 1;
|
||||
c->block_error.len = 1;
|
||||
c->block_count.len = 1;
|
||||
|
||||
dev_info(&client->dev, "Afatech AF9013 successfully attached\n");
|
||||
dev_info(&client->dev, "firmware version: %d.%d.%d.%d\n",
|
||||
|
|
Loading…
Reference in New Issue