Ignore:
File:
1 edited

Legend:

Unmodified
Added
Removed

  • uspace/drv/nic/e1k/e1k.c

    rec52752 re882e3a  
    4646#include <ddf/log.h>
    4747#include <ddf/interrupt.h>
    48 #include <devman.h>
    4948#include <device/hw_res_parsed.h>
    5049#include <device/pci.h>
    … …  
    5251#include <nil_remote.h>
    5352#include <ops/nic.h>
    54 #include <packet_client.h>
    55 #include <packet_remote.h>
    56 #include <net/packet_header.h>
    5753#include "e1k.h"
    5854
    … …  
    6258
    6359/* Must be power of 8 */
    64 #define E1000_RX_PACKETS_COUNT  128
    65 #define E1000_TX_PACKETS_COUNT  128
     60#define E1000_RX_FRAME_COUNT  128
     61#define E1000_TX_FRAME_COUNT  128
    6662
    6763#define E1000_RECEIVE_ADDRESS  16
    6864
    69 /** Maximum sending packet size */
     65/** Maximum sending frame size */
    7066#define E1000_MAX_SEND_FRAME_SIZE  2048
    71 /** Maximum receiving packet size */
    72 #define E1000_MAX_RECEIVE_PACKET_SIZE  2048
     67/** Maximum receiving frame size */
     68#define E1000_MAX_RECEIVE_FRAME_SIZE  2048
    7369
    7470/** nic_driver_data_t* -> e1000_t* cast */
    … …  
    137133        void *rx_ring_virt;
    138134       
    139         /** Packets in rx ring  */
    140         packet_t **rx_ring_packets;
     135        /** Ring of RX frames, physical address */
     136        void **rx_frame_phys;
     137        /** Ring of RX frames, virtual address */
     138        void **rx_frame_virt;
    141139       
    142140        /** VLAN tag */
    143141        uint16_t vlan_tag;
    144142       
    145         /** Add VLAN tag to packet */
     143        /** Add VLAN tag to frame */
    146144        bool vlan_tag_add;
    147145       
    … …  
    488486}
    489487
    490 /** Get state of acceptance of weird packets
     488/** Get state of acceptance of weird frames
    491489 *
    492490 * @param      device Device to check
    … …  
    506504};
    507505
    508 /** Set acceptance of weird packets
     506/** Set acceptance of weird frames
    509507 *
    510508 * @param device Device to update
    … …  
    690688}
    691689
    692 /** Disable receiving packets for default address
     690/** Disable receiving frames for default address
    693691 *
    694692 * @param e1000 E1000 data structure
    … …  
    702700}
    703701
    704 /** Enable receiving packets for default address
     702/** Enable receiving frames for default address
    705703 *
    706704 * @param e1000 E1000 data structure
    … …  
    762760}
    763761
    764 /** Enable accepting of broadcast packets
     762/** Enable accepting of broadcast frames
    765763 *
    766764 * @param e1000 E1000 data structure
    … …  
    774772}
    775773
    776 /** Disable accepting of broadcast packets
     774/** Disable accepting of broadcast frames
    777775 *
    778776 * @param e1000 E1000 data structure
    … …  
    810808}
    811809
    812 /** Set multicast packets acceptance mode
     810/** Set multicast frames acceptance mode
    813811 *
    814812 * @param nic      NIC device to update
    … …  
    864862}
    865863
    866 /** Set unicast packets acceptance mode
     864/** Set unicast frames acceptance mode
    867865 *
    868866 * @param nic      NIC device to update
    … …  
    922920}
    923921
    924 /** Set broadcast packets acceptance mode
     922/** Set broadcast frames acceptance mode
    925923 *
    926924 * @param nic  NIC device to update
    … …  
    10071005        if (vlan_mask) {
    10081006                /*
    1009                  * Disable receiving, so that packet matching
     1007                 * Disable receiving, so that frame matching
    10101008                 * partially written VLAN is not received.
    10111009                 */
    … …  
    10741072}
    10751073
    1076 /** Fill receive descriptor with new empty packet
    1077  *
    1078  * Store packet in e1000->rx_ring_packets
     1074/** Fill receive descriptor with new empty buffer
     1075 *
     1076 * Store frame in e1000->rx_frame_phys
    10791077 *
    10801078 * @param nic    NIC data stricture
    … …  
    10851083{
    10861084        e1000_t *e1000 = DRIVER_DATA_NIC(nic);
    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;
     1085       
    10931086        e1000_rx_descriptor_t *rx_descriptor = (e1000_rx_descriptor_t *)
    10941087            (e1000->rx_ring_virt + offset * sizeof(e1000_rx_descriptor_t));
    10951088       
    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        
     1089        rx_descriptor->phys_addr = PTR_TO_U64(e1000->rx_frame_phys[offset]);
    11051090        rx_descriptor->length = 0;
    11061091        rx_descriptor->checksum = 0;
    … …  
    11661151}
    11671152
    1168 /** Receive packets
     1153/** Receive frames
    11691154 *
    11701155 * @param nic NIC data
    11711156 *
    11721157 */
    1173 static void e1000_receive_packets(nic_t *nic)
     1158static void e1000_receive_frames(nic_t *nic)
    11741159{
    11751160        e1000_t *e1000 = DRIVER_DATA_NIC(nic);
    … …  
    11781163       
    11791164        uint32_t *tail_addr = E1000_REG_ADDR(e1000, E1000_RDT);
    1180         uint32_t next_tail = e1000_inc_tail(*tail_addr, E1000_RX_PACKETS_COUNT);
     1165        uint32_t next_tail = e1000_inc_tail(*tail_addr, E1000_RX_FRAME_COUNT);
    11811166       
    11821167        e1000_rx_descriptor_t *rx_descriptor = (e1000_rx_descriptor_t *)
    … …  
    11841169       
    11851170        while (rx_descriptor->status & 0x01) {
    1186                 uint32_t packet_size = rx_descriptor->length - E1000_CRC_SIZE;
     1171                uint32_t frame_size = rx_descriptor->length - E1000_CRC_SIZE;
    11871172               
    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);
     1173                nic_frame_t *frame = nic_alloc_frame(nic, frame_size);
     1174                if (frame != NULL) {
     1175                        memcpy(frame->data, e1000->rx_frame_virt[next_tail], frame_size);
     1176                        nic_received_frame(nic, frame);
     1177                } else {
     1178                        ddf_msg(LVL_ERROR, "Memory allocation failed. Frame dropped.");
     1179                }
    11931180               
    11941181                e1000_fill_new_rx_descriptor(nic, next_tail);
    11951182               
    1196                 *tail_addr = e1000_inc_tail(*tail_addr, E1000_RX_PACKETS_COUNT);
    1197                 next_tail = e1000_inc_tail(*tail_addr, E1000_RX_PACKETS_COUNT);
     1183                *tail_addr = e1000_inc_tail(*tail_addr, E1000_RX_FRAME_COUNT);
     1184                next_tail = e1000_inc_tail(*tail_addr, E1000_RX_FRAME_COUNT);
    11981185               
    11991186                rx_descriptor = (e1000_rx_descriptor_t *)
    … …  
    12361223{
    12371224        if (icr & ICR_RXT0)
    1238                 e1000_receive_packets(nic);
     1225                e1000_receive_frames(nic);
    12391226}
    12401227
    … …  
    12861273}
    12871274
    1288 /** Force receiving all packets in the receive buffer
     1275/** Force receiving all frames in the receive buffer
    12891276 *
    12901277 * @param nic NIC data
    … …  
    13591346static void e1000_initialize_rx_registers(e1000_t *e1000)
    13601347{
    1361         E1000_REG_WRITE(e1000, E1000_RDLEN, E1000_RX_PACKETS_COUNT * 16);
     1348        E1000_REG_WRITE(e1000, E1000_RDLEN, E1000_RX_FRAME_COUNT * 16);
    13621349        E1000_REG_WRITE(e1000, E1000_RDH, 0);
    13631350       
    13641351        /* It is not posible to let HW use all descriptors */
    1365         E1000_REG_WRITE(e1000, E1000_RDT, E1000_RX_PACKETS_COUNT - 1);
     1352        E1000_REG_WRITE(e1000, E1000_RDT, E1000_RX_FRAME_COUNT - 1);
    13661353       
    13671354        /* Set Broadcast Enable Bit */
    … …  
    13831370       
    13841371        int rc = dmamem_map_anonymous(
    1385             E1000_RX_PACKETS_COUNT * sizeof(e1000_rx_descriptor_t),
     1372            E1000_RX_FRAME_COUNT * sizeof(e1000_rx_descriptor_t),
    13861373            AS_AREA_READ | AS_AREA_WRITE, 0, &e1000->rx_ring_phys,
    13871374            &e1000->rx_ring_virt);
    … …  
    13941381            (uint32_t) PTR_TO_U64(e1000->rx_ring_phys));
    13951382       
    1396         e1000->rx_ring_packets =
    1397             malloc(E1000_RX_PACKETS_COUNT * sizeof(packet_t *));
    1398         // FIXME: Check return value
    1399        
     1383        e1000->rx_frame_phys =
     1384            calloc(E1000_RX_FRAME_COUNT, sizeof(void *));
     1385        e1000->rx_frame_virt =
     1386            calloc(E1000_RX_FRAME_COUNT, sizeof(void *));
     1387        if (e1000->rx_frame_phys == NULL || e1000->rx_frame_virt == NULL) {
     1388                rc = ENOMEM;
     1389                goto error;
     1390        }
     1391       
     1392        size_t i;
     1393        void *frame_virt;
     1394        void *frame_phys;
     1395       
     1396        for (i = 0; i < E1000_RX_FRAME_COUNT; i++) {
     1397                rc = dmamem_map_anonymous(
     1398                    E1000_MAX_SEND_FRAME_SIZE, AS_AREA_READ | AS_AREA_WRITE,
     1399                    0, &frame_phys, &frame_virt);
     1400                if (rc != EOK)
     1401                        goto error;
     1402               
     1403                e1000->rx_frame_virt[i] = frame_virt;
     1404                e1000->rx_frame_phys[i] = frame_phys;
     1405        }
     1406       
     1407        /* Write descriptor */
     1408        for (i = 0; i < E1000_RX_FRAME_COUNT; i++)
     1409                e1000_fill_new_rx_descriptor(nic, i);
     1410       
     1411        e1000_initialize_rx_registers(e1000);
     1412       
     1413        fibril_mutex_unlock(&e1000->rx_lock);
     1414        return EOK;
     1415       
     1416error:
     1417        for (i = 0; i < E1000_RX_FRAME_COUNT; i++) {
     1418                if (e1000->rx_frame_virt[i] != NULL) {
     1419                        dmamem_unmap_anonymous(e1000->rx_frame_virt[i]);
     1420                        e1000->rx_frame_virt[i] = NULL;
     1421                        e1000->rx_frame_phys[i] = NULL;
     1422                }
     1423        }
     1424       
     1425        if (e1000->rx_frame_phys != NULL) {
     1426                free(e1000->rx_frame_phys);
     1427                e1000->rx_frame_phys = NULL;
     1428        }
     1429       
     1430        if (e1000->rx_frame_virt != NULL) {
     1431                free(e1000->rx_frame_virt);
     1432                e1000->rx_frame_phys = NULL;
     1433        }
     1434       
     1435        return rc;
     1436}
     1437
     1438/** Uninitialize receive structure
     1439 *
     1440 * @param nic NIC data
     1441 *
     1442 */
     1443static void e1000_uninitialize_rx_structure(nic_t *nic)
     1444{
     1445        e1000_t *e1000 = DRIVER_DATA_NIC(nic);
     1446       
     1447        /* Write descriptor */
     1448        for (unsigned int offset = 0; offset < E1000_RX_FRAME_COUNT; offset++) {
     1449                dmamem_unmap_anonymous(e1000->rx_frame_virt[offset]);
     1450                e1000->rx_frame_virt[offset] = NULL;
     1451                e1000->rx_frame_phys[offset] = NULL;
     1452        }
     1453       
     1454        free(e1000->rx_frame_virt);
     1455        free(e1000->rx_frame_phys);
     1456        e1000->rx_frame_virt = NULL;
     1457        e1000->rx_frame_phys = NULL;
     1458        dmamem_unmap_anonymous(e1000->rx_ring_virt);
     1459}
     1460
     1461/** Clear receive descriptor ring
     1462 *
     1463 * @param e1000 E1000 data
     1464 *
     1465 */
     1466static void e1000_clear_rx_ring(e1000_t *e1000)
     1467{
    14001468        /* Write descriptor */
    14011469        for (unsigned int offset = 0;
    1402             offset < E1000_RX_PACKETS_COUNT;
    1403             offset++)
    1404                 e1000_fill_new_rx_descriptor(nic, offset);
    1405        
    1406         e1000_initialize_rx_registers(e1000);
    1407        
    1408         fibril_mutex_unlock(&e1000->rx_lock);
    1409         return EOK;
    1410 }
    1411 
    1412 /** Uninitialize receive structure
    1413  *
    1414  * @param nic NIC data
    1415  *
    1416  */
    1417 static void e1000_uninitialize_rx_structure(nic_t *nic)
    1418 {
    1419         e1000_t *e1000 = DRIVER_DATA_NIC(nic);
    1420        
    1421         /* Write descriptor */
    1422         for (unsigned int offset = 0;
    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;
     1470            offset < E1000_RX_FRAME_COUNT;
    14441471            offset++)
    14451472                e1000_clear_rx_descriptor(e1000, offset);
    … …  
    15101537static void e1000_initialize_tx_registers(e1000_t *e1000)
    15111538{
    1512         E1000_REG_WRITE(e1000, E1000_TDLEN, E1000_TX_PACKETS_COUNT * 16);
     1539        E1000_REG_WRITE(e1000, E1000_TDLEN, E1000_TX_FRAME_COUNT * 16);
    15131540        E1000_REG_WRITE(e1000, E1000_TDH, 0);
    15141541        E1000_REG_WRITE(e1000, E1000_TDT, 0);
    … …  
    15421569       
    15431570        int rc = dmamem_map_anonymous(
    1544             E1000_TX_PACKETS_COUNT * sizeof(e1000_tx_descriptor_t),
     1571            E1000_TX_FRAME_COUNT * sizeof(e1000_tx_descriptor_t),
    15451572            AS_AREA_READ | AS_AREA_WRITE, 0, &e1000->tx_ring_phys,
    15461573            &e1000->tx_ring_virt);
    … …  
    15491576       
    15501577        bzero(e1000->tx_ring_virt,
    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 *));
     1578            E1000_TX_FRAME_COUNT * sizeof(e1000_tx_descriptor_t));
     1579       
     1580        e1000->tx_frame_phys = calloc(E1000_TX_FRAME_COUNT, sizeof(void *));
     1581        e1000->tx_frame_virt = calloc(E1000_TX_FRAME_COUNT, sizeof(void *));
    15551582
    15561583        if (e1000->tx_frame_phys == NULL || e1000->tx_frame_virt == NULL) {
    … …  
    15591586        }
    15601587       
    1561         for (i = 0; i < E1000_TX_PACKETS_COUNT; i++) {
     1588        for (i = 0; i < E1000_TX_FRAME_COUNT; i++) {
    15621589                rc = dmamem_map_anonymous(
    15631590                    E1000_MAX_SEND_FRAME_SIZE, AS_AREA_READ | AS_AREA_WRITE,
    … …  
    15841611       
    15851612        if (e1000->tx_frame_phys != NULL && e1000->tx_frame_virt != NULL) {
    1586                 for (i = 0; i < E1000_TX_PACKETS_COUNT; i++) {
     1613                for (i = 0; i < E1000_TX_FRAME_COUNT; i++) {
    15871614                        if (e1000->tx_frame_virt[i] != NULL) {
    15881615                                dmamem_unmap_anonymous(e1000->tx_frame_virt[i]);
    … …  
    16151642        size_t i;
    16161643       
    1617         for (i = 0; i < E1000_TX_PACKETS_COUNT; i++) {
     1644        for (i = 0; i < E1000_TX_FRAME_COUNT; i++) {
    16181645                dmamem_unmap_anonymous(e1000->tx_frame_virt[i]);
    16191646                e1000->tx_frame_virt[i] = NULL;
    … …  
    16301657                e1000->tx_frame_phys = NULL;
    16311658        }
     1659       
    16321660        dmamem_unmap_anonymous(e1000->tx_ring_virt);
    16331661}
    … …  
    16421670        /* Write descriptor */
    16431671        for (unsigned int offset = 0;
    1644             offset < E1000_TX_PACKETS_COUNT;
     1672            offset < E1000_TX_FRAME_COUNT;
    16451673            offset++)
    16461674                e1000_clear_tx_descriptor(nic, offset);
    … …  
    16991727}
    17001728
    1701 /** Activate the device to receive and transmit packets
     1729/** Activate the device to receive and transmit frames
    17021730 *
    17031731 * @param nic NIC driver data
    … …  
    20402068        case E1000_82545:
    20412069        case E1000_82546:
    2042         case E1000_82572:
    20432070                e1000->info.eerd_start = 0x01;
    20442071                e1000->info.eerd_done = 0x10;
    … …  
    20472074                break;
    20482075        case E1000_82547:
     2076        case E1000_82572:
    20492077        case E1000_80003ES2:
    20502078                e1000->info.eerd_start = 0x01;
    … …  
    20852113int e1000_dev_add(ddf_dev_t *dev)
    20862114{
     2115        ddf_fun_t *fun;
    20872116        assert(dev);
    20882117       
    … …  
    21152144        e1000_initialize_vlan(e1000);
    21162145       
    2117         rc = nic_register_as_ddf_fun(nic, &e1000_dev_ops);
    2118         if (rc != EOK)
     2146        fun = ddf_fun_create(nic_get_ddf_dev(nic), fun_exposed, "port0");
     2147        if (fun == NULL)
    21192148                goto err_tx_structure;
     2149        nic_set_ddf_fun(nic, fun);
     2150        fun->ops = &e1000_dev_ops;
     2151        fun->driver_data = nic;
    21202152       
    21212153        rc = e1000_register_int_handler(nic);
    21222154        if (rc != EOK)
    2123                 goto err_tx_structure;
     2155                goto err_fun_create;
    21242156       
    21252157        rc = nic_connect_to_services(nic);
    … …  
    21442176                goto err_rx_structure;
    21452177       
     2178        rc = ddf_fun_bind(fun);
     2179        if (rc != EOK)
     2180                goto err_fun_bind;
     2181       
     2182        rc = ddf_fun_add_to_category(fun, DEVICE_CATEGORY_NIC);
     2183        if (rc != EOK)
     2184                goto err_add_to_cat;
     2185       
    21462186        return EOK;
    21472187       
     2188err_add_to_cat:
     2189        ddf_fun_unbind(fun);
     2190err_fun_bind:
    21482191err_rx_structure:
    21492192        e1000_uninitialize_rx_structure(nic);
    21502193err_irq:
    21512194        unregister_interrupt_handler(dev, DRIVER_DATA_DEV(dev)->irq);
     2195err_fun_create:
     2196        ddf_fun_destroy(fun);
     2197        nic_set_ddf_fun(nic, NULL);
    21522198err_tx_structure:
    21532199        e1000_uninitialize_tx_structure(e1000);
    … …  
    22952341       
    22962342        if (!descriptor_available) {
    2297                 /* Packet lost */
     2343                /* Frame lost */
    22982344                fibril_mutex_unlock(&e1000->tx_lock);
    22992345                return;
    … …  
    23242370       
    23252371        tdt++;
    2326         if (tdt == E1000_TX_PACKETS_COUNT)
     2372        if (tdt == E1000_TX_FRAME_COUNT)
    23272373                tdt = 0;
    23282374       
Note: See TracChangeset for help on using the changeset viewer.