|
@@ -29,6 +29,8 @@
|
|
|
|
|
|
#include <linux/mfd/si476x-core.h>
|
|
|
|
|
|
+#include <asm/unaligned.h>
|
|
|
+
|
|
|
#define msb(x) ((u8)((u16) x >> 8))
|
|
|
#define lsb(x) ((u8)((u16) x & 0x00FF))
|
|
|
|
|
@@ -150,7 +152,7 @@ enum si476x_acf_status_report_bits {
|
|
|
SI476X_ACF_SOFTMUTE_INT = (1 << 0),
|
|
|
|
|
|
SI476X_ACF_SMUTE = (1 << 0),
|
|
|
- SI476X_ACF_SMATTN = 0b11111,
|
|
|
+ SI476X_ACF_SMATTN = 0x1f,
|
|
|
SI476X_ACF_PILOT = (1 << 7),
|
|
|
SI476X_ACF_STBLEND = ~SI476X_ACF_PILOT,
|
|
|
};
|
|
@@ -483,7 +485,7 @@ int si476x_core_cmd_get_property(struct si476x_core *core, u16 property)
|
|
|
if (err < 0)
|
|
|
return err;
|
|
|
else
|
|
|
- return be16_to_cpup((__be16 *)(resp + 2));
|
|
|
+ return get_unaligned_be16(resp + 2);
|
|
|
}
|
|
|
EXPORT_SYMBOL_GPL(si476x_core_cmd_get_property);
|
|
|
|
|
@@ -772,18 +774,18 @@ int si476x_core_cmd_am_rsq_status(struct si476x_core *core,
|
|
|
if (!report)
|
|
|
return err;
|
|
|
|
|
|
- report->snrhint = 0b00001000 & resp[1];
|
|
|
- report->snrlint = 0b00000100 & resp[1];
|
|
|
- report->rssihint = 0b00000010 & resp[1];
|
|
|
- report->rssilint = 0b00000001 & resp[1];
|
|
|
+ report->snrhint = 0x08 & resp[1];
|
|
|
+ report->snrlint = 0x04 & resp[1];
|
|
|
+ report->rssihint = 0x02 & resp[1];
|
|
|
+ report->rssilint = 0x01 & resp[1];
|
|
|
|
|
|
- report->bltf = 0b10000000 & resp[2];
|
|
|
- report->snr_ready = 0b00100000 & resp[2];
|
|
|
- report->rssiready = 0b00001000 & resp[2];
|
|
|
- report->afcrl = 0b00000010 & resp[2];
|
|
|
- report->valid = 0b00000001 & resp[2];
|
|
|
+ report->bltf = 0x80 & resp[2];
|
|
|
+ report->snr_ready = 0x20 & resp[2];
|
|
|
+ report->rssiready = 0x08 & resp[2];
|
|
|
+ report->afcrl = 0x02 & resp[2];
|
|
|
+ report->valid = 0x01 & resp[2];
|
|
|
|
|
|
- report->readfreq = be16_to_cpup((__be16 *)(resp + 3));
|
|
|
+ report->readfreq = get_unaligned_be16(resp + 3);
|
|
|
report->freqoff = resp[5];
|
|
|
report->rssi = resp[6];
|
|
|
report->snr = resp[7];
|
|
@@ -931,26 +933,26 @@ int si476x_core_cmd_fm_rds_status(struct si476x_core *core,
|
|
|
if (err < 0 || report == NULL)
|
|
|
return err;
|
|
|
|
|
|
- report->rdstpptyint = 0b00010000 & resp[1];
|
|
|
- report->rdspiint = 0b00001000 & resp[1];
|
|
|
- report->rdssyncint = 0b00000010 & resp[1];
|
|
|
- report->rdsfifoint = 0b00000001 & resp[1];
|
|
|
+ report->rdstpptyint = 0x10 & resp[1];
|
|
|
+ report->rdspiint = 0x08 & resp[1];
|
|
|
+ report->rdssyncint = 0x02 & resp[1];
|
|
|
+ report->rdsfifoint = 0x01 & resp[1];
|
|
|
|
|
|
- report->tpptyvalid = 0b00010000 & resp[2];
|
|
|
- report->pivalid = 0b00001000 & resp[2];
|
|
|
- report->rdssync = 0b00000010 & resp[2];
|
|
|
- report->rdsfifolost = 0b00000001 & resp[2];
|
|
|
+ report->tpptyvalid = 0x10 & resp[2];
|
|
|
+ report->pivalid = 0x08 & resp[2];
|
|
|
+ report->rdssync = 0x02 & resp[2];
|
|
|
+ report->rdsfifolost = 0x01 & resp[2];
|
|
|
|
|
|
- report->tp = 0b00100000 & resp[3];
|
|
|
- report->pty = 0b00011111 & resp[3];
|
|
|
+ report->tp = 0x20 & resp[3];
|
|
|
+ report->pty = 0x1f & resp[3];
|
|
|
|
|
|
- report->pi = be16_to_cpup((__be16 *)(resp + 4));
|
|
|
+ report->pi = get_unaligned_be16(resp + 4);
|
|
|
report->rdsfifoused = resp[6];
|
|
|
|
|
|
- report->ble[V4L2_RDS_BLOCK_A] = 0b11000000 & resp[7];
|
|
|
- report->ble[V4L2_RDS_BLOCK_B] = 0b00110000 & resp[7];
|
|
|
- report->ble[V4L2_RDS_BLOCK_C] = 0b00001100 & resp[7];
|
|
|
- report->ble[V4L2_RDS_BLOCK_D] = 0b00000011 & resp[7];
|
|
|
+ report->ble[V4L2_RDS_BLOCK_A] = 0xc0 & resp[7];
|
|
|
+ report->ble[V4L2_RDS_BLOCK_B] = 0x30 & resp[7];
|
|
|
+ report->ble[V4L2_RDS_BLOCK_C] = 0x0c & resp[7];
|
|
|
+ report->ble[V4L2_RDS_BLOCK_D] = 0x03 & resp[7];
|
|
|
|
|
|
report->rds[V4L2_RDS_BLOCK_A].block = V4L2_RDS_BLOCK_A;
|
|
|
report->rds[V4L2_RDS_BLOCK_A].msb = resp[8];
|
|
@@ -991,9 +993,9 @@ int si476x_core_cmd_fm_rds_blockcount(struct si476x_core *core,
|
|
|
SI476X_DEFAULT_TIMEOUT);
|
|
|
|
|
|
if (!err) {
|
|
|
- report->expected = be16_to_cpup((__be16 *)(resp + 2));
|
|
|
- report->received = be16_to_cpup((__be16 *)(resp + 4));
|
|
|
- report->uncorrectable = be16_to_cpup((__be16 *)(resp + 6));
|
|
|
+ report->expected = get_unaligned_be16(resp + 2);
|
|
|
+ report->received = get_unaligned_be16(resp + 4);
|
|
|
+ report->uncorrectable = get_unaligned_be16(resp + 6);
|
|
|
}
|
|
|
|
|
|
return err;
|
|
@@ -1005,7 +1007,7 @@ int si476x_core_cmd_fm_phase_diversity(struct si476x_core *core,
|
|
|
{
|
|
|
u8 resp[CMD_FM_PHASE_DIVERSITY_NRESP];
|
|
|
const u8 args[CMD_FM_PHASE_DIVERSITY_NARGS] = {
|
|
|
- mode & 0b111,
|
|
|
+ mode & 0x07,
|
|
|
};
|
|
|
|
|
|
return si476x_core_send_command(core, CMD_FM_PHASE_DIVERSITY,
|
|
@@ -1162,7 +1164,7 @@ static int si476x_core_cmd_am_tune_freq_a20(struct si476x_core *core,
|
|
|
const int am_freq = tuneargs->freq;
|
|
|
u8 resp[CMD_AM_TUNE_FREQ_NRESP];
|
|
|
const u8 args[CMD_AM_TUNE_FREQ_NARGS] = {
|
|
|
- (tuneargs->zifsr << 6) | (tuneargs->injside & 0b11),
|
|
|
+ (tuneargs->zifsr << 6) | (tuneargs->injside & 0x03),
|
|
|
msb(am_freq),
|
|
|
lsb(am_freq),
|
|
|
};
|
|
@@ -1197,20 +1199,20 @@ static int si476x_core_cmd_fm_rsq_status_a10(struct si476x_core *core,
|
|
|
if (err < 0 || report == NULL)
|
|
|
return err;
|
|
|
|
|
|
- report->multhint = 0b10000000 & resp[1];
|
|
|
- report->multlint = 0b01000000 & resp[1];
|
|
|
- report->snrhint = 0b00001000 & resp[1];
|
|
|
- report->snrlint = 0b00000100 & resp[1];
|
|
|
- report->rssihint = 0b00000010 & resp[1];
|
|
|
- report->rssilint = 0b00000001 & resp[1];
|
|
|
+ report->multhint = 0x80 & resp[1];
|
|
|
+ report->multlint = 0x40 & resp[1];
|
|
|
+ report->snrhint = 0x08 & resp[1];
|
|
|
+ report->snrlint = 0x04 & resp[1];
|
|
|
+ report->rssihint = 0x02 & resp[1];
|
|
|
+ report->rssilint = 0x01 & resp[1];
|
|
|
|
|
|
- report->bltf = 0b10000000 & resp[2];
|
|
|
- report->snr_ready = 0b00100000 & resp[2];
|
|
|
- report->rssiready = 0b00001000 & resp[2];
|
|
|
- report->afcrl = 0b00000010 & resp[2];
|
|
|
- report->valid = 0b00000001 & resp[2];
|
|
|
+ report->bltf = 0x80 & resp[2];
|
|
|
+ report->snr_ready = 0x20 & resp[2];
|
|
|
+ report->rssiready = 0x08 & resp[2];
|
|
|
+ report->afcrl = 0x02 & resp[2];
|
|
|
+ report->valid = 0x01 & resp[2];
|
|
|
|
|
|
- report->readfreq = be16_to_cpup((__be16 *)(resp + 3));
|
|
|
+ report->readfreq = get_unaligned_be16(resp + 3);
|
|
|
report->freqoff = resp[5];
|
|
|
report->rssi = resp[6];
|
|
|
report->snr = resp[7];
|
|
@@ -1218,7 +1220,7 @@ static int si476x_core_cmd_fm_rsq_status_a10(struct si476x_core *core,
|
|
|
report->hassi = resp[10];
|
|
|
report->mult = resp[11];
|
|
|
report->dev = resp[12];
|
|
|
- report->readantcap = be16_to_cpup((__be16 *)(resp + 13));
|
|
|
+ report->readantcap = get_unaligned_be16(resp + 13);
|
|
|
report->assi = resp[15];
|
|
|
report->usn = resp[16];
|
|
|
|
|
@@ -1251,20 +1253,20 @@ static int si476x_core_cmd_fm_rsq_status_a20(struct si476x_core *core,
|
|
|
if (err < 0 || report == NULL)
|
|
|
return err;
|
|
|
|
|
|
- report->multhint = 0b10000000 & resp[1];
|
|
|
- report->multlint = 0b01000000 & resp[1];
|
|
|
- report->snrhint = 0b00001000 & resp[1];
|
|
|
- report->snrlint = 0b00000100 & resp[1];
|
|
|
- report->rssihint = 0b00000010 & resp[1];
|
|
|
- report->rssilint = 0b00000001 & resp[1];
|
|
|
+ report->multhint = 0x80 & resp[1];
|
|
|
+ report->multlint = 0x40 & resp[1];
|
|
|
+ report->snrhint = 0x08 & resp[1];
|
|
|
+ report->snrlint = 0x04 & resp[1];
|
|
|
+ report->rssihint = 0x02 & resp[1];
|
|
|
+ report->rssilint = 0x01 & resp[1];
|
|
|
|
|
|
- report->bltf = 0b10000000 & resp[2];
|
|
|
- report->snr_ready = 0b00100000 & resp[2];
|
|
|
- report->rssiready = 0b00001000 & resp[2];
|
|
|
- report->afcrl = 0b00000010 & resp[2];
|
|
|
- report->valid = 0b00000001 & resp[2];
|
|
|
+ report->bltf = 0x80 & resp[2];
|
|
|
+ report->snr_ready = 0x20 & resp[2];
|
|
|
+ report->rssiready = 0x08 & resp[2];
|
|
|
+ report->afcrl = 0x02 & resp[2];
|
|
|
+ report->valid = 0x01 & resp[2];
|
|
|
|
|
|
- report->readfreq = be16_to_cpup((__be16 *)(resp + 3));
|
|
|
+ report->readfreq = get_unaligned_be16(resp + 3);
|
|
|
report->freqoff = resp[5];
|
|
|
report->rssi = resp[6];
|
|
|
report->snr = resp[7];
|
|
@@ -1272,7 +1274,7 @@ static int si476x_core_cmd_fm_rsq_status_a20(struct si476x_core *core,
|
|
|
report->hassi = resp[10];
|
|
|
report->mult = resp[11];
|
|
|
report->dev = resp[12];
|
|
|
- report->readantcap = be16_to_cpup((__be16 *)(resp + 13));
|
|
|
+ report->readantcap = get_unaligned_be16(resp + 13);
|
|
|
report->assi = resp[15];
|
|
|
report->usn = resp[16];
|
|
|
|
|
@@ -1306,21 +1308,21 @@ static int si476x_core_cmd_fm_rsq_status_a30(struct si476x_core *core,
|
|
|
if (err < 0 || report == NULL)
|
|
|
return err;
|
|
|
|
|
|
- report->multhint = 0b10000000 & resp[1];
|
|
|
- report->multlint = 0b01000000 & resp[1];
|
|
|
- report->snrhint = 0b00001000 & resp[1];
|
|
|
- report->snrlint = 0b00000100 & resp[1];
|
|
|
- report->rssihint = 0b00000010 & resp[1];
|
|
|
- report->rssilint = 0b00000001 & resp[1];
|
|
|
-
|
|
|
- report->bltf = 0b10000000 & resp[2];
|
|
|
- report->snr_ready = 0b00100000 & resp[2];
|
|
|
- report->rssiready = 0b00001000 & resp[2];
|
|
|
- report->injside = 0b00000100 & resp[2];
|
|
|
- report->afcrl = 0b00000010 & resp[2];
|
|
|
- report->valid = 0b00000001 & resp[2];
|
|
|
-
|
|
|
- report->readfreq = be16_to_cpup((__be16 *)(resp + 3));
|
|
|
+ report->multhint = 0x80 & resp[1];
|
|
|
+ report->multlint = 0x40 & resp[1];
|
|
|
+ report->snrhint = 0x08 & resp[1];
|
|
|
+ report->snrlint = 0x04 & resp[1];
|
|
|
+ report->rssihint = 0x02 & resp[1];
|
|
|
+ report->rssilint = 0x01 & resp[1];
|
|
|
+
|
|
|
+ report->bltf = 0x80 & resp[2];
|
|
|
+ report->snr_ready = 0x20 & resp[2];
|
|
|
+ report->rssiready = 0x08 & resp[2];
|
|
|
+ report->injside = 0x04 & resp[2];
|
|
|
+ report->afcrl = 0x02 & resp[2];
|
|
|
+ report->valid = 0x01 & resp[2];
|
|
|
+
|
|
|
+ report->readfreq = get_unaligned_be16(resp + 3);
|
|
|
report->freqoff = resp[5];
|
|
|
report->rssi = resp[6];
|
|
|
report->snr = resp[7];
|
|
@@ -1329,7 +1331,7 @@ static int si476x_core_cmd_fm_rsq_status_a30(struct si476x_core *core,
|
|
|
report->hassi = resp[10];
|
|
|
report->mult = resp[11];
|
|
|
report->dev = resp[12];
|
|
|
- report->readantcap = be16_to_cpup((__be16 *)(resp + 13));
|
|
|
+ report->readantcap = get_unaligned_be16(resp + 13);
|
|
|
report->assi = resp[15];
|
|
|
report->usn = resp[16];
|
|
|
|
|
@@ -1337,7 +1339,7 @@ static int si476x_core_cmd_fm_rsq_status_a30(struct si476x_core *core,
|
|
|
report->rdsdev = resp[18];
|
|
|
report->assidev = resp[19];
|
|
|
report->strongdev = resp[20];
|
|
|
- report->rdspi = be16_to_cpup((__be16 *)(resp + 21));
|
|
|
+ report->rdspi = get_unaligned_be16(resp + 21);
|
|
|
|
|
|
return err;
|
|
|
}
|