提交SMOD ATSC IMX APP版本 V122
This commit is contained in:
Executable
+187
@@ -0,0 +1,187 @@
|
||||
/*
|
||||
* Console control through a FIFO.
|
||||
*
|
||||
* Usage from a shell:
|
||||
* echo "freq 473" > /tmp/atsc_ctrl
|
||||
* echo "rxfreq 473" > /tmp/atsc_ctrl
|
||||
* echo "status" > /tmp/atsc_ctrl
|
||||
*/
|
||||
#include <stdio.h>
|
||||
#include <stdlib.h>
|
||||
#include <string.h>
|
||||
#include <unistd.h>
|
||||
#include <pthread.h>
|
||||
#include <fcntl.h>
|
||||
#include <sys/types.h>
|
||||
#include <sys/stat.h>
|
||||
#include <errno.h>
|
||||
|
||||
#include "../inc/type.h"
|
||||
#include "../inc/lcd_task.h"
|
||||
#include "../inc/i2c_drv.h"
|
||||
#include "../inc/eeprom.h"
|
||||
#include "../inc/dac38j82.h"
|
||||
#include "../inc/console_ctrl.h"
|
||||
|
||||
#define ATSC_CTRL_FIFO "/tmp/atsc_ctrl"
|
||||
|
||||
static int mhz_to_chn(uint32 mhz)
|
||||
{
|
||||
uint32 chn;
|
||||
|
||||
for(chn = FREQ_MIN_V1; chn <= FREQ_MAX_ALL; chn++)
|
||||
{
|
||||
if(txfreq_to_hz(chn) == mhz)
|
||||
return (int)chn;
|
||||
}
|
||||
|
||||
return -1;
|
||||
}
|
||||
|
||||
static void save_tx_freq(uint8 chn)
|
||||
{
|
||||
int changed = (atsc_para.rf_para.txfreq != chn) ? 1 : 0;
|
||||
|
||||
atsc_para.rf_para.txfreq = chn;
|
||||
atsc_para.we_para.ch = chn;
|
||||
e2rom_read_leak(chn, &atsc_para.we_para);
|
||||
fpga_save_we(&atsc_para.we_para);
|
||||
c256_bytewrite(EEPROM_CHANNEL_ADDR, atsc_para.rf_para.txfreq);
|
||||
#if BAK_PARA_CHECK
|
||||
c256_bytewrite2(BAK_EEPROM_CHANNEL_ADDR, atsc_para.rf_para.txfreq);
|
||||
#endif
|
||||
|
||||
chang_freq(1, changed);
|
||||
}
|
||||
|
||||
static void save_rx_freq(uint8 chn)
|
||||
{
|
||||
#if USE_TUNER
|
||||
uint8 bak_tuner_freq = atsc_para.rf_para.rxfreq;
|
||||
#endif
|
||||
|
||||
atsc_para.rf_para.rxfreq = chn;
|
||||
|
||||
#if USE_TUNER
|
||||
if(bak_tuner_freq != atsc_para.rf_para.rxfreq)
|
||||
tuner_init(atsc_para.rf_para.rxfreq);
|
||||
#endif
|
||||
|
||||
c256_bytewrite(EEPROM_RXCHANNEL_ADDR, atsc_para.rf_para.rxfreq);
|
||||
#if BAK_PARA_CHECK
|
||||
c256_bytewrite2(BAK_EEPROM_RXCHANNEL_ADDR, atsc_para.rf_para.rxfreq);
|
||||
#endif
|
||||
}
|
||||
|
||||
static void exec_cmd(char *line)
|
||||
{
|
||||
char a0[32] = {0};
|
||||
char a1[32] = {0};
|
||||
int n = sscanf(line, "%31s %31s", a0, a1);
|
||||
|
||||
if(n < 1)
|
||||
return;
|
||||
|
||||
if((strcmp(a0, "freq") == 0) && (n >= 2))
|
||||
{
|
||||
uint32 mhz = (uint32)strtoul(a1, NULL, 0);
|
||||
int chn = mhz_to_chn(mhz);
|
||||
|
||||
if(chn < 0)
|
||||
{
|
||||
printf("[atsc_ctrl] freq %u MHz invalid\n", mhz);
|
||||
return;
|
||||
}
|
||||
|
||||
save_tx_freq((uint8)chn);
|
||||
printf("[atsc_ctrl] freq %u MHz -> chn %d done\n", mhz, chn);
|
||||
}
|
||||
else if((strcmp(a0, "rxfreq") == 0) && (n >= 2))
|
||||
{
|
||||
uint32 mhz = (uint32)strtoul(a1, NULL, 0);
|
||||
int chn = mhz_to_chn(mhz);
|
||||
|
||||
if(chn < 0)
|
||||
{
|
||||
printf("[atsc_ctrl] rxfreq %u MHz invalid\n", mhz);
|
||||
return;
|
||||
}
|
||||
|
||||
save_rx_freq((uint8)chn);
|
||||
printf("[atsc_ctrl] rxfreq %u MHz -> chn %d done\n", mhz, chn);
|
||||
}
|
||||
else if(strcmp(a0, "status") == 0)
|
||||
{
|
||||
printf("[atsc_ctrl] tx=%u MHz(chn=%u) rx=%u MHz(chn=%u) rf=%u power=%u db=%u\n",
|
||||
txfreq_to_hz(atsc_para.rf_para.txfreq),
|
||||
atsc_para.rf_para.txfreq,
|
||||
txfreq_to_hz(atsc_para.rf_para.rxfreq),
|
||||
atsc_para.rf_para.rxfreq,
|
||||
atsc_para.rf_para.rf,
|
||||
atsc_para.rf_para.power,
|
||||
atsc_para.rf_para.db);
|
||||
}
|
||||
else
|
||||
{
|
||||
printf("[atsc_ctrl] usage: freq <MHz> | rxfreq <MHz> | status\n");
|
||||
}
|
||||
}
|
||||
|
||||
static void *console_ctrl_thr(void *arg)
|
||||
{
|
||||
char line[256];
|
||||
int fd;
|
||||
FILE *fp;
|
||||
|
||||
(void)arg;
|
||||
|
||||
unlink(ATSC_CTRL_FIFO);
|
||||
if((mkfifo(ATSC_CTRL_FIFO, 0666) != 0) && (errno != EEXIST))
|
||||
printf("[atsc_ctrl] mkfifo %s err=%d\n", ATSC_CTRL_FIFO, errno);
|
||||
|
||||
chmod(ATSC_CTRL_FIFO, 0666);
|
||||
printf("[atsc_ctrl] console_ctrl up, FIFO=%s\n", ATSC_CTRL_FIFO);
|
||||
|
||||
fd = open(ATSC_CTRL_FIFO, O_RDWR);
|
||||
if(fd < 0)
|
||||
{
|
||||
printf("[atsc_ctrl] open FIFO err=%d\n", errno);
|
||||
return NULL;
|
||||
}
|
||||
|
||||
fp = fdopen(fd, "r");
|
||||
if(!fp)
|
||||
{
|
||||
printf("[atsc_ctrl] fdopen FIFO err=%d\n", errno);
|
||||
close(fd);
|
||||
return NULL;
|
||||
}
|
||||
|
||||
while(fgets(line, sizeof(line), fp))
|
||||
{
|
||||
line[strcspn(line, "\r\n")] = 0;
|
||||
if(line[0])
|
||||
{
|
||||
printf("[atsc_ctrl] cmd: %s\n", line);
|
||||
exec_cmd(line);
|
||||
}
|
||||
}
|
||||
|
||||
fclose(fp);
|
||||
return NULL;
|
||||
}
|
||||
|
||||
int creat_console_ctrl_thread(void)
|
||||
{
|
||||
pthread_t tid;
|
||||
int ret = pthread_create(&tid, NULL, console_ctrl_thr, NULL);
|
||||
|
||||
if(ret != 0)
|
||||
{
|
||||
printf(" Err.[%s,%d] creat console_ctrl thread err.\n", __FUNCTION__, __LINE__);
|
||||
return -1;
|
||||
}
|
||||
|
||||
printf(" Ok .[%s,%d] creat console_ctrl thread succeed.\n", __FUNCTION__, __LINE__);
|
||||
return 0;
|
||||
}
|
||||
Reference in New Issue
Block a user