From d8478dc5d5831c09a9eb46f19577d637253178ca Mon Sep 17 00:00:00 2001 From: OSQZSS Date: Sun, 7 Jan 2018 13:13:30 +0900 Subject: [PATCH] Windows port of ingenico-zanetti's limeplayer --- player/limeplayer_win/getopt.c | 110 ++++++++ player/limeplayer_win/getopt.h | 9 + player/limeplayer_win/limeplayer.c | 409 +++++++++++++++++++++++++++++ 3 files changed, 528 insertions(+) create mode 100644 player/limeplayer_win/getopt.c create mode 100644 player/limeplayer_win/getopt.h create mode 100644 player/limeplayer_win/limeplayer.c diff --git a/player/limeplayer_win/getopt.c b/player/limeplayer_win/getopt.c new file mode 100644 index 0000000..dab5fd8 --- /dev/null +++ b/player/limeplayer_win/getopt.c @@ -0,0 +1,110 @@ +/* +* Copyright (c) 1987, 1993, 1994 +* The Regents of the University of California. All rights reserved. +* +* Redistribution and use in source and binary forms, with or without +* modification, are permitted provided that the following conditions +* are met: +* 1. Redistributions of source code must retain the above copyright +* notice, this list of conditions and the following disclaimer. +* 2. Redistributions in binary form must reproduce the above copyright +* notice, this list of conditions and the following disclaimer in the +* documentation and/or other materials provided with the distribution. +* 3. All advertising materials mentioning features or use of this software +* must display the following acknowledgement: +* This product includes software developed by the University of +* California, Berkeley and its contributors. +* 4. Neither the name of the University nor the names of its contributors +* may be used to endorse or promote products derived from this software +* without specific prior written permission. +* +* THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND +* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE +* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE +* ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE +* FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL +* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS +* OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) +* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT +* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY +* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF +* SUCH DAMAGE. +*/ + +#include "getopt.h" +#include +#include + +int opterr = 1, /* if error message should be printed */ + optind = 1, /* index into parent argv vector */ + optopt, /* character checked for validity */ + optreset; /* reset getopt */ +char *optarg; /* argument associated with option */ + +#define BADCH (int)'?' +#define BADARG (int)':' +#define EMSG "" + +/* + * getopt -- + * Parse argc/argv argument vector. + * + * Note: Unlike GNU getopt(), after a non-option argument, all further + * arguments are considered also non-options. This is similar to + * the way non-GNU Unix systems work. + */ +int getopt(int nargc, char * const nargv[], const char *ostr) +{ + static char *place = EMSG; /* option letter processing */ + const char *oli; /* option letter list index */ + + if (optreset || !*place) { /* update scanning pointer */ + optreset = 0; + if (optind >= nargc || *(place = nargv[optind]) != '-') { + place = EMSG; + return (-1); + } + if (place[1] && *++place == '-') { /* found "--" */ + ++optind; + place = EMSG; + return (-1); + } + } /* option letter okay? */ + if ((optopt = (int)*place++) == (int)':' || + !(oli = strchr(ostr, optopt))) { + /* + * if the user didn't specify '-' as an option, + * assume it means -1. + */ + if (optopt == (int)'-') + return (-1); + if (!*place) + ++optind; + if (opterr && *ostr != ':') + (void)printf("illegal option -- %c\n", optopt); + return (BADCH); + } + if (*++oli != ':') { /* don't need argument */ + optarg = NULL; + if (!*place) + ++optind; + } + else { /* need an argument */ + if (*place) /* no white space */ + optarg = place; + else if (nargc <= ++optind) { /* no arg */ + place = EMSG; + if (*ostr == ':') + return (BADARG); + if (opterr) + (void)printf("option requires an argument -- %c\n", optopt); + return (BADCH); + } + else /* white space */ + optarg = nargv[optind]; + place = EMSG; + ++optind; + } + return (optopt); /* dump back option letter */ +} + \ No newline at end of file diff --git a/player/limeplayer_win/getopt.h b/player/limeplayer_win/getopt.h new file mode 100644 index 0000000..5978e22 --- /dev/null +++ b/player/limeplayer_win/getopt.h @@ -0,0 +1,9 @@ +#ifndef GETOPT_H +#define GETOPT_H + +extern char *optarg; +extern int optind; + +int getopt(int nargc, char * const nargv[], const char *ostr) ; + +#endif diff --git a/player/limeplayer_win/limeplayer.c b/player/limeplayer_win/limeplayer.c new file mode 100644 index 0000000..346a2f8 --- /dev/null +++ b/player/limeplayer_win/limeplayer.c @@ -0,0 +1,409 @@ +#define _CRT_SECURE_NO_WARNINGS + +#define WIN32_LEAN_AND_MEAN +#include +#include + +#include +#include +#include +#ifdef _WIN32 +#include "getopt.h" +#else +#include +#endif + +#include +// Configration Properties: +// C/C++ --> General --> Additional Include Directories: C:\Program Files\PothosSDR\include +// Linker --> General --> Additional Library Directories: C:\Program Files\PothosSDR\lib +// Linker --> Input --> Additional Dependencies: LimeSuite.lib + +#define EXIT_CODE_NO_DEVICE (-2) +#define EXIT_CODE_LMS_OPEN (-1) + +#define TX_FREQUENCY 1575420000.0 +#define TX_SAMPLERATE 2500000.0 +#define TX_BANDWIDTH 5000000.0 +#define DEFAULT_ANTENNA 1 // antenna with BW [30MHz .. 2000MHz] + +typedef struct timeval { + long tv_sec; + long tv_usec; +} timeval; + +int gettimeofday(struct timeval * tp, struct timezone * tzp) +{ + // Note: some broken versions only have 8 trailing zero's, the correct epoch has 9 trailing zero's + // This magic number is the number of 100 nanosecond intervals since January 1, 1601 (UTC) + // until 00:00:00 January 1, 1970 + static const uint64_t EPOCH = ((uint64_t)116444736000000000ULL); + + SYSTEMTIME system_time; + FILETIME file_time; + uint64_t time; + + GetSystemTime(&system_time); + SystemTimeToFileTime(&system_time, &file_time); + time = ((uint64_t)file_time.dwLowDateTime); + time += ((uint64_t)file_time.dwHighDateTime) << 32; + + tp->tv_sec = (long)((time - EPOCH) / 10000000L); + tp->tv_usec = (long)(system_time.wMilliseconds * 1000); + return 0; +} + +void usage(const char *progname) +{ + fprintf(stderr, "Usage: %s [options]\n" + " -f select IQ sample data file to transmit (required)\n" + " -g with gain in [0.0 .. 1.0] set the so-called normalized RF gain in LimeSDR (default: 1.0 max RF power)\n" + " -c with channel either 0 or 1 (default: 0)\n" + " -a with antenna in { 0, 1, 2 } (default: 1)\n" + " -i select LimeSDR if multiple devices connected (default: 0)\n" + " -b select bit count in IQ sample in { 1, 8, 12, 16 }, (default: 16)\n" + " -s configure baseband sample rate (default: 2500000.0)\n" + " -d configure dynamic for the 1-bit mode (default: 2047, max 12-bit signed value supported by LimeSDR)\n", + progname); + + return; +} + +int main(int argc, char *const argv[]) +{ + if (argc<3) { + usage(argv[0]); + exit(1); + } + + int device_count = LMS_GetDeviceList(NULL); + + if (device_count < 1) + { + fprintf(stderr, "ERROR: No device was found.\n"); + return(EXIT_CODE_NO_DEVICE); + } + + lms_info_str_t *device_list = malloc(sizeof(lms_info_str_t) * device_count); + device_count = LMS_GetDeviceList(device_list); + + int i = 0; + while (i < device_count) + { + printf("device[%d/%d]=%s" "\n", i + 1, device_count, device_list[i]); + i++; + } + + double gain = 1.0; + int32_t antenna = DEFAULT_ANTENNA; + int32_t channel = 0; + int32_t index = 0; + int32_t bits = 16; + double sampleRate = TX_SAMPLERATE; + int32_t dynamic = 2047; + + int result; + char txfile[128]; + + txfile[0] = 0; // Empty TX file name + + while ((result = getopt(argc, argv, "f:g:c:a:i:b:s:d:")) != -1) + { + switch (result) + { + case 'f': + strcpy(txfile, optarg); + break; + case 'a': + antenna = strtol(optarg, NULL, 0); + break; + case 'b': + bits = strtol(optarg, NULL, 0); + break; + case 'c': + channel = strtol(optarg, NULL, 0); + break; + case 'g': + gain = strtod(optarg, NULL); + break; + case 'i': + index = strtol(optarg, NULL, 0); + break; + case 's': + sampleRate = strtod(optarg, NULL); + break; + case 'd': + dynamic = strtol(optarg, NULL, 0); + if (dynamic > 2047) + dynamic = 2047; + break; + case '?': + usage(argv[0]); + exit(1); + default: + break; + } + } + + // Open TX file. + FILE *fp; + + if (txfile[0] == 0) + { + printf("ERROR: I/Q sampling data file is not specified.\n"); + exit(1); + } + + fp = fopen(txfile, "rb"); + + if (fp == NULL) { + fprintf(stderr, "ERROR: Failed to open TX file: %s\n", argv[1]); + exit(1); + } + + // Use existing device + if (index < 0) + index = 0; + + if (index >= device_count) + index = 0; + + printf("Using device index %d [%s]" "\n", index, device_list[index]); + + // Normalized gain shall be in [0.0 .. 1.0] + if (gain < 0.0) + gain = 0.0; + if (gain > 1.0) + gain = 1.0; + + printf("Using normalized gain %lf" "\n", gain); + + // Open device and initialize. + lms_device_t *device = NULL; + + if (LMS_Open(&device, device_list[index], NULL)) + return(EXIT_CODE_LMS_OPEN); + + int lmsReset = LMS_Reset(device); + if (lmsReset) + printf("lmsReset %d(%s)" "\n", lmsReset, LMS_GetLastErrorMessage()); + + int lmsInit = LMS_Init(device); + if (lmsInit) + printf("lmsInit %d(%s)" "\n", lmsInit, LMS_GetLastErrorMessage()); + + // Select channel. + int channel_count = LMS_GetNumChannels(device, LMS_CH_TX); + // printf("Tx channel count %d" "\n", channel_count); + if (channel < 0) + channel = 0; + if (channel >= channel_count) + channel = 0; + + printf("Using channel %d" "\n", channel); + + // Select antenna. + int antenna_count = LMS_GetAntennaList(device, LMS_CH_TX, channel, NULL); + printf("TX%d Channel has %d antenna(ae)" "\n", channel, antenna_count); + + lms_name_t *antenna_name = malloc(sizeof(lms_name_t) * antenna_count); + + if (antenna_count > 0) + { + int i = 0; + lms_range_t *antenna_bw = malloc(sizeof(lms_range_t) * antenna_count); + LMS_GetAntennaList(device, LMS_CH_TX, channel, antenna_name); + for (i = 0; i < antenna_count; i++) + { + LMS_GetAntennaBW(device, LMS_CH_TX, channel, i, antenna_bw + i); + printf("Channel %d, antenna [%s] has BW [%lf .. %lf] (step %lf)" "\n", channel, antenna_name[i], antenna_bw[i].min, antenna_bw[i].max, antenna_bw[i].step); + } + } + + if (antenna < 0) + antenna = DEFAULT_ANTENNA; + if (antenna >= antenna_count) + antenna = DEFAULT_ANTENNA; + // LMS_SetAntenna(device, LMS_CH_TX, channel, antenna); // SetLOFrequency should take care of selecting the proper antenna + + LMS_SetNormalizedGain(device, LMS_CH_TX, channel, gain); + // Disable all other channels + LMS_EnableChannel(device, LMS_CH_TX, 1 - channel, false); + LMS_EnableChannel(device, LMS_CH_RX, 0, false); + LMS_EnableChannel(device, LMS_CH_RX, 1, false); + // Enable our Tx channel + LMS_EnableChannel(device, LMS_CH_TX, channel, true); + + int setLOFrequency = LMS_SetLOFrequency(device, LMS_CH_TX, channel, TX_FREQUENCY); + if (setLOFrequency) + printf("setLOFrequency(%lf)=%d(%s)" "\n", TX_FREQUENCY, setLOFrequency, LMS_GetLastErrorMessage()); + + // Set sample rate. + lms_range_t sampleRateRange; + int getSampleRateRange = LMS_GetSampleRateRange(device, LMS_CH_TX, &sampleRateRange); + if (getSampleRateRange) + printf("getSampleRateRange=%d(%s)" "\n", getSampleRateRange, LMS_GetLastErrorMessage()); + else + { + printf("sampleRateRange [%lf MHz.. %lf MHz] (step=%lf Hz)" "\n", sampleRateRange.min / 1e6, sampleRateRange.max / 1e6, sampleRateRange.step); + } + + printf("Set sample rate to %lf ..." "\n", sampleRate); + int setSampleRate = LMS_SetSampleRate(device, sampleRate, 0); + if (setSampleRate) + printf("setSampleRate=%d(%s)" "\n", setSampleRate, LMS_GetLastErrorMessage()); + + double actualHostSampleRate = 0.0; + double actualRFSampleRate = 0.0; + int getSampleRate = LMS_GetSampleRate(device, LMS_CH_TX, channel, &actualHostSampleRate, &actualRFSampleRate); + if (getSampleRate) + printf("getSampleRate=%d(%s)" "\n", getSampleRate, LMS_GetLastErrorMessage()); + else + printf("actualRate %lf (Host) / %lf (RF)" "\n", actualHostSampleRate, actualRFSampleRate); + + printf("Calibrating ..." "\n"); + int calibrate = LMS_Calibrate(device, LMS_CH_TX, channel, TX_BANDWIDTH, 0); + if (calibrate) + printf("calibrate=%d(%s)" "\n", calibrate, LMS_GetLastErrorMessage()); + + printf("Setup TX stream ..." "\n"); + lms_stream_t tx_stream = { .channel = channel,.fifoSize = 1024 * 1024,.throughputVsLatency = 0.5,.isTx = true,.dataFmt = LMS_FMT_I12 }; + int setupStream = LMS_SetupStream(device, &tx_stream); + if (setupStream) + printf("setupStream=%d(%s)" "\n", setupStream, LMS_GetLastErrorMessage()); + + struct s16iq_sample_s { + signed short int i; + signed short int q; + }; + + int nSamples = (int)sampleRate / 100; + struct s16iq_sample_s *sampleBuffer = (struct s16iq_sample_s*)malloc(sizeof(struct s16iq_sample_s) * nSamples); + + LMS_StartStream(&tx_stream); + + int loop = 0; + if ((12 == bits) || (16 == bits)) + { + // File contains interleaved 16-bit IQ values, either with only 12-bit data, or with 16-bit data + while (fread(sampleBuffer, sizeof(struct s16iq_sample_s), nSamples, fp)) + { + loop++; + if (0 == (loop % 100)) + { + struct timeval tv; + gettimeofday(&tv, NULL); + printf("gettimeofday()=> %ld:%06ld ; ", tv.tv_sec, tv.tv_usec); + lms_stream_status_t status; + LMS_GetStreamStatus(&tx_stream, &status); //Obtain TX stream stats + printf("TX rate:%lf MB/s" "\n", status.linkRate / 1e6); + } + if (16 == bits) + { + // Scale down to 12-bit + // Quick and dirty, so -1 (0xFFFF) to -15 (0xFFF1) scale down to -1 instead of 0 + int i = 0; + while (i < nSamples) { + sampleBuffer[i].i >>= 4; + sampleBuffer[i].q >>= 4; + i++; + } + } + int sendStream = LMS_SendStream(&tx_stream, sampleBuffer, nSamples, NULL, 1000); + if (sendStream < 0) + printf("sendStream %d(%s)" "\n", sendStream, LMS_GetLastErrorMessage()); + } + } + else if (8 == bits) + { + // File contains interleaved signed 8-bit IQ values + struct s8iq_sample_s { + signed char i; + signed char q; + }; + struct s8iq_sample_s *fileSamples = (struct s8iq_sample_s*)malloc(sizeof(struct s8iq_sample_s) * nSamples); + while (fread(fileSamples, sizeof(struct s8iq_sample_s), nSamples, fp)) + { + loop++; + if (0 == (loop % 100)) + { + struct timeval tv; + gettimeofday(&tv, NULL); + printf("gettimeofday()=> %ld:%06ld ; ", tv.tv_sec, tv.tv_usec); + lms_stream_status_t status; + LMS_GetStreamStatus(&tx_stream, &status); //Obtain TX stream stats + printf("TX rate:%lf MB/s" "\n", status.linkRate / 1e6); + } + // Up-Scale to 12-bit + int i = 0; + while (i < nSamples) + { + sampleBuffer[i].i = (fileSamples[i].i << 4); + sampleBuffer[i].q = (fileSamples[i].q << 4); + i++; + } + int sendStream = LMS_SendStream(&tx_stream, sampleBuffer, nSamples, NULL, 1000); + if (sendStream < 0) + printf("sendStream %d(%s)" "\n", sendStream, LMS_GetLastErrorMessage()); + } + free(fileSamples); + } + else if (1 == bits) + { + // File contains interleaved signed 1-bit IQ values + // Each byte is IQIQIQIQ + int16_t expand_lut[256][8]; + int i, j; + for (i = 0; i<256; i++) + { + for (j = 0; j<8; j++) + expand_lut[i][j] = ((i >> (7 - j)) & 0x1) ? dynamic : -dynamic; + } + printf("1-bit mode: using dynamic=%d" "\n", dynamic); + // printf("sizeof(expand_lut[][])=%d, sizeof(expand_lut[0])=%d" "\n", sizeof(expand_lut), sizeof(expand_lut[0])); + int8_t *fileBuffer = (int8_t*)malloc(sizeof(int8_t) * nSamples); + while (fread(fileBuffer, sizeof(int8_t), nSamples / 4, fp)) + { + loop++; + if (0 == (loop % 100)) + { + struct timeval tv; + gettimeofday(&tv, NULL); + printf("gettimeofday()=> %ld:%06ld ; ", tv.tv_sec, tv.tv_usec); + lms_stream_status_t status; + LMS_GetStreamStatus(&tx_stream, &status); //Obtain TX stream stats + printf("TX rate:%lf MB/s" "\n", status.linkRate / 1e6); + } + // Expand + int src = 0; + int dst = 0; + while (src < (nSamples / 4)) + { + memcpy(sampleBuffer + dst, expand_lut + fileBuffer[src], sizeof(expand_lut[0])); + dst += 4; + src++; + } + int sendStream = LMS_SendStream(&tx_stream, sampleBuffer, nSamples, NULL, 1000); + if (sendStream < 0) + printf("sendStream %d(%s)" "\n", sendStream, LMS_GetLastErrorMessage()); + } + free(fileBuffer); + } + + LMS_StopStream(&tx_stream); + LMS_DestroyStream(device, &tx_stream); + + free(sampleBuffer); + + printf("Closing device...\n"); + LMS_EnableChannel(device, LMS_CH_TX, channel, false); + LMS_Close(device); + + // Close TX file + fclose(fp); + + printf("Done.\n"); + + return(0); +} +