static irqreturn_t Si4709_isr(int irq, void *unused)
{
debug("Si4709_isr: FM device called IRQ: %d\n", irq);
#ifdef RDS_INTERRUPT_ON_ALWAYS
if ((Si4709_dev_wait_flag == SEEK_WAITING) ||
(Si4709_dev_wait_flag == TUNE_WAITING)) {
debug("Si4709_isr: FM Seek/Tune Interrupt "
"called IRQ %d\n", irq);
Si4709_dev_wait_flag = WAIT_OVER;
wake_up_interruptible(&Si4709_waitq);
} else if (Si4709_RDS_flag == RDS_WAITING) { /* RDS Interrupt */
debug_rds("Si4709_isr: FM RDS Interrupt "
"called IRQ %d", irq);
debug_rds("RDS_Groups_Available_till_now b/w "
"Power ON/OFF : %d",
RDS_Groups_Available_till_now);
if (!work_pending(&Si4709_work))
queue_work(Si4709_wq, &Si4709_work);
}
#else
if ((Si4709_dev_wait_flag == SEEK_WAITING) ||
(Si4709_dev_wait_flag == TUNE_WAITING) ||
(Si4709_dev_wait_flag == RDS_WAITING)) {
Si4709_dev_wait_flag = WAIT_OVER;
wake_up_interruptible(&Si4709_waitq);
}
#endif
return IRQ_HANDLED;
}
/*Resetting the RDS Data Buffer*/
int Si4709_dev_reset_rds_data()
{
int ret = 0;
debug_rds("Si4709_dev_reset_rds_data called");
mutex_lock(&(Si4709_dev.lock));
if (Si4709_dev.valid == eFALSE) {
debug("Si4709_dev_reset_rds_data called when DS is invalid");
ret = -1;
} else {
RDS_Buffer_Index_write = 0;
RDS_Buffer_Index_read = 0;
RDS_Data_Lost = 0;
RDS_Data_Available = 0;
memset(RDS_Block_Data_buffer, 0, RDS_BUFFER_LENGTH * 8);
memset(RDS_Block_Error_buffer, 0, RDS_BUFFER_LENGTH * 4);
}
mutex_unlock(&(Si4709_dev.lock));
return ret;
}
void Si4709_work_func(struct work_struct *work)
{
int i, ret = 0;
#ifdef RDS_TESTING
u8 group_type;
#endif
debug_rds("%s", __func__);
mutex_lock(&(Si4709_dev.lock));
if (Si4709_dev.valid == eFALSE) {
error("Si4709_dev_RDS_data_get called when DS is invalid");
return;
}
if (RDS_Data_Lost > 1)
debug_rds("No_of_RDS_groups_Lost till now : %d",
RDS_Data_Lost);
fmRdsStatus(1, 0);
/* RDSR bit and RDS Block data, so reading the RDS registers */
do {
/* Writing into RDS_Block_Data_buffer */
i = 0;
RDS_Block_Data_buffer[i++ + 4 * RDS_Buffer_Index_write] =
BlockA;
RDS_Block_Data_buffer[i++ + 4 * RDS_Buffer_Index_write] =
BlockB;
RDS_Block_Data_buffer[i++ + 4 * RDS_Buffer_Index_write] =
BlockC;
RDS_Block_Data_buffer[i++ + 4 * RDS_Buffer_Index_write] =
BlockD;
/*Writing into RDS_Block_Error_buffer */
i = 0;
RDS_Block_Error_buffer[i++ + 4 * RDS_Buffer_Index_write] =
BleA;
RDS_Block_Error_buffer[i++ + 4 * RDS_Buffer_Index_write] =
BleB;
RDS_Block_Error_buffer[i++ + 4 * RDS_Buffer_Index_write] =
BleC;
RDS_Block_Error_buffer[i++ + 4 * RDS_Buffer_Index_write] =
BleD;
fmRdsStatus(1, 0);
} while (RdsFifoUsed != 0);
#ifdef RDS_TESTING
if (RDS_Block_Error_buffer
[0 + 4 * RDS_Buffer_Index_write] < 3) {
debug_rds("PI Code is %d",
RDS_Block_Data_buffer[0 + 4
* RDS_Buffer_Index_write]);
}
if (RDS_Block_Error_buffer
[1 + 4 * RDS_Buffer_Index_write] < 2) {
group_type = RDS_Block_Data_buffer[1 + 4
* RDS_Buffer_Index_write] >> 11;
if (group_type & 0x01) {
debug_rds("PI Code is %d",
RDS_Block_Data_buffer[2 + 4
* RDS_Buffer_Index_write]);
}
if (group_type == GROUP_TYPE_2A
|| group_type == GROUP_TYPE_2B) {
if (RDS_Block_Error_buffer
[2 + 4 * RDS_Buffer_Index_write] < 3) {
debug_rds("Update RT with RDSC");
} else {
debug_rds("RDS_Block_Error_buffer"
" of Block C is greater than 3");
}
}
}
void Si47xx_work_func(struct work_struct *work)
{
struct radio_data_t rds_data;
int i = 0;
u8 RdsFifoUsed;
#ifdef RDS_TESTING
u8 group_type;
#endif
debug_rds("%s", __func__);
mutex_lock(&(Si47xx_dev->lock));
if (Si47xx_dev->valid == eFALSE) {
dev_err(Si47xx_dev->dev, "Si47xx_dev_RDS_data_get called when DS is invalid");
return;
}
if (RDS_Data_Lost > 1)
debug_rds("No_of_RDS_groups_Lost till now : %d",
RDS_Data_Lost);
fmRdsStatus(1, 0, &rds_data, &RdsFifoUsed);
/* RDSR bit and RDS Block data, so reading the RDS registers */
do {
/* Writing into RDS_Block_Data_buffer */
i = 0;
RDS_Block_Data_buffer[i++ + 4 * RDS_Buffer_Index_write] =
rds_data.rdsa;
RDS_Block_Data_buffer[i++ + 4 * RDS_Buffer_Index_write] =
rds_data.rdsb;
RDS_Block_Data_buffer[i++ + 4 * RDS_Buffer_Index_write] =
rds_data.rdsc;
RDS_Block_Data_buffer[i++ + 4 * RDS_Buffer_Index_write] =
rds_data.rdsd;
/*Writing into RDS_Block_Error_buffer */
i = 0;
RDS_Block_Error_buffer[i++ + 4 * RDS_Buffer_Index_write] =
rds_data.blera;
RDS_Block_Error_buffer[i++ + 4 * RDS_Buffer_Index_write] =
rds_data.blerb;
RDS_Block_Error_buffer[i++ + 4 * RDS_Buffer_Index_write] =
rds_data.blerc;
RDS_Block_Error_buffer[i++ + 4 * RDS_Buffer_Index_write] =
rds_data.blerd;
fmRdsStatus(1, 0, &rds_data, &RdsFifoUsed);
} while (RdsFifoUsed != 0);
#ifdef RDS_TESTING
if (RDS_Block_Error_buffer
[0 + 4 * RDS_Buffer_Index_write] < 3) {
debug_rds("PI Code is %d",
RDS_Block_Data_buffer[0 + 4
* RDS_Buffer_Index_write]);
}
if (RDS_Block_Error_buffer
[1 + 4 * RDS_Buffer_Index_write] < 2) {
group_type = RDS_Block_Data_buffer[1 + 4
* RDS_Buffer_Index_write] >> 11;
if (group_type & 0x01) {
debug_rds("PI Code is %d",
RDS_Block_Data_buffer[2 + 4
* RDS_Buffer_Index_write]);
}
if (group_type == GROUP_TYPE_2A
|| group_type == GROUP_TYPE_2B) {
if (RDS_Block_Error_buffer
[2 + 4 * RDS_Buffer_Index_write] < 3) {
debug_rds("Update RT with RDSC");
} else {
debug_rds("RDS_Block_Error_buffer"
" of Block C is greater than 3");
}
}
}
