Mercurial > pt1
changeset 113:e7b786c42ca0
add an utility to check signal strength.
author | Yoshiki Yazawa <yaz@honeyplanet.jp> |
---|---|
date | Fri, 19 Mar 2010 01:01:35 +0900 |
parents | 38091ff0c8ed |
children | 3eccf1ef4853 |
files | recpt1/Makefile.in recpt1/checksignal.c |
diffstat | 2 files changed, 410 insertions(+), 4 deletions(-) [+] |
line wrap: on
line diff
--- a/recpt1/Makefile.in Fri Mar 19 00:57:25 2010 +0900 +++ b/recpt1/Makefile.in Fri Mar 19 01:01:35 2010 +0900 @@ -6,23 +6,27 @@ TARGET = recpt1 TARGET2 = recpt1ctl -TARGETS = $(TARGET) $(TARGET2) +TARGET3 = checksignal +TARGETS = $(TARGET) $(TARGET2) $(TARGET3) RELEASE_VERSION = "1.1.0" CPPFLAGS = -I../driver -Wall -D_LARGEFILE_SOURCE -D_FILE_OFFSET_BITS=64 CFLAGS = -O2 -g -pthread LIBS = @LIBS@ +LIBS3 = -lm LDFLAGS = -OBJS = recpt1.o decoder.o mkpath.o tssplitter_lite.o -OBJS2 = recpt1ctl.o +OBJS = recpt1.o decoder.o mkpath.o tssplitter_lite.o +OBJS2 = recpt1ctl.o +OBJS3 = checksignal.o +OBJALL = $(OBJS) $(OBJS2) $(OBJS3) DEPEND = .deps all: $(TARGETS) clean: - rm -f $(OBJS) $(OBJS2) $(TARGETS) $(DEPEND) version.h + rm -f $(OBJALL) $(TARGETS) $(DEPEND) version.h distclean: clean rm -f Makefile config.h config.log config.status @@ -36,6 +40,9 @@ $(TARGET2): $(OBJS2) $(CC) $(LDFLAGS) -o $@ $(OBJS2) $(LIBS2) +$(TARGET3): $(OBJS3) + $(CC) $(LDFLAGS) -o $@ $(OBJS3) $(LIBS3) + $(DEPEND): version.h $(CC) -MM $(OBJS:.o=.c) $(OBJS2:.o=.c) $(CPPFLAGS) > $@
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/recpt1/checksignal.c Fri Mar 19 01:01:35 2010 +0900 @@ -0,0 +1,399 @@ +/* -*- tab-width: 4; indent-tabs-mode: nil -*- */ +#include <stdio.h> +#include <fcntl.h> +#include <sys/types.h> +#include <sys/stat.h> +#include <time.h> +#include <stdlib.h> +#include <string.h> +#include <pthread.h> +#include <math.h> +#include <unistd.h> +#include <getopt.h> +#include <signal.h> +#include <errno.h> +#include <sys/time.h> +#include <ctype.h> +#include <libgen.h> + +#include <netdb.h> +#include <arpa/inet.h> +#include <netinet/in.h> + +#include <sys/ioctl.h> +#include "pt1_ioctl.h" + +#include "config.h" +#include "decoder.h" +#include "recpt1.h" +#include "version.h" +#include "mkpath.h" + +#include <sys/ipc.h> +#include <sys/msg.h> +#include "pt1_dev.h" +#include "tssplitter_lite.h" + +/* type definitions */ +typedef int boolean; + +typedef struct thread_data { + int ch; + int lnb; /* LNB voltage */ + int tfd; /* tuner fd */ + ISDB_T_FREQ_CONV_TABLE *table; +} thread_data; + +/* globals */ +boolean f_exit = FALSE; + +/* prototypes */ +int tune(char *channel, thread_data *tdata, char *device); +int close_tuner(thread_data *tdata); + +/* signal handler */ +void +handler(int dummy) +{ + f_exit = TRUE; +} + +/* lookup frequency conversion table*/ +ISDB_T_FREQ_CONV_TABLE * +searchrecoff(char *channel) +{ + int lp; + + for(lp = 0; isdb_t_conv_table[lp].parm_freq != NULL; lp++) { + /* return entry number in the table when strings match and + * lengths are same. */ + if((memcmp(isdb_t_conv_table[lp].parm_freq, channel, + strlen(channel)) == 0) && + (strlen(channel) == strlen(isdb_t_conv_table[lp].parm_freq))) { + return &isdb_t_conv_table[lp]; + } + } + return NULL; +} + +void +show_usage(char *cmd) +{ + fprintf(stderr, "Usage: \n%s [--device devicefile] [--lnb voltage] channel\n", cmd); + fprintf(stderr, "\n"); +} + +void +show_options(void) +{ + fprintf(stderr, "Options:\n"); + fprintf(stderr, "--device devicefile: Specify devicefile to use\n"); + fprintf(stderr, "--lnb voltage: Specify LNB voltage (0, 11, 15)\n"); + fprintf(stderr, "--help: Show this help\n"); + fprintf(stderr, "--version: Show version\n"); + fprintf(stderr, "--list: Show channel list\n"); +} + +void +show_channels(void) +{ + FILE *f; + char *home; + char buf[255], filename[255]; + + fprintf(stderr, "Available Channels:\n"); + + home = getenv("HOME"); + sprintf(filename, "%s/.recpt1-channels", home); + f = fopen(filename, "r"); + if(f) { + while(fgets(buf, 255, f)) + fprintf(stderr, "%s", buf); + fclose(f); + } + else + fprintf(stderr, "13-62: Terrestrial Channels\n"); + + fprintf(stderr, "101ch: NHK BS1\n"); + fprintf(stderr, "102ch: NHK BS2\n"); + fprintf(stderr, "103ch: NHK BShi\n"); + fprintf(stderr, "141ch: BS Nittele\n"); + fprintf(stderr, "151ch: BS Asahi\n"); + fprintf(stderr, "161ch: BS-TBS\n"); + fprintf(stderr, "171ch: BS Japan\n"); + fprintf(stderr, "181ch: BS Fuji\n"); + fprintf(stderr, "191ch: WOWOW\n"); + fprintf(stderr, "192ch: WOWOW2\n"); + fprintf(stderr, "193ch: WOWOW3\n"); + fprintf(stderr, "200ch: Star Channel\n"); + fprintf(stderr, "211ch: BS11 Digital\n"); + fprintf(stderr, "222ch: TwellV\n"); + fprintf(stderr, "C13-C63: CATV Channels\n"); + fprintf(stderr, "CS2-CS24: CS Channels\n"); +} + +float +getsignal_isdb_s(int signal) +{ + /* apply linear interpolation */ + static const float afLevelTable[] = { + 24.07f, // 00 00 0 24.07dB + 24.07f, // 10 00 4096 24.07dB + 18.61f, // 20 00 8192 18.61dB + 15.21f, // 30 00 12288 15.21dB + 12.50f, // 40 00 16384 12.50dB + 10.19f, // 50 00 20480 10.19dB + 8.140f, // 60 00 24576 8.140dB + 6.270f, // 70 00 28672 6.270dB + 4.550f, // 80 00 32768 4.550dB + 3.730f, // 88 00 34816 3.730dB + 3.630f, // 88 FF 35071 3.630dB + 2.940f, // 90 00 36864 2.940dB + 1.420f, // A0 00 40960 1.420dB + 0.000f // B0 00 45056 -0.01dB + }; + + unsigned char sigbuf[4]; + memset(sigbuf, '\0', sizeof(sigbuf)); + sigbuf[0] = (((signal & 0xFF00) >> 8) & 0XFF); + sigbuf[1] = (signal & 0xFF); + + /* calculate signal level */ + if(sigbuf[0] <= 0x10U) { + /* clipped maximum */ + return 24.07f; + } + else if (sigbuf[0] >= 0xB0U) { + /* clipped minimum */ + return 0.0f; + } + else { + /* linear interpolation */ + const float fMixRate = + (float)(((unsigned short)(sigbuf[0] & 0x0FU) << 8) | + (unsigned short)sigbuf[0]) / 4096.0f; + return afLevelTable[sigbuf[0] >> 4] * (1.0f - fMixRate) + + afLevelTable[(sigbuf[0] >> 4) + 0x01U] * fMixRate; + } +} + +void +calc_cn(int fd, int type) +{ + int rc ; + double P ; + double CNR; + + if(ioctl(fd, GET_SIGNAL_STRENGTH, &rc) < 0) { + fprintf(stderr, "Tuner Select Error\n"); + return ; + } + + if(type == CHTYPE_GROUND) { + P = log10(5505024/(double)rc) * 10; + CNR = (0.000024 * P * P * P * P) - (0.0016 * P * P * P) + + (0.0398 * P * P) + (0.5491 * P)+3.0965; + } + else { + CNR = getsignal_isdb_s(rc); + } + fprintf(stderr, "\rC/N = %fdB", CNR); +} + +int +tune(char *channel, thread_data *tdata, char *device) +{ + char **tuner; + int num_devs; + int lp; + FREQUENCY freq; + + /* get channel */ + tdata->table = searchrecoff(channel); + if(tdata->table == NULL) { + fprintf(stderr, "Invalid Channel: %s\n", channel); + return 1; + } + + freq.frequencyno = tdata->table->set_freq; + freq.slot = tdata->table->add_freq; + + /* open tuner */ + /* case 1: specified tuner device */ + if(device) { + fprintf(stderr, "device = %s\n", device); + tdata->tfd = open(device, O_RDONLY); + if(tdata->tfd < 0) { + fprintf(stderr, "Cannot open tuner device: %s\n", device); + return 1; + } + + /* power on LNB */ + if(tdata->table->type == CHTYPE_SATELLITE) { + if(ioctl(tdata->tfd, LNB_ENABLE, tdata->lnb) < 0) { + fprintf(stderr, "Power on LNB failed: %s\n", device); + } + } + + /* tune to specified channel */ + if(ioctl(tdata->tfd, SET_CHANNEL, &freq) < 0) { + close(tdata->tfd); + fprintf(stderr, "Cannot tune to the specified channel: %s\n", device); + return 1; + } + else { + tdata->ch = atoi(channel); + } + } + else { + /* case 2: loop around available devices */ + if(tdata->table->type == CHTYPE_SATELLITE) { + tuner = bsdev; + num_devs = NUM_BSDEV; + } + else { + tuner = isdb_t_dev; + num_devs = NUM_ISDB_T_DEV; + } + + for(lp = 0; lp < num_devs; lp++) { + tdata->tfd = open(tuner[lp], O_RDONLY); + if(tdata->tfd >= 0) { + /* power on LNB */ + if(tdata->table->type == CHTYPE_SATELLITE) { + if(ioctl(tdata->tfd, LNB_ENABLE, tdata->lnb) < 0) { + fprintf(stderr, "Warning: Power on LNB failed: %s\n", tuner[lp]); + } + } + + /* tune to specified channel */ + if(ioctl(tdata->tfd, SET_CHANNEL, &freq) < 0) { + close(tdata->tfd); + tdata->tfd = -1; + continue; + } + + fprintf(stderr, "device = %s\n", tuner[lp]); + break; /* found suitable tuner */ + } + } + + /* all tuners cannot be used */ + if(tdata->tfd < 0) { + fprintf(stderr, "Cannot tune to the specified channel\n"); + return 1; + } + else { + tdata->ch = atoi(channel); + } + } + + return 0; /* success */ +} + +int +close_tuner(thread_data *tdata) +{ + int rv = 0; + + if(tdata->table->type == CHTYPE_SATELLITE) { + if(ioctl(tdata->tfd, LNB_DISABLE, 0) < 0) { + rv = 1; + } + } + close(tdata->tfd); + + return rv; +} + +int +main(int argc, char **argv) +{ + static thread_data tdata; + int result; + int option_index; + struct option long_options[] = { + { "LNB", 1, NULL, 'n'}, + { "lnb", 1, NULL, 'n'}, + { "device", 1, NULL, 'd'}, + { "help", 0, NULL, 'h'}, + { "version", 0, NULL, 'v'}, + { "list", 0, NULL, 'l'}, + {0, 0, NULL, 0} /* terminate */ + }; + + char *device = NULL; + int val; + char *voltage[] = {"0V", "11V", "15V"}; + + while((result = getopt_long(argc, argv, "br:smn:ua:p:d:hvli:", + long_options, &option_index)) != -1) { + switch(result) { + case 'h': + fprintf(stderr, "\n"); + show_usage(argv[0]); + fprintf(stderr, "\n"); + show_options(); + fprintf(stderr, "\n"); + show_channels(); + fprintf(stderr, "\n"); + exit(0); + break; + case 'v': + fprintf(stderr, "%s %s\n", argv[0], version); + fprintf(stderr, "recorder command for PT1/2 digital tuner.\n"); + exit(0); + break; + case 'l': + show_channels(); + exit(0); + break; + /* following options require argument */ + case 'n': + val = atoi(optarg); + switch(val) { + case 11: + tdata.lnb = 1; + break; + case 15: + tdata.lnb = 2; + break; + default: + tdata.lnb = 0; + break; + } + fprintf(stderr, "LNB = %s\n", voltage[tdata.lnb]); + break; + case 'd': + device = optarg; + break; + } + } + + if(argc - optind < 1) { + fprintf(stderr, "channel must be specified!\n"); + fprintf(stderr, "Try '%s --help' for more information.\n", argv[0]); + return 1; + } + + /* add signal handler */ + signal(SIGTERM, handler); + + /* tune */ + if(tune(argv[optind], &tdata, device) != 0) + return 1; + + while(1) { + if(f_exit) + break; + /* show signal strength */ + calc_cn(tdata.tfd, tdata.table->type); + sleep(1); + } + + /* close tuner */ + if(close_tuner(&tdata) != 0) + return 1; + + return 0; +}