Signed-off-by: Benjamin Larsson <benjamin@xxxxxxxxxxxx>
---
drivers/staging/media/mn88472/mn88472.c | 31 +++++++++++++++++++++++++++++++
1 file changed, 31 insertions(+)
diff --git a/drivers/staging/media/mn88472/mn88472.c b/drivers/staging/media/mn88472/mn88472.c
index 746cc94..8b35639 100644
--- a/drivers/staging/media/mn88472/mn88472.c
+++ b/drivers/staging/media/mn88472/mn88472.c
@@ -392,6 +392,36 @@ err:
return ret;
}
+static int mn88472_read_ber(struct dvb_frontend *fe, u32 *ber)
+{
+ struct i2c_client *client = fe->demodulator_priv;
+ struct mn88472_dev *dev = i2c_get_clientdata(client);
+ int ret, err, len;
+ u8 data[3];
+
+ dev_dbg(&client->dev, "%s:\n", __func__);
+
+ ret = regmap_bulk_read(dev->regmap[0], 0x9F , data, 3);
+ if (ret)
+ goto err;
+ err = data[0]<<16 | data[1]<<8 | data[2];
+
+ ret = regmap_bulk_read(dev->regmap[0], 0xA2 , data, 2);
+ if (ret)
+ goto err;
+ len = data[0]<<8 | data[1];
+
+ if (len)
+ *ber = (err*100)/len;
+ else
+ *ber = 0;
+
+ return 0;
+err:
+ dev_dbg(&client->dev, "%s: failed=%d\n", __func__, ret);
+ return ret;
+}
+
static struct dvb_frontend_ops mn88472_ops = {
.delsys = {SYS_DVBT, SYS_DVBT2, SYS_DVBC_ANNEX_A},
.info = {
@@ -425,6 +455,7 @@ static struct dvb_frontend_ops mn88472_ops = {
.set_frontend = mn88472_set_frontend,
.read_status = mn88472_read_status,
+ .read_ber = mn88472_read_ber,
};
static int mn88472_probe(struct i2c_client *client,
--
1.9.1
--
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
