Ignore:
File:
1 edited

Legend:

Unmodified
Added
Removed
  • uspace/drv/nic/e1k/e1k.c

    rd81eaf94 r6d8455d  
    5252#include <nil_remote.h>
    5353#include <ops/nic.h>
     54#include <packet_client.h>
     55#include <packet_remote.h>
     56#include <net/packet_header.h>
    5457#include "e1k.h"
    5558
     
    5962
    6063/* Must be power of 8 */
    61 #define E1000_RX_FRAME_COUNT  128
    62 #define E1000_TX_FRAME_COUNT  128
     64#define E1000_RX_PACKETS_COUNT  128
     65#define E1000_TX_PACKETS_COUNT  128
    6366
    6467#define E1000_RECEIVE_ADDRESS  16
    6568
    66 /** Maximum sending frame size */
     69/** Maximum sending packet size */
    6770#define E1000_MAX_SEND_FRAME_SIZE  2048
    68 /** Maximum receiving frame size */
    69 #define E1000_MAX_RECEIVE_FRAME_SIZE  2048
     71/** Maximum receiving packet size */
     72#define E1000_MAX_RECEIVE_PACKET_SIZE  2048
    7073
    7174/** nic_driver_data_t* -> e1000_t* cast */
     
    134137        void *rx_ring_virt;
    135138       
    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;
    140141       
    141142        /** VLAN tag */
    142143        uint16_t vlan_tag;
    143144       
    144         /** Add VLAN tag to frame */
     145        /** Add VLAN tag to packet */
    145146        bool vlan_tag_add;
    146147       
     
    476477}
    477478
    478 /** Get state of acceptance of weird frames
     479/** Get state of acceptance of weird packets
    479480 *
    480481 * @param      device Device to check
     
    494495};
    495496
    496 /** Set acceptance of weird frames
     497/** Set acceptance of weird packets
    497498 *
    498499 * @param device Device to update
     
    678679}
    679680
    680 /** Disable receiving frames for default address
     681/** Disable receiving packets for default address
    681682 *
    682683 * @param e1000 E1000 data structure
     
    690691}
    691692
    692 /** Enable receiving frames for default address
     693/** Enable receiving packets for default address
    693694 *
    694695 * @param e1000 E1000 data structure
     
    750751}
    751752
    752 /** Enable accepting of broadcast frames
     753/** Enable accepting of broadcast packets
    753754 *
    754755 * @param e1000 E1000 data structure
     
    762763}
    763764
    764 /** Disable accepting of broadcast frames
     765/** Disable accepting of broadcast packets
    765766 *
    766767 * @param e1000 E1000 data structure
     
    798799}
    799800
    800 /** Set multicast frames acceptance mode
     801/** Set multicast packets acceptance mode
    801802 *
    802803 * @param nic      NIC device to update
     
    852853}
    853854
    854 /** Set unicast frames acceptance mode
     855/** Set unicast packets acceptance mode
    855856 *
    856857 * @param nic      NIC device to update
     
    910911}
    911912
    912 /** Set broadcast frames acceptance mode
     913/** Set broadcast packets acceptance mode
    913914 *
    914915 * @param nic  NIC device to update
     
    995996        if (vlan_mask) {
    996997                /*
    997                  * Disable receiving, so that frame matching
     998                 * Disable receiving, so that packet matching
    998999                 * partially written VLAN is not received.
    9991000                 */
     
    10621063}
    10631064
    1064 /** Fill receive descriptor with new empty buffer
    1065  *
    1066  * Store frame in e1000->rx_frame_phys
     1065/** Fill receive descriptor with new empty packet
     1066 *
     1067 * Store packet in e1000->rx_ring_packets
    10671068 *
    10681069 * @param nic    NIC data stricture
     
    10731074{
    10741075        e1000_t *e1000 = DRIVER_DATA_NIC(nic);
    1075        
     1076        packet_t *packet =
     1077            nic_alloc_packet(nic, E1000_MAX_RECEIVE_PACKET_SIZE);
     1078       
     1079        assert(packet);
     1080       
     1081        *(e1000->rx_ring_packets + offset) = packet;
    10761082        e1000_rx_descriptor_t *rx_descriptor = (e1000_rx_descriptor_t *)
    10771083            (e1000->rx_ring_virt + offset * sizeof(e1000_rx_descriptor_t));
    10781084       
    1079         rx_descriptor->phys_addr = PTR_TO_U64(e1000->rx_frame_phys[offset]);
     1085        void *phys;
     1086        int rc =
     1087            nic_dma_lock_packet(packet, E1000_MAX_RECEIVE_PACKET_SIZE, &phys);
     1088       
     1089        if (rc == EOK)
     1090                rx_descriptor->phys_addr = PTR_TO_U64(phys + packet->data_start);
     1091        else
     1092                rx_descriptor->phys_addr = 0;
     1093       
    10801094        rx_descriptor->length = 0;
    10811095        rx_descriptor->checksum = 0;
     
    11411155}
    11421156
    1143 /** Receive frames
     1157/** Receive packets
    11441158 *
    11451159 * @param nic NIC data
    11461160 *
    11471161 */
    1148 static void e1000_receive_frames(nic_t *nic)
     1162static void e1000_receive_packets(nic_t *nic)
    11491163{
    11501164        e1000_t *e1000 = DRIVER_DATA_NIC(nic);
     
    11531167       
    11541168        uint32_t *tail_addr = E1000_REG_ADDR(e1000, E1000_RDT);
    1155         uint32_t next_tail = e1000_inc_tail(*tail_addr, E1000_RX_FRAME_COUNT);
     1169        uint32_t next_tail = e1000_inc_tail(*tail_addr, E1000_RX_PACKETS_COUNT);
    11561170       
    11571171        e1000_rx_descriptor_t *rx_descriptor = (e1000_rx_descriptor_t *)
     
    11591173       
    11601174        while (rx_descriptor->status & 0x01) {
    1161                 uint32_t frame_size = rx_descriptor->length - E1000_CRC_SIZE;
     1175                uint32_t packet_size = rx_descriptor->length - E1000_CRC_SIZE;
    11621176               
    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                 }
     1177                packet_t *packet = *(e1000->rx_ring_packets + next_tail);
     1178                packet_suffix(packet, packet_size);
     1179               
     1180                nic_dma_unlock_packet(packet, E1000_MAX_RECEIVE_PACKET_SIZE);
     1181                nic_received_packet(nic, packet);
    11701182               
    11711183                e1000_fill_new_rx_descriptor(nic, next_tail);
    11721184               
    1173                 *tail_addr = e1000_inc_tail(*tail_addr, E1000_RX_FRAME_COUNT);
    1174                 next_tail = e1000_inc_tail(*tail_addr, E1000_RX_FRAME_COUNT);
     1185                *tail_addr = e1000_inc_tail(*tail_addr, E1000_RX_PACKETS_COUNT);
     1186                next_tail = e1000_inc_tail(*tail_addr, E1000_RX_PACKETS_COUNT);
    11751187               
    11761188                rx_descriptor = (e1000_rx_descriptor_t *)
     
    12131225{
    12141226        if (icr & ICR_RXT0)
    1215                 e1000_receive_frames(nic);
     1227                e1000_receive_packets(nic);
    12161228}
    12171229
     
    12621274}
    12631275
    1264 /** Force receiving all frames in the receive buffer
     1276/** Force receiving all packets in the receive buffer
    12651277 *
    12661278 * @param nic NIC data
     
    13351347static void e1000_initialize_rx_registers(e1000_t *e1000)
    13361348{
    1337         E1000_REG_WRITE(e1000, E1000_RDLEN, E1000_RX_FRAME_COUNT * 16);
     1349        E1000_REG_WRITE(e1000, E1000_RDLEN, E1000_RX_PACKETS_COUNT * 16);
    13381350        E1000_REG_WRITE(e1000, E1000_RDH, 0);
    13391351       
    13401352        /* It is not posible to let HW use all descriptors */
    1341         E1000_REG_WRITE(e1000, E1000_RDT, E1000_RX_FRAME_COUNT - 1);
     1353        E1000_REG_WRITE(e1000, E1000_RDT, E1000_RX_PACKETS_COUNT - 1);
    13421354       
    13431355        /* Set Broadcast Enable Bit */
     
    13591371       
    13601372        int rc = dmamem_map_anonymous(
    1361             E1000_RX_FRAME_COUNT * sizeof(e1000_rx_descriptor_t),
     1373            E1000_RX_PACKETS_COUNT * sizeof(e1000_rx_descriptor_t),
    13621374            AS_AREA_READ | AS_AREA_WRITE, 0, &e1000->rx_ring_phys,
    13631375            &e1000->rx_ring_virt);
     
    13701382            (uint32_t) PTR_TO_U64(e1000->rx_ring_phys));
    13711383       
    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         }
     1384        e1000->rx_ring_packets =
     1385            malloc(E1000_RX_PACKETS_COUNT * sizeof(packet_t *));
     1386        // FIXME: Check return value
    13951387       
    13961388        /* Write descriptor */
    1397         for (i = 0; i < E1000_RX_FRAME_COUNT; i++)
    1398                 e1000_fill_new_rx_descriptor(nic, i);
     1389        for (unsigned int offset = 0;
     1390            offset < E1000_RX_PACKETS_COUNT;
     1391            offset++)
     1392                e1000_fill_new_rx_descriptor(nic, offset);
    13991393       
    14001394        e1000_initialize_rx_registers(e1000);
     
    14021396        fibril_mutex_unlock(&e1000->rx_lock);
    14031397        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;
    14251398}
    14261399
     
    14341407        e1000_t *e1000 = DRIVER_DATA_NIC(nic);
    14351408       
    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 ring
    1451  *
    1452  * @param e1000 E1000 data
    1453  *
    1454  */
    1455 static void e1000_clear_rx_ring(e1000_t *e1000)
    1456 {
    14571409        /* Write descriptor */
    14581410        for (unsigned int offset = 0;
    1459             offset < E1000_RX_FRAME_COUNT;
     1411            offset < E1000_RX_PACKETS_COUNT;
     1412            offset++) {
     1413                packet_t *packet = *(e1000->rx_ring_packets + offset);
     1414                nic_dma_unlock_packet(packet, E1000_MAX_RECEIVE_PACKET_SIZE);
     1415                nic_release_packet(nic, packet);
     1416        }
     1417       
     1418        free(e1000->rx_ring_packets);
     1419        dmamem_unmap_anonymous(e1000->rx_ring_virt);
     1420}
     1421
     1422/** Clear receive descriptor ring
     1423 *
     1424 * @param e1000 E1000 data
     1425 *
     1426 */
     1427static void e1000_clear_rx_ring(e1000_t *e1000)
     1428{
     1429        /* Write descriptor */
     1430        for (unsigned int offset = 0;
     1431            offset < E1000_RX_PACKETS_COUNT;
    14601432            offset++)
    14611433                e1000_clear_rx_descriptor(e1000, offset);
     
    15261498static void e1000_initialize_tx_registers(e1000_t *e1000)
    15271499{
    1528         E1000_REG_WRITE(e1000, E1000_TDLEN, E1000_TX_FRAME_COUNT * 16);
     1500        E1000_REG_WRITE(e1000, E1000_TDLEN, E1000_TX_PACKETS_COUNT * 16);
    15291501        E1000_REG_WRITE(e1000, E1000_TDH, 0);
    15301502        E1000_REG_WRITE(e1000, E1000_TDT, 0);
     
    15581530       
    15591531        int rc = dmamem_map_anonymous(
    1560             E1000_TX_FRAME_COUNT * sizeof(e1000_tx_descriptor_t),
     1532            E1000_TX_PACKETS_COUNT * sizeof(e1000_tx_descriptor_t),
    15611533            AS_AREA_READ | AS_AREA_WRITE, 0, &e1000->tx_ring_phys,
    15621534            &e1000->tx_ring_virt);
     
    15651537       
    15661538        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 *));
     1539            E1000_TX_PACKETS_COUNT * sizeof(e1000_tx_descriptor_t));
     1540       
     1541        e1000->tx_frame_phys = calloc(E1000_TX_PACKETS_COUNT, sizeof(void *));
     1542        e1000->tx_frame_virt = calloc(E1000_TX_PACKETS_COUNT, sizeof(void *));
    15711543
    15721544        if (e1000->tx_frame_phys == NULL || e1000->tx_frame_virt == NULL) {
     
    15751547        }
    15761548       
    1577         for (i = 0; i < E1000_TX_FRAME_COUNT; i++) {
     1549        for (i = 0; i < E1000_TX_PACKETS_COUNT; i++) {
    15781550                rc = dmamem_map_anonymous(
    15791551                    E1000_MAX_SEND_FRAME_SIZE, AS_AREA_READ | AS_AREA_WRITE,
     
    16001572       
    16011573        if (e1000->tx_frame_phys != NULL && e1000->tx_frame_virt != NULL) {
    1602                 for (i = 0; i < E1000_TX_FRAME_COUNT; i++) {
     1574                for (i = 0; i < E1000_TX_PACKETS_COUNT; i++) {
    16031575                        if (e1000->tx_frame_virt[i] != NULL) {
    16041576                                dmamem_unmap_anonymous(e1000->tx_frame_virt[i]);
     
    16311603        size_t i;
    16321604       
    1633         for (i = 0; i < E1000_TX_FRAME_COUNT; i++) {
     1605        for (i = 0; i < E1000_TX_PACKETS_COUNT; i++) {
    16341606                dmamem_unmap_anonymous(e1000->tx_frame_virt[i]);
    16351607                e1000->tx_frame_virt[i] = NULL;
     
    16461618                e1000->tx_frame_phys = NULL;
    16471619        }
    1648        
    16491620        dmamem_unmap_anonymous(e1000->tx_ring_virt);
    16501621}
     
    16591630        /* Write descriptor */
    16601631        for (unsigned int offset = 0;
    1661             offset < E1000_TX_FRAME_COUNT;
     1632            offset < E1000_TX_PACKETS_COUNT;
    16621633            offset++)
    16631634                e1000_clear_tx_descriptor(nic, offset);
     
    17161687}
    17171688
    1718 /** Activate the device to receive and transmit frames
     1689/** Activate the device to receive and transmit packets
    17191690 *
    17201691 * @param nic NIC driver data
     
    20572028        case E1000_82545:
    20582029        case E1000_82546:
     2030        case E1000_82572:
    20592031                e1000->info.eerd_start = 0x01;
    20602032                e1000->info.eerd_done = 0x10;
     
    20632035                break;
    20642036        case E1000_82547:
    2065         case E1000_82572:
    20662037        case E1000_80003ES2:
    20672038                e1000->info.eerd_start = 0x01;
     
    21022073int e1000_dev_add(ddf_dev_t *dev)
    21032074{
    2104         ddf_fun_t *fun;
    21052075        assert(dev);
    21062076       
     
    21332103        e1000_initialize_vlan(e1000);
    21342104       
    2135         fun = ddf_fun_create(nic_get_ddf_dev(nic), fun_exposed, "port0");
    2136         if (fun == NULL)
     2105        rc = nic_register_as_ddf_fun(nic, &e1000_dev_ops);
     2106        if (rc != EOK)
    21372107                goto err_tx_structure;
    2138         nic_set_ddf_fun(nic, fun);
    2139         fun->ops = &e1000_dev_ops;
    2140         fun->driver_data = nic;
    21412108       
    21422109        rc = e1000_register_int_handler(nic);
    21432110        if (rc != EOK)
    2144                 goto err_fun_create;
     2111                goto err_tx_structure;
    21452112       
    21462113        rc = nic_connect_to_services(nic);
     
    21652132                goto err_rx_structure;
    21662133       
    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        
    21752134        return EOK;
    21762135       
    2177 err_add_to_cat:
    2178         ddf_fun_unbind(fun);
    2179 err_fun_bind:
    21802136err_rx_structure:
    21812137        e1000_uninitialize_rx_structure(nic);
    21822138err_irq:
    21832139        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);
    21872140err_tx_structure:
    21882141        e1000_uninitialize_tx_structure(e1000);
     
    23302283       
    23312284        if (!descriptor_available) {
    2332                 /* Frame lost */
     2285                /* Packet lost */
    23332286                fibril_mutex_unlock(&e1000->tx_lock);
    23342287                return;
     
    23592312       
    23602313        tdt++;
    2361         if (tdt == E1000_TX_FRAME_COUNT)
     2314        if (tdt == E1000_TX_PACKETS_COUNT)
    23622315                tdt = 0;
    23632316       
Note: See TracChangeset for help on using the changeset viewer.