mirror of
https://github.com/logicog/RTLPlayground.git
synced 2026-08-30 14:52:51 +08:00
Make RX of packets work
This commit is contained in:
+5
-5
@@ -81,10 +81,10 @@ __sfr __at(0xa9) SFR_FLASH_ADDR0;
|
||||
|
||||
/*
|
||||
* NIC Interface
|
||||
* CAREFUL: This is now Little Endian
|
||||
*/
|
||||
|
||||
__sfr __at(0xb7) SFR_NIC_CTRL;
|
||||
__sfr __at(0xb3) SFR_NIC_DATA_H;
|
||||
__sfr __at(0xb4) SFR_NIC_DATA_L;
|
||||
__sfr __at(0xb5) SFR_NIC_DATA_X;
|
||||
__sfr __at(0xb5) SFR_NIC_DATA_Y;
|
||||
__sfr __at(0xb3) SFR_NIC_DATA_L;
|
||||
__sfr __at(0xb4) SFR_NIC_DATA_H;
|
||||
__sfr __at(0xb5) SFR_NIC_RING_L;
|
||||
__sfr __at(0xb6) SFR_NIC_RING_H;
|
||||
|
||||
@@ -50,6 +50,8 @@ __code uint8_t * __code greeting = "\r\nA minimal prompt to explore the RTL8372!
|
||||
__code uint8_t * __code hex = "0123456789abcdef";
|
||||
|
||||
__xdata uint8_t flash_buf[256];
|
||||
__xdata uint8_t rx_headers[32];
|
||||
__xdata uint8_t rx_buf[1024];
|
||||
|
||||
__code uint16_t bit_mask[16] = {
|
||||
0x0001, 0x0002, 0x0004,0x0008,0x0010,0x0020,0x0040, 0x0080,
|
||||
@@ -330,6 +332,44 @@ void sfr_mask_data(uint8_t n, uint8_t mask, uint8_t set)
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* Transfer Network Interface RX data from the ASIC to the 8051 XMEM
|
||||
* data will be stored in the rx_header structure
|
||||
* len is the length of data to be transferred
|
||||
*/
|
||||
void nic_rx_header(uint16_t ring_ptr)
|
||||
{
|
||||
uint16_t buffer = (uint16_t) rx_headers,
|
||||
SFR_NIC_DATA_H = buffer >> 8;
|
||||
SFR_NIC_DATA_L = buffer;
|
||||
SFR_NIC_RING_L = ring_ptr;
|
||||
SFR_NIC_RING_H = ring_ptr >> 8;
|
||||
SFR_NIC_CTRL = 1;
|
||||
do { } while (SFR_NIC_CTRL != 0);
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* Transfer Network Interface RX data from the ASIC to the 8051 XMEM
|
||||
* the description of the packet must be in the rx_headers data structure
|
||||
* data will be returned in the xmem buffer points to
|
||||
* ring_ptr is the current position of the RX Ring on the ASIC side
|
||||
*/
|
||||
void nic_rx_packet(uint16_t buffer, uint16_t ring_ptr)
|
||||
{
|
||||
SFR_NIC_DATA_H = buffer >> 8;
|
||||
SFR_NIC_DATA_L = buffer;
|
||||
SFR_NIC_RING_L = ring_ptr;
|
||||
SFR_NIC_RING_H = ring_ptr >> 8;
|
||||
uint16_t len = (((uint16_t)rx_headers[5]) << 8) | rx_headers[4];
|
||||
len += 7;
|
||||
len >>= 3;
|
||||
print_string(" len: ");
|
||||
print_short(len);
|
||||
SFR_NIC_CTRL = len;
|
||||
do { } while (SFR_NIC_CTRL != 0);
|
||||
}
|
||||
|
||||
/* Read flash using the MMIO capabilities of the DW8051 core
|
||||
* Bank is < 0x3f and is the MSB
|
||||
* addr gives the address in the bank
|
||||
@@ -645,6 +685,43 @@ uint8_t sfp_read_reg(uint8_t reg)
|
||||
}
|
||||
|
||||
|
||||
void handle_rx(void)
|
||||
{
|
||||
reg_read_m(0x7874);
|
||||
if (sfr_data[3] != 0) {
|
||||
print_string("\r\nrx:");
|
||||
print_long_x(sfr_data);
|
||||
reg_read_m(0x787c);
|
||||
print_string(", ");
|
||||
print_long_x(sfr_data);
|
||||
uint16_t ring_ptr = ((uint16_t)sfr_data[2]) << 8;
|
||||
ring_ptr |= sfr_data[3];
|
||||
ring_ptr <<= 3;
|
||||
print_string(", ring_ptr: ");
|
||||
print_short(ring_ptr);
|
||||
nic_rx_header(ring_ptr);
|
||||
__xdata uint8_t *ptr = rx_headers;
|
||||
print_string(": ");
|
||||
for (uint8_t i = 0; i < 8; i++) {
|
||||
print_byte(*ptr++);
|
||||
write_char(' ');
|
||||
}
|
||||
|
||||
nic_rx_packet((uint16_t) rx_buf, ring_ptr + 8);
|
||||
print_string("\r\n> ");
|
||||
ptr = rx_buf;
|
||||
for (uint8_t i = 0; i < 80; i++) {
|
||||
print_byte(*ptr++);
|
||||
write_char(' ');
|
||||
}
|
||||
|
||||
sfr_data[0] = sfr_data[1] = sfr_data[2] = 0;
|
||||
sfr_data[3] = 0x1;
|
||||
reg_write_m(0x784c);
|
||||
reg_write_m(0x7850);
|
||||
}
|
||||
}
|
||||
|
||||
//
|
||||
// An idle function that sleeps for 1 tick and does all the house-keeping
|
||||
//
|
||||
@@ -732,6 +809,9 @@ void idle(void)
|
||||
sfp_pins_last |= 0x02;
|
||||
print_string("\r\n<RX LOS>\r\n");
|
||||
}
|
||||
|
||||
// Check new Packets RX
|
||||
handle_rx();
|
||||
}
|
||||
|
||||
|
||||
|
||||
Reference in New Issue
Block a user