Begin porting AMBServer code for use in waveforms. Add thumbDV.c|h files and successfully open serial port

DSP_API/SmartSDR_Interface/sched_waveform.c

@@ -43,6 +43,7 @@
 #include "hal_buffer.h"
 #include "sched_waveform.h"
 #include "vita_output.h"
+#include "thumbDV.h"
 
 //static Queue sched_fft_queue;
 static pthread_rwlock_t _list_lock;
@@ -183,6 +184,7 @@ Circular_Short_Buffer TX3_cb = &tx3_cb;
 circular_float_buffer tx4_cb;
 Circular_Float_Buffer TX4_cb = &tx4_cb;
 
+static int _dv_serial_fd = 0;
 
 static void* _sched_waveform_thread(void* param)
 {
@@ -216,11 +218,9 @@ static void* _sched_waveform_thread(void* param)
     float 	tx_float_in_24k[PACKET_SAMPLES * DECIMATION_FACTOR + FILTER_TAPS];
     float 	tx_float_out_24k[PACKET_SAMPLES * DECIMATION_FACTOR ];
 
-
-
-
     // =======================  Initialization Section =========================
 
+    _dv_serial_fd = openSerial("/dev/ttyUSB0");
 
     // Initialize the Circular Buffers
 
@@ -359,7 +359,7 @@ static void* _sched_waveform_thread(void* param)
 
                             /********* ENCODE *///////////////
                             //nout = freedv_rx(_freedvS, speech_out, demod_in);
-
+                            nout = 320;
                             for( i=0 ; i < nout ; i++)
                             {
                                 cbWriteShort(RX3_cb, speech_out[i]);

DSP_API/ThumbDV/thumbDV.c

@@ -0,0 +1,217 @@
+///*!   \file thumbdv.c
+// *    \brief Functions required to communicate and decode packets from ThumbDV
+// *
+// *    \copyright  Copyright 2012-2014 FlexRadio Systems.  All Rights Reserved.
+// *                Unauthorized use, duplication or distribution of this software is
+// *                strictly prohibited by law.
+// *
+// *    \date 26-MAY-2015
+// *    \author     Ed Gonzalez
+// *
+// *
+// */
+
+/* *****************************************************************************
+ *
+ *  Copyright (C) 2014 FlexRadio Systems.
+ *
+ *  This program is free software: you can redistribute it and/or modify
+ *  it under the terms of the GNU General Public License as published by
+ *  the Free Software Foundation, either version 3 of the License, or
+ *  (at your option) any later version.
+ *  This program is distributed in the hope that it will be useful,
+ *  but WITHOUT ANY WARRANTY; without even the implied warranty of
+ *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
+ *  GNU General Public License for more details.
+ *  You should have received a copy of the GNU General Public License
+ *  along with this program. If not, see <http://www.gnu.org/licenses/>.
+ *
+ *  Contact Information:
+ *  email: gpl<at>flexradiosystems.com
+ *  Mail:  FlexRadio Systems, Suite 1-150, 4616 W. Howard LN, Austin, TX 78728
+ *
+ * ************************************************************************** */
+#include <stdio.h>
+#include <time.h>
+#include <stdlib.h>
+#include <unistd.h>
+#include <ctype.h>
+#include <errno.h>
+#include <termios.h>
+#include <string.h>
+#include <fcntl.h>
+
+#include <sys/stat.h>
+#include <sys/types.h>
+#include <sys/select.h>
+#include <sys/socket.h>
+
+#include <netinet/in.h>
+
+#include "common.h"
+#include "datatypes.h"
+#include "hal_buffer.h"
+
+#include "vita_output.h"
+#include "thumbDV.h"
+
+
+#define DV3000_TTY              "/dev/ttyAMA0"
+#define DV3000_VERSION          "2014-04-23"
+
+#define AMBE3000_HEADER_LEN     4U
+#define AMBE3000_START_BYTE     0x61U
+
+#define DEFAULT_PORT            2460U
+#define BUFFER_LENGTH           400U
+
+static void delay(unsigned int delay) {
+    struct timespec tim, tim2;
+    tim.tv_sec = 0;
+    tim.tv_nsec = delay * 1000UL;
+    nanosleep(&tim, &tim2);
+};
+
+
+static void dump(char *text, unsigned char *data, unsigned int length)
+{
+    unsigned int offset = 0U;
+    unsigned int i;
+
+    fputs(text, stdout);
+    fputc('\n', stdout);
+
+    while (length > 0U) {
+        unsigned int bytes = (length > 16U) ? 16U : length;
+
+        output( "%04X:  ", offset);
+
+        for (i = 0U; i < bytes; i++)
+            fprintf(stdout, "%02X ", data[offset + i]);
+
+        for (i = bytes; i < 16U; i++)
+            fputs("   ", stdout);
+
+        fputs("   *", stdout);
+
+        for (i = 0U; i < bytes; i++) {
+            unsigned char c = data[offset + i];
+
+            if (isprint(c))
+                fputc(c, stdout);
+            else
+                fputc('.', stdout);
+        }
+
+        fputs("*\n", stdout);
+
+        offset += 16U;
+
+        if (length >= 16U)
+            length -= 16U;
+        else
+            length = 0U;
+    }
+
+}
+
+int openSerial(const char * tty_name)
+{
+    struct termios tty;
+    int fd;
+    int n1;
+    char reset[5] = { 0x61, 0x00, 0x01, 0x00, 0x33 };
+
+    /* TODO: Sanitize tty_name */
+
+    fd = open(tty_name, O_RDWR | O_NOCTTY | O_SYNC);
+    if (fd < 0) {
+        output("AMBEserver: error when opening %s, errno=%d\n", tty_name,errno);
+        return fd;
+    }
+
+    if (tcgetattr(fd, &tty) != 0) {
+        output( "AMBEserver: error %d from tcgetattr\n", errno);
+        return -1;
+    }
+
+    cfsetospeed(&tty, B230400);
+    cfsetispeed(&tty, B230400);
+
+    tty.c_cflag = (tty.c_cflag & ~CSIZE) | CS8;
+    tty.c_iflag &= ~IGNBRK;
+    tty.c_lflag = 0;
+
+    tty.c_oflag = 0;
+    tty.c_cc[VMIN]  = 0;
+    tty.c_cc[VTIME] = 5;
+
+    tty.c_iflag &= ~(IXON | IXOFF | IXANY);
+
+    tty.c_cflag |= (CLOCAL | CREAD);
+
+    tty.c_cflag &= ~(PARENB | PARODD);
+    tty.c_cflag &= ~CSTOPB;
+    tty.c_cflag &= ~CRTSCTS;
+
+    if (tcsetattr(fd, TCSANOW, &tty) != 0) {
+        output("AMBEserver: error %d from tcsetattr\n", errno);
+        return -1;
+    }
+
+    output("opened %s - fd = %d\n", tty_name, fd);
+    n1 = write(fd,reset,5);
+    output("Wrote Reset %d chars\n",n1);
+
+    return fd;
+}
+
+
+int processSerial(int serial_fd)
+{
+    unsigned char buffer[BUFFER_LENGTH];
+    unsigned int respLen;
+    unsigned int offset;
+    ssize_t len;
+
+    len = read(serial_fd, buffer, 1);
+    if (len != 1) {
+        output(ANSI_RED "AMBEserver: error when reading from the serial port, errno=%d" ANSI_WHITE, errno);
+        return 0;
+    }
+
+    if (buffer[0U] != AMBE3000_START_BYTE) {
+        output(ANSI_RED "AMBEserver: unknown byte from the DV3000, 0x%02X" ANSI_WHITE, buffer[0U]);
+        return 1;
+    }
+
+    offset = 0U;
+    while (offset < (AMBE3000_HEADER_LEN - 1U)) {
+        len = read(serial_fd, buffer + 1U + offset, AMBE3000_HEADER_LEN - 1 - offset);
+
+        if (len == 0)
+            delay(5UL);
+
+        offset += len;
+    }
+
+    respLen = buffer[1U] * 256U + buffer[2U];
+
+    offset = 0U;
+    while (offset < respLen) {
+        len = read(serial_fd, buffer + AMBE3000_HEADER_LEN + offset, respLen - offset);
+
+        if (len == 0)
+            delay(5UL);
+
+        offset += len;
+    }
+
+    respLen += AMBE3000_HEADER_LEN;
+
+
+    dump("Serial data", buffer, respLen);
+
+    return 0;
+}
+

DSP_API/ThumbDV/thumbDV.h

@@ -0,0 +1,42 @@
+///*!   \file thumbdv.h
+// *    \brief Functions required to communicate and decode packets from ThumbDV
+// *
+// *    \copyright  Copyright 2012-2014 FlexRadio Systems.  All Rights Reserved.
+// *                Unauthorized use, duplication or distribution of this software is
+// *                strictly prohibited by law.
+// *
+// *    \date 26-MAY-2015
+// *    \author     Ed Gonzalez
+// *
+// *
+// */
+
+/* *****************************************************************************
+ *
+ *  Copyright (C) 2014 FlexRadio Systems.
+ *
+ *  This program is free software: you can redistribute it and/or modify
+ *  it under the terms of the GNU General Public License as published by
+ *  the Free Software Foundation, either version 3 of the License, or
+ *  (at your option) any later version.
+ *  This program is distributed in the hope that it will be useful,
+ *  but WITHOUT ANY WARRANTY; without even the implied warranty of
+ *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
+ *  GNU General Public License for more details.
+ *  You should have received a copy of the GNU General Public License
+ *  along with this program. If not, see <http://www.gnu.org/licenses/>.
+ *
+ *  Contact Information:
+ *  email: gpl<at>flexradiosystems.com
+ *  Mail:  FlexRadio Systems, Suite 1-150, 4616 W. Howard LN, Austin, TX 78728
+ *
+ * ************************************************************************** */
+
+
+#ifndef THUMBDV_THUMBDV_
+#define THUMBDV_THUMBDV_
+
+int openSerial(const char * tty_name);
+int processSerial(int serial_fd);
+
+#endif /* THUMBDV_THUMBDV_ */