API update, stepsize update and RDS fix
Updated API. Added stepsize 10MHz (FM) / 1MHz (AM) Make RDS more sensitive.
This commit is contained in:
+305
-132
@@ -40,27 +40,16 @@ const char* const PTY[]
|
||||
void TEF6686::init(byte TEF) {
|
||||
uint8_t bootstatus;
|
||||
Tuner_I2C_Init();
|
||||
getBootStatus(bootstatus);
|
||||
devTEF_APPL_Get_Operation_Status(&bootstatus);
|
||||
if (bootstatus == 0) {
|
||||
Tuner_Patch(TEF);
|
||||
delay(50);
|
||||
if (digitalRead(15) == LOW) {
|
||||
Tuner_Init9216();
|
||||
} else {
|
||||
Tuner_Init4000();
|
||||
}
|
||||
if (digitalRead(15) == LOW) Tuner_Init9216(); else Tuner_Init4000();
|
||||
power(1);
|
||||
Tuner_Init();
|
||||
}
|
||||
}
|
||||
|
||||
void TEF6686::power(uint8_t mode) {
|
||||
devTEF_APPL_Set_OperationMode(mode);
|
||||
if (mode == 0) {
|
||||
devTEF_Set_Cmd(TEF_FM, Cmd_Tune_To, 7, 1, 10000);
|
||||
}
|
||||
}
|
||||
|
||||
bool TEF6686::getIdentification(uint16_t &device, uint16_t &hw_version, uint16_t &sw_version) {
|
||||
bool result = devTEF_Radio_Get_Identification(&device, &hw_version, &sw_version);
|
||||
return device;
|
||||
@@ -68,70 +57,75 @@ bool TEF6686::getIdentification(uint16_t &device, uint16_t &hw_version, uint16_t
|
||||
return sw_version;
|
||||
}
|
||||
|
||||
void TEF6686::setFrequency(uint16_t frequency, uint16_t LowEdge, uint16_t HighEdge, bool fullsearchrds) {
|
||||
Radio_SetFreq(frequency, LowEdge, HighEdge, fullsearchrds);
|
||||
void TEF6686::power(bool mode) {
|
||||
devTEF_APPL_Set_OperationMode(mode);
|
||||
if (mode == 0) devTEF_Set_Cmd(TEF_FM, Cmd_Tune_To, 7, 1, 10000);
|
||||
}
|
||||
|
||||
void TEF6686::setFrequency_AM(uint16_t frequency) {
|
||||
Radio_SetFreq_AM(frequency);
|
||||
void TEF6686::SetFreq(uint16_t frequency) {
|
||||
devTEF_Radio_Tune_To(frequency);
|
||||
}
|
||||
|
||||
uint16_t TEF6686::getFrequency() {
|
||||
return Radio_GetCurrentFreq();
|
||||
void TEF6686::SetFreqAM(uint16_t frequency) {
|
||||
devTEF_Radio_Tune_AM (frequency);
|
||||
}
|
||||
|
||||
uint16_t TEF6686::getFrequency_AM() {
|
||||
return Radio_GetCurrentFreq_AM();
|
||||
}
|
||||
|
||||
void TEF6686::setOffset(int16_t offset) {
|
||||
void TEF6686::setOffset(int8_t offset) {
|
||||
devTEF_Radio_Set_LevelOffset(offset * 10);
|
||||
}
|
||||
|
||||
void TEF6686::setFMBandw(uint16_t bandwidth) {
|
||||
devTEF_Radio_Set_Bandwidth(0, bandwidth * 10, 1000, 1000);
|
||||
}
|
||||
|
||||
void TEF6686::setAMBandw(uint16_t bandwidth) {
|
||||
devTEF_Radio_Set_BandwidthAM(0, bandwidth * 10, 1000, 1000);
|
||||
}
|
||||
|
||||
void TEF6686::setAMCoChannel(uint16_t start) {
|
||||
devTEF_Radio_Set_CoChannel_AM(start * 10);
|
||||
}
|
||||
|
||||
void TEF6686::setSoftmuteAM(uint8_t mode) {
|
||||
devTEF_Radio_Set_Softmute_Max_AM(mode);
|
||||
}
|
||||
|
||||
void TEF6686::setSoftmuteFM(uint8_t mode) {
|
||||
devTEF_Radio_Set_Softmute_Max_FM(mode);
|
||||
}
|
||||
|
||||
void TEF6686::setAMNoiseBlanker(uint16_t start) {
|
||||
if (start == 0) devTEF_Radio_Set_Noiseblanker_AM(0, 1000); else devTEF_Radio_Set_Noiseblanker_AM(1, (start * 10) + 500);
|
||||
}
|
||||
|
||||
void TEF6686::setAMAttenuation(uint16_t start) {
|
||||
devTEF_Radio_Set_Attenuator_AM(start * 10);
|
||||
}
|
||||
|
||||
void TEF6686::setFMABandw() {
|
||||
devTEF_Radio_Set_Bandwidth(1, 3110, 1000, 1000);
|
||||
}
|
||||
|
||||
void TEF6686::setAMBandw(uint16_t bandwidth) {
|
||||
devTEF_Radio_Set_Bandwidth_AM(0, bandwidth * 10, 1000, 1000);
|
||||
}
|
||||
|
||||
void TEF6686::setiMS(uint16_t mph) {
|
||||
void TEF6686::setiMS(bool mph) {
|
||||
devTEF_Radio_Set_MphSuppression(mph);
|
||||
}
|
||||
|
||||
void TEF6686::setEQ(uint16_t eq) {
|
||||
void TEF6686::setEQ(bool eq) {
|
||||
devTEF_Radio_Set_ChannelEqualizer(eq);
|
||||
}
|
||||
|
||||
bool TEF6686::getStereoStatus() {
|
||||
return Radio_CheckStereo();
|
||||
uint16_t status;
|
||||
bool stereo = 0;
|
||||
if (1 == devTEF_Radio_Get_Stereo_Status(&status)) stereo = ((status >> 15) & 1) ? 1 : 0;
|
||||
return stereo;
|
||||
}
|
||||
|
||||
void TEF6686::setMono(uint8_t mono) {
|
||||
void TEF6686::setMono(bool mono) {
|
||||
devTEF_Radio_Set_Stereo_Min(mono);
|
||||
}
|
||||
|
||||
uint16_t TEF6686::tuneUp(uint8_t stepsize, uint16_t LowEdge, uint16_t HighEdge, bool fullsearchrds) {
|
||||
return tune(1, stepsize, LowEdge, HighEdge, fullsearchrds);
|
||||
}
|
||||
|
||||
uint16_t TEF6686::tuneDown(uint8_t stepsize, uint16_t LowEdge, uint16_t HighEdge, bool fullsearchrds) {
|
||||
return tune(0, stepsize, LowEdge, HighEdge, fullsearchrds);
|
||||
}
|
||||
|
||||
uint16_t TEF6686::tuneUp_AM(uint8_t stepsize) {
|
||||
return tune_AM(1, stepsize);
|
||||
}
|
||||
|
||||
uint16_t TEF6686::tuneDown_AM(uint8_t stepsize) {
|
||||
return tune_AM(0, stepsize);
|
||||
}
|
||||
|
||||
void TEF6686::setVolume(int16_t volume) {
|
||||
void TEF6686::setVolume(int8_t volume) {
|
||||
devTEF_Audio_Set_Volume(volume);
|
||||
}
|
||||
|
||||
@@ -143,34 +137,47 @@ void TEF6686::setUnMute() {
|
||||
devTEF_Audio_Set_Mute(0);
|
||||
}
|
||||
|
||||
void TEF6686::setAGC(uint8_t start) {
|
||||
if (start == 0) {
|
||||
devTEF_Radio_Set_RFAGC(920);
|
||||
}
|
||||
if (start == 1) {
|
||||
devTEF_Radio_Set_RFAGC(900);
|
||||
}
|
||||
if (start == 2) {
|
||||
devTEF_Radio_Set_RFAGC(870);
|
||||
}
|
||||
if (start == 3) {
|
||||
devTEF_Radio_Set_RFAGC(840);
|
||||
}
|
||||
void TEF6686::setAGC(uint8_t agc) {
|
||||
if (agc == 0) devTEF_Radio_Set_RFAGC(920);
|
||||
if (agc == 1) devTEF_Radio_Set_RFAGC(900);
|
||||
if (agc == 2) devTEF_Radio_Set_RFAGC(870);
|
||||
if (agc == 3) devTEF_Radio_Set_RFAGC(840);
|
||||
}
|
||||
|
||||
void TEF6686::setDeemphasis(uint8_t timeconstant) {
|
||||
if (timeconstant == 0) {
|
||||
devTEF_Radio_Set_Deemphasis(500);
|
||||
}
|
||||
if (timeconstant == 1) {
|
||||
devTEF_Radio_Set_Deemphasis(750);
|
||||
}
|
||||
if (timeconstant == 2) {
|
||||
devTEF_Radio_Set_Deemphasis(0);
|
||||
}
|
||||
if (timeconstant == 1) devTEF_Radio_Set_Deemphasis(500);
|
||||
if (timeconstant == 2) devTEF_Radio_Set_Deemphasis(750);
|
||||
if (timeconstant == 3) devTEF_Radio_Set_Deemphasis(0);
|
||||
}
|
||||
|
||||
void TEF6686::setStereoLevel(uint16_t start) {
|
||||
void TEF6686::setAudio(uint8_t audio) {
|
||||
if (audio == 1) devTEF_Radio_Specials(0);
|
||||
if (audio == 2) devTEF_Radio_Specials(1);
|
||||
}
|
||||
|
||||
void TEF6686::setFMSI(uint8_t mode) {
|
||||
if (mode == 1) devTEF_APPL_Set_StereoImprovement(0);
|
||||
if (mode == 2) devTEF_APPL_Set_StereoImprovement(1);
|
||||
}
|
||||
|
||||
void TEF6686::setFMSI_Time(uint16_t attack, uint16_t decay) {
|
||||
devTEF_APPL_Set_StereoBandBlend_Time(attack, decay);
|
||||
}
|
||||
|
||||
void TEF6686::setFMSI_Gain(uint16_t band1, uint16_t band2, uint16_t band3, uint16_t band4) {
|
||||
devTEF_APPL_Set_StereoBandBlend_Gain(band1 * 10, band2 * 10, band3 * 10, band4 * 10);
|
||||
}
|
||||
|
||||
void TEF6686::setFMSI_Bias(int16_t band1, int16_t band2, int16_t band3, int16_t band4) {
|
||||
devTEF_APPL_Set_StereoBandBlend_Bias(band1 - 250, band2 - 250, band3 - 250, band4 - 250);
|
||||
}
|
||||
|
||||
|
||||
void TEF6686::setNoiseBlanker(uint16_t start) {
|
||||
if (start == 0) devTEF_Radio_Set_NoisBlanker(0, 1000); else devTEF_Radio_Set_NoisBlanker(1, (start * 10) + 500);
|
||||
}
|
||||
|
||||
void TEF6686::setStereoLevel(uint8_t start) {
|
||||
if (start == 0) {
|
||||
devTEF_Radio_Set_Stereo_Level(0, start * 10, 60);
|
||||
devTEF_Radio_Set_Stereo_Noise(0, 240, 200);
|
||||
@@ -182,7 +189,7 @@ void TEF6686::setStereoLevel(uint16_t start) {
|
||||
}
|
||||
}
|
||||
|
||||
void TEF6686::setHighCutOffset(uint16_t start) {
|
||||
void TEF6686::setHighCutOffset(uint8_t start) {
|
||||
if (start == 0) {
|
||||
devTEF_Radio_Set_Highcut_Level(0, start * 10, 300);
|
||||
devTEF_Radio_Set_Highcut_Noise(0, 360, 300);
|
||||
@@ -198,13 +205,35 @@ void TEF6686::setHighCutLevel(uint16_t limit) {
|
||||
devTEF_Radio_Set_Highcut_Max(1, limit * 100);
|
||||
}
|
||||
|
||||
bool TEF6686::getBootStatus(uint8_t &bootstatus) {
|
||||
uint8_t result = devTEF_APPL_Get_Operation_Status(&bootstatus);
|
||||
return bootstatus;
|
||||
void TEF6686::setStHiBlendLevel(uint16_t limit) {
|
||||
devTEF_Radio_Set_StHiBlend_Max(1, limit * 100);
|
||||
}
|
||||
|
||||
void TEF6686::setStHiBlendOffset(uint8_t start) {
|
||||
if (start == 0) {
|
||||
devTEF_Radio_Set_StHiBlend_Level(0, start * 10, 300);
|
||||
devTEF_Radio_Set_StHiBlend_Noise(0, 360, 300);
|
||||
devTEF_Radio_Set_StHiBlend_Mph(0, 360, 300);
|
||||
} else {
|
||||
devTEF_Radio_Set_StHiBlend_Level(3, start * 10, 300);
|
||||
devTEF_Radio_Set_StHiBlend_Noise(3, 360, 300);
|
||||
devTEF_Radio_Set_StHiBlend_Mph(3, 360, 300);
|
||||
}
|
||||
}
|
||||
|
||||
bool TEF6686::getProcessing(uint16_t &highcut, uint16_t &stereo, uint16_t &sthiblend, uint8_t &stband_1, uint8_t &stband_2, uint8_t &stband_3, uint8_t &stband_4) {
|
||||
bool result = devTEF_Radio_Get_Processing_Status(&highcut, &stereo, &sthiblend, &stband_1, &stband_2, &stband_3, &stband_4);
|
||||
return highcut;
|
||||
return stereo;
|
||||
return sthiblend;
|
||||
return stband_1;
|
||||
return stband_2;
|
||||
return stband_3;
|
||||
return stband_4;
|
||||
}
|
||||
|
||||
bool TEF6686::getStatus(int16_t &level, uint16_t &USN, uint16_t &WAM, int16_t &offset, uint16_t &bandwidth, uint16_t &modulation) {
|
||||
uint8_t result = devTEF_Radio_Get_Quality_Status(&level, &USN, &WAM, &offset, &bandwidth, &modulation);
|
||||
bool result = devTEF_Radio_Get_Quality_Status(&level, &USN, &WAM, &offset, &bandwidth, &modulation);
|
||||
return level;
|
||||
return USN;
|
||||
return WAM;
|
||||
@@ -212,35 +241,38 @@ bool TEF6686::getStatus(int16_t &level, uint16_t &USN, uint16_t &WAM, int16_t &o
|
||||
return modulation;
|
||||
}
|
||||
|
||||
bool TEF6686::getStatus_AM(int16_t &level, uint16_t &USN, uint16_t &WAM, int16_t &offset, uint16_t &bandwidth, uint16_t &modulation) {
|
||||
uint8_t result = devTEF_Radio_Get_Quality_Status_AM(&level, &USN, &WAM, &offset, &bandwidth, &modulation);
|
||||
bool TEF6686::getStatusAM(int16_t &level, uint16_t &noise, uint16_t &cochannel, int16_t &offset, uint16_t &bandwidth, uint16_t &modulation) {
|
||||
bool result = devTEF_Radio_Get_Quality_Status_AM(&level, &noise, &cochannel, &offset, &bandwidth, &modulation);
|
||||
return level;
|
||||
return USN;
|
||||
return WAM;
|
||||
return noise;
|
||||
return cochannel;
|
||||
return bandwidth;
|
||||
return modulation;
|
||||
}
|
||||
|
||||
bool TEF6686::readRDS()
|
||||
{
|
||||
char status;
|
||||
uint16_t rdsStat = 0, rdsErr = 65535, rdsErrA = 65535, rdsErrB = 65535, rdsErrC = 65535, rdsErrD = 65535;
|
||||
uint16_t result = devTEF_Radio_Get_RDS_Data(&rdsStat, &rds.rdsA, &rds.rdsB, &rds.rdsC, &rds.rdsD, &rdsErr);
|
||||
uint8_t rds_group;
|
||||
uint8_t offset;
|
||||
bool rdsErrCheck = false, rdsDataReady = false;
|
||||
char status;
|
||||
uint16_t rdsStat = 0, rdsErr = 65535, rdsErrA = 65535, rdsErrB = 65535, rdsErrC = 65535, rdsErrD = 65535;
|
||||
uint16_t result = devTEF_Radio_Get_RDS_Data(&rdsStat, &rds.rdsA, &rds.rdsB, &rds.rdsC, &rds.rdsD, &rdsErr);
|
||||
uint8_t rds_group;
|
||||
uint8_t offset;
|
||||
bool rdsErrCheck = false, rdsDataReady = false;
|
||||
|
||||
rdsErrA = ((rdsErr >> 14) & 0x02);
|
||||
rdsErrB = ((rdsErr >> 12) & 0x02);
|
||||
rdsErrC = ((rdsErr >> 10) & 0x02);
|
||||
rdsErrD = ((rdsErr >> 8) & 0x02);
|
||||
|
||||
rdsTimeOut += rdsErr == 0 && rds.rdsA != 0 ? -rdsTimeOut : rdsTimeOut < 32768 ? 1 : 0;
|
||||
rds.hasRDS = rdsTimeOut < 32768 ? true : false;
|
||||
|
||||
rdsErrCheck = rdsErr == 0;
|
||||
rdsDataReady = ((rdsStat & (1 << 15)) && (rdsStat & (1 << 9)));
|
||||
rdsDataReady = ((rdsStat & (1 << 15)) && (rdsStat & (1 << 9)));
|
||||
rds.errors = rdsErr;
|
||||
if (rdsDataReady && rdsErrCheck)
|
||||
if (rdsDataReady)
|
||||
{
|
||||
//RDS PI
|
||||
//PI
|
||||
if (rds.stationID == 0) rds.stationID = rds.rdsA;
|
||||
char Hex[16] = { '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', 'A', 'B', 'C', 'D', 'E', 'F'};
|
||||
rds.picode[0] = Hex[(rds.rdsA & 0xF000U) >> 12];
|
||||
@@ -249,42 +281,79 @@ bool TEF6686::readRDS()
|
||||
rds.picode[3] = Hex[(rds.rdsA & 0x000FU)];
|
||||
rds.picode[4] = '\0';
|
||||
rds_group = (rds.rdsB >> 11);
|
||||
|
||||
if (rdsErrCheck) rds.correct = true; else rds.correct = false;
|
||||
|
||||
switch (rds_group)
|
||||
{
|
||||
case RDS_GROUP_0A:
|
||||
case RDS_GROUP_0B:
|
||||
{
|
||||
//RDS PS
|
||||
//RDS Programm-Service
|
||||
offset = rds.rdsB & 0x03;
|
||||
if ((offset == 0) && (ps_process == 0)) ps_process = 1;
|
||||
|
||||
if ((offset == 0) && (ps_process == 0))ps_process = 1;
|
||||
|
||||
if (ps_process == 1)
|
||||
{
|
||||
if (ps_process == 1) {
|
||||
ps_buffer[(offset * 2) + 0] = ascii_converter(rds.rdsD >> 8);
|
||||
ps_buffer[(offset * 2) + 1] = ascii_converter(rds.rdsD & 0xFF);
|
||||
ps_buffer[(offset * 2) + 2] = 0;
|
||||
ps_process = strlen(ps_buffer) == 8 ? 2 : 1;
|
||||
}
|
||||
|
||||
if (ps_process == 2)
|
||||
{
|
||||
if (ps_process == 2) {
|
||||
strcpy(rds.stationName, ps_buffer);
|
||||
for (int i = 0; i < 9; i++)
|
||||
ps_buffer[i] = '\0';
|
||||
for (int i = 0; i < 9; i++) ps_buffer[i] = '\0';
|
||||
ps_process = 0;
|
||||
rds.hasPS = true;
|
||||
}
|
||||
|
||||
//RDS PTY Code
|
||||
//PTY
|
||||
rds.stationTypeCode = (rds.rdsB >> 5) & 0x1F;
|
||||
rds.hasPTY = true;
|
||||
strcpy(rds.stationType, PTY[rds.stationTypeCode]);
|
||||
|
||||
//TP-TA-EON-MS
|
||||
if ((bitRead(rds.rdsB, 4)) == 1 && ((bitRead(rds.rdsB, 10)) == 0)) rds.hasEON = true; else rds.hasEON = false;
|
||||
if ((bitRead(rds.rdsB, 4)) == 0 && ((bitRead(rds.rdsB, 10)) == 1)) rds.hasTP = true; else rds.hasTP = false;
|
||||
rds.hasTA = (bitRead(rds.rdsB, 4)) && (bitRead(rds.rdsB, 10)) & 0x1F;
|
||||
rds.MS = (bitRead(rds.rdsB, 3)) & 0x1F;
|
||||
|
||||
//AF
|
||||
uint8_t af_controlCode = rds.rdsC >> 8;
|
||||
if ((af_controlCode < 224) && (af_counter < 50))
|
||||
{
|
||||
uint16_t buffer0 = (rds.rdsC >> 8);
|
||||
uint16_t buffer1 = (rds.rdsC & 0xFF);
|
||||
rds.hasAF = true;
|
||||
if (buffer0 != 0 && buffer1 != 0)
|
||||
{
|
||||
buffer0 = buffer0 * 10 + 8750;
|
||||
buffer1 = buffer1 * 10 + 8750;
|
||||
bool isDouble = false;
|
||||
isDouble = checkDouble(buffer0);
|
||||
if (!isDouble && buffer0 != 0) {
|
||||
af[af_counter].frequency = buffer0;
|
||||
af_counter++;
|
||||
}
|
||||
|
||||
isDouble = checkDouble(buffer1);
|
||||
if (!isDouble && buffer1 != 0) {
|
||||
af[af_counter].frequency = buffer1;
|
||||
af_counter++;
|
||||
}
|
||||
}
|
||||
}
|
||||
} break;
|
||||
|
||||
case RDS_GROUP_1A:
|
||||
if (rds.rdsC < 255) rds.ECC = rds.rdsC;
|
||||
break;
|
||||
|
||||
case RDS_GROUP_2A:
|
||||
case RDS_GROUP_2B:
|
||||
{
|
||||
//RDS RT Code
|
||||
boolean limit_reached = false;
|
||||
rds.hasRT = true;
|
||||
offset = (rds.rdsB & 0xf) * 4;
|
||||
rds.rtAB = (bitRead(rds.rdsB, 4));
|
||||
limit_reached = (offset == 60 || (rds.rdsC >> 8) == '\r' || (rds.rdsC & 0xFF) == '\r' || (rds.rdsD >> 8) == '\r' || (rds.rdsD & 0xFF) == '\r') ? true : false;
|
||||
@@ -292,17 +361,14 @@ bool TEF6686::readRDS()
|
||||
|
||||
if (rds.rtAB != ABold) {
|
||||
offsetold = 0;
|
||||
for (int i = 0; i < 65; i++) {
|
||||
rds.stationText[i] = 0;
|
||||
}
|
||||
if (rt_timer == 64) {
|
||||
strcpy(rds.stationText, stationTextBuffer);
|
||||
}
|
||||
for (int i = 0; i < 65; i++) rds.stationText[i] = 0;
|
||||
if (rt_timer == 64) strcpy(rds.stationText, stationTextBuffer);
|
||||
|
||||
for (int i = 0; i < 65; i++) {
|
||||
rt_buffer[i] = 0;
|
||||
stationTextBuffer[i] = 0;
|
||||
}
|
||||
rt_process = 0;
|
||||
if (rds.hasRDSplus == false) rt_process = 0;
|
||||
}
|
||||
ABold = rds.rtAB;
|
||||
|
||||
@@ -320,9 +386,8 @@ bool TEF6686::readRDS()
|
||||
rt_buffer[offset + 2] = ascii_converter(rds.rdsD >> 8);
|
||||
rt_buffer[offset + 3] = ascii_converter(rds.rdsD & 0xff);
|
||||
|
||||
if (offset > offsetold) {
|
||||
offsetold = offset;
|
||||
}
|
||||
if (offset > offsetold) offsetold = offset;
|
||||
|
||||
if (offset == offsetold) {
|
||||
strcpy(stationTextBuffer, rt_buffer);
|
||||
if (rt_timer < 64) {
|
||||
@@ -339,6 +404,7 @@ bool TEF6686::readRDS()
|
||||
{
|
||||
for (int i = 0; i < 64; i++)
|
||||
{
|
||||
rt_buffer2[i] = rt_buffer[i];
|
||||
rt_buffer[i] = 0;
|
||||
}
|
||||
}
|
||||
@@ -347,7 +413,26 @@ bool TEF6686::readRDS()
|
||||
case RDS_GROUP_4A:
|
||||
case RDS_GROUP_4B:
|
||||
{
|
||||
//RDS CT
|
||||
uint32_t mjd;
|
||||
rds.hasCT = true;
|
||||
mjd = (rds.rdsB & 0x03);
|
||||
mjd <<= 15;
|
||||
mjd += ((rds.rdsC >> 1) & 0x7FFF);
|
||||
|
||||
long J, C, Y, M;
|
||||
uint8_t LocalOffset;
|
||||
J = mjd + 2400001 + 68569;
|
||||
C = 4 * J / 146097;
|
||||
J = J - (146097 * C + 3) / 4;
|
||||
Y = 4000 * (J + 1) / 1461001;
|
||||
J = J - 1461 * Y / 4 + 31;
|
||||
M = 80 * (J + 0) / 2447;
|
||||
|
||||
rds.days = J - 2447 * M / 80;
|
||||
J = M / 11;
|
||||
|
||||
rds.months = M + 2 - (12 * J);
|
||||
rds.years = 100 * (C - 49) + Y + J;
|
||||
rds.hours = ((rds.rdsD >> 12) & 0x0f);
|
||||
rds.hours += ((rds.rdsC << 4) & 0x0010);
|
||||
rds.minutes = ((rds.rdsD >> 6) & 0x3f);
|
||||
@@ -355,6 +440,77 @@ bool TEF6686::readRDS()
|
||||
rds.offset = (rds.rdsD & 0x3f);
|
||||
rds.hasCT = true;
|
||||
} break;
|
||||
|
||||
case RDS_GROUP_10A:
|
||||
case RDS_GROUP_10B:
|
||||
case RDS_GROUP_11A:
|
||||
case RDS_GROUP_11B:
|
||||
case RDS_GROUP_12A:
|
||||
case RDS_GROUP_12B:
|
||||
{
|
||||
if (useRTPlus)
|
||||
{
|
||||
uint16_t content_byte_1 = (rds.rdsB & 0x07);
|
||||
content_byte_1 = (content_byte_1 << 0x03);
|
||||
content_byte_1 += (rds.rdsC >> 0x0D);
|
||||
uint16_t content_byte_2 = (rds.rdsC & 0x01);
|
||||
content_byte_2 = (content_byte_2 << 0x05);
|
||||
content_byte_2 += (rds.rdsD >> 0x0B);
|
||||
uint16_t start_marker_1 = (rds.rdsC >> 0x07);
|
||||
start_marker_1 = (start_marker_1 & 0x3F);
|
||||
uint16_t length_marker_1 = (rds.rdsC >> 0x01);
|
||||
length_marker_1 = (length_marker_1 & 0x3F);
|
||||
uint16_t start_marker_2 = (rds.rdsD >> 0x05);
|
||||
start_marker_2 = (start_marker_2 & 0x3F);
|
||||
uint16_t length_marker_2 = (rds.rdsD & 0x1F);
|
||||
rds.hasRDSplus = true;
|
||||
|
||||
if (rt_process == 2)
|
||||
{
|
||||
if (content_byte_1 == 0x04) { //ArtistID
|
||||
rds.hasMusicArtist = true;
|
||||
for (int i = 0; i <= length_marker_1; i++)rds.musicArtist[i] = rt_buffer2[i + start_marker_1];
|
||||
rds.musicArtist[length_marker_1 + 1] = 0;
|
||||
}
|
||||
else if (content_byte_1 == 0x01) {//TitleID
|
||||
rds.hasMusicTitle = true;
|
||||
for (int i = 0; i <= length_marker_1; i++)rds.musicTitle[i] = rt_buffer2[i + start_marker_1];
|
||||
rds.musicTitle[length_marker_1 + 1] = 0;
|
||||
}
|
||||
if (content_byte_2 == 0x04) {//ArtistID
|
||||
rds.hasMusicArtist = true;
|
||||
for (int i = 0; i <= length_marker_2; i++)rds.musicArtist[i] = rt_buffer2[i + start_marker_2];
|
||||
rds.musicArtist[length_marker_2 + 1] = 0;
|
||||
}
|
||||
else if (content_byte_2 == 0x01) {//TitleID
|
||||
rds.hasMusicTitle = true;
|
||||
for (int i = 0; i <= length_marker_2; i++)rds.musicTitle[i] = rt_buffer2[i + start_marker_2];
|
||||
rds.musicTitle[length_marker_2 + 1] = 0;
|
||||
}
|
||||
if (content_byte_1 == 0x24) {//HostID
|
||||
rds.hasStationHost = true;
|
||||
for (int i = 0; i <= length_marker_1; i++)rds.stationHost[i] = rt_buffer2[i + start_marker_1];
|
||||
rds.stationHost[length_marker_1 + 1] = 0;
|
||||
}
|
||||
else if (content_byte_2 == 0x24) {
|
||||
rds.hasStationHost = true;
|
||||
for (int i = 0; i <= length_marker_2; i++)rds.stationHost[i] = rt_buffer2[i + start_marker_2];
|
||||
rds.stationHost[length_marker_2 + 1] = 0;
|
||||
}
|
||||
if (content_byte_1 == 0x21) {//EventID
|
||||
rds.hasStationEvent = true;
|
||||
for (int i = 0; i <= length_marker_1; i++)rds.stationEvent[i] = rt_buffer2[i + start_marker_1];
|
||||
rds.stationEvent[length_marker_1 + 1] = 0;
|
||||
}
|
||||
else if (content_byte_2 == 0x21) {
|
||||
rds.hasStationEvent = true;
|
||||
for (int i = 0; i <= length_marker_2; i++)rds.stationEvent[i] = rt_buffer2[i + start_marker_2];
|
||||
rds.stationEvent[length_marker_2 + 1] = 0;
|
||||
}
|
||||
rt_process = 0;
|
||||
}
|
||||
}
|
||||
} break;
|
||||
}
|
||||
}
|
||||
return rdsDataReady;
|
||||
@@ -377,6 +533,12 @@ uint8_t TEF6686::ascii_converter (uint8_t src)
|
||||
return (dest);
|
||||
}
|
||||
|
||||
bool TEF6686::checkDouble (uint16_t value)
|
||||
{
|
||||
for (int i = 0; i < 50; i++) if (af[i].frequency == value)return (true);
|
||||
return (false);
|
||||
}
|
||||
|
||||
void TEF6686::clearRDS (bool fullsearchrds)
|
||||
{
|
||||
devTEF_Radio_Set_RDS(fullsearchrds);
|
||||
@@ -389,44 +551,55 @@ void TEF6686::clearRDS (bool fullsearchrds)
|
||||
rds.stationText[i] = 0;
|
||||
stationTextBuffer[i] = 0;
|
||||
rt_buffer[i] = 0;
|
||||
rt_buffer2[i] = 0;
|
||||
}
|
||||
for (i = 0; i < 17; i++) {
|
||||
rds.stationType[i] = 0;
|
||||
}
|
||||
|
||||
for (i = 0; i < 5; i++) {
|
||||
rds.picode[i] = 0;
|
||||
for (i = 0; i < 32; i++) {
|
||||
rds.musicArtist[i] = 0;
|
||||
rds.musicTitle[i] = 0;
|
||||
rds.stationEvent[i] = 0;
|
||||
rds.stationHost[i] = 0;
|
||||
}
|
||||
for (i = 0; i < 5; i++) rds.picode[i] = 0;
|
||||
|
||||
for (i = 0; i < 50; i++) af[i].frequency = 0;
|
||||
|
||||
rds.stationType[i] = '\0';
|
||||
rds.stationID = 0;
|
||||
rds.ECC = 0;
|
||||
offsetold = 0;
|
||||
rds.stationTypeCode = 32;
|
||||
rdsTimeOut = 32768;
|
||||
rds.hasRDSplus = false;
|
||||
rds.afclear = false;
|
||||
rds.hasRT = false;
|
||||
rds.hasRDS = false;
|
||||
rds.hasPS = false;
|
||||
rds.hasTP = false;
|
||||
rds.hasTA = false;
|
||||
rds.hasEON = false;
|
||||
rds.MS = false;
|
||||
rds.hasPTY = false;
|
||||
rds.hasCT = false;
|
||||
rds.hasMusicTitle = false;
|
||||
rds.hasMusicArtist = false;
|
||||
rds.hasStationEvent = false;
|
||||
rds.hasStationHost = false;
|
||||
rds.stationTextOffset = 0;
|
||||
rds.errors = 0;
|
||||
rds.correct = 0;
|
||||
rt_process = 0;
|
||||
ps_process = 1;
|
||||
af_counter = 0;
|
||||
rt_timer = 0;
|
||||
rds.errors = 0;
|
||||
}
|
||||
|
||||
uint16_t TEF6686::tune(uint8_t up, uint8_t stepsize, uint16_t LowEdge, uint16_t HighEdge, bool fullsearchrds) {
|
||||
Radio_ChangeFreqOneStep(up, stepsize, LowEdge, HighEdge, fullsearchrds);
|
||||
Radio_SetFreq(Radio_GetCurrentFreq(), LowEdge, HighEdge, fullsearchrds);
|
||||
|
||||
return Radio_GetCurrentFreq();
|
||||
}
|
||||
|
||||
uint16_t TEF6686::tune_AM(uint8_t up, uint8_t stepsize) {
|
||||
Radio_ChangeFreqOneStep_AM(up, stepsize);
|
||||
Radio_SetFreq_AM(Radio_GetCurrentFreq_AM());
|
||||
return Radio_GetCurrentFreq_AM();
|
||||
}
|
||||
|
||||
void TEF6686::tone(uint16_t time, int16_t amplitude, uint16_t frequency) {
|
||||
devTEF_Audio_Set_Mute(0);
|
||||
devTEF_Radio_Set_Wavegen(1, amplitude, frequency);
|
||||
delay (time);
|
||||
devTEF_Radio_Set_Wavegen(0, 0, 0);
|
||||
devTEF_Audio_Set_Mute(0);
|
||||
devTEF_Radio_Set_Wavegen(1, amplitude, frequency);
|
||||
delay (time);
|
||||
devTEF_Radio_Set_Wavegen(0, 0, 0);
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user