Changeset cfb79747 in mainline for uspace/drv/nic/e1k/e1k.c


Ignore:
Timestamp:
2012-02-14T22:06:15Z (12 years ago)
Author:
Jakub Jermar <jakub@…>
Branches:
lfn, master, serial, ticket/834-toolchain-update, topic/msim-upgrade, topic/simplify-dev-export
Children:
a31aad1
Parents:
199112e4 (diff), e10d41a (diff)
Note: this is a merge changeset, the changes displayed below correspond to the merge itself.
Use the (diff) links above to see all the changes relative to each parent.
Message:

Merge mainline changes.

File:
1 edited

Legend:

Unmodified
Added
Removed

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

    r199112e4 rcfb79747  
    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>
    5754#include "e1k.h"
    5855
    … …  
    6259
    6360/* Must be power of 8 */
    64 #define E1000_RX_PACKETS_COUNT  128
    65 #define E1000_TX_PACKETS_COUNT  128
     61#define E1000_RX_FRAME_COUNT  128
     62#define E1000_TX_FRAME_COUNT  128
    6663
    6764#define E1000_RECEIVE_ADDRESS  16
    6865
    69 /** Maximum sending packet size */
     66/** Maximum sending frame size */
    7067#define E1000_MAX_SEND_FRAME_SIZE  2048
    71 /** Maximum receiving packet size */
    72 #define E1000_MAX_RECEIVE_PACKET_SIZE  2048
     68/** Maximum receiving frame size */
     69#define E1000_MAX_RECEIVE_FRAME_SIZE  2048
    7370
    7471/** nic_driver_data_t* -> e1000_t* cast */
    … …  
    137134        void *rx_ring_virt;
    138135       
    139         /** Packets in rx ring  */
    140         packet_t **rx_ring_packets;
     136        /** Ring of RX frames, physical address */
     137        void **rx_frame_phys;
     138        /** Ring of RX frames, virtual address */
     139        void **rx_frame_virt;
    141140       
    142141        /** VLAN tag */
    143142        uint16_t vlan_tag;
    144143       
    145         /** Add VLAN tag to packet */
     144        /** Add VLAN tag to frame */
    146145        bool vlan_tag_add;
    147146       
    … …  
    488487}
    489488
    490 /** Get state of acceptance of weird packets
     489/** Get state of acceptance of weird frames
    491490 *
    492491 * @param      device Device to check
    … …  
    506505};
    507506
    508 /** Set acceptance of weird packets
     507/** Set acceptance of weird frames
    509508 *
    510509 * @param device Device to update
    … …  
    690689}
    691690
    692 /** Disable receiving packets for default address
     691/** Disable receiving frames for default address
    693692 *
    694693 * @param e1000 E1000 data structure
    … …  
    702701}
    703702
    704 /** Enable receiving packets for default address
     703/** Enable receiving frames for default address
    705704 *
    706705 * @param e1000 E1000 data structure
    … …  
    762761}
    763762
    764 /** Enable accepting of broadcast packets
     763/** Enable accepting of broadcast frames
    765764 *
    766765 * @param e1000 E1000 data structure
    … …  
    774773}
    775774
    776 /** Disable accepting of broadcast packets
     775/** Disable accepting of broadcast frames
    777776 *
    778777 * @param e1000 E1000 data structure
    … …  
    810809}
    811810
    812 /** Set multicast packets acceptance mode
     811/** Set multicast frames acceptance mode
    813812 *
    814813 * @param nic      NIC device to update
    … …  
    864863}
    865864
    866 /** Set unicast packets acceptance mode
     865/** Set unicast frames acceptance mode
    867866 *
    868867 * @param nic      NIC device to update
    … …  
    922921}
    923922
    924 /** Set broadcast packets acceptance mode
     923/** Set broadcast frames acceptance mode
    925924 *
    926925 * @param nic  NIC device to update
    … …  
    10071006        if (vlan_mask) {
    10081007                /*
    1009                  * Disable receiving, so that packet matching
     1008                 * Disable receiving, so that frame matching
    10101009                 * partially written VLAN is not received.
    10111010                 */
    … …  
    10741073}
    10751074
    1076 /** Fill receive descriptor with new empty packet
    1077  *
    1078  * Store packet in e1000->rx_ring_packets
     1075/** Fill receive descriptor with new empty buffer
     1076 *
     1077 * Store frame in e1000->rx_frame_phys
    10791078 *
    10801079 * @param nic    NIC data stricture
    … …  
    10851084{
    10861085        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;
     1086       
    10931087        e1000_rx_descriptor_t *rx_descriptor = (e1000_rx_descriptor_t *)
    10941088            (e1000->rx_ring_virt + offset * sizeof(e1000_rx_descriptor_t));
    10951089       
    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        
     1090        rx_descriptor->phys_addr = PTR_TO_U64(e1000->rx_frame_phys[offset]);
    11051091        rx_descriptor->length = 0;
    11061092        rx_descriptor->checksum = 0;
    … …  
    11661152}
    11671153
    1168 /** Receive packets
     1154/** Receive frames
    11691155 *
    11701156 * @param nic NIC data
    11711157 *
    11721158 */
    1173 static void e1000_receive_packets(nic_t *nic)
     1159static void e1000_receive_frames(nic_t *nic)
    11741160{
    11751161        e1000_t *e1000 = DRIVER_DATA_NIC(nic);
    … …  
    11781164       
    11791165        uint32_t *tail_addr = E1000_REG_ADDR(e1000, E1000_RDT);
    1180         uint32_t next_tail = e1000_inc_tail(*tail_addr, E1000_RX_PACKETS_COUNT);
     1166        uint32_t next_tail = e1000_inc_tail(*tail_addr, E1000_RX_FRAME_COUNT);
    11811167       
    11821168        e1000_rx_descriptor_t *rx_descriptor = (e1000_rx_descriptor_t *)
    … …  
    11841170       
    11851171        while (rx_descriptor->status & 0x01) {
    1186                 uint32_t packet_size = rx_descriptor->length - E1000_CRC_SIZE;
     1172                uint32_t frame_size = rx_descriptor->length - E1000_CRC_SIZE;
    11871173               
    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);
     1174                nic_frame_t *frame = nic_alloc_frame(nic, frame_size);
     1175                if (frame != NULL) {
     1176                        memcpy(frame->data, e1000->rx_frame_virt[next_tail], frame_size);
     1177                        nic_received_frame(nic, frame);
     1178                } else {
     1179                        ddf_msg(LVL_ERROR, "Memory allocation failed. Frame dropped.");
     1180                }
    11931181               
    11941182                e1000_fill_new_rx_descriptor(nic, next_tail);
    11951183               
    1196                 *tail_addr = e1000_inc_tail(*tail_addr, E1000_RX_PACKETS_COUNT);
    1197                 next_tail = e1000_inc_tail(*tail_addr, E1000_RX_PACKETS_COUNT);
     1184                *tail_addr = e1000_inc_tail(*tail_addr, E1000_RX_FRAME_COUNT);
     1185                next_tail = e1000_inc_tail(*tail_addr, E1000_RX_FRAME_COUNT);
    11981186               
    11991187                rx_descriptor = (e1000_rx_descriptor_t *)
    … …  
    12361224{
    12371225        if (icr & ICR_RXT0)
    1238                 e1000_receive_packets(nic);
     1226                e1000_receive_frames(nic);
    12391227}
    12401228
    … …  
    12861274}
    12871275
    1288 /** Force receiving all packets in the receive buffer
     1276/** Force receiving all frames in the receive buffer
    12891277 *
    12901278 * @param nic NIC data
    … …  
    13591347static void e1000_initialize_rx_registers(e1000_t *e1000)
    13601348{
    1361         E1000_REG_WRITE(e1000, E1000_RDLEN, E1000_RX_PACKETS_COUNT * 16);
     1349        E1000_REG_WRITE(e1000, E1000_RDLEN, E1000_RX_FRAME_COUNT * 16);
    13621350        E1000_REG_WRITE(e1000, E1000_RDH, 0);
    13631351       
    13641352        /* It is not posible to let HW use all descriptors */
    1365         E1000_REG_WRITE(e1000, E1000_RDT, E1000_RX_PACKETS_COUNT - 1);
     1353        E1000_REG_WRITE(e1000, E1000_RDT, E1000_RX_FRAME_COUNT - 1);
    13661354       
    13671355        /* Set Broadcast Enable Bit */
    … …  
    13831371       
    13841372        int rc = dmamem_map_anonymous(
    1385             E1000_RX_PACKETS_COUNT * sizeof(e1000_rx_descriptor_t),
     1373            E1000_RX_FRAME_COUNT * sizeof(e1000_rx_descriptor_t),
    13861374            AS_AREA_READ | AS_AREA_WRITE, 0, &e1000->rx_ring_phys,
    13871375            &e1000->rx_ring_virt);
    … …  
    13941382            (uint32_t) PTR_TO_U64(e1000->rx_ring_phys));
    13951383       
    1396         e1000->rx_ring_packets =
    1397             malloc(E1000_RX_PACKETS_COUNT * sizeof(packet_t *));
    1398         // FIXME: Check return value
    1399        
     1384        e1000->rx_frame_phys =
     1385            calloc(E1000_RX_FRAME_COUNT, sizeof(void *));
     1386        e1000->rx_frame_virt =
     1387            calloc(E1000_RX_FRAME_COUNT, sizeof(void *));
     1388        if (e1000->rx_frame_phys == NULL || e1000->rx_frame_virt == NULL) {
     1389                rc = ENOMEM;
     1390                goto error;
     1391        }
     1392       
     1393        size_t i;
     1394        void *frame_virt;
     1395        void *frame_phys;
     1396       
     1397        for (i = 0; i < E1000_RX_FRAME_COUNT; i++) {
     1398                rc = dmamem_map_anonymous(
     1399                    E1000_MAX_SEND_FRAME_SIZE, AS_AREA_READ | AS_AREA_WRITE,
     1400                    0, &frame_phys, &frame_virt);
     1401                if (rc != EOK)
     1402                        goto error;
     1403               
     1404                e1000->rx_frame_virt[i] = frame_virt;
     1405                e1000->rx_frame_phys[i] = frame_phys;
     1406        }
     1407       
     1408        /* Write descriptor */
     1409        for (i = 0; i < E1000_RX_FRAME_COUNT; i++)
     1410                e1000_fill_new_rx_descriptor(nic, i);
     1411       
     1412        e1000_initialize_rx_registers(e1000);
     1413       
     1414        fibril_mutex_unlock(&e1000->rx_lock);
     1415        return EOK;
     1416       
     1417error:
     1418        for (i = 0; i < E1000_RX_FRAME_COUNT; i++) {
     1419                if (e1000->rx_frame_virt[i] != NULL) {
     1420                        dmamem_unmap_anonymous(e1000->rx_frame_virt[i]);
     1421                        e1000->rx_frame_virt[i] = NULL;
     1422                        e1000->rx_frame_phys[i] = NULL;
     1423                }
     1424        }
     1425       
     1426        if (e1000->rx_frame_phys != NULL) {
     1427                free(e1000->rx_frame_phys);
     1428                e1000->rx_frame_phys = NULL;
     1429        }
     1430       
     1431        if (e1000->rx_frame_virt != NULL) {
     1432                free(e1000->rx_frame_virt);
     1433                e1000->rx_frame_phys = NULL;
     1434        }
     1435       
     1436        return rc;
     1437}
     1438
     1439/** Uninitialize receive structure
     1440 *
     1441 * @param nic NIC data
     1442 *
     1443 */
     1444static void e1000_uninitialize_rx_structure(nic_t *nic)
     1445{
     1446        e1000_t *e1000 = DRIVER_DATA_NIC(nic);
     1447       
     1448        /* Write descriptor */
     1449        for (unsigned int offset = 0; offset < E1000_RX_FRAME_COUNT; offset++) {
     1450                dmamem_unmap_anonymous(e1000->rx_frame_virt[offset]);
     1451                e1000->rx_frame_virt[offset] = NULL;
     1452                e1000->rx_frame_phys[offset] = NULL;
     1453        }
     1454       
     1455        free(e1000->rx_frame_virt);
     1456        free(e1000->rx_frame_phys);
     1457        e1000->rx_frame_virt = NULL;
     1458        e1000->rx_frame_phys = NULL;
     1459        dmamem_unmap_anonymous(e1000->rx_ring_virt);
     1460}
     1461
     1462/** Clear receive descriptor ring
     1463 *
     1464 * @param e1000 E1000 data
     1465 *
     1466 */
     1467static void e1000_clear_rx_ring(e1000_t *e1000)
     1468{
    14001469        /* Write descriptor */
    14011470        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;
     1471            offset < E1000_RX_FRAME_COUNT;
    14441472            offset++)
    14451473                e1000_clear_rx_descriptor(e1000, offset);
    … …  
    15101538static void e1000_initialize_tx_registers(e1000_t *e1000)
    15111539{
    1512         E1000_REG_WRITE(e1000, E1000_TDLEN, E1000_TX_PACKETS_COUNT * 16);
     1540        E1000_REG_WRITE(e1000, E1000_TDLEN, E1000_TX_FRAME_COUNT * 16);
    15131541        E1000_REG_WRITE(e1000, E1000_TDH, 0);
    15141542        E1000_REG_WRITE(e1000, E1000_TDT, 0);
    … …  
    15421570       
    15431571        int rc = dmamem_map_anonymous(
    1544             E1000_TX_PACKETS_COUNT * sizeof(e1000_tx_descriptor_t),
     1572            E1000_TX_FRAME_COUNT * sizeof(e1000_tx_descriptor_t),
    15451573            AS_AREA_READ | AS_AREA_WRITE, 0, &e1000->tx_ring_phys,
    15461574            &e1000->tx_ring_virt);
    … …  
    15491577       
    15501578        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 *));
     1579            E1000_TX_FRAME_COUNT * sizeof(e1000_tx_descriptor_t));
     1580       
     1581        e1000->tx_frame_phys = calloc(E1000_TX_FRAME_COUNT, sizeof(void *));
     1582        e1000->tx_frame_virt = calloc(E1000_TX_FRAME_COUNT, sizeof(void *));
    15551583
    15561584        if (e1000->tx_frame_phys == NULL || e1000->tx_frame_virt == NULL) {
    … …  
    15591587        }
    15601588       
    1561         for (i = 0; i < E1000_TX_PACKETS_COUNT; i++) {
     1589        for (i = 0; i < E1000_TX_FRAME_COUNT; i++) {
    15621590                rc = dmamem_map_anonymous(
    15631591                    E1000_MAX_SEND_FRAME_SIZE, AS_AREA_READ | AS_AREA_WRITE,
    … …  
    15841612       
    15851613        if (e1000->tx_frame_phys != NULL && e1000->tx_frame_virt != NULL) {
    1586                 for (i = 0; i < E1000_TX_PACKETS_COUNT; i++) {
     1614                for (i = 0; i < E1000_TX_FRAME_COUNT; i++) {
    15871615                        if (e1000->tx_frame_virt[i] != NULL) {
    15881616                                dmamem_unmap_anonymous(e1000->tx_frame_virt[i]);
    … …  
    16151643        size_t i;
    16161644       
    1617         for (i = 0; i < E1000_TX_PACKETS_COUNT; i++) {
     1645        for (i = 0; i < E1000_TX_FRAME_COUNT; i++) {
    16181646                dmamem_unmap_anonymous(e1000->tx_frame_virt[i]);
    16191647                e1000->tx_frame_virt[i] = NULL;
    … …  
    16301658                e1000->tx_frame_phys = NULL;
    16311659        }
     1660       
    16321661        dmamem_unmap_anonymous(e1000->tx_ring_virt);
    16331662}
    … …  
    16421671        /* Write descriptor */
    16431672        for (unsigned int offset = 0;
    1644             offset < E1000_TX_PACKETS_COUNT;
     1673            offset < E1000_TX_FRAME_COUNT;
    16451674            offset++)
    16461675                e1000_clear_tx_descriptor(nic, offset);
    … …  
    16991728}
    17001729
    1701 /** Activate the device to receive and transmit packets
     1730/** Activate the device to receive and transmit frames
    17021731 *
    17031732 * @param nic NIC driver data
    … …  
    20402069        case E1000_82545:
    20412070        case E1000_82546:
    2042         case E1000_82572:
    20432071                e1000->info.eerd_start = 0x01;
    20442072                e1000->info.eerd_done = 0x10;
    … …  
    20472075                break;
    20482076        case E1000_82547:
     2077        case E1000_82572:
    20492078        case E1000_80003ES2:
    20502079                e1000->info.eerd_start = 0x01;
    … …  
    20852114int e1000_dev_add(ddf_dev_t *dev)
    20862115{
     2116        ddf_fun_t *fun;
    20872117        assert(dev);
    20882118       
    … …  
    21152145        e1000_initialize_vlan(e1000);
    21162146       
    2117         rc = nic_register_as_ddf_fun(nic, &e1000_dev_ops);
    2118         if (rc != EOK)
     2147        fun = ddf_fun_create(nic_get_ddf_dev(nic), fun_exposed, "port0");
     2148        if (fun == NULL)
    21192149                goto err_tx_structure;
     2150        nic_set_ddf_fun(nic, fun);
     2151        fun->ops = &e1000_dev_ops;
     2152        fun->driver_data = nic;
    21202153       
    21212154        rc = e1000_register_int_handler(nic);
    21222155        if (rc != EOK)
    2123                 goto err_tx_structure;
     2156                goto err_fun_create;
    21242157       
    21252158        rc = nic_connect_to_services(nic);
    … …  
    21442177                goto err_rx_structure;
    21452178       
     2179        rc = ddf_fun_bind(fun);
     2180        if (rc != EOK)
     2181                goto err_fun_bind;
     2182       
     2183        rc = ddf_fun_add_to_category(fun, DEVICE_CATEGORY_NIC);
     2184        if (rc != EOK)
     2185                goto err_add_to_cat;
     2186       
    21462187        return EOK;
    21472188       
     2189err_add_to_cat:
     2190        ddf_fun_unbind(fun);
     2191err_fun_bind:
    21482192err_rx_structure:
    21492193        e1000_uninitialize_rx_structure(nic);
    21502194err_irq:
    21512195        unregister_interrupt_handler(dev, DRIVER_DATA_DEV(dev)->irq);
     2196err_fun_create:
     2197        ddf_fun_destroy(fun);
     2198        nic_set_ddf_fun(nic, NULL);
    21522199err_tx_structure:
    21532200        e1000_uninitialize_tx_structure(e1000);
    … …  
    22952342       
    22962343        if (!descriptor_available) {
    2297                 /* Packet lost */
     2344                /* Frame lost */
    22982345                fibril_mutex_unlock(&e1000->tx_lock);
    22992346                return;
    … …  
    23242371       
    23252372        tdt++;
    2326         if (tdt == E1000_TX_PACKETS_COUNT)
     2373        if (tdt == E1000_TX_FRAME_COUNT)
    23272374                tdt = 0;
    23282375       
Note: See TracChangeset for help on using the changeset viewer.