Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit 6d03f6a8 authored by Bimow Chen's avatar Bimow Chen Committed by Mauro Carvalho Chehab
Browse files

[media] af9033: fix DVBv3 snr value not correct issue



Snr returns value not correct. Fix it.

Signed-off-by: default avatarBimow Chen <Bimow.Chen@ite.com.tw>
Signed-off-by: default avatarAntti Palosaari <crope@iki.fi>
Signed-off-by: default avatarMauro Carvalho Chehab <mchehab@osg.samsung.com>
parent 1620d221
Loading
Loading
Loading
Loading
+58 −3
Original line number Diff line number Diff line
@@ -849,14 +849,42 @@ static int af9033_read_snr(struct dvb_frontend *fe, u16 *snr)
{
	struct af9033_dev *dev = fe->demodulator_priv;
	struct dtv_frontend_properties *c = &dev->fe.dtv_property_cache;
	int ret;
	u8 u8tmp;

	/* use DVBv5 CNR */
	if (c->cnr.stat[0].scale == FE_SCALE_DECIBEL)
		*snr = div_s64(c->cnr.stat[0].svalue, 100); /* 1000x => 10x */
	else
	if (c->cnr.stat[0].scale == FE_SCALE_DECIBEL) {
		*snr = div_s64(c->cnr.stat[0].svalue, 1000);

		/* read current modulation */
		ret = af9033_rd_reg(dev, 0x80f903, &u8tmp);
		if (ret)
			goto err;

		/* scale value to 0x0000-0xffff */
		switch ((u8tmp >> 0) & 3) {
		case 0:
			*snr = *snr * 0xFFFF / 23;
			break;
		case 1:
			*snr = *snr * 0xFFFF / 26;
			break;
		case 2:
			*snr = *snr * 0xFFFF / 32;
			break;
		default:
			goto err;
		}
	} else {
		*snr = 0;
	}

	return 0;

err:
	dev_dbg(&dev->client->dev, "failed=%d\n", ret);

	return ret;
}

static int af9033_read_signal_strength(struct dvb_frontend *fe, u16 *strength)
@@ -1044,6 +1072,33 @@ static void af9033_stat_work(struct work_struct *work)

		snr_val = (buf[2] << 16) | (buf[1] << 8) | (buf[0] << 0);

		/* read superframe number */
		ret = af9033_rd_reg(dev, 0x80f78b, &u8tmp);
		if (ret)
			goto err;

		if (u8tmp)
			snr_val /= u8tmp;

		/* read current transmission mode */
		ret = af9033_rd_reg(dev, 0x80f900, &u8tmp);
		if (ret)
			goto err;

		switch ((u8tmp >> 0) & 3) {
		case 0:
			snr_val *= 4;
			break;
		case 1:
			snr_val *= 1;
			break;
		case 2:
			snr_val *= 2;
			break;
		default:
			goto err;
		}

		/* read current modulation */
		ret = af9033_rd_reg(dev, 0x80f903, &u8tmp);
		if (ret)
+4 −1
Original line number Diff line number Diff line
@@ -181,7 +181,10 @@ static const struct val_snr qam64_snr_lut[] = {
	{ 0x05570d, 26 },
	{ 0x059feb, 27 },
	{ 0x05bf38, 28 },
	{ 0xffffff, 29 },
	{ 0x05f78f, 29 },
	{ 0x0612c3, 30 },
	{ 0x0626be, 31 },
	{ 0xffffff, 32 },
};

static const struct reg_val ofsm_init[] = {