diff options
Diffstat (limited to 'firmware/zpu/apps/txrx_uhd.c')
| -rw-r--r-- | firmware/zpu/apps/txrx_uhd.c | 386 |
1 files changed, 0 insertions, 386 deletions
diff --git a/firmware/zpu/apps/txrx_uhd.c b/firmware/zpu/apps/txrx_uhd.c deleted file mode 100644 index 30efc9518..000000000 --- a/firmware/zpu/apps/txrx_uhd.c +++ /dev/null @@ -1,386 +0,0 @@ -/* - * Copyright 2010-2012 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/>. - */ - -//peripheral headers -#include "u2_init.h" -#include "spi.h" -#include "i2c.h" -#include "hal_io.h" -#include "pic.h" - -//printf headers -#include "nonstdio.h" - -//network headers -#include "arp_cache.h" -#include "ethernet.h" -#include "net_common.h" -#include "usrp2/fw_common.h" -#include "udp_fw_update.h" -#include "pkt_ctrl.h" -#include "udp_uart.h" - -//standard headers -#include <stddef.h> -#include <stdlib.h> -#include <string.h> -#include <stdbool.h> - -#ifdef BOOTLOADER -#include <bootloader_utils.h> -#endif - -//virtual registers in the firmware to store persistent values -static uint32_t fw_regs[8]; - -static void handle_udp_data_packet( - struct socket_address src, struct socket_address dst, - unsigned char *payload, int payload_len -){ - //handle ICMP destination unreachable - if (payload == NULL) switch(src.port){ - case USRP2_UDP_RX_DSP0_PORT: - //reset dsp to stop streaming - sr_rx_ctrl0->clear = 1; - fw_regs[U2_FW_REG_LOCK_TIME] = 0; //force an unlock - return; - - case USRP2_UDP_RX_DSP1_PORT: - //reset dsp to stop streaming - sr_rx_ctrl1->clear = 1; - fw_regs[U2_FW_REG_LOCK_TIME] = 0; //force an unlock - return; - - case USRP2_UDP_TX_DSP0_PORT: - //end async update packets per second - sr_tx_ctrl->cyc_per_up = 0; - fw_regs[U2_FW_REG_LOCK_TIME] = 0; //force an unlock - return; - - default: return; - } - - //handle an incoming UDP packet - size_t which = 0; - if (payload != 0) switch(dst.port){ - case USRP2_UDP_RX_DSP0_PORT: - which = 0; - break; - - case USRP2_UDP_RX_DSP1_PORT: - which = 2; - break; - - case USRP2_UDP_TX_DSP0_PORT: - which = 1; - break; - - case USRP2_UDP_FIFO_CRTL_PORT: - which = 3; - break; - - default: return; - } - - //assume the packet destination is the packet source - //the arp cache lookup should never fail for this case - const struct socket_address src_addr = dst; - struct socket_address dst_addr = src; - eth_mac_addr_t eth_mac_dst; - arp_cache_lookup_mac(&dst_addr.addr, ð_mac_dst); - - //however, if this control packet has an alternative destination... - if (payload_len >= sizeof(usrp2_stream_ctrl_t)){ - - //parse the destination ip addr and udp port from the payload - const usrp2_stream_ctrl_t *stream_ctrl = (const usrp2_stream_ctrl_t *)payload; - dst_addr.addr.addr = stream_ctrl->ip_addr; - dst_addr.port = (uint16_t)stream_ctrl->udp_port; - struct ip_addr ip_dest = dst_addr.addr; - - //are we in the subnet? if not use the gateway - const uint32_t subnet_mask = get_subnet()->addr; - const bool in_subnet = ((get_ip_addr()->addr & subnet_mask) == (ip_dest.addr & subnet_mask)); - if (!in_subnet) ip_dest = *get_gateway(); - - //lookup the host ip address with ARP (this may fail) - const bool ok = arp_cache_lookup_mac(&ip_dest, ð_mac_dst); - if (!ok) net_common_send_arp_request(&ip_dest); - const uint32_t result = (ok)? 0 : ~0; - send_udp_pkt(dst.port, src, &result, sizeof(result)); - } - - setup_framer(eth_mac_dst, *ethernet_mac_addr(), dst_addr, src_addr, which); -} - -#define OTW_GPIO_BANK_TO_NUM(bank) \ - (((bank) == USRP2_DIR_RX)? (GPIO_RX_BANK) : (GPIO_TX_BANK)) - -static void handle_udp_ctrl_packet( - struct socket_address src, struct socket_address dst, - unsigned char *payload, int payload_len -){ - //printf("Got ctrl packet #words: %d\n", (int)payload_len); - const usrp2_ctrl_data_t *ctrl_data_in = (usrp2_ctrl_data_t *)payload; - uint32_t ctrl_data_in_id = ctrl_data_in->id; - - //ensure that the protocol versions match - if (payload_len >= sizeof(uint32_t) && ctrl_data_in->proto_ver != USRP2_FW_COMPAT_NUM){ - if (ctrl_data_in->proto_ver) printf("!Error in control packet handler: Expected compatibility number %d, but got %d\n", - USRP2_FW_COMPAT_NUM, ctrl_data_in->proto_ver - ); - ctrl_data_in_id = USRP2_CTRL_ID_WAZZUP_BRO; - } - - //ensure that this is not a short packet - if (payload_len < sizeof(usrp2_ctrl_data_t)){ - printf("!Error in control packet handler: Expected payload length %d, but got %d\n", - (int)sizeof(usrp2_ctrl_data_t), payload_len - ); - ctrl_data_in_id = USRP2_CTRL_ID_HUH_WHAT; - } - - //setup the output data - usrp2_ctrl_data_t ctrl_data_out; - ctrl_data_out.proto_ver = USRP2_FW_COMPAT_NUM; - ctrl_data_out.id=USRP2_CTRL_ID_HUH_WHAT; - ctrl_data_out.seq=ctrl_data_in->seq; - - //handle the data based on the id - switch(ctrl_data_in_id){ - - /******************************************************************* - * Addressing - ******************************************************************/ - case USRP2_CTRL_ID_WAZZUP_BRO: - ctrl_data_out.id = USRP2_CTRL_ID_WAZZUP_DUDE; - memcpy(&ctrl_data_out.data.ip_addr, get_ip_addr(), sizeof(struct ip_addr)); - break; - - /******************************************************************* - * SPI - ******************************************************************/ - case USRP2_CTRL_ID_TRANSACT_ME_SOME_SPI_BRO:{ - //transact - uint32_t result = spi_transact( - (ctrl_data_in->data.spi_args.readback == 0)? SPI_TXONLY : SPI_TXRX, - ctrl_data_in->data.spi_args.dev, //which device - ctrl_data_in->data.spi_args.data, //32 bit data - ctrl_data_in->data.spi_args.num_bits, //length in bits - ((ctrl_data_in->data.spi_args.mosi_edge == USRP2_CLK_EDGE_RISE)? SPI_PUSH_FALL : SPI_PUSH_RISE) | - ((ctrl_data_in->data.spi_args.miso_edge == USRP2_CLK_EDGE_RISE)? SPI_LATCH_RISE : SPI_LATCH_FALL) - ); - - //load output - ctrl_data_out.data.spi_args.data = result; - ctrl_data_out.id = USRP2_CTRL_ID_OMG_TRANSACTED_SPI_DUDE; - } - break; - - /******************************************************************* - * I2C - ******************************************************************/ - case USRP2_CTRL_ID_DO_AN_I2C_READ_FOR_ME_BRO:{ - uint8_t num_bytes = ctrl_data_in->data.i2c_args.bytes; - i2c_read( - ctrl_data_in->data.i2c_args.addr, - ctrl_data_out.data.i2c_args.data, - num_bytes - ); - ctrl_data_out.id = USRP2_CTRL_ID_HERES_THE_I2C_DATA_DUDE; - ctrl_data_out.data.i2c_args.bytes = num_bytes; - } - break; - - case USRP2_CTRL_ID_WRITE_THESE_I2C_VALUES_BRO:{ - uint8_t num_bytes = ctrl_data_in->data.i2c_args.bytes; - i2c_write( - ctrl_data_in->data.i2c_args.addr, - ctrl_data_in->data.i2c_args.data, - num_bytes - ); - ctrl_data_out.id = USRP2_CTRL_ID_COOL_IM_DONE_I2C_WRITE_DUDE; - ctrl_data_out.data.i2c_args.bytes = num_bytes; - } - break; - - /******************************************************************* - * Peek and Poke Register - ******************************************************************/ - case USRP2_CTRL_ID_GET_THIS_REGISTER_FOR_ME_BRO: - switch(ctrl_data_in->data.reg_args.action){ - case USRP2_REG_ACTION_FPGA_PEEK32: - ctrl_data_out.data.reg_args.data = *((uint32_t *) ctrl_data_in->data.reg_args.addr); - break; - - case USRP2_REG_ACTION_FPGA_PEEK16: - ctrl_data_out.data.reg_args.data = *((uint16_t *) ctrl_data_in->data.reg_args.addr); - break; - - case USRP2_REG_ACTION_FPGA_POKE32: - *((uint32_t *) ctrl_data_in->data.reg_args.addr) = (uint32_t)ctrl_data_in->data.reg_args.data; - break; - - case USRP2_REG_ACTION_FPGA_POKE16: - *((uint16_t *) ctrl_data_in->data.reg_args.addr) = (uint16_t)ctrl_data_in->data.reg_args.data; - break; - - case USRP2_REG_ACTION_FW_PEEK32: - ctrl_data_out.data.reg_args.data = fw_regs[(ctrl_data_in->data.reg_args.addr)]; - break; - - case USRP2_REG_ACTION_FW_POKE32: - fw_regs[(ctrl_data_in->data.reg_args.addr)] = ctrl_data_in->data.reg_args.data; - break; - - } - ctrl_data_out.id = USRP2_CTRL_ID_OMG_GOT_REGISTER_SO_BAD_DUDE; - break; - - /******************************************************************* - * Echo test - ******************************************************************/ - case USRP2_CTRL_ID_HOLLER_AT_ME_BRO: - ctrl_data_out.data.echo_args.len = payload_len; - ctrl_data_out.id = USRP2_CTRL_ID_HOLLER_BACK_DUDE; - send_udp_pkt(USRP2_UDP_CTRL_PORT, src, &ctrl_data_out, ctrl_data_in->data.echo_args.len); - return; - - default: - ctrl_data_out.id = USRP2_CTRL_ID_HUH_WHAT; - } - send_udp_pkt(USRP2_UDP_CTRL_PORT, src, &ctrl_data_out, sizeof(ctrl_data_out)); -} - -#include <net/padded_eth_hdr.h> -static void handle_inp_packet(uint32_t *buff, size_t num_lines){ - - //test if its an ip recovery packet - typedef struct{ - padded_eth_hdr_t eth_hdr; - char code[4]; - union { - struct ip_addr ip_addr; - } data; - }recovery_packet_t; - recovery_packet_t *recovery_packet = (recovery_packet_t *)buff; - if (recovery_packet->eth_hdr.ethertype == 0xbeee && strncmp(recovery_packet->code, "addr", 4) == 0){ - printf("Got ip recovery packet: "); print_ip_addr(&recovery_packet->data.ip_addr); newline(); - set_ip_addr(&recovery_packet->data.ip_addr); - return; - } - - //pass it to the slow-path handler - handle_eth_packet(buff, num_lines); -} - -//------------------------------------------------------------------ - -/* - * Called when eth phy state changes (w/ interrupts disabled) - */ -void link_changed_callback(int speed){ - printf("\neth link changed: speed = %d\n", speed); - if (speed != 0){ - hal_set_leds(LED_RJ45, LED_RJ45); - pkt_ctrl_set_routing_mode(PKT_CTRL_ROUTING_MODE_MASTER); - send_gratuitous_arp(); - } - else{ - hal_set_leds(0x0, LED_RJ45); - pkt_ctrl_set_routing_mode(PKT_CTRL_ROUTING_MODE_SLAVE); - } -} - -int -main(void) -{ - u2_init(); - arp_cache_init(); -#ifdef BOOTLOADER - putstr("\nUSRP N210 UDP bootloader\n"); -#else - putstr("\nTxRx-UHD-ZPU\n"); -#endif - printf("FPGA compatibility number: %d\n", USRP2_FPGA_COMPAT_NUM); - printf("Firmware compatibility number: %d\n", USRP2_FW_COMPAT_NUM); - - //init readback for firmware minor version number - fw_regs[U2_FW_REG_VER_MINOR] = USRP2_FW_VER_MINOR; - -#ifdef BOOTLOADER - //load the production FPGA image or firmware if appropriate - do_the_bootload_thing(); - //if we get here we've fallen through to safe firmware - eth_addrs_set_default(); -#endif - - print_mac_addr(ethernet_mac_addr()); newline(); - print_ip_addr(get_ip_addr()); newline(); - - //1) register the addresses into the network stack - register_addrs(ethernet_mac_addr(), get_ip_addr()); - pkt_ctrl_program_inspector(get_ip_addr(), USRP2_UDP_TX_DSP0_PORT); - - //2) register callbacks for udp ports we service - init_udp_listeners(); - register_udp_listener(USRP2_UDP_CTRL_PORT, handle_udp_ctrl_packet); - register_udp_listener(USRP2_UDP_RX_DSP0_PORT, handle_udp_data_packet); - register_udp_listener(USRP2_UDP_RX_DSP1_PORT, handle_udp_data_packet); - register_udp_listener(USRP2_UDP_TX_DSP0_PORT, handle_udp_data_packet); - register_udp_listener(USRP2_UDP_FIFO_CRTL_PORT, handle_udp_data_packet); - -#ifdef USRP2P - register_udp_listener(USRP2_UDP_UPDATE_PORT, handle_udp_fw_update_packet); -#endif - - udp_uart_init(USRP2_UDP_UART_BASE_PORT); //setup uart messaging - - //3) set the routing mode to slave to set defaults - pkt_ctrl_set_routing_mode(PKT_CTRL_ROUTING_MODE_SLAVE); - - //4) setup ethernet hardware to bring the link up - ethernet_register_link_changed_callback(link_changed_callback); - ethernet_init(); - - while(true){ - - size_t num_lines; - void *buff = pkt_ctrl_claim_incoming_buffer(&num_lines); - if (buff != NULL){ - handle_inp_packet((uint32_t *)buff, num_lines); - pkt_ctrl_release_incoming_buffer(); - } - - udp_uart_poll(); //uart message handling - - pic_interrupt_handler(); - /* - int pending = pic_regs->pending; // poll for under or overrun - - if (pending & PIC_UNDERRUN_INT){ - pic_regs->pending = PIC_UNDERRUN_INT; // clear interrupt - putchar('U'); - } - - if (pending & PIC_OVERRUN_INT){ - pic_regs->pending = PIC_OVERRUN_INT; // clear interrupt - putchar('O'); - } - */ - } -} |