af9033: implement read_ber and read_ucblocks functions.
Signed-off-by: Hans-Frieder Vogt <hfvogt@xxxxxxx>
drivers/media/dvb/frontends/af9033.c | 62 +++++++++++++++++++++++++++++++++--
1 file changed, 60 insertions(+), 2 deletions(-)
diff -Nupr a/drivers/media/dvb/frontends/af9033.c b/drivers/media/dvb/frontends/af9033.c
--- a/drivers/media/dvb/frontends/af9033.c 2012-04-03 19:07:50.991367619 +0200
+++ b/drivers/media/dvb/frontends/af9033.c 2012-04-03 22:47:34.152121451 +0200
@@ -29,6 +29,10 @@ struct af9033_state {
u32 bandwidth_hz;
bool ts_mode_parallel;
bool ts_mode_serial;
+
+ u32 ber;
+ u32 ucb;
+ unsigned long last_stat_check;
};
/* write multiple registers */
@@ -645,16 +649,70 @@ err:
return ret;
}
+static int af9033_update_ch_stat(struct af9033_state *state)
+{
+ int ret = 0;
+ u32 post_err_cnt, post_bit_cnt;
+ u16 abort_cnt;
+ u8 buf[7];
+
+ /* only update data every half second */
+ if (time_after(jiffies, state->last_stat_check + msecs_to_jiffies(500))) {
+ ret = af9033_rd_regs(state, 0x800032, buf, sizeof(buf));
+ if (ret < 0)
+ goto err;
+ abort_cnt = (buf[1] << 8) + buf[0];
+ post_err_cnt = (buf[4] << 16) + (buf[3] << 8) + buf[2];
+ post_bit_cnt = (buf[6] << 8) + buf[5];
+ if (post_bit_cnt == 0) {
+ abort_cnt = 1000;
+ post_err_cnt = 1;
+ post_bit_cnt = 2;
+ } else {
+ post_bit_cnt -= (u32)abort_cnt;
+ if (post_bit_cnt == 0) {
+ post_err_cnt = 1;
+ post_bit_cnt = 2;
+ } else {
+ post_err_cnt -= (u32)abort_cnt * 8 * 8;
+ post_bit_cnt *= 204 * 8;
+ }
+ }
+ state->ber = post_err_cnt * (0xffffffff / post_bit_cnt);
+ state->ucb = abort_cnt;
+ state->last_stat_check = jiffies;
+ }
+
+ return 0;
+err:
+ pr_debug("%s: failed=%d\n", __func__, ret);
+ return ret;
+}
+
static int af9033_read_ber(struct dvb_frontend *fe, u32 *ber)
{
- *ber = 0;
+ struct af9033_state *state = fe->demodulator_priv;
+ int ret;
+
+ ret = af9033_update_ch_stat(state);
+ if (ret < 0)
+ return ret;
+
+ *ber = state->ber;
return 0;
}
static int af9033_read_ucblocks(struct dvb_frontend *fe, u32 *ucblocks)
{
- *ucblocks = 0;
+ struct af9033_state *state = fe->demodulator_priv;
+ int ret;
+
+ ret = af9033_update_ch_stat(state);
+ if (ret < 0)
+ return ret;
+
+ *ucblocks = state->ucb;
return 0;
}
Hans-Frieder Vogt e-mail: hfvogt <at> gmx .dot. net
--
To unsubscribe from this list: send the line "unsubscribe linux-media" in
the body of a message to majordomo@xxxxxxxxxxxxxxx
More majordomo info at http://vger.kernel.org/majordomo-info.html
