14a71df50SFrank Blaschka /* 24a71df50SFrank Blaschka * drivers/s390/net/qeth_core_main.c 34a71df50SFrank Blaschka * 44a71df50SFrank Blaschka * Copyright IBM Corp. 2007 54a71df50SFrank Blaschka * Author(s): Utz Bacher <utz.bacher@de.ibm.com>, 64a71df50SFrank Blaschka * Frank Pavlic <fpavlic@de.ibm.com>, 74a71df50SFrank Blaschka * Thomas Spatzier <tspat@de.ibm.com>, 84a71df50SFrank Blaschka * Frank Blaschka <frank.blaschka@de.ibm.com> 94a71df50SFrank Blaschka */ 104a71df50SFrank Blaschka 1174eacdb9SFrank Blaschka #define KMSG_COMPONENT "qeth" 1274eacdb9SFrank Blaschka #define pr_fmt(fmt) KMSG_COMPONENT ": " fmt 1374eacdb9SFrank Blaschka 144a71df50SFrank Blaschka #include <linux/module.h> 154a71df50SFrank Blaschka #include <linux/moduleparam.h> 164a71df50SFrank Blaschka #include <linux/string.h> 174a71df50SFrank Blaschka #include <linux/errno.h> 184a71df50SFrank Blaschka #include <linux/kernel.h> 194a71df50SFrank Blaschka #include <linux/ip.h> 204a71df50SFrank Blaschka #include <linux/ipv6.h> 214a71df50SFrank Blaschka #include <linux/tcp.h> 224a71df50SFrank Blaschka #include <linux/mii.h> 234a71df50SFrank Blaschka #include <linux/kthread.h> 244a71df50SFrank Blaschka 25ab4227cbSMartin Schwidefsky #include <asm/ebcdic.h> 26ab4227cbSMartin Schwidefsky #include <asm/io.h> 274a71df50SFrank Blaschka #include <asm/s390_rdev.h> 284a71df50SFrank Blaschka 294a71df50SFrank Blaschka #include "qeth_core.h" 304a71df50SFrank Blaschka #include "qeth_core_offl.h" 314a71df50SFrank Blaschka 32d11ba0c4SPeter Tiedemann struct qeth_dbf_info qeth_dbf[QETH_DBF_INFOS] = { 33d11ba0c4SPeter Tiedemann /* define dbf - Name, Pages, Areas, Maxlen, Level, View, Handle */ 34d11ba0c4SPeter Tiedemann /* N P A M L V H */ 35d11ba0c4SPeter Tiedemann [QETH_DBF_SETUP] = {"qeth_setup", 36d11ba0c4SPeter Tiedemann 8, 1, 8, 5, &debug_hex_ascii_view, NULL}, 37d11ba0c4SPeter Tiedemann [QETH_DBF_QERR] = {"qeth_qerr", 38d11ba0c4SPeter Tiedemann 2, 1, 8, 2, &debug_hex_ascii_view, NULL}, 39d11ba0c4SPeter Tiedemann [QETH_DBF_TRACE] = {"qeth_trace", 40d11ba0c4SPeter Tiedemann 4, 1, 8, 3, &debug_hex_ascii_view, NULL}, 41d11ba0c4SPeter Tiedemann [QETH_DBF_MSG] = {"qeth_msg", 42d11ba0c4SPeter Tiedemann 8, 1, 128, 3, &debug_sprintf_view, NULL}, 43d11ba0c4SPeter Tiedemann [QETH_DBF_SENSE] = {"qeth_sense", 44d11ba0c4SPeter Tiedemann 2, 1, 64, 2, &debug_hex_ascii_view, NULL}, 45d11ba0c4SPeter Tiedemann [QETH_DBF_MISC] = {"qeth_misc", 46d11ba0c4SPeter Tiedemann 2, 1, 256, 2, &debug_hex_ascii_view, NULL}, 47d11ba0c4SPeter Tiedemann [QETH_DBF_CTRL] = {"qeth_control", 48d11ba0c4SPeter Tiedemann 8, 1, QETH_DBF_CTRL_LEN, 5, &debug_hex_ascii_view, NULL}, 49d11ba0c4SPeter Tiedemann }; 50d11ba0c4SPeter Tiedemann EXPORT_SYMBOL_GPL(qeth_dbf); 514a71df50SFrank Blaschka 524a71df50SFrank Blaschka struct qeth_card_list_struct qeth_core_card_list; 534a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_core_card_list); 54683d718aSFrank Blaschka struct kmem_cache *qeth_core_header_cache; 55683d718aSFrank Blaschka EXPORT_SYMBOL_GPL(qeth_core_header_cache); 564a71df50SFrank Blaschka 574a71df50SFrank Blaschka static struct device *qeth_core_root_dev; 584a71df50SFrank Blaschka static unsigned int known_devices[][10] = QETH_MODELLIST_ARRAY; 594a71df50SFrank Blaschka static struct lock_class_key qdio_out_skb_queue_key; 604a71df50SFrank Blaschka 614a71df50SFrank Blaschka static void qeth_send_control_data_cb(struct qeth_channel *, 624a71df50SFrank Blaschka struct qeth_cmd_buffer *); 634a71df50SFrank Blaschka static int qeth_issue_next_read(struct qeth_card *); 644a71df50SFrank Blaschka static struct qeth_cmd_buffer *qeth_get_buffer(struct qeth_channel *); 654a71df50SFrank Blaschka static void qeth_setup_ccw(struct qeth_channel *, unsigned char *, __u32); 664a71df50SFrank Blaschka static void qeth_free_buffer_pool(struct qeth_card *); 674a71df50SFrank Blaschka static int qeth_qdio_establish(struct qeth_card *); 684a71df50SFrank Blaschka 694a71df50SFrank Blaschka 704a71df50SFrank Blaschka static inline void __qeth_fill_buffer_frag(struct sk_buff *skb, 714a71df50SFrank Blaschka struct qdio_buffer *buffer, int is_tso, 724a71df50SFrank Blaschka int *next_element_to_fill) 734a71df50SFrank Blaschka { 744a71df50SFrank Blaschka struct skb_frag_struct *frag; 754a71df50SFrank Blaschka int fragno; 764a71df50SFrank Blaschka unsigned long addr; 774a71df50SFrank Blaschka int element, cnt, dlen; 784a71df50SFrank Blaschka 794a71df50SFrank Blaschka fragno = skb_shinfo(skb)->nr_frags; 804a71df50SFrank Blaschka element = *next_element_to_fill; 814a71df50SFrank Blaschka dlen = 0; 824a71df50SFrank Blaschka 834a71df50SFrank Blaschka if (is_tso) 844a71df50SFrank Blaschka buffer->element[element].flags = 854a71df50SFrank Blaschka SBAL_FLAGS_MIDDLE_FRAG; 864a71df50SFrank Blaschka else 874a71df50SFrank Blaschka buffer->element[element].flags = 884a71df50SFrank Blaschka SBAL_FLAGS_FIRST_FRAG; 894a71df50SFrank Blaschka dlen = skb->len - skb->data_len; 904a71df50SFrank Blaschka if (dlen) { 914a71df50SFrank Blaschka buffer->element[element].addr = skb->data; 924a71df50SFrank Blaschka buffer->element[element].length = dlen; 934a71df50SFrank Blaschka element++; 944a71df50SFrank Blaschka } 954a71df50SFrank Blaschka for (cnt = 0; cnt < fragno; cnt++) { 964a71df50SFrank Blaschka frag = &skb_shinfo(skb)->frags[cnt]; 974a71df50SFrank Blaschka addr = (page_to_pfn(frag->page) << PAGE_SHIFT) + 984a71df50SFrank Blaschka frag->page_offset; 994a71df50SFrank Blaschka buffer->element[element].addr = (char *)addr; 1004a71df50SFrank Blaschka buffer->element[element].length = frag->size; 1014a71df50SFrank Blaschka if (cnt < (fragno - 1)) 1024a71df50SFrank Blaschka buffer->element[element].flags = 1034a71df50SFrank Blaschka SBAL_FLAGS_MIDDLE_FRAG; 1044a71df50SFrank Blaschka else 1054a71df50SFrank Blaschka buffer->element[element].flags = 1064a71df50SFrank Blaschka SBAL_FLAGS_LAST_FRAG; 1074a71df50SFrank Blaschka element++; 1084a71df50SFrank Blaschka } 1094a71df50SFrank Blaschka *next_element_to_fill = element; 1104a71df50SFrank Blaschka } 1114a71df50SFrank Blaschka 1124a71df50SFrank Blaschka static inline const char *qeth_get_cardname(struct qeth_card *card) 1134a71df50SFrank Blaschka { 1144a71df50SFrank Blaschka if (card->info.guestlan) { 1154a71df50SFrank Blaschka switch (card->info.type) { 1164a71df50SFrank Blaschka case QETH_CARD_TYPE_OSAE: 1174a71df50SFrank Blaschka return " Guest LAN QDIO"; 1184a71df50SFrank Blaschka case QETH_CARD_TYPE_IQD: 1194a71df50SFrank Blaschka return " Guest LAN Hiper"; 1204a71df50SFrank Blaschka default: 1214a71df50SFrank Blaschka return " unknown"; 1224a71df50SFrank Blaschka } 1234a71df50SFrank Blaschka } else { 1244a71df50SFrank Blaschka switch (card->info.type) { 1254a71df50SFrank Blaschka case QETH_CARD_TYPE_OSAE: 1264a71df50SFrank Blaschka return " OSD Express"; 1274a71df50SFrank Blaschka case QETH_CARD_TYPE_IQD: 1284a71df50SFrank Blaschka return " HiperSockets"; 1294a71df50SFrank Blaschka case QETH_CARD_TYPE_OSN: 1304a71df50SFrank Blaschka return " OSN QDIO"; 1314a71df50SFrank Blaschka default: 1324a71df50SFrank Blaschka return " unknown"; 1334a71df50SFrank Blaschka } 1344a71df50SFrank Blaschka } 1354a71df50SFrank Blaschka return " n/a"; 1364a71df50SFrank Blaschka } 1374a71df50SFrank Blaschka 1384a71df50SFrank Blaschka /* max length to be returned: 14 */ 1394a71df50SFrank Blaschka const char *qeth_get_cardname_short(struct qeth_card *card) 1404a71df50SFrank Blaschka { 1414a71df50SFrank Blaschka if (card->info.guestlan) { 1424a71df50SFrank Blaschka switch (card->info.type) { 1434a71df50SFrank Blaschka case QETH_CARD_TYPE_OSAE: 1444a71df50SFrank Blaschka return "GuestLAN QDIO"; 1454a71df50SFrank Blaschka case QETH_CARD_TYPE_IQD: 1464a71df50SFrank Blaschka return "GuestLAN Hiper"; 1474a71df50SFrank Blaschka default: 1484a71df50SFrank Blaschka return "unknown"; 1494a71df50SFrank Blaschka } 1504a71df50SFrank Blaschka } else { 1514a71df50SFrank Blaschka switch (card->info.type) { 1524a71df50SFrank Blaschka case QETH_CARD_TYPE_OSAE: 1534a71df50SFrank Blaschka switch (card->info.link_type) { 1544a71df50SFrank Blaschka case QETH_LINK_TYPE_FAST_ETH: 1554a71df50SFrank Blaschka return "OSD_100"; 1564a71df50SFrank Blaschka case QETH_LINK_TYPE_HSTR: 1574a71df50SFrank Blaschka return "HSTR"; 1584a71df50SFrank Blaschka case QETH_LINK_TYPE_GBIT_ETH: 1594a71df50SFrank Blaschka return "OSD_1000"; 1604a71df50SFrank Blaschka case QETH_LINK_TYPE_10GBIT_ETH: 1614a71df50SFrank Blaschka return "OSD_10GIG"; 1624a71df50SFrank Blaschka case QETH_LINK_TYPE_LANE_ETH100: 1634a71df50SFrank Blaschka return "OSD_FE_LANE"; 1644a71df50SFrank Blaschka case QETH_LINK_TYPE_LANE_TR: 1654a71df50SFrank Blaschka return "OSD_TR_LANE"; 1664a71df50SFrank Blaschka case QETH_LINK_TYPE_LANE_ETH1000: 1674a71df50SFrank Blaschka return "OSD_GbE_LANE"; 1684a71df50SFrank Blaschka case QETH_LINK_TYPE_LANE: 1694a71df50SFrank Blaschka return "OSD_ATM_LANE"; 1704a71df50SFrank Blaschka default: 1714a71df50SFrank Blaschka return "OSD_Express"; 1724a71df50SFrank Blaschka } 1734a71df50SFrank Blaschka case QETH_CARD_TYPE_IQD: 1744a71df50SFrank Blaschka return "HiperSockets"; 1754a71df50SFrank Blaschka case QETH_CARD_TYPE_OSN: 1764a71df50SFrank Blaschka return "OSN"; 1774a71df50SFrank Blaschka default: 1784a71df50SFrank Blaschka return "unknown"; 1794a71df50SFrank Blaschka } 1804a71df50SFrank Blaschka } 1814a71df50SFrank Blaschka return "n/a"; 1824a71df50SFrank Blaschka } 1834a71df50SFrank Blaschka 1844a71df50SFrank Blaschka void qeth_set_allowed_threads(struct qeth_card *card, unsigned long threads, 1854a71df50SFrank Blaschka int clear_start_mask) 1864a71df50SFrank Blaschka { 1874a71df50SFrank Blaschka unsigned long flags; 1884a71df50SFrank Blaschka 1894a71df50SFrank Blaschka spin_lock_irqsave(&card->thread_mask_lock, flags); 1904a71df50SFrank Blaschka card->thread_allowed_mask = threads; 1914a71df50SFrank Blaschka if (clear_start_mask) 1924a71df50SFrank Blaschka card->thread_start_mask &= threads; 1934a71df50SFrank Blaschka spin_unlock_irqrestore(&card->thread_mask_lock, flags); 1944a71df50SFrank Blaschka wake_up(&card->wait_q); 1954a71df50SFrank Blaschka } 1964a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_set_allowed_threads); 1974a71df50SFrank Blaschka 1984a71df50SFrank Blaschka int qeth_threads_running(struct qeth_card *card, unsigned long threads) 1994a71df50SFrank Blaschka { 2004a71df50SFrank Blaschka unsigned long flags; 2014a71df50SFrank Blaschka int rc = 0; 2024a71df50SFrank Blaschka 2034a71df50SFrank Blaschka spin_lock_irqsave(&card->thread_mask_lock, flags); 2044a71df50SFrank Blaschka rc = (card->thread_running_mask & threads); 2054a71df50SFrank Blaschka spin_unlock_irqrestore(&card->thread_mask_lock, flags); 2064a71df50SFrank Blaschka return rc; 2074a71df50SFrank Blaschka } 2084a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_threads_running); 2094a71df50SFrank Blaschka 2104a71df50SFrank Blaschka int qeth_wait_for_threads(struct qeth_card *card, unsigned long threads) 2114a71df50SFrank Blaschka { 2124a71df50SFrank Blaschka return wait_event_interruptible(card->wait_q, 2134a71df50SFrank Blaschka qeth_threads_running(card, threads) == 0); 2144a71df50SFrank Blaschka } 2154a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_wait_for_threads); 2164a71df50SFrank Blaschka 2174a71df50SFrank Blaschka void qeth_clear_working_pool_list(struct qeth_card *card) 2184a71df50SFrank Blaschka { 2194a71df50SFrank Blaschka struct qeth_buffer_pool_entry *pool_entry, *tmp; 2204a71df50SFrank Blaschka 221d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 5, "clwrklst"); 2224a71df50SFrank Blaschka list_for_each_entry_safe(pool_entry, tmp, 2234a71df50SFrank Blaschka &card->qdio.in_buf_pool.entry_list, list){ 2244a71df50SFrank Blaschka list_del(&pool_entry->list); 2254a71df50SFrank Blaschka } 2264a71df50SFrank Blaschka } 2274a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_clear_working_pool_list); 2284a71df50SFrank Blaschka 2294a71df50SFrank Blaschka static int qeth_alloc_buffer_pool(struct qeth_card *card) 2304a71df50SFrank Blaschka { 2314a71df50SFrank Blaschka struct qeth_buffer_pool_entry *pool_entry; 2324a71df50SFrank Blaschka void *ptr; 2334a71df50SFrank Blaschka int i, j; 2344a71df50SFrank Blaschka 235d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 5, "alocpool"); 2364a71df50SFrank Blaschka for (i = 0; i < card->qdio.init_pool.buf_count; ++i) { 2374a71df50SFrank Blaschka pool_entry = kmalloc(sizeof(*pool_entry), GFP_KERNEL); 2384a71df50SFrank Blaschka if (!pool_entry) { 2394a71df50SFrank Blaschka qeth_free_buffer_pool(card); 2404a71df50SFrank Blaschka return -ENOMEM; 2414a71df50SFrank Blaschka } 2424a71df50SFrank Blaschka for (j = 0; j < QETH_MAX_BUFFER_ELEMENTS(card); ++j) { 243508b3c4fSUrsula Braun ptr = (void *) __get_free_page(GFP_KERNEL); 2444a71df50SFrank Blaschka if (!ptr) { 2454a71df50SFrank Blaschka while (j > 0) 2464a71df50SFrank Blaschka free_page((unsigned long) 2474a71df50SFrank Blaschka pool_entry->elements[--j]); 2484a71df50SFrank Blaschka kfree(pool_entry); 2494a71df50SFrank Blaschka qeth_free_buffer_pool(card); 2504a71df50SFrank Blaschka return -ENOMEM; 2514a71df50SFrank Blaschka } 2524a71df50SFrank Blaschka pool_entry->elements[j] = ptr; 2534a71df50SFrank Blaschka } 2544a71df50SFrank Blaschka list_add(&pool_entry->init_list, 2554a71df50SFrank Blaschka &card->qdio.init_pool.entry_list); 2564a71df50SFrank Blaschka } 2574a71df50SFrank Blaschka return 0; 2584a71df50SFrank Blaschka } 2594a71df50SFrank Blaschka 2604a71df50SFrank Blaschka int qeth_realloc_buffer_pool(struct qeth_card *card, int bufcnt) 2614a71df50SFrank Blaschka { 262d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 2, "realcbp"); 2634a71df50SFrank Blaschka 2644a71df50SFrank Blaschka if ((card->state != CARD_STATE_DOWN) && 2654a71df50SFrank Blaschka (card->state != CARD_STATE_RECOVER)) 2664a71df50SFrank Blaschka return -EPERM; 2674a71df50SFrank Blaschka 2684a71df50SFrank Blaschka /* TODO: steel/add buffers from/to a running card's buffer pool (?) */ 2694a71df50SFrank Blaschka qeth_clear_working_pool_list(card); 2704a71df50SFrank Blaschka qeth_free_buffer_pool(card); 2714a71df50SFrank Blaschka card->qdio.in_buf_pool.buf_count = bufcnt; 2724a71df50SFrank Blaschka card->qdio.init_pool.buf_count = bufcnt; 2734a71df50SFrank Blaschka return qeth_alloc_buffer_pool(card); 2744a71df50SFrank Blaschka } 2754a71df50SFrank Blaschka 2764a71df50SFrank Blaschka int qeth_set_large_send(struct qeth_card *card, 2774a71df50SFrank Blaschka enum qeth_large_send_types type) 2784a71df50SFrank Blaschka { 2794a71df50SFrank Blaschka int rc = 0; 2804a71df50SFrank Blaschka 2814a71df50SFrank Blaschka if (card->dev == NULL) { 2824a71df50SFrank Blaschka card->options.large_send = type; 2834a71df50SFrank Blaschka return 0; 2844a71df50SFrank Blaschka } 2854a71df50SFrank Blaschka if (card->state == CARD_STATE_UP) 2864a71df50SFrank Blaschka netif_tx_disable(card->dev); 2874a71df50SFrank Blaschka card->options.large_send = type; 2884a71df50SFrank Blaschka switch (card->options.large_send) { 2894a71df50SFrank Blaschka case QETH_LARGE_SEND_EDDP: 2904a71df50SFrank Blaschka card->dev->features |= NETIF_F_TSO | NETIF_F_SG | 2914a71df50SFrank Blaschka NETIF_F_HW_CSUM; 2924a71df50SFrank Blaschka break; 2934a71df50SFrank Blaschka case QETH_LARGE_SEND_TSO: 2944a71df50SFrank Blaschka if (qeth_is_supported(card, IPA_OUTBOUND_TSO)) { 2954a71df50SFrank Blaschka card->dev->features |= NETIF_F_TSO | NETIF_F_SG | 2964a71df50SFrank Blaschka NETIF_F_HW_CSUM; 2974a71df50SFrank Blaschka } else { 2984a71df50SFrank Blaschka card->dev->features &= ~(NETIF_F_TSO | NETIF_F_SG | 2994a71df50SFrank Blaschka NETIF_F_HW_CSUM); 3004a71df50SFrank Blaschka card->options.large_send = QETH_LARGE_SEND_NO; 3014a71df50SFrank Blaschka rc = -EOPNOTSUPP; 3024a71df50SFrank Blaschka } 3034a71df50SFrank Blaschka break; 3044a71df50SFrank Blaschka default: /* includes QETH_LARGE_SEND_NO */ 3054a71df50SFrank Blaschka card->dev->features &= ~(NETIF_F_TSO | NETIF_F_SG | 3064a71df50SFrank Blaschka NETIF_F_HW_CSUM); 3074a71df50SFrank Blaschka break; 3084a71df50SFrank Blaschka } 3094a71df50SFrank Blaschka if (card->state == CARD_STATE_UP) 3104a71df50SFrank Blaschka netif_wake_queue(card->dev); 3114a71df50SFrank Blaschka return rc; 3124a71df50SFrank Blaschka } 3134a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_set_large_send); 3144a71df50SFrank Blaschka 3154a71df50SFrank Blaschka static int qeth_issue_next_read(struct qeth_card *card) 3164a71df50SFrank Blaschka { 3174a71df50SFrank Blaschka int rc; 3184a71df50SFrank Blaschka struct qeth_cmd_buffer *iob; 3194a71df50SFrank Blaschka 320d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 5, "issnxrd"); 3214a71df50SFrank Blaschka if (card->read.state != CH_STATE_UP) 3224a71df50SFrank Blaschka return -EIO; 3234a71df50SFrank Blaschka iob = qeth_get_buffer(&card->read); 3244a71df50SFrank Blaschka if (!iob) { 32574eacdb9SFrank Blaschka dev_warn(&card->gdev->dev, "The qeth device driver " 32674eacdb9SFrank Blaschka "failed to recover an error on the device\n"); 32774eacdb9SFrank Blaschka QETH_DBF_MESSAGE(2, "%s issue_next_read failed: no iob " 32874eacdb9SFrank Blaschka "available\n", dev_name(&card->gdev->dev)); 3294a71df50SFrank Blaschka return -ENOMEM; 3304a71df50SFrank Blaschka } 3314a71df50SFrank Blaschka qeth_setup_ccw(&card->read, iob->data, QETH_BUFSIZE); 332d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 6, "noirqpnd"); 3334a71df50SFrank Blaschka rc = ccw_device_start(card->read.ccwdev, &card->read.ccw, 3344a71df50SFrank Blaschka (addr_t) iob, 0, 0); 3354a71df50SFrank Blaschka if (rc) { 33674eacdb9SFrank Blaschka QETH_DBF_MESSAGE(2, "%s error in starting next read ccw! " 33774eacdb9SFrank Blaschka "rc=%i\n", dev_name(&card->gdev->dev), rc); 3384a71df50SFrank Blaschka atomic_set(&card->read.irq_pending, 0); 3394a71df50SFrank Blaschka qeth_schedule_recovery(card); 3404a71df50SFrank Blaschka wake_up(&card->wait_q); 3414a71df50SFrank Blaschka } 3424a71df50SFrank Blaschka return rc; 3434a71df50SFrank Blaschka } 3444a71df50SFrank Blaschka 3454a71df50SFrank Blaschka static struct qeth_reply *qeth_alloc_reply(struct qeth_card *card) 3464a71df50SFrank Blaschka { 3474a71df50SFrank Blaschka struct qeth_reply *reply; 3484a71df50SFrank Blaschka 3494a71df50SFrank Blaschka reply = kzalloc(sizeof(struct qeth_reply), GFP_ATOMIC); 3504a71df50SFrank Blaschka if (reply) { 3514a71df50SFrank Blaschka atomic_set(&reply->refcnt, 1); 3524a71df50SFrank Blaschka atomic_set(&reply->received, 0); 3534a71df50SFrank Blaschka reply->card = card; 3544a71df50SFrank Blaschka }; 3554a71df50SFrank Blaschka return reply; 3564a71df50SFrank Blaschka } 3574a71df50SFrank Blaschka 3584a71df50SFrank Blaschka static void qeth_get_reply(struct qeth_reply *reply) 3594a71df50SFrank Blaschka { 3604a71df50SFrank Blaschka WARN_ON(atomic_read(&reply->refcnt) <= 0); 3614a71df50SFrank Blaschka atomic_inc(&reply->refcnt); 3624a71df50SFrank Blaschka } 3634a71df50SFrank Blaschka 3644a71df50SFrank Blaschka static void qeth_put_reply(struct qeth_reply *reply) 3654a71df50SFrank Blaschka { 3664a71df50SFrank Blaschka WARN_ON(atomic_read(&reply->refcnt) <= 0); 3674a71df50SFrank Blaschka if (atomic_dec_and_test(&reply->refcnt)) 3684a71df50SFrank Blaschka kfree(reply); 3694a71df50SFrank Blaschka } 3704a71df50SFrank Blaschka 371d11ba0c4SPeter Tiedemann static void qeth_issue_ipa_msg(struct qeth_ipa_cmd *cmd, int rc, 3724a71df50SFrank Blaschka struct qeth_card *card) 3734a71df50SFrank Blaschka { 3744a71df50SFrank Blaschka char *ipa_name; 375d11ba0c4SPeter Tiedemann int com = cmd->hdr.command; 3764a71df50SFrank Blaschka ipa_name = qeth_get_ipa_cmd_name(com); 377d11ba0c4SPeter Tiedemann if (rc) 378d11ba0c4SPeter Tiedemann QETH_DBF_MESSAGE(2, "IPA: %s(x%X) for %s returned x%X \"%s\"\n", 379d11ba0c4SPeter Tiedemann ipa_name, com, QETH_CARD_IFNAME(card), 380d11ba0c4SPeter Tiedemann rc, qeth_get_ipa_msg(rc)); 381d11ba0c4SPeter Tiedemann else 382d11ba0c4SPeter Tiedemann QETH_DBF_MESSAGE(5, "IPA: %s(x%X) for %s succeeded\n", 383d11ba0c4SPeter Tiedemann ipa_name, com, QETH_CARD_IFNAME(card)); 3844a71df50SFrank Blaschka } 3854a71df50SFrank Blaschka 3864a71df50SFrank Blaschka static struct qeth_ipa_cmd *qeth_check_ipa_data(struct qeth_card *card, 3874a71df50SFrank Blaschka struct qeth_cmd_buffer *iob) 3884a71df50SFrank Blaschka { 3894a71df50SFrank Blaschka struct qeth_ipa_cmd *cmd = NULL; 3904a71df50SFrank Blaschka 391d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 5, "chkipad"); 3924a71df50SFrank Blaschka if (IS_IPA(iob->data)) { 3934a71df50SFrank Blaschka cmd = (struct qeth_ipa_cmd *) PDU_ENCAPSULATION(iob->data); 3944a71df50SFrank Blaschka if (IS_IPA_REPLY(cmd)) { 395d11ba0c4SPeter Tiedemann if (cmd->hdr.command < IPA_CMD_SETCCID || 396d11ba0c4SPeter Tiedemann cmd->hdr.command > IPA_CMD_MODCCID) 397d11ba0c4SPeter Tiedemann qeth_issue_ipa_msg(cmd, 398d11ba0c4SPeter Tiedemann cmd->hdr.return_code, card); 3994a71df50SFrank Blaschka return cmd; 4004a71df50SFrank Blaschka } else { 4014a71df50SFrank Blaschka switch (cmd->hdr.command) { 4024a71df50SFrank Blaschka case IPA_CMD_STOPLAN: 40374eacdb9SFrank Blaschka dev_warn(&card->gdev->dev, 40474eacdb9SFrank Blaschka "The link for interface %s on CHPID" 40574eacdb9SFrank Blaschka " 0x%X failed\n", 4064a71df50SFrank Blaschka QETH_CARD_IFNAME(card), 4074a71df50SFrank Blaschka card->info.chpid); 4084a71df50SFrank Blaschka card->lan_online = 0; 4094a71df50SFrank Blaschka if (card->dev && netif_carrier_ok(card->dev)) 4104a71df50SFrank Blaschka netif_carrier_off(card->dev); 4114a71df50SFrank Blaschka return NULL; 4124a71df50SFrank Blaschka case IPA_CMD_STARTLAN: 41374eacdb9SFrank Blaschka dev_info(&card->gdev->dev, 41474eacdb9SFrank Blaschka "The link for %s on CHPID 0x%X has" 41574eacdb9SFrank Blaschka " been restored\n", 4164a71df50SFrank Blaschka QETH_CARD_IFNAME(card), 4174a71df50SFrank Blaschka card->info.chpid); 4184a71df50SFrank Blaschka netif_carrier_on(card->dev); 419922dc062SUrsula Braun card->lan_online = 1; 4204a71df50SFrank Blaschka qeth_schedule_recovery(card); 4214a71df50SFrank Blaschka return NULL; 4224a71df50SFrank Blaschka case IPA_CMD_MODCCID: 4234a71df50SFrank Blaschka return cmd; 4244a71df50SFrank Blaschka case IPA_CMD_REGISTER_LOCAL_ADDR: 425d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 3, "irla"); 4264a71df50SFrank Blaschka break; 4274a71df50SFrank Blaschka case IPA_CMD_UNREGISTER_LOCAL_ADDR: 428d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 3, "urla"); 4294a71df50SFrank Blaschka break; 4304a71df50SFrank Blaschka default: 431c4cef07cSFrank Blaschka QETH_DBF_MESSAGE(2, "Received data is IPA " 4324a71df50SFrank Blaschka "but not a reply!\n"); 4334a71df50SFrank Blaschka break; 4344a71df50SFrank Blaschka } 4354a71df50SFrank Blaschka } 4364a71df50SFrank Blaschka } 4374a71df50SFrank Blaschka return cmd; 4384a71df50SFrank Blaschka } 4394a71df50SFrank Blaschka 4404a71df50SFrank Blaschka void qeth_clear_ipacmd_list(struct qeth_card *card) 4414a71df50SFrank Blaschka { 4424a71df50SFrank Blaschka struct qeth_reply *reply, *r; 4434a71df50SFrank Blaschka unsigned long flags; 4444a71df50SFrank Blaschka 445d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 4, "clipalst"); 4464a71df50SFrank Blaschka 4474a71df50SFrank Blaschka spin_lock_irqsave(&card->lock, flags); 4484a71df50SFrank Blaschka list_for_each_entry_safe(reply, r, &card->cmd_waiter_list, list) { 4494a71df50SFrank Blaschka qeth_get_reply(reply); 4504a71df50SFrank Blaschka reply->rc = -EIO; 4514a71df50SFrank Blaschka atomic_inc(&reply->received); 4524a71df50SFrank Blaschka list_del_init(&reply->list); 4534a71df50SFrank Blaschka wake_up(&reply->wait_q); 4544a71df50SFrank Blaschka qeth_put_reply(reply); 4554a71df50SFrank Blaschka } 4564a71df50SFrank Blaschka spin_unlock_irqrestore(&card->lock, flags); 4574a71df50SFrank Blaschka } 4584a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_clear_ipacmd_list); 4594a71df50SFrank Blaschka 4604a71df50SFrank Blaschka static int qeth_check_idx_response(unsigned char *buffer) 4614a71df50SFrank Blaschka { 4624a71df50SFrank Blaschka if (!buffer) 4634a71df50SFrank Blaschka return 0; 4644a71df50SFrank Blaschka 465d11ba0c4SPeter Tiedemann QETH_DBF_HEX(CTRL, 2, buffer, QETH_DBF_CTRL_LEN); 4664a71df50SFrank Blaschka if ((buffer[2] & 0xc0) == 0xc0) { 46774eacdb9SFrank Blaschka QETH_DBF_MESSAGE(2, "received an IDX TERMINATE " 4684a71df50SFrank Blaschka "with cause code 0x%02x%s\n", 4694a71df50SFrank Blaschka buffer[4], 4704a71df50SFrank Blaschka ((buffer[4] == 0x22) ? 4714a71df50SFrank Blaschka " -- try another portname" : "")); 472d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 2, "ckidxres"); 473d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 2, " idxterm"); 474d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(TRACE, 2, " rc%d", -EIO); 4754a71df50SFrank Blaschka return -EIO; 4764a71df50SFrank Blaschka } 4774a71df50SFrank Blaschka return 0; 4784a71df50SFrank Blaschka } 4794a71df50SFrank Blaschka 4804a71df50SFrank Blaschka static void qeth_setup_ccw(struct qeth_channel *channel, unsigned char *iob, 4814a71df50SFrank Blaschka __u32 len) 4824a71df50SFrank Blaschka { 4834a71df50SFrank Blaschka struct qeth_card *card; 4844a71df50SFrank Blaschka 485d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 4, "setupccw"); 4864a71df50SFrank Blaschka card = CARD_FROM_CDEV(channel->ccwdev); 4874a71df50SFrank Blaschka if (channel == &card->read) 4884a71df50SFrank Blaschka memcpy(&channel->ccw, READ_CCW, sizeof(struct ccw1)); 4894a71df50SFrank Blaschka else 4904a71df50SFrank Blaschka memcpy(&channel->ccw, WRITE_CCW, sizeof(struct ccw1)); 4914a71df50SFrank Blaschka channel->ccw.count = len; 4924a71df50SFrank Blaschka channel->ccw.cda = (__u32) __pa(iob); 4934a71df50SFrank Blaschka } 4944a71df50SFrank Blaschka 4954a71df50SFrank Blaschka static struct qeth_cmd_buffer *__qeth_get_buffer(struct qeth_channel *channel) 4964a71df50SFrank Blaschka { 4974a71df50SFrank Blaschka __u8 index; 4984a71df50SFrank Blaschka 499d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 6, "getbuff"); 5004a71df50SFrank Blaschka index = channel->io_buf_no; 5014a71df50SFrank Blaschka do { 5024a71df50SFrank Blaschka if (channel->iob[index].state == BUF_STATE_FREE) { 5034a71df50SFrank Blaschka channel->iob[index].state = BUF_STATE_LOCKED; 5044a71df50SFrank Blaschka channel->io_buf_no = (channel->io_buf_no + 1) % 5054a71df50SFrank Blaschka QETH_CMD_BUFFER_NO; 5064a71df50SFrank Blaschka memset(channel->iob[index].data, 0, QETH_BUFSIZE); 5074a71df50SFrank Blaschka return channel->iob + index; 5084a71df50SFrank Blaschka } 5094a71df50SFrank Blaschka index = (index + 1) % QETH_CMD_BUFFER_NO; 5104a71df50SFrank Blaschka } while (index != channel->io_buf_no); 5114a71df50SFrank Blaschka 5124a71df50SFrank Blaschka return NULL; 5134a71df50SFrank Blaschka } 5144a71df50SFrank Blaschka 5154a71df50SFrank Blaschka void qeth_release_buffer(struct qeth_channel *channel, 5164a71df50SFrank Blaschka struct qeth_cmd_buffer *iob) 5174a71df50SFrank Blaschka { 5184a71df50SFrank Blaschka unsigned long flags; 5194a71df50SFrank Blaschka 520d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 6, "relbuff"); 5214a71df50SFrank Blaschka spin_lock_irqsave(&channel->iob_lock, flags); 5224a71df50SFrank Blaschka memset(iob->data, 0, QETH_BUFSIZE); 5234a71df50SFrank Blaschka iob->state = BUF_STATE_FREE; 5244a71df50SFrank Blaschka iob->callback = qeth_send_control_data_cb; 5254a71df50SFrank Blaschka iob->rc = 0; 5264a71df50SFrank Blaschka spin_unlock_irqrestore(&channel->iob_lock, flags); 5274a71df50SFrank Blaschka } 5284a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_release_buffer); 5294a71df50SFrank Blaschka 5304a71df50SFrank Blaschka static struct qeth_cmd_buffer *qeth_get_buffer(struct qeth_channel *channel) 5314a71df50SFrank Blaschka { 5324a71df50SFrank Blaschka struct qeth_cmd_buffer *buffer = NULL; 5334a71df50SFrank Blaschka unsigned long flags; 5344a71df50SFrank Blaschka 5354a71df50SFrank Blaschka spin_lock_irqsave(&channel->iob_lock, flags); 5364a71df50SFrank Blaschka buffer = __qeth_get_buffer(channel); 5374a71df50SFrank Blaschka spin_unlock_irqrestore(&channel->iob_lock, flags); 5384a71df50SFrank Blaschka return buffer; 5394a71df50SFrank Blaschka } 5404a71df50SFrank Blaschka 5414a71df50SFrank Blaschka struct qeth_cmd_buffer *qeth_wait_for_buffer(struct qeth_channel *channel) 5424a71df50SFrank Blaschka { 5434a71df50SFrank Blaschka struct qeth_cmd_buffer *buffer; 5444a71df50SFrank Blaschka wait_event(channel->wait_q, 5454a71df50SFrank Blaschka ((buffer = qeth_get_buffer(channel)) != NULL)); 5464a71df50SFrank Blaschka return buffer; 5474a71df50SFrank Blaschka } 5484a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_wait_for_buffer); 5494a71df50SFrank Blaschka 5504a71df50SFrank Blaschka void qeth_clear_cmd_buffers(struct qeth_channel *channel) 5514a71df50SFrank Blaschka { 5524a71df50SFrank Blaschka int cnt; 5534a71df50SFrank Blaschka 5544a71df50SFrank Blaschka for (cnt = 0; cnt < QETH_CMD_BUFFER_NO; cnt++) 5554a71df50SFrank Blaschka qeth_release_buffer(channel, &channel->iob[cnt]); 5564a71df50SFrank Blaschka channel->buf_no = 0; 5574a71df50SFrank Blaschka channel->io_buf_no = 0; 5584a71df50SFrank Blaschka } 5594a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_clear_cmd_buffers); 5604a71df50SFrank Blaschka 5614a71df50SFrank Blaschka static void qeth_send_control_data_cb(struct qeth_channel *channel, 5624a71df50SFrank Blaschka struct qeth_cmd_buffer *iob) 5634a71df50SFrank Blaschka { 5644a71df50SFrank Blaschka struct qeth_card *card; 5654a71df50SFrank Blaschka struct qeth_reply *reply, *r; 5664a71df50SFrank Blaschka struct qeth_ipa_cmd *cmd; 5674a71df50SFrank Blaschka unsigned long flags; 5684a71df50SFrank Blaschka int keep_reply; 5694a71df50SFrank Blaschka 570d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 4, "sndctlcb"); 5714a71df50SFrank Blaschka 5724a71df50SFrank Blaschka card = CARD_FROM_CDEV(channel->ccwdev); 5734a71df50SFrank Blaschka if (qeth_check_idx_response(iob->data)) { 5744a71df50SFrank Blaschka qeth_clear_ipacmd_list(card); 575fc9c2460SUrsula Braun if (((iob->data[2] & 0xc0) == 0xc0) && iob->data[4] == 0xf6) 576fc9c2460SUrsula Braun dev_err(&card->gdev->dev, 577fc9c2460SUrsula Braun "The qeth device is not configured " 578fc9c2460SUrsula Braun "for the OSI layer required by z/VM\n"); 5794a71df50SFrank Blaschka qeth_schedule_recovery(card); 5804a71df50SFrank Blaschka goto out; 5814a71df50SFrank Blaschka } 5824a71df50SFrank Blaschka 5834a71df50SFrank Blaschka cmd = qeth_check_ipa_data(card, iob); 5844a71df50SFrank Blaschka if ((cmd == NULL) && (card->state != CARD_STATE_DOWN)) 5854a71df50SFrank Blaschka goto out; 5864a71df50SFrank Blaschka /*in case of OSN : check if cmd is set */ 5874a71df50SFrank Blaschka if (card->info.type == QETH_CARD_TYPE_OSN && 5884a71df50SFrank Blaschka cmd && 5894a71df50SFrank Blaschka cmd->hdr.command != IPA_CMD_STARTLAN && 5904a71df50SFrank Blaschka card->osn_info.assist_cb != NULL) { 5914a71df50SFrank Blaschka card->osn_info.assist_cb(card->dev, cmd); 5924a71df50SFrank Blaschka goto out; 5934a71df50SFrank Blaschka } 5944a71df50SFrank Blaschka 5954a71df50SFrank Blaschka spin_lock_irqsave(&card->lock, flags); 5964a71df50SFrank Blaschka list_for_each_entry_safe(reply, r, &card->cmd_waiter_list, list) { 5974a71df50SFrank Blaschka if ((reply->seqno == QETH_IDX_COMMAND_SEQNO) || 5984a71df50SFrank Blaschka ((cmd) && (reply->seqno == cmd->hdr.seqno))) { 5994a71df50SFrank Blaschka qeth_get_reply(reply); 6004a71df50SFrank Blaschka list_del_init(&reply->list); 6014a71df50SFrank Blaschka spin_unlock_irqrestore(&card->lock, flags); 6024a71df50SFrank Blaschka keep_reply = 0; 6034a71df50SFrank Blaschka if (reply->callback != NULL) { 6044a71df50SFrank Blaschka if (cmd) { 6054a71df50SFrank Blaschka reply->offset = (__u16)((char *)cmd - 6064a71df50SFrank Blaschka (char *)iob->data); 6074a71df50SFrank Blaschka keep_reply = reply->callback(card, 6084a71df50SFrank Blaschka reply, 6094a71df50SFrank Blaschka (unsigned long)cmd); 6104a71df50SFrank Blaschka } else 6114a71df50SFrank Blaschka keep_reply = reply->callback(card, 6124a71df50SFrank Blaschka reply, 6134a71df50SFrank Blaschka (unsigned long)iob); 6144a71df50SFrank Blaschka } 6154a71df50SFrank Blaschka if (cmd) 6164a71df50SFrank Blaschka reply->rc = (u16) cmd->hdr.return_code; 6174a71df50SFrank Blaschka else if (iob->rc) 6184a71df50SFrank Blaschka reply->rc = iob->rc; 6194a71df50SFrank Blaschka if (keep_reply) { 6204a71df50SFrank Blaschka spin_lock_irqsave(&card->lock, flags); 6214a71df50SFrank Blaschka list_add_tail(&reply->list, 6224a71df50SFrank Blaschka &card->cmd_waiter_list); 6234a71df50SFrank Blaschka spin_unlock_irqrestore(&card->lock, flags); 6244a71df50SFrank Blaschka } else { 6254a71df50SFrank Blaschka atomic_inc(&reply->received); 6264a71df50SFrank Blaschka wake_up(&reply->wait_q); 6274a71df50SFrank Blaschka } 6284a71df50SFrank Blaschka qeth_put_reply(reply); 6294a71df50SFrank Blaschka goto out; 6304a71df50SFrank Blaschka } 6314a71df50SFrank Blaschka } 6324a71df50SFrank Blaschka spin_unlock_irqrestore(&card->lock, flags); 6334a71df50SFrank Blaschka out: 6344a71df50SFrank Blaschka memcpy(&card->seqno.pdu_hdr_ack, 6354a71df50SFrank Blaschka QETH_PDU_HEADER_SEQ_NO(iob->data), 6364a71df50SFrank Blaschka QETH_SEQ_NO_LENGTH); 6374a71df50SFrank Blaschka qeth_release_buffer(channel, iob); 6384a71df50SFrank Blaschka } 6394a71df50SFrank Blaschka 6404a71df50SFrank Blaschka static int qeth_setup_channel(struct qeth_channel *channel) 6414a71df50SFrank Blaschka { 6424a71df50SFrank Blaschka int cnt; 6434a71df50SFrank Blaschka 644d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "setupch"); 6454a71df50SFrank Blaschka for (cnt = 0; cnt < QETH_CMD_BUFFER_NO; cnt++) { 6464a71df50SFrank Blaschka channel->iob[cnt].data = (char *) 6474a71df50SFrank Blaschka kmalloc(QETH_BUFSIZE, GFP_DMA|GFP_KERNEL); 6484a71df50SFrank Blaschka if (channel->iob[cnt].data == NULL) 6494a71df50SFrank Blaschka break; 6504a71df50SFrank Blaschka channel->iob[cnt].state = BUF_STATE_FREE; 6514a71df50SFrank Blaschka channel->iob[cnt].channel = channel; 6524a71df50SFrank Blaschka channel->iob[cnt].callback = qeth_send_control_data_cb; 6534a71df50SFrank Blaschka channel->iob[cnt].rc = 0; 6544a71df50SFrank Blaschka } 6554a71df50SFrank Blaschka if (cnt < QETH_CMD_BUFFER_NO) { 6564a71df50SFrank Blaschka while (cnt-- > 0) 6574a71df50SFrank Blaschka kfree(channel->iob[cnt].data); 6584a71df50SFrank Blaschka return -ENOMEM; 6594a71df50SFrank Blaschka } 6604a71df50SFrank Blaschka channel->buf_no = 0; 6614a71df50SFrank Blaschka channel->io_buf_no = 0; 6624a71df50SFrank Blaschka atomic_set(&channel->irq_pending, 0); 6634a71df50SFrank Blaschka spin_lock_init(&channel->iob_lock); 6644a71df50SFrank Blaschka 6654a71df50SFrank Blaschka init_waitqueue_head(&channel->wait_q); 6664a71df50SFrank Blaschka return 0; 6674a71df50SFrank Blaschka } 6684a71df50SFrank Blaschka 6694a71df50SFrank Blaschka static int qeth_set_thread_start_bit(struct qeth_card *card, 6704a71df50SFrank Blaschka unsigned long thread) 6714a71df50SFrank Blaschka { 6724a71df50SFrank Blaschka unsigned long flags; 6734a71df50SFrank Blaschka 6744a71df50SFrank Blaschka spin_lock_irqsave(&card->thread_mask_lock, flags); 6754a71df50SFrank Blaschka if (!(card->thread_allowed_mask & thread) || 6764a71df50SFrank Blaschka (card->thread_start_mask & thread)) { 6774a71df50SFrank Blaschka spin_unlock_irqrestore(&card->thread_mask_lock, flags); 6784a71df50SFrank Blaschka return -EPERM; 6794a71df50SFrank Blaschka } 6804a71df50SFrank Blaschka card->thread_start_mask |= thread; 6814a71df50SFrank Blaschka spin_unlock_irqrestore(&card->thread_mask_lock, flags); 6824a71df50SFrank Blaschka return 0; 6834a71df50SFrank Blaschka } 6844a71df50SFrank Blaschka 6854a71df50SFrank Blaschka void qeth_clear_thread_start_bit(struct qeth_card *card, unsigned long thread) 6864a71df50SFrank Blaschka { 6874a71df50SFrank Blaschka unsigned long flags; 6884a71df50SFrank Blaschka 6894a71df50SFrank Blaschka spin_lock_irqsave(&card->thread_mask_lock, flags); 6904a71df50SFrank Blaschka card->thread_start_mask &= ~thread; 6914a71df50SFrank Blaschka spin_unlock_irqrestore(&card->thread_mask_lock, flags); 6924a71df50SFrank Blaschka wake_up(&card->wait_q); 6934a71df50SFrank Blaschka } 6944a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_clear_thread_start_bit); 6954a71df50SFrank Blaschka 6964a71df50SFrank Blaschka void qeth_clear_thread_running_bit(struct qeth_card *card, unsigned long thread) 6974a71df50SFrank Blaschka { 6984a71df50SFrank Blaschka unsigned long flags; 6994a71df50SFrank Blaschka 7004a71df50SFrank Blaschka spin_lock_irqsave(&card->thread_mask_lock, flags); 7014a71df50SFrank Blaschka card->thread_running_mask &= ~thread; 7024a71df50SFrank Blaschka spin_unlock_irqrestore(&card->thread_mask_lock, flags); 7034a71df50SFrank Blaschka wake_up(&card->wait_q); 7044a71df50SFrank Blaschka } 7054a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_clear_thread_running_bit); 7064a71df50SFrank Blaschka 7074a71df50SFrank Blaschka static int __qeth_do_run_thread(struct qeth_card *card, unsigned long thread) 7084a71df50SFrank Blaschka { 7094a71df50SFrank Blaschka unsigned long flags; 7104a71df50SFrank Blaschka int rc = 0; 7114a71df50SFrank Blaschka 7124a71df50SFrank Blaschka spin_lock_irqsave(&card->thread_mask_lock, flags); 7134a71df50SFrank Blaschka if (card->thread_start_mask & thread) { 7144a71df50SFrank Blaschka if ((card->thread_allowed_mask & thread) && 7154a71df50SFrank Blaschka !(card->thread_running_mask & thread)) { 7164a71df50SFrank Blaschka rc = 1; 7174a71df50SFrank Blaschka card->thread_start_mask &= ~thread; 7184a71df50SFrank Blaschka card->thread_running_mask |= thread; 7194a71df50SFrank Blaschka } else 7204a71df50SFrank Blaschka rc = -EPERM; 7214a71df50SFrank Blaschka } 7224a71df50SFrank Blaschka spin_unlock_irqrestore(&card->thread_mask_lock, flags); 7234a71df50SFrank Blaschka return rc; 7244a71df50SFrank Blaschka } 7254a71df50SFrank Blaschka 7264a71df50SFrank Blaschka int qeth_do_run_thread(struct qeth_card *card, unsigned long thread) 7274a71df50SFrank Blaschka { 7284a71df50SFrank Blaschka int rc = 0; 7294a71df50SFrank Blaschka 7304a71df50SFrank Blaschka wait_event(card->wait_q, 7314a71df50SFrank Blaschka (rc = __qeth_do_run_thread(card, thread)) >= 0); 7324a71df50SFrank Blaschka return rc; 7334a71df50SFrank Blaschka } 7344a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_do_run_thread); 7354a71df50SFrank Blaschka 7364a71df50SFrank Blaschka void qeth_schedule_recovery(struct qeth_card *card) 7374a71df50SFrank Blaschka { 738d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 2, "startrec"); 7394a71df50SFrank Blaschka if (qeth_set_thread_start_bit(card, QETH_RECOVER_THREAD) == 0) 7404a71df50SFrank Blaschka schedule_work(&card->kernel_thread_starter); 7414a71df50SFrank Blaschka } 7424a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_schedule_recovery); 7434a71df50SFrank Blaschka 7444a71df50SFrank Blaschka static int qeth_get_problem(struct ccw_device *cdev, struct irb *irb) 7454a71df50SFrank Blaschka { 7464a71df50SFrank Blaschka int dstat, cstat; 7474a71df50SFrank Blaschka char *sense; 7484a71df50SFrank Blaschka 7494a71df50SFrank Blaschka sense = (char *) irb->ecw; 75023d805b6SPeter Oberparleiter cstat = irb->scsw.cmd.cstat; 75123d805b6SPeter Oberparleiter dstat = irb->scsw.cmd.dstat; 7524a71df50SFrank Blaschka 7534a71df50SFrank Blaschka if (cstat & (SCHN_STAT_CHN_CTRL_CHK | SCHN_STAT_INTF_CTRL_CHK | 7544a71df50SFrank Blaschka SCHN_STAT_CHN_DATA_CHK | SCHN_STAT_CHAIN_CHECK | 7554a71df50SFrank Blaschka SCHN_STAT_PROT_CHECK | SCHN_STAT_PROG_CHECK)) { 756d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 2, "CGENCHK"); 75774eacdb9SFrank Blaschka dev_warn(&cdev->dev, "The qeth device driver " 75874eacdb9SFrank Blaschka "failed to recover an error on the device\n"); 75974eacdb9SFrank Blaschka QETH_DBF_MESSAGE(2, "%s check on device dstat=x%x, cstat=x%x ", 7602a0217d5SKay Sievers dev_name(&cdev->dev), dstat, cstat); 7614a71df50SFrank Blaschka print_hex_dump(KERN_WARNING, "qeth: irb ", DUMP_PREFIX_OFFSET, 7624a71df50SFrank Blaschka 16, 1, irb, 64, 1); 7634a71df50SFrank Blaschka return 1; 7644a71df50SFrank Blaschka } 7654a71df50SFrank Blaschka 7664a71df50SFrank Blaschka if (dstat & DEV_STAT_UNIT_CHECK) { 7674a71df50SFrank Blaschka if (sense[SENSE_RESETTING_EVENT_BYTE] & 7684a71df50SFrank Blaschka SENSE_RESETTING_EVENT_FLAG) { 769d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 2, "REVIND"); 7704a71df50SFrank Blaschka return 1; 7714a71df50SFrank Blaschka } 7724a71df50SFrank Blaschka if (sense[SENSE_COMMAND_REJECT_BYTE] & 7734a71df50SFrank Blaschka SENSE_COMMAND_REJECT_FLAG) { 774d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 2, "CMDREJi"); 77528a7e4c9SUrsula Braun return 1; 7764a71df50SFrank Blaschka } 7774a71df50SFrank Blaschka if ((sense[2] == 0xaf) && (sense[3] == 0xfe)) { 778d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 2, "AFFE"); 7794a71df50SFrank Blaschka return 1; 7804a71df50SFrank Blaschka } 7814a71df50SFrank Blaschka if ((!sense[0]) && (!sense[1]) && (!sense[2]) && (!sense[3])) { 782d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 2, "ZEROSEN"); 7834a71df50SFrank Blaschka return 0; 7844a71df50SFrank Blaschka } 785d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 2, "DGENCHK"); 7864a71df50SFrank Blaschka return 1; 7874a71df50SFrank Blaschka } 7884a71df50SFrank Blaschka return 0; 7894a71df50SFrank Blaschka } 7904a71df50SFrank Blaschka 7914a71df50SFrank Blaschka static long __qeth_check_irb_error(struct ccw_device *cdev, 7924a71df50SFrank Blaschka unsigned long intparm, struct irb *irb) 7934a71df50SFrank Blaschka { 7944a71df50SFrank Blaschka if (!IS_ERR(irb)) 7954a71df50SFrank Blaschka return 0; 7964a71df50SFrank Blaschka 7974a71df50SFrank Blaschka switch (PTR_ERR(irb)) { 7984a71df50SFrank Blaschka case -EIO: 79974eacdb9SFrank Blaschka QETH_DBF_MESSAGE(2, "%s i/o-error on device\n", 80074eacdb9SFrank Blaschka dev_name(&cdev->dev)); 801d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 2, "ckirberr"); 802d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(TRACE, 2, " rc%d", -EIO); 8034a71df50SFrank Blaschka break; 8044a71df50SFrank Blaschka case -ETIMEDOUT: 80574eacdb9SFrank Blaschka dev_warn(&cdev->dev, "A hardware operation timed out" 80674eacdb9SFrank Blaschka " on the device\n"); 807d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 2, "ckirberr"); 808d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(TRACE, 2, " rc%d", -ETIMEDOUT); 8094a71df50SFrank Blaschka if (intparm == QETH_RCD_PARM) { 8104a71df50SFrank Blaschka struct qeth_card *card = CARD_FROM_CDEV(cdev); 8114a71df50SFrank Blaschka 8124a71df50SFrank Blaschka if (card && (card->data.ccwdev == cdev)) { 8134a71df50SFrank Blaschka card->data.state = CH_STATE_DOWN; 8144a71df50SFrank Blaschka wake_up(&card->wait_q); 8154a71df50SFrank Blaschka } 8164a71df50SFrank Blaschka } 8174a71df50SFrank Blaschka break; 8184a71df50SFrank Blaschka default: 81974eacdb9SFrank Blaschka QETH_DBF_MESSAGE(2, "%s unknown error %ld on device\n", 82074eacdb9SFrank Blaschka dev_name(&cdev->dev), PTR_ERR(irb)); 821d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 2, "ckirberr"); 822d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 2, " rc???"); 8234a71df50SFrank Blaschka } 8244a71df50SFrank Blaschka return PTR_ERR(irb); 8254a71df50SFrank Blaschka } 8264a71df50SFrank Blaschka 8274a71df50SFrank Blaschka static void qeth_irq(struct ccw_device *cdev, unsigned long intparm, 8284a71df50SFrank Blaschka struct irb *irb) 8294a71df50SFrank Blaschka { 8304a71df50SFrank Blaschka int rc; 8314a71df50SFrank Blaschka int cstat, dstat; 8324a71df50SFrank Blaschka struct qeth_cmd_buffer *buffer; 8334a71df50SFrank Blaschka struct qeth_channel *channel; 8344a71df50SFrank Blaschka struct qeth_card *card; 8354a71df50SFrank Blaschka struct qeth_cmd_buffer *iob; 8364a71df50SFrank Blaschka __u8 index; 8374a71df50SFrank Blaschka 838d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 5, "irq"); 8394a71df50SFrank Blaschka 8404a71df50SFrank Blaschka if (__qeth_check_irb_error(cdev, intparm, irb)) 8414a71df50SFrank Blaschka return; 84223d805b6SPeter Oberparleiter cstat = irb->scsw.cmd.cstat; 84323d805b6SPeter Oberparleiter dstat = irb->scsw.cmd.dstat; 8444a71df50SFrank Blaschka 8454a71df50SFrank Blaschka card = CARD_FROM_CDEV(cdev); 8464a71df50SFrank Blaschka if (!card) 8474a71df50SFrank Blaschka return; 8484a71df50SFrank Blaschka 8494a71df50SFrank Blaschka if (card->read.ccwdev == cdev) { 8504a71df50SFrank Blaschka channel = &card->read; 851d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 5, "read"); 8524a71df50SFrank Blaschka } else if (card->write.ccwdev == cdev) { 8534a71df50SFrank Blaschka channel = &card->write; 854d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 5, "write"); 8554a71df50SFrank Blaschka } else { 8564a71df50SFrank Blaschka channel = &card->data; 857d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 5, "data"); 8584a71df50SFrank Blaschka } 8594a71df50SFrank Blaschka atomic_set(&channel->irq_pending, 0); 8604a71df50SFrank Blaschka 86123d805b6SPeter Oberparleiter if (irb->scsw.cmd.fctl & (SCSW_FCTL_CLEAR_FUNC)) 8624a71df50SFrank Blaschka channel->state = CH_STATE_STOPPED; 8634a71df50SFrank Blaschka 86423d805b6SPeter Oberparleiter if (irb->scsw.cmd.fctl & (SCSW_FCTL_HALT_FUNC)) 8654a71df50SFrank Blaschka channel->state = CH_STATE_HALTED; 8664a71df50SFrank Blaschka 8674a71df50SFrank Blaschka /*let's wake up immediately on data channel*/ 8684a71df50SFrank Blaschka if ((channel == &card->data) && (intparm != 0) && 8694a71df50SFrank Blaschka (intparm != QETH_RCD_PARM)) 8704a71df50SFrank Blaschka goto out; 8714a71df50SFrank Blaschka 8724a71df50SFrank Blaschka if (intparm == QETH_CLEAR_CHANNEL_PARM) { 873d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 6, "clrchpar"); 8744a71df50SFrank Blaschka /* we don't have to handle this further */ 8754a71df50SFrank Blaschka intparm = 0; 8764a71df50SFrank Blaschka } 8774a71df50SFrank Blaschka if (intparm == QETH_HALT_CHANNEL_PARM) { 878d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 6, "hltchpar"); 8794a71df50SFrank Blaschka /* we don't have to handle this further */ 8804a71df50SFrank Blaschka intparm = 0; 8814a71df50SFrank Blaschka } 8824a71df50SFrank Blaschka if ((dstat & DEV_STAT_UNIT_EXCEP) || 8834a71df50SFrank Blaschka (dstat & DEV_STAT_UNIT_CHECK) || 8844a71df50SFrank Blaschka (cstat)) { 8854a71df50SFrank Blaschka if (irb->esw.esw0.erw.cons) { 88674eacdb9SFrank Blaschka dev_warn(&channel->ccwdev->dev, 88774eacdb9SFrank Blaschka "The qeth device driver failed to recover " 88874eacdb9SFrank Blaschka "an error on the device\n"); 88974eacdb9SFrank Blaschka QETH_DBF_MESSAGE(2, "%s sense data available. cstat " 89074eacdb9SFrank Blaschka "0x%X dstat 0x%X\n", 89174eacdb9SFrank Blaschka dev_name(&channel->ccwdev->dev), cstat, dstat); 8924a71df50SFrank Blaschka print_hex_dump(KERN_WARNING, "qeth: irb ", 8934a71df50SFrank Blaschka DUMP_PREFIX_OFFSET, 16, 1, irb, 32, 1); 8944a71df50SFrank Blaschka print_hex_dump(KERN_WARNING, "qeth: sense data ", 8954a71df50SFrank Blaschka DUMP_PREFIX_OFFSET, 16, 1, irb->ecw, 32, 1); 8964a71df50SFrank Blaschka } 8974a71df50SFrank Blaschka if (intparm == QETH_RCD_PARM) { 8984a71df50SFrank Blaschka channel->state = CH_STATE_DOWN; 8994a71df50SFrank Blaschka goto out; 9004a71df50SFrank Blaschka } 9014a71df50SFrank Blaschka rc = qeth_get_problem(cdev, irb); 9024a71df50SFrank Blaschka if (rc) { 90328a7e4c9SUrsula Braun qeth_clear_ipacmd_list(card); 9044a71df50SFrank Blaschka qeth_schedule_recovery(card); 9054a71df50SFrank Blaschka goto out; 9064a71df50SFrank Blaschka } 9074a71df50SFrank Blaschka } 9084a71df50SFrank Blaschka 9094a71df50SFrank Blaschka if (intparm == QETH_RCD_PARM) { 9104a71df50SFrank Blaschka channel->state = CH_STATE_RCD_DONE; 9114a71df50SFrank Blaschka goto out; 9124a71df50SFrank Blaschka } 9134a71df50SFrank Blaschka if (intparm) { 9144a71df50SFrank Blaschka buffer = (struct qeth_cmd_buffer *) __va((addr_t)intparm); 9154a71df50SFrank Blaschka buffer->state = BUF_STATE_PROCESSED; 9164a71df50SFrank Blaschka } 9174a71df50SFrank Blaschka if (channel == &card->data) 9184a71df50SFrank Blaschka return; 9194a71df50SFrank Blaschka if (channel == &card->read && 9204a71df50SFrank Blaschka channel->state == CH_STATE_UP) 9214a71df50SFrank Blaschka qeth_issue_next_read(card); 9224a71df50SFrank Blaschka 9234a71df50SFrank Blaschka iob = channel->iob; 9244a71df50SFrank Blaschka index = channel->buf_no; 9254a71df50SFrank Blaschka while (iob[index].state == BUF_STATE_PROCESSED) { 9264a71df50SFrank Blaschka if (iob[index].callback != NULL) 9274a71df50SFrank Blaschka iob[index].callback(channel, iob + index); 9284a71df50SFrank Blaschka 9294a71df50SFrank Blaschka index = (index + 1) % QETH_CMD_BUFFER_NO; 9304a71df50SFrank Blaschka } 9314a71df50SFrank Blaschka channel->buf_no = index; 9324a71df50SFrank Blaschka out: 9334a71df50SFrank Blaschka wake_up(&card->wait_q); 9344a71df50SFrank Blaschka return; 9354a71df50SFrank Blaschka } 9364a71df50SFrank Blaschka 9374a71df50SFrank Blaschka static void qeth_clear_output_buffer(struct qeth_qdio_out_q *queue, 9384a71df50SFrank Blaschka struct qeth_qdio_out_buffer *buf) 9394a71df50SFrank Blaschka { 9404a71df50SFrank Blaschka int i; 9414a71df50SFrank Blaschka struct sk_buff *skb; 9424a71df50SFrank Blaschka 9434a71df50SFrank Blaschka /* is PCI flag set on buffer? */ 9444a71df50SFrank Blaschka if (buf->buffer->element[0].flags & 0x40) 9454a71df50SFrank Blaschka atomic_dec(&queue->set_pci_flags_count); 9464a71df50SFrank Blaschka 9474a71df50SFrank Blaschka skb = skb_dequeue(&buf->skb_list); 9484a71df50SFrank Blaschka while (skb) { 9494a71df50SFrank Blaschka atomic_dec(&skb->users); 9504a71df50SFrank Blaschka dev_kfree_skb_any(skb); 9514a71df50SFrank Blaschka skb = skb_dequeue(&buf->skb_list); 9524a71df50SFrank Blaschka } 9534a71df50SFrank Blaschka qeth_eddp_buf_release_contexts(buf); 9544a71df50SFrank Blaschka for (i = 0; i < QETH_MAX_BUFFER_ELEMENTS(queue->card); ++i) { 955683d718aSFrank Blaschka if (buf->buffer->element[i].addr && buf->is_header[i]) 956683d718aSFrank Blaschka kmem_cache_free(qeth_core_header_cache, 957683d718aSFrank Blaschka buf->buffer->element[i].addr); 958683d718aSFrank Blaschka buf->is_header[i] = 0; 9594a71df50SFrank Blaschka buf->buffer->element[i].length = 0; 9604a71df50SFrank Blaschka buf->buffer->element[i].addr = NULL; 9614a71df50SFrank Blaschka buf->buffer->element[i].flags = 0; 9624a71df50SFrank Blaschka } 9634a71df50SFrank Blaschka buf->next_element_to_fill = 0; 9644a71df50SFrank Blaschka atomic_set(&buf->state, QETH_QDIO_BUF_EMPTY); 9654a71df50SFrank Blaschka } 9664a71df50SFrank Blaschka 9674a71df50SFrank Blaschka void qeth_clear_qdio_buffers(struct qeth_card *card) 9684a71df50SFrank Blaschka { 9694a71df50SFrank Blaschka int i, j; 9704a71df50SFrank Blaschka 971d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 2, "clearqdbf"); 9724a71df50SFrank Blaschka /* clear outbound buffers to free skbs */ 9734a71df50SFrank Blaschka for (i = 0; i < card->qdio.no_out_queues; ++i) 9744a71df50SFrank Blaschka if (card->qdio.out_qs[i]) { 9754a71df50SFrank Blaschka for (j = 0; j < QDIO_MAX_BUFFERS_PER_Q; ++j) 9764a71df50SFrank Blaschka qeth_clear_output_buffer(card->qdio.out_qs[i], 9774a71df50SFrank Blaschka &card->qdio.out_qs[i]->bufs[j]); 9784a71df50SFrank Blaschka } 9794a71df50SFrank Blaschka } 9804a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_clear_qdio_buffers); 9814a71df50SFrank Blaschka 9824a71df50SFrank Blaschka static void qeth_free_buffer_pool(struct qeth_card *card) 9834a71df50SFrank Blaschka { 9844a71df50SFrank Blaschka struct qeth_buffer_pool_entry *pool_entry, *tmp; 9854a71df50SFrank Blaschka int i = 0; 986d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 5, "freepool"); 9874a71df50SFrank Blaschka list_for_each_entry_safe(pool_entry, tmp, 9884a71df50SFrank Blaschka &card->qdio.init_pool.entry_list, init_list){ 9894a71df50SFrank Blaschka for (i = 0; i < QETH_MAX_BUFFER_ELEMENTS(card); ++i) 9904a71df50SFrank Blaschka free_page((unsigned long)pool_entry->elements[i]); 9914a71df50SFrank Blaschka list_del(&pool_entry->init_list); 9924a71df50SFrank Blaschka kfree(pool_entry); 9934a71df50SFrank Blaschka } 9944a71df50SFrank Blaschka } 9954a71df50SFrank Blaschka 9964a71df50SFrank Blaschka static void qeth_free_qdio_buffers(struct qeth_card *card) 9974a71df50SFrank Blaschka { 9984a71df50SFrank Blaschka int i, j; 9994a71df50SFrank Blaschka 1000d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 2, "freeqdbf"); 10014a71df50SFrank Blaschka if (atomic_xchg(&card->qdio.state, QETH_QDIO_UNINITIALIZED) == 10024a71df50SFrank Blaschka QETH_QDIO_UNINITIALIZED) 10034a71df50SFrank Blaschka return; 10044a71df50SFrank Blaschka kfree(card->qdio.in_q); 10054a71df50SFrank Blaschka card->qdio.in_q = NULL; 10064a71df50SFrank Blaschka /* inbound buffer pool */ 10074a71df50SFrank Blaschka qeth_free_buffer_pool(card); 10084a71df50SFrank Blaschka /* free outbound qdio_qs */ 10094a71df50SFrank Blaschka if (card->qdio.out_qs) { 10104a71df50SFrank Blaschka for (i = 0; i < card->qdio.no_out_queues; ++i) { 10114a71df50SFrank Blaschka for (j = 0; j < QDIO_MAX_BUFFERS_PER_Q; ++j) 10124a71df50SFrank Blaschka qeth_clear_output_buffer(card->qdio.out_qs[i], 10134a71df50SFrank Blaschka &card->qdio.out_qs[i]->bufs[j]); 10144a71df50SFrank Blaschka kfree(card->qdio.out_qs[i]); 10154a71df50SFrank Blaschka } 10164a71df50SFrank Blaschka kfree(card->qdio.out_qs); 10174a71df50SFrank Blaschka card->qdio.out_qs = NULL; 10184a71df50SFrank Blaschka } 10194a71df50SFrank Blaschka } 10204a71df50SFrank Blaschka 10214a71df50SFrank Blaschka static void qeth_clean_channel(struct qeth_channel *channel) 10224a71df50SFrank Blaschka { 10234a71df50SFrank Blaschka int cnt; 10244a71df50SFrank Blaschka 1025d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "freech"); 10264a71df50SFrank Blaschka for (cnt = 0; cnt < QETH_CMD_BUFFER_NO; cnt++) 10274a71df50SFrank Blaschka kfree(channel->iob[cnt].data); 10284a71df50SFrank Blaschka } 10294a71df50SFrank Blaschka 10304a71df50SFrank Blaschka static int qeth_is_1920_device(struct qeth_card *card) 10314a71df50SFrank Blaschka { 10324a71df50SFrank Blaschka int single_queue = 0; 10334a71df50SFrank Blaschka struct ccw_device *ccwdev; 10344a71df50SFrank Blaschka struct channelPath_dsc { 10354a71df50SFrank Blaschka u8 flags; 10364a71df50SFrank Blaschka u8 lsn; 10374a71df50SFrank Blaschka u8 desc; 10384a71df50SFrank Blaschka u8 chpid; 10394a71df50SFrank Blaschka u8 swla; 10404a71df50SFrank Blaschka u8 zeroes; 10414a71df50SFrank Blaschka u8 chla; 10424a71df50SFrank Blaschka u8 chpp; 10434a71df50SFrank Blaschka } *chp_dsc; 10444a71df50SFrank Blaschka 1045d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "chk_1920"); 10464a71df50SFrank Blaschka 10474a71df50SFrank Blaschka ccwdev = card->data.ccwdev; 10484a71df50SFrank Blaschka chp_dsc = (struct channelPath_dsc *)ccw_device_get_chp_desc(ccwdev, 0); 10494a71df50SFrank Blaschka if (chp_dsc != NULL) { 10504a71df50SFrank Blaschka /* CHPP field bit 6 == 1 -> single queue */ 10514a71df50SFrank Blaschka single_queue = ((chp_dsc->chpp & 0x02) == 0x02); 10524a71df50SFrank Blaschka kfree(chp_dsc); 10534a71df50SFrank Blaschka } 1054d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "rc:%x", single_queue); 10554a71df50SFrank Blaschka return single_queue; 10564a71df50SFrank Blaschka } 10574a71df50SFrank Blaschka 10584a71df50SFrank Blaschka static void qeth_init_qdio_info(struct qeth_card *card) 10594a71df50SFrank Blaschka { 1060d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 4, "intqdinf"); 10614a71df50SFrank Blaschka atomic_set(&card->qdio.state, QETH_QDIO_UNINITIALIZED); 10624a71df50SFrank Blaschka /* inbound */ 10634a71df50SFrank Blaschka card->qdio.in_buf_size = QETH_IN_BUF_SIZE_DEFAULT; 10644a71df50SFrank Blaschka card->qdio.init_pool.buf_count = QETH_IN_BUF_COUNT_DEFAULT; 10654a71df50SFrank Blaschka card->qdio.in_buf_pool.buf_count = card->qdio.init_pool.buf_count; 10664a71df50SFrank Blaschka INIT_LIST_HEAD(&card->qdio.in_buf_pool.entry_list); 10674a71df50SFrank Blaschka INIT_LIST_HEAD(&card->qdio.init_pool.entry_list); 10684a71df50SFrank Blaschka } 10694a71df50SFrank Blaschka 10704a71df50SFrank Blaschka static void qeth_set_intial_options(struct qeth_card *card) 10714a71df50SFrank Blaschka { 10724a71df50SFrank Blaschka card->options.route4.type = NO_ROUTER; 10734a71df50SFrank Blaschka card->options.route6.type = NO_ROUTER; 10744a71df50SFrank Blaschka card->options.checksum_type = QETH_CHECKSUM_DEFAULT; 10754a71df50SFrank Blaschka card->options.broadcast_mode = QETH_TR_BROADCAST_ALLRINGS; 10764a71df50SFrank Blaschka card->options.macaddr_mode = QETH_TR_MACADDR_NONCANONICAL; 10774a71df50SFrank Blaschka card->options.fake_broadcast = 0; 10784a71df50SFrank Blaschka card->options.add_hhlen = DEFAULT_ADD_HHLEN; 10794a71df50SFrank Blaschka card->options.performance_stats = 0; 10804a71df50SFrank Blaschka card->options.rx_sg_cb = QETH_RX_SG_CB; 10814a71df50SFrank Blaschka } 10824a71df50SFrank Blaschka 10834a71df50SFrank Blaschka static int qeth_do_start_thread(struct qeth_card *card, unsigned long thread) 10844a71df50SFrank Blaschka { 10854a71df50SFrank Blaschka unsigned long flags; 10864a71df50SFrank Blaschka int rc = 0; 10874a71df50SFrank Blaschka 10884a71df50SFrank Blaschka spin_lock_irqsave(&card->thread_mask_lock, flags); 1089d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(TRACE, 4, " %02x%02x%02x", 10904a71df50SFrank Blaschka (u8) card->thread_start_mask, 10914a71df50SFrank Blaschka (u8) card->thread_allowed_mask, 10924a71df50SFrank Blaschka (u8) card->thread_running_mask); 10934a71df50SFrank Blaschka rc = (card->thread_start_mask & thread); 10944a71df50SFrank Blaschka spin_unlock_irqrestore(&card->thread_mask_lock, flags); 10954a71df50SFrank Blaschka return rc; 10964a71df50SFrank Blaschka } 10974a71df50SFrank Blaschka 10984a71df50SFrank Blaschka static void qeth_start_kernel_thread(struct work_struct *work) 10994a71df50SFrank Blaschka { 11004a71df50SFrank Blaschka struct qeth_card *card = container_of(work, struct qeth_card, 11014a71df50SFrank Blaschka kernel_thread_starter); 1102d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE , 2, "strthrd"); 11034a71df50SFrank Blaschka 11044a71df50SFrank Blaschka if (card->read.state != CH_STATE_UP && 11054a71df50SFrank Blaschka card->write.state != CH_STATE_UP) 11064a71df50SFrank Blaschka return; 11074a71df50SFrank Blaschka if (qeth_do_start_thread(card, QETH_RECOVER_THREAD)) 11084a71df50SFrank Blaschka kthread_run(card->discipline.recover, (void *) card, 11094a71df50SFrank Blaschka "qeth_recover"); 11104a71df50SFrank Blaschka } 11114a71df50SFrank Blaschka 11124a71df50SFrank Blaschka static int qeth_setup_card(struct qeth_card *card) 11134a71df50SFrank Blaschka { 11144a71df50SFrank Blaschka 1115d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "setupcrd"); 1116d11ba0c4SPeter Tiedemann QETH_DBF_HEX(SETUP, 2, &card, sizeof(void *)); 11174a71df50SFrank Blaschka 11184a71df50SFrank Blaschka card->read.state = CH_STATE_DOWN; 11194a71df50SFrank Blaschka card->write.state = CH_STATE_DOWN; 11204a71df50SFrank Blaschka card->data.state = CH_STATE_DOWN; 11214a71df50SFrank Blaschka card->state = CARD_STATE_DOWN; 11224a71df50SFrank Blaschka card->lan_online = 0; 11234a71df50SFrank Blaschka card->use_hard_stop = 0; 11244a71df50SFrank Blaschka card->dev = NULL; 11254a71df50SFrank Blaschka spin_lock_init(&card->vlanlock); 11264a71df50SFrank Blaschka spin_lock_init(&card->mclock); 11274a71df50SFrank Blaschka card->vlangrp = NULL; 11284a71df50SFrank Blaschka spin_lock_init(&card->lock); 11294a71df50SFrank Blaschka spin_lock_init(&card->ip_lock); 11304a71df50SFrank Blaschka spin_lock_init(&card->thread_mask_lock); 11314a71df50SFrank Blaschka card->thread_start_mask = 0; 11324a71df50SFrank Blaschka card->thread_allowed_mask = 0; 11334a71df50SFrank Blaschka card->thread_running_mask = 0; 11344a71df50SFrank Blaschka INIT_WORK(&card->kernel_thread_starter, qeth_start_kernel_thread); 11354a71df50SFrank Blaschka INIT_LIST_HEAD(&card->ip_list); 11364a71df50SFrank Blaschka card->ip_tbd_list = kmalloc(sizeof(struct list_head), GFP_KERNEL); 11374a71df50SFrank Blaschka if (!card->ip_tbd_list) { 1138d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 0, "iptbdnom"); 11394a71df50SFrank Blaschka return -ENOMEM; 11404a71df50SFrank Blaschka } 11414a71df50SFrank Blaschka INIT_LIST_HEAD(card->ip_tbd_list); 11424a71df50SFrank Blaschka INIT_LIST_HEAD(&card->cmd_waiter_list); 11434a71df50SFrank Blaschka init_waitqueue_head(&card->wait_q); 11444a71df50SFrank Blaschka /* intial options */ 11454a71df50SFrank Blaschka qeth_set_intial_options(card); 11464a71df50SFrank Blaschka /* IP address takeover */ 11474a71df50SFrank Blaschka INIT_LIST_HEAD(&card->ipato.entries); 11484a71df50SFrank Blaschka card->ipato.enabled = 0; 11494a71df50SFrank Blaschka card->ipato.invert4 = 0; 11504a71df50SFrank Blaschka card->ipato.invert6 = 0; 11514a71df50SFrank Blaschka /* init QDIO stuff */ 11524a71df50SFrank Blaschka qeth_init_qdio_info(card); 11534a71df50SFrank Blaschka return 0; 11544a71df50SFrank Blaschka } 11554a71df50SFrank Blaschka 11566bcac508SMartin Schwidefsky static void qeth_core_sl_print(struct seq_file *m, struct service_level *slr) 11576bcac508SMartin Schwidefsky { 11586bcac508SMartin Schwidefsky struct qeth_card *card = container_of(slr, struct qeth_card, 11596bcac508SMartin Schwidefsky qeth_service_level); 11606bcac508SMartin Schwidefsky seq_printf(m, "qeth: %s firmware level %s\n", CARD_BUS_ID(card), 11616bcac508SMartin Schwidefsky card->info.mcl_level); 11626bcac508SMartin Schwidefsky } 11636bcac508SMartin Schwidefsky 11644a71df50SFrank Blaschka static struct qeth_card *qeth_alloc_card(void) 11654a71df50SFrank Blaschka { 11664a71df50SFrank Blaschka struct qeth_card *card; 11674a71df50SFrank Blaschka 1168d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "alloccrd"); 11694a71df50SFrank Blaschka card = kzalloc(sizeof(struct qeth_card), GFP_DMA|GFP_KERNEL); 11704a71df50SFrank Blaschka if (!card) 11714a71df50SFrank Blaschka return NULL; 1172d11ba0c4SPeter Tiedemann QETH_DBF_HEX(SETUP, 2, &card, sizeof(void *)); 11734a71df50SFrank Blaschka if (qeth_setup_channel(&card->read)) { 11744a71df50SFrank Blaschka kfree(card); 11754a71df50SFrank Blaschka return NULL; 11764a71df50SFrank Blaschka } 11774a71df50SFrank Blaschka if (qeth_setup_channel(&card->write)) { 11784a71df50SFrank Blaschka qeth_clean_channel(&card->read); 11794a71df50SFrank Blaschka kfree(card); 11804a71df50SFrank Blaschka return NULL; 11814a71df50SFrank Blaschka } 11824a71df50SFrank Blaschka card->options.layer2 = -1; 11836bcac508SMartin Schwidefsky card->qeth_service_level.seq_print = qeth_core_sl_print; 11846bcac508SMartin Schwidefsky register_service_level(&card->qeth_service_level); 11854a71df50SFrank Blaschka return card; 11864a71df50SFrank Blaschka } 11874a71df50SFrank Blaschka 11884a71df50SFrank Blaschka static int qeth_determine_card_type(struct qeth_card *card) 11894a71df50SFrank Blaschka { 11904a71df50SFrank Blaschka int i = 0; 11914a71df50SFrank Blaschka 1192d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "detcdtyp"); 11934a71df50SFrank Blaschka 11944a71df50SFrank Blaschka card->qdio.do_prio_queueing = QETH_PRIOQ_DEFAULT; 11954a71df50SFrank Blaschka card->qdio.default_out_queue = QETH_DEFAULT_QUEUE; 11964a71df50SFrank Blaschka while (known_devices[i][4]) { 11974a71df50SFrank Blaschka if ((CARD_RDEV(card)->id.dev_type == known_devices[i][2]) && 11984a71df50SFrank Blaschka (CARD_RDEV(card)->id.dev_model == known_devices[i][3])) { 11994a71df50SFrank Blaschka card->info.type = known_devices[i][4]; 12004a71df50SFrank Blaschka card->qdio.no_out_queues = known_devices[i][8]; 12014a71df50SFrank Blaschka card->info.is_multicast_different = known_devices[i][9]; 12024a71df50SFrank Blaschka if (qeth_is_1920_device(card)) { 120374eacdb9SFrank Blaschka dev_info(&card->gdev->dev, 120474eacdb9SFrank Blaschka "Priority Queueing not supported\n"); 12054a71df50SFrank Blaschka card->qdio.no_out_queues = 1; 12064a71df50SFrank Blaschka card->qdio.default_out_queue = 0; 12074a71df50SFrank Blaschka } 12084a71df50SFrank Blaschka return 0; 12094a71df50SFrank Blaschka } 12104a71df50SFrank Blaschka i++; 12114a71df50SFrank Blaschka } 12124a71df50SFrank Blaschka card->info.type = QETH_CARD_TYPE_UNKNOWN; 121374eacdb9SFrank Blaschka dev_err(&card->gdev->dev, "The adapter hardware is of an " 121474eacdb9SFrank Blaschka "unknown type\n"); 12154a71df50SFrank Blaschka return -ENOENT; 12164a71df50SFrank Blaschka } 12174a71df50SFrank Blaschka 12184a71df50SFrank Blaschka static int qeth_clear_channel(struct qeth_channel *channel) 12194a71df50SFrank Blaschka { 12204a71df50SFrank Blaschka unsigned long flags; 12214a71df50SFrank Blaschka struct qeth_card *card; 12224a71df50SFrank Blaschka int rc; 12234a71df50SFrank Blaschka 1224d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 3, "clearch"); 12254a71df50SFrank Blaschka card = CARD_FROM_CDEV(channel->ccwdev); 12264a71df50SFrank Blaschka spin_lock_irqsave(get_ccwdev_lock(channel->ccwdev), flags); 12274a71df50SFrank Blaschka rc = ccw_device_clear(channel->ccwdev, QETH_CLEAR_CHANNEL_PARM); 12284a71df50SFrank Blaschka spin_unlock_irqrestore(get_ccwdev_lock(channel->ccwdev), flags); 12294a71df50SFrank Blaschka 12304a71df50SFrank Blaschka if (rc) 12314a71df50SFrank Blaschka return rc; 12324a71df50SFrank Blaschka rc = wait_event_interruptible_timeout(card->wait_q, 12334a71df50SFrank Blaschka channel->state == CH_STATE_STOPPED, QETH_TIMEOUT); 12344a71df50SFrank Blaschka if (rc == -ERESTARTSYS) 12354a71df50SFrank Blaschka return rc; 12364a71df50SFrank Blaschka if (channel->state != CH_STATE_STOPPED) 12374a71df50SFrank Blaschka return -ETIME; 12384a71df50SFrank Blaschka channel->state = CH_STATE_DOWN; 12394a71df50SFrank Blaschka return 0; 12404a71df50SFrank Blaschka } 12414a71df50SFrank Blaschka 12424a71df50SFrank Blaschka static int qeth_halt_channel(struct qeth_channel *channel) 12434a71df50SFrank Blaschka { 12444a71df50SFrank Blaschka unsigned long flags; 12454a71df50SFrank Blaschka struct qeth_card *card; 12464a71df50SFrank Blaschka int rc; 12474a71df50SFrank Blaschka 1248d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 3, "haltch"); 12494a71df50SFrank Blaschka card = CARD_FROM_CDEV(channel->ccwdev); 12504a71df50SFrank Blaschka spin_lock_irqsave(get_ccwdev_lock(channel->ccwdev), flags); 12514a71df50SFrank Blaschka rc = ccw_device_halt(channel->ccwdev, QETH_HALT_CHANNEL_PARM); 12524a71df50SFrank Blaschka spin_unlock_irqrestore(get_ccwdev_lock(channel->ccwdev), flags); 12534a71df50SFrank Blaschka 12544a71df50SFrank Blaschka if (rc) 12554a71df50SFrank Blaschka return rc; 12564a71df50SFrank Blaschka rc = wait_event_interruptible_timeout(card->wait_q, 12574a71df50SFrank Blaschka channel->state == CH_STATE_HALTED, QETH_TIMEOUT); 12584a71df50SFrank Blaschka if (rc == -ERESTARTSYS) 12594a71df50SFrank Blaschka return rc; 12604a71df50SFrank Blaschka if (channel->state != CH_STATE_HALTED) 12614a71df50SFrank Blaschka return -ETIME; 12624a71df50SFrank Blaschka return 0; 12634a71df50SFrank Blaschka } 12644a71df50SFrank Blaschka 12654a71df50SFrank Blaschka static int qeth_halt_channels(struct qeth_card *card) 12664a71df50SFrank Blaschka { 12674a71df50SFrank Blaschka int rc1 = 0, rc2 = 0, rc3 = 0; 12684a71df50SFrank Blaschka 1269d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 3, "haltchs"); 12704a71df50SFrank Blaschka rc1 = qeth_halt_channel(&card->read); 12714a71df50SFrank Blaschka rc2 = qeth_halt_channel(&card->write); 12724a71df50SFrank Blaschka rc3 = qeth_halt_channel(&card->data); 12734a71df50SFrank Blaschka if (rc1) 12744a71df50SFrank Blaschka return rc1; 12754a71df50SFrank Blaschka if (rc2) 12764a71df50SFrank Blaschka return rc2; 12774a71df50SFrank Blaschka return rc3; 12784a71df50SFrank Blaschka } 12794a71df50SFrank Blaschka 12804a71df50SFrank Blaschka static int qeth_clear_channels(struct qeth_card *card) 12814a71df50SFrank Blaschka { 12824a71df50SFrank Blaschka int rc1 = 0, rc2 = 0, rc3 = 0; 12834a71df50SFrank Blaschka 1284d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 3, "clearchs"); 12854a71df50SFrank Blaschka rc1 = qeth_clear_channel(&card->read); 12864a71df50SFrank Blaschka rc2 = qeth_clear_channel(&card->write); 12874a71df50SFrank Blaschka rc3 = qeth_clear_channel(&card->data); 12884a71df50SFrank Blaschka if (rc1) 12894a71df50SFrank Blaschka return rc1; 12904a71df50SFrank Blaschka if (rc2) 12914a71df50SFrank Blaschka return rc2; 12924a71df50SFrank Blaschka return rc3; 12934a71df50SFrank Blaschka } 12944a71df50SFrank Blaschka 12954a71df50SFrank Blaschka static int qeth_clear_halt_card(struct qeth_card *card, int halt) 12964a71df50SFrank Blaschka { 12974a71df50SFrank Blaschka int rc = 0; 12984a71df50SFrank Blaschka 1299d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 3, "clhacrd"); 1300d11ba0c4SPeter Tiedemann QETH_DBF_HEX(TRACE, 3, &card, sizeof(void *)); 13014a71df50SFrank Blaschka 13024a71df50SFrank Blaschka if (halt) 13034a71df50SFrank Blaschka rc = qeth_halt_channels(card); 13044a71df50SFrank Blaschka if (rc) 13054a71df50SFrank Blaschka return rc; 13064a71df50SFrank Blaschka return qeth_clear_channels(card); 13074a71df50SFrank Blaschka } 13084a71df50SFrank Blaschka 13094a71df50SFrank Blaschka int qeth_qdio_clear_card(struct qeth_card *card, int use_halt) 13104a71df50SFrank Blaschka { 13114a71df50SFrank Blaschka int rc = 0; 13124a71df50SFrank Blaschka 1313d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 3, "qdioclr"); 13144a71df50SFrank Blaschka switch (atomic_cmpxchg(&card->qdio.state, QETH_QDIO_ESTABLISHED, 13154a71df50SFrank Blaschka QETH_QDIO_CLEANING)) { 13164a71df50SFrank Blaschka case QETH_QDIO_ESTABLISHED: 13174a71df50SFrank Blaschka if (card->info.type == QETH_CARD_TYPE_IQD) 13184a71df50SFrank Blaschka rc = qdio_cleanup(CARD_DDEV(card), 13194a71df50SFrank Blaschka QDIO_FLAG_CLEANUP_USING_HALT); 13204a71df50SFrank Blaschka else 13214a71df50SFrank Blaschka rc = qdio_cleanup(CARD_DDEV(card), 13224a71df50SFrank Blaschka QDIO_FLAG_CLEANUP_USING_CLEAR); 13234a71df50SFrank Blaschka if (rc) 1324d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(TRACE, 3, "1err%d", rc); 13254a71df50SFrank Blaschka atomic_set(&card->qdio.state, QETH_QDIO_ALLOCATED); 13264a71df50SFrank Blaschka break; 13274a71df50SFrank Blaschka case QETH_QDIO_CLEANING: 13284a71df50SFrank Blaschka return rc; 13294a71df50SFrank Blaschka default: 13304a71df50SFrank Blaschka break; 13314a71df50SFrank Blaschka } 13324a71df50SFrank Blaschka rc = qeth_clear_halt_card(card, use_halt); 13334a71df50SFrank Blaschka if (rc) 1334d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(TRACE, 3, "2err%d", rc); 13354a71df50SFrank Blaschka card->state = CARD_STATE_DOWN; 13364a71df50SFrank Blaschka return rc; 13374a71df50SFrank Blaschka } 13384a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_qdio_clear_card); 13394a71df50SFrank Blaschka 13404a71df50SFrank Blaschka static int qeth_read_conf_data(struct qeth_card *card, void **buffer, 13414a71df50SFrank Blaschka int *length) 13424a71df50SFrank Blaschka { 13434a71df50SFrank Blaschka struct ciw *ciw; 13444a71df50SFrank Blaschka char *rcd_buf; 13454a71df50SFrank Blaschka int ret; 13464a71df50SFrank Blaschka struct qeth_channel *channel = &card->data; 13474a71df50SFrank Blaschka unsigned long flags; 13484a71df50SFrank Blaschka 13494a71df50SFrank Blaschka /* 13504a71df50SFrank Blaschka * scan for RCD command in extended SenseID data 13514a71df50SFrank Blaschka */ 13524a71df50SFrank Blaschka ciw = ccw_device_get_ciw(channel->ccwdev, CIW_TYPE_RCD); 13534a71df50SFrank Blaschka if (!ciw || ciw->cmd == 0) 13544a71df50SFrank Blaschka return -EOPNOTSUPP; 13554a71df50SFrank Blaschka rcd_buf = kzalloc(ciw->count, GFP_KERNEL | GFP_DMA); 13564a71df50SFrank Blaschka if (!rcd_buf) 13574a71df50SFrank Blaschka return -ENOMEM; 13584a71df50SFrank Blaschka 13594a71df50SFrank Blaschka channel->ccw.cmd_code = ciw->cmd; 13604a71df50SFrank Blaschka channel->ccw.cda = (__u32) __pa(rcd_buf); 13614a71df50SFrank Blaschka channel->ccw.count = ciw->count; 13624a71df50SFrank Blaschka channel->ccw.flags = CCW_FLAG_SLI; 13634a71df50SFrank Blaschka channel->state = CH_STATE_RCD; 13644a71df50SFrank Blaschka spin_lock_irqsave(get_ccwdev_lock(channel->ccwdev), flags); 13654a71df50SFrank Blaschka ret = ccw_device_start_timeout(channel->ccwdev, &channel->ccw, 13664a71df50SFrank Blaschka QETH_RCD_PARM, LPM_ANYPATH, 0, 13674a71df50SFrank Blaschka QETH_RCD_TIMEOUT); 13684a71df50SFrank Blaschka spin_unlock_irqrestore(get_ccwdev_lock(channel->ccwdev), flags); 13694a71df50SFrank Blaschka if (!ret) 13704a71df50SFrank Blaschka wait_event(card->wait_q, 13714a71df50SFrank Blaschka (channel->state == CH_STATE_RCD_DONE || 13724a71df50SFrank Blaschka channel->state == CH_STATE_DOWN)); 13734a71df50SFrank Blaschka if (channel->state == CH_STATE_DOWN) 13744a71df50SFrank Blaschka ret = -EIO; 13754a71df50SFrank Blaschka else 13764a71df50SFrank Blaschka channel->state = CH_STATE_DOWN; 13774a71df50SFrank Blaschka if (ret) { 13784a71df50SFrank Blaschka kfree(rcd_buf); 13794a71df50SFrank Blaschka *buffer = NULL; 13804a71df50SFrank Blaschka *length = 0; 13814a71df50SFrank Blaschka } else { 13824a71df50SFrank Blaschka *length = ciw->count; 13834a71df50SFrank Blaschka *buffer = rcd_buf; 13844a71df50SFrank Blaschka } 13854a71df50SFrank Blaschka return ret; 13864a71df50SFrank Blaschka } 13874a71df50SFrank Blaschka 13884a71df50SFrank Blaschka static int qeth_get_unitaddr(struct qeth_card *card) 13894a71df50SFrank Blaschka { 13904a71df50SFrank Blaschka int length; 13914a71df50SFrank Blaschka char *prcd; 13924a71df50SFrank Blaschka int rc; 13934a71df50SFrank Blaschka 1394d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "getunit"); 13954a71df50SFrank Blaschka rc = qeth_read_conf_data(card, (void **) &prcd, &length); 13964a71df50SFrank Blaschka if (rc) { 139774eacdb9SFrank Blaschka QETH_DBF_MESSAGE(2, "%s qeth_read_conf_data returned %i\n", 139874eacdb9SFrank Blaschka dev_name(&card->gdev->dev), rc); 13994a71df50SFrank Blaschka return rc; 14004a71df50SFrank Blaschka } 14014a71df50SFrank Blaschka card->info.chpid = prcd[30]; 14024a71df50SFrank Blaschka card->info.unit_addr2 = prcd[31]; 14034a71df50SFrank Blaschka card->info.cula = prcd[63]; 14044a71df50SFrank Blaschka card->info.guestlan = ((prcd[0x10] == _ascebc['V']) && 14054a71df50SFrank Blaschka (prcd[0x11] == _ascebc['M'])); 14064a71df50SFrank Blaschka kfree(prcd); 14074a71df50SFrank Blaschka return 0; 14084a71df50SFrank Blaschka } 14094a71df50SFrank Blaschka 14104a71df50SFrank Blaschka static void qeth_init_tokens(struct qeth_card *card) 14114a71df50SFrank Blaschka { 14124a71df50SFrank Blaschka card->token.issuer_rm_w = 0x00010103UL; 14134a71df50SFrank Blaschka card->token.cm_filter_w = 0x00010108UL; 14144a71df50SFrank Blaschka card->token.cm_connection_w = 0x0001010aUL; 14154a71df50SFrank Blaschka card->token.ulp_filter_w = 0x0001010bUL; 14164a71df50SFrank Blaschka card->token.ulp_connection_w = 0x0001010dUL; 14174a71df50SFrank Blaschka } 14184a71df50SFrank Blaschka 14194a71df50SFrank Blaschka static void qeth_init_func_level(struct qeth_card *card) 14204a71df50SFrank Blaschka { 14214a71df50SFrank Blaschka if (card->ipato.enabled) { 14224a71df50SFrank Blaschka if (card->info.type == QETH_CARD_TYPE_IQD) 14234a71df50SFrank Blaschka card->info.func_level = 14244a71df50SFrank Blaschka QETH_IDX_FUNC_LEVEL_IQD_ENA_IPAT; 14254a71df50SFrank Blaschka else 14264a71df50SFrank Blaschka card->info.func_level = 14274a71df50SFrank Blaschka QETH_IDX_FUNC_LEVEL_OSAE_ENA_IPAT; 14284a71df50SFrank Blaschka } else { 14294a71df50SFrank Blaschka if (card->info.type == QETH_CARD_TYPE_IQD) 14304a71df50SFrank Blaschka /*FIXME:why do we have same values for dis and ena for 14314a71df50SFrank Blaschka osae??? */ 14324a71df50SFrank Blaschka card->info.func_level = 14334a71df50SFrank Blaschka QETH_IDX_FUNC_LEVEL_IQD_DIS_IPAT; 14344a71df50SFrank Blaschka else 14354a71df50SFrank Blaschka card->info.func_level = 14364a71df50SFrank Blaschka QETH_IDX_FUNC_LEVEL_OSAE_DIS_IPAT; 14374a71df50SFrank Blaschka } 14384a71df50SFrank Blaschka } 14394a71df50SFrank Blaschka 14404a71df50SFrank Blaschka static int qeth_idx_activate_get_answer(struct qeth_channel *channel, 14414a71df50SFrank Blaschka void (*idx_reply_cb)(struct qeth_channel *, 14424a71df50SFrank Blaschka struct qeth_cmd_buffer *)) 14434a71df50SFrank Blaschka { 14444a71df50SFrank Blaschka struct qeth_cmd_buffer *iob; 14454a71df50SFrank Blaschka unsigned long flags; 14464a71df50SFrank Blaschka int rc; 14474a71df50SFrank Blaschka struct qeth_card *card; 14484a71df50SFrank Blaschka 1449d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "idxanswr"); 14504a71df50SFrank Blaschka card = CARD_FROM_CDEV(channel->ccwdev); 14514a71df50SFrank Blaschka iob = qeth_get_buffer(channel); 14524a71df50SFrank Blaschka iob->callback = idx_reply_cb; 14534a71df50SFrank Blaschka memcpy(&channel->ccw, READ_CCW, sizeof(struct ccw1)); 14544a71df50SFrank Blaschka channel->ccw.count = QETH_BUFSIZE; 14554a71df50SFrank Blaschka channel->ccw.cda = (__u32) __pa(iob->data); 14564a71df50SFrank Blaschka 14574a71df50SFrank Blaschka wait_event(card->wait_q, 14584a71df50SFrank Blaschka atomic_cmpxchg(&channel->irq_pending, 0, 1) == 0); 1459d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 6, "noirqpnd"); 14604a71df50SFrank Blaschka spin_lock_irqsave(get_ccwdev_lock(channel->ccwdev), flags); 14614a71df50SFrank Blaschka rc = ccw_device_start(channel->ccwdev, 14624a71df50SFrank Blaschka &channel->ccw, (addr_t) iob, 0, 0); 14634a71df50SFrank Blaschka spin_unlock_irqrestore(get_ccwdev_lock(channel->ccwdev), flags); 14644a71df50SFrank Blaschka 14654a71df50SFrank Blaschka if (rc) { 146614cc21b6SFrank Blaschka QETH_DBF_MESSAGE(2, "Error2 in activating channel rc=%d\n", rc); 1467d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "2err%d", rc); 14684a71df50SFrank Blaschka atomic_set(&channel->irq_pending, 0); 14694a71df50SFrank Blaschka wake_up(&card->wait_q); 14704a71df50SFrank Blaschka return rc; 14714a71df50SFrank Blaschka } 14724a71df50SFrank Blaschka rc = wait_event_interruptible_timeout(card->wait_q, 14734a71df50SFrank Blaschka channel->state == CH_STATE_UP, QETH_TIMEOUT); 14744a71df50SFrank Blaschka if (rc == -ERESTARTSYS) 14754a71df50SFrank Blaschka return rc; 14764a71df50SFrank Blaschka if (channel->state != CH_STATE_UP) { 14774a71df50SFrank Blaschka rc = -ETIME; 1478d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "3err%d", rc); 14794a71df50SFrank Blaschka qeth_clear_cmd_buffers(channel); 14804a71df50SFrank Blaschka } else 14814a71df50SFrank Blaschka rc = 0; 14824a71df50SFrank Blaschka return rc; 14834a71df50SFrank Blaschka } 14844a71df50SFrank Blaschka 14854a71df50SFrank Blaschka static int qeth_idx_activate_channel(struct qeth_channel *channel, 14864a71df50SFrank Blaschka void (*idx_reply_cb)(struct qeth_channel *, 14874a71df50SFrank Blaschka struct qeth_cmd_buffer *)) 14884a71df50SFrank Blaschka { 14894a71df50SFrank Blaschka struct qeth_card *card; 14904a71df50SFrank Blaschka struct qeth_cmd_buffer *iob; 14914a71df50SFrank Blaschka unsigned long flags; 14924a71df50SFrank Blaschka __u16 temp; 14934a71df50SFrank Blaschka __u8 tmp; 14944a71df50SFrank Blaschka int rc; 1495f06f6f32SCornelia Huck struct ccw_dev_id temp_devid; 14964a71df50SFrank Blaschka 14974a71df50SFrank Blaschka card = CARD_FROM_CDEV(channel->ccwdev); 14984a71df50SFrank Blaschka 1499d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "idxactch"); 15004a71df50SFrank Blaschka 15014a71df50SFrank Blaschka iob = qeth_get_buffer(channel); 15024a71df50SFrank Blaschka iob->callback = idx_reply_cb; 15034a71df50SFrank Blaschka memcpy(&channel->ccw, WRITE_CCW, sizeof(struct ccw1)); 15044a71df50SFrank Blaschka channel->ccw.count = IDX_ACTIVATE_SIZE; 15054a71df50SFrank Blaschka channel->ccw.cda = (__u32) __pa(iob->data); 15064a71df50SFrank Blaschka if (channel == &card->write) { 15074a71df50SFrank Blaschka memcpy(iob->data, IDX_ACTIVATE_WRITE, IDX_ACTIVATE_SIZE); 15084a71df50SFrank Blaschka memcpy(QETH_TRANSPORT_HEADER_SEQ_NO(iob->data), 15094a71df50SFrank Blaschka &card->seqno.trans_hdr, QETH_SEQ_NO_LENGTH); 15104a71df50SFrank Blaschka card->seqno.trans_hdr++; 15114a71df50SFrank Blaschka } else { 15124a71df50SFrank Blaschka memcpy(iob->data, IDX_ACTIVATE_READ, IDX_ACTIVATE_SIZE); 15134a71df50SFrank Blaschka memcpy(QETH_TRANSPORT_HEADER_SEQ_NO(iob->data), 15144a71df50SFrank Blaschka &card->seqno.trans_hdr, QETH_SEQ_NO_LENGTH); 15154a71df50SFrank Blaschka } 15164a71df50SFrank Blaschka tmp = ((__u8)card->info.portno) | 0x80; 15174a71df50SFrank Blaschka memcpy(QETH_IDX_ACT_PNO(iob->data), &tmp, 1); 15184a71df50SFrank Blaschka memcpy(QETH_IDX_ACT_ISSUER_RM_TOKEN(iob->data), 15194a71df50SFrank Blaschka &card->token.issuer_rm_w, QETH_MPC_TOKEN_LENGTH); 15204a71df50SFrank Blaschka memcpy(QETH_IDX_ACT_FUNC_LEVEL(iob->data), 15214a71df50SFrank Blaschka &card->info.func_level, sizeof(__u16)); 1522f06f6f32SCornelia Huck ccw_device_get_id(CARD_DDEV(card), &temp_devid); 1523f06f6f32SCornelia Huck memcpy(QETH_IDX_ACT_QDIO_DEV_CUA(iob->data), &temp_devid.devno, 2); 15244a71df50SFrank Blaschka temp = (card->info.cula << 8) + card->info.unit_addr2; 15254a71df50SFrank Blaschka memcpy(QETH_IDX_ACT_QDIO_DEV_REALADDR(iob->data), &temp, 2); 15264a71df50SFrank Blaschka 15274a71df50SFrank Blaschka wait_event(card->wait_q, 15284a71df50SFrank Blaschka atomic_cmpxchg(&channel->irq_pending, 0, 1) == 0); 1529d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 6, "noirqpnd"); 15304a71df50SFrank Blaschka spin_lock_irqsave(get_ccwdev_lock(channel->ccwdev), flags); 15314a71df50SFrank Blaschka rc = ccw_device_start(channel->ccwdev, 15324a71df50SFrank Blaschka &channel->ccw, (addr_t) iob, 0, 0); 15334a71df50SFrank Blaschka spin_unlock_irqrestore(get_ccwdev_lock(channel->ccwdev), flags); 15344a71df50SFrank Blaschka 15354a71df50SFrank Blaschka if (rc) { 153614cc21b6SFrank Blaschka QETH_DBF_MESSAGE(2, "Error1 in activating channel. rc=%d\n", 153714cc21b6SFrank Blaschka rc); 1538d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "1err%d", rc); 15394a71df50SFrank Blaschka atomic_set(&channel->irq_pending, 0); 15404a71df50SFrank Blaschka wake_up(&card->wait_q); 15414a71df50SFrank Blaschka return rc; 15424a71df50SFrank Blaschka } 15434a71df50SFrank Blaschka rc = wait_event_interruptible_timeout(card->wait_q, 15444a71df50SFrank Blaschka channel->state == CH_STATE_ACTIVATING, QETH_TIMEOUT); 15454a71df50SFrank Blaschka if (rc == -ERESTARTSYS) 15464a71df50SFrank Blaschka return rc; 15474a71df50SFrank Blaschka if (channel->state != CH_STATE_ACTIVATING) { 154874eacdb9SFrank Blaschka dev_warn(&channel->ccwdev->dev, "The qeth device driver" 154974eacdb9SFrank Blaschka " failed to recover an error on the device\n"); 155074eacdb9SFrank Blaschka QETH_DBF_MESSAGE(2, "%s IDX activate timed out\n", 155174eacdb9SFrank Blaschka dev_name(&channel->ccwdev->dev)); 1552d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "2err%d", -ETIME); 15534a71df50SFrank Blaschka qeth_clear_cmd_buffers(channel); 15544a71df50SFrank Blaschka return -ETIME; 15554a71df50SFrank Blaschka } 15564a71df50SFrank Blaschka return qeth_idx_activate_get_answer(channel, idx_reply_cb); 15574a71df50SFrank Blaschka } 15584a71df50SFrank Blaschka 15594a71df50SFrank Blaschka static int qeth_peer_func_level(int level) 15604a71df50SFrank Blaschka { 15614a71df50SFrank Blaschka if ((level & 0xff) == 8) 15624a71df50SFrank Blaschka return (level & 0xff) + 0x400; 15634a71df50SFrank Blaschka if (((level >> 8) & 3) == 1) 15644a71df50SFrank Blaschka return (level & 0xff) + 0x200; 15654a71df50SFrank Blaschka return level; 15664a71df50SFrank Blaschka } 15674a71df50SFrank Blaschka 15684a71df50SFrank Blaschka static void qeth_idx_write_cb(struct qeth_channel *channel, 15694a71df50SFrank Blaschka struct qeth_cmd_buffer *iob) 15704a71df50SFrank Blaschka { 15714a71df50SFrank Blaschka struct qeth_card *card; 15724a71df50SFrank Blaschka __u16 temp; 15734a71df50SFrank Blaschka 1574d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP , 2, "idxwrcb"); 15754a71df50SFrank Blaschka 15764a71df50SFrank Blaschka if (channel->state == CH_STATE_DOWN) { 15774a71df50SFrank Blaschka channel->state = CH_STATE_ACTIVATING; 15784a71df50SFrank Blaschka goto out; 15794a71df50SFrank Blaschka } 15804a71df50SFrank Blaschka card = CARD_FROM_CDEV(channel->ccwdev); 15814a71df50SFrank Blaschka 15824a71df50SFrank Blaschka if (!(QETH_IS_IDX_ACT_POS_REPLY(iob->data))) { 15834a71df50SFrank Blaschka if (QETH_IDX_ACT_CAUSE_CODE(iob->data) == 0x19) 158474eacdb9SFrank Blaschka dev_err(&card->write.ccwdev->dev, 158574eacdb9SFrank Blaschka "The adapter is used exclusively by another " 158674eacdb9SFrank Blaschka "host\n"); 15874a71df50SFrank Blaschka else 158874eacdb9SFrank Blaschka QETH_DBF_MESSAGE(2, "%s IDX_ACTIVATE on write channel:" 158974eacdb9SFrank Blaschka " negative reply\n", 159074eacdb9SFrank Blaschka dev_name(&card->write.ccwdev->dev)); 15914a71df50SFrank Blaschka goto out; 15924a71df50SFrank Blaschka } 15934a71df50SFrank Blaschka memcpy(&temp, QETH_IDX_ACT_FUNC_LEVEL(iob->data), 2); 15944a71df50SFrank Blaschka if ((temp & ~0x0100) != qeth_peer_func_level(card->info.func_level)) { 159574eacdb9SFrank Blaschka QETH_DBF_MESSAGE(2, "%s IDX_ACTIVATE on write channel: " 159674eacdb9SFrank Blaschka "function level mismatch (sent: 0x%x, received: " 159774eacdb9SFrank Blaschka "0x%x)\n", dev_name(&card->write.ccwdev->dev), 159874eacdb9SFrank Blaschka card->info.func_level, temp); 15994a71df50SFrank Blaschka goto out; 16004a71df50SFrank Blaschka } 16014a71df50SFrank Blaschka channel->state = CH_STATE_UP; 16024a71df50SFrank Blaschka out: 16034a71df50SFrank Blaschka qeth_release_buffer(channel, iob); 16044a71df50SFrank Blaschka } 16054a71df50SFrank Blaschka 16064a71df50SFrank Blaschka static void qeth_idx_read_cb(struct qeth_channel *channel, 16074a71df50SFrank Blaschka struct qeth_cmd_buffer *iob) 16084a71df50SFrank Blaschka { 16094a71df50SFrank Blaschka struct qeth_card *card; 16104a71df50SFrank Blaschka __u16 temp; 16114a71df50SFrank Blaschka 1612d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP , 2, "idxrdcb"); 16134a71df50SFrank Blaschka if (channel->state == CH_STATE_DOWN) { 16144a71df50SFrank Blaschka channel->state = CH_STATE_ACTIVATING; 16154a71df50SFrank Blaschka goto out; 16164a71df50SFrank Blaschka } 16174a71df50SFrank Blaschka 16184a71df50SFrank Blaschka card = CARD_FROM_CDEV(channel->ccwdev); 16194a71df50SFrank Blaschka if (qeth_check_idx_response(iob->data)) 16204a71df50SFrank Blaschka goto out; 16214a71df50SFrank Blaschka 16224a71df50SFrank Blaschka if (!(QETH_IS_IDX_ACT_POS_REPLY(iob->data))) { 16234a71df50SFrank Blaschka if (QETH_IDX_ACT_CAUSE_CODE(iob->data) == 0x19) 162474eacdb9SFrank Blaschka dev_err(&card->write.ccwdev->dev, 162574eacdb9SFrank Blaschka "The adapter is used exclusively by another " 162674eacdb9SFrank Blaschka "host\n"); 16274a71df50SFrank Blaschka else 162874eacdb9SFrank Blaschka QETH_DBF_MESSAGE(2, "%s IDX_ACTIVATE on read channel:" 162974eacdb9SFrank Blaschka " negative reply\n", 163074eacdb9SFrank Blaschka dev_name(&card->read.ccwdev->dev)); 16314a71df50SFrank Blaschka goto out; 16324a71df50SFrank Blaschka } 16334a71df50SFrank Blaschka 16344a71df50SFrank Blaschka /** 16354a71df50SFrank Blaschka * temporary fix for microcode bug 16364a71df50SFrank Blaschka * to revert it,replace OR by AND 16374a71df50SFrank Blaschka */ 16384a71df50SFrank Blaschka if ((!QETH_IDX_NO_PORTNAME_REQUIRED(iob->data)) || 16394a71df50SFrank Blaschka (card->info.type == QETH_CARD_TYPE_OSAE)) 16404a71df50SFrank Blaschka card->info.portname_required = 1; 16414a71df50SFrank Blaschka 16424a71df50SFrank Blaschka memcpy(&temp, QETH_IDX_ACT_FUNC_LEVEL(iob->data), 2); 16434a71df50SFrank Blaschka if (temp != qeth_peer_func_level(card->info.func_level)) { 164474eacdb9SFrank Blaschka QETH_DBF_MESSAGE(2, "%s IDX_ACTIVATE on read channel: function " 16454a71df50SFrank Blaschka "level mismatch (sent: 0x%x, received: 0x%x)\n", 164674eacdb9SFrank Blaschka dev_name(&card->read.ccwdev->dev), 164774eacdb9SFrank Blaschka card->info.func_level, temp); 16484a71df50SFrank Blaschka goto out; 16494a71df50SFrank Blaschka } 16504a71df50SFrank Blaschka memcpy(&card->token.issuer_rm_r, 16514a71df50SFrank Blaschka QETH_IDX_ACT_ISSUER_RM_TOKEN(iob->data), 16524a71df50SFrank Blaschka QETH_MPC_TOKEN_LENGTH); 16534a71df50SFrank Blaschka memcpy(&card->info.mcl_level[0], 16544a71df50SFrank Blaschka QETH_IDX_REPLY_LEVEL(iob->data), QETH_MCL_LENGTH); 16554a71df50SFrank Blaschka channel->state = CH_STATE_UP; 16564a71df50SFrank Blaschka out: 16574a71df50SFrank Blaschka qeth_release_buffer(channel, iob); 16584a71df50SFrank Blaschka } 16594a71df50SFrank Blaschka 16604a71df50SFrank Blaschka void qeth_prepare_control_data(struct qeth_card *card, int len, 16614a71df50SFrank Blaschka struct qeth_cmd_buffer *iob) 16624a71df50SFrank Blaschka { 16634a71df50SFrank Blaschka qeth_setup_ccw(&card->write, iob->data, len); 16644a71df50SFrank Blaschka iob->callback = qeth_release_buffer; 16654a71df50SFrank Blaschka 16664a71df50SFrank Blaschka memcpy(QETH_TRANSPORT_HEADER_SEQ_NO(iob->data), 16674a71df50SFrank Blaschka &card->seqno.trans_hdr, QETH_SEQ_NO_LENGTH); 16684a71df50SFrank Blaschka card->seqno.trans_hdr++; 16694a71df50SFrank Blaschka memcpy(QETH_PDU_HEADER_SEQ_NO(iob->data), 16704a71df50SFrank Blaschka &card->seqno.pdu_hdr, QETH_SEQ_NO_LENGTH); 16714a71df50SFrank Blaschka card->seqno.pdu_hdr++; 16724a71df50SFrank Blaschka memcpy(QETH_PDU_HEADER_ACK_SEQ_NO(iob->data), 16734a71df50SFrank Blaschka &card->seqno.pdu_hdr_ack, QETH_SEQ_NO_LENGTH); 1674d11ba0c4SPeter Tiedemann QETH_DBF_HEX(CTRL, 2, iob->data, QETH_DBF_CTRL_LEN); 16754a71df50SFrank Blaschka } 16764a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_prepare_control_data); 16774a71df50SFrank Blaschka 16784a71df50SFrank Blaschka int qeth_send_control_data(struct qeth_card *card, int len, 16794a71df50SFrank Blaschka struct qeth_cmd_buffer *iob, 16804a71df50SFrank Blaschka int (*reply_cb)(struct qeth_card *, struct qeth_reply *, 16814a71df50SFrank Blaschka unsigned long), 16824a71df50SFrank Blaschka void *reply_param) 16834a71df50SFrank Blaschka { 16844a71df50SFrank Blaschka int rc; 16854a71df50SFrank Blaschka unsigned long flags; 16864a71df50SFrank Blaschka struct qeth_reply *reply = NULL; 16874a71df50SFrank Blaschka unsigned long timeout; 16885b54e16fSFrank Blaschka struct qeth_ipa_cmd *cmd; 16894a71df50SFrank Blaschka 1690d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 2, "sendctl"); 16914a71df50SFrank Blaschka 16924a71df50SFrank Blaschka reply = qeth_alloc_reply(card); 16934a71df50SFrank Blaschka if (!reply) { 16944a71df50SFrank Blaschka return -ENOMEM; 16954a71df50SFrank Blaschka } 16964a71df50SFrank Blaschka reply->callback = reply_cb; 16974a71df50SFrank Blaschka reply->param = reply_param; 16984a71df50SFrank Blaschka if (card->state == CARD_STATE_DOWN) 16994a71df50SFrank Blaschka reply->seqno = QETH_IDX_COMMAND_SEQNO; 17004a71df50SFrank Blaschka else 17014a71df50SFrank Blaschka reply->seqno = card->seqno.ipa++; 17024a71df50SFrank Blaschka init_waitqueue_head(&reply->wait_q); 17034a71df50SFrank Blaschka spin_lock_irqsave(&card->lock, flags); 17044a71df50SFrank Blaschka list_add_tail(&reply->list, &card->cmd_waiter_list); 17054a71df50SFrank Blaschka spin_unlock_irqrestore(&card->lock, flags); 1706d11ba0c4SPeter Tiedemann QETH_DBF_HEX(CTRL, 2, iob->data, QETH_DBF_CTRL_LEN); 17074a71df50SFrank Blaschka 17084a71df50SFrank Blaschka while (atomic_cmpxchg(&card->write.irq_pending, 0, 1)) ; 17094a71df50SFrank Blaschka qeth_prepare_control_data(card, len, iob); 17104a71df50SFrank Blaschka 17114a71df50SFrank Blaschka if (IS_IPA(iob->data)) 17124a71df50SFrank Blaschka timeout = jiffies + QETH_IPA_TIMEOUT; 17134a71df50SFrank Blaschka else 17144a71df50SFrank Blaschka timeout = jiffies + QETH_TIMEOUT; 17154a71df50SFrank Blaschka 1716d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 6, "noirqpnd"); 17174a71df50SFrank Blaschka spin_lock_irqsave(get_ccwdev_lock(card->write.ccwdev), flags); 17184a71df50SFrank Blaschka rc = ccw_device_start(card->write.ccwdev, &card->write.ccw, 17194a71df50SFrank Blaschka (addr_t) iob, 0, 0); 17204a71df50SFrank Blaschka spin_unlock_irqrestore(get_ccwdev_lock(card->write.ccwdev), flags); 17214a71df50SFrank Blaschka if (rc) { 172274eacdb9SFrank Blaschka QETH_DBF_MESSAGE(2, "%s qeth_send_control_data: " 172374eacdb9SFrank Blaschka "ccw_device_start rc = %i\n", 172474eacdb9SFrank Blaschka dev_name(&card->write.ccwdev->dev), rc); 1725d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(TRACE, 2, " err%d", rc); 17264a71df50SFrank Blaschka spin_lock_irqsave(&card->lock, flags); 17274a71df50SFrank Blaschka list_del_init(&reply->list); 17284a71df50SFrank Blaschka qeth_put_reply(reply); 17294a71df50SFrank Blaschka spin_unlock_irqrestore(&card->lock, flags); 17304a71df50SFrank Blaschka qeth_release_buffer(iob->channel, iob); 17314a71df50SFrank Blaschka atomic_set(&card->write.irq_pending, 0); 17324a71df50SFrank Blaschka wake_up(&card->wait_q); 17334a71df50SFrank Blaschka return rc; 17344a71df50SFrank Blaschka } 17355b54e16fSFrank Blaschka 17365b54e16fSFrank Blaschka /* we have only one long running ipassist, since we can ensure 17375b54e16fSFrank Blaschka process context of this command we can sleep */ 17385b54e16fSFrank Blaschka cmd = (struct qeth_ipa_cmd *)(iob->data+IPA_PDU_HEADER_SIZE); 17395b54e16fSFrank Blaschka if ((cmd->hdr.command == IPA_CMD_SETIP) && 17405b54e16fSFrank Blaschka (cmd->hdr.prot_version == QETH_PROT_IPV4)) { 17415b54e16fSFrank Blaschka if (!wait_event_timeout(reply->wait_q, 17425b54e16fSFrank Blaschka atomic_read(&reply->received), timeout)) 17435b54e16fSFrank Blaschka goto time_err; 17445b54e16fSFrank Blaschka } else { 17454a71df50SFrank Blaschka while (!atomic_read(&reply->received)) { 17465b54e16fSFrank Blaschka if (time_after(jiffies, timeout)) 17475b54e16fSFrank Blaschka goto time_err; 17485b54e16fSFrank Blaschka cpu_relax(); 17495b54e16fSFrank Blaschka }; 17505b54e16fSFrank Blaschka } 17515b54e16fSFrank Blaschka 17525b54e16fSFrank Blaschka rc = reply->rc; 17535b54e16fSFrank Blaschka qeth_put_reply(reply); 17545b54e16fSFrank Blaschka return rc; 17555b54e16fSFrank Blaschka 17565b54e16fSFrank Blaschka time_err: 17574a71df50SFrank Blaschka spin_lock_irqsave(&reply->card->lock, flags); 17584a71df50SFrank Blaschka list_del_init(&reply->list); 17594a71df50SFrank Blaschka spin_unlock_irqrestore(&reply->card->lock, flags); 17604a71df50SFrank Blaschka reply->rc = -ETIME; 17614a71df50SFrank Blaschka atomic_inc(&reply->received); 17624a71df50SFrank Blaschka wake_up(&reply->wait_q); 17634a71df50SFrank Blaschka rc = reply->rc; 17644a71df50SFrank Blaschka qeth_put_reply(reply); 17654a71df50SFrank Blaschka return rc; 17664a71df50SFrank Blaschka } 17674a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_send_control_data); 17684a71df50SFrank Blaschka 17694a71df50SFrank Blaschka static int qeth_cm_enable_cb(struct qeth_card *card, struct qeth_reply *reply, 17704a71df50SFrank Blaschka unsigned long data) 17714a71df50SFrank Blaschka { 17724a71df50SFrank Blaschka struct qeth_cmd_buffer *iob; 17734a71df50SFrank Blaschka 1774d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "cmenblcb"); 17754a71df50SFrank Blaschka 17764a71df50SFrank Blaschka iob = (struct qeth_cmd_buffer *) data; 17774a71df50SFrank Blaschka memcpy(&card->token.cm_filter_r, 17784a71df50SFrank Blaschka QETH_CM_ENABLE_RESP_FILTER_TOKEN(iob->data), 17794a71df50SFrank Blaschka QETH_MPC_TOKEN_LENGTH); 1780d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, " rc%d", iob->rc); 17814a71df50SFrank Blaschka return 0; 17824a71df50SFrank Blaschka } 17834a71df50SFrank Blaschka 17844a71df50SFrank Blaschka static int qeth_cm_enable(struct qeth_card *card) 17854a71df50SFrank Blaschka { 17864a71df50SFrank Blaschka int rc; 17874a71df50SFrank Blaschka struct qeth_cmd_buffer *iob; 17884a71df50SFrank Blaschka 1789d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "cmenable"); 17904a71df50SFrank Blaschka 17914a71df50SFrank Blaschka iob = qeth_wait_for_buffer(&card->write); 17924a71df50SFrank Blaschka memcpy(iob->data, CM_ENABLE, CM_ENABLE_SIZE); 17934a71df50SFrank Blaschka memcpy(QETH_CM_ENABLE_ISSUER_RM_TOKEN(iob->data), 17944a71df50SFrank Blaschka &card->token.issuer_rm_r, QETH_MPC_TOKEN_LENGTH); 17954a71df50SFrank Blaschka memcpy(QETH_CM_ENABLE_FILTER_TOKEN(iob->data), 17964a71df50SFrank Blaschka &card->token.cm_filter_w, QETH_MPC_TOKEN_LENGTH); 17974a71df50SFrank Blaschka 17984a71df50SFrank Blaschka rc = qeth_send_control_data(card, CM_ENABLE_SIZE, iob, 17994a71df50SFrank Blaschka qeth_cm_enable_cb, NULL); 18004a71df50SFrank Blaschka return rc; 18014a71df50SFrank Blaschka } 18024a71df50SFrank Blaschka 18034a71df50SFrank Blaschka static int qeth_cm_setup_cb(struct qeth_card *card, struct qeth_reply *reply, 18044a71df50SFrank Blaschka unsigned long data) 18054a71df50SFrank Blaschka { 18064a71df50SFrank Blaschka 18074a71df50SFrank Blaschka struct qeth_cmd_buffer *iob; 18084a71df50SFrank Blaschka 1809d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "cmsetpcb"); 18104a71df50SFrank Blaschka 18114a71df50SFrank Blaschka iob = (struct qeth_cmd_buffer *) data; 18124a71df50SFrank Blaschka memcpy(&card->token.cm_connection_r, 18134a71df50SFrank Blaschka QETH_CM_SETUP_RESP_DEST_ADDR(iob->data), 18144a71df50SFrank Blaschka QETH_MPC_TOKEN_LENGTH); 1815d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, " rc%d", iob->rc); 18164a71df50SFrank Blaschka return 0; 18174a71df50SFrank Blaschka } 18184a71df50SFrank Blaschka 18194a71df50SFrank Blaschka static int qeth_cm_setup(struct qeth_card *card) 18204a71df50SFrank Blaschka { 18214a71df50SFrank Blaschka int rc; 18224a71df50SFrank Blaschka struct qeth_cmd_buffer *iob; 18234a71df50SFrank Blaschka 1824d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "cmsetup"); 18254a71df50SFrank Blaschka 18264a71df50SFrank Blaschka iob = qeth_wait_for_buffer(&card->write); 18274a71df50SFrank Blaschka memcpy(iob->data, CM_SETUP, CM_SETUP_SIZE); 18284a71df50SFrank Blaschka memcpy(QETH_CM_SETUP_DEST_ADDR(iob->data), 18294a71df50SFrank Blaschka &card->token.issuer_rm_r, QETH_MPC_TOKEN_LENGTH); 18304a71df50SFrank Blaschka memcpy(QETH_CM_SETUP_CONNECTION_TOKEN(iob->data), 18314a71df50SFrank Blaschka &card->token.cm_connection_w, QETH_MPC_TOKEN_LENGTH); 18324a71df50SFrank Blaschka memcpy(QETH_CM_SETUP_FILTER_TOKEN(iob->data), 18334a71df50SFrank Blaschka &card->token.cm_filter_r, QETH_MPC_TOKEN_LENGTH); 18344a71df50SFrank Blaschka rc = qeth_send_control_data(card, CM_SETUP_SIZE, iob, 18354a71df50SFrank Blaschka qeth_cm_setup_cb, NULL); 18364a71df50SFrank Blaschka return rc; 18374a71df50SFrank Blaschka 18384a71df50SFrank Blaschka } 18394a71df50SFrank Blaschka 18404a71df50SFrank Blaschka static inline int qeth_get_initial_mtu_for_card(struct qeth_card *card) 18414a71df50SFrank Blaschka { 18424a71df50SFrank Blaschka switch (card->info.type) { 18434a71df50SFrank Blaschka case QETH_CARD_TYPE_UNKNOWN: 18444a71df50SFrank Blaschka return 1500; 18454a71df50SFrank Blaschka case QETH_CARD_TYPE_IQD: 18464a71df50SFrank Blaschka return card->info.max_mtu; 18474a71df50SFrank Blaschka case QETH_CARD_TYPE_OSAE: 18484a71df50SFrank Blaschka switch (card->info.link_type) { 18494a71df50SFrank Blaschka case QETH_LINK_TYPE_HSTR: 18504a71df50SFrank Blaschka case QETH_LINK_TYPE_LANE_TR: 18514a71df50SFrank Blaschka return 2000; 18524a71df50SFrank Blaschka default: 18534a71df50SFrank Blaschka return 1492; 18544a71df50SFrank Blaschka } 18554a71df50SFrank Blaschka default: 18564a71df50SFrank Blaschka return 1500; 18574a71df50SFrank Blaschka } 18584a71df50SFrank Blaschka } 18594a71df50SFrank Blaschka 18604a71df50SFrank Blaschka static inline int qeth_get_max_mtu_for_card(int cardtype) 18614a71df50SFrank Blaschka { 18624a71df50SFrank Blaschka switch (cardtype) { 18634a71df50SFrank Blaschka 18644a71df50SFrank Blaschka case QETH_CARD_TYPE_UNKNOWN: 18654a71df50SFrank Blaschka case QETH_CARD_TYPE_OSAE: 18664a71df50SFrank Blaschka case QETH_CARD_TYPE_OSN: 18674a71df50SFrank Blaschka return 61440; 18684a71df50SFrank Blaschka case QETH_CARD_TYPE_IQD: 18694a71df50SFrank Blaschka return 57344; 18704a71df50SFrank Blaschka default: 18714a71df50SFrank Blaschka return 1500; 18724a71df50SFrank Blaschka } 18734a71df50SFrank Blaschka } 18744a71df50SFrank Blaschka 18754a71df50SFrank Blaschka static inline int qeth_get_mtu_out_of_mpc(int cardtype) 18764a71df50SFrank Blaschka { 18774a71df50SFrank Blaschka switch (cardtype) { 18784a71df50SFrank Blaschka case QETH_CARD_TYPE_IQD: 18794a71df50SFrank Blaschka return 1; 18804a71df50SFrank Blaschka default: 18814a71df50SFrank Blaschka return 0; 18824a71df50SFrank Blaschka } 18834a71df50SFrank Blaschka } 18844a71df50SFrank Blaschka 18854a71df50SFrank Blaschka static inline int qeth_get_mtu_outof_framesize(int framesize) 18864a71df50SFrank Blaschka { 18874a71df50SFrank Blaschka switch (framesize) { 18884a71df50SFrank Blaschka case 0x4000: 18894a71df50SFrank Blaschka return 8192; 18904a71df50SFrank Blaschka case 0x6000: 18914a71df50SFrank Blaschka return 16384; 18924a71df50SFrank Blaschka case 0xa000: 18934a71df50SFrank Blaschka return 32768; 18944a71df50SFrank Blaschka case 0xffff: 18954a71df50SFrank Blaschka return 57344; 18964a71df50SFrank Blaschka default: 18974a71df50SFrank Blaschka return 0; 18984a71df50SFrank Blaschka } 18994a71df50SFrank Blaschka } 19004a71df50SFrank Blaschka 19014a71df50SFrank Blaschka static inline int qeth_mtu_is_valid(struct qeth_card *card, int mtu) 19024a71df50SFrank Blaschka { 19034a71df50SFrank Blaschka switch (card->info.type) { 19044a71df50SFrank Blaschka case QETH_CARD_TYPE_OSAE: 19054a71df50SFrank Blaschka return ((mtu >= 576) && (mtu <= 61440)); 19064a71df50SFrank Blaschka case QETH_CARD_TYPE_IQD: 19074a71df50SFrank Blaschka return ((mtu >= 576) && 19084a71df50SFrank Blaschka (mtu <= card->info.max_mtu + 4096 - 32)); 19094a71df50SFrank Blaschka case QETH_CARD_TYPE_OSN: 19104a71df50SFrank Blaschka case QETH_CARD_TYPE_UNKNOWN: 19114a71df50SFrank Blaschka default: 19124a71df50SFrank Blaschka return 1; 19134a71df50SFrank Blaschka } 19144a71df50SFrank Blaschka } 19154a71df50SFrank Blaschka 19164a71df50SFrank Blaschka static int qeth_ulp_enable_cb(struct qeth_card *card, struct qeth_reply *reply, 19174a71df50SFrank Blaschka unsigned long data) 19184a71df50SFrank Blaschka { 19194a71df50SFrank Blaschka 19204a71df50SFrank Blaschka __u16 mtu, framesize; 19214a71df50SFrank Blaschka __u16 len; 19224a71df50SFrank Blaschka __u8 link_type; 19234a71df50SFrank Blaschka struct qeth_cmd_buffer *iob; 19244a71df50SFrank Blaschka 1925d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "ulpenacb"); 19264a71df50SFrank Blaschka 19274a71df50SFrank Blaschka iob = (struct qeth_cmd_buffer *) data; 19284a71df50SFrank Blaschka memcpy(&card->token.ulp_filter_r, 19294a71df50SFrank Blaschka QETH_ULP_ENABLE_RESP_FILTER_TOKEN(iob->data), 19304a71df50SFrank Blaschka QETH_MPC_TOKEN_LENGTH); 19314a71df50SFrank Blaschka if (qeth_get_mtu_out_of_mpc(card->info.type)) { 19324a71df50SFrank Blaschka memcpy(&framesize, QETH_ULP_ENABLE_RESP_MAX_MTU(iob->data), 2); 19334a71df50SFrank Blaschka mtu = qeth_get_mtu_outof_framesize(framesize); 19344a71df50SFrank Blaschka if (!mtu) { 19354a71df50SFrank Blaschka iob->rc = -EINVAL; 1936d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, " rc%d", iob->rc); 19374a71df50SFrank Blaschka return 0; 19384a71df50SFrank Blaschka } 19394a71df50SFrank Blaschka card->info.max_mtu = mtu; 19404a71df50SFrank Blaschka card->info.initial_mtu = mtu; 19414a71df50SFrank Blaschka card->qdio.in_buf_size = mtu + 2 * PAGE_SIZE; 19424a71df50SFrank Blaschka } else { 19434a71df50SFrank Blaschka card->info.initial_mtu = qeth_get_initial_mtu_for_card(card); 19444a71df50SFrank Blaschka card->info.max_mtu = qeth_get_max_mtu_for_card(card->info.type); 19454a71df50SFrank Blaschka card->qdio.in_buf_size = QETH_IN_BUF_SIZE_DEFAULT; 19464a71df50SFrank Blaschka } 19474a71df50SFrank Blaschka 19484a71df50SFrank Blaschka memcpy(&len, QETH_ULP_ENABLE_RESP_DIFINFO_LEN(iob->data), 2); 19494a71df50SFrank Blaschka if (len >= QETH_MPC_DIFINFO_LEN_INDICATES_LINK_TYPE) { 19504a71df50SFrank Blaschka memcpy(&link_type, 19514a71df50SFrank Blaschka QETH_ULP_ENABLE_RESP_LINK_TYPE(iob->data), 1); 19524a71df50SFrank Blaschka card->info.link_type = link_type; 19534a71df50SFrank Blaschka } else 19544a71df50SFrank Blaschka card->info.link_type = 0; 1955d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, " rc%d", iob->rc); 19564a71df50SFrank Blaschka return 0; 19574a71df50SFrank Blaschka } 19584a71df50SFrank Blaschka 19594a71df50SFrank Blaschka static int qeth_ulp_enable(struct qeth_card *card) 19604a71df50SFrank Blaschka { 19614a71df50SFrank Blaschka int rc; 19624a71df50SFrank Blaschka char prot_type; 19634a71df50SFrank Blaschka struct qeth_cmd_buffer *iob; 19644a71df50SFrank Blaschka 19654a71df50SFrank Blaschka /*FIXME: trace view callbacks*/ 1966d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "ulpenabl"); 19674a71df50SFrank Blaschka 19684a71df50SFrank Blaschka iob = qeth_wait_for_buffer(&card->write); 19694a71df50SFrank Blaschka memcpy(iob->data, ULP_ENABLE, ULP_ENABLE_SIZE); 19704a71df50SFrank Blaschka 19714a71df50SFrank Blaschka *(QETH_ULP_ENABLE_LINKNUM(iob->data)) = 19724a71df50SFrank Blaschka (__u8) card->info.portno; 19734a71df50SFrank Blaschka if (card->options.layer2) 19744a71df50SFrank Blaschka if (card->info.type == QETH_CARD_TYPE_OSN) 19754a71df50SFrank Blaschka prot_type = QETH_PROT_OSN2; 19764a71df50SFrank Blaschka else 19774a71df50SFrank Blaschka prot_type = QETH_PROT_LAYER2; 19784a71df50SFrank Blaschka else 19794a71df50SFrank Blaschka prot_type = QETH_PROT_TCPIP; 19804a71df50SFrank Blaschka 19814a71df50SFrank Blaschka memcpy(QETH_ULP_ENABLE_PROT_TYPE(iob->data), &prot_type, 1); 19824a71df50SFrank Blaschka memcpy(QETH_ULP_ENABLE_DEST_ADDR(iob->data), 19834a71df50SFrank Blaschka &card->token.cm_connection_r, QETH_MPC_TOKEN_LENGTH); 19844a71df50SFrank Blaschka memcpy(QETH_ULP_ENABLE_FILTER_TOKEN(iob->data), 19854a71df50SFrank Blaschka &card->token.ulp_filter_w, QETH_MPC_TOKEN_LENGTH); 19864a71df50SFrank Blaschka memcpy(QETH_ULP_ENABLE_PORTNAME_AND_LL(iob->data), 19874a71df50SFrank Blaschka card->info.portname, 9); 19884a71df50SFrank Blaschka rc = qeth_send_control_data(card, ULP_ENABLE_SIZE, iob, 19894a71df50SFrank Blaschka qeth_ulp_enable_cb, NULL); 19904a71df50SFrank Blaschka return rc; 19914a71df50SFrank Blaschka 19924a71df50SFrank Blaschka } 19934a71df50SFrank Blaschka 19944a71df50SFrank Blaschka static int qeth_ulp_setup_cb(struct qeth_card *card, struct qeth_reply *reply, 19954a71df50SFrank Blaschka unsigned long data) 19964a71df50SFrank Blaschka { 19974a71df50SFrank Blaschka struct qeth_cmd_buffer *iob; 19984a71df50SFrank Blaschka 1999d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "ulpstpcb"); 20004a71df50SFrank Blaschka 20014a71df50SFrank Blaschka iob = (struct qeth_cmd_buffer *) data; 20024a71df50SFrank Blaschka memcpy(&card->token.ulp_connection_r, 20034a71df50SFrank Blaschka QETH_ULP_SETUP_RESP_CONNECTION_TOKEN(iob->data), 20044a71df50SFrank Blaschka QETH_MPC_TOKEN_LENGTH); 2005d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, " rc%d", iob->rc); 20064a71df50SFrank Blaschka return 0; 20074a71df50SFrank Blaschka } 20084a71df50SFrank Blaschka 20094a71df50SFrank Blaschka static int qeth_ulp_setup(struct qeth_card *card) 20104a71df50SFrank Blaschka { 20114a71df50SFrank Blaschka int rc; 20124a71df50SFrank Blaschka __u16 temp; 20134a71df50SFrank Blaschka struct qeth_cmd_buffer *iob; 20144a71df50SFrank Blaschka struct ccw_dev_id dev_id; 20154a71df50SFrank Blaschka 2016d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "ulpsetup"); 20174a71df50SFrank Blaschka 20184a71df50SFrank Blaschka iob = qeth_wait_for_buffer(&card->write); 20194a71df50SFrank Blaschka memcpy(iob->data, ULP_SETUP, ULP_SETUP_SIZE); 20204a71df50SFrank Blaschka 20214a71df50SFrank Blaschka memcpy(QETH_ULP_SETUP_DEST_ADDR(iob->data), 20224a71df50SFrank Blaschka &card->token.cm_connection_r, QETH_MPC_TOKEN_LENGTH); 20234a71df50SFrank Blaschka memcpy(QETH_ULP_SETUP_CONNECTION_TOKEN(iob->data), 20244a71df50SFrank Blaschka &card->token.ulp_connection_w, QETH_MPC_TOKEN_LENGTH); 20254a71df50SFrank Blaschka memcpy(QETH_ULP_SETUP_FILTER_TOKEN(iob->data), 20264a71df50SFrank Blaschka &card->token.ulp_filter_r, QETH_MPC_TOKEN_LENGTH); 20274a71df50SFrank Blaschka 20284a71df50SFrank Blaschka ccw_device_get_id(CARD_DDEV(card), &dev_id); 20294a71df50SFrank Blaschka memcpy(QETH_ULP_SETUP_CUA(iob->data), &dev_id.devno, 2); 20304a71df50SFrank Blaschka temp = (card->info.cula << 8) + card->info.unit_addr2; 20314a71df50SFrank Blaschka memcpy(QETH_ULP_SETUP_REAL_DEVADDR(iob->data), &temp, 2); 20324a71df50SFrank Blaschka rc = qeth_send_control_data(card, ULP_SETUP_SIZE, iob, 20334a71df50SFrank Blaschka qeth_ulp_setup_cb, NULL); 20344a71df50SFrank Blaschka return rc; 20354a71df50SFrank Blaschka } 20364a71df50SFrank Blaschka 20374a71df50SFrank Blaschka static int qeth_alloc_qdio_buffers(struct qeth_card *card) 20384a71df50SFrank Blaschka { 20394a71df50SFrank Blaschka int i, j; 20404a71df50SFrank Blaschka 2041d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "allcqdbf"); 20424a71df50SFrank Blaschka 20434a71df50SFrank Blaschka if (atomic_cmpxchg(&card->qdio.state, QETH_QDIO_UNINITIALIZED, 20444a71df50SFrank Blaschka QETH_QDIO_ALLOCATED) != QETH_QDIO_UNINITIALIZED) 20454a71df50SFrank Blaschka return 0; 20464a71df50SFrank Blaschka 20474a71df50SFrank Blaschka card->qdio.in_q = kmalloc(sizeof(struct qeth_qdio_q), 2048508b3c4fSUrsula Braun GFP_KERNEL); 20494a71df50SFrank Blaschka if (!card->qdio.in_q) 20504a71df50SFrank Blaschka goto out_nomem; 2051d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "inq"); 2052d11ba0c4SPeter Tiedemann QETH_DBF_HEX(SETUP, 2, &card->qdio.in_q, sizeof(void *)); 20534a71df50SFrank Blaschka memset(card->qdio.in_q, 0, sizeof(struct qeth_qdio_q)); 20544a71df50SFrank Blaschka /* give inbound qeth_qdio_buffers their qdio_buffers */ 20554a71df50SFrank Blaschka for (i = 0; i < QDIO_MAX_BUFFERS_PER_Q; ++i) 20564a71df50SFrank Blaschka card->qdio.in_q->bufs[i].buffer = 20574a71df50SFrank Blaschka &card->qdio.in_q->qdio_bufs[i]; 20584a71df50SFrank Blaschka /* inbound buffer pool */ 20594a71df50SFrank Blaschka if (qeth_alloc_buffer_pool(card)) 20604a71df50SFrank Blaschka goto out_freeinq; 20614a71df50SFrank Blaschka /* outbound */ 20624a71df50SFrank Blaschka card->qdio.out_qs = 20634a71df50SFrank Blaschka kmalloc(card->qdio.no_out_queues * 20644a71df50SFrank Blaschka sizeof(struct qeth_qdio_out_q *), GFP_KERNEL); 20654a71df50SFrank Blaschka if (!card->qdio.out_qs) 20664a71df50SFrank Blaschka goto out_freepool; 20674a71df50SFrank Blaschka for (i = 0; i < card->qdio.no_out_queues; ++i) { 20684a71df50SFrank Blaschka card->qdio.out_qs[i] = kmalloc(sizeof(struct qeth_qdio_out_q), 2069508b3c4fSUrsula Braun GFP_KERNEL); 20704a71df50SFrank Blaschka if (!card->qdio.out_qs[i]) 20714a71df50SFrank Blaschka goto out_freeoutq; 2072d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "outq %i", i); 2073d11ba0c4SPeter Tiedemann QETH_DBF_HEX(SETUP, 2, &card->qdio.out_qs[i], sizeof(void *)); 20744a71df50SFrank Blaschka memset(card->qdio.out_qs[i], 0, sizeof(struct qeth_qdio_out_q)); 20754a71df50SFrank Blaschka card->qdio.out_qs[i]->queue_no = i; 20764a71df50SFrank Blaschka /* give outbound qeth_qdio_buffers their qdio_buffers */ 20774a71df50SFrank Blaschka for (j = 0; j < QDIO_MAX_BUFFERS_PER_Q; ++j) { 20784a71df50SFrank Blaschka card->qdio.out_qs[i]->bufs[j].buffer = 20794a71df50SFrank Blaschka &card->qdio.out_qs[i]->qdio_bufs[j]; 20804a71df50SFrank Blaschka skb_queue_head_init(&card->qdio.out_qs[i]->bufs[j]. 20814a71df50SFrank Blaschka skb_list); 20824a71df50SFrank Blaschka lockdep_set_class( 20834a71df50SFrank Blaschka &card->qdio.out_qs[i]->bufs[j].skb_list.lock, 20844a71df50SFrank Blaschka &qdio_out_skb_queue_key); 20854a71df50SFrank Blaschka INIT_LIST_HEAD(&card->qdio.out_qs[i]->bufs[j].ctx_list); 20864a71df50SFrank Blaschka } 20874a71df50SFrank Blaschka } 20884a71df50SFrank Blaschka return 0; 20894a71df50SFrank Blaschka 20904a71df50SFrank Blaschka out_freeoutq: 20914a71df50SFrank Blaschka while (i > 0) 20924a71df50SFrank Blaschka kfree(card->qdio.out_qs[--i]); 20934a71df50SFrank Blaschka kfree(card->qdio.out_qs); 20944a71df50SFrank Blaschka card->qdio.out_qs = NULL; 20954a71df50SFrank Blaschka out_freepool: 20964a71df50SFrank Blaschka qeth_free_buffer_pool(card); 20974a71df50SFrank Blaschka out_freeinq: 20984a71df50SFrank Blaschka kfree(card->qdio.in_q); 20994a71df50SFrank Blaschka card->qdio.in_q = NULL; 21004a71df50SFrank Blaschka out_nomem: 21014a71df50SFrank Blaschka atomic_set(&card->qdio.state, QETH_QDIO_UNINITIALIZED); 21024a71df50SFrank Blaschka return -ENOMEM; 21034a71df50SFrank Blaschka } 21044a71df50SFrank Blaschka 21054a71df50SFrank Blaschka static void qeth_create_qib_param_field(struct qeth_card *card, 21064a71df50SFrank Blaschka char *param_field) 21074a71df50SFrank Blaschka { 21084a71df50SFrank Blaschka 21094a71df50SFrank Blaschka param_field[0] = _ascebc['P']; 21104a71df50SFrank Blaschka param_field[1] = _ascebc['C']; 21114a71df50SFrank Blaschka param_field[2] = _ascebc['I']; 21124a71df50SFrank Blaschka param_field[3] = _ascebc['T']; 21134a71df50SFrank Blaschka *((unsigned int *) (¶m_field[4])) = QETH_PCI_THRESHOLD_A(card); 21144a71df50SFrank Blaschka *((unsigned int *) (¶m_field[8])) = QETH_PCI_THRESHOLD_B(card); 21154a71df50SFrank Blaschka *((unsigned int *) (¶m_field[12])) = QETH_PCI_TIMER_VALUE(card); 21164a71df50SFrank Blaschka } 21174a71df50SFrank Blaschka 21184a71df50SFrank Blaschka static void qeth_create_qib_param_field_blkt(struct qeth_card *card, 21194a71df50SFrank Blaschka char *param_field) 21204a71df50SFrank Blaschka { 21214a71df50SFrank Blaschka param_field[16] = _ascebc['B']; 21224a71df50SFrank Blaschka param_field[17] = _ascebc['L']; 21234a71df50SFrank Blaschka param_field[18] = _ascebc['K']; 21244a71df50SFrank Blaschka param_field[19] = _ascebc['T']; 21254a71df50SFrank Blaschka *((unsigned int *) (¶m_field[20])) = card->info.blkt.time_total; 21264a71df50SFrank Blaschka *((unsigned int *) (¶m_field[24])) = card->info.blkt.inter_packet; 21274a71df50SFrank Blaschka *((unsigned int *) (¶m_field[28])) = 21284a71df50SFrank Blaschka card->info.blkt.inter_packet_jumbo; 21294a71df50SFrank Blaschka } 21304a71df50SFrank Blaschka 21314a71df50SFrank Blaschka static int qeth_qdio_activate(struct qeth_card *card) 21324a71df50SFrank Blaschka { 2133d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 3, "qdioact"); 2134779e6e1cSJan Glauber return qdio_activate(CARD_DDEV(card)); 21354a71df50SFrank Blaschka } 21364a71df50SFrank Blaschka 21374a71df50SFrank Blaschka static int qeth_dm_act(struct qeth_card *card) 21384a71df50SFrank Blaschka { 21394a71df50SFrank Blaschka int rc; 21404a71df50SFrank Blaschka struct qeth_cmd_buffer *iob; 21414a71df50SFrank Blaschka 2142d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "dmact"); 21434a71df50SFrank Blaschka 21444a71df50SFrank Blaschka iob = qeth_wait_for_buffer(&card->write); 21454a71df50SFrank Blaschka memcpy(iob->data, DM_ACT, DM_ACT_SIZE); 21464a71df50SFrank Blaschka 21474a71df50SFrank Blaschka memcpy(QETH_DM_ACT_DEST_ADDR(iob->data), 21484a71df50SFrank Blaschka &card->token.cm_connection_r, QETH_MPC_TOKEN_LENGTH); 21494a71df50SFrank Blaschka memcpy(QETH_DM_ACT_CONNECTION_TOKEN(iob->data), 21504a71df50SFrank Blaschka &card->token.ulp_connection_r, QETH_MPC_TOKEN_LENGTH); 21514a71df50SFrank Blaschka rc = qeth_send_control_data(card, DM_ACT_SIZE, iob, NULL, NULL); 21524a71df50SFrank Blaschka return rc; 21534a71df50SFrank Blaschka } 21544a71df50SFrank Blaschka 21554a71df50SFrank Blaschka static int qeth_mpc_initialize(struct qeth_card *card) 21564a71df50SFrank Blaschka { 21574a71df50SFrank Blaschka int rc; 21584a71df50SFrank Blaschka 2159d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "mpcinit"); 21604a71df50SFrank Blaschka 21614a71df50SFrank Blaschka rc = qeth_issue_next_read(card); 21624a71df50SFrank Blaschka if (rc) { 2163d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "1err%d", rc); 21644a71df50SFrank Blaschka return rc; 21654a71df50SFrank Blaschka } 21664a71df50SFrank Blaschka rc = qeth_cm_enable(card); 21674a71df50SFrank Blaschka if (rc) { 2168d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "2err%d", rc); 21694a71df50SFrank Blaschka goto out_qdio; 21704a71df50SFrank Blaschka } 21714a71df50SFrank Blaschka rc = qeth_cm_setup(card); 21724a71df50SFrank Blaschka if (rc) { 2173d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "3err%d", rc); 21744a71df50SFrank Blaschka goto out_qdio; 21754a71df50SFrank Blaschka } 21764a71df50SFrank Blaschka rc = qeth_ulp_enable(card); 21774a71df50SFrank Blaschka if (rc) { 2178d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "4err%d", rc); 21794a71df50SFrank Blaschka goto out_qdio; 21804a71df50SFrank Blaschka } 21814a71df50SFrank Blaschka rc = qeth_ulp_setup(card); 21824a71df50SFrank Blaschka if (rc) { 2183d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "5err%d", rc); 21844a71df50SFrank Blaschka goto out_qdio; 21854a71df50SFrank Blaschka } 21864a71df50SFrank Blaschka rc = qeth_alloc_qdio_buffers(card); 21874a71df50SFrank Blaschka if (rc) { 2188d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "5err%d", rc); 21894a71df50SFrank Blaschka goto out_qdio; 21904a71df50SFrank Blaschka } 21914a71df50SFrank Blaschka rc = qeth_qdio_establish(card); 21924a71df50SFrank Blaschka if (rc) { 2193d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "6err%d", rc); 21944a71df50SFrank Blaschka qeth_free_qdio_buffers(card); 21954a71df50SFrank Blaschka goto out_qdio; 21964a71df50SFrank Blaschka } 21974a71df50SFrank Blaschka rc = qeth_qdio_activate(card); 21984a71df50SFrank Blaschka if (rc) { 2199d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "7err%d", rc); 22004a71df50SFrank Blaschka goto out_qdio; 22014a71df50SFrank Blaschka } 22024a71df50SFrank Blaschka rc = qeth_dm_act(card); 22034a71df50SFrank Blaschka if (rc) { 2204d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "8err%d", rc); 22054a71df50SFrank Blaschka goto out_qdio; 22064a71df50SFrank Blaschka } 22074a71df50SFrank Blaschka 22084a71df50SFrank Blaschka return 0; 22094a71df50SFrank Blaschka out_qdio: 22104a71df50SFrank Blaschka qeth_qdio_clear_card(card, card->info.type != QETH_CARD_TYPE_IQD); 22114a71df50SFrank Blaschka return rc; 22124a71df50SFrank Blaschka } 22134a71df50SFrank Blaschka 22144a71df50SFrank Blaschka static void qeth_print_status_with_portname(struct qeth_card *card) 22154a71df50SFrank Blaschka { 22164a71df50SFrank Blaschka char dbf_text[15]; 22174a71df50SFrank Blaschka int i; 22184a71df50SFrank Blaschka 22194a71df50SFrank Blaschka sprintf(dbf_text, "%s", card->info.portname + 1); 22204a71df50SFrank Blaschka for (i = 0; i < 8; i++) 22214a71df50SFrank Blaschka dbf_text[i] = 22224a71df50SFrank Blaschka (char) _ebcasc[(__u8) dbf_text[i]]; 22234a71df50SFrank Blaschka dbf_text[8] = 0; 222474eacdb9SFrank Blaschka dev_info(&card->gdev->dev, "Device is a%s card%s%s%s\n" 22254a71df50SFrank Blaschka "with link type %s (portname: %s)\n", 22264a71df50SFrank Blaschka qeth_get_cardname(card), 22274a71df50SFrank Blaschka (card->info.mcl_level[0]) ? " (level: " : "", 22284a71df50SFrank Blaschka (card->info.mcl_level[0]) ? card->info.mcl_level : "", 22294a71df50SFrank Blaschka (card->info.mcl_level[0]) ? ")" : "", 22304a71df50SFrank Blaschka qeth_get_cardname_short(card), 22314a71df50SFrank Blaschka dbf_text); 22324a71df50SFrank Blaschka 22334a71df50SFrank Blaschka } 22344a71df50SFrank Blaschka 22354a71df50SFrank Blaschka static void qeth_print_status_no_portname(struct qeth_card *card) 22364a71df50SFrank Blaschka { 22374a71df50SFrank Blaschka if (card->info.portname[0]) 223874eacdb9SFrank Blaschka dev_info(&card->gdev->dev, "Device is a%s " 22394a71df50SFrank Blaschka "card%s%s%s\nwith link type %s " 22404a71df50SFrank Blaschka "(no portname needed by interface).\n", 22414a71df50SFrank Blaschka qeth_get_cardname(card), 22424a71df50SFrank Blaschka (card->info.mcl_level[0]) ? " (level: " : "", 22434a71df50SFrank Blaschka (card->info.mcl_level[0]) ? card->info.mcl_level : "", 22444a71df50SFrank Blaschka (card->info.mcl_level[0]) ? ")" : "", 22454a71df50SFrank Blaschka qeth_get_cardname_short(card)); 22464a71df50SFrank Blaschka else 224774eacdb9SFrank Blaschka dev_info(&card->gdev->dev, "Device is a%s " 22484a71df50SFrank Blaschka "card%s%s%s\nwith link type %s.\n", 22494a71df50SFrank Blaschka qeth_get_cardname(card), 22504a71df50SFrank Blaschka (card->info.mcl_level[0]) ? " (level: " : "", 22514a71df50SFrank Blaschka (card->info.mcl_level[0]) ? card->info.mcl_level : "", 22524a71df50SFrank Blaschka (card->info.mcl_level[0]) ? ")" : "", 22534a71df50SFrank Blaschka qeth_get_cardname_short(card)); 22544a71df50SFrank Blaschka } 22554a71df50SFrank Blaschka 22564a71df50SFrank Blaschka void qeth_print_status_message(struct qeth_card *card) 22574a71df50SFrank Blaschka { 22584a71df50SFrank Blaschka switch (card->info.type) { 22594a71df50SFrank Blaschka case QETH_CARD_TYPE_OSAE: 22604a71df50SFrank Blaschka /* VM will use a non-zero first character 22614a71df50SFrank Blaschka * to indicate a HiperSockets like reporting 22624a71df50SFrank Blaschka * of the level OSA sets the first character to zero 22634a71df50SFrank Blaschka * */ 22644a71df50SFrank Blaschka if (!card->info.mcl_level[0]) { 22654a71df50SFrank Blaschka sprintf(card->info.mcl_level, "%02x%02x", 22664a71df50SFrank Blaschka card->info.mcl_level[2], 22674a71df50SFrank Blaschka card->info.mcl_level[3]); 22684a71df50SFrank Blaschka 22694a71df50SFrank Blaschka card->info.mcl_level[QETH_MCL_LENGTH] = 0; 22704a71df50SFrank Blaschka break; 22714a71df50SFrank Blaschka } 22724a71df50SFrank Blaschka /* fallthrough */ 22734a71df50SFrank Blaschka case QETH_CARD_TYPE_IQD: 2274906f1f07SKlaus-Dieter Wacker if ((card->info.guestlan) || 2275906f1f07SKlaus-Dieter Wacker (card->info.mcl_level[0] & 0x80)) { 22764a71df50SFrank Blaschka card->info.mcl_level[0] = (char) _ebcasc[(__u8) 22774a71df50SFrank Blaschka card->info.mcl_level[0]]; 22784a71df50SFrank Blaschka card->info.mcl_level[1] = (char) _ebcasc[(__u8) 22794a71df50SFrank Blaschka card->info.mcl_level[1]]; 22804a71df50SFrank Blaschka card->info.mcl_level[2] = (char) _ebcasc[(__u8) 22814a71df50SFrank Blaschka card->info.mcl_level[2]]; 22824a71df50SFrank Blaschka card->info.mcl_level[3] = (char) _ebcasc[(__u8) 22834a71df50SFrank Blaschka card->info.mcl_level[3]]; 22844a71df50SFrank Blaschka card->info.mcl_level[QETH_MCL_LENGTH] = 0; 22854a71df50SFrank Blaschka } 22864a71df50SFrank Blaschka break; 22874a71df50SFrank Blaschka default: 22884a71df50SFrank Blaschka memset(&card->info.mcl_level[0], 0, QETH_MCL_LENGTH + 1); 22894a71df50SFrank Blaschka } 22904a71df50SFrank Blaschka if (card->info.portname_required) 22914a71df50SFrank Blaschka qeth_print_status_with_portname(card); 22924a71df50SFrank Blaschka else 22934a71df50SFrank Blaschka qeth_print_status_no_portname(card); 22944a71df50SFrank Blaschka } 22954a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_print_status_message); 22964a71df50SFrank Blaschka 22974a71df50SFrank Blaschka static void qeth_initialize_working_pool_list(struct qeth_card *card) 22984a71df50SFrank Blaschka { 22994a71df50SFrank Blaschka struct qeth_buffer_pool_entry *entry; 23004a71df50SFrank Blaschka 2301d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 5, "inwrklst"); 23024a71df50SFrank Blaschka 23034a71df50SFrank Blaschka list_for_each_entry(entry, 23044a71df50SFrank Blaschka &card->qdio.init_pool.entry_list, init_list) { 23054a71df50SFrank Blaschka qeth_put_buffer_pool_entry(card, entry); 23064a71df50SFrank Blaschka } 23074a71df50SFrank Blaschka } 23084a71df50SFrank Blaschka 23094a71df50SFrank Blaschka static inline struct qeth_buffer_pool_entry *qeth_find_free_buffer_pool_entry( 23104a71df50SFrank Blaschka struct qeth_card *card) 23114a71df50SFrank Blaschka { 23124a71df50SFrank Blaschka struct list_head *plh; 23134a71df50SFrank Blaschka struct qeth_buffer_pool_entry *entry; 23144a71df50SFrank Blaschka int i, free; 23154a71df50SFrank Blaschka struct page *page; 23164a71df50SFrank Blaschka 23174a71df50SFrank Blaschka if (list_empty(&card->qdio.in_buf_pool.entry_list)) 23184a71df50SFrank Blaschka return NULL; 23194a71df50SFrank Blaschka 23204a71df50SFrank Blaschka list_for_each(plh, &card->qdio.in_buf_pool.entry_list) { 23214a71df50SFrank Blaschka entry = list_entry(plh, struct qeth_buffer_pool_entry, list); 23224a71df50SFrank Blaschka free = 1; 23234a71df50SFrank Blaschka for (i = 0; i < QETH_MAX_BUFFER_ELEMENTS(card); ++i) { 23244a71df50SFrank Blaschka if (page_count(virt_to_page(entry->elements[i])) > 1) { 23254a71df50SFrank Blaschka free = 0; 23264a71df50SFrank Blaschka break; 23274a71df50SFrank Blaschka } 23284a71df50SFrank Blaschka } 23294a71df50SFrank Blaschka if (free) { 23304a71df50SFrank Blaschka list_del_init(&entry->list); 23314a71df50SFrank Blaschka return entry; 23324a71df50SFrank Blaschka } 23334a71df50SFrank Blaschka } 23344a71df50SFrank Blaschka 23354a71df50SFrank Blaschka /* no free buffer in pool so take first one and swap pages */ 23364a71df50SFrank Blaschka entry = list_entry(card->qdio.in_buf_pool.entry_list.next, 23374a71df50SFrank Blaschka struct qeth_buffer_pool_entry, list); 23384a71df50SFrank Blaschka for (i = 0; i < QETH_MAX_BUFFER_ELEMENTS(card); ++i) { 23394a71df50SFrank Blaschka if (page_count(virt_to_page(entry->elements[i])) > 1) { 2340508b3c4fSUrsula Braun page = alloc_page(GFP_ATOMIC); 23414a71df50SFrank Blaschka if (!page) { 23424a71df50SFrank Blaschka return NULL; 23434a71df50SFrank Blaschka } else { 23444a71df50SFrank Blaschka free_page((unsigned long)entry->elements[i]); 23454a71df50SFrank Blaschka entry->elements[i] = page_address(page); 23464a71df50SFrank Blaschka if (card->options.performance_stats) 23474a71df50SFrank Blaschka card->perf_stats.sg_alloc_page_rx++; 23484a71df50SFrank Blaschka } 23494a71df50SFrank Blaschka } 23504a71df50SFrank Blaschka } 23514a71df50SFrank Blaschka list_del_init(&entry->list); 23524a71df50SFrank Blaschka return entry; 23534a71df50SFrank Blaschka } 23544a71df50SFrank Blaschka 23554a71df50SFrank Blaschka static int qeth_init_input_buffer(struct qeth_card *card, 23564a71df50SFrank Blaschka struct qeth_qdio_buffer *buf) 23574a71df50SFrank Blaschka { 23584a71df50SFrank Blaschka struct qeth_buffer_pool_entry *pool_entry; 23594a71df50SFrank Blaschka int i; 23604a71df50SFrank Blaschka 23614a71df50SFrank Blaschka pool_entry = qeth_find_free_buffer_pool_entry(card); 23624a71df50SFrank Blaschka if (!pool_entry) 23634a71df50SFrank Blaschka return 1; 23644a71df50SFrank Blaschka 23654a71df50SFrank Blaschka /* 23664a71df50SFrank Blaschka * since the buffer is accessed only from the input_tasklet 23674a71df50SFrank Blaschka * there shouldn't be a need to synchronize; also, since we use 23684a71df50SFrank Blaschka * the QETH_IN_BUF_REQUEUE_THRESHOLD we should never run out off 23694a71df50SFrank Blaschka * buffers 23704a71df50SFrank Blaschka */ 23714a71df50SFrank Blaschka 23724a71df50SFrank Blaschka buf->pool_entry = pool_entry; 23734a71df50SFrank Blaschka for (i = 0; i < QETH_MAX_BUFFER_ELEMENTS(card); ++i) { 23744a71df50SFrank Blaschka buf->buffer->element[i].length = PAGE_SIZE; 23754a71df50SFrank Blaschka buf->buffer->element[i].addr = pool_entry->elements[i]; 23764a71df50SFrank Blaschka if (i == QETH_MAX_BUFFER_ELEMENTS(card) - 1) 23774a71df50SFrank Blaschka buf->buffer->element[i].flags = SBAL_FLAGS_LAST_ENTRY; 23784a71df50SFrank Blaschka else 23794a71df50SFrank Blaschka buf->buffer->element[i].flags = 0; 23804a71df50SFrank Blaschka } 23814a71df50SFrank Blaschka return 0; 23824a71df50SFrank Blaschka } 23834a71df50SFrank Blaschka 23844a71df50SFrank Blaschka int qeth_init_qdio_queues(struct qeth_card *card) 23854a71df50SFrank Blaschka { 23864a71df50SFrank Blaschka int i, j; 23874a71df50SFrank Blaschka int rc; 23884a71df50SFrank Blaschka 2389d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "initqdqs"); 23904a71df50SFrank Blaschka 23914a71df50SFrank Blaschka /* inbound queue */ 23924a71df50SFrank Blaschka memset(card->qdio.in_q->qdio_bufs, 0, 23934a71df50SFrank Blaschka QDIO_MAX_BUFFERS_PER_Q * sizeof(struct qdio_buffer)); 23944a71df50SFrank Blaschka qeth_initialize_working_pool_list(card); 23954a71df50SFrank Blaschka /*give only as many buffers to hardware as we have buffer pool entries*/ 23964a71df50SFrank Blaschka for (i = 0; i < card->qdio.in_buf_pool.buf_count - 1; ++i) 23974a71df50SFrank Blaschka qeth_init_input_buffer(card, &card->qdio.in_q->bufs[i]); 23984a71df50SFrank Blaschka card->qdio.in_q->next_buf_to_init = 23994a71df50SFrank Blaschka card->qdio.in_buf_pool.buf_count - 1; 24004a71df50SFrank Blaschka rc = do_QDIO(CARD_DDEV(card), QDIO_FLAG_SYNC_INPUT, 0, 0, 2401779e6e1cSJan Glauber card->qdio.in_buf_pool.buf_count - 1); 24024a71df50SFrank Blaschka if (rc) { 2403d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "1err%d", rc); 24044a71df50SFrank Blaschka return rc; 24054a71df50SFrank Blaschka } 24064a71df50SFrank Blaschka /* outbound queue */ 24074a71df50SFrank Blaschka for (i = 0; i < card->qdio.no_out_queues; ++i) { 24084a71df50SFrank Blaschka memset(card->qdio.out_qs[i]->qdio_bufs, 0, 24094a71df50SFrank Blaschka QDIO_MAX_BUFFERS_PER_Q * sizeof(struct qdio_buffer)); 24104a71df50SFrank Blaschka for (j = 0; j < QDIO_MAX_BUFFERS_PER_Q; ++j) { 24114a71df50SFrank Blaschka qeth_clear_output_buffer(card->qdio.out_qs[i], 24124a71df50SFrank Blaschka &card->qdio.out_qs[i]->bufs[j]); 24134a71df50SFrank Blaschka } 24144a71df50SFrank Blaschka card->qdio.out_qs[i]->card = card; 24154a71df50SFrank Blaschka card->qdio.out_qs[i]->next_buf_to_fill = 0; 24164a71df50SFrank Blaschka card->qdio.out_qs[i]->do_pack = 0; 24174a71df50SFrank Blaschka atomic_set(&card->qdio.out_qs[i]->used_buffers, 0); 24184a71df50SFrank Blaschka atomic_set(&card->qdio.out_qs[i]->set_pci_flags_count, 0); 24194a71df50SFrank Blaschka atomic_set(&card->qdio.out_qs[i]->state, 24204a71df50SFrank Blaschka QETH_OUT_Q_UNLOCKED); 24214a71df50SFrank Blaschka } 24224a71df50SFrank Blaschka return 0; 24234a71df50SFrank Blaschka } 24244a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_init_qdio_queues); 24254a71df50SFrank Blaschka 24264a71df50SFrank Blaschka static inline __u8 qeth_get_ipa_adp_type(enum qeth_link_types link_type) 24274a71df50SFrank Blaschka { 24284a71df50SFrank Blaschka switch (link_type) { 24294a71df50SFrank Blaschka case QETH_LINK_TYPE_HSTR: 24304a71df50SFrank Blaschka return 2; 24314a71df50SFrank Blaschka default: 24324a71df50SFrank Blaschka return 1; 24334a71df50SFrank Blaschka } 24344a71df50SFrank Blaschka } 24354a71df50SFrank Blaschka 24364a71df50SFrank Blaschka static void qeth_fill_ipacmd_header(struct qeth_card *card, 24374a71df50SFrank Blaschka struct qeth_ipa_cmd *cmd, __u8 command, 24384a71df50SFrank Blaschka enum qeth_prot_versions prot) 24394a71df50SFrank Blaschka { 24404a71df50SFrank Blaschka memset(cmd, 0, sizeof(struct qeth_ipa_cmd)); 24414a71df50SFrank Blaschka cmd->hdr.command = command; 24424a71df50SFrank Blaschka cmd->hdr.initiator = IPA_CMD_INITIATOR_HOST; 24434a71df50SFrank Blaschka cmd->hdr.seqno = card->seqno.ipa; 24444a71df50SFrank Blaschka cmd->hdr.adapter_type = qeth_get_ipa_adp_type(card->info.link_type); 24454a71df50SFrank Blaschka cmd->hdr.rel_adapter_no = (__u8) card->info.portno; 24464a71df50SFrank Blaschka if (card->options.layer2) 24474a71df50SFrank Blaschka cmd->hdr.prim_version_no = 2; 24484a71df50SFrank Blaschka else 24494a71df50SFrank Blaschka cmd->hdr.prim_version_no = 1; 24504a71df50SFrank Blaschka cmd->hdr.param_count = 1; 24514a71df50SFrank Blaschka cmd->hdr.prot_version = prot; 24524a71df50SFrank Blaschka cmd->hdr.ipa_supported = 0; 24534a71df50SFrank Blaschka cmd->hdr.ipa_enabled = 0; 24544a71df50SFrank Blaschka } 24554a71df50SFrank Blaschka 24564a71df50SFrank Blaschka struct qeth_cmd_buffer *qeth_get_ipacmd_buffer(struct qeth_card *card, 24574a71df50SFrank Blaschka enum qeth_ipa_cmds ipacmd, enum qeth_prot_versions prot) 24584a71df50SFrank Blaschka { 24594a71df50SFrank Blaschka struct qeth_cmd_buffer *iob; 24604a71df50SFrank Blaschka struct qeth_ipa_cmd *cmd; 24614a71df50SFrank Blaschka 24624a71df50SFrank Blaschka iob = qeth_wait_for_buffer(&card->write); 24634a71df50SFrank Blaschka cmd = (struct qeth_ipa_cmd *)(iob->data+IPA_PDU_HEADER_SIZE); 24644a71df50SFrank Blaschka qeth_fill_ipacmd_header(card, cmd, ipacmd, prot); 24654a71df50SFrank Blaschka 24664a71df50SFrank Blaschka return iob; 24674a71df50SFrank Blaschka } 24684a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_get_ipacmd_buffer); 24694a71df50SFrank Blaschka 24704a71df50SFrank Blaschka void qeth_prepare_ipa_cmd(struct qeth_card *card, struct qeth_cmd_buffer *iob, 24714a71df50SFrank Blaschka char prot_type) 24724a71df50SFrank Blaschka { 24734a71df50SFrank Blaschka memcpy(iob->data, IPA_PDU_HEADER, IPA_PDU_HEADER_SIZE); 24744a71df50SFrank Blaschka memcpy(QETH_IPA_CMD_PROT_TYPE(iob->data), &prot_type, 1); 24754a71df50SFrank Blaschka memcpy(QETH_IPA_CMD_DEST_ADDR(iob->data), 24764a71df50SFrank Blaschka &card->token.ulp_connection_r, QETH_MPC_TOKEN_LENGTH); 24774a71df50SFrank Blaschka } 24784a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_prepare_ipa_cmd); 24794a71df50SFrank Blaschka 24804a71df50SFrank Blaschka int qeth_send_ipa_cmd(struct qeth_card *card, struct qeth_cmd_buffer *iob, 24814a71df50SFrank Blaschka int (*reply_cb)(struct qeth_card *, struct qeth_reply*, 24824a71df50SFrank Blaschka unsigned long), 24834a71df50SFrank Blaschka void *reply_param) 24844a71df50SFrank Blaschka { 24854a71df50SFrank Blaschka int rc; 24864a71df50SFrank Blaschka char prot_type; 24874a71df50SFrank Blaschka 2488d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 4, "sendipa"); 24894a71df50SFrank Blaschka 24904a71df50SFrank Blaschka if (card->options.layer2) 24914a71df50SFrank Blaschka if (card->info.type == QETH_CARD_TYPE_OSN) 24924a71df50SFrank Blaschka prot_type = QETH_PROT_OSN2; 24934a71df50SFrank Blaschka else 24944a71df50SFrank Blaschka prot_type = QETH_PROT_LAYER2; 24954a71df50SFrank Blaschka else 24964a71df50SFrank Blaschka prot_type = QETH_PROT_TCPIP; 24974a71df50SFrank Blaschka qeth_prepare_ipa_cmd(card, iob, prot_type); 2498d11ba0c4SPeter Tiedemann rc = qeth_send_control_data(card, IPA_CMD_LENGTH, 2499d11ba0c4SPeter Tiedemann iob, reply_cb, reply_param); 25004a71df50SFrank Blaschka return rc; 25014a71df50SFrank Blaschka } 25024a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_send_ipa_cmd); 25034a71df50SFrank Blaschka 25044a71df50SFrank Blaschka static int qeth_send_startstoplan(struct qeth_card *card, 25054a71df50SFrank Blaschka enum qeth_ipa_cmds ipacmd, enum qeth_prot_versions prot) 25064a71df50SFrank Blaschka { 25074a71df50SFrank Blaschka int rc; 25084a71df50SFrank Blaschka struct qeth_cmd_buffer *iob; 25094a71df50SFrank Blaschka 25104a71df50SFrank Blaschka iob = qeth_get_ipacmd_buffer(card, ipacmd, prot); 25114a71df50SFrank Blaschka rc = qeth_send_ipa_cmd(card, iob, NULL, NULL); 25124a71df50SFrank Blaschka 25134a71df50SFrank Blaschka return rc; 25144a71df50SFrank Blaschka } 25154a71df50SFrank Blaschka 25164a71df50SFrank Blaschka int qeth_send_startlan(struct qeth_card *card) 25174a71df50SFrank Blaschka { 25184a71df50SFrank Blaschka int rc; 25194a71df50SFrank Blaschka 2520d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "strtlan"); 25214a71df50SFrank Blaschka 25224a71df50SFrank Blaschka rc = qeth_send_startstoplan(card, IPA_CMD_STARTLAN, 0); 25234a71df50SFrank Blaschka return rc; 25244a71df50SFrank Blaschka } 25254a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_send_startlan); 25264a71df50SFrank Blaschka 25274a71df50SFrank Blaschka int qeth_send_stoplan(struct qeth_card *card) 25284a71df50SFrank Blaschka { 25294a71df50SFrank Blaschka int rc = 0; 25304a71df50SFrank Blaschka 25314a71df50SFrank Blaschka /* 25324a71df50SFrank Blaschka * TODO: according to the IPA format document page 14, 25334a71df50SFrank Blaschka * TCP/IP (we!) never issue a STOPLAN 25344a71df50SFrank Blaschka * is this right ?!? 25354a71df50SFrank Blaschka */ 2536d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "stoplan"); 25374a71df50SFrank Blaschka 25384a71df50SFrank Blaschka rc = qeth_send_startstoplan(card, IPA_CMD_STOPLAN, 0); 25394a71df50SFrank Blaschka return rc; 25404a71df50SFrank Blaschka } 25414a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_send_stoplan); 25424a71df50SFrank Blaschka 25434a71df50SFrank Blaschka int qeth_default_setadapterparms_cb(struct qeth_card *card, 25444a71df50SFrank Blaschka struct qeth_reply *reply, unsigned long data) 25454a71df50SFrank Blaschka { 25464a71df50SFrank Blaschka struct qeth_ipa_cmd *cmd; 25474a71df50SFrank Blaschka 2548d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 4, "defadpcb"); 25494a71df50SFrank Blaschka 25504a71df50SFrank Blaschka cmd = (struct qeth_ipa_cmd *) data; 25514a71df50SFrank Blaschka if (cmd->hdr.return_code == 0) 25524a71df50SFrank Blaschka cmd->hdr.return_code = 25534a71df50SFrank Blaschka cmd->data.setadapterparms.hdr.return_code; 25544a71df50SFrank Blaschka return 0; 25554a71df50SFrank Blaschka } 25564a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_default_setadapterparms_cb); 25574a71df50SFrank Blaschka 25584a71df50SFrank Blaschka static int qeth_query_setadapterparms_cb(struct qeth_card *card, 25594a71df50SFrank Blaschka struct qeth_reply *reply, unsigned long data) 25604a71df50SFrank Blaschka { 25614a71df50SFrank Blaschka struct qeth_ipa_cmd *cmd; 25624a71df50SFrank Blaschka 2563d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 3, "quyadpcb"); 25644a71df50SFrank Blaschka 25654a71df50SFrank Blaschka cmd = (struct qeth_ipa_cmd *) data; 25664a71df50SFrank Blaschka if (cmd->data.setadapterparms.data.query_cmds_supp.lan_type & 0x7f) 25674a71df50SFrank Blaschka card->info.link_type = 25684a71df50SFrank Blaschka cmd->data.setadapterparms.data.query_cmds_supp.lan_type; 25694a71df50SFrank Blaschka card->options.adp.supported_funcs = 25704a71df50SFrank Blaschka cmd->data.setadapterparms.data.query_cmds_supp.supported_cmds; 25714a71df50SFrank Blaschka return qeth_default_setadapterparms_cb(card, reply, (unsigned long)cmd); 25724a71df50SFrank Blaschka } 25734a71df50SFrank Blaschka 25744a71df50SFrank Blaschka struct qeth_cmd_buffer *qeth_get_adapter_cmd(struct qeth_card *card, 25754a71df50SFrank Blaschka __u32 command, __u32 cmdlen) 25764a71df50SFrank Blaschka { 25774a71df50SFrank Blaschka struct qeth_cmd_buffer *iob; 25784a71df50SFrank Blaschka struct qeth_ipa_cmd *cmd; 25794a71df50SFrank Blaschka 25804a71df50SFrank Blaschka iob = qeth_get_ipacmd_buffer(card, IPA_CMD_SETADAPTERPARMS, 25814a71df50SFrank Blaschka QETH_PROT_IPV4); 25824a71df50SFrank Blaschka cmd = (struct qeth_ipa_cmd *)(iob->data+IPA_PDU_HEADER_SIZE); 25834a71df50SFrank Blaschka cmd->data.setadapterparms.hdr.cmdlength = cmdlen; 25844a71df50SFrank Blaschka cmd->data.setadapterparms.hdr.command_code = command; 25854a71df50SFrank Blaschka cmd->data.setadapterparms.hdr.used_total = 1; 25864a71df50SFrank Blaschka cmd->data.setadapterparms.hdr.seq_no = 1; 25874a71df50SFrank Blaschka 25884a71df50SFrank Blaschka return iob; 25894a71df50SFrank Blaschka } 25904a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_get_adapter_cmd); 25914a71df50SFrank Blaschka 25924a71df50SFrank Blaschka int qeth_query_setadapterparms(struct qeth_card *card) 25934a71df50SFrank Blaschka { 25944a71df50SFrank Blaschka int rc; 25954a71df50SFrank Blaschka struct qeth_cmd_buffer *iob; 25964a71df50SFrank Blaschka 2597d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 3, "queryadp"); 25984a71df50SFrank Blaschka iob = qeth_get_adapter_cmd(card, IPA_SETADP_QUERY_COMMANDS_SUPPORTED, 25994a71df50SFrank Blaschka sizeof(struct qeth_ipacmd_setadpparms)); 26004a71df50SFrank Blaschka rc = qeth_send_ipa_cmd(card, iob, qeth_query_setadapterparms_cb, NULL); 26014a71df50SFrank Blaschka return rc; 26024a71df50SFrank Blaschka } 26034a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_query_setadapterparms); 26044a71df50SFrank Blaschka 26054a71df50SFrank Blaschka int qeth_check_qdio_errors(struct qdio_buffer *buf, unsigned int qdio_error, 2606779e6e1cSJan Glauber const char *dbftext) 26074a71df50SFrank Blaschka { 2608779e6e1cSJan Glauber if (qdio_error) { 2609d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 2, dbftext); 2610d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(QERR, 2, dbftext); 2611d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(QERR, 2, " F15=%02X", 26124a71df50SFrank Blaschka buf->element[15].flags & 0xff); 2613d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(QERR, 2, " F14=%02X", 26144a71df50SFrank Blaschka buf->element[14].flags & 0xff); 2615d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(QERR, 2, " qerr=%X", qdio_error); 26164a71df50SFrank Blaschka return 1; 26174a71df50SFrank Blaschka } 26184a71df50SFrank Blaschka return 0; 26194a71df50SFrank Blaschka } 26204a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_check_qdio_errors); 26214a71df50SFrank Blaschka 26224a71df50SFrank Blaschka void qeth_queue_input_buffer(struct qeth_card *card, int index) 26234a71df50SFrank Blaschka { 26244a71df50SFrank Blaschka struct qeth_qdio_q *queue = card->qdio.in_q; 26254a71df50SFrank Blaschka int count; 26264a71df50SFrank Blaschka int i; 26274a71df50SFrank Blaschka int rc; 26284a71df50SFrank Blaschka int newcount = 0; 26294a71df50SFrank Blaschka 26304a71df50SFrank Blaschka count = (index < queue->next_buf_to_init)? 26314a71df50SFrank Blaschka card->qdio.in_buf_pool.buf_count - 26324a71df50SFrank Blaschka (queue->next_buf_to_init - index) : 26334a71df50SFrank Blaschka card->qdio.in_buf_pool.buf_count - 26344a71df50SFrank Blaschka (queue->next_buf_to_init + QDIO_MAX_BUFFERS_PER_Q - index); 26354a71df50SFrank Blaschka /* only requeue at a certain threshold to avoid SIGAs */ 26364a71df50SFrank Blaschka if (count >= QETH_IN_BUF_REQUEUE_THRESHOLD(card)) { 26374a71df50SFrank Blaschka for (i = queue->next_buf_to_init; 26384a71df50SFrank Blaschka i < queue->next_buf_to_init + count; ++i) { 26394a71df50SFrank Blaschka if (qeth_init_input_buffer(card, 26404a71df50SFrank Blaschka &queue->bufs[i % QDIO_MAX_BUFFERS_PER_Q])) { 26414a71df50SFrank Blaschka break; 26424a71df50SFrank Blaschka } else { 26434a71df50SFrank Blaschka newcount++; 26444a71df50SFrank Blaschka } 26454a71df50SFrank Blaschka } 26464a71df50SFrank Blaschka 26474a71df50SFrank Blaschka if (newcount < count) { 26484a71df50SFrank Blaschka /* we are in memory shortage so we switch back to 26494a71df50SFrank Blaschka traditional skb allocation and drop packages */ 26504a71df50SFrank Blaschka atomic_set(&card->force_alloc_skb, 3); 26514a71df50SFrank Blaschka count = newcount; 26524a71df50SFrank Blaschka } else { 26534a71df50SFrank Blaschka atomic_add_unless(&card->force_alloc_skb, -1, 0); 26544a71df50SFrank Blaschka } 26554a71df50SFrank Blaschka 26564a71df50SFrank Blaschka /* 26574a71df50SFrank Blaschka * according to old code it should be avoided to requeue all 26584a71df50SFrank Blaschka * 128 buffers in order to benefit from PCI avoidance. 26594a71df50SFrank Blaschka * this function keeps at least one buffer (the buffer at 26604a71df50SFrank Blaschka * 'index') un-requeued -> this buffer is the first buffer that 26614a71df50SFrank Blaschka * will be requeued the next time 26624a71df50SFrank Blaschka */ 26634a71df50SFrank Blaschka if (card->options.performance_stats) { 26644a71df50SFrank Blaschka card->perf_stats.inbound_do_qdio_cnt++; 26654a71df50SFrank Blaschka card->perf_stats.inbound_do_qdio_start_time = 26664a71df50SFrank Blaschka qeth_get_micros(); 26674a71df50SFrank Blaschka } 2668779e6e1cSJan Glauber rc = do_QDIO(CARD_DDEV(card), QDIO_FLAG_SYNC_INPUT, 0, 2669779e6e1cSJan Glauber queue->next_buf_to_init, count); 26704a71df50SFrank Blaschka if (card->options.performance_stats) 26714a71df50SFrank Blaschka card->perf_stats.inbound_do_qdio_time += 26724a71df50SFrank Blaschka qeth_get_micros() - 26734a71df50SFrank Blaschka card->perf_stats.inbound_do_qdio_start_time; 26744a71df50SFrank Blaschka if (rc) { 267574eacdb9SFrank Blaschka dev_warn(&card->gdev->dev, 267674eacdb9SFrank Blaschka "QDIO reported an error, rc=%i\n", rc); 2677d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 2, "qinberr"); 2678d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(TRACE, 2, "%s", CARD_BUS_ID(card)); 26794a71df50SFrank Blaschka } 26804a71df50SFrank Blaschka queue->next_buf_to_init = (queue->next_buf_to_init + count) % 26814a71df50SFrank Blaschka QDIO_MAX_BUFFERS_PER_Q; 26824a71df50SFrank Blaschka } 26834a71df50SFrank Blaschka } 26844a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_queue_input_buffer); 26854a71df50SFrank Blaschka 26864a71df50SFrank Blaschka static int qeth_handle_send_error(struct qeth_card *card, 2687779e6e1cSJan Glauber struct qeth_qdio_out_buffer *buffer, unsigned int qdio_err) 26884a71df50SFrank Blaschka { 26894a71df50SFrank Blaschka int sbalf15 = buffer->buffer->element[15].flags & 0xff; 2690779e6e1cSJan Glauber int cc = qdio_err & 3; 26914a71df50SFrank Blaschka 2692d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 6, "hdsnderr"); 2693779e6e1cSJan Glauber qeth_check_qdio_errors(buffer->buffer, qdio_err, "qouterr"); 26944a71df50SFrank Blaschka switch (cc) { 26954a71df50SFrank Blaschka case 0: 26964a71df50SFrank Blaschka if (qdio_err) { 2697d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 1, "lnkfail"); 2698d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(TRACE, 1, "%s", CARD_BUS_ID(card)); 2699d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(TRACE, 1, "%04x %02x", 27004a71df50SFrank Blaschka (u16)qdio_err, (u8)sbalf15); 27014a71df50SFrank Blaschka return QETH_SEND_ERROR_LINK_FAILURE; 27024a71df50SFrank Blaschka } 27034a71df50SFrank Blaschka return QETH_SEND_ERROR_NONE; 27044a71df50SFrank Blaschka case 2: 2705779e6e1cSJan Glauber if (qdio_err & QDIO_ERROR_SIGA_BUSY) { 2706d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 1, "SIGAcc2B"); 2707d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(TRACE, 1, "%s", CARD_BUS_ID(card)); 27084a71df50SFrank Blaschka return QETH_SEND_ERROR_KICK_IT; 27094a71df50SFrank Blaschka } 27104a71df50SFrank Blaschka if ((sbalf15 >= 15) && (sbalf15 <= 31)) 27114a71df50SFrank Blaschka return QETH_SEND_ERROR_RETRY; 27124a71df50SFrank Blaschka return QETH_SEND_ERROR_LINK_FAILURE; 27134a71df50SFrank Blaschka /* look at qdio_error and sbalf 15 */ 27144a71df50SFrank Blaschka case 1: 2715d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 1, "SIGAcc1"); 2716d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(TRACE, 1, "%s", CARD_BUS_ID(card)); 27174a71df50SFrank Blaschka return QETH_SEND_ERROR_LINK_FAILURE; 27184a71df50SFrank Blaschka case 3: 27194a71df50SFrank Blaschka default: 2720d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 1, "SIGAcc3"); 2721d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(TRACE, 1, "%s", CARD_BUS_ID(card)); 27224a71df50SFrank Blaschka return QETH_SEND_ERROR_KICK_IT; 27234a71df50SFrank Blaschka } 27244a71df50SFrank Blaschka } 27254a71df50SFrank Blaschka 27264a71df50SFrank Blaschka /* 27274a71df50SFrank Blaschka * Switched to packing state if the number of used buffers on a queue 27284a71df50SFrank Blaschka * reaches a certain limit. 27294a71df50SFrank Blaschka */ 27304a71df50SFrank Blaschka static void qeth_switch_to_packing_if_needed(struct qeth_qdio_out_q *queue) 27314a71df50SFrank Blaschka { 27324a71df50SFrank Blaschka if (!queue->do_pack) { 27334a71df50SFrank Blaschka if (atomic_read(&queue->used_buffers) 27344a71df50SFrank Blaschka >= QETH_HIGH_WATERMARK_PACK){ 27354a71df50SFrank Blaschka /* switch non-PACKING -> PACKING */ 2736d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 6, "np->pack"); 27374a71df50SFrank Blaschka if (queue->card->options.performance_stats) 27384a71df50SFrank Blaschka queue->card->perf_stats.sc_dp_p++; 27394a71df50SFrank Blaschka queue->do_pack = 1; 27404a71df50SFrank Blaschka } 27414a71df50SFrank Blaschka } 27424a71df50SFrank Blaschka } 27434a71df50SFrank Blaschka 27444a71df50SFrank Blaschka /* 27454a71df50SFrank Blaschka * Switches from packing to non-packing mode. If there is a packing 27464a71df50SFrank Blaschka * buffer on the queue this buffer will be prepared to be flushed. 27474a71df50SFrank Blaschka * In that case 1 is returned to inform the caller. If no buffer 27484a71df50SFrank Blaschka * has to be flushed, zero is returned. 27494a71df50SFrank Blaschka */ 27504a71df50SFrank Blaschka static int qeth_switch_to_nonpacking_if_needed(struct qeth_qdio_out_q *queue) 27514a71df50SFrank Blaschka { 27524a71df50SFrank Blaschka struct qeth_qdio_out_buffer *buffer; 27534a71df50SFrank Blaschka int flush_count = 0; 27544a71df50SFrank Blaschka 27554a71df50SFrank Blaschka if (queue->do_pack) { 27564a71df50SFrank Blaschka if (atomic_read(&queue->used_buffers) 27574a71df50SFrank Blaschka <= QETH_LOW_WATERMARK_PACK) { 27584a71df50SFrank Blaschka /* switch PACKING -> non-PACKING */ 2759d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 6, "pack->np"); 27604a71df50SFrank Blaschka if (queue->card->options.performance_stats) 27614a71df50SFrank Blaschka queue->card->perf_stats.sc_p_dp++; 27624a71df50SFrank Blaschka queue->do_pack = 0; 27634a71df50SFrank Blaschka /* flush packing buffers */ 27644a71df50SFrank Blaschka buffer = &queue->bufs[queue->next_buf_to_fill]; 27654a71df50SFrank Blaschka if ((atomic_read(&buffer->state) == 27664a71df50SFrank Blaschka QETH_QDIO_BUF_EMPTY) && 27674a71df50SFrank Blaschka (buffer->next_element_to_fill > 0)) { 27684a71df50SFrank Blaschka atomic_set(&buffer->state, 27694a71df50SFrank Blaschka QETH_QDIO_BUF_PRIMED); 27704a71df50SFrank Blaschka flush_count++; 27714a71df50SFrank Blaschka queue->next_buf_to_fill = 27724a71df50SFrank Blaschka (queue->next_buf_to_fill + 1) % 27734a71df50SFrank Blaschka QDIO_MAX_BUFFERS_PER_Q; 27744a71df50SFrank Blaschka } 27754a71df50SFrank Blaschka } 27764a71df50SFrank Blaschka } 27774a71df50SFrank Blaschka return flush_count; 27784a71df50SFrank Blaschka } 27794a71df50SFrank Blaschka 27804a71df50SFrank Blaschka /* 27814a71df50SFrank Blaschka * Called to flush a packing buffer if no more pci flags are on the queue. 27824a71df50SFrank Blaschka * Checks if there is a packing buffer and prepares it to be flushed. 27834a71df50SFrank Blaschka * In that case returns 1, otherwise zero. 27844a71df50SFrank Blaschka */ 27854a71df50SFrank Blaschka static int qeth_flush_buffers_on_no_pci(struct qeth_qdio_out_q *queue) 27864a71df50SFrank Blaschka { 27874a71df50SFrank Blaschka struct qeth_qdio_out_buffer *buffer; 27884a71df50SFrank Blaschka 27894a71df50SFrank Blaschka buffer = &queue->bufs[queue->next_buf_to_fill]; 27904a71df50SFrank Blaschka if ((atomic_read(&buffer->state) == QETH_QDIO_BUF_EMPTY) && 27914a71df50SFrank Blaschka (buffer->next_element_to_fill > 0)) { 27924a71df50SFrank Blaschka /* it's a packing buffer */ 27934a71df50SFrank Blaschka atomic_set(&buffer->state, QETH_QDIO_BUF_PRIMED); 27944a71df50SFrank Blaschka queue->next_buf_to_fill = 27954a71df50SFrank Blaschka (queue->next_buf_to_fill + 1) % QDIO_MAX_BUFFERS_PER_Q; 27964a71df50SFrank Blaschka return 1; 27974a71df50SFrank Blaschka } 27984a71df50SFrank Blaschka return 0; 27994a71df50SFrank Blaschka } 28004a71df50SFrank Blaschka 2801779e6e1cSJan Glauber static void qeth_flush_buffers(struct qeth_qdio_out_q *queue, int index, 2802779e6e1cSJan Glauber int count) 28034a71df50SFrank Blaschka { 28044a71df50SFrank Blaschka struct qeth_qdio_out_buffer *buf; 28054a71df50SFrank Blaschka int rc; 28064a71df50SFrank Blaschka int i; 28074a71df50SFrank Blaschka unsigned int qdio_flags; 28084a71df50SFrank Blaschka 28094a71df50SFrank Blaschka for (i = index; i < index + count; ++i) { 28104a71df50SFrank Blaschka buf = &queue->bufs[i % QDIO_MAX_BUFFERS_PER_Q]; 28114a71df50SFrank Blaschka buf->buffer->element[buf->next_element_to_fill - 1].flags |= 28124a71df50SFrank Blaschka SBAL_FLAGS_LAST_ENTRY; 28134a71df50SFrank Blaschka 28144a71df50SFrank Blaschka if (queue->card->info.type == QETH_CARD_TYPE_IQD) 28154a71df50SFrank Blaschka continue; 28164a71df50SFrank Blaschka 28174a71df50SFrank Blaschka if (!queue->do_pack) { 28184a71df50SFrank Blaschka if ((atomic_read(&queue->used_buffers) >= 28194a71df50SFrank Blaschka (QETH_HIGH_WATERMARK_PACK - 28204a71df50SFrank Blaschka QETH_WATERMARK_PACK_FUZZ)) && 28214a71df50SFrank Blaschka !atomic_read(&queue->set_pci_flags_count)) { 28224a71df50SFrank Blaschka /* it's likely that we'll go to packing 28234a71df50SFrank Blaschka * mode soon */ 28244a71df50SFrank Blaschka atomic_inc(&queue->set_pci_flags_count); 28254a71df50SFrank Blaschka buf->buffer->element[0].flags |= 0x40; 28264a71df50SFrank Blaschka } 28274a71df50SFrank Blaschka } else { 28284a71df50SFrank Blaschka if (!atomic_read(&queue->set_pci_flags_count)) { 28294a71df50SFrank Blaschka /* 28304a71df50SFrank Blaschka * there's no outstanding PCI any more, so we 28314a71df50SFrank Blaschka * have to request a PCI to be sure the the PCI 28324a71df50SFrank Blaschka * will wake at some time in the future then we 28334a71df50SFrank Blaschka * can flush packed buffers that might still be 28344a71df50SFrank Blaschka * hanging around, which can happen if no 28354a71df50SFrank Blaschka * further send was requested by the stack 28364a71df50SFrank Blaschka */ 28374a71df50SFrank Blaschka atomic_inc(&queue->set_pci_flags_count); 28384a71df50SFrank Blaschka buf->buffer->element[0].flags |= 0x40; 28394a71df50SFrank Blaschka } 28404a71df50SFrank Blaschka } 28414a71df50SFrank Blaschka } 28424a71df50SFrank Blaschka 28434a71df50SFrank Blaschka queue->card->dev->trans_start = jiffies; 28444a71df50SFrank Blaschka if (queue->card->options.performance_stats) { 28454a71df50SFrank Blaschka queue->card->perf_stats.outbound_do_qdio_cnt++; 28464a71df50SFrank Blaschka queue->card->perf_stats.outbound_do_qdio_start_time = 28474a71df50SFrank Blaschka qeth_get_micros(); 28484a71df50SFrank Blaschka } 28494a71df50SFrank Blaschka qdio_flags = QDIO_FLAG_SYNC_OUTPUT; 28504a71df50SFrank Blaschka if (atomic_read(&queue->set_pci_flags_count)) 28514a71df50SFrank Blaschka qdio_flags |= QDIO_FLAG_PCI_OUT; 28524a71df50SFrank Blaschka rc = do_QDIO(CARD_DDEV(queue->card), qdio_flags, 2853779e6e1cSJan Glauber queue->queue_no, index, count); 28544a71df50SFrank Blaschka if (queue->card->options.performance_stats) 28554a71df50SFrank Blaschka queue->card->perf_stats.outbound_do_qdio_time += 28564a71df50SFrank Blaschka qeth_get_micros() - 28574a71df50SFrank Blaschka queue->card->perf_stats.outbound_do_qdio_start_time; 28584a71df50SFrank Blaschka if (rc) { 2859d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 2, "flushbuf"); 2860d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(TRACE, 2, " err%d", rc); 2861d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(TRACE, 2, "%s", CARD_DDEV_ID(queue->card)); 28624a71df50SFrank Blaschka queue->card->stats.tx_errors += count; 28634a71df50SFrank Blaschka /* this must not happen under normal circumstances. if it 28644a71df50SFrank Blaschka * happens something is really wrong -> recover */ 28654a71df50SFrank Blaschka qeth_schedule_recovery(queue->card); 28664a71df50SFrank Blaschka return; 28674a71df50SFrank Blaschka } 28684a71df50SFrank Blaschka atomic_add(count, &queue->used_buffers); 28694a71df50SFrank Blaschka if (queue->card->options.performance_stats) 28704a71df50SFrank Blaschka queue->card->perf_stats.bufs_sent += count; 28714a71df50SFrank Blaschka } 28724a71df50SFrank Blaschka 28734a71df50SFrank Blaschka static void qeth_check_outbound_queue(struct qeth_qdio_out_q *queue) 28744a71df50SFrank Blaschka { 28754a71df50SFrank Blaschka int index; 28764a71df50SFrank Blaschka int flush_cnt = 0; 28774a71df50SFrank Blaschka int q_was_packing = 0; 28784a71df50SFrank Blaschka 28794a71df50SFrank Blaschka /* 28804a71df50SFrank Blaschka * check if weed have to switch to non-packing mode or if 28814a71df50SFrank Blaschka * we have to get a pci flag out on the queue 28824a71df50SFrank Blaschka */ 28834a71df50SFrank Blaschka if ((atomic_read(&queue->used_buffers) <= QETH_LOW_WATERMARK_PACK) || 28844a71df50SFrank Blaschka !atomic_read(&queue->set_pci_flags_count)) { 28854a71df50SFrank Blaschka if (atomic_xchg(&queue->state, QETH_OUT_Q_LOCKED_FLUSH) == 28864a71df50SFrank Blaschka QETH_OUT_Q_UNLOCKED) { 28874a71df50SFrank Blaschka /* 28884a71df50SFrank Blaschka * If we get in here, there was no action in 28894a71df50SFrank Blaschka * do_send_packet. So, we check if there is a 28904a71df50SFrank Blaschka * packing buffer to be flushed here. 28914a71df50SFrank Blaschka */ 28924a71df50SFrank Blaschka netif_stop_queue(queue->card->dev); 28934a71df50SFrank Blaschka index = queue->next_buf_to_fill; 28944a71df50SFrank Blaschka q_was_packing = queue->do_pack; 28954a71df50SFrank Blaschka /* queue->do_pack may change */ 28964a71df50SFrank Blaschka barrier(); 28974a71df50SFrank Blaschka flush_cnt += qeth_switch_to_nonpacking_if_needed(queue); 28984a71df50SFrank Blaschka if (!flush_cnt && 28994a71df50SFrank Blaschka !atomic_read(&queue->set_pci_flags_count)) 29004a71df50SFrank Blaschka flush_cnt += 29014a71df50SFrank Blaschka qeth_flush_buffers_on_no_pci(queue); 29024a71df50SFrank Blaschka if (queue->card->options.performance_stats && 29034a71df50SFrank Blaschka q_was_packing) 29044a71df50SFrank Blaschka queue->card->perf_stats.bufs_sent_pack += 29054a71df50SFrank Blaschka flush_cnt; 29064a71df50SFrank Blaschka if (flush_cnt) 2907779e6e1cSJan Glauber qeth_flush_buffers(queue, index, flush_cnt); 29084a71df50SFrank Blaschka atomic_set(&queue->state, QETH_OUT_Q_UNLOCKED); 29094a71df50SFrank Blaschka } 29104a71df50SFrank Blaschka } 29114a71df50SFrank Blaschka } 29124a71df50SFrank Blaschka 2913779e6e1cSJan Glauber void qeth_qdio_output_handler(struct ccw_device *ccwdev, 2914779e6e1cSJan Glauber unsigned int qdio_error, int __queue, int first_element, 2915779e6e1cSJan Glauber int count, unsigned long card_ptr) 29164a71df50SFrank Blaschka { 29174a71df50SFrank Blaschka struct qeth_card *card = (struct qeth_card *) card_ptr; 29184a71df50SFrank Blaschka struct qeth_qdio_out_q *queue = card->qdio.out_qs[__queue]; 29194a71df50SFrank Blaschka struct qeth_qdio_out_buffer *buffer; 29204a71df50SFrank Blaschka int i; 29214a71df50SFrank Blaschka 2922d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 6, "qdouhdl"); 2923779e6e1cSJan Glauber if (qdio_error & QDIO_ERROR_ACTIVATE_CHECK_CONDITION) { 2924d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 2, "achkcond"); 2925d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(TRACE, 2, "%s", CARD_BUS_ID(card)); 29264a71df50SFrank Blaschka netif_stop_queue(card->dev); 29274a71df50SFrank Blaschka qeth_schedule_recovery(card); 29284a71df50SFrank Blaschka return; 29294a71df50SFrank Blaschka } 29304a71df50SFrank Blaschka if (card->options.performance_stats) { 29314a71df50SFrank Blaschka card->perf_stats.outbound_handler_cnt++; 29324a71df50SFrank Blaschka card->perf_stats.outbound_handler_start_time = 29334a71df50SFrank Blaschka qeth_get_micros(); 29344a71df50SFrank Blaschka } 29354a71df50SFrank Blaschka for (i = first_element; i < (first_element + count); ++i) { 29364a71df50SFrank Blaschka buffer = &queue->bufs[i % QDIO_MAX_BUFFERS_PER_Q]; 29374a71df50SFrank Blaschka /*we only handle the KICK_IT error by doing a recovery */ 2938779e6e1cSJan Glauber if (qeth_handle_send_error(card, buffer, qdio_error) 29394a71df50SFrank Blaschka == QETH_SEND_ERROR_KICK_IT){ 29404a71df50SFrank Blaschka netif_stop_queue(card->dev); 29414a71df50SFrank Blaschka qeth_schedule_recovery(card); 29424a71df50SFrank Blaschka return; 29434a71df50SFrank Blaschka } 29444a71df50SFrank Blaschka qeth_clear_output_buffer(queue, buffer); 29454a71df50SFrank Blaschka } 29464a71df50SFrank Blaschka atomic_sub(count, &queue->used_buffers); 29474a71df50SFrank Blaschka /* check if we need to do something on this outbound queue */ 29484a71df50SFrank Blaschka if (card->info.type != QETH_CARD_TYPE_IQD) 29494a71df50SFrank Blaschka qeth_check_outbound_queue(queue); 29504a71df50SFrank Blaschka 29514a71df50SFrank Blaschka netif_wake_queue(queue->card->dev); 29524a71df50SFrank Blaschka if (card->options.performance_stats) 29534a71df50SFrank Blaschka card->perf_stats.outbound_handler_time += qeth_get_micros() - 29544a71df50SFrank Blaschka card->perf_stats.outbound_handler_start_time; 29554a71df50SFrank Blaschka } 29564a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_qdio_output_handler); 29574a71df50SFrank Blaschka 29584a71df50SFrank Blaschka int qeth_get_cast_type(struct qeth_card *card, struct sk_buff *skb) 29594a71df50SFrank Blaschka { 29604a71df50SFrank Blaschka int cast_type = RTN_UNSPEC; 29614a71df50SFrank Blaschka 29624a71df50SFrank Blaschka if (card->info.type == QETH_CARD_TYPE_OSN) 29634a71df50SFrank Blaschka return cast_type; 29644a71df50SFrank Blaschka 29654a71df50SFrank Blaschka if (skb->dst && skb->dst->neighbour) { 29664a71df50SFrank Blaschka cast_type = skb->dst->neighbour->type; 29674a71df50SFrank Blaschka if ((cast_type == RTN_BROADCAST) || 29684a71df50SFrank Blaschka (cast_type == RTN_MULTICAST) || 29694a71df50SFrank Blaschka (cast_type == RTN_ANYCAST)) 29704a71df50SFrank Blaschka return cast_type; 29714a71df50SFrank Blaschka else 29724a71df50SFrank Blaschka return RTN_UNSPEC; 29734a71df50SFrank Blaschka } 29744a71df50SFrank Blaschka /* try something else */ 29754a71df50SFrank Blaschka if (skb->protocol == ETH_P_IPV6) 29764a71df50SFrank Blaschka return (skb_network_header(skb)[24] == 0xff) ? 29774a71df50SFrank Blaschka RTN_MULTICAST : 0; 29784a71df50SFrank Blaschka else if (skb->protocol == ETH_P_IP) 29794a71df50SFrank Blaschka return ((skb_network_header(skb)[16] & 0xf0) == 0xe0) ? 29804a71df50SFrank Blaschka RTN_MULTICAST : 0; 29814a71df50SFrank Blaschka /* ... */ 29824a71df50SFrank Blaschka if (!memcmp(skb->data, skb->dev->broadcast, 6)) 29834a71df50SFrank Blaschka return RTN_BROADCAST; 29844a71df50SFrank Blaschka else { 29854a71df50SFrank Blaschka u16 hdr_mac; 29864a71df50SFrank Blaschka 29874a71df50SFrank Blaschka hdr_mac = *((u16 *)skb->data); 29884a71df50SFrank Blaschka /* tr multicast? */ 29894a71df50SFrank Blaschka switch (card->info.link_type) { 29904a71df50SFrank Blaschka case QETH_LINK_TYPE_HSTR: 29914a71df50SFrank Blaschka case QETH_LINK_TYPE_LANE_TR: 29924a71df50SFrank Blaschka if ((hdr_mac == QETH_TR_MAC_NC) || 29934a71df50SFrank Blaschka (hdr_mac == QETH_TR_MAC_C)) 29944a71df50SFrank Blaschka return RTN_MULTICAST; 29954a71df50SFrank Blaschka break; 29964a71df50SFrank Blaschka /* eth or so multicast? */ 29974a71df50SFrank Blaschka default: 29984a71df50SFrank Blaschka if ((hdr_mac == QETH_ETH_MAC_V4) || 29994a71df50SFrank Blaschka (hdr_mac == QETH_ETH_MAC_V6)) 30004a71df50SFrank Blaschka return RTN_MULTICAST; 30014a71df50SFrank Blaschka } 30024a71df50SFrank Blaschka } 30034a71df50SFrank Blaschka return cast_type; 30044a71df50SFrank Blaschka } 30054a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_get_cast_type); 30064a71df50SFrank Blaschka 30074a71df50SFrank Blaschka int qeth_get_priority_queue(struct qeth_card *card, struct sk_buff *skb, 30084a71df50SFrank Blaschka int ipv, int cast_type) 30094a71df50SFrank Blaschka { 30104a71df50SFrank Blaschka if (!ipv && (card->info.type == QETH_CARD_TYPE_OSAE)) 30114a71df50SFrank Blaschka return card->qdio.default_out_queue; 30124a71df50SFrank Blaschka switch (card->qdio.no_out_queues) { 30134a71df50SFrank Blaschka case 4: 30144a71df50SFrank Blaschka if (cast_type && card->info.is_multicast_different) 30154a71df50SFrank Blaschka return card->info.is_multicast_different & 30164a71df50SFrank Blaschka (card->qdio.no_out_queues - 1); 30174a71df50SFrank Blaschka if (card->qdio.do_prio_queueing && (ipv == 4)) { 30184a71df50SFrank Blaschka const u8 tos = ip_hdr(skb)->tos; 30194a71df50SFrank Blaschka 30204a71df50SFrank Blaschka if (card->qdio.do_prio_queueing == 30214a71df50SFrank Blaschka QETH_PRIO_Q_ING_TOS) { 30224a71df50SFrank Blaschka if (tos & IP_TOS_NOTIMPORTANT) 30234a71df50SFrank Blaschka return 3; 30244a71df50SFrank Blaschka if (tos & IP_TOS_HIGHRELIABILITY) 30254a71df50SFrank Blaschka return 2; 30264a71df50SFrank Blaschka if (tos & IP_TOS_HIGHTHROUGHPUT) 30274a71df50SFrank Blaschka return 1; 30284a71df50SFrank Blaschka if (tos & IP_TOS_LOWDELAY) 30294a71df50SFrank Blaschka return 0; 30304a71df50SFrank Blaschka } 30314a71df50SFrank Blaschka if (card->qdio.do_prio_queueing == 30324a71df50SFrank Blaschka QETH_PRIO_Q_ING_PREC) 30334a71df50SFrank Blaschka return 3 - (tos >> 6); 30344a71df50SFrank Blaschka } else if (card->qdio.do_prio_queueing && (ipv == 6)) { 30354a71df50SFrank Blaschka /* TODO: IPv6!!! */ 30364a71df50SFrank Blaschka } 30374a71df50SFrank Blaschka return card->qdio.default_out_queue; 30384a71df50SFrank Blaschka case 1: /* fallthrough for single-out-queue 1920-device */ 30394a71df50SFrank Blaschka default: 30404a71df50SFrank Blaschka return card->qdio.default_out_queue; 30414a71df50SFrank Blaschka } 30424a71df50SFrank Blaschka } 30434a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_get_priority_queue); 30444a71df50SFrank Blaschka 30454a71df50SFrank Blaschka int qeth_get_elements_no(struct qeth_card *card, void *hdr, 30464a71df50SFrank Blaschka struct sk_buff *skb, int elems) 30474a71df50SFrank Blaschka { 30484a71df50SFrank Blaschka int elements_needed = 0; 30494a71df50SFrank Blaschka 30504a71df50SFrank Blaschka if (skb_shinfo(skb)->nr_frags > 0) 30514a71df50SFrank Blaschka elements_needed = (skb_shinfo(skb)->nr_frags + 1); 30524a71df50SFrank Blaschka if (elements_needed == 0) 3053683d718aSFrank Blaschka elements_needed = 1 + (((((unsigned long) skb->data) % 3054683d718aSFrank Blaschka PAGE_SIZE) + skb->len) >> PAGE_SHIFT); 30554a71df50SFrank Blaschka if ((elements_needed + elems) > QETH_MAX_BUFFER_ELEMENTS(card)) { 305614cc21b6SFrank Blaschka QETH_DBF_MESSAGE(2, "Invalid size of IP packet " 30574a71df50SFrank Blaschka "(Number=%d / Length=%d). Discarded.\n", 30584a71df50SFrank Blaschka (elements_needed+elems), skb->len); 30594a71df50SFrank Blaschka return 0; 30604a71df50SFrank Blaschka } 30614a71df50SFrank Blaschka return elements_needed; 30624a71df50SFrank Blaschka } 30634a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_get_elements_no); 30644a71df50SFrank Blaschka 3065f90b744eSFrank Blaschka static inline void __qeth_fill_buffer(struct sk_buff *skb, 3066683d718aSFrank Blaschka struct qdio_buffer *buffer, int is_tso, int *next_element_to_fill, 3067683d718aSFrank Blaschka int offset) 30684a71df50SFrank Blaschka { 3069e1f03ae8SFrank Blaschka int length = skb->len; 30704a71df50SFrank Blaschka int length_here; 30714a71df50SFrank Blaschka int element; 30724a71df50SFrank Blaschka char *data; 30734a71df50SFrank Blaschka int first_lap ; 30744a71df50SFrank Blaschka 30754a71df50SFrank Blaschka element = *next_element_to_fill; 30764a71df50SFrank Blaschka data = skb->data; 30774a71df50SFrank Blaschka first_lap = (is_tso == 0 ? 1 : 0); 30784a71df50SFrank Blaschka 3079683d718aSFrank Blaschka if (offset >= 0) { 3080683d718aSFrank Blaschka data = skb->data + offset; 3081e1f03ae8SFrank Blaschka length -= offset; 3082683d718aSFrank Blaschka first_lap = 0; 3083683d718aSFrank Blaschka } 3084683d718aSFrank Blaschka 30854a71df50SFrank Blaschka while (length > 0) { 30864a71df50SFrank Blaschka /* length_here is the remaining amount of data in this page */ 30874a71df50SFrank Blaschka length_here = PAGE_SIZE - ((unsigned long) data % PAGE_SIZE); 30884a71df50SFrank Blaschka if (length < length_here) 30894a71df50SFrank Blaschka length_here = length; 30904a71df50SFrank Blaschka 30914a71df50SFrank Blaschka buffer->element[element].addr = data; 30924a71df50SFrank Blaschka buffer->element[element].length = length_here; 30934a71df50SFrank Blaschka length -= length_here; 30944a71df50SFrank Blaschka if (!length) { 30954a71df50SFrank Blaschka if (first_lap) 30964a71df50SFrank Blaschka buffer->element[element].flags = 0; 30974a71df50SFrank Blaschka else 30984a71df50SFrank Blaschka buffer->element[element].flags = 30994a71df50SFrank Blaschka SBAL_FLAGS_LAST_FRAG; 31004a71df50SFrank Blaschka } else { 31014a71df50SFrank Blaschka if (first_lap) 31024a71df50SFrank Blaschka buffer->element[element].flags = 31034a71df50SFrank Blaschka SBAL_FLAGS_FIRST_FRAG; 31044a71df50SFrank Blaschka else 31054a71df50SFrank Blaschka buffer->element[element].flags = 31064a71df50SFrank Blaschka SBAL_FLAGS_MIDDLE_FRAG; 31074a71df50SFrank Blaschka } 31084a71df50SFrank Blaschka data += length_here; 31094a71df50SFrank Blaschka element++; 31104a71df50SFrank Blaschka first_lap = 0; 31114a71df50SFrank Blaschka } 31124a71df50SFrank Blaschka *next_element_to_fill = element; 31134a71df50SFrank Blaschka } 31144a71df50SFrank Blaschka 3115f90b744eSFrank Blaschka static inline int qeth_fill_buffer(struct qeth_qdio_out_q *queue, 3116683d718aSFrank Blaschka struct qeth_qdio_out_buffer *buf, struct sk_buff *skb, 3117683d718aSFrank Blaschka struct qeth_hdr *hdr, int offset, int hd_len) 31184a71df50SFrank Blaschka { 31194a71df50SFrank Blaschka struct qdio_buffer *buffer; 31204a71df50SFrank Blaschka int flush_cnt = 0, hdr_len, large_send = 0; 31214a71df50SFrank Blaschka 31224a71df50SFrank Blaschka buffer = buf->buffer; 31234a71df50SFrank Blaschka atomic_inc(&skb->users); 31244a71df50SFrank Blaschka skb_queue_tail(&buf->skb_list, skb); 31254a71df50SFrank Blaschka 31264a71df50SFrank Blaschka /*check first on TSO ....*/ 3127683d718aSFrank Blaschka if (hdr->hdr.l3.id == QETH_HEADER_TYPE_TSO) { 31284a71df50SFrank Blaschka int element = buf->next_element_to_fill; 31294a71df50SFrank Blaschka 3130683d718aSFrank Blaschka hdr_len = sizeof(struct qeth_hdr_tso) + 3131683d718aSFrank Blaschka ((struct qeth_hdr_tso *)hdr)->ext.dg_hdr_len; 31324a71df50SFrank Blaschka /*fill first buffer entry only with header information */ 31334a71df50SFrank Blaschka buffer->element[element].addr = skb->data; 31344a71df50SFrank Blaschka buffer->element[element].length = hdr_len; 31354a71df50SFrank Blaschka buffer->element[element].flags = SBAL_FLAGS_FIRST_FRAG; 31364a71df50SFrank Blaschka buf->next_element_to_fill++; 31374a71df50SFrank Blaschka skb->data += hdr_len; 31384a71df50SFrank Blaschka skb->len -= hdr_len; 31394a71df50SFrank Blaschka large_send = 1; 31404a71df50SFrank Blaschka } 3141683d718aSFrank Blaschka 3142683d718aSFrank Blaschka if (offset >= 0) { 3143683d718aSFrank Blaschka int element = buf->next_element_to_fill; 3144683d718aSFrank Blaschka buffer->element[element].addr = hdr; 3145683d718aSFrank Blaschka buffer->element[element].length = sizeof(struct qeth_hdr) + 3146683d718aSFrank Blaschka hd_len; 3147683d718aSFrank Blaschka buffer->element[element].flags = SBAL_FLAGS_FIRST_FRAG; 3148683d718aSFrank Blaschka buf->is_header[element] = 1; 3149683d718aSFrank Blaschka buf->next_element_to_fill++; 3150683d718aSFrank Blaschka } 3151683d718aSFrank Blaschka 31524a71df50SFrank Blaschka if (skb_shinfo(skb)->nr_frags == 0) 31534a71df50SFrank Blaschka __qeth_fill_buffer(skb, buffer, large_send, 3154683d718aSFrank Blaschka (int *)&buf->next_element_to_fill, offset); 31554a71df50SFrank Blaschka else 31564a71df50SFrank Blaschka __qeth_fill_buffer_frag(skb, buffer, large_send, 31574a71df50SFrank Blaschka (int *)&buf->next_element_to_fill); 31584a71df50SFrank Blaschka 31594a71df50SFrank Blaschka if (!queue->do_pack) { 3160d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 6, "fillbfnp"); 31614a71df50SFrank Blaschka /* set state to PRIMED -> will be flushed */ 31624a71df50SFrank Blaschka atomic_set(&buf->state, QETH_QDIO_BUF_PRIMED); 31634a71df50SFrank Blaschka flush_cnt = 1; 31644a71df50SFrank Blaschka } else { 3165d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 6, "fillbfpa"); 31664a71df50SFrank Blaschka if (queue->card->options.performance_stats) 31674a71df50SFrank Blaschka queue->card->perf_stats.skbs_sent_pack++; 31684a71df50SFrank Blaschka if (buf->next_element_to_fill >= 31694a71df50SFrank Blaschka QETH_MAX_BUFFER_ELEMENTS(queue->card)) { 31704a71df50SFrank Blaschka /* 31714a71df50SFrank Blaschka * packed buffer if full -> set state PRIMED 31724a71df50SFrank Blaschka * -> will be flushed 31734a71df50SFrank Blaschka */ 31744a71df50SFrank Blaschka atomic_set(&buf->state, QETH_QDIO_BUF_PRIMED); 31754a71df50SFrank Blaschka flush_cnt = 1; 31764a71df50SFrank Blaschka } 31774a71df50SFrank Blaschka } 31784a71df50SFrank Blaschka return flush_cnt; 31794a71df50SFrank Blaschka } 31804a71df50SFrank Blaschka 31814a71df50SFrank Blaschka int qeth_do_send_packet_fast(struct qeth_card *card, 31824a71df50SFrank Blaschka struct qeth_qdio_out_q *queue, struct sk_buff *skb, 31834a71df50SFrank Blaschka struct qeth_hdr *hdr, int elements_needed, 3184683d718aSFrank Blaschka struct qeth_eddp_context *ctx, int offset, int hd_len) 31854a71df50SFrank Blaschka { 31864a71df50SFrank Blaschka struct qeth_qdio_out_buffer *buffer; 31874a71df50SFrank Blaschka int buffers_needed = 0; 31884a71df50SFrank Blaschka int flush_cnt = 0; 31894a71df50SFrank Blaschka int index; 31904a71df50SFrank Blaschka 31914a71df50SFrank Blaschka /* spin until we get the queue ... */ 31924a71df50SFrank Blaschka while (atomic_cmpxchg(&queue->state, QETH_OUT_Q_UNLOCKED, 31934a71df50SFrank Blaschka QETH_OUT_Q_LOCKED) != QETH_OUT_Q_UNLOCKED); 31944a71df50SFrank Blaschka /* ... now we've got the queue */ 31954a71df50SFrank Blaschka index = queue->next_buf_to_fill; 31964a71df50SFrank Blaschka buffer = &queue->bufs[queue->next_buf_to_fill]; 31974a71df50SFrank Blaschka /* 31984a71df50SFrank Blaschka * check if buffer is empty to make sure that we do not 'overtake' 31994a71df50SFrank Blaschka * ourselves and try to fill a buffer that is already primed 32004a71df50SFrank Blaschka */ 32014a71df50SFrank Blaschka if (atomic_read(&buffer->state) != QETH_QDIO_BUF_EMPTY) 32024a71df50SFrank Blaschka goto out; 32034a71df50SFrank Blaschka if (ctx == NULL) 32044a71df50SFrank Blaschka queue->next_buf_to_fill = (queue->next_buf_to_fill + 1) % 32054a71df50SFrank Blaschka QDIO_MAX_BUFFERS_PER_Q; 32064a71df50SFrank Blaschka else { 32074a71df50SFrank Blaschka buffers_needed = qeth_eddp_check_buffers_for_context(queue, 32084a71df50SFrank Blaschka ctx); 32094a71df50SFrank Blaschka if (buffers_needed < 0) 32104a71df50SFrank Blaschka goto out; 32114a71df50SFrank Blaschka queue->next_buf_to_fill = 32124a71df50SFrank Blaschka (queue->next_buf_to_fill + buffers_needed) % 32134a71df50SFrank Blaschka QDIO_MAX_BUFFERS_PER_Q; 32144a71df50SFrank Blaschka } 32154a71df50SFrank Blaschka atomic_set(&queue->state, QETH_OUT_Q_UNLOCKED); 32164a71df50SFrank Blaschka if (ctx == NULL) { 3217683d718aSFrank Blaschka qeth_fill_buffer(queue, buffer, skb, hdr, offset, hd_len); 3218779e6e1cSJan Glauber qeth_flush_buffers(queue, index, 1); 32194a71df50SFrank Blaschka } else { 32204a71df50SFrank Blaschka flush_cnt = qeth_eddp_fill_buffer(queue, ctx, index); 32214a71df50SFrank Blaschka WARN_ON(buffers_needed != flush_cnt); 3222779e6e1cSJan Glauber qeth_flush_buffers(queue, index, flush_cnt); 32234a71df50SFrank Blaschka } 32244a71df50SFrank Blaschka return 0; 32254a71df50SFrank Blaschka out: 32264a71df50SFrank Blaschka atomic_set(&queue->state, QETH_OUT_Q_UNLOCKED); 32274a71df50SFrank Blaschka return -EBUSY; 32284a71df50SFrank Blaschka } 32294a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_do_send_packet_fast); 32304a71df50SFrank Blaschka 32314a71df50SFrank Blaschka int qeth_do_send_packet(struct qeth_card *card, struct qeth_qdio_out_q *queue, 32324a71df50SFrank Blaschka struct sk_buff *skb, struct qeth_hdr *hdr, 32334a71df50SFrank Blaschka int elements_needed, struct qeth_eddp_context *ctx) 32344a71df50SFrank Blaschka { 32354a71df50SFrank Blaschka struct qeth_qdio_out_buffer *buffer; 32364a71df50SFrank Blaschka int start_index; 32374a71df50SFrank Blaschka int flush_count = 0; 32384a71df50SFrank Blaschka int do_pack = 0; 32394a71df50SFrank Blaschka int tmp; 32404a71df50SFrank Blaschka int rc = 0; 32414a71df50SFrank Blaschka 32424a71df50SFrank Blaschka /* spin until we get the queue ... */ 32434a71df50SFrank Blaschka while (atomic_cmpxchg(&queue->state, QETH_OUT_Q_UNLOCKED, 32444a71df50SFrank Blaschka QETH_OUT_Q_LOCKED) != QETH_OUT_Q_UNLOCKED); 32454a71df50SFrank Blaschka start_index = queue->next_buf_to_fill; 32464a71df50SFrank Blaschka buffer = &queue->bufs[queue->next_buf_to_fill]; 32474a71df50SFrank Blaschka /* 32484a71df50SFrank Blaschka * check if buffer is empty to make sure that we do not 'overtake' 32494a71df50SFrank Blaschka * ourselves and try to fill a buffer that is already primed 32504a71df50SFrank Blaschka */ 32514a71df50SFrank Blaschka if (atomic_read(&buffer->state) != QETH_QDIO_BUF_EMPTY) { 32524a71df50SFrank Blaschka atomic_set(&queue->state, QETH_OUT_Q_UNLOCKED); 32534a71df50SFrank Blaschka return -EBUSY; 32544a71df50SFrank Blaschka } 32554a71df50SFrank Blaschka /* check if we need to switch packing state of this queue */ 32564a71df50SFrank Blaschka qeth_switch_to_packing_if_needed(queue); 32574a71df50SFrank Blaschka if (queue->do_pack) { 32584a71df50SFrank Blaschka do_pack = 1; 32594a71df50SFrank Blaschka if (ctx == NULL) { 32604a71df50SFrank Blaschka /* does packet fit in current buffer? */ 32614a71df50SFrank Blaschka if ((QETH_MAX_BUFFER_ELEMENTS(card) - 32624a71df50SFrank Blaschka buffer->next_element_to_fill) < elements_needed) { 32634a71df50SFrank Blaschka /* ... no -> set state PRIMED */ 32644a71df50SFrank Blaschka atomic_set(&buffer->state, 32654a71df50SFrank Blaschka QETH_QDIO_BUF_PRIMED); 32664a71df50SFrank Blaschka flush_count++; 32674a71df50SFrank Blaschka queue->next_buf_to_fill = 32684a71df50SFrank Blaschka (queue->next_buf_to_fill + 1) % 32694a71df50SFrank Blaschka QDIO_MAX_BUFFERS_PER_Q; 32704a71df50SFrank Blaschka buffer = &queue->bufs[queue->next_buf_to_fill]; 32714a71df50SFrank Blaschka /* we did a step forward, so check buffer state 32724a71df50SFrank Blaschka * again */ 32734a71df50SFrank Blaschka if (atomic_read(&buffer->state) != 32744a71df50SFrank Blaschka QETH_QDIO_BUF_EMPTY){ 3275779e6e1cSJan Glauber qeth_flush_buffers(queue, start_index, 3276779e6e1cSJan Glauber flush_count); 32774a71df50SFrank Blaschka atomic_set(&queue->state, 32784a71df50SFrank Blaschka QETH_OUT_Q_UNLOCKED); 32794a71df50SFrank Blaschka return -EBUSY; 32804a71df50SFrank Blaschka } 32814a71df50SFrank Blaschka } 32824a71df50SFrank Blaschka } else { 32834a71df50SFrank Blaschka /* check if we have enough elements (including following 32844a71df50SFrank Blaschka * free buffers) to handle eddp context */ 32854a71df50SFrank Blaschka if (qeth_eddp_check_buffers_for_context(queue, ctx) 32864a71df50SFrank Blaschka < 0) { 32874a71df50SFrank Blaschka rc = -EBUSY; 32884a71df50SFrank Blaschka goto out; 32894a71df50SFrank Blaschka } 32904a71df50SFrank Blaschka } 32914a71df50SFrank Blaschka } 32924a71df50SFrank Blaschka if (ctx == NULL) 3293683d718aSFrank Blaschka tmp = qeth_fill_buffer(queue, buffer, skb, hdr, -1, 0); 32944a71df50SFrank Blaschka else { 32954a71df50SFrank Blaschka tmp = qeth_eddp_fill_buffer(queue, ctx, 32964a71df50SFrank Blaschka queue->next_buf_to_fill); 32974a71df50SFrank Blaschka if (tmp < 0) { 32984a71df50SFrank Blaschka rc = -EBUSY; 32994a71df50SFrank Blaschka goto out; 33004a71df50SFrank Blaschka } 33014a71df50SFrank Blaschka } 33024a71df50SFrank Blaschka queue->next_buf_to_fill = (queue->next_buf_to_fill + tmp) % 33034a71df50SFrank Blaschka QDIO_MAX_BUFFERS_PER_Q; 33044a71df50SFrank Blaschka flush_count += tmp; 33054a71df50SFrank Blaschka out: 33064a71df50SFrank Blaschka if (flush_count) 3307779e6e1cSJan Glauber qeth_flush_buffers(queue, start_index, flush_count); 33084a71df50SFrank Blaschka else if (!atomic_read(&queue->set_pci_flags_count)) 33094a71df50SFrank Blaschka atomic_xchg(&queue->state, QETH_OUT_Q_LOCKED_FLUSH); 33104a71df50SFrank Blaschka /* 33114a71df50SFrank Blaschka * queue->state will go from LOCKED -> UNLOCKED or from 33124a71df50SFrank Blaschka * LOCKED_FLUSH -> LOCKED if output_handler wanted to 'notify' us 33134a71df50SFrank Blaschka * (switch packing state or flush buffer to get another pci flag out). 33144a71df50SFrank Blaschka * In that case we will enter this loop 33154a71df50SFrank Blaschka */ 33164a71df50SFrank Blaschka while (atomic_dec_return(&queue->state)) { 33174a71df50SFrank Blaschka flush_count = 0; 33184a71df50SFrank Blaschka start_index = queue->next_buf_to_fill; 33194a71df50SFrank Blaschka /* check if we can go back to non-packing state */ 33204a71df50SFrank Blaschka flush_count += qeth_switch_to_nonpacking_if_needed(queue); 33214a71df50SFrank Blaschka /* 33224a71df50SFrank Blaschka * check if we need to flush a packing buffer to get a pci 33234a71df50SFrank Blaschka * flag out on the queue 33244a71df50SFrank Blaschka */ 33254a71df50SFrank Blaschka if (!flush_count && !atomic_read(&queue->set_pci_flags_count)) 33264a71df50SFrank Blaschka flush_count += qeth_flush_buffers_on_no_pci(queue); 33274a71df50SFrank Blaschka if (flush_count) 3328779e6e1cSJan Glauber qeth_flush_buffers(queue, start_index, flush_count); 33294a71df50SFrank Blaschka } 33304a71df50SFrank Blaschka /* at this point the queue is UNLOCKED again */ 33314a71df50SFrank Blaschka if (queue->card->options.performance_stats && do_pack) 33324a71df50SFrank Blaschka queue->card->perf_stats.bufs_sent_pack += flush_count; 33334a71df50SFrank Blaschka 33344a71df50SFrank Blaschka return rc; 33354a71df50SFrank Blaschka } 33364a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_do_send_packet); 33374a71df50SFrank Blaschka 33384a71df50SFrank Blaschka static int qeth_setadp_promisc_mode_cb(struct qeth_card *card, 33394a71df50SFrank Blaschka struct qeth_reply *reply, unsigned long data) 33404a71df50SFrank Blaschka { 33414a71df50SFrank Blaschka struct qeth_ipa_cmd *cmd; 33424a71df50SFrank Blaschka struct qeth_ipacmd_setadpparms *setparms; 33434a71df50SFrank Blaschka 3344d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 4, "prmadpcb"); 33454a71df50SFrank Blaschka 33464a71df50SFrank Blaschka cmd = (struct qeth_ipa_cmd *) data; 33474a71df50SFrank Blaschka setparms = &(cmd->data.setadapterparms); 33484a71df50SFrank Blaschka 33494a71df50SFrank Blaschka qeth_default_setadapterparms_cb(card, reply, (unsigned long)cmd); 33504a71df50SFrank Blaschka if (cmd->hdr.return_code) { 3351d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(TRACE, 4, "prmrc%2.2x", cmd->hdr.return_code); 33524a71df50SFrank Blaschka setparms->data.mode = SET_PROMISC_MODE_OFF; 33534a71df50SFrank Blaschka } 33544a71df50SFrank Blaschka card->info.promisc_mode = setparms->data.mode; 33554a71df50SFrank Blaschka return 0; 33564a71df50SFrank Blaschka } 33574a71df50SFrank Blaschka 33584a71df50SFrank Blaschka void qeth_setadp_promisc_mode(struct qeth_card *card) 33594a71df50SFrank Blaschka { 33604a71df50SFrank Blaschka enum qeth_ipa_promisc_modes mode; 33614a71df50SFrank Blaschka struct net_device *dev = card->dev; 33624a71df50SFrank Blaschka struct qeth_cmd_buffer *iob; 33634a71df50SFrank Blaschka struct qeth_ipa_cmd *cmd; 33644a71df50SFrank Blaschka 3365d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 4, "setprom"); 33664a71df50SFrank Blaschka 33674a71df50SFrank Blaschka if (((dev->flags & IFF_PROMISC) && 33684a71df50SFrank Blaschka (card->info.promisc_mode == SET_PROMISC_MODE_ON)) || 33694a71df50SFrank Blaschka (!(dev->flags & IFF_PROMISC) && 33704a71df50SFrank Blaschka (card->info.promisc_mode == SET_PROMISC_MODE_OFF))) 33714a71df50SFrank Blaschka return; 33724a71df50SFrank Blaschka mode = SET_PROMISC_MODE_OFF; 33734a71df50SFrank Blaschka if (dev->flags & IFF_PROMISC) 33744a71df50SFrank Blaschka mode = SET_PROMISC_MODE_ON; 3375d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(TRACE, 4, "mode:%x", mode); 33764a71df50SFrank Blaschka 33774a71df50SFrank Blaschka iob = qeth_get_adapter_cmd(card, IPA_SETADP_SET_PROMISC_MODE, 33784a71df50SFrank Blaschka sizeof(struct qeth_ipacmd_setadpparms)); 33794a71df50SFrank Blaschka cmd = (struct qeth_ipa_cmd *)(iob->data + IPA_PDU_HEADER_SIZE); 33804a71df50SFrank Blaschka cmd->data.setadapterparms.data.mode = mode; 33814a71df50SFrank Blaschka qeth_send_ipa_cmd(card, iob, qeth_setadp_promisc_mode_cb, NULL); 33824a71df50SFrank Blaschka } 33834a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_setadp_promisc_mode); 33844a71df50SFrank Blaschka 33854a71df50SFrank Blaschka int qeth_change_mtu(struct net_device *dev, int new_mtu) 33864a71df50SFrank Blaschka { 33874a71df50SFrank Blaschka struct qeth_card *card; 33884a71df50SFrank Blaschka char dbf_text[15]; 33894a71df50SFrank Blaschka 3390509e2562SHeiko Carstens card = dev->ml_priv; 33914a71df50SFrank Blaschka 3392d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 4, "chgmtu"); 33934a71df50SFrank Blaschka sprintf(dbf_text, "%8x", new_mtu); 3394d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 4, dbf_text); 33954a71df50SFrank Blaschka 33964a71df50SFrank Blaschka if (new_mtu < 64) 33974a71df50SFrank Blaschka return -EINVAL; 33984a71df50SFrank Blaschka if (new_mtu > 65535) 33994a71df50SFrank Blaschka return -EINVAL; 34004a71df50SFrank Blaschka if ((!qeth_is_supported(card, IPA_IP_FRAGMENTATION)) && 34014a71df50SFrank Blaschka (!qeth_mtu_is_valid(card, new_mtu))) 34024a71df50SFrank Blaschka return -EINVAL; 34034a71df50SFrank Blaschka dev->mtu = new_mtu; 34044a71df50SFrank Blaschka return 0; 34054a71df50SFrank Blaschka } 34064a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_change_mtu); 34074a71df50SFrank Blaschka 34084a71df50SFrank Blaschka struct net_device_stats *qeth_get_stats(struct net_device *dev) 34094a71df50SFrank Blaschka { 34104a71df50SFrank Blaschka struct qeth_card *card; 34114a71df50SFrank Blaschka 3412509e2562SHeiko Carstens card = dev->ml_priv; 34134a71df50SFrank Blaschka 3414d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 5, "getstat"); 34154a71df50SFrank Blaschka 34164a71df50SFrank Blaschka return &card->stats; 34174a71df50SFrank Blaschka } 34184a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_get_stats); 34194a71df50SFrank Blaschka 34204a71df50SFrank Blaschka static int qeth_setadpparms_change_macaddr_cb(struct qeth_card *card, 34214a71df50SFrank Blaschka struct qeth_reply *reply, unsigned long data) 34224a71df50SFrank Blaschka { 34234a71df50SFrank Blaschka struct qeth_ipa_cmd *cmd; 34244a71df50SFrank Blaschka 3425d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 4, "chgmaccb"); 34264a71df50SFrank Blaschka 34274a71df50SFrank Blaschka cmd = (struct qeth_ipa_cmd *) data; 34284a71df50SFrank Blaschka if (!card->options.layer2 || 34294a71df50SFrank Blaschka !(card->info.mac_bits & QETH_LAYER2_MAC_READ)) { 34304a71df50SFrank Blaschka memcpy(card->dev->dev_addr, 34314a71df50SFrank Blaschka &cmd->data.setadapterparms.data.change_addr.addr, 34324a71df50SFrank Blaschka OSA_ADDR_LEN); 34334a71df50SFrank Blaschka card->info.mac_bits |= QETH_LAYER2_MAC_READ; 34344a71df50SFrank Blaschka } 34354a71df50SFrank Blaschka qeth_default_setadapterparms_cb(card, reply, (unsigned long) cmd); 34364a71df50SFrank Blaschka return 0; 34374a71df50SFrank Blaschka } 34384a71df50SFrank Blaschka 34394a71df50SFrank Blaschka int qeth_setadpparms_change_macaddr(struct qeth_card *card) 34404a71df50SFrank Blaschka { 34414a71df50SFrank Blaschka int rc; 34424a71df50SFrank Blaschka struct qeth_cmd_buffer *iob; 34434a71df50SFrank Blaschka struct qeth_ipa_cmd *cmd; 34444a71df50SFrank Blaschka 3445d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 4, "chgmac"); 34464a71df50SFrank Blaschka 34474a71df50SFrank Blaschka iob = qeth_get_adapter_cmd(card, IPA_SETADP_ALTER_MAC_ADDRESS, 34484a71df50SFrank Blaschka sizeof(struct qeth_ipacmd_setadpparms)); 34494a71df50SFrank Blaschka cmd = (struct qeth_ipa_cmd *)(iob->data+IPA_PDU_HEADER_SIZE); 34504a71df50SFrank Blaschka cmd->data.setadapterparms.data.change_addr.cmd = CHANGE_ADDR_READ_MAC; 34514a71df50SFrank Blaschka cmd->data.setadapterparms.data.change_addr.addr_size = OSA_ADDR_LEN; 34524a71df50SFrank Blaschka memcpy(&cmd->data.setadapterparms.data.change_addr.addr, 34534a71df50SFrank Blaschka card->dev->dev_addr, OSA_ADDR_LEN); 34544a71df50SFrank Blaschka rc = qeth_send_ipa_cmd(card, iob, qeth_setadpparms_change_macaddr_cb, 34554a71df50SFrank Blaschka NULL); 34564a71df50SFrank Blaschka return rc; 34574a71df50SFrank Blaschka } 34584a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_setadpparms_change_macaddr); 34594a71df50SFrank Blaschka 34604a71df50SFrank Blaschka void qeth_tx_timeout(struct net_device *dev) 34614a71df50SFrank Blaschka { 34624a71df50SFrank Blaschka struct qeth_card *card; 34634a71df50SFrank Blaschka 3464509e2562SHeiko Carstens card = dev->ml_priv; 34654a71df50SFrank Blaschka card->stats.tx_errors++; 34664a71df50SFrank Blaschka qeth_schedule_recovery(card); 34674a71df50SFrank Blaschka } 34684a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_tx_timeout); 34694a71df50SFrank Blaschka 34704a71df50SFrank Blaschka int qeth_mdio_read(struct net_device *dev, int phy_id, int regnum) 34714a71df50SFrank Blaschka { 3472509e2562SHeiko Carstens struct qeth_card *card = dev->ml_priv; 34734a71df50SFrank Blaschka int rc = 0; 34744a71df50SFrank Blaschka 34754a71df50SFrank Blaschka switch (regnum) { 34764a71df50SFrank Blaschka case MII_BMCR: /* Basic mode control register */ 34774a71df50SFrank Blaschka rc = BMCR_FULLDPLX; 34784a71df50SFrank Blaschka if ((card->info.link_type != QETH_LINK_TYPE_GBIT_ETH) && 34794a71df50SFrank Blaschka (card->info.link_type != QETH_LINK_TYPE_OSN) && 34804a71df50SFrank Blaschka (card->info.link_type != QETH_LINK_TYPE_10GBIT_ETH)) 34814a71df50SFrank Blaschka rc |= BMCR_SPEED100; 34824a71df50SFrank Blaschka break; 34834a71df50SFrank Blaschka case MII_BMSR: /* Basic mode status register */ 34844a71df50SFrank Blaschka rc = BMSR_ERCAP | BMSR_ANEGCOMPLETE | BMSR_LSTATUS | 34854a71df50SFrank Blaschka BMSR_10HALF | BMSR_10FULL | BMSR_100HALF | BMSR_100FULL | 34864a71df50SFrank Blaschka BMSR_100BASE4; 34874a71df50SFrank Blaschka break; 34884a71df50SFrank Blaschka case MII_PHYSID1: /* PHYS ID 1 */ 34894a71df50SFrank Blaschka rc = (dev->dev_addr[0] << 16) | (dev->dev_addr[1] << 8) | 34904a71df50SFrank Blaschka dev->dev_addr[2]; 34914a71df50SFrank Blaschka rc = (rc >> 5) & 0xFFFF; 34924a71df50SFrank Blaschka break; 34934a71df50SFrank Blaschka case MII_PHYSID2: /* PHYS ID 2 */ 34944a71df50SFrank Blaschka rc = (dev->dev_addr[2] << 10) & 0xFFFF; 34954a71df50SFrank Blaschka break; 34964a71df50SFrank Blaschka case MII_ADVERTISE: /* Advertisement control reg */ 34974a71df50SFrank Blaschka rc = ADVERTISE_ALL; 34984a71df50SFrank Blaschka break; 34994a71df50SFrank Blaschka case MII_LPA: /* Link partner ability reg */ 35004a71df50SFrank Blaschka rc = LPA_10HALF | LPA_10FULL | LPA_100HALF | LPA_100FULL | 35014a71df50SFrank Blaschka LPA_100BASE4 | LPA_LPACK; 35024a71df50SFrank Blaschka break; 35034a71df50SFrank Blaschka case MII_EXPANSION: /* Expansion register */ 35044a71df50SFrank Blaschka break; 35054a71df50SFrank Blaschka case MII_DCOUNTER: /* disconnect counter */ 35064a71df50SFrank Blaschka break; 35074a71df50SFrank Blaschka case MII_FCSCOUNTER: /* false carrier counter */ 35084a71df50SFrank Blaschka break; 35094a71df50SFrank Blaschka case MII_NWAYTEST: /* N-way auto-neg test register */ 35104a71df50SFrank Blaschka break; 35114a71df50SFrank Blaschka case MII_RERRCOUNTER: /* rx error counter */ 35124a71df50SFrank Blaschka rc = card->stats.rx_errors; 35134a71df50SFrank Blaschka break; 35144a71df50SFrank Blaschka case MII_SREVISION: /* silicon revision */ 35154a71df50SFrank Blaschka break; 35164a71df50SFrank Blaschka case MII_RESV1: /* reserved 1 */ 35174a71df50SFrank Blaschka break; 35184a71df50SFrank Blaschka case MII_LBRERROR: /* loopback, rx, bypass error */ 35194a71df50SFrank Blaschka break; 35204a71df50SFrank Blaschka case MII_PHYADDR: /* physical address */ 35214a71df50SFrank Blaschka break; 35224a71df50SFrank Blaschka case MII_RESV2: /* reserved 2 */ 35234a71df50SFrank Blaschka break; 35244a71df50SFrank Blaschka case MII_TPISTATUS: /* TPI status for 10mbps */ 35254a71df50SFrank Blaschka break; 35264a71df50SFrank Blaschka case MII_NCONFIG: /* network interface config */ 35274a71df50SFrank Blaschka break; 35284a71df50SFrank Blaschka default: 35294a71df50SFrank Blaschka break; 35304a71df50SFrank Blaschka } 35314a71df50SFrank Blaschka return rc; 35324a71df50SFrank Blaschka } 35334a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_mdio_read); 35344a71df50SFrank Blaschka 35354a71df50SFrank Blaschka static int qeth_send_ipa_snmp_cmd(struct qeth_card *card, 35364a71df50SFrank Blaschka struct qeth_cmd_buffer *iob, int len, 35374a71df50SFrank Blaschka int (*reply_cb)(struct qeth_card *, struct qeth_reply *, 35384a71df50SFrank Blaschka unsigned long), 35394a71df50SFrank Blaschka void *reply_param) 35404a71df50SFrank Blaschka { 35414a71df50SFrank Blaschka u16 s1, s2; 35424a71df50SFrank Blaschka 3543d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 4, "sendsnmp"); 35444a71df50SFrank Blaschka 35454a71df50SFrank Blaschka memcpy(iob->data, IPA_PDU_HEADER, IPA_PDU_HEADER_SIZE); 35464a71df50SFrank Blaschka memcpy(QETH_IPA_CMD_DEST_ADDR(iob->data), 35474a71df50SFrank Blaschka &card->token.ulp_connection_r, QETH_MPC_TOKEN_LENGTH); 35484a71df50SFrank Blaschka /* adjust PDU length fields in IPA_PDU_HEADER */ 35494a71df50SFrank Blaschka s1 = (u32) IPA_PDU_HEADER_SIZE + len; 35504a71df50SFrank Blaschka s2 = (u32) len; 35514a71df50SFrank Blaschka memcpy(QETH_IPA_PDU_LEN_TOTAL(iob->data), &s1, 2); 35524a71df50SFrank Blaschka memcpy(QETH_IPA_PDU_LEN_PDU1(iob->data), &s2, 2); 35534a71df50SFrank Blaschka memcpy(QETH_IPA_PDU_LEN_PDU2(iob->data), &s2, 2); 35544a71df50SFrank Blaschka memcpy(QETH_IPA_PDU_LEN_PDU3(iob->data), &s2, 2); 35554a71df50SFrank Blaschka return qeth_send_control_data(card, IPA_PDU_HEADER_SIZE + len, iob, 35564a71df50SFrank Blaschka reply_cb, reply_param); 35574a71df50SFrank Blaschka } 35584a71df50SFrank Blaschka 35594a71df50SFrank Blaschka static int qeth_snmp_command_cb(struct qeth_card *card, 35604a71df50SFrank Blaschka struct qeth_reply *reply, unsigned long sdata) 35614a71df50SFrank Blaschka { 35624a71df50SFrank Blaschka struct qeth_ipa_cmd *cmd; 35634a71df50SFrank Blaschka struct qeth_arp_query_info *qinfo; 35644a71df50SFrank Blaschka struct qeth_snmp_cmd *snmp; 35654a71df50SFrank Blaschka unsigned char *data; 35664a71df50SFrank Blaschka __u16 data_len; 35674a71df50SFrank Blaschka 3568d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 3, "snpcmdcb"); 35694a71df50SFrank Blaschka 35704a71df50SFrank Blaschka cmd = (struct qeth_ipa_cmd *) sdata; 35714a71df50SFrank Blaschka data = (unsigned char *)((char *)cmd - reply->offset); 35724a71df50SFrank Blaschka qinfo = (struct qeth_arp_query_info *) reply->param; 35734a71df50SFrank Blaschka snmp = &cmd->data.setadapterparms.data.snmp; 35744a71df50SFrank Blaschka 35754a71df50SFrank Blaschka if (cmd->hdr.return_code) { 3576d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(TRACE, 4, "scer1%i", cmd->hdr.return_code); 35774a71df50SFrank Blaschka return 0; 35784a71df50SFrank Blaschka } 35794a71df50SFrank Blaschka if (cmd->data.setadapterparms.hdr.return_code) { 35804a71df50SFrank Blaschka cmd->hdr.return_code = 35814a71df50SFrank Blaschka cmd->data.setadapterparms.hdr.return_code; 3582d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(TRACE, 4, "scer2%i", cmd->hdr.return_code); 35834a71df50SFrank Blaschka return 0; 35844a71df50SFrank Blaschka } 35854a71df50SFrank Blaschka data_len = *((__u16 *)QETH_IPA_PDU_LEN_PDU1(data)); 35864a71df50SFrank Blaschka if (cmd->data.setadapterparms.hdr.seq_no == 1) 35874a71df50SFrank Blaschka data_len -= (__u16)((char *)&snmp->data - (char *)cmd); 35884a71df50SFrank Blaschka else 35894a71df50SFrank Blaschka data_len -= (__u16)((char *)&snmp->request - (char *)cmd); 35904a71df50SFrank Blaschka 35914a71df50SFrank Blaschka /* check if there is enough room in userspace */ 35924a71df50SFrank Blaschka if ((qinfo->udata_len - qinfo->udata_offset) < data_len) { 3593d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(TRACE, 4, "scer3%i", -ENOMEM); 35944a71df50SFrank Blaschka cmd->hdr.return_code = -ENOMEM; 35954a71df50SFrank Blaschka return 0; 35964a71df50SFrank Blaschka } 3597d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(TRACE, 4, "snore%i", 35984a71df50SFrank Blaschka cmd->data.setadapterparms.hdr.used_total); 3599d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(TRACE, 4, "sseqn%i", 36004a71df50SFrank Blaschka cmd->data.setadapterparms.hdr.seq_no); 36014a71df50SFrank Blaschka /*copy entries to user buffer*/ 36024a71df50SFrank Blaschka if (cmd->data.setadapterparms.hdr.seq_no == 1) { 36034a71df50SFrank Blaschka memcpy(qinfo->udata + qinfo->udata_offset, 36044a71df50SFrank Blaschka (char *)snmp, 36054a71df50SFrank Blaschka data_len + offsetof(struct qeth_snmp_cmd, data)); 36064a71df50SFrank Blaschka qinfo->udata_offset += offsetof(struct qeth_snmp_cmd, data); 36074a71df50SFrank Blaschka } else { 36084a71df50SFrank Blaschka memcpy(qinfo->udata + qinfo->udata_offset, 36094a71df50SFrank Blaschka (char *)&snmp->request, data_len); 36104a71df50SFrank Blaschka } 36114a71df50SFrank Blaschka qinfo->udata_offset += data_len; 36124a71df50SFrank Blaschka /* check if all replies received ... */ 3613d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(TRACE, 4, "srtot%i", 36144a71df50SFrank Blaschka cmd->data.setadapterparms.hdr.used_total); 3615d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(TRACE, 4, "srseq%i", 36164a71df50SFrank Blaschka cmd->data.setadapterparms.hdr.seq_no); 36174a71df50SFrank Blaschka if (cmd->data.setadapterparms.hdr.seq_no < 36184a71df50SFrank Blaschka cmd->data.setadapterparms.hdr.used_total) 36194a71df50SFrank Blaschka return 1; 36204a71df50SFrank Blaschka return 0; 36214a71df50SFrank Blaschka } 36224a71df50SFrank Blaschka 36234a71df50SFrank Blaschka int qeth_snmp_command(struct qeth_card *card, char __user *udata) 36244a71df50SFrank Blaschka { 36254a71df50SFrank Blaschka struct qeth_cmd_buffer *iob; 36264a71df50SFrank Blaschka struct qeth_ipa_cmd *cmd; 36274a71df50SFrank Blaschka struct qeth_snmp_ureq *ureq; 36284a71df50SFrank Blaschka int req_len; 36294a71df50SFrank Blaschka struct qeth_arp_query_info qinfo = {0, }; 36304a71df50SFrank Blaschka int rc = 0; 36314a71df50SFrank Blaschka 3632d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 3, "snmpcmd"); 36334a71df50SFrank Blaschka 36344a71df50SFrank Blaschka if (card->info.guestlan) 36354a71df50SFrank Blaschka return -EOPNOTSUPP; 36364a71df50SFrank Blaschka 36374a71df50SFrank Blaschka if ((!qeth_adp_supported(card, IPA_SETADP_SET_SNMP_CONTROL)) && 36384a71df50SFrank Blaschka (!card->options.layer2)) { 36394a71df50SFrank Blaschka return -EOPNOTSUPP; 36404a71df50SFrank Blaschka } 36414a71df50SFrank Blaschka /* skip 4 bytes (data_len struct member) to get req_len */ 36424a71df50SFrank Blaschka if (copy_from_user(&req_len, udata + sizeof(int), sizeof(int))) 36434a71df50SFrank Blaschka return -EFAULT; 36444a71df50SFrank Blaschka ureq = kmalloc(req_len+sizeof(struct qeth_snmp_ureq_hdr), GFP_KERNEL); 36454a71df50SFrank Blaschka if (!ureq) { 3646d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 2, "snmpnome"); 36474a71df50SFrank Blaschka return -ENOMEM; 36484a71df50SFrank Blaschka } 36494a71df50SFrank Blaschka if (copy_from_user(ureq, udata, 36504a71df50SFrank Blaschka req_len + sizeof(struct qeth_snmp_ureq_hdr))) { 36514a71df50SFrank Blaschka kfree(ureq); 36524a71df50SFrank Blaschka return -EFAULT; 36534a71df50SFrank Blaschka } 36544a71df50SFrank Blaschka qinfo.udata_len = ureq->hdr.data_len; 36554a71df50SFrank Blaschka qinfo.udata = kzalloc(qinfo.udata_len, GFP_KERNEL); 36564a71df50SFrank Blaschka if (!qinfo.udata) { 36574a71df50SFrank Blaschka kfree(ureq); 36584a71df50SFrank Blaschka return -ENOMEM; 36594a71df50SFrank Blaschka } 36604a71df50SFrank Blaschka qinfo.udata_offset = sizeof(struct qeth_snmp_ureq_hdr); 36614a71df50SFrank Blaschka 36624a71df50SFrank Blaschka iob = qeth_get_adapter_cmd(card, IPA_SETADP_SET_SNMP_CONTROL, 36634a71df50SFrank Blaschka QETH_SNMP_SETADP_CMDLENGTH + req_len); 36644a71df50SFrank Blaschka cmd = (struct qeth_ipa_cmd *)(iob->data+IPA_PDU_HEADER_SIZE); 36654a71df50SFrank Blaschka memcpy(&cmd->data.setadapterparms.data.snmp, &ureq->cmd, req_len); 36664a71df50SFrank Blaschka rc = qeth_send_ipa_snmp_cmd(card, iob, QETH_SETADP_BASE_LEN + req_len, 36674a71df50SFrank Blaschka qeth_snmp_command_cb, (void *)&qinfo); 36684a71df50SFrank Blaschka if (rc) 366914cc21b6SFrank Blaschka QETH_DBF_MESSAGE(2, "SNMP command failed on %s: (0x%x)\n", 36704a71df50SFrank Blaschka QETH_CARD_IFNAME(card), rc); 36714a71df50SFrank Blaschka else { 36724a71df50SFrank Blaschka if (copy_to_user(udata, qinfo.udata, qinfo.udata_len)) 36734a71df50SFrank Blaschka rc = -EFAULT; 36744a71df50SFrank Blaschka } 36754a71df50SFrank Blaschka 36764a71df50SFrank Blaschka kfree(ureq); 36774a71df50SFrank Blaschka kfree(qinfo.udata); 36784a71df50SFrank Blaschka return rc; 36794a71df50SFrank Blaschka } 36804a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_snmp_command); 36814a71df50SFrank Blaschka 36824a71df50SFrank Blaschka static inline int qeth_get_qdio_q_format(struct qeth_card *card) 36834a71df50SFrank Blaschka { 36844a71df50SFrank Blaschka switch (card->info.type) { 36854a71df50SFrank Blaschka case QETH_CARD_TYPE_IQD: 36864a71df50SFrank Blaschka return 2; 36874a71df50SFrank Blaschka default: 36884a71df50SFrank Blaschka return 0; 36894a71df50SFrank Blaschka } 36904a71df50SFrank Blaschka } 36914a71df50SFrank Blaschka 36924a71df50SFrank Blaschka static int qeth_qdio_establish(struct qeth_card *card) 36934a71df50SFrank Blaschka { 36944a71df50SFrank Blaschka struct qdio_initialize init_data; 36954a71df50SFrank Blaschka char *qib_param_field; 36964a71df50SFrank Blaschka struct qdio_buffer **in_sbal_ptrs; 36974a71df50SFrank Blaschka struct qdio_buffer **out_sbal_ptrs; 36984a71df50SFrank Blaschka int i, j, k; 36994a71df50SFrank Blaschka int rc = 0; 37004a71df50SFrank Blaschka 3701d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "qdioest"); 37024a71df50SFrank Blaschka 37034a71df50SFrank Blaschka qib_param_field = kzalloc(QDIO_MAX_BUFFERS_PER_Q * sizeof(char), 37044a71df50SFrank Blaschka GFP_KERNEL); 37054a71df50SFrank Blaschka if (!qib_param_field) 37064a71df50SFrank Blaschka return -ENOMEM; 37074a71df50SFrank Blaschka 37084a71df50SFrank Blaschka qeth_create_qib_param_field(card, qib_param_field); 37094a71df50SFrank Blaschka qeth_create_qib_param_field_blkt(card, qib_param_field); 37104a71df50SFrank Blaschka 37114a71df50SFrank Blaschka in_sbal_ptrs = kmalloc(QDIO_MAX_BUFFERS_PER_Q * sizeof(void *), 37124a71df50SFrank Blaschka GFP_KERNEL); 37134a71df50SFrank Blaschka if (!in_sbal_ptrs) { 37144a71df50SFrank Blaschka kfree(qib_param_field); 37154a71df50SFrank Blaschka return -ENOMEM; 37164a71df50SFrank Blaschka } 37174a71df50SFrank Blaschka for (i = 0; i < QDIO_MAX_BUFFERS_PER_Q; ++i) 37184a71df50SFrank Blaschka in_sbal_ptrs[i] = (struct qdio_buffer *) 37194a71df50SFrank Blaschka virt_to_phys(card->qdio.in_q->bufs[i].buffer); 37204a71df50SFrank Blaschka 37214a71df50SFrank Blaschka out_sbal_ptrs = 37224a71df50SFrank Blaschka kmalloc(card->qdio.no_out_queues * QDIO_MAX_BUFFERS_PER_Q * 37234a71df50SFrank Blaschka sizeof(void *), GFP_KERNEL); 37244a71df50SFrank Blaschka if (!out_sbal_ptrs) { 37254a71df50SFrank Blaschka kfree(in_sbal_ptrs); 37264a71df50SFrank Blaschka kfree(qib_param_field); 37274a71df50SFrank Blaschka return -ENOMEM; 37284a71df50SFrank Blaschka } 37294a71df50SFrank Blaschka for (i = 0, k = 0; i < card->qdio.no_out_queues; ++i) 37304a71df50SFrank Blaschka for (j = 0; j < QDIO_MAX_BUFFERS_PER_Q; ++j, ++k) { 37314a71df50SFrank Blaschka out_sbal_ptrs[k] = (struct qdio_buffer *)virt_to_phys( 37324a71df50SFrank Blaschka card->qdio.out_qs[i]->bufs[j].buffer); 37334a71df50SFrank Blaschka } 37344a71df50SFrank Blaschka 37354a71df50SFrank Blaschka memset(&init_data, 0, sizeof(struct qdio_initialize)); 37364a71df50SFrank Blaschka init_data.cdev = CARD_DDEV(card); 37374a71df50SFrank Blaschka init_data.q_format = qeth_get_qdio_q_format(card); 37384a71df50SFrank Blaschka init_data.qib_param_field_format = 0; 37394a71df50SFrank Blaschka init_data.qib_param_field = qib_param_field; 37404a71df50SFrank Blaschka init_data.no_input_qs = 1; 37414a71df50SFrank Blaschka init_data.no_output_qs = card->qdio.no_out_queues; 37424a71df50SFrank Blaschka init_data.input_handler = card->discipline.input_handler; 37434a71df50SFrank Blaschka init_data.output_handler = card->discipline.output_handler; 37444a71df50SFrank Blaschka init_data.int_parm = (unsigned long) card; 37454a71df50SFrank Blaschka init_data.flags = QDIO_INBOUND_0COPY_SBALS | 37464a71df50SFrank Blaschka QDIO_OUTBOUND_0COPY_SBALS | 37474a71df50SFrank Blaschka QDIO_USE_OUTBOUND_PCIS; 37484a71df50SFrank Blaschka init_data.input_sbal_addr_array = (void **) in_sbal_ptrs; 37494a71df50SFrank Blaschka init_data.output_sbal_addr_array = (void **) out_sbal_ptrs; 37504a71df50SFrank Blaschka 37514a71df50SFrank Blaschka if (atomic_cmpxchg(&card->qdio.state, QETH_QDIO_ALLOCATED, 37524a71df50SFrank Blaschka QETH_QDIO_ESTABLISHED) == QETH_QDIO_ALLOCATED) { 37534a71df50SFrank Blaschka rc = qdio_initialize(&init_data); 37544a71df50SFrank Blaschka if (rc) 37554a71df50SFrank Blaschka atomic_set(&card->qdio.state, QETH_QDIO_ALLOCATED); 37564a71df50SFrank Blaschka } 37574a71df50SFrank Blaschka kfree(out_sbal_ptrs); 37584a71df50SFrank Blaschka kfree(in_sbal_ptrs); 37594a71df50SFrank Blaschka kfree(qib_param_field); 37604a71df50SFrank Blaschka return rc; 37614a71df50SFrank Blaschka } 37624a71df50SFrank Blaschka 37634a71df50SFrank Blaschka static void qeth_core_free_card(struct qeth_card *card) 37644a71df50SFrank Blaschka { 37654a71df50SFrank Blaschka 3766d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "freecrd"); 3767d11ba0c4SPeter Tiedemann QETH_DBF_HEX(SETUP, 2, &card, sizeof(void *)); 37684a71df50SFrank Blaschka qeth_clean_channel(&card->read); 37694a71df50SFrank Blaschka qeth_clean_channel(&card->write); 37704a71df50SFrank Blaschka if (card->dev) 37714a71df50SFrank Blaschka free_netdev(card->dev); 37724a71df50SFrank Blaschka kfree(card->ip_tbd_list); 37734a71df50SFrank Blaschka qeth_free_qdio_buffers(card); 37746bcac508SMartin Schwidefsky unregister_service_level(&card->qeth_service_level); 37754a71df50SFrank Blaschka kfree(card); 37764a71df50SFrank Blaschka } 37774a71df50SFrank Blaschka 37784a71df50SFrank Blaschka static struct ccw_device_id qeth_ids[] = { 37794a71df50SFrank Blaschka {CCW_DEVICE(0x1731, 0x01), .driver_info = QETH_CARD_TYPE_OSAE}, 37804a71df50SFrank Blaschka {CCW_DEVICE(0x1731, 0x05), .driver_info = QETH_CARD_TYPE_IQD}, 37814a71df50SFrank Blaschka {CCW_DEVICE(0x1731, 0x06), .driver_info = QETH_CARD_TYPE_OSN}, 37824a71df50SFrank Blaschka {}, 37834a71df50SFrank Blaschka }; 37844a71df50SFrank Blaschka MODULE_DEVICE_TABLE(ccw, qeth_ids); 37854a71df50SFrank Blaschka 37864a71df50SFrank Blaschka static struct ccw_driver qeth_ccw_driver = { 37874a71df50SFrank Blaschka .name = "qeth", 37884a71df50SFrank Blaschka .ids = qeth_ids, 37894a71df50SFrank Blaschka .probe = ccwgroup_probe_ccwdev, 37904a71df50SFrank Blaschka .remove = ccwgroup_remove_ccwdev, 37914a71df50SFrank Blaschka }; 37924a71df50SFrank Blaschka 37934a71df50SFrank Blaschka static int qeth_core_driver_group(const char *buf, struct device *root_dev, 37944a71df50SFrank Blaschka unsigned long driver_id) 37954a71df50SFrank Blaschka { 3796022b660aSUrsula Braun return ccwgroup_create_from_string(root_dev, driver_id, 3797022b660aSUrsula Braun &qeth_ccw_driver, 3, buf); 37984a71df50SFrank Blaschka } 37994a71df50SFrank Blaschka 38004a71df50SFrank Blaschka int qeth_core_hardsetup_card(struct qeth_card *card) 38014a71df50SFrank Blaschka { 3802bbd50e17SJan Glauber struct qdio_ssqd_desc *ssqd; 38034a71df50SFrank Blaschka int retries = 3; 3804779e6e1cSJan Glauber int mpno = 0; 38054a71df50SFrank Blaschka int rc; 38064a71df50SFrank Blaschka 3807d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "hrdsetup"); 38084a71df50SFrank Blaschka atomic_set(&card->force_alloc_skb, 0); 38094a71df50SFrank Blaschka retry: 38104a71df50SFrank Blaschka if (retries < 3) { 381174eacdb9SFrank Blaschka QETH_DBF_MESSAGE(2, "%s Retrying to do IDX activates.\n", 381274eacdb9SFrank Blaschka dev_name(&card->gdev->dev)); 38134a71df50SFrank Blaschka ccw_device_set_offline(CARD_DDEV(card)); 38144a71df50SFrank Blaschka ccw_device_set_offline(CARD_WDEV(card)); 38154a71df50SFrank Blaschka ccw_device_set_offline(CARD_RDEV(card)); 38164a71df50SFrank Blaschka ccw_device_set_online(CARD_RDEV(card)); 38174a71df50SFrank Blaschka ccw_device_set_online(CARD_WDEV(card)); 38184a71df50SFrank Blaschka ccw_device_set_online(CARD_DDEV(card)); 38194a71df50SFrank Blaschka } 38204a71df50SFrank Blaschka rc = qeth_qdio_clear_card(card, card->info.type != QETH_CARD_TYPE_IQD); 38214a71df50SFrank Blaschka if (rc == -ERESTARTSYS) { 3822d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "break1"); 38234a71df50SFrank Blaschka return rc; 38244a71df50SFrank Blaschka } else if (rc) { 3825d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "1err%d", rc); 38264a71df50SFrank Blaschka if (--retries < 0) 38274a71df50SFrank Blaschka goto out; 38284a71df50SFrank Blaschka else 38294a71df50SFrank Blaschka goto retry; 38304a71df50SFrank Blaschka } 38314a71df50SFrank Blaschka 38324a71df50SFrank Blaschka rc = qeth_get_unitaddr(card); 38334a71df50SFrank Blaschka if (rc) { 3834d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "2err%d", rc); 38354a71df50SFrank Blaschka return rc; 38364a71df50SFrank Blaschka } 3837779e6e1cSJan Glauber 3838bbd50e17SJan Glauber ssqd = kmalloc(sizeof(struct qdio_ssqd_desc), GFP_KERNEL); 3839bbd50e17SJan Glauber if (!ssqd) { 3840bbd50e17SJan Glauber rc = -ENOMEM; 3841bbd50e17SJan Glauber goto out; 3842bbd50e17SJan Glauber } 3843bbd50e17SJan Glauber rc = qdio_get_ssqd_desc(CARD_DDEV(card), ssqd); 3844bbd50e17SJan Glauber if (rc == 0) 3845bbd50e17SJan Glauber mpno = ssqd->pcnt; 3846bbd50e17SJan Glauber kfree(ssqd); 3847bbd50e17SJan Glauber 3848a74b08c7SUrsula Braun if (mpno) 3849a74b08c7SUrsula Braun mpno = min(mpno - 1, QETH_MAX_PORTNO); 38504a71df50SFrank Blaschka if (card->info.portno > mpno) { 385114cc21b6SFrank Blaschka QETH_DBF_MESSAGE(2, "Device %s does not offer port number %d" 385214cc21b6SFrank Blaschka "\n.", CARD_BUS_ID(card), card->info.portno); 38534a71df50SFrank Blaschka rc = -ENODEV; 38544a71df50SFrank Blaschka goto out; 38554a71df50SFrank Blaschka } 38564a71df50SFrank Blaschka qeth_init_tokens(card); 38574a71df50SFrank Blaschka qeth_init_func_level(card); 38584a71df50SFrank Blaschka rc = qeth_idx_activate_channel(&card->read, qeth_idx_read_cb); 38594a71df50SFrank Blaschka if (rc == -ERESTARTSYS) { 3860d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "break2"); 38614a71df50SFrank Blaschka return rc; 38624a71df50SFrank Blaschka } else if (rc) { 3863d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "3err%d", rc); 38644a71df50SFrank Blaschka if (--retries < 0) 38654a71df50SFrank Blaschka goto out; 38664a71df50SFrank Blaschka else 38674a71df50SFrank Blaschka goto retry; 38684a71df50SFrank Blaschka } 38694a71df50SFrank Blaschka rc = qeth_idx_activate_channel(&card->write, qeth_idx_write_cb); 38704a71df50SFrank Blaschka if (rc == -ERESTARTSYS) { 3871d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "break3"); 38724a71df50SFrank Blaschka return rc; 38734a71df50SFrank Blaschka } else if (rc) { 3874d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "4err%d", rc); 38754a71df50SFrank Blaschka if (--retries < 0) 38764a71df50SFrank Blaschka goto out; 38774a71df50SFrank Blaschka else 38784a71df50SFrank Blaschka goto retry; 38794a71df50SFrank Blaschka } 38804a71df50SFrank Blaschka rc = qeth_mpc_initialize(card); 38814a71df50SFrank Blaschka if (rc) { 3882d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "5err%d", rc); 38834a71df50SFrank Blaschka goto out; 38844a71df50SFrank Blaschka } 38854a71df50SFrank Blaschka return 0; 38864a71df50SFrank Blaschka out: 388774eacdb9SFrank Blaschka dev_warn(&card->gdev->dev, "The qeth device driver failed to recover " 388874eacdb9SFrank Blaschka "an error on the device\n"); 388974eacdb9SFrank Blaschka QETH_DBF_MESSAGE(2, "%s Initialization in hardsetup failed! rc=%d\n", 389074eacdb9SFrank Blaschka dev_name(&card->gdev->dev), rc); 38914a71df50SFrank Blaschka return rc; 38924a71df50SFrank Blaschka } 38934a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_core_hardsetup_card); 38944a71df50SFrank Blaschka 38954a71df50SFrank Blaschka static inline int qeth_create_skb_frag(struct qdio_buffer_element *element, 38964a71df50SFrank Blaschka struct sk_buff **pskb, int offset, int *pfrag, int data_len) 38974a71df50SFrank Blaschka { 38984a71df50SFrank Blaschka struct page *page = virt_to_page(element->addr); 38994a71df50SFrank Blaschka if (*pskb == NULL) { 39004a71df50SFrank Blaschka /* the upper protocol layers assume that there is data in the 39014a71df50SFrank Blaschka * skb itself. Copy a small amount (64 bytes) to make them 39024a71df50SFrank Blaschka * happy. */ 39034a71df50SFrank Blaschka *pskb = dev_alloc_skb(64 + ETH_HLEN); 39044a71df50SFrank Blaschka if (!(*pskb)) 39054a71df50SFrank Blaschka return -ENOMEM; 39064a71df50SFrank Blaschka skb_reserve(*pskb, ETH_HLEN); 39074a71df50SFrank Blaschka if (data_len <= 64) { 39084a71df50SFrank Blaschka memcpy(skb_put(*pskb, data_len), element->addr + offset, 39094a71df50SFrank Blaschka data_len); 39104a71df50SFrank Blaschka } else { 39114a71df50SFrank Blaschka get_page(page); 39124a71df50SFrank Blaschka memcpy(skb_put(*pskb, 64), element->addr + offset, 64); 39134a71df50SFrank Blaschka skb_fill_page_desc(*pskb, *pfrag, page, offset + 64, 39144a71df50SFrank Blaschka data_len - 64); 39154a71df50SFrank Blaschka (*pskb)->data_len += data_len - 64; 39164a71df50SFrank Blaschka (*pskb)->len += data_len - 64; 39174a71df50SFrank Blaschka (*pskb)->truesize += data_len - 64; 39184a71df50SFrank Blaschka (*pfrag)++; 39194a71df50SFrank Blaschka } 39204a71df50SFrank Blaschka } else { 39214a71df50SFrank Blaschka get_page(page); 39224a71df50SFrank Blaschka skb_fill_page_desc(*pskb, *pfrag, page, offset, data_len); 39234a71df50SFrank Blaschka (*pskb)->data_len += data_len; 39244a71df50SFrank Blaschka (*pskb)->len += data_len; 39254a71df50SFrank Blaschka (*pskb)->truesize += data_len; 39264a71df50SFrank Blaschka (*pfrag)++; 39274a71df50SFrank Blaschka } 39284a71df50SFrank Blaschka return 0; 39294a71df50SFrank Blaschka } 39304a71df50SFrank Blaschka 39314a71df50SFrank Blaschka struct sk_buff *qeth_core_get_next_skb(struct qeth_card *card, 39324a71df50SFrank Blaschka struct qdio_buffer *buffer, 39334a71df50SFrank Blaschka struct qdio_buffer_element **__element, int *__offset, 39344a71df50SFrank Blaschka struct qeth_hdr **hdr) 39354a71df50SFrank Blaschka { 39364a71df50SFrank Blaschka struct qdio_buffer_element *element = *__element; 39374a71df50SFrank Blaschka int offset = *__offset; 39384a71df50SFrank Blaschka struct sk_buff *skb = NULL; 39394a71df50SFrank Blaschka int skb_len; 39404a71df50SFrank Blaschka void *data_ptr; 39414a71df50SFrank Blaschka int data_len; 39424a71df50SFrank Blaschka int headroom = 0; 39434a71df50SFrank Blaschka int use_rx_sg = 0; 39444a71df50SFrank Blaschka int frag = 0; 39454a71df50SFrank Blaschka 39464a71df50SFrank Blaschka /* qeth_hdr must not cross element boundaries */ 39474a71df50SFrank Blaschka if (element->length < offset + sizeof(struct qeth_hdr)) { 39484a71df50SFrank Blaschka if (qeth_is_last_sbale(element)) 39494a71df50SFrank Blaschka return NULL; 39504a71df50SFrank Blaschka element++; 39514a71df50SFrank Blaschka offset = 0; 39524a71df50SFrank Blaschka if (element->length < sizeof(struct qeth_hdr)) 39534a71df50SFrank Blaschka return NULL; 39544a71df50SFrank Blaschka } 39554a71df50SFrank Blaschka *hdr = element->addr + offset; 39564a71df50SFrank Blaschka 39574a71df50SFrank Blaschka offset += sizeof(struct qeth_hdr); 39584a71df50SFrank Blaschka if (card->options.layer2) { 39594a71df50SFrank Blaschka if (card->info.type == QETH_CARD_TYPE_OSN) { 39604a71df50SFrank Blaschka skb_len = (*hdr)->hdr.osn.pdu_length; 39614a71df50SFrank Blaschka headroom = sizeof(struct qeth_hdr); 39624a71df50SFrank Blaschka } else { 39634a71df50SFrank Blaschka skb_len = (*hdr)->hdr.l2.pkt_length; 39644a71df50SFrank Blaschka } 39654a71df50SFrank Blaschka } else { 39664a71df50SFrank Blaschka skb_len = (*hdr)->hdr.l3.length; 3967b403e685SFrank Blaschka if ((card->info.link_type == QETH_LINK_TYPE_LANE_TR) || 3968b403e685SFrank Blaschka (card->info.link_type == QETH_LINK_TYPE_HSTR)) 3969b403e685SFrank Blaschka headroom = TR_HLEN; 3970b403e685SFrank Blaschka else 3971b403e685SFrank Blaschka headroom = ETH_HLEN; 39724a71df50SFrank Blaschka } 39734a71df50SFrank Blaschka 39744a71df50SFrank Blaschka if (!skb_len) 39754a71df50SFrank Blaschka return NULL; 39764a71df50SFrank Blaschka 39774a71df50SFrank Blaschka if ((skb_len >= card->options.rx_sg_cb) && 39784a71df50SFrank Blaschka (!(card->info.type == QETH_CARD_TYPE_OSN)) && 39794a71df50SFrank Blaschka (!atomic_read(&card->force_alloc_skb))) { 39804a71df50SFrank Blaschka use_rx_sg = 1; 39814a71df50SFrank Blaschka } else { 39824a71df50SFrank Blaschka skb = dev_alloc_skb(skb_len + headroom); 39834a71df50SFrank Blaschka if (!skb) 39844a71df50SFrank Blaschka goto no_mem; 39854a71df50SFrank Blaschka if (headroom) 39864a71df50SFrank Blaschka skb_reserve(skb, headroom); 39874a71df50SFrank Blaschka } 39884a71df50SFrank Blaschka 39894a71df50SFrank Blaschka data_ptr = element->addr + offset; 39904a71df50SFrank Blaschka while (skb_len) { 39914a71df50SFrank Blaschka data_len = min(skb_len, (int)(element->length - offset)); 39924a71df50SFrank Blaschka if (data_len) { 39934a71df50SFrank Blaschka if (use_rx_sg) { 39944a71df50SFrank Blaschka if (qeth_create_skb_frag(element, &skb, offset, 39954a71df50SFrank Blaschka &frag, data_len)) 39964a71df50SFrank Blaschka goto no_mem; 39974a71df50SFrank Blaschka } else { 39984a71df50SFrank Blaschka memcpy(skb_put(skb, data_len), data_ptr, 39994a71df50SFrank Blaschka data_len); 40004a71df50SFrank Blaschka } 40014a71df50SFrank Blaschka } 40024a71df50SFrank Blaschka skb_len -= data_len; 40034a71df50SFrank Blaschka if (skb_len) { 40044a71df50SFrank Blaschka if (qeth_is_last_sbale(element)) { 4005d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 4, "unexeob"); 4006d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(TRACE, 4, "%s", 40074a71df50SFrank Blaschka CARD_BUS_ID(card)); 4008d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(QERR, 2, "unexeob"); 4009d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(QERR, 2, "%s", 40104a71df50SFrank Blaschka CARD_BUS_ID(card)); 4011d11ba0c4SPeter Tiedemann QETH_DBF_HEX(MISC, 4, buffer, sizeof(*buffer)); 40124a71df50SFrank Blaschka dev_kfree_skb_any(skb); 40134a71df50SFrank Blaschka card->stats.rx_errors++; 40144a71df50SFrank Blaschka return NULL; 40154a71df50SFrank Blaschka } 40164a71df50SFrank Blaschka element++; 40174a71df50SFrank Blaschka offset = 0; 40184a71df50SFrank Blaschka data_ptr = element->addr; 40194a71df50SFrank Blaschka } else { 40204a71df50SFrank Blaschka offset += data_len; 40214a71df50SFrank Blaschka } 40224a71df50SFrank Blaschka } 40234a71df50SFrank Blaschka *__element = element; 40244a71df50SFrank Blaschka *__offset = offset; 40254a71df50SFrank Blaschka if (use_rx_sg && card->options.performance_stats) { 40264a71df50SFrank Blaschka card->perf_stats.sg_skbs_rx++; 40274a71df50SFrank Blaschka card->perf_stats.sg_frags_rx += skb_shinfo(skb)->nr_frags; 40284a71df50SFrank Blaschka } 40294a71df50SFrank Blaschka return skb; 40304a71df50SFrank Blaschka no_mem: 40314a71df50SFrank Blaschka if (net_ratelimit()) { 4032d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 2, "noskbmem"); 4033d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(TRACE, 2, "%s", CARD_BUS_ID(card)); 40344a71df50SFrank Blaschka } 40354a71df50SFrank Blaschka card->stats.rx_dropped++; 40364a71df50SFrank Blaschka return NULL; 40374a71df50SFrank Blaschka } 40384a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_core_get_next_skb); 40394a71df50SFrank Blaschka 40404a71df50SFrank Blaschka static void qeth_unregister_dbf_views(void) 40414a71df50SFrank Blaschka { 4042d11ba0c4SPeter Tiedemann int x; 4043d11ba0c4SPeter Tiedemann for (x = 0; x < QETH_DBF_INFOS; x++) { 4044d11ba0c4SPeter Tiedemann debug_unregister(qeth_dbf[x].id); 4045d11ba0c4SPeter Tiedemann qeth_dbf[x].id = NULL; 4046d11ba0c4SPeter Tiedemann } 40474a71df50SFrank Blaschka } 40484a71df50SFrank Blaschka 4049345aa66eSPeter Tiedemann void qeth_dbf_longtext(enum qeth_dbf_names dbf_nix, int level, char *fmt, ...) 4050cd023216SPeter Tiedemann { 4051cd023216SPeter Tiedemann char dbf_txt_buf[32]; 4052345aa66eSPeter Tiedemann va_list args; 4053cd023216SPeter Tiedemann 4054cd023216SPeter Tiedemann if (level > (qeth_dbf[dbf_nix].id)->level) 4055cd023216SPeter Tiedemann return; 4056345aa66eSPeter Tiedemann va_start(args, fmt); 4057345aa66eSPeter Tiedemann vsnprintf(dbf_txt_buf, sizeof(dbf_txt_buf), fmt, args); 4058345aa66eSPeter Tiedemann va_end(args); 4059cd023216SPeter Tiedemann debug_text_event(qeth_dbf[dbf_nix].id, level, dbf_txt_buf); 4060cd023216SPeter Tiedemann } 4061cd023216SPeter Tiedemann EXPORT_SYMBOL_GPL(qeth_dbf_longtext); 4062cd023216SPeter Tiedemann 40634a71df50SFrank Blaschka static int qeth_register_dbf_views(void) 40644a71df50SFrank Blaschka { 4065d11ba0c4SPeter Tiedemann int ret; 4066d11ba0c4SPeter Tiedemann int x; 40674a71df50SFrank Blaschka 4068d11ba0c4SPeter Tiedemann for (x = 0; x < QETH_DBF_INFOS; x++) { 4069d11ba0c4SPeter Tiedemann /* register the areas */ 4070d11ba0c4SPeter Tiedemann qeth_dbf[x].id = debug_register(qeth_dbf[x].name, 4071d11ba0c4SPeter Tiedemann qeth_dbf[x].pages, 4072d11ba0c4SPeter Tiedemann qeth_dbf[x].areas, 4073d11ba0c4SPeter Tiedemann qeth_dbf[x].len); 4074d11ba0c4SPeter Tiedemann if (qeth_dbf[x].id == NULL) { 40754a71df50SFrank Blaschka qeth_unregister_dbf_views(); 40764a71df50SFrank Blaschka return -ENOMEM; 40774a71df50SFrank Blaschka } 40784a71df50SFrank Blaschka 4079d11ba0c4SPeter Tiedemann /* register a view */ 4080d11ba0c4SPeter Tiedemann ret = debug_register_view(qeth_dbf[x].id, qeth_dbf[x].view); 4081d11ba0c4SPeter Tiedemann if (ret) { 4082d11ba0c4SPeter Tiedemann qeth_unregister_dbf_views(); 4083d11ba0c4SPeter Tiedemann return ret; 4084d11ba0c4SPeter Tiedemann } 40854a71df50SFrank Blaschka 4086d11ba0c4SPeter Tiedemann /* set a passing level */ 4087d11ba0c4SPeter Tiedemann debug_set_level(qeth_dbf[x].id, qeth_dbf[x].level); 4088d11ba0c4SPeter Tiedemann } 40894a71df50SFrank Blaschka 40904a71df50SFrank Blaschka return 0; 40914a71df50SFrank Blaschka } 40924a71df50SFrank Blaschka 40934a71df50SFrank Blaschka int qeth_core_load_discipline(struct qeth_card *card, 40944a71df50SFrank Blaschka enum qeth_discipline_id discipline) 40954a71df50SFrank Blaschka { 40964a71df50SFrank Blaschka int rc = 0; 40974a71df50SFrank Blaschka switch (discipline) { 40984a71df50SFrank Blaschka case QETH_DISCIPLINE_LAYER3: 40994a71df50SFrank Blaschka card->discipline.ccwgdriver = try_then_request_module( 41004a71df50SFrank Blaschka symbol_get(qeth_l3_ccwgroup_driver), 41014a71df50SFrank Blaschka "qeth_l3"); 41024a71df50SFrank Blaschka break; 41034a71df50SFrank Blaschka case QETH_DISCIPLINE_LAYER2: 41044a71df50SFrank Blaschka card->discipline.ccwgdriver = try_then_request_module( 41054a71df50SFrank Blaschka symbol_get(qeth_l2_ccwgroup_driver), 41064a71df50SFrank Blaschka "qeth_l2"); 41074a71df50SFrank Blaschka break; 41084a71df50SFrank Blaschka } 41094a71df50SFrank Blaschka if (!card->discipline.ccwgdriver) { 411074eacdb9SFrank Blaschka dev_err(&card->gdev->dev, "There is no kernel module to " 411174eacdb9SFrank Blaschka "support discipline %d\n", discipline); 41124a71df50SFrank Blaschka rc = -EINVAL; 41134a71df50SFrank Blaschka } 41144a71df50SFrank Blaschka return rc; 41154a71df50SFrank Blaschka } 41164a71df50SFrank Blaschka 41174a71df50SFrank Blaschka void qeth_core_free_discipline(struct qeth_card *card) 41184a71df50SFrank Blaschka { 41194a71df50SFrank Blaschka if (card->options.layer2) 41204a71df50SFrank Blaschka symbol_put(qeth_l2_ccwgroup_driver); 41214a71df50SFrank Blaschka else 41224a71df50SFrank Blaschka symbol_put(qeth_l3_ccwgroup_driver); 41234a71df50SFrank Blaschka card->discipline.ccwgdriver = NULL; 41244a71df50SFrank Blaschka } 41254a71df50SFrank Blaschka 41264a71df50SFrank Blaschka static int qeth_core_probe_device(struct ccwgroup_device *gdev) 41274a71df50SFrank Blaschka { 41284a71df50SFrank Blaschka struct qeth_card *card; 41294a71df50SFrank Blaschka struct device *dev; 41304a71df50SFrank Blaschka int rc; 41314a71df50SFrank Blaschka unsigned long flags; 41324a71df50SFrank Blaschka 4133d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "probedev"); 41344a71df50SFrank Blaschka 41354a71df50SFrank Blaschka dev = &gdev->dev; 41364a71df50SFrank Blaschka if (!get_device(dev)) 41374a71df50SFrank Blaschka return -ENODEV; 41384a71df50SFrank Blaschka 41392a0217d5SKay Sievers QETH_DBF_TEXT_(SETUP, 2, "%s", dev_name(&gdev->dev)); 41404a71df50SFrank Blaschka 41414a71df50SFrank Blaschka card = qeth_alloc_card(); 41424a71df50SFrank Blaschka if (!card) { 4143d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "1err%d", -ENOMEM); 41444a71df50SFrank Blaschka rc = -ENOMEM; 41454a71df50SFrank Blaschka goto err_dev; 41464a71df50SFrank Blaschka } 41474a71df50SFrank Blaschka card->read.ccwdev = gdev->cdev[0]; 41484a71df50SFrank Blaschka card->write.ccwdev = gdev->cdev[1]; 41494a71df50SFrank Blaschka card->data.ccwdev = gdev->cdev[2]; 41504a71df50SFrank Blaschka dev_set_drvdata(&gdev->dev, card); 41514a71df50SFrank Blaschka card->gdev = gdev; 41524a71df50SFrank Blaschka gdev->cdev[0]->handler = qeth_irq; 41534a71df50SFrank Blaschka gdev->cdev[1]->handler = qeth_irq; 41544a71df50SFrank Blaschka gdev->cdev[2]->handler = qeth_irq; 41554a71df50SFrank Blaschka 41564a71df50SFrank Blaschka rc = qeth_determine_card_type(card); 41574a71df50SFrank Blaschka if (rc) { 4158d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "3err%d", rc); 41594a71df50SFrank Blaschka goto err_card; 41604a71df50SFrank Blaschka } 41614a71df50SFrank Blaschka rc = qeth_setup_card(card); 41624a71df50SFrank Blaschka if (rc) { 4163d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "2err%d", rc); 41644a71df50SFrank Blaschka goto err_card; 41654a71df50SFrank Blaschka } 41664a71df50SFrank Blaschka 41674a71df50SFrank Blaschka if (card->info.type == QETH_CARD_TYPE_OSN) { 41684a71df50SFrank Blaschka rc = qeth_core_create_osn_attributes(dev); 41694a71df50SFrank Blaschka if (rc) 41704a71df50SFrank Blaschka goto err_card; 41714a71df50SFrank Blaschka rc = qeth_core_load_discipline(card, QETH_DISCIPLINE_LAYER2); 41724a71df50SFrank Blaschka if (rc) { 41734a71df50SFrank Blaschka qeth_core_remove_osn_attributes(dev); 41744a71df50SFrank Blaschka goto err_card; 41754a71df50SFrank Blaschka } 41764a71df50SFrank Blaschka rc = card->discipline.ccwgdriver->probe(card->gdev); 41774a71df50SFrank Blaschka if (rc) { 41784a71df50SFrank Blaschka qeth_core_free_discipline(card); 41794a71df50SFrank Blaschka qeth_core_remove_osn_attributes(dev); 41804a71df50SFrank Blaschka goto err_card; 41814a71df50SFrank Blaschka } 41824a71df50SFrank Blaschka } else { 41834a71df50SFrank Blaschka rc = qeth_core_create_device_attributes(dev); 41844a71df50SFrank Blaschka if (rc) 41854a71df50SFrank Blaschka goto err_card; 41864a71df50SFrank Blaschka } 41874a71df50SFrank Blaschka 41884a71df50SFrank Blaschka write_lock_irqsave(&qeth_core_card_list.rwlock, flags); 41894a71df50SFrank Blaschka list_add_tail(&card->list, &qeth_core_card_list.list); 41904a71df50SFrank Blaschka write_unlock_irqrestore(&qeth_core_card_list.rwlock, flags); 41914a71df50SFrank Blaschka return 0; 41924a71df50SFrank Blaschka 41934a71df50SFrank Blaschka err_card: 41944a71df50SFrank Blaschka qeth_core_free_card(card); 41954a71df50SFrank Blaschka err_dev: 41964a71df50SFrank Blaschka put_device(dev); 41974a71df50SFrank Blaschka return rc; 41984a71df50SFrank Blaschka } 41994a71df50SFrank Blaschka 42004a71df50SFrank Blaschka static void qeth_core_remove_device(struct ccwgroup_device *gdev) 42014a71df50SFrank Blaschka { 42024a71df50SFrank Blaschka unsigned long flags; 42034a71df50SFrank Blaschka struct qeth_card *card = dev_get_drvdata(&gdev->dev); 42044a71df50SFrank Blaschka 420528a7e4c9SUrsula Braun QETH_DBF_TEXT(SETUP, 2, "removedv"); 42064a71df50SFrank Blaschka if (card->discipline.ccwgdriver) { 42074a71df50SFrank Blaschka card->discipline.ccwgdriver->remove(gdev); 42084a71df50SFrank Blaschka qeth_core_free_discipline(card); 42094a71df50SFrank Blaschka } 42104a71df50SFrank Blaschka 42114a71df50SFrank Blaschka if (card->info.type == QETH_CARD_TYPE_OSN) { 42124a71df50SFrank Blaschka qeth_core_remove_osn_attributes(&gdev->dev); 42134a71df50SFrank Blaschka } else { 42144a71df50SFrank Blaschka qeth_core_remove_device_attributes(&gdev->dev); 42154a71df50SFrank Blaschka } 42164a71df50SFrank Blaschka write_lock_irqsave(&qeth_core_card_list.rwlock, flags); 42174a71df50SFrank Blaschka list_del(&card->list); 42184a71df50SFrank Blaschka write_unlock_irqrestore(&qeth_core_card_list.rwlock, flags); 42194a71df50SFrank Blaschka qeth_core_free_card(card); 42204a71df50SFrank Blaschka dev_set_drvdata(&gdev->dev, NULL); 42214a71df50SFrank Blaschka put_device(&gdev->dev); 42224a71df50SFrank Blaschka return; 42234a71df50SFrank Blaschka } 42244a71df50SFrank Blaschka 42254a71df50SFrank Blaschka static int qeth_core_set_online(struct ccwgroup_device *gdev) 42264a71df50SFrank Blaschka { 42274a71df50SFrank Blaschka struct qeth_card *card = dev_get_drvdata(&gdev->dev); 42284a71df50SFrank Blaschka int rc = 0; 42294a71df50SFrank Blaschka int def_discipline; 42304a71df50SFrank Blaschka 42314a71df50SFrank Blaschka if (!card->discipline.ccwgdriver) { 42324a71df50SFrank Blaschka if (card->info.type == QETH_CARD_TYPE_IQD) 42334a71df50SFrank Blaschka def_discipline = QETH_DISCIPLINE_LAYER3; 42344a71df50SFrank Blaschka else 42354a71df50SFrank Blaschka def_discipline = QETH_DISCIPLINE_LAYER2; 42364a71df50SFrank Blaschka rc = qeth_core_load_discipline(card, def_discipline); 42374a71df50SFrank Blaschka if (rc) 42384a71df50SFrank Blaschka goto err; 42394a71df50SFrank Blaschka rc = card->discipline.ccwgdriver->probe(card->gdev); 42404a71df50SFrank Blaschka if (rc) 42414a71df50SFrank Blaschka goto err; 42424a71df50SFrank Blaschka } 42434a71df50SFrank Blaschka rc = card->discipline.ccwgdriver->set_online(gdev); 42444a71df50SFrank Blaschka err: 42454a71df50SFrank Blaschka return rc; 42464a71df50SFrank Blaschka } 42474a71df50SFrank Blaschka 42484a71df50SFrank Blaschka static int qeth_core_set_offline(struct ccwgroup_device *gdev) 42494a71df50SFrank Blaschka { 42504a71df50SFrank Blaschka struct qeth_card *card = dev_get_drvdata(&gdev->dev); 42514a71df50SFrank Blaschka return card->discipline.ccwgdriver->set_offline(gdev); 42524a71df50SFrank Blaschka } 42534a71df50SFrank Blaschka 42544a71df50SFrank Blaschka static void qeth_core_shutdown(struct ccwgroup_device *gdev) 42554a71df50SFrank Blaschka { 42564a71df50SFrank Blaschka struct qeth_card *card = dev_get_drvdata(&gdev->dev); 42574a71df50SFrank Blaschka if (card->discipline.ccwgdriver && 42584a71df50SFrank Blaschka card->discipline.ccwgdriver->shutdown) 42594a71df50SFrank Blaschka card->discipline.ccwgdriver->shutdown(gdev); 42604a71df50SFrank Blaschka } 42614a71df50SFrank Blaschka 42624a71df50SFrank Blaschka static struct ccwgroup_driver qeth_core_ccwgroup_driver = { 42634a71df50SFrank Blaschka .owner = THIS_MODULE, 42644a71df50SFrank Blaschka .name = "qeth", 42654a71df50SFrank Blaschka .driver_id = 0xD8C5E3C8, 42664a71df50SFrank Blaschka .probe = qeth_core_probe_device, 42674a71df50SFrank Blaschka .remove = qeth_core_remove_device, 42684a71df50SFrank Blaschka .set_online = qeth_core_set_online, 42694a71df50SFrank Blaschka .set_offline = qeth_core_set_offline, 42704a71df50SFrank Blaschka .shutdown = qeth_core_shutdown, 42714a71df50SFrank Blaschka }; 42724a71df50SFrank Blaschka 42734a71df50SFrank Blaschka static ssize_t 42744a71df50SFrank Blaschka qeth_core_driver_group_store(struct device_driver *ddrv, const char *buf, 42754a71df50SFrank Blaschka size_t count) 42764a71df50SFrank Blaschka { 42774a71df50SFrank Blaschka int err; 42784a71df50SFrank Blaschka err = qeth_core_driver_group(buf, qeth_core_root_dev, 42794a71df50SFrank Blaschka qeth_core_ccwgroup_driver.driver_id); 42804a71df50SFrank Blaschka if (err) 42814a71df50SFrank Blaschka return err; 42824a71df50SFrank Blaschka else 42834a71df50SFrank Blaschka return count; 42844a71df50SFrank Blaschka } 42854a71df50SFrank Blaschka 42864a71df50SFrank Blaschka static DRIVER_ATTR(group, 0200, NULL, qeth_core_driver_group_store); 42874a71df50SFrank Blaschka 42884a71df50SFrank Blaschka static struct { 42894a71df50SFrank Blaschka const char str[ETH_GSTRING_LEN]; 42904a71df50SFrank Blaschka } qeth_ethtool_stats_keys[] = { 42914a71df50SFrank Blaschka /* 0 */{"rx skbs"}, 42924a71df50SFrank Blaschka {"rx buffers"}, 42934a71df50SFrank Blaschka {"tx skbs"}, 42944a71df50SFrank Blaschka {"tx buffers"}, 42954a71df50SFrank Blaschka {"tx skbs no packing"}, 42964a71df50SFrank Blaschka {"tx buffers no packing"}, 42974a71df50SFrank Blaschka {"tx skbs packing"}, 42984a71df50SFrank Blaschka {"tx buffers packing"}, 42994a71df50SFrank Blaschka {"tx sg skbs"}, 43004a71df50SFrank Blaschka {"tx sg frags"}, 43014a71df50SFrank Blaschka /* 10 */{"rx sg skbs"}, 43024a71df50SFrank Blaschka {"rx sg frags"}, 43034a71df50SFrank Blaschka {"rx sg page allocs"}, 43044a71df50SFrank Blaschka {"tx large kbytes"}, 43054a71df50SFrank Blaschka {"tx large count"}, 43064a71df50SFrank Blaschka {"tx pk state ch n->p"}, 43074a71df50SFrank Blaschka {"tx pk state ch p->n"}, 43084a71df50SFrank Blaschka {"tx pk watermark low"}, 43094a71df50SFrank Blaschka {"tx pk watermark high"}, 43104a71df50SFrank Blaschka {"queue 0 buffer usage"}, 43114a71df50SFrank Blaschka /* 20 */{"queue 1 buffer usage"}, 43124a71df50SFrank Blaschka {"queue 2 buffer usage"}, 43134a71df50SFrank Blaschka {"queue 3 buffer usage"}, 43144a71df50SFrank Blaschka {"rx handler time"}, 43154a71df50SFrank Blaschka {"rx handler count"}, 43164a71df50SFrank Blaschka {"rx do_QDIO time"}, 43174a71df50SFrank Blaschka {"rx do_QDIO count"}, 43184a71df50SFrank Blaschka {"tx handler time"}, 43194a71df50SFrank Blaschka {"tx handler count"}, 43204a71df50SFrank Blaschka {"tx time"}, 43214a71df50SFrank Blaschka /* 30 */{"tx count"}, 43224a71df50SFrank Blaschka {"tx do_QDIO time"}, 43234a71df50SFrank Blaschka {"tx do_QDIO count"}, 43244a71df50SFrank Blaschka }; 43254a71df50SFrank Blaschka 43264a71df50SFrank Blaschka int qeth_core_get_stats_count(struct net_device *dev) 43274a71df50SFrank Blaschka { 43284a71df50SFrank Blaschka return (sizeof(qeth_ethtool_stats_keys) / ETH_GSTRING_LEN); 43294a71df50SFrank Blaschka } 43304a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_core_get_stats_count); 43314a71df50SFrank Blaschka 43324a71df50SFrank Blaschka void qeth_core_get_ethtool_stats(struct net_device *dev, 43334a71df50SFrank Blaschka struct ethtool_stats *stats, u64 *data) 43344a71df50SFrank Blaschka { 4335509e2562SHeiko Carstens struct qeth_card *card = dev->ml_priv; 43364a71df50SFrank Blaschka data[0] = card->stats.rx_packets - 43374a71df50SFrank Blaschka card->perf_stats.initial_rx_packets; 43384a71df50SFrank Blaschka data[1] = card->perf_stats.bufs_rec; 43394a71df50SFrank Blaschka data[2] = card->stats.tx_packets - 43404a71df50SFrank Blaschka card->perf_stats.initial_tx_packets; 43414a71df50SFrank Blaschka data[3] = card->perf_stats.bufs_sent; 43424a71df50SFrank Blaschka data[4] = card->stats.tx_packets - card->perf_stats.initial_tx_packets 43434a71df50SFrank Blaschka - card->perf_stats.skbs_sent_pack; 43444a71df50SFrank Blaschka data[5] = card->perf_stats.bufs_sent - card->perf_stats.bufs_sent_pack; 43454a71df50SFrank Blaschka data[6] = card->perf_stats.skbs_sent_pack; 43464a71df50SFrank Blaschka data[7] = card->perf_stats.bufs_sent_pack; 43474a71df50SFrank Blaschka data[8] = card->perf_stats.sg_skbs_sent; 43484a71df50SFrank Blaschka data[9] = card->perf_stats.sg_frags_sent; 43494a71df50SFrank Blaschka data[10] = card->perf_stats.sg_skbs_rx; 43504a71df50SFrank Blaschka data[11] = card->perf_stats.sg_frags_rx; 43514a71df50SFrank Blaschka data[12] = card->perf_stats.sg_alloc_page_rx; 43524a71df50SFrank Blaschka data[13] = (card->perf_stats.large_send_bytes >> 10); 43534a71df50SFrank Blaschka data[14] = card->perf_stats.large_send_cnt; 43544a71df50SFrank Blaschka data[15] = card->perf_stats.sc_dp_p; 43554a71df50SFrank Blaschka data[16] = card->perf_stats.sc_p_dp; 43564a71df50SFrank Blaschka data[17] = QETH_LOW_WATERMARK_PACK; 43574a71df50SFrank Blaschka data[18] = QETH_HIGH_WATERMARK_PACK; 43584a71df50SFrank Blaschka data[19] = atomic_read(&card->qdio.out_qs[0]->used_buffers); 43594a71df50SFrank Blaschka data[20] = (card->qdio.no_out_queues > 1) ? 43604a71df50SFrank Blaschka atomic_read(&card->qdio.out_qs[1]->used_buffers) : 0; 43614a71df50SFrank Blaschka data[21] = (card->qdio.no_out_queues > 2) ? 43624a71df50SFrank Blaschka atomic_read(&card->qdio.out_qs[2]->used_buffers) : 0; 43634a71df50SFrank Blaschka data[22] = (card->qdio.no_out_queues > 3) ? 43644a71df50SFrank Blaschka atomic_read(&card->qdio.out_qs[3]->used_buffers) : 0; 43654a71df50SFrank Blaschka data[23] = card->perf_stats.inbound_time; 43664a71df50SFrank Blaschka data[24] = card->perf_stats.inbound_cnt; 43674a71df50SFrank Blaschka data[25] = card->perf_stats.inbound_do_qdio_time; 43684a71df50SFrank Blaschka data[26] = card->perf_stats.inbound_do_qdio_cnt; 43694a71df50SFrank Blaschka data[27] = card->perf_stats.outbound_handler_time; 43704a71df50SFrank Blaschka data[28] = card->perf_stats.outbound_handler_cnt; 43714a71df50SFrank Blaschka data[29] = card->perf_stats.outbound_time; 43724a71df50SFrank Blaschka data[30] = card->perf_stats.outbound_cnt; 43734a71df50SFrank Blaschka data[31] = card->perf_stats.outbound_do_qdio_time; 43744a71df50SFrank Blaschka data[32] = card->perf_stats.outbound_do_qdio_cnt; 43754a71df50SFrank Blaschka } 43764a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_core_get_ethtool_stats); 43774a71df50SFrank Blaschka 43784a71df50SFrank Blaschka void qeth_core_get_strings(struct net_device *dev, u32 stringset, u8 *data) 43794a71df50SFrank Blaschka { 43804a71df50SFrank Blaschka switch (stringset) { 43814a71df50SFrank Blaschka case ETH_SS_STATS: 43824a71df50SFrank Blaschka memcpy(data, &qeth_ethtool_stats_keys, 43834a71df50SFrank Blaschka sizeof(qeth_ethtool_stats_keys)); 43844a71df50SFrank Blaschka break; 43854a71df50SFrank Blaschka default: 43864a71df50SFrank Blaschka WARN_ON(1); 43874a71df50SFrank Blaschka break; 43884a71df50SFrank Blaschka } 43894a71df50SFrank Blaschka } 43904a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_core_get_strings); 43914a71df50SFrank Blaschka 43924a71df50SFrank Blaschka void qeth_core_get_drvinfo(struct net_device *dev, 43934a71df50SFrank Blaschka struct ethtool_drvinfo *info) 43944a71df50SFrank Blaschka { 4395509e2562SHeiko Carstens struct qeth_card *card = dev->ml_priv; 43964a71df50SFrank Blaschka if (card->options.layer2) 43974a71df50SFrank Blaschka strcpy(info->driver, "qeth_l2"); 43984a71df50SFrank Blaschka else 43994a71df50SFrank Blaschka strcpy(info->driver, "qeth_l3"); 44004a71df50SFrank Blaschka 44014a71df50SFrank Blaschka strcpy(info->version, "1.0"); 44024a71df50SFrank Blaschka strcpy(info->fw_version, card->info.mcl_level); 44034a71df50SFrank Blaschka sprintf(info->bus_info, "%s/%s/%s", 44044a71df50SFrank Blaschka CARD_RDEV_ID(card), 44054a71df50SFrank Blaschka CARD_WDEV_ID(card), 44064a71df50SFrank Blaschka CARD_DDEV_ID(card)); 44074a71df50SFrank Blaschka } 44084a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_core_get_drvinfo); 44094a71df50SFrank Blaschka 44103f9975aaSFrank Blaschka int qeth_core_ethtool_get_settings(struct net_device *netdev, 44113f9975aaSFrank Blaschka struct ethtool_cmd *ecmd) 44123f9975aaSFrank Blaschka { 4413509e2562SHeiko Carstens struct qeth_card *card = netdev->ml_priv; 44143f9975aaSFrank Blaschka enum qeth_link_types link_type; 44153f9975aaSFrank Blaschka 44163f9975aaSFrank Blaschka if ((card->info.type == QETH_CARD_TYPE_IQD) || (card->info.guestlan)) 44173f9975aaSFrank Blaschka link_type = QETH_LINK_TYPE_10GBIT_ETH; 44183f9975aaSFrank Blaschka else 44193f9975aaSFrank Blaschka link_type = card->info.link_type; 44203f9975aaSFrank Blaschka 44213f9975aaSFrank Blaschka ecmd->transceiver = XCVR_INTERNAL; 44223f9975aaSFrank Blaschka ecmd->supported = SUPPORTED_Autoneg; 44233f9975aaSFrank Blaschka ecmd->advertising = ADVERTISED_Autoneg; 44243f9975aaSFrank Blaschka ecmd->duplex = DUPLEX_FULL; 44253f9975aaSFrank Blaschka ecmd->autoneg = AUTONEG_ENABLE; 44263f9975aaSFrank Blaschka 44273f9975aaSFrank Blaschka switch (link_type) { 44283f9975aaSFrank Blaschka case QETH_LINK_TYPE_FAST_ETH: 44293f9975aaSFrank Blaschka case QETH_LINK_TYPE_LANE_ETH100: 44303f9975aaSFrank Blaschka ecmd->supported |= SUPPORTED_10baseT_Half | 44313f9975aaSFrank Blaschka SUPPORTED_10baseT_Full | 44323f9975aaSFrank Blaschka SUPPORTED_100baseT_Half | 44333f9975aaSFrank Blaschka SUPPORTED_100baseT_Full | 44343f9975aaSFrank Blaschka SUPPORTED_TP; 44353f9975aaSFrank Blaschka ecmd->advertising |= ADVERTISED_10baseT_Half | 44363f9975aaSFrank Blaschka ADVERTISED_10baseT_Full | 44373f9975aaSFrank Blaschka ADVERTISED_100baseT_Half | 44383f9975aaSFrank Blaschka ADVERTISED_100baseT_Full | 44393f9975aaSFrank Blaschka ADVERTISED_TP; 44403f9975aaSFrank Blaschka ecmd->speed = SPEED_100; 44413f9975aaSFrank Blaschka ecmd->port = PORT_TP; 44423f9975aaSFrank Blaschka break; 44433f9975aaSFrank Blaschka 44443f9975aaSFrank Blaschka case QETH_LINK_TYPE_GBIT_ETH: 44453f9975aaSFrank Blaschka case QETH_LINK_TYPE_LANE_ETH1000: 44463f9975aaSFrank Blaschka ecmd->supported |= SUPPORTED_10baseT_Half | 44473f9975aaSFrank Blaschka SUPPORTED_10baseT_Full | 44483f9975aaSFrank Blaschka SUPPORTED_100baseT_Half | 44493f9975aaSFrank Blaschka SUPPORTED_100baseT_Full | 44503f9975aaSFrank Blaschka SUPPORTED_1000baseT_Half | 44513f9975aaSFrank Blaschka SUPPORTED_1000baseT_Full | 44523f9975aaSFrank Blaschka SUPPORTED_FIBRE; 44533f9975aaSFrank Blaschka ecmd->advertising |= ADVERTISED_10baseT_Half | 44543f9975aaSFrank Blaschka ADVERTISED_10baseT_Full | 44553f9975aaSFrank Blaschka ADVERTISED_100baseT_Half | 44563f9975aaSFrank Blaschka ADVERTISED_100baseT_Full | 44573f9975aaSFrank Blaschka ADVERTISED_1000baseT_Half | 44583f9975aaSFrank Blaschka ADVERTISED_1000baseT_Full | 44593f9975aaSFrank Blaschka ADVERTISED_FIBRE; 44603f9975aaSFrank Blaschka ecmd->speed = SPEED_1000; 44613f9975aaSFrank Blaschka ecmd->port = PORT_FIBRE; 44623f9975aaSFrank Blaschka break; 44633f9975aaSFrank Blaschka 44643f9975aaSFrank Blaschka case QETH_LINK_TYPE_10GBIT_ETH: 44653f9975aaSFrank Blaschka ecmd->supported |= SUPPORTED_10baseT_Half | 44663f9975aaSFrank Blaschka SUPPORTED_10baseT_Full | 44673f9975aaSFrank Blaschka SUPPORTED_100baseT_Half | 44683f9975aaSFrank Blaschka SUPPORTED_100baseT_Full | 44693f9975aaSFrank Blaschka SUPPORTED_1000baseT_Half | 44703f9975aaSFrank Blaschka SUPPORTED_1000baseT_Full | 44713f9975aaSFrank Blaschka SUPPORTED_10000baseT_Full | 44723f9975aaSFrank Blaschka SUPPORTED_FIBRE; 44733f9975aaSFrank Blaschka ecmd->advertising |= ADVERTISED_10baseT_Half | 44743f9975aaSFrank Blaschka ADVERTISED_10baseT_Full | 44753f9975aaSFrank Blaschka ADVERTISED_100baseT_Half | 44763f9975aaSFrank Blaschka ADVERTISED_100baseT_Full | 44773f9975aaSFrank Blaschka ADVERTISED_1000baseT_Half | 44783f9975aaSFrank Blaschka ADVERTISED_1000baseT_Full | 44793f9975aaSFrank Blaschka ADVERTISED_10000baseT_Full | 44803f9975aaSFrank Blaschka ADVERTISED_FIBRE; 44813f9975aaSFrank Blaschka ecmd->speed = SPEED_10000; 44823f9975aaSFrank Blaschka ecmd->port = PORT_FIBRE; 44833f9975aaSFrank Blaschka break; 44843f9975aaSFrank Blaschka 44853f9975aaSFrank Blaschka default: 44863f9975aaSFrank Blaschka ecmd->supported |= SUPPORTED_10baseT_Half | 44873f9975aaSFrank Blaschka SUPPORTED_10baseT_Full | 44883f9975aaSFrank Blaschka SUPPORTED_TP; 44893f9975aaSFrank Blaschka ecmd->advertising |= ADVERTISED_10baseT_Half | 44903f9975aaSFrank Blaschka ADVERTISED_10baseT_Full | 44913f9975aaSFrank Blaschka ADVERTISED_TP; 44923f9975aaSFrank Blaschka ecmd->speed = SPEED_10; 44933f9975aaSFrank Blaschka ecmd->port = PORT_TP; 44943f9975aaSFrank Blaschka } 44953f9975aaSFrank Blaschka 44963f9975aaSFrank Blaschka return 0; 44973f9975aaSFrank Blaschka } 44983f9975aaSFrank Blaschka EXPORT_SYMBOL_GPL(qeth_core_ethtool_get_settings); 44993f9975aaSFrank Blaschka 45004a71df50SFrank Blaschka static int __init qeth_core_init(void) 45014a71df50SFrank Blaschka { 45024a71df50SFrank Blaschka int rc; 45034a71df50SFrank Blaschka 450474eacdb9SFrank Blaschka pr_info("loading core functions\n"); 45054a71df50SFrank Blaschka INIT_LIST_HEAD(&qeth_core_card_list.list); 45064a71df50SFrank Blaschka rwlock_init(&qeth_core_card_list.rwlock); 45074a71df50SFrank Blaschka 45084a71df50SFrank Blaschka rc = qeth_register_dbf_views(); 45094a71df50SFrank Blaschka if (rc) 45104a71df50SFrank Blaschka goto out_err; 45114a71df50SFrank Blaschka rc = ccw_driver_register(&qeth_ccw_driver); 45124a71df50SFrank Blaschka if (rc) 45134a71df50SFrank Blaschka goto ccw_err; 45144a71df50SFrank Blaschka rc = ccwgroup_driver_register(&qeth_core_ccwgroup_driver); 45154a71df50SFrank Blaschka if (rc) 45164a71df50SFrank Blaschka goto ccwgroup_err; 45174a71df50SFrank Blaschka rc = driver_create_file(&qeth_core_ccwgroup_driver.driver, 45184a71df50SFrank Blaschka &driver_attr_group); 45194a71df50SFrank Blaschka if (rc) 45204a71df50SFrank Blaschka goto driver_err; 45214a71df50SFrank Blaschka qeth_core_root_dev = s390_root_dev_register("qeth"); 45224a71df50SFrank Blaschka rc = IS_ERR(qeth_core_root_dev) ? PTR_ERR(qeth_core_root_dev) : 0; 45234a71df50SFrank Blaschka if (rc) 45244a71df50SFrank Blaschka goto register_err; 45254a71df50SFrank Blaschka 4526683d718aSFrank Blaschka qeth_core_header_cache = kmem_cache_create("qeth_hdr", 4527683d718aSFrank Blaschka sizeof(struct qeth_hdr) + ETH_HLEN, 64, 0, NULL); 4528683d718aSFrank Blaschka if (!qeth_core_header_cache) { 4529683d718aSFrank Blaschka rc = -ENOMEM; 4530683d718aSFrank Blaschka goto slab_err; 4531683d718aSFrank Blaschka } 4532683d718aSFrank Blaschka 4533683d718aSFrank Blaschka return 0; 4534683d718aSFrank Blaschka slab_err: 4535683d718aSFrank Blaschka s390_root_dev_unregister(qeth_core_root_dev); 45364a71df50SFrank Blaschka register_err: 45374a71df50SFrank Blaschka driver_remove_file(&qeth_core_ccwgroup_driver.driver, 45384a71df50SFrank Blaschka &driver_attr_group); 45394a71df50SFrank Blaschka driver_err: 45404a71df50SFrank Blaschka ccwgroup_driver_unregister(&qeth_core_ccwgroup_driver); 45414a71df50SFrank Blaschka ccwgroup_err: 45424a71df50SFrank Blaschka ccw_driver_unregister(&qeth_ccw_driver); 45434a71df50SFrank Blaschka ccw_err: 454474eacdb9SFrank Blaschka QETH_DBF_MESSAGE(2, "Initialization failed with code %d\n", rc); 45454a71df50SFrank Blaschka qeth_unregister_dbf_views(); 45464a71df50SFrank Blaschka out_err: 454774eacdb9SFrank Blaschka pr_err("Initializing the qeth device driver failed\n"); 45484a71df50SFrank Blaschka return rc; 45494a71df50SFrank Blaschka } 45504a71df50SFrank Blaschka 45514a71df50SFrank Blaschka static void __exit qeth_core_exit(void) 45524a71df50SFrank Blaschka { 45534a71df50SFrank Blaschka s390_root_dev_unregister(qeth_core_root_dev); 45544a71df50SFrank Blaschka driver_remove_file(&qeth_core_ccwgroup_driver.driver, 45554a71df50SFrank Blaschka &driver_attr_group); 45564a71df50SFrank Blaschka ccwgroup_driver_unregister(&qeth_core_ccwgroup_driver); 45574a71df50SFrank Blaschka ccw_driver_unregister(&qeth_ccw_driver); 4558683d718aSFrank Blaschka kmem_cache_destroy(qeth_core_header_cache); 45594a71df50SFrank Blaschka qeth_unregister_dbf_views(); 456074eacdb9SFrank Blaschka pr_info("core functions removed\n"); 45614a71df50SFrank Blaschka } 45624a71df50SFrank Blaschka 45634a71df50SFrank Blaschka module_init(qeth_core_init); 45644a71df50SFrank Blaschka module_exit(qeth_core_exit); 45654a71df50SFrank Blaschka MODULE_AUTHOR("Frank Blaschka <frank.blaschka@de.ibm.com>"); 45664a71df50SFrank Blaschka MODULE_DESCRIPTION("qeth core functions"); 45674a71df50SFrank Blaschka MODULE_LICENSE("GPL"); 4568