aboutsummaryrefslogtreecommitdiffstats
path: root/firmware/x300/lib/udp_uart.c
diff options
context:
space:
mode:
Diffstat (limited to 'firmware/x300/lib/udp_uart.c')
-rw-r--r--firmware/x300/lib/udp_uart.c149
1 files changed, 0 insertions, 149 deletions
diff --git a/firmware/x300/lib/udp_uart.c b/firmware/x300/lib/udp_uart.c
deleted file mode 100644
index d078aa2c3..000000000
--- a/firmware/x300/lib/udp_uart.c
+++ /dev/null
@@ -1,149 +0,0 @@
-/*
- * Copyright 2011-2013 Ettus Research LLC
- *
- * 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/>.
- */
-
-#include <wb_uart.h>
-#include <udp_uart.h>
-#include <u3_net_stack.h>
-
-/***********************************************************************
- * Constants
- **********************************************************************/
-#define MAX_NUM_UARTS 4
-
-static const size_t num_idle_cyc_b4_flush = 22;
-
-/***********************************************************************
- * Globals
- **********************************************************************/
-typedef struct
-{
- uint32_t uart_base;
- struct ip_addr host_addr;
- int host_ethno;
- uint16_t host_port;
- uint16_t local_port;
- __attribute__ ((aligned (16))) uint8_t buf[256];
- size_t len; //length of buffer
- size_t cyc; //idle cycle count
-} udp_uart_state_t;
-
-static udp_uart_state_t _states[MAX_NUM_UARTS];
-
-static int udp_uart_lookup(const uint16_t port)
-{
- for (size_t i = 0; i < MAX_NUM_UARTS; i++)
- {
- if (_states[i].local_port == port) return i;
- }
- return -1;
-}
-
-/***********************************************************************
- * UDP handler for UARTs
- **********************************************************************/
-static void handle_uart_data_packet(
- const uint8_t ethno,
- const struct ip_addr *src, const struct ip_addr *dst,
- const uint16_t src_port, const uint16_t dst_port,
- const void *buff, const size_t num_bytes
-){
- //handle ICMP destination unreachable
- if (buff == NULL)
- {
- const size_t which = udp_uart_lookup(src_port);
- if (which == -1) return;
- _states[which].host_port = 0;
- }
-
- //handle a regular blocking UART write
- else
- {
- const size_t which = udp_uart_lookup(dst_port);
- if (which == -1) return;
- _states[which].host_ethno = ethno;
- _states[which].host_addr = *src;
- _states[which].host_port = src_port;
- for (size_t i = 0; i < num_bytes; i++)
- {
- const char ch = ((const char *)buff)[i];
- if (ch == '\n') wb_uart_putc(_states[which].uart_base, (int)'\r');
- wb_uart_putc(_states[which].uart_base, (int)ch);
- udp_uart_poll();
- }
- }
-}
-
-/***********************************************************************
- * Public init function
- **********************************************************************/
-void udp_uart_init(const uint32_t uart_base, const uint16_t udp_port)
-{
- for (size_t i = 0; i < MAX_NUM_UARTS; i++)
- {
- if (_states[i].uart_base != 0) continue;
- _states[i].uart_base = uart_base;
- _states[i].local_port = udp_port;
- _states[i].host_port = 0; //reset to null port
- _states[i].len = 0;
- _states[i].cyc = 0;
- u3_net_stack_register_udp_handler(udp_port, &handle_uart_data_packet);
- return;
- }
-}
-
-/***********************************************************************
- * Public poll function
- **********************************************************************/
-void udp_uart_poll(void)
-{
- for (size_t i = 0; i < MAX_NUM_UARTS; i++)
- {
- if (_states[i].uart_base == 0) continue;
-
- bool newline = false;
- udp_uart_state_t *state = &_states[i];
-
- //read all characters we can without blocking
- for (size_t j = state->len; j < sizeof(state->buf); j++)
- {
- int ret = wb_uart_getc(state->uart_base);
- if (ret == -1) break;
- char ch = (char) ret;
- if (ch == '\n' || ch == '\r') newline = true;
- state->buf[j] = ch;
- state->len++;
- state->cyc = 0; //reset idle cycles
- }
-
- //nothing in buffer, continue to next uart
- if (state->len == 0) continue;
-
- //send out a message if newline or forced flush
- if (newline || state->cyc++ > num_idle_cyc_b4_flush)
- {
- if (state->host_port != 0) u3_net_stack_send_udp_pkt(
- state->host_ethno,
- &state->host_addr,
- state->local_port,
- state->host_port,
- state->buf, state->len
- );
- state->len = 0;
- state->cyc = 0;
- }
- }
-}