internal changes, remove useless things
This commit is contained in:
+16
-32
@@ -10,14 +10,14 @@ void devTEF_Set_Cmd(TEF_MODULE module, uint8_t cmd, uint16_t len, ...) {
|
||||
buf[1] = cmd;
|
||||
buf[2] = 1;
|
||||
|
||||
for (i = 3; i < len; i++) {
|
||||
for (i = 0; i < len; i++) {
|
||||
temp = va_arg(vArgs, int);
|
||||
buf[i++] = High_16bto8b(temp);
|
||||
buf[i] = Low_16bto8b(temp);
|
||||
buf[3 + i++] = High_16bto8b(temp);
|
||||
buf[3 + i] = Low_16bto8b(temp);
|
||||
}
|
||||
|
||||
va_end(vArgs);
|
||||
Tuner_WriteBuffer(buf, len);
|
||||
Tuner_WriteBuffer(buf, len + 3);
|
||||
}
|
||||
|
||||
bool devTEF_Get_Cmd(TEF_MODULE module, uint8_t cmd, uint8_t *receive, uint16_t len) {
|
||||
@@ -32,25 +32,10 @@ bool devTEF_Get_Cmd(TEF_MODULE module, uint8_t cmd, uint8_t *receive, uint16_t l
|
||||
|
||||
uint8_t devTEF_APPL_Get_Operation_Status() {
|
||||
uint8_t buf[2];
|
||||
while(!devTEF_Get_Cmd(TEF_APPL, Cmd_Get_Operation_Status, buf, sizeof(buf))) delay(1);
|
||||
while(!devTEF_Get_Cmd(TEF_APPL, Cmd_Get_Operation_Status, buf, sizeof(buf))) delay(2);
|
||||
return Convert8bto16b(buf);
|
||||
}
|
||||
|
||||
bool devTEF_Radio_Get_Processing_Status(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) {
|
||||
uint8_t buf[12];
|
||||
uint16_t r = devTEF_Get_Cmd(TEF_FM, Cmd_Get_Processing_Status, buf, sizeof(buf));
|
||||
*highcut = Convert8bto16b(buf + 2) / 10;
|
||||
*stereo = Convert8bto16b(buf + 4) / 10;
|
||||
*sthiblend = Convert8bto16b(buf + 6) / 10;
|
||||
uint16_t stband_1_2 = Convert8bto16b(buf + 8);
|
||||
uint16_t stband_3_4 = Convert8bto16b(buf + 10);
|
||||
*stband_1 = High_16bto8b(stband_1_2);
|
||||
*stband_2 = Low_16bto8b(stband_1_2);
|
||||
*stband_3 = High_16bto8b(stband_3_4);
|
||||
*stband_4 = Low_16bto8b(stband_3_4);
|
||||
return r;
|
||||
}
|
||||
|
||||
void devTEF_Radio_Get_Quality_Status(uint16_t *status, int16_t *level, uint16_t *usn, uint16_t *wam, int16_t *offset, uint16_t *bandwidth, uint16_t *mod, int8_t *snr) {
|
||||
uint8_t buf[14];
|
||||
devTEF_Get_Cmd(TEF_FM, Cmd_Get_Quality_Data, buf, sizeof(buf));
|
||||
@@ -77,16 +62,15 @@ void devTEF_Radio_Get_RDS_Status(uint16_t *status, uint16_t *A_block, uint16_t *
|
||||
if(dec_error != NULL) *dec_error = Convert8bto16b(buf + 10);
|
||||
}
|
||||
|
||||
bool devTEF_Radio_Get_RDS_Data(uint16_t *status, uint16_t *A_block, uint16_t *B_block, uint16_t *C_block, uint16_t *D_block, uint16_t *dec_error) {
|
||||
void devTEF_Radio_Get_RDS_Data(uint16_t *status, uint16_t *A_block, uint16_t *B_block, uint16_t *C_block, uint16_t *D_block, uint16_t *dec_error) {
|
||||
uint8_t buf[12];
|
||||
uint8_t r = devTEF_Get_Cmd(TEF_FM, Cmd_Get_RDS_Data, buf, sizeof(buf));
|
||||
*status = Convert8bto16b(buf);
|
||||
*A_block = Convert8bto16b(buf + 2);
|
||||
*B_block = Convert8bto16b(buf + 4);
|
||||
*C_block = Convert8bto16b(buf + 6);
|
||||
*D_block = Convert8bto16b(buf + 8);
|
||||
*dec_error = Convert8bto16b(buf + 10);
|
||||
return r;
|
||||
devTEF_Get_Cmd(TEF_FM, Cmd_Get_RDS_Data, buf, sizeof(buf));
|
||||
if(status != NULL) *status = Convert8bto16b(buf);
|
||||
if(A_block != NULL) *A_block = Convert8bto16b(buf + 2);
|
||||
if(B_block != NULL) *B_block = Convert8bto16b(buf + 4);
|
||||
if(C_block != NULL) *C_block = Convert8bto16b(buf + 6);
|
||||
if(D_block != NULL) *D_block = Convert8bto16b(buf + 8);
|
||||
if(dec_error != NULL) *dec_error = Convert8bto16b(buf + 10);
|
||||
}
|
||||
|
||||
bool devTEF_Radio_Get_Stereo_Status(uint16_t *status) {
|
||||
@@ -98,7 +82,7 @@ bool devTEF_Radio_Get_Stereo_Status(uint16_t *status) {
|
||||
}
|
||||
|
||||
void devTEF_Radio_Set_Wavegen(bool mode, int16_t amplitude, uint16_t freq) {
|
||||
devTEF_Set_Cmd(TEF_AUDIO, Cmd_Set_Input, 5, mode ? 240 : 0);
|
||||
if (mode) devTEF_Set_Cmd(TEF_AUDIO, Cmd_Set_WaveGen, 15, 5, 0, amplitude * 10, freq, amplitude * 10, freq);
|
||||
else devTEF_Set_Cmd(TEF_AUDIO, Cmd_Set_WaveGen, 15, 0);
|
||||
devTEF_Set_Cmd(TEF_AUDIO, Cmd_Set_Input, 2, mode ? 240 : 0);
|
||||
if (mode) devTEF_Set_Cmd(TEF_AUDIO, Cmd_Set_WaveGen, 12, 5, 0, amplitude * 10, freq, amplitude * 10, freq);
|
||||
else devTEF_Set_Cmd(TEF_AUDIO, Cmd_Set_WaveGen, 12, 0);
|
||||
}
|
||||
Reference in New Issue
Block a user