tuner_fc0013: fix and improve manual LNA gain

Signed-off-by: Steve Markgraf <steve@steve-m.de>

3 files changed, 65 insertions, 40 deletions

diff --git a/include/tuner_fc0013.h b/include/tuner_fc0013.h
index b409fe8..68a26ee 100644
--- a/include/tuner_fc0013.h
+++ b/include/tuner_fc0013.h
@@ -31,6 +31,7 @@
 
 int fc0013_init(void *dev);
 int fc0013_set_params(void *dev, uint32_t freq, uint32_t bandwidth);
-int fc0013_set_gain(void *dev, int gain);
+int fc0013_set_gain_mode(void *dev, int manual);
+int fc0013_set_lna_gain(void *dev, int gain);
 
 #endif
diff --git a/src/librtlsdr.c b/src/librtlsdr.c
index 71ae131..8866c49 100644
--- a/src/librtlsdr.c
+++ b/src/librtlsdr.c
@@ -151,8 +151,7 @@ int fc0013_set_freq(void *dev, uint32_t freq) {
 	return fc0013_set_params(dev, freq, 6000000);
 }
 int fc0013_set_bw(void *dev, int bw) { return 0; }
-int _fc0013_set_gain(void *dev, int gain) { return fc0013_set_gain(dev, gain); }
-int fc0013_set_gain_mode(void *dev, int manual) { return 0; }
+int _fc0013_set_gain(void *dev, int gain) { return fc0013_set_lna_gain(dev, gain); }
 
 int fc2580_init(void *dev) { return fc2580_Initialize(dev); }
 int fc2580_exit(void *dev) { return 0; }
@@ -757,7 +756,9 @@ int rtlsdr_get_tuner_gains(rtlsdr_dev_t *dev, int *gains)
 	const int e4k_gains[] = { -10, 15, 40, 65, 90, 115, 140, 165, 190, 215,
 				  240, 290, 340, 420 };
 	const int fc0012_gains[] = { -99, -40, 71, 179, 192 };
-	const int fc0013_gains[] = { -63, 71, 191, 197 };
+	const int fc0013_gains[] = { -99, -73, -65, -63, -60, -58, -54, 58, 61,
+				       63, 65, 67, 68, 70, 71, 179, 181, 182,
+				       184, 186, 188, 191, 197 };
 	const int fc2580_gains[] = { 0 /* no gain values */ };
 	const int r820t_gains[] = { 0 /* no gain values */ };
 	const int unknown_gains[] = { 0 /* no gain values */ };
diff --git a/src/tuner_fc0013.c b/src/tuner_fc0013.c
index 76e4b68..99f2e4b 100644
--- a/src/tuner_fc0013.c
+++ b/src/tuner_fc0013.c
@@ -432,52 +432,75 @@ exit:
 	return ret;
 }
 
-int fc0013_set_gain(void *dev, int gain)
+int fc0013_set_gain_mode(void *dev, int manual)
 {
-	int ret, gainshift = 0, en_in_chg = 0;
+	int ret = 0;
 	uint8_t tmp = 0;
 
-	ret = fc0013_readreg(dev, 0x14, &tmp);
+	ret |= fc0013_readreg(dev, 0x0d, &tmp);
 
-	/* mask bits off */
-	tmp &= 0xe0;
+	if (manual)
+		tmp |= (1 << 3);
+	else
+		tmp &= ~(1 << 3);
 
-	switch (gain) {
-	case -63:		/* -6.3 dB */
-		break;
-	case 71:
-		tmp |= 0x08;	/* 7.1 dB */
-		break;
-	case 191:
-		gainshift = 1;
-		tmp |= 0x11;	/* 19.1 dB */
-		break;
-	case 197:
-	default:
-		en_in_chg = 1;
-		gainshift = 1;
-		tmp |= 0x10;	/* 19.7 dB */
-		break;
-	}
+	ret |= fc0013_writereg(dev, 0x0d, tmp);
 
-	/* set gain */
-	ret = fc0013_writereg(dev, 0x14, tmp);
+	/* set a fixed IF-gain for now */
+	ret |= fc0013_writereg(dev, 0x13, 0x0a);
+
+	return ret;
+}
 
-	/* set en_in_chg */
-	ret = fc0013_readreg(dev, 0x0a, &tmp);
+int fc0013_lna_gains[] ={
+	-99,	0x02,
+	-73,	0x03,
+	-65,	0x05,
+	-63,	0x04,
+	-63,	0x00,
+	-60,	0x07,
+	-58,	0x01,
+	-54,	0x06,
+	58,	0x0f,
+	61,	0x0e,
+	63,	0x0d,
+	65,	0x0c,
+	67,	0x0b,
+	68,	0x0a,
+	70,	0x09,
+	71,	0x08,
+	179,	0x17,
+	181,	0x16,
+	182,	0x15,
+	184,	0x14,
+	186,	0x13,
+	188,	0x12,
+	191,	0x11,
+	197,	0x10
+};
+
+#define GAIN_CNT	(sizeof(fc0013_lna_gains) / sizeof(int) / 2)
+
+int fc0013_set_lna_gain(void *dev, int gain)
+{
+	int ret = 0;
+	unsigned int i;
+	uint8_t tmp = 0;
 
-	if (en_in_chg)
-		tmp |= 0x20;
-	else
-		tmp &= ~0x20;
+	ret |= fc0013_readreg(dev, 0x14, &tmp);
 
-	ret = fc0013_writereg(dev, 0x0a, tmp);
+	/* mask bits off */
+	tmp &= 0xe0;
+
+	for (i = 0; i < GAIN_CNT; i++) {
+		if ((fc0013_lna_gains[i*2] >= gain) || (i+1 == GAIN_CNT)) {
+			tmp |= fc0013_lna_gains[i*2 + 1];
+			break;
+		}
+	}
 
-	/* set gain shift */
-	ret = fc0013_readreg(dev, 0x07, &tmp);
-	tmp &= 0xf0;
-	tmp |= gainshift ? 0x0a : 0x07;
-	ret = fc0013_writereg(dev, 0x07, tmp);
+	/* set gain */
+	ret |= fc0013_writereg(dev, 0x14, tmp);
 
 	return ret;
 }