IodeOs/device_brax_brax3
4
0
Fork 0
Code Issues Pull requests Projects Releases Wiki Activity
device_brax_brax3/libfmjni/common.cpp
Vincent Vidal 8710a52d67 init
2025-08-07 16:07:57 +02:00

968 lines
26 KiB
C++
Executable file
Raw Blame History

/*
* Copyright (C) 2014 The Android Open Source Project
*
* Licensed under the Apache License, Version 2.0 (the "License");
* you may not use this file except in compliance with the License.
* You may obtain a copy of the License at
*
* http://www.apache.org/licenses/LICENSE-2.0
*
* Unless required by applicable law or agreed to in writing, software
* distributed under the License is distributed on an "AS IS" BASIS,
* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
* See the License for the specific language governing permissions and
* limitations under the License.
*/
#include <cutils/properties.h>
#include "fmr.h"
#ifdef LOG_TAG
#undef LOG_TAG
#endif
#define LOG_TAG "FMLIB_COM"
#define UNUSED(x) (void)(x)
int COM_get_seek_space()
{
// FM radio seek space, 5:50KHZ; 1:100KHZ; 2:200KHZ
if (property_get_int32("persist.vendor.connsys.fm_50khz_support", 0) == 1)
return FM_SPACE_50K;
return FM_SPACE_DEFAULT;
}
int COM_open_dev(const char *pname, int *fd)
{
int ret = 0;
int tmp = -1;
FMR_ASSERT(pname);
FMR_ASSERT(fd);
LOGI("COM_open_dev start\n");
tmp = open(pname, O_RDWR);
if (tmp < 0) {
LOGE("Open %s failed, %s\n", pname, strerror(errno));
ret = -ERR_INVALID_FD;
}
*fd = tmp;
LOGI("%s, [fd=%d] [ret=%d]\n", __func__, *fd, ret);
return ret;
}
int COM_close_dev(int fd)
{
int ret = 0;
LOGI("COM_close_dev start\n");
ret = close(fd);
if (ret) {
LOGE("%s, failed\n", __func__);
}
LOGD("%s, [fd=%d] [ret=%d]\n", __func__, fd, ret);
return ret;
}
int COM_pwr_up(int fd, int band, int freq)
{
int ret = 0;
struct fm_tune_parm parm;
LOGI("%s, [freq=%d]\n", __func__, freq);
bzero(&parm, sizeof(struct fm_tune_parm));
parm.band = band;
parm.freq = freq;
parm.hilo = FM_AUTO_HILO_OFF;
parm.space = FM_SEEK_SPACE;
ret = ioctl(fd, FM_IOCTL_POWERUP, &parm);
if (ret) {
LOGE("%s, failed\n", __func__);
}
LOGD("%s, [fd=%d] [ret=%d]\n", __func__, fd, ret);
return ret;
}
int COM_pwr_down(int fd, int type)
{
int ret = 0;
LOGI("%s, [type=%d]\n", __func__, type);
ret = ioctl(fd, FM_IOCTL_POWERDOWN, &type);
if (ret) {
LOGE("%s, failed\n", __func__);
}
LOGD("%s, [fd=%d] [ret=%d]\n", __func__, fd, ret);
return ret;
}
int COM_get_chip_id(int fd, int *chipid)
{
int ret = 0;
uint16_t tmp = 0;
FMR_ASSERT(chipid);
ret = ioctl(fd, FM_IOCTL_GETCHIPID, &tmp);
*chipid = (int)tmp;
if (ret){
LOGE("%s, failed\n", __func__);
}
LOGD("%s, [fd=%d] [chipid=%x] [ret=%d]\n", __func__, fd, *chipid, ret);
return ret;
}
int COM_get_rssi(int fd, int *rssi)
{
int ret = 0;
FMR_ASSERT(rssi);
ret = ioctl(fd, FM_IOCTL_GETRSSI, rssi);
if(ret){
LOGE("%s, failed, [ret=%d]\n", __func__, ret);
}
LOGI("%s, [rssi=%d] [ret=%d]\n", __func__, *rssi, ret);
return ret;
}
/*0x20: space, 0x7E:~*/
#define ISVALID(c)((c)>=0x20 && (c)<=0x7E)
/*change any char which out of [0x20,0x7E]to space(0x20)*/
void COM_change_string(uint8_t *str, int len)
{
int i = 0;
for (i=0; i<len; i++) {
if (false == ISVALID(str[i])) {
str[i]= 0x20;
}
}
}
int COM_get_ps(int fd, RDSData_Struct *rds, uint8_t **ps, int *ps_len)
{
int ret = 0;
char tmp_ps[9] = {0};
UNUSED(fd);
FMR_ASSERT(rds);
FMR_ASSERT(ps);
FMR_ASSERT(ps_len);
if (rds->event_status&RDS_EVENT_PROGRAMNAME) {
LOGD("%s, Success,[event_status=%d]\n", __func__, rds->event_status);
*ps = &rds->PS_Data.PS[3][0];
*ps_len = sizeof(rds->PS_Data.PS[3]);
COM_change_string(*ps, *ps_len);
memcpy(tmp_ps, *ps, 8);
LOGI("PS=%s\n", tmp_ps);
} else {
LOGE("%s, Failed,[event_status=%d]\n", __func__, rds->event_status);
*ps = NULL;
*ps_len = 0;
ret = -ERR_RDS_NO_DATA;
}
return ret;
}
int COM_get_rt(int fd, RDSData_Struct *rds, uint8_t **rt, int *rt_len)
{
int ret = 0;
char tmp_rt[65] = { 0 };
UNUSED(fd);
FMR_ASSERT(rds);
FMR_ASSERT(rt);
FMR_ASSERT(rt_len);
if (rds->event_status&RDS_EVENT_LAST_RADIOTEXT) {
LOGD("%s, Success,[event_status=%d]\n", __func__, rds->event_status);
*rt = &rds->RT_Data.TextData[3][0];
*rt_len = rds->RT_Data.TextLength;
COM_change_string(*rt, *rt_len);
memcpy(tmp_rt, *rt, 64);
LOGI("RT=%s\n", tmp_rt);
} else {
LOGE("%s, Failed,[event_status=%d]\n", __func__, rds->event_status);
*rt = NULL;
*rt_len = 0;
ret = -ERR_RDS_NO_DATA;
}
return ret;
}
int COM_get_pi(int fd, RDSData_Struct *rds, uint16_t *pi)
{
int ret = 0;
UNUSED(fd);
FMR_ASSERT(rds);
FMR_ASSERT(pi);
if (rds->event_status & RDS_EVENT_PI_CODE) {
LOGD("%s, Success,[event_status=%d] [PI=%d]\n", __func__, rds->event_status, rds->PI);
*pi = rds->PI;
} else {
LOGI("%s, Failed, there's no pi,[event_status=%d]\n", __func__, rds->event_status);
*pi = -1;
ret = -ERR_RDS_NO_DATA;
}
return ret;
}
int COM_get_ecc(int fd, RDSData_Struct *rds, uint8_t *ecc)
{
int ret = 0;
UNUSED(fd);
FMR_ASSERT(rds);
FMR_ASSERT(ecc);
if (rds->event_status & RDS_EVENT_ECC_CODE) {
LOGD("%s, Success,[event_status=%d] [ECC=%d]\n", __func__,
rds->event_status, rds->Extend_Country_Code);
*ecc = rds->Extend_Country_Code;
} else {
LOGI("%s, Failed, there's no ECC,[event_status=%d]\n", __func__, rds->event_status);
*ecc = -1;
ret = -ERR_RDS_NO_DATA;
}
return ret;
}
int COM_get_pty(int fd, RDSData_Struct *rds, uint8_t *pty)
{
int ret = 0;
UNUSED(fd);
FMR_ASSERT(rds);
FMR_ASSERT(pty);
if(rds->event_status&RDS_EVENT_PTY_CODE){
LOGD("%s, Success,[event_status=%d] [PTY=%d]\n", __func__, rds->event_status, rds->PTY);
*pty = rds->PTY;
}else{
LOGI("%s, Success, there's no pty,[event_status=%d]\n", __func__, rds->event_status);
*pty = -1;
ret = -ERR_RDS_NO_DATA;
}
return ret;
}
int COM_tune(int fd, int freq, int band)
{
int ret = 0;
struct fm_tune_parm parm;
bzero(&parm, sizeof(struct fm_tune_parm));
parm.band = band;
parm.freq = freq;
parm.hilo = FM_AUTO_HILO_OFF;
parm.space = FM_SEEK_SPACE;
ret = ioctl(fd, FM_IOCTL_TUNE, &parm);
if (ret) {
LOGE("%s, failed\n", __func__);
}
LOGD("%s, [fd=%d] [freq=%d] [ret=%d]\n", __func__, fd, freq, ret);
return ret;
}
int COM_seek(int fd, int *freq, int band, int dir, int lev)
{
int ret = 0;
struct fm_seek_parm parm;
bzero(&parm, sizeof(struct fm_tune_parm));
parm.band = band;
parm.freq = *freq;
parm.hilo = FM_AUTO_HILO_OFF;
parm.space = FM_SEEK_SPACE;
if (dir == 1) {
parm.seekdir = FM_SEEK_UP;
} else if (dir == 0) {
parm.seekdir = FM_SEEK_DOWN;
}
parm.seekth = lev;
ret = ioctl(fd, FM_IOCTL_SEEK, &parm);
if (ret == 0) {
*freq = parm.freq;
}
LOGD("%s, [fd=%d] [ret=%d]\n", __func__, fd, ret);
return ret;
}
int COM_set_mute(int fd, int mute)
{
int ret = 0;
int tmp = mute;
LOGD("%s, start \n", __func__);
ret = ioctl(fd, FM_IOCTL_MUTE, &tmp);
if (ret) {
LOGE("%s, failed\n", __func__);
}
LOGD("%s, [fd=%d] [ret=%d]\n", __func__, fd, ret);
return ret;
}
int COM_is_fm_pwrup(int fd, int *pwrup)
{
int ret = 0;
ret = ioctl(fd, FM_IOCTL_IS_FM_POWERED_UP, pwrup);
if (ret) {
LOGE("%s, failed\n", __func__);
}
LOGD("%s, [fd=%d] [ret=%d]\n", __func__, fd, ret);
return ret;
}
/******************************************
* Inquiry if RDS is support in driver.
* Parameter:
* None
*supt Value:
* 1: support
* 0: NOT support
* -1: error
******************************************/
int COM_is_rdsrx_support(int fd, int *supt)
{
int ret = 0;
int support = -1;
if (fd < 0) {
LOGE("FM isRDSsupport fail, g_fm_fd = %d\n", fd);
*supt = -1;
ret = -ERR_INVALID_FD;
return ret;
}
ret = ioctl(fd, FM_IOCTL_RDS_SUPPORT, &support);
if (ret) {
LOGE("FM FM_IOCTL_RDS_SUPPORT fail, errno = %d\n", errno);
//don't support
*supt = 0;
return ret;
}
LOGI("isRDSsupport Success,[support=%d]\n", support);
*supt = support;
return ret;
}
int COM_pre_search(int fd)
{
fm_s32 ret = 0;
ret = ioctl(fd, FM_IOCTL_PRE_SEARCH, 0);
LOGD("COM_pre_search:%d\n",ret);
return ret;
}
int COM_restore_search(int fd)
{
fm_s32 ret = 0;
ret = ioctl(fd, FM_IOCTL_RESTORE_SEARCH, 0);
LOGD("COM_restore_search:%d\n",ret);
return ret;
}
/*soft mute tune function, usually for sw scan implement or CQI log tool*/
int COM_Soft_Mute_Tune(int fd, fm_softmute_tune_t *para)
{
fm_s32 ret = 0;
//fm_s32 RSSI = 0, PAMD = 0,MR = 0, ATDC = 0;
//fm_u32 PRX = 0;
//fm_u16 softmuteGainLvl = 0;
fm_softmute_tune_t value;
value.freq = para->freq;
ret = ioctl(fd, FM_IOCTL_SOFT_MUTE_TUNE, &value);
if (ret) {
LOGE("FM soft mute tune faild:%d\n",ret);
return ret;
}
#if 0
LOGD("Raw data of soft mute tune[%d]: RSSI:[%x]PAMD:[%x]MR:[%x]ATDC:[%x]PRX:[%x]SMG:[%x]",para->freq,value.RSSI,value.PAMD,value.MR,value.ATDC,value.PRX,value.SMG);
RSSI = ((value.RSSI & 0x03FF) >= 512) ? ((value.RSSI & 0x03FF) - 1024) : (value.RSSI & 0x03FF);
PAMD = ((value.PAMD & 0xFF) >= 128) ? ((value.PAMD & 0x00FF) - 256) : (value.PAMD & 0x00FF);
MR = ((value.MR & 0x01FF) >= 256) ? ((value.MR & 0x01FF) - 512) : (value.MR & 0x01FF);
ATDC =((value.ATDC & 0x0FFF) >= 2048) ? ((value.ATDC & 0x0FFF) - 4096) : (value.ATDC & 0x0FFF);
if (ATDC < 0) {
ATDC = (~(ATDC)) - 1;//Get abs value of ATDC
}
PRX = (value.PRX & 0x00FF);
softmuteGainLvl = value.SMG;
//check if the channel is valid according to each CQIs
if ((RSSI >= RSSI_TH)
&& (PAMD <= PAMD_TH)
&& (ATDC <= ATDC_TH)
&& (MR >= MR_TH)
&& (PRX >= PRX_TH)
&& (softmuteGainLvl <= softMuteGainTH)) {
para->valid = fm_true;
} else {
para->valid = fm_false;
}
#endif
para->valid = value.valid;
para->rssi = value.rssi;
//LOGI("soft mute tune[%d] valid[%d]: RSSI:[%d]PAMD:[%d]MR:[%d]ATDC:[%d]PRX:[%d]SMG:[%d]",para->freq,para->valid,RSSI,PAMD,MR,ATDC,PRX,softmuteGainLvl);
return 0;
}
int COM_get_cqi(int fd, int num, char *buf, int buf_len)
{
int ret;
struct fm_cqi_req cqi_req;
//check buf
num = (num > CQI_CH_NUM_MAX) ? CQI_CH_NUM_MAX : num;
num = (num < CQI_CH_NUM_MIN) ? CQI_CH_NUM_MIN : num;
cqi_req.ch_num = (uint16_t)num;
cqi_req.buf_size = cqi_req.ch_num * sizeof(struct fm_cqi);
if (!buf || (buf_len < cqi_req.buf_size)) {
LOGE("get cqi, invalid buf\n");
return -1;
}
cqi_req.cqi_buf = buf;
//get cqi from driver
ret = ioctl(fd, FM_IOCTL_CQI_GET, &cqi_req);
if (ret < 0) {
LOGE("get cqi, failed %d\n", ret);
return -1;
}
return 0;
}
int COM_turn_on_off_rds(int fd, int onoff)
{
int ret = 0;
uint16_t rds_on = -1;
LOGD("Rdsset start\n");
if (onoff == FMR_RDS_ON) {
rds_on = 1;
ret = ioctl(fd, FM_IOCTL_RDS_ONOFF, &rds_on);
if (ret) {
LOGE("FM_IOCTL_RDS_ON failed\n");
return ret;
}
LOGD("Rdsset Success,[rds_on=%d]\n", rds_on);
} else {
rds_on = 0;
ret = ioctl(fd, FM_IOCTL_RDS_ONOFF, &rds_on);
if (ret) {
LOGE("FM_IOCTL_RDS_OFF failed\n");
return ret;
}
LOGD("Rdsset Success,[rds_on=%d]\n", rds_on);
}
return ret;
}
int COM_read_rds_data(int fd, RDSData_Struct *rds, uint16_t *rds_status)
{
int ret = 0;
uint16_t event_status;
//char tmp_ps[9] = {0};
//char tmp_rt[65] = { 0 };
FMR_ASSERT(rds);
FMR_ASSERT(rds_status);
if (read(fd, rds, sizeof(RDSData_Struct)) == sizeof(RDSData_Struct)) {
event_status = rds->event_status;
//memcpy(tmp_ps, &rds->PS_Data.PS[3][0], 8);
//memcpy(tmp_rt, &rds->RT_Data.TextData[3][0], 64);
LOGI("event_status = 0x%x\n", event_status);
//memset(tmp_ps, 0, 9);
//memset(tmp_rt, 0, 65);
*rds_status = event_status;
return ret;
} else {
//LOGE("readrds get no event\n");
ret = -ERR_RDS_NO_DATA;
}
return ret;
}
static int COM_get_af_pi(int fd, uint16_t *pi)
{
int ret;
struct rds_raw_data rrd;
uint16_t pi1, pi2;
FMR_ASSERT(pi);
memset(&rrd, 0, sizeof(rrd));
ret = ioctl(fd, FM_IOCTL_RDS_GET_LOG, &rrd);
if (ret) {
LOGE("COM_get_af_pi fail(%d)\n", ret);
*pi = 0;
return ret;
}
if (rrd.len == 0) {
LOGE("COM_get_af_pi fail, RDS log empty!\n");
*pi = 0;
return -1;
}
pi1 = rrd.data[4];
pi1 |= (rrd.data[5] << 8);
LOGI("data[4]=%02x,data[5]=%02x,pi1=%04x\n", rrd.data[4], rrd.data[5], pi1);
pi2 = rrd.data[16];
pi2 |= (rrd.data[17] << 8);
LOGI("data[16]=%02x,data[17]=%02x,pi2=%04x\n", rrd.data[16], rrd.data[17], pi2);
if (pi1 == pi2) {
LOGI("got af pi!!!\n");
*pi = pi1;
} else {
LOGE("af pi check fail\n");
*pi = 0;
return -1;
}
return 0;
}
int COM_active_af(int fd, RDSData_Struct *rds, CUST_cfg_ds *cfg_data, uint16_t orig_pi, uint16_t cur_freq, uint16_t *ret_freq)
{
int ret = 0;
int i = 0, j = 0;
struct fm_tune_parm parm;
struct fm_softmute_tune_t smt_parm;
uint16_t set_freq = 0, sw_freq = 0, org_freq = 0;
uint16_t PAMD_Value = 0, AF_PAMD_LBound = 0, AF_PAMD_HBound = 0;
uint16_t PAMD_Level[25];
uint16_t PI[25];
uint16_t PAMD_DB_TBL[5] = {// 5dB, 10dB, 15dB, 20dB, 25dB,
// 13, 17, 21, 25, 29};
8, 12, 15, 18, 20};
AF_Info af_list_backup;
AF_Info af_list;
FMR_ASSERT(rds);
FMR_ASSERT(cfg_data);
sw_freq = cur_freq; //current freq
org_freq = cur_freq;
parm.band = cfg_data->band;
parm.freq = sw_freq;
parm.hilo = FM_AUTO_HILO_OFF;
parm.space = FM_SPACE_DEFAULT;
if (!(rds->event_status & RDS_EVENT_AF)) {
LOGE("activeAF failed\n");
*ret_freq = 0;
ret = -ERR_RDS_NO_DATA;
return ret;
}
memset(&af_list_backup, 0, sizeof(af_list_backup));
memcpy(&af_list_backup, &rds->AF_Data, sizeof(AF_Info));
memset(&af_list, 0, sizeof(af_list));
AF_PAMD_LBound = PAMD_DB_TBL[0]; //5dB
AF_PAMD_HBound = PAMD_DB_TBL[1]; //15dB
ioctl(fd, FM_IOCTL_GETCURPAMD, &PAMD_Value);
for (i = 0; i < 3 && (PAMD_Value < AF_PAMD_LBound); i++) {
usleep(10 * 1000);
ioctl(fd, FM_IOCTL_GETCURPAMD, &PAMD_Value);
LOGI("check PAMD %d time(s), PAMD =%d", i+1, PAMD_Value);
}
LOGI("current_freq=%d, PAMD_Value=%d, orig_pi=%d\n", cur_freq, PAMD_Value, orig_pi);
/* Start to detect AF channels when orignal channel turn weak */
if (PAMD_Value < AF_PAMD_LBound) {
/* Make sure rds->AF_Data.AF_Num is valid */
af_list_backup.AF_Num = af_list_backup.AF_Num > 25 ? 25 : af_list_backup.AF_Num;
/* Precheck af list*/
for (i = 0, j = 0; i < af_list_backup.AF_Num; i++) {
set_freq = af_list_backup.AF[1][i];
if(set_freq < cfg_data->low_band || set_freq > cfg_data->high_band) {
/*band check fail*/
LOGI("AF[1][%d]:freq %d out of bandwidth[%d,%d], skip!\n",
i, af_list_backup.AF[1][i], cfg_data->low_band, cfg_data->high_band);
continue;
}
/* Using Com_Soft_Mute_Tune to query valid channel*/
memset(&smt_parm, 0, sizeof(fm_softmute_tune_t));
smt_parm.freq = set_freq;
COM_Soft_Mute_Tune(fd, &smt_parm);
LOGE("af list pre-check:freq %d, valid:%d\n", smt_parm.freq, smt_parm.valid);
if(smt_parm.valid == 1) {
/* Update valid AF channel to af_list*/
af_list.AF[1][j] = af_list_backup.AF[1][i];
j++;
af_list.AF_Num++;
}
}
/*AF switch process*/
for (i = 0; i < af_list.AF_Num; i++) {
set_freq = af_list.AF[1][i];
LOGI("set_freq[%d] = %d, org_freq = %d\n", i, set_freq, org_freq);
if (set_freq != org_freq) {
// Set mute to check every af channels
COM_set_mute(fd, 1);
parm.freq = set_freq;
ioctl(fd, FM_IOCTL_TUNE, &parm);
usleep(20 * 1000);
ioctl(fd, FM_IOCTL_GETCURPAMD, &PAMD_Level[i]);
/* If signal is not good enough, skip */
if (PAMD_Level[i] < AF_PAMD_HBound) {
LOGI("PAMD_Level[%d] =%d < AF_PAMD_HBound, continue", i, PAMD_Level[i]);
continue;
}
for (j = 0 ; j < 5; j++ ) {
usleep(200 * 1000);
/* Query pi to 5 times */
if (COM_get_af_pi(fd, &PI[i])) {
if (j == 4)
LOGE("get af pi fail\n");
continue;
} else
break;
}
if (orig_pi != PI[i]) {
LOGI("pi not match, current pi(%04x), orig pi(%04x)\n", PI[i], orig_pi);
continue;
}
LOGI("next_freq=%d, PAMD_Level[%d]=%d\n", parm.freq, i, PAMD_Level[i]);
/* To get largest PAMD */
/* This is a trade-off*/
/* If want to get a better quality AF channel, do as follows, it will spend longer to do AF switch*/
/* If want to mute shorter, just use one fixed PAMD_VALUE, don't need to compare */
if (PAMD_Level[i] > AF_PAMD_HBound) {
LOGI("PAMD_Level[%d] =%d > AF_PAMD_HBound, af switch", i, PAMD_Level[i]);
sw_freq = set_freq;
PAMD_Value = PAMD_Level[i];
break;
}
}
}
LOGI("AF deside tune to freq: %d, PAMD_Level: %d\n", sw_freq, PAMD_Value);
if ((PAMD_Value > AF_PAMD_HBound)&&(sw_freq != 0)) { /* Tune to AF channel */
parm.freq = sw_freq;
ioctl(fd, FM_IOCTL_TUNE, &parm);
cur_freq = parm.freq;
} else { /* Tune to orignal channel */
parm.freq = org_freq;
ioctl(fd, FM_IOCTL_TUNE, &parm);
cur_freq = parm.freq;
}
/* Unmute when finish AF switch */
COM_set_mute(fd, 0);
} else {
LOGD("RDS_EVENT_AF old freq:%d\n", org_freq);
}
*ret_freq = cur_freq;
return ret;
}
int COM_active_ta(int fd, RDSData_Struct *rds, int band, uint16_t cur_freq, uint16_t *backup_freq, uint16_t *ret_freq)
{
int ret = 0;
FMR_ASSERT(rds);
FMR_ASSERT(backup_freq);
FMR_ASSERT(ret_freq);
if(rds->event_status&RDS_EVENT_TAON){
uint16_t rds_on = 0;
struct fm_tune_parm parm;
uint16_t PAMD_Level[25];
uint16_t PAMD_DB_TBL[5] = {13, 17, 21, 25, 29};
uint16_t set_freq, sw_freq, org_freq, PAMD_Value, TA_PAMD_Threshold;
int i = 0;
rds_on = 0;
ioctl(fd, FM_IOCTL_RDS_ONOFF, &rds_on);
TA_PAMD_Threshold = PAMD_DB_TBL[2]; //15dB
sw_freq = cur_freq;
org_freq = cur_freq;
*backup_freq = org_freq;
parm.band = band;
parm.freq = sw_freq;
parm.hilo = FM_AUTO_HILO_OFF;
parm.space = COM_get_seek_space();
ioctl(fd, FM_IOCTL_GETCURPAMD, &PAMD_Value);
//make sure rds->AF_Data.AF_Num is valid
rds->AFON_Data.AF_Num = (rds->AFON_Data.AF_Num > 25)? 25 : rds->AFON_Data.AF_Num;
for(i=0; i< rds->AFON_Data.AF_Num; i++){
set_freq = rds->AFON_Data.AF[1][i];
LOGI("set_freq=0x%02x,org_freq=0x%02x\n", set_freq, org_freq);
if(set_freq != org_freq){
parm.freq = sw_freq;
ioctl(fd, FM_IOCTL_TUNE, &parm);
ioctl(fd, FM_IOCTL_GETCURPAMD, &PAMD_Level[i]);
if(PAMD_Level[i] > PAMD_Value){
PAMD_Value = PAMD_Level[i];
sw_freq = set_freq;
}
}
}
if((PAMD_Value > TA_PAMD_Threshold)&&(sw_freq != 0)){
rds->Switch_TP= 1;
parm.freq = sw_freq;
ioctl(fd, FM_IOCTL_TUNE, &parm);
cur_freq = parm.freq;
}else{
parm.freq = org_freq;
ioctl(fd, FM_IOCTL_TUNE, &parm);
cur_freq = parm.freq;
}
rds_on = 1;
ioctl(fd, FM_IOCTL_RDS_ONOFF, &rds_on);
}
*ret_freq = cur_freq;
return ret;
}
int COM_deactive_ta(int fd, RDSData_Struct *rds, int band, uint16_t cur_freq, uint16_t *backup_freq, uint16_t *ret_freq)
{
int ret = 0;
UNUSED(band);
FMR_ASSERT(rds);
FMR_ASSERT(backup_freq);
FMR_ASSERT(ret_freq);
if(rds->event_status&RDS_EVENT_TAON_OFF){
uint16_t rds_on = 0;
struct fm_tune_parm parm;
parm.band = FM_RAIDO_BAND;
parm.freq = *backup_freq;
parm.hilo = FM_AUTO_HILO_OFF;
parm.space = COM_get_seek_space();
ioctl(fd, FM_IOCTL_RDS_ONOFF, &rds_on);
ioctl(fd, FM_IOCTL_TUNE, &parm);
cur_freq = parm.freq;
rds_on = 1;
ioctl(fd, FM_IOCTL_RDS_ONOFF, &rds_on);
}
*ret_freq = cur_freq;
return ret;
}
int COM_ana_switch(int fd, int antenna)
{
int ret = 0;
ret = ioctl(fd, FM_IOCTL_ANA_SWITCH, &antenna);
if (ret < 0) {
LOGE("%s: fail, ret = %d\n", __func__, ret);
}
LOGD("%s: [ret = %d]\n", __func__, ret);
return ret;
}
int COM_get_badratio(int fd, int *badratio)
{
int ret = 0;
uint16_t tmp = 0;
ret = ioctl(fd, FM_IOCTL_GETBLERRATIO, &tmp);
*badratio = (int)tmp;
if (ret){
LOGE("%s, failed\n", __func__);
}
LOGD("%s, [fd=%d] [ret=%d]\n", __func__, fd, ret);
return ret;
}
int COM_get_stereomono(int fd, int *stemono)
{
int ret = 0;
uint16_t tmp = 0;
ret = ioctl(fd, FM_IOCTL_GETMONOSTERO, &tmp);
*stemono = (int)tmp;
if (ret){
LOGE("%s, failed\n", __func__);
}
LOGD("%s, [fd=%d] [ret=%d]\n", __func__, fd, ret);
return ret;
}
int COM_set_stereomono(int fd, int stemono)
{
int ret = 0;
ret = ioctl(fd, FM_IOCTL_SETMONOSTERO, &stemono);
if (ret){
LOGE("%s, failed\n", __func__);
}
LOGD("%s, [fd=%d] [ret=%d]\n", __func__, fd, ret);
return ret;
}
int COM_get_caparray(int fd, int *caparray)
{
int ret = 0;
int tmp = 0;
LOGD("%s, [fd=%d]\n", __func__, fd);
ret = ioctl(fd, FM_IOCTL_GETCAPARRAY, &tmp);
if (ret){
LOGE("%s, failed\n", __func__);
}
*caparray = tmp;
LOGD("%s, [fd=%d] [ret=%d]\n", __func__, fd, ret);
return ret;
}
int COM_get_hw_info(int fd, struct fm_hw_info *info)
{
int ret = 0;
ret = ioctl(fd, FM_IOCTL_GET_HW_INFO, info);
if(ret){
LOGE("%s, failed\n", __func__);
}
LOGD("%s, [fd=%d] [ret=%d]\n", __func__, fd, ret);
return ret;
}
/* COM_is_dese_chan -- check if gived channel is a de-sense channel or not
* @fd - fd of "dev/fm"
* @freq - gived channel
* return value: 0, not a dese chan; 1, a dese chan; else error NO.
*/
int COM_is_dese_chan(int fd, int freq)
{
int ret = 0;
int tmp = freq;
ret = ioctl(fd, FM_IOCTL_IS_DESE_CHAN, &freq);
if (ret < 0) {
LOGE("%s, failed,ret=%d\n", __func__,ret);
return ret;
} else {
LOGD("[fd=%d] %d --> dese=%d\n", fd, tmp, freq);
return freq;
}
}
/* COM_desense_check -- check if gived channel is a de-sense channel or not
* @fd - fd of "dev/fm"
* @freq - gived channel
* @rssi-freq's rssi
* return value: 0, is desense channel and rssi is less than threshold; 1, not desense channel or it is but rssi is more than threshold.
*/
int COM_desense_check(int fd, int freq, int rssi)
{
int ret = 0;
fm_desense_check_t parm;
parm.freq = freq;
parm.rssi = rssi;
ret = ioctl(fd, FM_IOCTL_DESENSE_CHECK, &parm);
if (ret < 0) {
LOGE("%s, failed,ret=%d\n", __func__,ret);
return ret;
} else {
LOGD("[fd=%d] %d --> dese=%d\n", fd,freq,ret);
return ret;
}
}
/*
th_idx:
threshold type: 0, RSSI. 1,desense RSSI. 2,SMG.
th_val: threshold value*/
int COM_set_search_threshold(int fd, int th_idx,int th_val)
{
int ret = 0;
fm_search_threshold_t th_parm;
th_parm.th_type = th_idx;
th_parm.th_val = th_val;
ret = ioctl(fd, FM_IOCTL_SET_SEARCH_THRESHOLD, &th_parm);
if (ret < 0)
{
LOGE("%s, failed,ret=%d\n", __func__,ret);
}
return ret;
}
int COM_full_cqi_logger(int fd, fm_full_cqi_log_t *log_parm)
{
int ret = 0;
ret = ioctl(fd, FM_IOCTL_FULL_CQI_LOG, log_parm);
if (ret < 0)
{
LOGE("%s, failed,ret=%d\n", __func__,ret);
}
return ret;
}
void FM_interface_init(struct fm_cbk_tbl *cbk_tbl)
{
//Basic functions.
cbk_tbl->open_dev = COM_open_dev;
cbk_tbl->close_dev = COM_close_dev;
cbk_tbl->pwr_up = COM_pwr_up;
cbk_tbl->pwr_down = COM_pwr_down;
cbk_tbl->tune = COM_tune;
cbk_tbl->set_mute = COM_set_mute;
cbk_tbl->is_rdsrx_support = COM_is_rdsrx_support;
cbk_tbl->turn_on_off_rds = COM_turn_on_off_rds;
cbk_tbl->get_chip_id = COM_get_chip_id;
//For RDS RX.
cbk_tbl->read_rds_data = COM_read_rds_data;
cbk_tbl->get_pi = COM_get_pi;
cbk_tbl->get_ps = COM_get_ps;
cbk_tbl->get_ecc = COM_get_ecc;
cbk_tbl->get_pty = COM_get_pty;
cbk_tbl->get_rssi = COM_get_rssi;
cbk_tbl->get_rt = COM_get_rt;
cbk_tbl->active_af = COM_active_af;
cbk_tbl->active_ta = COM_active_ta;
cbk_tbl->deactive_ta = COM_deactive_ta;
//FM short antenna
cbk_tbl->ana_switch = COM_ana_switch;
cbk_tbl->desense_check = COM_desense_check;
//RX EM mode use
cbk_tbl->get_badratio = COM_get_badratio;
cbk_tbl->get_stereomono = COM_get_stereomono;
cbk_tbl->set_stereomono = COM_set_stereomono;
cbk_tbl->get_caparray = COM_get_caparray;
cbk_tbl->get_cqi = COM_get_cqi;
cbk_tbl->is_dese_chan = COM_is_dese_chan;
cbk_tbl->desense_check = COM_desense_check;
cbk_tbl->get_hw_info = COM_get_hw_info;
//soft mute tune
cbk_tbl->soft_mute_tune = COM_Soft_Mute_Tune;
cbk_tbl->pre_search = COM_pre_search;
cbk_tbl->restore_search = COM_restore_search;
//EM
cbk_tbl->set_search_threshold = COM_set_search_threshold;
cbk_tbl->full_cqi_logger = COM_full_cqi_logger;
return;
}
Reference in a new issue View git blame Copy permalink