aboutsummaryrefslogtreecommitdiffstats
path: root/firmware/zpu/lib/udp_uart.c
diff options
context:
space:
mode:
Diffstat (limited to 'firmware/zpu/lib/udp_uart.c')
-rw-r--r--firmware/zpu/lib/udp_uart.c115
1 files changed, 115 insertions, 0 deletions
diff --git a/firmware/zpu/lib/udp_uart.c b/firmware/zpu/lib/udp_uart.c
new file mode 100644
index 000000000..6f6b9ee91
--- /dev/null
+++ b/firmware/zpu/lib/udp_uart.c
@@ -0,0 +1,115 @@
+/*
+ * Copyright 2011 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 "udp_uart.h"
+#include "hal_uart.h"
+#include "net_common.h"
+#include "compiler.h"
+#include <stdbool.h>
+
+/***********************************************************************
+ * Constants
+ **********************************************************************/
+#define MAX_NUM_UARTS 4
+#ifndef UDP_UART_MASK
+ #error missing definition for UDP_UART_MASK enable mask
+#endif
+static const size_t num_idle_cyc_b4_flush = 11; //small but lucky number
+
+/***********************************************************************
+ * Globals
+ **********************************************************************/
+static uint16_t _base_port;
+
+typedef struct{
+ struct socket_address dst;
+ _AL4 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];
+
+/***********************************************************************
+ * UDP handler for UARTs
+ **********************************************************************/
+static void handle_uart_data_packet(
+ struct socket_address src, struct socket_address dst,
+ unsigned char *payload, int payload_len
+){
+ //handle ICMP destination unreachable
+ if (payload == NULL){
+ const size_t which = src.port-_base_port;
+ if (which >= MAX_NUM_UARTS) return;
+ _states[which].dst.port = 0;
+ }
+
+ //handle a regular blocking UART write
+ else{
+ const size_t which = dst.port-_base_port;
+ if (which >= MAX_NUM_UARTS) return;
+ _states[which].dst = src;
+ for (size_t i = 0; i < payload_len; i++){
+ hal_uart_putc((hal_uart_name_t)which, (int)payload[i]);
+ }
+ }
+}
+
+/***********************************************************************
+ * Public init function
+ **********************************************************************/
+void udp_uart_init(const uint16_t base_port){
+ _base_port = base_port;
+ for(size_t i = 0; i < MAX_NUM_UARTS; i++){
+ _states[i].dst.port = 0; //reset to null port
+ _states[i].len = 0;
+ _states[i].cyc = 0;
+ register_udp_listener(_base_port+i, handle_uart_data_packet);
+ }
+}
+
+/***********************************************************************
+ * Public poll function
+ **********************************************************************/
+void udp_uart_poll(void){
+ for (size_t i = 0; i < MAX_NUM_UARTS; i++){
+ if (((UDP_UART_MASK) & (1 << i)) == 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(_states[0].buf); j++){
+ uint8_t ch = hal_uart_getc_noblock((hal_uart_name_t)i);
+ if (ch == 255) break;
+ 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->dst.port != 0) send_udp_pkt(_base_port+i, state->dst, state->buf, state->len);
+ state->len = 0;
+ state->cyc = 0;
+ }
+ }
+}