Changes in uspace/drv/nic/e1k/e1k.c [d81eaf94:ec52752] in mainline
- File:
-
- 1 edited
Legend:
- Unmodified
- Added
- Removed
-
uspace/drv/nic/e1k/e1k.c
rd81eaf94 rec52752 52 52 #include <nil_remote.h> 53 53 #include <ops/nic.h> 54 #include <packet_client.h> 55 #include <packet_remote.h> 56 #include <net/packet_header.h> 54 57 #include "e1k.h" 55 58 … … 59 62 60 63 /* Must be power of 8 */ 61 #define E1000_RX_ FRAME_COUNT 12862 #define E1000_TX_ FRAME_COUNT 12864 #define E1000_RX_PACKETS_COUNT 128 65 #define E1000_TX_PACKETS_COUNT 128 63 66 64 67 #define E1000_RECEIVE_ADDRESS 16 65 68 66 /** Maximum sending framesize */69 /** Maximum sending packet size */ 67 70 #define E1000_MAX_SEND_FRAME_SIZE 2048 68 /** Maximum receiving framesize */69 #define E1000_MAX_RECEIVE_ FRAME_SIZE 204871 /** Maximum receiving packet size */ 72 #define E1000_MAX_RECEIVE_PACKET_SIZE 2048 70 73 71 74 /** nic_driver_data_t* -> e1000_t* cast */ … … 134 137 void *rx_ring_virt; 135 138 136 /** Ring of RX frames, physical address */ 137 void **rx_frame_phys; 138 /** Ring of RX frames, virtual address */ 139 void **rx_frame_virt; 139 /** Packets in rx ring */ 140 packet_t **rx_ring_packets; 140 141 141 142 /** VLAN tag */ 142 143 uint16_t vlan_tag; 143 144 144 /** Add VLAN tag to frame*/145 /** Add VLAN tag to packet */ 145 146 bool vlan_tag_add; 146 147 … … 227 228 static int e1000_on_stopping(nic_t *); 228 229 static void e1000_send_frame(nic_t *, void *, size_t); 230 231 /** PIO ranges used in the IRQ code. */ 232 irq_pio_range_t e1000_irq_pio_ranges[] = { 233 { 234 .base = 0, 235 .size = PAGE_SIZE, /* XXX */ 236 } 237 }; 229 238 230 239 /** Commands to deal with interrupt … … 256 265 /** Interrupt code definition */ 257 266 irq_code_t e1000_irq_code = { 267 .rangecount = sizeof(e1000_irq_pio_ranges) / 268 sizeof(irq_pio_range_t), 269 .ranges = e1000_irq_pio_ranges, 258 270 .cmdcount = sizeof(e1000_irq_commands) / sizeof(irq_cmd_t), 259 271 .cmds = e1000_irq_commands … … 476 488 } 477 489 478 /** Get state of acceptance of weird frames490 /** Get state of acceptance of weird packets 479 491 * 480 492 * @param device Device to check … … 494 506 }; 495 507 496 /** Set acceptance of weird frames508 /** Set acceptance of weird packets 497 509 * 498 510 * @param device Device to update … … 678 690 } 679 691 680 /** Disable receiving frames for default address692 /** Disable receiving packets for default address 681 693 * 682 694 * @param e1000 E1000 data structure … … 690 702 } 691 703 692 /** Enable receiving frames for default address704 /** Enable receiving packets for default address 693 705 * 694 706 * @param e1000 E1000 data structure … … 750 762 } 751 763 752 /** Enable accepting of broadcast frames764 /** Enable accepting of broadcast packets 753 765 * 754 766 * @param e1000 E1000 data structure … … 762 774 } 763 775 764 /** Disable accepting of broadcast frames776 /** Disable accepting of broadcast packets 765 777 * 766 778 * @param e1000 E1000 data structure … … 798 810 } 799 811 800 /** Set multicast frames acceptance mode812 /** Set multicast packets acceptance mode 801 813 * 802 814 * @param nic NIC device to update … … 852 864 } 853 865 854 /** Set unicast frames acceptance mode866 /** Set unicast packets acceptance mode 855 867 * 856 868 * @param nic NIC device to update … … 910 922 } 911 923 912 /** Set broadcast frames acceptance mode924 /** Set broadcast packets acceptance mode 913 925 * 914 926 * @param nic NIC device to update … … 995 1007 if (vlan_mask) { 996 1008 /* 997 * Disable receiving, so that framematching1009 * Disable receiving, so that packet matching 998 1010 * partially written VLAN is not received. 999 1011 */ … … 1062 1074 } 1063 1075 1064 /** Fill receive descriptor with new empty buffer1065 * 1066 * Store frame in e1000->rx_frame_phys1076 /** Fill receive descriptor with new empty packet 1077 * 1078 * Store packet in e1000->rx_ring_packets 1067 1079 * 1068 1080 * @param nic NIC data stricture … … 1073 1085 { 1074 1086 e1000_t *e1000 = DRIVER_DATA_NIC(nic); 1075 1087 packet_t *packet = 1088 nic_alloc_packet(nic, E1000_MAX_RECEIVE_PACKET_SIZE); 1089 1090 assert(packet); 1091 1092 *(e1000->rx_ring_packets + offset) = packet; 1076 1093 e1000_rx_descriptor_t *rx_descriptor = (e1000_rx_descriptor_t *) 1077 1094 (e1000->rx_ring_virt + offset * sizeof(e1000_rx_descriptor_t)); 1078 1095 1079 rx_descriptor->phys_addr = PTR_TO_U64(e1000->rx_frame_phys[offset]); 1096 void *phys; 1097 int rc = 1098 nic_dma_lock_packet(packet, E1000_MAX_RECEIVE_PACKET_SIZE, &phys); 1099 1100 if (rc == EOK) 1101 rx_descriptor->phys_addr = PTR_TO_U64(phys + packet->data_start); 1102 else 1103 rx_descriptor->phys_addr = 0; 1104 1080 1105 rx_descriptor->length = 0; 1081 1106 rx_descriptor->checksum = 0; … … 1141 1166 } 1142 1167 1143 /** Receive frames1168 /** Receive packets 1144 1169 * 1145 1170 * @param nic NIC data 1146 1171 * 1147 1172 */ 1148 static void e1000_receive_ frames(nic_t *nic)1173 static void e1000_receive_packets(nic_t *nic) 1149 1174 { 1150 1175 e1000_t *e1000 = DRIVER_DATA_NIC(nic); … … 1153 1178 1154 1179 uint32_t *tail_addr = E1000_REG_ADDR(e1000, E1000_RDT); 1155 uint32_t next_tail = e1000_inc_tail(*tail_addr, E1000_RX_ FRAME_COUNT);1180 uint32_t next_tail = e1000_inc_tail(*tail_addr, E1000_RX_PACKETS_COUNT); 1156 1181 1157 1182 e1000_rx_descriptor_t *rx_descriptor = (e1000_rx_descriptor_t *) … … 1159 1184 1160 1185 while (rx_descriptor->status & 0x01) { 1161 uint32_t frame_size = rx_descriptor->length - E1000_CRC_SIZE;1186 uint32_t packet_size = rx_descriptor->length - E1000_CRC_SIZE; 1162 1187 1163 nic_frame_t *frame = nic_alloc_frame(nic, frame_size); 1164 if (frame != NULL) { 1165 memcpy(frame->data, e1000->rx_frame_virt[next_tail], frame_size); 1166 nic_received_frame(nic, frame); 1167 } else { 1168 ddf_msg(LVL_ERROR, "Memory allocation failed. Frame dropped."); 1169 } 1188 packet_t *packet = *(e1000->rx_ring_packets + next_tail); 1189 packet_suffix(packet, packet_size); 1190 1191 nic_dma_unlock_packet(packet, E1000_MAX_RECEIVE_PACKET_SIZE); 1192 nic_received_packet(nic, packet); 1170 1193 1171 1194 e1000_fill_new_rx_descriptor(nic, next_tail); 1172 1195 1173 *tail_addr = e1000_inc_tail(*tail_addr, E1000_RX_ FRAME_COUNT);1174 next_tail = e1000_inc_tail(*tail_addr, E1000_RX_ FRAME_COUNT);1196 *tail_addr = e1000_inc_tail(*tail_addr, E1000_RX_PACKETS_COUNT); 1197 next_tail = e1000_inc_tail(*tail_addr, E1000_RX_PACKETS_COUNT); 1175 1198 1176 1199 rx_descriptor = (e1000_rx_descriptor_t *) … … 1213 1236 { 1214 1237 if (icr & ICR_RXT0) 1215 e1000_receive_ frames(nic);1238 e1000_receive_packets(nic); 1216 1239 } 1217 1240 … … 1252 1275 fibril_mutex_lock(&irq_reg_mutex); 1253 1276 1254 e1000_irq_code.cmds[0].addr = e1000->reg_base_virt + E1000_ICR; 1255 e1000_irq_code.cmds[2].addr = e1000->reg_base_virt + E1000_IMC; 1277 e1000_irq_code.ranges[0].base = (uintptr_t) e1000->reg_base_phys; 1278 e1000_irq_code.cmds[0].addr = e1000->reg_base_phys + E1000_ICR; 1279 e1000_irq_code.cmds[2].addr = e1000->reg_base_phys + E1000_IMC; 1256 1280 1257 1281 int rc = register_interrupt_handler(nic_get_ddf_dev(nic), … … 1262 1286 } 1263 1287 1264 /** Force receiving all frames in the receive buffer1288 /** Force receiving all packets in the receive buffer 1265 1289 * 1266 1290 * @param nic NIC data … … 1335 1359 static void e1000_initialize_rx_registers(e1000_t *e1000) 1336 1360 { 1337 E1000_REG_WRITE(e1000, E1000_RDLEN, E1000_RX_ FRAME_COUNT * 16);1361 E1000_REG_WRITE(e1000, E1000_RDLEN, E1000_RX_PACKETS_COUNT * 16); 1338 1362 E1000_REG_WRITE(e1000, E1000_RDH, 0); 1339 1363 1340 1364 /* It is not posible to let HW use all descriptors */ 1341 E1000_REG_WRITE(e1000, E1000_RDT, E1000_RX_ FRAME_COUNT - 1);1365 E1000_REG_WRITE(e1000, E1000_RDT, E1000_RX_PACKETS_COUNT - 1); 1342 1366 1343 1367 /* Set Broadcast Enable Bit */ … … 1359 1383 1360 1384 int rc = dmamem_map_anonymous( 1361 E1000_RX_ FRAME_COUNT * sizeof(e1000_rx_descriptor_t),1385 E1000_RX_PACKETS_COUNT * sizeof(e1000_rx_descriptor_t), 1362 1386 AS_AREA_READ | AS_AREA_WRITE, 0, &e1000->rx_ring_phys, 1363 1387 &e1000->rx_ring_virt); … … 1370 1394 (uint32_t) PTR_TO_U64(e1000->rx_ring_phys)); 1371 1395 1372 e1000->rx_frame_phys = 1373 calloc(E1000_RX_FRAME_COUNT, sizeof(void *)); 1374 e1000->rx_frame_virt = 1375 calloc(E1000_RX_FRAME_COUNT, sizeof(void *)); 1376 if (e1000->rx_frame_phys == NULL || e1000->rx_frame_virt == NULL) { 1377 rc = ENOMEM; 1378 goto error; 1379 } 1380 1381 size_t i; 1382 void *frame_virt; 1383 void *frame_phys; 1384 1385 for (i = 0; i < E1000_RX_FRAME_COUNT; i++) { 1386 rc = dmamem_map_anonymous( 1387 E1000_MAX_SEND_FRAME_SIZE, AS_AREA_READ | AS_AREA_WRITE, 1388 0, &frame_phys, &frame_virt); 1389 if (rc != EOK) 1390 goto error; 1391 1392 e1000->rx_frame_virt[i] = frame_virt; 1393 e1000->rx_frame_phys[i] = frame_phys; 1394 } 1396 e1000->rx_ring_packets = 1397 malloc(E1000_RX_PACKETS_COUNT * sizeof(packet_t *)); 1398 // FIXME: Check return value 1395 1399 1396 1400 /* Write descriptor */ 1397 for (i = 0; i < E1000_RX_FRAME_COUNT; i++) 1398 e1000_fill_new_rx_descriptor(nic, i); 1401 for (unsigned int offset = 0; 1402 offset < E1000_RX_PACKETS_COUNT; 1403 offset++) 1404 e1000_fill_new_rx_descriptor(nic, offset); 1399 1405 1400 1406 e1000_initialize_rx_registers(e1000); … … 1402 1408 fibril_mutex_unlock(&e1000->rx_lock); 1403 1409 return EOK; 1404 1405 error:1406 for (i = 0; i < E1000_RX_FRAME_COUNT; i++) {1407 if (e1000->rx_frame_virt[i] != NULL) {1408 dmamem_unmap_anonymous(e1000->rx_frame_virt[i]);1409 e1000->rx_frame_virt[i] = NULL;1410 e1000->rx_frame_phys[i] = NULL;1411 }1412 }1413 1414 if (e1000->rx_frame_phys != NULL) {1415 free(e1000->rx_frame_phys);1416 e1000->rx_frame_phys = NULL;1417 }1418 1419 if (e1000->rx_frame_virt != NULL) {1420 free(e1000->rx_frame_virt);1421 e1000->rx_frame_phys = NULL;1422 }1423 1424 return rc;1425 1410 } 1426 1411 … … 1434 1419 e1000_t *e1000 = DRIVER_DATA_NIC(nic); 1435 1420 1436 /* Write descriptor */1437 for (unsigned int offset = 0; offset < E1000_RX_FRAME_COUNT; offset++) {1438 dmamem_unmap_anonymous(e1000->rx_frame_virt[offset]);1439 e1000->rx_frame_virt[offset] = NULL;1440 e1000->rx_frame_phys[offset] = NULL;1441 }1442 1443 free(e1000->rx_frame_virt);1444 free(e1000->rx_frame_phys);1445 e1000->rx_frame_virt = NULL;1446 e1000->rx_frame_phys = NULL;1447 dmamem_unmap_anonymous(e1000->rx_ring_virt);1448 }1449 1450 /** Clear receive descriptor ring1451 *1452 * @param e1000 E1000 data1453 *1454 */1455 static void e1000_clear_rx_ring(e1000_t *e1000)1456 {1457 1421 /* Write descriptor */ 1458 1422 for (unsigned int offset = 0; 1459 offset < E1000_RX_FRAME_COUNT; 1423 offset < E1000_RX_PACKETS_COUNT; 1424 offset++) { 1425 packet_t *packet = *(e1000->rx_ring_packets + offset); 1426 nic_dma_unlock_packet(packet, E1000_MAX_RECEIVE_PACKET_SIZE); 1427 nic_release_packet(nic, packet); 1428 } 1429 1430 free(e1000->rx_ring_packets); 1431 dmamem_unmap_anonymous(e1000->rx_ring_virt); 1432 } 1433 1434 /** Clear receive descriptor ring 1435 * 1436 * @param e1000 E1000 data 1437 * 1438 */ 1439 static void e1000_clear_rx_ring(e1000_t *e1000) 1440 { 1441 /* Write descriptor */ 1442 for (unsigned int offset = 0; 1443 offset < E1000_RX_PACKETS_COUNT; 1460 1444 offset++) 1461 1445 e1000_clear_rx_descriptor(e1000, offset); … … 1526 1510 static void e1000_initialize_tx_registers(e1000_t *e1000) 1527 1511 { 1528 E1000_REG_WRITE(e1000, E1000_TDLEN, E1000_TX_ FRAME_COUNT * 16);1512 E1000_REG_WRITE(e1000, E1000_TDLEN, E1000_TX_PACKETS_COUNT * 16); 1529 1513 E1000_REG_WRITE(e1000, E1000_TDH, 0); 1530 1514 E1000_REG_WRITE(e1000, E1000_TDT, 0); … … 1558 1542 1559 1543 int rc = dmamem_map_anonymous( 1560 E1000_TX_ FRAME_COUNT * sizeof(e1000_tx_descriptor_t),1544 E1000_TX_PACKETS_COUNT * sizeof(e1000_tx_descriptor_t), 1561 1545 AS_AREA_READ | AS_AREA_WRITE, 0, &e1000->tx_ring_phys, 1562 1546 &e1000->tx_ring_virt); … … 1565 1549 1566 1550 bzero(e1000->tx_ring_virt, 1567 E1000_TX_ FRAME_COUNT * sizeof(e1000_tx_descriptor_t));1568 1569 e1000->tx_frame_phys = calloc(E1000_TX_ FRAME_COUNT, sizeof(void *));1570 e1000->tx_frame_virt = calloc(E1000_TX_ FRAME_COUNT, sizeof(void *));1551 E1000_TX_PACKETS_COUNT * sizeof(e1000_tx_descriptor_t)); 1552 1553 e1000->tx_frame_phys = calloc(E1000_TX_PACKETS_COUNT, sizeof(void *)); 1554 e1000->tx_frame_virt = calloc(E1000_TX_PACKETS_COUNT, sizeof(void *)); 1571 1555 1572 1556 if (e1000->tx_frame_phys == NULL || e1000->tx_frame_virt == NULL) { … … 1575 1559 } 1576 1560 1577 for (i = 0; i < E1000_TX_ FRAME_COUNT; i++) {1561 for (i = 0; i < E1000_TX_PACKETS_COUNT; i++) { 1578 1562 rc = dmamem_map_anonymous( 1579 1563 E1000_MAX_SEND_FRAME_SIZE, AS_AREA_READ | AS_AREA_WRITE, … … 1600 1584 1601 1585 if (e1000->tx_frame_phys != NULL && e1000->tx_frame_virt != NULL) { 1602 for (i = 0; i < E1000_TX_ FRAME_COUNT; i++) {1586 for (i = 0; i < E1000_TX_PACKETS_COUNT; i++) { 1603 1587 if (e1000->tx_frame_virt[i] != NULL) { 1604 1588 dmamem_unmap_anonymous(e1000->tx_frame_virt[i]); … … 1631 1615 size_t i; 1632 1616 1633 for (i = 0; i < E1000_TX_ FRAME_COUNT; i++) {1617 for (i = 0; i < E1000_TX_PACKETS_COUNT; i++) { 1634 1618 dmamem_unmap_anonymous(e1000->tx_frame_virt[i]); 1635 1619 e1000->tx_frame_virt[i] = NULL; … … 1646 1630 e1000->tx_frame_phys = NULL; 1647 1631 } 1648 1649 1632 dmamem_unmap_anonymous(e1000->tx_ring_virt); 1650 1633 } … … 1659 1642 /* Write descriptor */ 1660 1643 for (unsigned int offset = 0; 1661 offset < E1000_TX_ FRAME_COUNT;1644 offset < E1000_TX_PACKETS_COUNT; 1662 1645 offset++) 1663 1646 e1000_clear_tx_descriptor(nic, offset); … … 1716 1699 } 1717 1700 1718 /** Activate the device to receive and transmit frames1701 /** Activate the device to receive and transmit packets 1719 1702 * 1720 1703 * @param nic NIC driver data … … 2057 2040 case E1000_82545: 2058 2041 case E1000_82546: 2042 case E1000_82572: 2059 2043 e1000->info.eerd_start = 0x01; 2060 2044 e1000->info.eerd_done = 0x10; … … 2063 2047 break; 2064 2048 case E1000_82547: 2065 case E1000_82572:2066 2049 case E1000_80003ES2: 2067 2050 e1000->info.eerd_start = 0x01; … … 2102 2085 int e1000_dev_add(ddf_dev_t *dev) 2103 2086 { 2104 ddf_fun_t *fun;2105 2087 assert(dev); 2106 2088 … … 2133 2115 e1000_initialize_vlan(e1000); 2134 2116 2135 fun = ddf_fun_create(nic_get_ddf_dev(nic), fun_exposed, "port0");2136 if ( fun == NULL)2117 rc = nic_register_as_ddf_fun(nic, &e1000_dev_ops); 2118 if (rc != EOK) 2137 2119 goto err_tx_structure; 2138 nic_set_ddf_fun(nic, fun);2139 fun->ops = &e1000_dev_ops;2140 fun->driver_data = nic;2141 2120 2142 2121 rc = e1000_register_int_handler(nic); 2143 2122 if (rc != EOK) 2144 goto err_ fun_create;2123 goto err_tx_structure; 2145 2124 2146 2125 rc = nic_connect_to_services(nic); … … 2165 2144 goto err_rx_structure; 2166 2145 2167 rc = ddf_fun_bind(fun);2168 if (rc != EOK)2169 goto err_fun_bind;2170 2171 rc = ddf_fun_add_to_category(fun, DEVICE_CATEGORY_NIC);2172 if (rc != EOK)2173 goto err_add_to_cat;2174 2175 2146 return EOK; 2176 2147 2177 err_add_to_cat:2178 ddf_fun_unbind(fun);2179 err_fun_bind:2180 2148 err_rx_structure: 2181 2149 e1000_uninitialize_rx_structure(nic); 2182 2150 err_irq: 2183 2151 unregister_interrupt_handler(dev, DRIVER_DATA_DEV(dev)->irq); 2184 err_fun_create:2185 ddf_fun_destroy(fun);2186 nic_set_ddf_fun(nic, NULL);2187 2152 err_tx_structure: 2188 2153 e1000_uninitialize_tx_structure(e1000); … … 2330 2295 2331 2296 if (!descriptor_available) { 2332 /* Framelost */2297 /* Packet lost */ 2333 2298 fibril_mutex_unlock(&e1000->tx_lock); 2334 2299 return; … … 2359 2324 2360 2325 tdt++; 2361 if (tdt == E1000_TX_ FRAME_COUNT)2326 if (tdt == E1000_TX_PACKETS_COUNT) 2362 2327 tdt = 0; 2363 2328
Note:
See TracChangeset
for help on using the changeset viewer.