git.gag.com Git - debian/gnuradio/blob - usrp2/firmware/apps/app_passthru_v2.c

   1 /* -*- c++ -*- */
   2 /*
   3  * Copyright 2007,2008 Free Software Foundation, Inc.
   4  *
   5  * This program is free software: you can redistribute it and/or modify
   6  * it under the terms of the GNU General Public License as published by
   7  * the Free Software Foundation, either version 3 of the License, or
   8  * (at your option) any later version.
   9  *
  10  * This program is distributed in the hope that it will be useful,
  11  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  12  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  13  * GNU General Public License for more details.
  14  *
  15  * You should have received a copy of the GNU General Public License
  16  * along with this program.  If not, see <http://www.gnu.org/licenses/>.
  17  */
  18
  19 #ifdef HAVE_CONFIG_H
  20 #include "config.h"
  21 #endif
  22
  23 #include "app_passthru_v2.h"
  24 #include "buffer_pool.h"
  25 #include "memcpy_wa.h"
  26 #include "ethernet.h"
  27 #include "nonstdio.h"
  28 #include "print_rmon_regs.h"
  29 #include "db.h"
  30 #include "clocks.h"
  31 #include <string.h>
  32
  33 volatile bool link_is_up = false;       // eth handler sets this
  34
  35
  36 // If this is non-zero, this dbsm could be writing to the ethernet
  37 dbsm_t *ac_could_be_sending_to_eth;
  38
  39 //static unsigned char exp_seqno = 0;
  40
  41 void
  42 set_reply_hdr(u2_eth_packet_t *reply_pkt, u2_eth_packet_t const *cmd_pkt)
  43 {
  44   reply_pkt->ehdr.dst = cmd_pkt->ehdr.src;
  45   reply_pkt->ehdr.ethertype = U2_ETHERTYPE;
  46   reply_pkt->thdr.flags = 0;
  47   reply_pkt->thdr.fifo_status = 0;      // written by protocol engine
  48   reply_pkt->thdr.seqno = 0;            // written by protocol engine
  49   reply_pkt->thdr.ack = 0;              // written by protocol engine
  50   u2p_set_word0(&reply_pkt->fixed, 0, CONTROL_CHAN);
  51   reply_pkt->fixed.timestamp = timer_regs->time;
  52 }
  53
  54 static void
  55 send_reply(unsigned char *reply, size_t reply_len)
  56 {
  57   if (reply_len < 64)
  58     reply_len = 64;
  59
  60   // wait for buffer to become idle
  61   hal_set_leds(0x4, 0x4);
  62   while((buffer_pool_status->status & BPS_IDLE(CPU_TX_BUF)) == 0)
  63     ;
  64   hal_set_leds(0x0, 0x4);
  65
  66   // copy reply into CPU_TX_BUF
  67   memcpy_wa(buffer_ram(CPU_TX_BUF), reply, reply_len);
  68
  69   // wait until nobody else is sending to the ethernet
  70   if (ac_could_be_sending_to_eth){
  71     hal_set_leds(0x8, 0x8);
  72     dbsm_wait_for_opening(ac_could_be_sending_to_eth);
  73     hal_set_leds(0x0, 0x8);
  74   }
  75
  76   // fire it off
  77   bp_send_from_buf(CPU_TX_BUF, PORT_ETH, 1, 0, reply_len/4);
  78
  79   // wait for it to complete (not long, it's a small pkt)
  80   while((buffer_pool_status->status & (BPS_DONE(CPU_TX_BUF) | BPS_ERROR(CPU_TX_BUF))) == 0)
  81     ;
  82
  83   bp_clear_buf(CPU_TX_BUF);
  84 }
  85
  86
  87 static size_t
  88 op_id_cmd(const op_generic_t *p,
  89           void *reply_payload, size_t reply_payload_space)
  90 {
  91   op_id_reply_t *r = (op_id_reply_t *) reply_payload;
  92   if (reply_payload_space < sizeof(*r)) // no room
  93     return 0;
  94
  95   // Build reply subpacket
  96
  97   r->opcode = OP_ID_REPLY;
  98   r->len = sizeof(op_id_reply_t);
  99   r->rid = p->rid;
 100   r->addr = *ethernet_mac_addr();
 101   r->hw_rev = 0x0000;   // FIXME
 102   // r->fpga_md5sum = ; // FIXME
 103   // r->sw_md5sum = ;   // FIXME
 104
 105   // FIXME Add d'board info, including dbid, min/max gain, min/max freq
 106
 107   return r->len;
 108 }
 109
 110 static size_t
 111 add_eop(void *reply_payload, size_t reply_payload_space)
 112 {
 113   op_generic_t *r = (op_generic_t *) reply_payload;
 114   if (reply_payload_space < sizeof(*r))
 115     return 0;                                   // no room
 116
 117   r->opcode = OP_EOP;
 118   r->len = sizeof(*r);
 119   r->rid = 0;
 120   r->ok =  0;
 121
 122   return r->len;
 123 }
 124
 125 bool
 126 handle_control_chan_frame(u2_eth_packet_t *pkt, size_t len)
 127 {
 128   unsigned char reply[sizeof(u2_eth_packet_t) + 4 * sizeof(u2_subpkt_t)] _AL4;
 129   unsigned char *reply_payload = &reply[sizeof(u2_eth_packet_t)];
 130   int reply_payload_space = sizeof(reply) - sizeof(u2_eth_packet_t);
 131
 132   bool handled_it = false;
 133
 134   // initialize reply
 135   memset(reply, 0, sizeof(reply));
 136   set_reply_hdr((u2_eth_packet_t *) reply, pkt);
 137
 138   // point to beginning of payload (subpackets)
 139   unsigned char *payload = ((unsigned char *) pkt) + sizeof(u2_eth_packet_t);
 140   int payload_len = len - sizeof(u2_eth_packet_t);
 141
 142   size_t subpktlen = 0;
 143
 144   while (payload_len >= sizeof(op_generic_t)){
 145     const op_generic_t *gp = (const op_generic_t *) payload;
 146     subpktlen = 0;
 147
 148     switch(gp->opcode){
 149     case OP_EOP:                // end of subpackets
 150       goto end_of_subpackets;
 151
 152     case OP_ID:
 153       subpktlen = op_id_cmd(gp, reply_payload, reply_payload_space);
 154       handled_it = true;
 155       break;
 156
 157     default:
 158       if (0){
 159         printf("\npassing on %d\n", gp->opcode);
 160       }
 161       break;
 162     }
 163
 164     int t = (gp->len + 3) & ~3;         // bump to a multiple of 4
 165     payload += t;
 166     payload_len -= t;
 167
 168     subpktlen = (subpktlen + 3) & ~3;   // bump to a multiple of 4
 169     reply_payload += subpktlen;
 170     reply_payload_space -= subpktlen;
 171   }
 172
 173  end_of_subpackets:
 174
 175   if (handled_it){
 176     // add the EOP marker
 177     subpktlen = add_eop(reply_payload, reply_payload_space);
 178     subpktlen = (subpktlen + 3) & ~3;   // bump to a multiple of 4
 179     reply_payload += subpktlen;
 180     reply_payload_space -= subpktlen;
 181
 182     send_reply(reply, reply_payload - reply);
 183   }
 184
 185   return handled_it;
 186 }
 187
 188
 189 /*
 190  * Called when an ethernet packet is received.
 191  * Return true if we handled it here, otherwise
 192  * it'll be passed on to the DSP Tx pipe
 193  */
 194 bool
 195 eth_pkt_inspector(dbsm_t *sm, int bufno)
 196 {
 197   u2_eth_packet_t *pkt = (u2_eth_packet_t *) buffer_ram(bufno);
 198   size_t byte_len = (buffer_pool_status->last_line[bufno] - 3) * 4;
 199
 200   //static size_t last_len = 0;
 201
 202   // hal_toggle_leds(0x1);
 203
 204   // inspect rcvd frame and figure out what do do.
 205
 206   if (pkt->ehdr.ethertype != U2_ETHERTYPE)
 207     return true;        // ignore, probably bogus PAUSE frame from MAC
 208
 209   int chan = u2p_chan(&pkt->fixed);
 210
 211   switch (chan){
 212   case CONTROL_CHAN:
 213     return handle_control_chan_frame(pkt, byte_len);
 214     break;
 215
 216   case 0:
 217   default:
 218 #if 0
 219     if (last_len != 0){
 220       if (byte_len != last_len){
 221         printf("Len: %d last: %d\n", byte_len, last_len);
 222       }
 223     }
 224     last_len = byte_len;
 225
 226     if((pkt->thdr.seqno) == exp_seqno){
 227       exp_seqno++;
 228       //putchar('.');
 229     }
 230     else {
 231       // putchar('S');
 232       //printf("S%d %d ",exp_seqno,pkt->thdr.seqno);
 233       exp_seqno = pkt->thdr.seqno + 1;
 234     }
 235 #endif
 236     return false;       // pass it on to Tx DSP
 237     break;
 238   }
 239 }
 240
 241 /*
 242  * Called when eth phy state changes (w/ interrupts disabled)
 243  */
 244 void
 245 link_changed_callback(int speed)
 246 {
 247   link_is_up = speed != 0;
 248   hal_set_leds(link_is_up ? LED_RJ45 : 0x0, LED_RJ45);
 249   printf("\neth link changed: speed = %d\n", speed);
 250 }