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 114a71df50SFrank Blaschka #include <linux/module.h> 124a71df50SFrank Blaschka #include <linux/moduleparam.h> 134a71df50SFrank Blaschka #include <linux/string.h> 144a71df50SFrank Blaschka #include <linux/errno.h> 154a71df50SFrank Blaschka #include <linux/kernel.h> 164a71df50SFrank Blaschka #include <linux/ip.h> 174a71df50SFrank Blaschka #include <linux/ipv6.h> 184a71df50SFrank Blaschka #include <linux/tcp.h> 194a71df50SFrank Blaschka #include <linux/mii.h> 204a71df50SFrank Blaschka #include <linux/kthread.h> 214a71df50SFrank Blaschka 22ab4227cbSMartin Schwidefsky #include <asm/ebcdic.h> 23ab4227cbSMartin Schwidefsky #include <asm/io.h> 244a71df50SFrank Blaschka #include <asm/s390_rdev.h> 254a71df50SFrank Blaschka 264a71df50SFrank Blaschka #include "qeth_core.h" 274a71df50SFrank Blaschka #include "qeth_core_offl.h" 284a71df50SFrank Blaschka 29d11ba0c4SPeter Tiedemann struct qeth_dbf_info qeth_dbf[QETH_DBF_INFOS] = { 30d11ba0c4SPeter Tiedemann /* define dbf - Name, Pages, Areas, Maxlen, Level, View, Handle */ 31d11ba0c4SPeter Tiedemann /* N P A M L V H */ 32d11ba0c4SPeter Tiedemann [QETH_DBF_SETUP] = {"qeth_setup", 33d11ba0c4SPeter Tiedemann 8, 1, 8, 5, &debug_hex_ascii_view, NULL}, 34d11ba0c4SPeter Tiedemann [QETH_DBF_QERR] = {"qeth_qerr", 35d11ba0c4SPeter Tiedemann 2, 1, 8, 2, &debug_hex_ascii_view, NULL}, 36d11ba0c4SPeter Tiedemann [QETH_DBF_TRACE] = {"qeth_trace", 37d11ba0c4SPeter Tiedemann 4, 1, 8, 3, &debug_hex_ascii_view, NULL}, 38d11ba0c4SPeter Tiedemann [QETH_DBF_MSG] = {"qeth_msg", 39d11ba0c4SPeter Tiedemann 8, 1, 128, 3, &debug_sprintf_view, NULL}, 40d11ba0c4SPeter Tiedemann [QETH_DBF_SENSE] = {"qeth_sense", 41d11ba0c4SPeter Tiedemann 2, 1, 64, 2, &debug_hex_ascii_view, NULL}, 42d11ba0c4SPeter Tiedemann [QETH_DBF_MISC] = {"qeth_misc", 43d11ba0c4SPeter Tiedemann 2, 1, 256, 2, &debug_hex_ascii_view, NULL}, 44d11ba0c4SPeter Tiedemann [QETH_DBF_CTRL] = {"qeth_control", 45d11ba0c4SPeter Tiedemann 8, 1, QETH_DBF_CTRL_LEN, 5, &debug_hex_ascii_view, NULL}, 46d11ba0c4SPeter Tiedemann }; 47d11ba0c4SPeter Tiedemann EXPORT_SYMBOL_GPL(qeth_dbf); 484a71df50SFrank Blaschka 494a71df50SFrank Blaschka struct qeth_card_list_struct qeth_core_card_list; 504a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_core_card_list); 51683d718aSFrank Blaschka struct kmem_cache *qeth_core_header_cache; 52683d718aSFrank Blaschka EXPORT_SYMBOL_GPL(qeth_core_header_cache); 534a71df50SFrank Blaschka 544a71df50SFrank Blaschka static struct device *qeth_core_root_dev; 554a71df50SFrank Blaschka static unsigned int known_devices[][10] = QETH_MODELLIST_ARRAY; 564a71df50SFrank Blaschka static struct lock_class_key qdio_out_skb_queue_key; 574a71df50SFrank Blaschka 584a71df50SFrank Blaschka static void qeth_send_control_data_cb(struct qeth_channel *, 594a71df50SFrank Blaschka struct qeth_cmd_buffer *); 604a71df50SFrank Blaschka static int qeth_issue_next_read(struct qeth_card *); 614a71df50SFrank Blaschka static struct qeth_cmd_buffer *qeth_get_buffer(struct qeth_channel *); 624a71df50SFrank Blaschka static void qeth_setup_ccw(struct qeth_channel *, unsigned char *, __u32); 634a71df50SFrank Blaschka static void qeth_free_buffer_pool(struct qeth_card *); 644a71df50SFrank Blaschka static int qeth_qdio_establish(struct qeth_card *); 654a71df50SFrank Blaschka 664a71df50SFrank Blaschka 674a71df50SFrank Blaschka static inline void __qeth_fill_buffer_frag(struct sk_buff *skb, 684a71df50SFrank Blaschka struct qdio_buffer *buffer, int is_tso, 694a71df50SFrank Blaschka int *next_element_to_fill) 704a71df50SFrank Blaschka { 714a71df50SFrank Blaschka struct skb_frag_struct *frag; 724a71df50SFrank Blaschka int fragno; 734a71df50SFrank Blaschka unsigned long addr; 744a71df50SFrank Blaschka int element, cnt, dlen; 754a71df50SFrank Blaschka 764a71df50SFrank Blaschka fragno = skb_shinfo(skb)->nr_frags; 774a71df50SFrank Blaschka element = *next_element_to_fill; 784a71df50SFrank Blaschka dlen = 0; 794a71df50SFrank Blaschka 804a71df50SFrank Blaschka if (is_tso) 814a71df50SFrank Blaschka buffer->element[element].flags = 824a71df50SFrank Blaschka SBAL_FLAGS_MIDDLE_FRAG; 834a71df50SFrank Blaschka else 844a71df50SFrank Blaschka buffer->element[element].flags = 854a71df50SFrank Blaschka SBAL_FLAGS_FIRST_FRAG; 864a71df50SFrank Blaschka dlen = skb->len - skb->data_len; 874a71df50SFrank Blaschka if (dlen) { 884a71df50SFrank Blaschka buffer->element[element].addr = skb->data; 894a71df50SFrank Blaschka buffer->element[element].length = dlen; 904a71df50SFrank Blaschka element++; 914a71df50SFrank Blaschka } 924a71df50SFrank Blaschka for (cnt = 0; cnt < fragno; cnt++) { 934a71df50SFrank Blaschka frag = &skb_shinfo(skb)->frags[cnt]; 944a71df50SFrank Blaschka addr = (page_to_pfn(frag->page) << PAGE_SHIFT) + 954a71df50SFrank Blaschka frag->page_offset; 964a71df50SFrank Blaschka buffer->element[element].addr = (char *)addr; 974a71df50SFrank Blaschka buffer->element[element].length = frag->size; 984a71df50SFrank Blaschka if (cnt < (fragno - 1)) 994a71df50SFrank Blaschka buffer->element[element].flags = 1004a71df50SFrank Blaschka SBAL_FLAGS_MIDDLE_FRAG; 1014a71df50SFrank Blaschka else 1024a71df50SFrank Blaschka buffer->element[element].flags = 1034a71df50SFrank Blaschka SBAL_FLAGS_LAST_FRAG; 1044a71df50SFrank Blaschka element++; 1054a71df50SFrank Blaschka } 1064a71df50SFrank Blaschka *next_element_to_fill = element; 1074a71df50SFrank Blaschka } 1084a71df50SFrank Blaschka 1094a71df50SFrank Blaschka static inline const char *qeth_get_cardname(struct qeth_card *card) 1104a71df50SFrank Blaschka { 1114a71df50SFrank Blaschka if (card->info.guestlan) { 1124a71df50SFrank Blaschka switch (card->info.type) { 1134a71df50SFrank Blaschka case QETH_CARD_TYPE_OSAE: 1144a71df50SFrank Blaschka return " Guest LAN QDIO"; 1154a71df50SFrank Blaschka case QETH_CARD_TYPE_IQD: 1164a71df50SFrank Blaschka return " Guest LAN Hiper"; 1174a71df50SFrank Blaschka default: 1184a71df50SFrank Blaschka return " unknown"; 1194a71df50SFrank Blaschka } 1204a71df50SFrank Blaschka } else { 1214a71df50SFrank Blaschka switch (card->info.type) { 1224a71df50SFrank Blaschka case QETH_CARD_TYPE_OSAE: 1234a71df50SFrank Blaschka return " OSD Express"; 1244a71df50SFrank Blaschka case QETH_CARD_TYPE_IQD: 1254a71df50SFrank Blaschka return " HiperSockets"; 1264a71df50SFrank Blaschka case QETH_CARD_TYPE_OSN: 1274a71df50SFrank Blaschka return " OSN QDIO"; 1284a71df50SFrank Blaschka default: 1294a71df50SFrank Blaschka return " unknown"; 1304a71df50SFrank Blaschka } 1314a71df50SFrank Blaschka } 1324a71df50SFrank Blaschka return " n/a"; 1334a71df50SFrank Blaschka } 1344a71df50SFrank Blaschka 1354a71df50SFrank Blaschka /* max length to be returned: 14 */ 1364a71df50SFrank Blaschka const char *qeth_get_cardname_short(struct qeth_card *card) 1374a71df50SFrank Blaschka { 1384a71df50SFrank Blaschka if (card->info.guestlan) { 1394a71df50SFrank Blaschka switch (card->info.type) { 1404a71df50SFrank Blaschka case QETH_CARD_TYPE_OSAE: 1414a71df50SFrank Blaschka return "GuestLAN QDIO"; 1424a71df50SFrank Blaschka case QETH_CARD_TYPE_IQD: 1434a71df50SFrank Blaschka return "GuestLAN Hiper"; 1444a71df50SFrank Blaschka default: 1454a71df50SFrank Blaschka return "unknown"; 1464a71df50SFrank Blaschka } 1474a71df50SFrank Blaschka } else { 1484a71df50SFrank Blaschka switch (card->info.type) { 1494a71df50SFrank Blaschka case QETH_CARD_TYPE_OSAE: 1504a71df50SFrank Blaschka switch (card->info.link_type) { 1514a71df50SFrank Blaschka case QETH_LINK_TYPE_FAST_ETH: 1524a71df50SFrank Blaschka return "OSD_100"; 1534a71df50SFrank Blaschka case QETH_LINK_TYPE_HSTR: 1544a71df50SFrank Blaschka return "HSTR"; 1554a71df50SFrank Blaschka case QETH_LINK_TYPE_GBIT_ETH: 1564a71df50SFrank Blaschka return "OSD_1000"; 1574a71df50SFrank Blaschka case QETH_LINK_TYPE_10GBIT_ETH: 1584a71df50SFrank Blaschka return "OSD_10GIG"; 1594a71df50SFrank Blaschka case QETH_LINK_TYPE_LANE_ETH100: 1604a71df50SFrank Blaschka return "OSD_FE_LANE"; 1614a71df50SFrank Blaschka case QETH_LINK_TYPE_LANE_TR: 1624a71df50SFrank Blaschka return "OSD_TR_LANE"; 1634a71df50SFrank Blaschka case QETH_LINK_TYPE_LANE_ETH1000: 1644a71df50SFrank Blaschka return "OSD_GbE_LANE"; 1654a71df50SFrank Blaschka case QETH_LINK_TYPE_LANE: 1664a71df50SFrank Blaschka return "OSD_ATM_LANE"; 1674a71df50SFrank Blaschka default: 1684a71df50SFrank Blaschka return "OSD_Express"; 1694a71df50SFrank Blaschka } 1704a71df50SFrank Blaschka case QETH_CARD_TYPE_IQD: 1714a71df50SFrank Blaschka return "HiperSockets"; 1724a71df50SFrank Blaschka case QETH_CARD_TYPE_OSN: 1734a71df50SFrank Blaschka return "OSN"; 1744a71df50SFrank Blaschka default: 1754a71df50SFrank Blaschka return "unknown"; 1764a71df50SFrank Blaschka } 1774a71df50SFrank Blaschka } 1784a71df50SFrank Blaschka return "n/a"; 1794a71df50SFrank Blaschka } 1804a71df50SFrank Blaschka 1814a71df50SFrank Blaschka void qeth_set_allowed_threads(struct qeth_card *card, unsigned long threads, 1824a71df50SFrank Blaschka int clear_start_mask) 1834a71df50SFrank Blaschka { 1844a71df50SFrank Blaschka unsigned long flags; 1854a71df50SFrank Blaschka 1864a71df50SFrank Blaschka spin_lock_irqsave(&card->thread_mask_lock, flags); 1874a71df50SFrank Blaschka card->thread_allowed_mask = threads; 1884a71df50SFrank Blaschka if (clear_start_mask) 1894a71df50SFrank Blaschka card->thread_start_mask &= threads; 1904a71df50SFrank Blaschka spin_unlock_irqrestore(&card->thread_mask_lock, flags); 1914a71df50SFrank Blaschka wake_up(&card->wait_q); 1924a71df50SFrank Blaschka } 1934a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_set_allowed_threads); 1944a71df50SFrank Blaschka 1954a71df50SFrank Blaschka int qeth_threads_running(struct qeth_card *card, unsigned long threads) 1964a71df50SFrank Blaschka { 1974a71df50SFrank Blaschka unsigned long flags; 1984a71df50SFrank Blaschka int rc = 0; 1994a71df50SFrank Blaschka 2004a71df50SFrank Blaschka spin_lock_irqsave(&card->thread_mask_lock, flags); 2014a71df50SFrank Blaschka rc = (card->thread_running_mask & threads); 2024a71df50SFrank Blaschka spin_unlock_irqrestore(&card->thread_mask_lock, flags); 2034a71df50SFrank Blaschka return rc; 2044a71df50SFrank Blaschka } 2054a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_threads_running); 2064a71df50SFrank Blaschka 2074a71df50SFrank Blaschka int qeth_wait_for_threads(struct qeth_card *card, unsigned long threads) 2084a71df50SFrank Blaschka { 2094a71df50SFrank Blaschka return wait_event_interruptible(card->wait_q, 2104a71df50SFrank Blaschka qeth_threads_running(card, threads) == 0); 2114a71df50SFrank Blaschka } 2124a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_wait_for_threads); 2134a71df50SFrank Blaschka 2144a71df50SFrank Blaschka void qeth_clear_working_pool_list(struct qeth_card *card) 2154a71df50SFrank Blaschka { 2164a71df50SFrank Blaschka struct qeth_buffer_pool_entry *pool_entry, *tmp; 2174a71df50SFrank Blaschka 218d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 5, "clwrklst"); 2194a71df50SFrank Blaschka list_for_each_entry_safe(pool_entry, tmp, 2204a71df50SFrank Blaschka &card->qdio.in_buf_pool.entry_list, list){ 2214a71df50SFrank Blaschka list_del(&pool_entry->list); 2224a71df50SFrank Blaschka } 2234a71df50SFrank Blaschka } 2244a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_clear_working_pool_list); 2254a71df50SFrank Blaschka 2264a71df50SFrank Blaschka static int qeth_alloc_buffer_pool(struct qeth_card *card) 2274a71df50SFrank Blaschka { 2284a71df50SFrank Blaschka struct qeth_buffer_pool_entry *pool_entry; 2294a71df50SFrank Blaschka void *ptr; 2304a71df50SFrank Blaschka int i, j; 2314a71df50SFrank Blaschka 232d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 5, "alocpool"); 2334a71df50SFrank Blaschka for (i = 0; i < card->qdio.init_pool.buf_count; ++i) { 2344a71df50SFrank Blaschka pool_entry = kmalloc(sizeof(*pool_entry), GFP_KERNEL); 2354a71df50SFrank Blaschka if (!pool_entry) { 2364a71df50SFrank Blaschka qeth_free_buffer_pool(card); 2374a71df50SFrank Blaschka return -ENOMEM; 2384a71df50SFrank Blaschka } 2394a71df50SFrank Blaschka for (j = 0; j < QETH_MAX_BUFFER_ELEMENTS(card); ++j) { 240508b3c4fSUrsula Braun ptr = (void *) __get_free_page(GFP_KERNEL); 2414a71df50SFrank Blaschka if (!ptr) { 2424a71df50SFrank Blaschka while (j > 0) 2434a71df50SFrank Blaschka free_page((unsigned long) 2444a71df50SFrank Blaschka pool_entry->elements[--j]); 2454a71df50SFrank Blaschka kfree(pool_entry); 2464a71df50SFrank Blaschka qeth_free_buffer_pool(card); 2474a71df50SFrank Blaschka return -ENOMEM; 2484a71df50SFrank Blaschka } 2494a71df50SFrank Blaschka pool_entry->elements[j] = ptr; 2504a71df50SFrank Blaschka } 2514a71df50SFrank Blaschka list_add(&pool_entry->init_list, 2524a71df50SFrank Blaschka &card->qdio.init_pool.entry_list); 2534a71df50SFrank Blaschka } 2544a71df50SFrank Blaschka return 0; 2554a71df50SFrank Blaschka } 2564a71df50SFrank Blaschka 2574a71df50SFrank Blaschka int qeth_realloc_buffer_pool(struct qeth_card *card, int bufcnt) 2584a71df50SFrank Blaschka { 259d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 2, "realcbp"); 2604a71df50SFrank Blaschka 2614a71df50SFrank Blaschka if ((card->state != CARD_STATE_DOWN) && 2624a71df50SFrank Blaschka (card->state != CARD_STATE_RECOVER)) 2634a71df50SFrank Blaschka return -EPERM; 2644a71df50SFrank Blaschka 2654a71df50SFrank Blaschka /* TODO: steel/add buffers from/to a running card's buffer pool (?) */ 2664a71df50SFrank Blaschka qeth_clear_working_pool_list(card); 2674a71df50SFrank Blaschka qeth_free_buffer_pool(card); 2684a71df50SFrank Blaschka card->qdio.in_buf_pool.buf_count = bufcnt; 2694a71df50SFrank Blaschka card->qdio.init_pool.buf_count = bufcnt; 2704a71df50SFrank Blaschka return qeth_alloc_buffer_pool(card); 2714a71df50SFrank Blaschka } 2724a71df50SFrank Blaschka 2734a71df50SFrank Blaschka int qeth_set_large_send(struct qeth_card *card, 2744a71df50SFrank Blaschka enum qeth_large_send_types type) 2754a71df50SFrank Blaschka { 2764a71df50SFrank Blaschka int rc = 0; 2774a71df50SFrank Blaschka 2784a71df50SFrank Blaschka if (card->dev == NULL) { 2794a71df50SFrank Blaschka card->options.large_send = type; 2804a71df50SFrank Blaschka return 0; 2814a71df50SFrank Blaschka } 2824a71df50SFrank Blaschka if (card->state == CARD_STATE_UP) 2834a71df50SFrank Blaschka netif_tx_disable(card->dev); 2844a71df50SFrank Blaschka card->options.large_send = type; 2854a71df50SFrank Blaschka switch (card->options.large_send) { 2864a71df50SFrank Blaschka case QETH_LARGE_SEND_EDDP: 2874a71df50SFrank Blaschka card->dev->features |= NETIF_F_TSO | NETIF_F_SG | 2884a71df50SFrank Blaschka NETIF_F_HW_CSUM; 2894a71df50SFrank Blaschka break; 2904a71df50SFrank Blaschka case QETH_LARGE_SEND_TSO: 2914a71df50SFrank Blaschka if (qeth_is_supported(card, IPA_OUTBOUND_TSO)) { 2924a71df50SFrank Blaschka card->dev->features |= NETIF_F_TSO | NETIF_F_SG | 2934a71df50SFrank Blaschka NETIF_F_HW_CSUM; 2944a71df50SFrank Blaschka } else { 2954a71df50SFrank Blaschka card->dev->features &= ~(NETIF_F_TSO | NETIF_F_SG | 2964a71df50SFrank Blaschka NETIF_F_HW_CSUM); 2974a71df50SFrank Blaschka card->options.large_send = QETH_LARGE_SEND_NO; 2984a71df50SFrank Blaschka rc = -EOPNOTSUPP; 2994a71df50SFrank Blaschka } 3004a71df50SFrank Blaschka break; 3014a71df50SFrank Blaschka default: /* includes QETH_LARGE_SEND_NO */ 3024a71df50SFrank Blaschka card->dev->features &= ~(NETIF_F_TSO | NETIF_F_SG | 3034a71df50SFrank Blaschka NETIF_F_HW_CSUM); 3044a71df50SFrank Blaschka break; 3054a71df50SFrank Blaschka } 3064a71df50SFrank Blaschka if (card->state == CARD_STATE_UP) 3074a71df50SFrank Blaschka netif_wake_queue(card->dev); 3084a71df50SFrank Blaschka return rc; 3094a71df50SFrank Blaschka } 3104a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_set_large_send); 3114a71df50SFrank Blaschka 3124a71df50SFrank Blaschka static int qeth_issue_next_read(struct qeth_card *card) 3134a71df50SFrank Blaschka { 3144a71df50SFrank Blaschka int rc; 3154a71df50SFrank Blaschka struct qeth_cmd_buffer *iob; 3164a71df50SFrank Blaschka 317d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 5, "issnxrd"); 3184a71df50SFrank Blaschka if (card->read.state != CH_STATE_UP) 3194a71df50SFrank Blaschka return -EIO; 3204a71df50SFrank Blaschka iob = qeth_get_buffer(&card->read); 3214a71df50SFrank Blaschka if (!iob) { 3224a71df50SFrank Blaschka PRINT_WARN("issue_next_read failed: no iob available!\n"); 3234a71df50SFrank Blaschka return -ENOMEM; 3244a71df50SFrank Blaschka } 3254a71df50SFrank Blaschka qeth_setup_ccw(&card->read, iob->data, QETH_BUFSIZE); 326d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 6, "noirqpnd"); 3274a71df50SFrank Blaschka rc = ccw_device_start(card->read.ccwdev, &card->read.ccw, 3284a71df50SFrank Blaschka (addr_t) iob, 0, 0); 3294a71df50SFrank Blaschka if (rc) { 3304a71df50SFrank Blaschka PRINT_ERR("Error in starting next read ccw! rc=%i\n", rc); 3314a71df50SFrank Blaschka atomic_set(&card->read.irq_pending, 0); 3324a71df50SFrank Blaschka qeth_schedule_recovery(card); 3334a71df50SFrank Blaschka wake_up(&card->wait_q); 3344a71df50SFrank Blaschka } 3354a71df50SFrank Blaschka return rc; 3364a71df50SFrank Blaschka } 3374a71df50SFrank Blaschka 3384a71df50SFrank Blaschka static struct qeth_reply *qeth_alloc_reply(struct qeth_card *card) 3394a71df50SFrank Blaschka { 3404a71df50SFrank Blaschka struct qeth_reply *reply; 3414a71df50SFrank Blaschka 3424a71df50SFrank Blaschka reply = kzalloc(sizeof(struct qeth_reply), GFP_ATOMIC); 3434a71df50SFrank Blaschka if (reply) { 3444a71df50SFrank Blaschka atomic_set(&reply->refcnt, 1); 3454a71df50SFrank Blaschka atomic_set(&reply->received, 0); 3464a71df50SFrank Blaschka reply->card = card; 3474a71df50SFrank Blaschka }; 3484a71df50SFrank Blaschka return reply; 3494a71df50SFrank Blaschka } 3504a71df50SFrank Blaschka 3514a71df50SFrank Blaschka static void qeth_get_reply(struct qeth_reply *reply) 3524a71df50SFrank Blaschka { 3534a71df50SFrank Blaschka WARN_ON(atomic_read(&reply->refcnt) <= 0); 3544a71df50SFrank Blaschka atomic_inc(&reply->refcnt); 3554a71df50SFrank Blaschka } 3564a71df50SFrank Blaschka 3574a71df50SFrank Blaschka static void qeth_put_reply(struct qeth_reply *reply) 3584a71df50SFrank Blaschka { 3594a71df50SFrank Blaschka WARN_ON(atomic_read(&reply->refcnt) <= 0); 3604a71df50SFrank Blaschka if (atomic_dec_and_test(&reply->refcnt)) 3614a71df50SFrank Blaschka kfree(reply); 3624a71df50SFrank Blaschka } 3634a71df50SFrank Blaschka 364d11ba0c4SPeter Tiedemann static void qeth_issue_ipa_msg(struct qeth_ipa_cmd *cmd, int rc, 3654a71df50SFrank Blaschka struct qeth_card *card) 3664a71df50SFrank Blaschka { 3674a71df50SFrank Blaschka char *ipa_name; 368d11ba0c4SPeter Tiedemann int com = cmd->hdr.command; 3694a71df50SFrank Blaschka ipa_name = qeth_get_ipa_cmd_name(com); 370d11ba0c4SPeter Tiedemann if (rc) 371d11ba0c4SPeter Tiedemann QETH_DBF_MESSAGE(2, "IPA: %s(x%X) for %s returned x%X \"%s\"\n", 372d11ba0c4SPeter Tiedemann ipa_name, com, QETH_CARD_IFNAME(card), 373d11ba0c4SPeter Tiedemann rc, qeth_get_ipa_msg(rc)); 374d11ba0c4SPeter Tiedemann else 375d11ba0c4SPeter Tiedemann QETH_DBF_MESSAGE(5, "IPA: %s(x%X) for %s succeeded\n", 376d11ba0c4SPeter Tiedemann ipa_name, com, QETH_CARD_IFNAME(card)); 3774a71df50SFrank Blaschka } 3784a71df50SFrank Blaschka 3794a71df50SFrank Blaschka static struct qeth_ipa_cmd *qeth_check_ipa_data(struct qeth_card *card, 3804a71df50SFrank Blaschka struct qeth_cmd_buffer *iob) 3814a71df50SFrank Blaschka { 3824a71df50SFrank Blaschka struct qeth_ipa_cmd *cmd = NULL; 3834a71df50SFrank Blaschka 384d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 5, "chkipad"); 3854a71df50SFrank Blaschka if (IS_IPA(iob->data)) { 3864a71df50SFrank Blaschka cmd = (struct qeth_ipa_cmd *) PDU_ENCAPSULATION(iob->data); 3874a71df50SFrank Blaschka if (IS_IPA_REPLY(cmd)) { 388d11ba0c4SPeter Tiedemann if (cmd->hdr.command < IPA_CMD_SETCCID || 389d11ba0c4SPeter Tiedemann cmd->hdr.command > IPA_CMD_MODCCID) 390d11ba0c4SPeter Tiedemann qeth_issue_ipa_msg(cmd, 391d11ba0c4SPeter Tiedemann cmd->hdr.return_code, card); 3924a71df50SFrank Blaschka return cmd; 3934a71df50SFrank Blaschka } else { 3944a71df50SFrank Blaschka switch (cmd->hdr.command) { 3954a71df50SFrank Blaschka case IPA_CMD_STOPLAN: 3964a71df50SFrank Blaschka PRINT_WARN("Link failure on %s (CHPID 0x%X) - " 3974a71df50SFrank Blaschka "there is a network problem or " 3984a71df50SFrank Blaschka "someone pulled the cable or " 3994a71df50SFrank Blaschka "disabled the port.\n", 4004a71df50SFrank Blaschka QETH_CARD_IFNAME(card), 4014a71df50SFrank Blaschka card->info.chpid); 4024a71df50SFrank Blaschka card->lan_online = 0; 4034a71df50SFrank Blaschka if (card->dev && netif_carrier_ok(card->dev)) 4044a71df50SFrank Blaschka netif_carrier_off(card->dev); 4054a71df50SFrank Blaschka return NULL; 4064a71df50SFrank Blaschka case IPA_CMD_STARTLAN: 4074a71df50SFrank Blaschka PRINT_INFO("Link reestablished on %s " 4084a71df50SFrank Blaschka "(CHPID 0x%X). Scheduling " 4094a71df50SFrank Blaschka "IP address reset.\n", 4104a71df50SFrank Blaschka QETH_CARD_IFNAME(card), 4114a71df50SFrank Blaschka card->info.chpid); 4124a71df50SFrank Blaschka netif_carrier_on(card->dev); 413922dc062SUrsula Braun card->lan_online = 1; 4144a71df50SFrank Blaschka qeth_schedule_recovery(card); 4154a71df50SFrank Blaschka return NULL; 4164a71df50SFrank Blaschka case IPA_CMD_MODCCID: 4174a71df50SFrank Blaschka return cmd; 4184a71df50SFrank Blaschka case IPA_CMD_REGISTER_LOCAL_ADDR: 419d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 3, "irla"); 4204a71df50SFrank Blaschka break; 4214a71df50SFrank Blaschka case IPA_CMD_UNREGISTER_LOCAL_ADDR: 422d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 3, "urla"); 4234a71df50SFrank Blaschka break; 4244a71df50SFrank Blaschka default: 425c4cef07cSFrank Blaschka QETH_DBF_MESSAGE(2, "Received data is IPA " 4264a71df50SFrank Blaschka "but not a reply!\n"); 4274a71df50SFrank Blaschka break; 4284a71df50SFrank Blaschka } 4294a71df50SFrank Blaschka } 4304a71df50SFrank Blaschka } 4314a71df50SFrank Blaschka return cmd; 4324a71df50SFrank Blaschka } 4334a71df50SFrank Blaschka 4344a71df50SFrank Blaschka void qeth_clear_ipacmd_list(struct qeth_card *card) 4354a71df50SFrank Blaschka { 4364a71df50SFrank Blaschka struct qeth_reply *reply, *r; 4374a71df50SFrank Blaschka unsigned long flags; 4384a71df50SFrank Blaschka 439d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 4, "clipalst"); 4404a71df50SFrank Blaschka 4414a71df50SFrank Blaschka spin_lock_irqsave(&card->lock, flags); 4424a71df50SFrank Blaschka list_for_each_entry_safe(reply, r, &card->cmd_waiter_list, list) { 4434a71df50SFrank Blaschka qeth_get_reply(reply); 4444a71df50SFrank Blaschka reply->rc = -EIO; 4454a71df50SFrank Blaschka atomic_inc(&reply->received); 4464a71df50SFrank Blaschka list_del_init(&reply->list); 4474a71df50SFrank Blaschka wake_up(&reply->wait_q); 4484a71df50SFrank Blaschka qeth_put_reply(reply); 4494a71df50SFrank Blaschka } 4504a71df50SFrank Blaschka spin_unlock_irqrestore(&card->lock, flags); 4514a71df50SFrank Blaschka } 4524a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_clear_ipacmd_list); 4534a71df50SFrank Blaschka 4544a71df50SFrank Blaschka static int qeth_check_idx_response(unsigned char *buffer) 4554a71df50SFrank Blaschka { 4564a71df50SFrank Blaschka if (!buffer) 4574a71df50SFrank Blaschka return 0; 4584a71df50SFrank Blaschka 459d11ba0c4SPeter Tiedemann QETH_DBF_HEX(CTRL, 2, buffer, QETH_DBF_CTRL_LEN); 4604a71df50SFrank Blaschka if ((buffer[2] & 0xc0) == 0xc0) { 4614a71df50SFrank Blaschka PRINT_WARN("received an IDX TERMINATE " 4624a71df50SFrank Blaschka "with cause code 0x%02x%s\n", 4634a71df50SFrank Blaschka buffer[4], 4644a71df50SFrank Blaschka ((buffer[4] == 0x22) ? 4654a71df50SFrank Blaschka " -- try another portname" : "")); 466d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 2, "ckidxres"); 467d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 2, " idxterm"); 468d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(TRACE, 2, " rc%d", -EIO); 4694a71df50SFrank Blaschka return -EIO; 4704a71df50SFrank Blaschka } 4714a71df50SFrank Blaschka return 0; 4724a71df50SFrank Blaschka } 4734a71df50SFrank Blaschka 4744a71df50SFrank Blaschka static void qeth_setup_ccw(struct qeth_channel *channel, unsigned char *iob, 4754a71df50SFrank Blaschka __u32 len) 4764a71df50SFrank Blaschka { 4774a71df50SFrank Blaschka struct qeth_card *card; 4784a71df50SFrank Blaschka 479d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 4, "setupccw"); 4804a71df50SFrank Blaschka card = CARD_FROM_CDEV(channel->ccwdev); 4814a71df50SFrank Blaschka if (channel == &card->read) 4824a71df50SFrank Blaschka memcpy(&channel->ccw, READ_CCW, sizeof(struct ccw1)); 4834a71df50SFrank Blaschka else 4844a71df50SFrank Blaschka memcpy(&channel->ccw, WRITE_CCW, sizeof(struct ccw1)); 4854a71df50SFrank Blaschka channel->ccw.count = len; 4864a71df50SFrank Blaschka channel->ccw.cda = (__u32) __pa(iob); 4874a71df50SFrank Blaschka } 4884a71df50SFrank Blaschka 4894a71df50SFrank Blaschka static struct qeth_cmd_buffer *__qeth_get_buffer(struct qeth_channel *channel) 4904a71df50SFrank Blaschka { 4914a71df50SFrank Blaschka __u8 index; 4924a71df50SFrank Blaschka 493d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 6, "getbuff"); 4944a71df50SFrank Blaschka index = channel->io_buf_no; 4954a71df50SFrank Blaschka do { 4964a71df50SFrank Blaschka if (channel->iob[index].state == BUF_STATE_FREE) { 4974a71df50SFrank Blaschka channel->iob[index].state = BUF_STATE_LOCKED; 4984a71df50SFrank Blaschka channel->io_buf_no = (channel->io_buf_no + 1) % 4994a71df50SFrank Blaschka QETH_CMD_BUFFER_NO; 5004a71df50SFrank Blaschka memset(channel->iob[index].data, 0, QETH_BUFSIZE); 5014a71df50SFrank Blaschka return channel->iob + index; 5024a71df50SFrank Blaschka } 5034a71df50SFrank Blaschka index = (index + 1) % QETH_CMD_BUFFER_NO; 5044a71df50SFrank Blaschka } while (index != channel->io_buf_no); 5054a71df50SFrank Blaschka 5064a71df50SFrank Blaschka return NULL; 5074a71df50SFrank Blaschka } 5084a71df50SFrank Blaschka 5094a71df50SFrank Blaschka void qeth_release_buffer(struct qeth_channel *channel, 5104a71df50SFrank Blaschka struct qeth_cmd_buffer *iob) 5114a71df50SFrank Blaschka { 5124a71df50SFrank Blaschka unsigned long flags; 5134a71df50SFrank Blaschka 514d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 6, "relbuff"); 5154a71df50SFrank Blaschka spin_lock_irqsave(&channel->iob_lock, flags); 5164a71df50SFrank Blaschka memset(iob->data, 0, QETH_BUFSIZE); 5174a71df50SFrank Blaschka iob->state = BUF_STATE_FREE; 5184a71df50SFrank Blaschka iob->callback = qeth_send_control_data_cb; 5194a71df50SFrank Blaschka iob->rc = 0; 5204a71df50SFrank Blaschka spin_unlock_irqrestore(&channel->iob_lock, flags); 5214a71df50SFrank Blaschka } 5224a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_release_buffer); 5234a71df50SFrank Blaschka 5244a71df50SFrank Blaschka static struct qeth_cmd_buffer *qeth_get_buffer(struct qeth_channel *channel) 5254a71df50SFrank Blaschka { 5264a71df50SFrank Blaschka struct qeth_cmd_buffer *buffer = NULL; 5274a71df50SFrank Blaschka unsigned long flags; 5284a71df50SFrank Blaschka 5294a71df50SFrank Blaschka spin_lock_irqsave(&channel->iob_lock, flags); 5304a71df50SFrank Blaschka buffer = __qeth_get_buffer(channel); 5314a71df50SFrank Blaschka spin_unlock_irqrestore(&channel->iob_lock, flags); 5324a71df50SFrank Blaschka return buffer; 5334a71df50SFrank Blaschka } 5344a71df50SFrank Blaschka 5354a71df50SFrank Blaschka struct qeth_cmd_buffer *qeth_wait_for_buffer(struct qeth_channel *channel) 5364a71df50SFrank Blaschka { 5374a71df50SFrank Blaschka struct qeth_cmd_buffer *buffer; 5384a71df50SFrank Blaschka wait_event(channel->wait_q, 5394a71df50SFrank Blaschka ((buffer = qeth_get_buffer(channel)) != NULL)); 5404a71df50SFrank Blaschka return buffer; 5414a71df50SFrank Blaschka } 5424a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_wait_for_buffer); 5434a71df50SFrank Blaschka 5444a71df50SFrank Blaschka void qeth_clear_cmd_buffers(struct qeth_channel *channel) 5454a71df50SFrank Blaschka { 5464a71df50SFrank Blaschka int cnt; 5474a71df50SFrank Blaschka 5484a71df50SFrank Blaschka for (cnt = 0; cnt < QETH_CMD_BUFFER_NO; cnt++) 5494a71df50SFrank Blaschka qeth_release_buffer(channel, &channel->iob[cnt]); 5504a71df50SFrank Blaschka channel->buf_no = 0; 5514a71df50SFrank Blaschka channel->io_buf_no = 0; 5524a71df50SFrank Blaschka } 5534a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_clear_cmd_buffers); 5544a71df50SFrank Blaschka 5554a71df50SFrank Blaschka static void qeth_send_control_data_cb(struct qeth_channel *channel, 5564a71df50SFrank Blaschka struct qeth_cmd_buffer *iob) 5574a71df50SFrank Blaschka { 5584a71df50SFrank Blaschka struct qeth_card *card; 5594a71df50SFrank Blaschka struct qeth_reply *reply, *r; 5604a71df50SFrank Blaschka struct qeth_ipa_cmd *cmd; 5614a71df50SFrank Blaschka unsigned long flags; 5624a71df50SFrank Blaschka int keep_reply; 5634a71df50SFrank Blaschka 564d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 4, "sndctlcb"); 5654a71df50SFrank Blaschka 5664a71df50SFrank Blaschka card = CARD_FROM_CDEV(channel->ccwdev); 5674a71df50SFrank Blaschka if (qeth_check_idx_response(iob->data)) { 5684a71df50SFrank Blaschka qeth_clear_ipacmd_list(card); 5694a71df50SFrank Blaschka qeth_schedule_recovery(card); 5704a71df50SFrank Blaschka goto out; 5714a71df50SFrank Blaschka } 5724a71df50SFrank Blaschka 5734a71df50SFrank Blaschka cmd = qeth_check_ipa_data(card, iob); 5744a71df50SFrank Blaschka if ((cmd == NULL) && (card->state != CARD_STATE_DOWN)) 5754a71df50SFrank Blaschka goto out; 5764a71df50SFrank Blaschka /*in case of OSN : check if cmd is set */ 5774a71df50SFrank Blaschka if (card->info.type == QETH_CARD_TYPE_OSN && 5784a71df50SFrank Blaschka cmd && 5794a71df50SFrank Blaschka cmd->hdr.command != IPA_CMD_STARTLAN && 5804a71df50SFrank Blaschka card->osn_info.assist_cb != NULL) { 5814a71df50SFrank Blaschka card->osn_info.assist_cb(card->dev, cmd); 5824a71df50SFrank Blaschka goto out; 5834a71df50SFrank Blaschka } 5844a71df50SFrank Blaschka 5854a71df50SFrank Blaschka spin_lock_irqsave(&card->lock, flags); 5864a71df50SFrank Blaschka list_for_each_entry_safe(reply, r, &card->cmd_waiter_list, list) { 5874a71df50SFrank Blaschka if ((reply->seqno == QETH_IDX_COMMAND_SEQNO) || 5884a71df50SFrank Blaschka ((cmd) && (reply->seqno == cmd->hdr.seqno))) { 5894a71df50SFrank Blaschka qeth_get_reply(reply); 5904a71df50SFrank Blaschka list_del_init(&reply->list); 5914a71df50SFrank Blaschka spin_unlock_irqrestore(&card->lock, flags); 5924a71df50SFrank Blaschka keep_reply = 0; 5934a71df50SFrank Blaschka if (reply->callback != NULL) { 5944a71df50SFrank Blaschka if (cmd) { 5954a71df50SFrank Blaschka reply->offset = (__u16)((char *)cmd - 5964a71df50SFrank Blaschka (char *)iob->data); 5974a71df50SFrank Blaschka keep_reply = reply->callback(card, 5984a71df50SFrank Blaschka reply, 5994a71df50SFrank Blaschka (unsigned long)cmd); 6004a71df50SFrank Blaschka } else 6014a71df50SFrank Blaschka keep_reply = reply->callback(card, 6024a71df50SFrank Blaschka reply, 6034a71df50SFrank Blaschka (unsigned long)iob); 6044a71df50SFrank Blaschka } 6054a71df50SFrank Blaschka if (cmd) 6064a71df50SFrank Blaschka reply->rc = (u16) cmd->hdr.return_code; 6074a71df50SFrank Blaschka else if (iob->rc) 6084a71df50SFrank Blaschka reply->rc = iob->rc; 6094a71df50SFrank Blaschka if (keep_reply) { 6104a71df50SFrank Blaschka spin_lock_irqsave(&card->lock, flags); 6114a71df50SFrank Blaschka list_add_tail(&reply->list, 6124a71df50SFrank Blaschka &card->cmd_waiter_list); 6134a71df50SFrank Blaschka spin_unlock_irqrestore(&card->lock, flags); 6144a71df50SFrank Blaschka } else { 6154a71df50SFrank Blaschka atomic_inc(&reply->received); 6164a71df50SFrank Blaschka wake_up(&reply->wait_q); 6174a71df50SFrank Blaschka } 6184a71df50SFrank Blaschka qeth_put_reply(reply); 6194a71df50SFrank Blaschka goto out; 6204a71df50SFrank Blaschka } 6214a71df50SFrank Blaschka } 6224a71df50SFrank Blaschka spin_unlock_irqrestore(&card->lock, flags); 6234a71df50SFrank Blaschka out: 6244a71df50SFrank Blaschka memcpy(&card->seqno.pdu_hdr_ack, 6254a71df50SFrank Blaschka QETH_PDU_HEADER_SEQ_NO(iob->data), 6264a71df50SFrank Blaschka QETH_SEQ_NO_LENGTH); 6274a71df50SFrank Blaschka qeth_release_buffer(channel, iob); 6284a71df50SFrank Blaschka } 6294a71df50SFrank Blaschka 6304a71df50SFrank Blaschka static int qeth_setup_channel(struct qeth_channel *channel) 6314a71df50SFrank Blaschka { 6324a71df50SFrank Blaschka int cnt; 6334a71df50SFrank Blaschka 634d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "setupch"); 6354a71df50SFrank Blaschka for (cnt = 0; cnt < QETH_CMD_BUFFER_NO; cnt++) { 6364a71df50SFrank Blaschka channel->iob[cnt].data = (char *) 6374a71df50SFrank Blaschka kmalloc(QETH_BUFSIZE, GFP_DMA|GFP_KERNEL); 6384a71df50SFrank Blaschka if (channel->iob[cnt].data == NULL) 6394a71df50SFrank Blaschka break; 6404a71df50SFrank Blaschka channel->iob[cnt].state = BUF_STATE_FREE; 6414a71df50SFrank Blaschka channel->iob[cnt].channel = channel; 6424a71df50SFrank Blaschka channel->iob[cnt].callback = qeth_send_control_data_cb; 6434a71df50SFrank Blaschka channel->iob[cnt].rc = 0; 6444a71df50SFrank Blaschka } 6454a71df50SFrank Blaschka if (cnt < QETH_CMD_BUFFER_NO) { 6464a71df50SFrank Blaschka while (cnt-- > 0) 6474a71df50SFrank Blaschka kfree(channel->iob[cnt].data); 6484a71df50SFrank Blaschka return -ENOMEM; 6494a71df50SFrank Blaschka } 6504a71df50SFrank Blaschka channel->buf_no = 0; 6514a71df50SFrank Blaschka channel->io_buf_no = 0; 6524a71df50SFrank Blaschka atomic_set(&channel->irq_pending, 0); 6534a71df50SFrank Blaschka spin_lock_init(&channel->iob_lock); 6544a71df50SFrank Blaschka 6554a71df50SFrank Blaschka init_waitqueue_head(&channel->wait_q); 6564a71df50SFrank Blaschka return 0; 6574a71df50SFrank Blaschka } 6584a71df50SFrank Blaschka 6594a71df50SFrank Blaschka static int qeth_set_thread_start_bit(struct qeth_card *card, 6604a71df50SFrank Blaschka unsigned long thread) 6614a71df50SFrank Blaschka { 6624a71df50SFrank Blaschka unsigned long flags; 6634a71df50SFrank Blaschka 6644a71df50SFrank Blaschka spin_lock_irqsave(&card->thread_mask_lock, flags); 6654a71df50SFrank Blaschka if (!(card->thread_allowed_mask & thread) || 6664a71df50SFrank Blaschka (card->thread_start_mask & thread)) { 6674a71df50SFrank Blaschka spin_unlock_irqrestore(&card->thread_mask_lock, flags); 6684a71df50SFrank Blaschka return -EPERM; 6694a71df50SFrank Blaschka } 6704a71df50SFrank Blaschka card->thread_start_mask |= thread; 6714a71df50SFrank Blaschka spin_unlock_irqrestore(&card->thread_mask_lock, flags); 6724a71df50SFrank Blaschka return 0; 6734a71df50SFrank Blaschka } 6744a71df50SFrank Blaschka 6754a71df50SFrank Blaschka void qeth_clear_thread_start_bit(struct qeth_card *card, unsigned long thread) 6764a71df50SFrank Blaschka { 6774a71df50SFrank Blaschka unsigned long flags; 6784a71df50SFrank Blaschka 6794a71df50SFrank Blaschka spin_lock_irqsave(&card->thread_mask_lock, flags); 6804a71df50SFrank Blaschka card->thread_start_mask &= ~thread; 6814a71df50SFrank Blaschka spin_unlock_irqrestore(&card->thread_mask_lock, flags); 6824a71df50SFrank Blaschka wake_up(&card->wait_q); 6834a71df50SFrank Blaschka } 6844a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_clear_thread_start_bit); 6854a71df50SFrank Blaschka 6864a71df50SFrank Blaschka void qeth_clear_thread_running_bit(struct qeth_card *card, unsigned long thread) 6874a71df50SFrank Blaschka { 6884a71df50SFrank Blaschka unsigned long flags; 6894a71df50SFrank Blaschka 6904a71df50SFrank Blaschka spin_lock_irqsave(&card->thread_mask_lock, flags); 6914a71df50SFrank Blaschka card->thread_running_mask &= ~thread; 6924a71df50SFrank Blaschka spin_unlock_irqrestore(&card->thread_mask_lock, flags); 6934a71df50SFrank Blaschka wake_up(&card->wait_q); 6944a71df50SFrank Blaschka } 6954a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_clear_thread_running_bit); 6964a71df50SFrank Blaschka 6974a71df50SFrank Blaschka static int __qeth_do_run_thread(struct qeth_card *card, unsigned long thread) 6984a71df50SFrank Blaschka { 6994a71df50SFrank Blaschka unsigned long flags; 7004a71df50SFrank Blaschka int rc = 0; 7014a71df50SFrank Blaschka 7024a71df50SFrank Blaschka spin_lock_irqsave(&card->thread_mask_lock, flags); 7034a71df50SFrank Blaschka if (card->thread_start_mask & thread) { 7044a71df50SFrank Blaschka if ((card->thread_allowed_mask & thread) && 7054a71df50SFrank Blaschka !(card->thread_running_mask & thread)) { 7064a71df50SFrank Blaschka rc = 1; 7074a71df50SFrank Blaschka card->thread_start_mask &= ~thread; 7084a71df50SFrank Blaschka card->thread_running_mask |= thread; 7094a71df50SFrank Blaschka } else 7104a71df50SFrank Blaschka rc = -EPERM; 7114a71df50SFrank Blaschka } 7124a71df50SFrank Blaschka spin_unlock_irqrestore(&card->thread_mask_lock, flags); 7134a71df50SFrank Blaschka return rc; 7144a71df50SFrank Blaschka } 7154a71df50SFrank Blaschka 7164a71df50SFrank Blaschka int qeth_do_run_thread(struct qeth_card *card, unsigned long thread) 7174a71df50SFrank Blaschka { 7184a71df50SFrank Blaschka int rc = 0; 7194a71df50SFrank Blaschka 7204a71df50SFrank Blaschka wait_event(card->wait_q, 7214a71df50SFrank Blaschka (rc = __qeth_do_run_thread(card, thread)) >= 0); 7224a71df50SFrank Blaschka return rc; 7234a71df50SFrank Blaschka } 7244a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_do_run_thread); 7254a71df50SFrank Blaschka 7264a71df50SFrank Blaschka void qeth_schedule_recovery(struct qeth_card *card) 7274a71df50SFrank Blaschka { 728d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 2, "startrec"); 7294a71df50SFrank Blaschka if (qeth_set_thread_start_bit(card, QETH_RECOVER_THREAD) == 0) 7304a71df50SFrank Blaschka schedule_work(&card->kernel_thread_starter); 7314a71df50SFrank Blaschka } 7324a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_schedule_recovery); 7334a71df50SFrank Blaschka 7344a71df50SFrank Blaschka static int qeth_get_problem(struct ccw_device *cdev, struct irb *irb) 7354a71df50SFrank Blaschka { 7364a71df50SFrank Blaschka int dstat, cstat; 7374a71df50SFrank Blaschka char *sense; 7384a71df50SFrank Blaschka 7394a71df50SFrank Blaschka sense = (char *) irb->ecw; 74023d805b6SPeter Oberparleiter cstat = irb->scsw.cmd.cstat; 74123d805b6SPeter Oberparleiter dstat = irb->scsw.cmd.dstat; 7424a71df50SFrank Blaschka 7434a71df50SFrank Blaschka if (cstat & (SCHN_STAT_CHN_CTRL_CHK | SCHN_STAT_INTF_CTRL_CHK | 7444a71df50SFrank Blaschka SCHN_STAT_CHN_DATA_CHK | SCHN_STAT_CHAIN_CHECK | 7454a71df50SFrank Blaschka SCHN_STAT_PROT_CHECK | SCHN_STAT_PROG_CHECK)) { 746d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 2, "CGENCHK"); 7474a71df50SFrank Blaschka PRINT_WARN("check on device %s, dstat=x%x, cstat=x%x ", 7482a0217d5SKay Sievers dev_name(&cdev->dev), dstat, cstat); 7494a71df50SFrank Blaschka print_hex_dump(KERN_WARNING, "qeth: irb ", DUMP_PREFIX_OFFSET, 7504a71df50SFrank Blaschka 16, 1, irb, 64, 1); 7514a71df50SFrank Blaschka return 1; 7524a71df50SFrank Blaschka } 7534a71df50SFrank Blaschka 7544a71df50SFrank Blaschka if (dstat & DEV_STAT_UNIT_CHECK) { 7554a71df50SFrank Blaschka if (sense[SENSE_RESETTING_EVENT_BYTE] & 7564a71df50SFrank Blaschka SENSE_RESETTING_EVENT_FLAG) { 757d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 2, "REVIND"); 7584a71df50SFrank Blaschka return 1; 7594a71df50SFrank Blaschka } 7604a71df50SFrank Blaschka if (sense[SENSE_COMMAND_REJECT_BYTE] & 7614a71df50SFrank Blaschka SENSE_COMMAND_REJECT_FLAG) { 762d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 2, "CMDREJi"); 76328a7e4c9SUrsula Braun return 1; 7644a71df50SFrank Blaschka } 7654a71df50SFrank Blaschka if ((sense[2] == 0xaf) && (sense[3] == 0xfe)) { 766d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 2, "AFFE"); 7674a71df50SFrank Blaschka return 1; 7684a71df50SFrank Blaschka } 7694a71df50SFrank Blaschka if ((!sense[0]) && (!sense[1]) && (!sense[2]) && (!sense[3])) { 770d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 2, "ZEROSEN"); 7714a71df50SFrank Blaschka return 0; 7724a71df50SFrank Blaschka } 773d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 2, "DGENCHK"); 7744a71df50SFrank Blaschka return 1; 7754a71df50SFrank Blaschka } 7764a71df50SFrank Blaschka return 0; 7774a71df50SFrank Blaschka } 7784a71df50SFrank Blaschka 7794a71df50SFrank Blaschka static long __qeth_check_irb_error(struct ccw_device *cdev, 7804a71df50SFrank Blaschka unsigned long intparm, struct irb *irb) 7814a71df50SFrank Blaschka { 7824a71df50SFrank Blaschka if (!IS_ERR(irb)) 7834a71df50SFrank Blaschka return 0; 7844a71df50SFrank Blaschka 7854a71df50SFrank Blaschka switch (PTR_ERR(irb)) { 7864a71df50SFrank Blaschka case -EIO: 7872a0217d5SKay Sievers PRINT_WARN("i/o-error on device %s\n", dev_name(&cdev->dev)); 788d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 2, "ckirberr"); 789d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(TRACE, 2, " rc%d", -EIO); 7904a71df50SFrank Blaschka break; 7914a71df50SFrank Blaschka case -ETIMEDOUT: 7922a0217d5SKay Sievers PRINT_WARN("timeout on device %s\n", dev_name(&cdev->dev)); 793d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 2, "ckirberr"); 794d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(TRACE, 2, " rc%d", -ETIMEDOUT); 7954a71df50SFrank Blaschka if (intparm == QETH_RCD_PARM) { 7964a71df50SFrank Blaschka struct qeth_card *card = CARD_FROM_CDEV(cdev); 7974a71df50SFrank Blaschka 7984a71df50SFrank Blaschka if (card && (card->data.ccwdev == cdev)) { 7994a71df50SFrank Blaschka card->data.state = CH_STATE_DOWN; 8004a71df50SFrank Blaschka wake_up(&card->wait_q); 8014a71df50SFrank Blaschka } 8024a71df50SFrank Blaschka } 8034a71df50SFrank Blaschka break; 8044a71df50SFrank Blaschka default: 8054a71df50SFrank Blaschka PRINT_WARN("unknown error %ld on device %s\n", PTR_ERR(irb), 8062a0217d5SKay Sievers dev_name(&cdev->dev)); 807d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 2, "ckirberr"); 808d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 2, " rc???"); 8094a71df50SFrank Blaschka } 8104a71df50SFrank Blaschka return PTR_ERR(irb); 8114a71df50SFrank Blaschka } 8124a71df50SFrank Blaschka 8134a71df50SFrank Blaschka static void qeth_irq(struct ccw_device *cdev, unsigned long intparm, 8144a71df50SFrank Blaschka struct irb *irb) 8154a71df50SFrank Blaschka { 8164a71df50SFrank Blaschka int rc; 8174a71df50SFrank Blaschka int cstat, dstat; 8184a71df50SFrank Blaschka struct qeth_cmd_buffer *buffer; 8194a71df50SFrank Blaschka struct qeth_channel *channel; 8204a71df50SFrank Blaschka struct qeth_card *card; 8214a71df50SFrank Blaschka struct qeth_cmd_buffer *iob; 8224a71df50SFrank Blaschka __u8 index; 8234a71df50SFrank Blaschka 824d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 5, "irq"); 8254a71df50SFrank Blaschka 8264a71df50SFrank Blaschka if (__qeth_check_irb_error(cdev, intparm, irb)) 8274a71df50SFrank Blaschka return; 82823d805b6SPeter Oberparleiter cstat = irb->scsw.cmd.cstat; 82923d805b6SPeter Oberparleiter dstat = irb->scsw.cmd.dstat; 8304a71df50SFrank Blaschka 8314a71df50SFrank Blaschka card = CARD_FROM_CDEV(cdev); 8324a71df50SFrank Blaschka if (!card) 8334a71df50SFrank Blaschka return; 8344a71df50SFrank Blaschka 8354a71df50SFrank Blaschka if (card->read.ccwdev == cdev) { 8364a71df50SFrank Blaschka channel = &card->read; 837d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 5, "read"); 8384a71df50SFrank Blaschka } else if (card->write.ccwdev == cdev) { 8394a71df50SFrank Blaschka channel = &card->write; 840d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 5, "write"); 8414a71df50SFrank Blaschka } else { 8424a71df50SFrank Blaschka channel = &card->data; 843d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 5, "data"); 8444a71df50SFrank Blaschka } 8454a71df50SFrank Blaschka atomic_set(&channel->irq_pending, 0); 8464a71df50SFrank Blaschka 84723d805b6SPeter Oberparleiter if (irb->scsw.cmd.fctl & (SCSW_FCTL_CLEAR_FUNC)) 8484a71df50SFrank Blaschka channel->state = CH_STATE_STOPPED; 8494a71df50SFrank Blaschka 85023d805b6SPeter Oberparleiter if (irb->scsw.cmd.fctl & (SCSW_FCTL_HALT_FUNC)) 8514a71df50SFrank Blaschka channel->state = CH_STATE_HALTED; 8524a71df50SFrank Blaschka 8534a71df50SFrank Blaschka /*let's wake up immediately on data channel*/ 8544a71df50SFrank Blaschka if ((channel == &card->data) && (intparm != 0) && 8554a71df50SFrank Blaschka (intparm != QETH_RCD_PARM)) 8564a71df50SFrank Blaschka goto out; 8574a71df50SFrank Blaschka 8584a71df50SFrank Blaschka if (intparm == QETH_CLEAR_CHANNEL_PARM) { 859d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 6, "clrchpar"); 8604a71df50SFrank Blaschka /* we don't have to handle this further */ 8614a71df50SFrank Blaschka intparm = 0; 8624a71df50SFrank Blaschka } 8634a71df50SFrank Blaschka if (intparm == QETH_HALT_CHANNEL_PARM) { 864d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 6, "hltchpar"); 8654a71df50SFrank Blaschka /* we don't have to handle this further */ 8664a71df50SFrank Blaschka intparm = 0; 8674a71df50SFrank Blaschka } 8684a71df50SFrank Blaschka if ((dstat & DEV_STAT_UNIT_EXCEP) || 8694a71df50SFrank Blaschka (dstat & DEV_STAT_UNIT_CHECK) || 8704a71df50SFrank Blaschka (cstat)) { 8714a71df50SFrank Blaschka if (irb->esw.esw0.erw.cons) { 8724a71df50SFrank Blaschka /* TODO: we should make this s390dbf */ 8734a71df50SFrank Blaschka PRINT_WARN("sense data available on channel %s.\n", 8744a71df50SFrank Blaschka CHANNEL_ID(channel)); 8754a71df50SFrank Blaschka PRINT_WARN(" cstat 0x%X\n dstat 0x%X\n", cstat, dstat); 8764a71df50SFrank Blaschka print_hex_dump(KERN_WARNING, "qeth: irb ", 8774a71df50SFrank Blaschka DUMP_PREFIX_OFFSET, 16, 1, irb, 32, 1); 8784a71df50SFrank Blaschka print_hex_dump(KERN_WARNING, "qeth: sense data ", 8794a71df50SFrank Blaschka DUMP_PREFIX_OFFSET, 16, 1, irb->ecw, 32, 1); 8804a71df50SFrank Blaschka } 8814a71df50SFrank Blaschka if (intparm == QETH_RCD_PARM) { 8824a71df50SFrank Blaschka channel->state = CH_STATE_DOWN; 8834a71df50SFrank Blaschka goto out; 8844a71df50SFrank Blaschka } 8854a71df50SFrank Blaschka rc = qeth_get_problem(cdev, irb); 8864a71df50SFrank Blaschka if (rc) { 88728a7e4c9SUrsula Braun qeth_clear_ipacmd_list(card); 8884a71df50SFrank Blaschka qeth_schedule_recovery(card); 8894a71df50SFrank Blaschka goto out; 8904a71df50SFrank Blaschka } 8914a71df50SFrank Blaschka } 8924a71df50SFrank Blaschka 8934a71df50SFrank Blaschka if (intparm == QETH_RCD_PARM) { 8944a71df50SFrank Blaschka channel->state = CH_STATE_RCD_DONE; 8954a71df50SFrank Blaschka goto out; 8964a71df50SFrank Blaschka } 8974a71df50SFrank Blaschka if (intparm) { 8984a71df50SFrank Blaschka buffer = (struct qeth_cmd_buffer *) __va((addr_t)intparm); 8994a71df50SFrank Blaschka buffer->state = BUF_STATE_PROCESSED; 9004a71df50SFrank Blaschka } 9014a71df50SFrank Blaschka if (channel == &card->data) 9024a71df50SFrank Blaschka return; 9034a71df50SFrank Blaschka if (channel == &card->read && 9044a71df50SFrank Blaschka channel->state == CH_STATE_UP) 9054a71df50SFrank Blaschka qeth_issue_next_read(card); 9064a71df50SFrank Blaschka 9074a71df50SFrank Blaschka iob = channel->iob; 9084a71df50SFrank Blaschka index = channel->buf_no; 9094a71df50SFrank Blaschka while (iob[index].state == BUF_STATE_PROCESSED) { 9104a71df50SFrank Blaschka if (iob[index].callback != NULL) 9114a71df50SFrank Blaschka iob[index].callback(channel, iob + index); 9124a71df50SFrank Blaschka 9134a71df50SFrank Blaschka index = (index + 1) % QETH_CMD_BUFFER_NO; 9144a71df50SFrank Blaschka } 9154a71df50SFrank Blaschka channel->buf_no = index; 9164a71df50SFrank Blaschka out: 9174a71df50SFrank Blaschka wake_up(&card->wait_q); 9184a71df50SFrank Blaschka return; 9194a71df50SFrank Blaschka } 9204a71df50SFrank Blaschka 9214a71df50SFrank Blaschka static void qeth_clear_output_buffer(struct qeth_qdio_out_q *queue, 9224a71df50SFrank Blaschka struct qeth_qdio_out_buffer *buf) 9234a71df50SFrank Blaschka { 9244a71df50SFrank Blaschka int i; 9254a71df50SFrank Blaschka struct sk_buff *skb; 9264a71df50SFrank Blaschka 9274a71df50SFrank Blaschka /* is PCI flag set on buffer? */ 9284a71df50SFrank Blaschka if (buf->buffer->element[0].flags & 0x40) 9294a71df50SFrank Blaschka atomic_dec(&queue->set_pci_flags_count); 9304a71df50SFrank Blaschka 9314a71df50SFrank Blaschka skb = skb_dequeue(&buf->skb_list); 9324a71df50SFrank Blaschka while (skb) { 9334a71df50SFrank Blaschka atomic_dec(&skb->users); 9344a71df50SFrank Blaschka dev_kfree_skb_any(skb); 9354a71df50SFrank Blaschka skb = skb_dequeue(&buf->skb_list); 9364a71df50SFrank Blaschka } 9374a71df50SFrank Blaschka qeth_eddp_buf_release_contexts(buf); 9384a71df50SFrank Blaschka for (i = 0; i < QETH_MAX_BUFFER_ELEMENTS(queue->card); ++i) { 939683d718aSFrank Blaschka if (buf->buffer->element[i].addr && buf->is_header[i]) 940683d718aSFrank Blaschka kmem_cache_free(qeth_core_header_cache, 941683d718aSFrank Blaschka buf->buffer->element[i].addr); 942683d718aSFrank Blaschka buf->is_header[i] = 0; 9434a71df50SFrank Blaschka buf->buffer->element[i].length = 0; 9444a71df50SFrank Blaschka buf->buffer->element[i].addr = NULL; 9454a71df50SFrank Blaschka buf->buffer->element[i].flags = 0; 9464a71df50SFrank Blaschka } 9474a71df50SFrank Blaschka buf->next_element_to_fill = 0; 9484a71df50SFrank Blaschka atomic_set(&buf->state, QETH_QDIO_BUF_EMPTY); 9494a71df50SFrank Blaschka } 9504a71df50SFrank Blaschka 9514a71df50SFrank Blaschka void qeth_clear_qdio_buffers(struct qeth_card *card) 9524a71df50SFrank Blaschka { 9534a71df50SFrank Blaschka int i, j; 9544a71df50SFrank Blaschka 955d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 2, "clearqdbf"); 9564a71df50SFrank Blaschka /* clear outbound buffers to free skbs */ 9574a71df50SFrank Blaschka for (i = 0; i < card->qdio.no_out_queues; ++i) 9584a71df50SFrank Blaschka if (card->qdio.out_qs[i]) { 9594a71df50SFrank Blaschka for (j = 0; j < QDIO_MAX_BUFFERS_PER_Q; ++j) 9604a71df50SFrank Blaschka qeth_clear_output_buffer(card->qdio.out_qs[i], 9614a71df50SFrank Blaschka &card->qdio.out_qs[i]->bufs[j]); 9624a71df50SFrank Blaschka } 9634a71df50SFrank Blaschka } 9644a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_clear_qdio_buffers); 9654a71df50SFrank Blaschka 9664a71df50SFrank Blaschka static void qeth_free_buffer_pool(struct qeth_card *card) 9674a71df50SFrank Blaschka { 9684a71df50SFrank Blaschka struct qeth_buffer_pool_entry *pool_entry, *tmp; 9694a71df50SFrank Blaschka int i = 0; 970d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 5, "freepool"); 9714a71df50SFrank Blaschka list_for_each_entry_safe(pool_entry, tmp, 9724a71df50SFrank Blaschka &card->qdio.init_pool.entry_list, init_list){ 9734a71df50SFrank Blaschka for (i = 0; i < QETH_MAX_BUFFER_ELEMENTS(card); ++i) 9744a71df50SFrank Blaschka free_page((unsigned long)pool_entry->elements[i]); 9754a71df50SFrank Blaschka list_del(&pool_entry->init_list); 9764a71df50SFrank Blaschka kfree(pool_entry); 9774a71df50SFrank Blaschka } 9784a71df50SFrank Blaschka } 9794a71df50SFrank Blaschka 9804a71df50SFrank Blaschka static void qeth_free_qdio_buffers(struct qeth_card *card) 9814a71df50SFrank Blaschka { 9824a71df50SFrank Blaschka int i, j; 9834a71df50SFrank Blaschka 984d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 2, "freeqdbf"); 9854a71df50SFrank Blaschka if (atomic_xchg(&card->qdio.state, QETH_QDIO_UNINITIALIZED) == 9864a71df50SFrank Blaschka QETH_QDIO_UNINITIALIZED) 9874a71df50SFrank Blaschka return; 9884a71df50SFrank Blaschka kfree(card->qdio.in_q); 9894a71df50SFrank Blaschka card->qdio.in_q = NULL; 9904a71df50SFrank Blaschka /* inbound buffer pool */ 9914a71df50SFrank Blaschka qeth_free_buffer_pool(card); 9924a71df50SFrank Blaschka /* free outbound qdio_qs */ 9934a71df50SFrank Blaschka if (card->qdio.out_qs) { 9944a71df50SFrank Blaschka for (i = 0; i < card->qdio.no_out_queues; ++i) { 9954a71df50SFrank Blaschka for (j = 0; j < QDIO_MAX_BUFFERS_PER_Q; ++j) 9964a71df50SFrank Blaschka qeth_clear_output_buffer(card->qdio.out_qs[i], 9974a71df50SFrank Blaschka &card->qdio.out_qs[i]->bufs[j]); 9984a71df50SFrank Blaschka kfree(card->qdio.out_qs[i]); 9994a71df50SFrank Blaschka } 10004a71df50SFrank Blaschka kfree(card->qdio.out_qs); 10014a71df50SFrank Blaschka card->qdio.out_qs = NULL; 10024a71df50SFrank Blaschka } 10034a71df50SFrank Blaschka } 10044a71df50SFrank Blaschka 10054a71df50SFrank Blaschka static void qeth_clean_channel(struct qeth_channel *channel) 10064a71df50SFrank Blaschka { 10074a71df50SFrank Blaschka int cnt; 10084a71df50SFrank Blaschka 1009d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "freech"); 10104a71df50SFrank Blaschka for (cnt = 0; cnt < QETH_CMD_BUFFER_NO; cnt++) 10114a71df50SFrank Blaschka kfree(channel->iob[cnt].data); 10124a71df50SFrank Blaschka } 10134a71df50SFrank Blaschka 10144a71df50SFrank Blaschka static int qeth_is_1920_device(struct qeth_card *card) 10154a71df50SFrank Blaschka { 10164a71df50SFrank Blaschka int single_queue = 0; 10174a71df50SFrank Blaschka struct ccw_device *ccwdev; 10184a71df50SFrank Blaschka struct channelPath_dsc { 10194a71df50SFrank Blaschka u8 flags; 10204a71df50SFrank Blaschka u8 lsn; 10214a71df50SFrank Blaschka u8 desc; 10224a71df50SFrank Blaschka u8 chpid; 10234a71df50SFrank Blaschka u8 swla; 10244a71df50SFrank Blaschka u8 zeroes; 10254a71df50SFrank Blaschka u8 chla; 10264a71df50SFrank Blaschka u8 chpp; 10274a71df50SFrank Blaschka } *chp_dsc; 10284a71df50SFrank Blaschka 1029d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "chk_1920"); 10304a71df50SFrank Blaschka 10314a71df50SFrank Blaschka ccwdev = card->data.ccwdev; 10324a71df50SFrank Blaschka chp_dsc = (struct channelPath_dsc *)ccw_device_get_chp_desc(ccwdev, 0); 10334a71df50SFrank Blaschka if (chp_dsc != NULL) { 10344a71df50SFrank Blaschka /* CHPP field bit 6 == 1 -> single queue */ 10354a71df50SFrank Blaschka single_queue = ((chp_dsc->chpp & 0x02) == 0x02); 10364a71df50SFrank Blaschka kfree(chp_dsc); 10374a71df50SFrank Blaschka } 1038d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "rc:%x", single_queue); 10394a71df50SFrank Blaschka return single_queue; 10404a71df50SFrank Blaschka } 10414a71df50SFrank Blaschka 10424a71df50SFrank Blaschka static void qeth_init_qdio_info(struct qeth_card *card) 10434a71df50SFrank Blaschka { 1044d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 4, "intqdinf"); 10454a71df50SFrank Blaschka atomic_set(&card->qdio.state, QETH_QDIO_UNINITIALIZED); 10464a71df50SFrank Blaschka /* inbound */ 10474a71df50SFrank Blaschka card->qdio.in_buf_size = QETH_IN_BUF_SIZE_DEFAULT; 10484a71df50SFrank Blaschka card->qdio.init_pool.buf_count = QETH_IN_BUF_COUNT_DEFAULT; 10494a71df50SFrank Blaschka card->qdio.in_buf_pool.buf_count = card->qdio.init_pool.buf_count; 10504a71df50SFrank Blaschka INIT_LIST_HEAD(&card->qdio.in_buf_pool.entry_list); 10514a71df50SFrank Blaschka INIT_LIST_HEAD(&card->qdio.init_pool.entry_list); 10524a71df50SFrank Blaschka } 10534a71df50SFrank Blaschka 10544a71df50SFrank Blaschka static void qeth_set_intial_options(struct qeth_card *card) 10554a71df50SFrank Blaschka { 10564a71df50SFrank Blaschka card->options.route4.type = NO_ROUTER; 10574a71df50SFrank Blaschka card->options.route6.type = NO_ROUTER; 10584a71df50SFrank Blaschka card->options.checksum_type = QETH_CHECKSUM_DEFAULT; 10594a71df50SFrank Blaschka card->options.broadcast_mode = QETH_TR_BROADCAST_ALLRINGS; 10604a71df50SFrank Blaschka card->options.macaddr_mode = QETH_TR_MACADDR_NONCANONICAL; 10614a71df50SFrank Blaschka card->options.fake_broadcast = 0; 10624a71df50SFrank Blaschka card->options.add_hhlen = DEFAULT_ADD_HHLEN; 10634a71df50SFrank Blaschka card->options.fake_ll = 0; 10644a71df50SFrank Blaschka card->options.performance_stats = 0; 10654a71df50SFrank Blaschka card->options.rx_sg_cb = QETH_RX_SG_CB; 10664a71df50SFrank Blaschka } 10674a71df50SFrank Blaschka 10684a71df50SFrank Blaschka static int qeth_do_start_thread(struct qeth_card *card, unsigned long thread) 10694a71df50SFrank Blaschka { 10704a71df50SFrank Blaschka unsigned long flags; 10714a71df50SFrank Blaschka int rc = 0; 10724a71df50SFrank Blaschka 10734a71df50SFrank Blaschka spin_lock_irqsave(&card->thread_mask_lock, flags); 1074d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(TRACE, 4, " %02x%02x%02x", 10754a71df50SFrank Blaschka (u8) card->thread_start_mask, 10764a71df50SFrank Blaschka (u8) card->thread_allowed_mask, 10774a71df50SFrank Blaschka (u8) card->thread_running_mask); 10784a71df50SFrank Blaschka rc = (card->thread_start_mask & thread); 10794a71df50SFrank Blaschka spin_unlock_irqrestore(&card->thread_mask_lock, flags); 10804a71df50SFrank Blaschka return rc; 10814a71df50SFrank Blaschka } 10824a71df50SFrank Blaschka 10834a71df50SFrank Blaschka static void qeth_start_kernel_thread(struct work_struct *work) 10844a71df50SFrank Blaschka { 10854a71df50SFrank Blaschka struct qeth_card *card = container_of(work, struct qeth_card, 10864a71df50SFrank Blaschka kernel_thread_starter); 1087d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE , 2, "strthrd"); 10884a71df50SFrank Blaschka 10894a71df50SFrank Blaschka if (card->read.state != CH_STATE_UP && 10904a71df50SFrank Blaschka card->write.state != CH_STATE_UP) 10914a71df50SFrank Blaschka return; 10924a71df50SFrank Blaschka if (qeth_do_start_thread(card, QETH_RECOVER_THREAD)) 10934a71df50SFrank Blaschka kthread_run(card->discipline.recover, (void *) card, 10944a71df50SFrank Blaschka "qeth_recover"); 10954a71df50SFrank Blaschka } 10964a71df50SFrank Blaschka 10974a71df50SFrank Blaschka static int qeth_setup_card(struct qeth_card *card) 10984a71df50SFrank Blaschka { 10994a71df50SFrank Blaschka 1100d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "setupcrd"); 1101d11ba0c4SPeter Tiedemann QETH_DBF_HEX(SETUP, 2, &card, sizeof(void *)); 11024a71df50SFrank Blaschka 11034a71df50SFrank Blaschka card->read.state = CH_STATE_DOWN; 11044a71df50SFrank Blaschka card->write.state = CH_STATE_DOWN; 11054a71df50SFrank Blaschka card->data.state = CH_STATE_DOWN; 11064a71df50SFrank Blaschka card->state = CARD_STATE_DOWN; 11074a71df50SFrank Blaschka card->lan_online = 0; 11084a71df50SFrank Blaschka card->use_hard_stop = 0; 11094a71df50SFrank Blaschka card->dev = NULL; 11104a71df50SFrank Blaschka spin_lock_init(&card->vlanlock); 11114a71df50SFrank Blaschka spin_lock_init(&card->mclock); 11124a71df50SFrank Blaschka card->vlangrp = NULL; 11134a71df50SFrank Blaschka spin_lock_init(&card->lock); 11144a71df50SFrank Blaschka spin_lock_init(&card->ip_lock); 11154a71df50SFrank Blaschka spin_lock_init(&card->thread_mask_lock); 11164a71df50SFrank Blaschka card->thread_start_mask = 0; 11174a71df50SFrank Blaschka card->thread_allowed_mask = 0; 11184a71df50SFrank Blaschka card->thread_running_mask = 0; 11194a71df50SFrank Blaschka INIT_WORK(&card->kernel_thread_starter, qeth_start_kernel_thread); 11204a71df50SFrank Blaschka INIT_LIST_HEAD(&card->ip_list); 11214a71df50SFrank Blaschka card->ip_tbd_list = kmalloc(sizeof(struct list_head), GFP_KERNEL); 11224a71df50SFrank Blaschka if (!card->ip_tbd_list) { 1123d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 0, "iptbdnom"); 11244a71df50SFrank Blaschka return -ENOMEM; 11254a71df50SFrank Blaschka } 11264a71df50SFrank Blaschka INIT_LIST_HEAD(card->ip_tbd_list); 11274a71df50SFrank Blaschka INIT_LIST_HEAD(&card->cmd_waiter_list); 11284a71df50SFrank Blaschka init_waitqueue_head(&card->wait_q); 11294a71df50SFrank Blaschka /* intial options */ 11304a71df50SFrank Blaschka qeth_set_intial_options(card); 11314a71df50SFrank Blaschka /* IP address takeover */ 11324a71df50SFrank Blaschka INIT_LIST_HEAD(&card->ipato.entries); 11334a71df50SFrank Blaschka card->ipato.enabled = 0; 11344a71df50SFrank Blaschka card->ipato.invert4 = 0; 11354a71df50SFrank Blaschka card->ipato.invert6 = 0; 11364a71df50SFrank Blaschka /* init QDIO stuff */ 11374a71df50SFrank Blaschka qeth_init_qdio_info(card); 11384a71df50SFrank Blaschka return 0; 11394a71df50SFrank Blaschka } 11404a71df50SFrank Blaschka 11414a71df50SFrank Blaschka static struct qeth_card *qeth_alloc_card(void) 11424a71df50SFrank Blaschka { 11434a71df50SFrank Blaschka struct qeth_card *card; 11444a71df50SFrank Blaschka 1145d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "alloccrd"); 11464a71df50SFrank Blaschka card = kzalloc(sizeof(struct qeth_card), GFP_DMA|GFP_KERNEL); 11474a71df50SFrank Blaschka if (!card) 11484a71df50SFrank Blaschka return NULL; 1149d11ba0c4SPeter Tiedemann QETH_DBF_HEX(SETUP, 2, &card, sizeof(void *)); 11504a71df50SFrank Blaschka if (qeth_setup_channel(&card->read)) { 11514a71df50SFrank Blaschka kfree(card); 11524a71df50SFrank Blaschka return NULL; 11534a71df50SFrank Blaschka } 11544a71df50SFrank Blaschka if (qeth_setup_channel(&card->write)) { 11554a71df50SFrank Blaschka qeth_clean_channel(&card->read); 11564a71df50SFrank Blaschka kfree(card); 11574a71df50SFrank Blaschka return NULL; 11584a71df50SFrank Blaschka } 11594a71df50SFrank Blaschka card->options.layer2 = -1; 11604a71df50SFrank Blaschka return card; 11614a71df50SFrank Blaschka } 11624a71df50SFrank Blaschka 11634a71df50SFrank Blaschka static int qeth_determine_card_type(struct qeth_card *card) 11644a71df50SFrank Blaschka { 11654a71df50SFrank Blaschka int i = 0; 11664a71df50SFrank Blaschka 1167d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "detcdtyp"); 11684a71df50SFrank Blaschka 11694a71df50SFrank Blaschka card->qdio.do_prio_queueing = QETH_PRIOQ_DEFAULT; 11704a71df50SFrank Blaschka card->qdio.default_out_queue = QETH_DEFAULT_QUEUE; 11714a71df50SFrank Blaschka while (known_devices[i][4]) { 11724a71df50SFrank Blaschka if ((CARD_RDEV(card)->id.dev_type == known_devices[i][2]) && 11734a71df50SFrank Blaschka (CARD_RDEV(card)->id.dev_model == known_devices[i][3])) { 11744a71df50SFrank Blaschka card->info.type = known_devices[i][4]; 11754a71df50SFrank Blaschka card->qdio.no_out_queues = known_devices[i][8]; 11764a71df50SFrank Blaschka card->info.is_multicast_different = known_devices[i][9]; 11774a71df50SFrank Blaschka if (qeth_is_1920_device(card)) { 11784a71df50SFrank Blaschka PRINT_INFO("Priority Queueing not able " 11794a71df50SFrank Blaschka "due to hardware limitations!\n"); 11804a71df50SFrank Blaschka card->qdio.no_out_queues = 1; 11814a71df50SFrank Blaschka card->qdio.default_out_queue = 0; 11824a71df50SFrank Blaschka } 11834a71df50SFrank Blaschka return 0; 11844a71df50SFrank Blaschka } 11854a71df50SFrank Blaschka i++; 11864a71df50SFrank Blaschka } 11874a71df50SFrank Blaschka card->info.type = QETH_CARD_TYPE_UNKNOWN; 11884a71df50SFrank Blaschka PRINT_ERR("unknown card type on device %s\n", CARD_BUS_ID(card)); 11894a71df50SFrank Blaschka return -ENOENT; 11904a71df50SFrank Blaschka } 11914a71df50SFrank Blaschka 11924a71df50SFrank Blaschka static int qeth_clear_channel(struct qeth_channel *channel) 11934a71df50SFrank Blaschka { 11944a71df50SFrank Blaschka unsigned long flags; 11954a71df50SFrank Blaschka struct qeth_card *card; 11964a71df50SFrank Blaschka int rc; 11974a71df50SFrank Blaschka 1198d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 3, "clearch"); 11994a71df50SFrank Blaschka card = CARD_FROM_CDEV(channel->ccwdev); 12004a71df50SFrank Blaschka spin_lock_irqsave(get_ccwdev_lock(channel->ccwdev), flags); 12014a71df50SFrank Blaschka rc = ccw_device_clear(channel->ccwdev, QETH_CLEAR_CHANNEL_PARM); 12024a71df50SFrank Blaschka spin_unlock_irqrestore(get_ccwdev_lock(channel->ccwdev), flags); 12034a71df50SFrank Blaschka 12044a71df50SFrank Blaschka if (rc) 12054a71df50SFrank Blaschka return rc; 12064a71df50SFrank Blaschka rc = wait_event_interruptible_timeout(card->wait_q, 12074a71df50SFrank Blaschka channel->state == CH_STATE_STOPPED, QETH_TIMEOUT); 12084a71df50SFrank Blaschka if (rc == -ERESTARTSYS) 12094a71df50SFrank Blaschka return rc; 12104a71df50SFrank Blaschka if (channel->state != CH_STATE_STOPPED) 12114a71df50SFrank Blaschka return -ETIME; 12124a71df50SFrank Blaschka channel->state = CH_STATE_DOWN; 12134a71df50SFrank Blaschka return 0; 12144a71df50SFrank Blaschka } 12154a71df50SFrank Blaschka 12164a71df50SFrank Blaschka static int qeth_halt_channel(struct qeth_channel *channel) 12174a71df50SFrank Blaschka { 12184a71df50SFrank Blaschka unsigned long flags; 12194a71df50SFrank Blaschka struct qeth_card *card; 12204a71df50SFrank Blaschka int rc; 12214a71df50SFrank Blaschka 1222d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 3, "haltch"); 12234a71df50SFrank Blaschka card = CARD_FROM_CDEV(channel->ccwdev); 12244a71df50SFrank Blaschka spin_lock_irqsave(get_ccwdev_lock(channel->ccwdev), flags); 12254a71df50SFrank Blaschka rc = ccw_device_halt(channel->ccwdev, QETH_HALT_CHANNEL_PARM); 12264a71df50SFrank Blaschka spin_unlock_irqrestore(get_ccwdev_lock(channel->ccwdev), flags); 12274a71df50SFrank Blaschka 12284a71df50SFrank Blaschka if (rc) 12294a71df50SFrank Blaschka return rc; 12304a71df50SFrank Blaschka rc = wait_event_interruptible_timeout(card->wait_q, 12314a71df50SFrank Blaschka channel->state == CH_STATE_HALTED, QETH_TIMEOUT); 12324a71df50SFrank Blaschka if (rc == -ERESTARTSYS) 12334a71df50SFrank Blaschka return rc; 12344a71df50SFrank Blaschka if (channel->state != CH_STATE_HALTED) 12354a71df50SFrank Blaschka return -ETIME; 12364a71df50SFrank Blaschka return 0; 12374a71df50SFrank Blaschka } 12384a71df50SFrank Blaschka 12394a71df50SFrank Blaschka static int qeth_halt_channels(struct qeth_card *card) 12404a71df50SFrank Blaschka { 12414a71df50SFrank Blaschka int rc1 = 0, rc2 = 0, rc3 = 0; 12424a71df50SFrank Blaschka 1243d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 3, "haltchs"); 12444a71df50SFrank Blaschka rc1 = qeth_halt_channel(&card->read); 12454a71df50SFrank Blaschka rc2 = qeth_halt_channel(&card->write); 12464a71df50SFrank Blaschka rc3 = qeth_halt_channel(&card->data); 12474a71df50SFrank Blaschka if (rc1) 12484a71df50SFrank Blaschka return rc1; 12494a71df50SFrank Blaschka if (rc2) 12504a71df50SFrank Blaschka return rc2; 12514a71df50SFrank Blaschka return rc3; 12524a71df50SFrank Blaschka } 12534a71df50SFrank Blaschka 12544a71df50SFrank Blaschka static int qeth_clear_channels(struct qeth_card *card) 12554a71df50SFrank Blaschka { 12564a71df50SFrank Blaschka int rc1 = 0, rc2 = 0, rc3 = 0; 12574a71df50SFrank Blaschka 1258d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 3, "clearchs"); 12594a71df50SFrank Blaschka rc1 = qeth_clear_channel(&card->read); 12604a71df50SFrank Blaschka rc2 = qeth_clear_channel(&card->write); 12614a71df50SFrank Blaschka rc3 = qeth_clear_channel(&card->data); 12624a71df50SFrank Blaschka if (rc1) 12634a71df50SFrank Blaschka return rc1; 12644a71df50SFrank Blaschka if (rc2) 12654a71df50SFrank Blaschka return rc2; 12664a71df50SFrank Blaschka return rc3; 12674a71df50SFrank Blaschka } 12684a71df50SFrank Blaschka 12694a71df50SFrank Blaschka static int qeth_clear_halt_card(struct qeth_card *card, int halt) 12704a71df50SFrank Blaschka { 12714a71df50SFrank Blaschka int rc = 0; 12724a71df50SFrank Blaschka 1273d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 3, "clhacrd"); 1274d11ba0c4SPeter Tiedemann QETH_DBF_HEX(TRACE, 3, &card, sizeof(void *)); 12754a71df50SFrank Blaschka 12764a71df50SFrank Blaschka if (halt) 12774a71df50SFrank Blaschka rc = qeth_halt_channels(card); 12784a71df50SFrank Blaschka if (rc) 12794a71df50SFrank Blaschka return rc; 12804a71df50SFrank Blaschka return qeth_clear_channels(card); 12814a71df50SFrank Blaschka } 12824a71df50SFrank Blaschka 12834a71df50SFrank Blaschka int qeth_qdio_clear_card(struct qeth_card *card, int use_halt) 12844a71df50SFrank Blaschka { 12854a71df50SFrank Blaschka int rc = 0; 12864a71df50SFrank Blaschka 1287d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 3, "qdioclr"); 12884a71df50SFrank Blaschka switch (atomic_cmpxchg(&card->qdio.state, QETH_QDIO_ESTABLISHED, 12894a71df50SFrank Blaschka QETH_QDIO_CLEANING)) { 12904a71df50SFrank Blaschka case QETH_QDIO_ESTABLISHED: 12914a71df50SFrank Blaschka if (card->info.type == QETH_CARD_TYPE_IQD) 12924a71df50SFrank Blaschka rc = qdio_cleanup(CARD_DDEV(card), 12934a71df50SFrank Blaschka QDIO_FLAG_CLEANUP_USING_HALT); 12944a71df50SFrank Blaschka else 12954a71df50SFrank Blaschka rc = qdio_cleanup(CARD_DDEV(card), 12964a71df50SFrank Blaschka QDIO_FLAG_CLEANUP_USING_CLEAR); 12974a71df50SFrank Blaschka if (rc) 1298d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(TRACE, 3, "1err%d", rc); 12994a71df50SFrank Blaschka atomic_set(&card->qdio.state, QETH_QDIO_ALLOCATED); 13004a71df50SFrank Blaschka break; 13014a71df50SFrank Blaschka case QETH_QDIO_CLEANING: 13024a71df50SFrank Blaschka return rc; 13034a71df50SFrank Blaschka default: 13044a71df50SFrank Blaschka break; 13054a71df50SFrank Blaschka } 13064a71df50SFrank Blaschka rc = qeth_clear_halt_card(card, use_halt); 13074a71df50SFrank Blaschka if (rc) 1308d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(TRACE, 3, "2err%d", rc); 13094a71df50SFrank Blaschka card->state = CARD_STATE_DOWN; 13104a71df50SFrank Blaschka return rc; 13114a71df50SFrank Blaschka } 13124a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_qdio_clear_card); 13134a71df50SFrank Blaschka 13144a71df50SFrank Blaschka static int qeth_read_conf_data(struct qeth_card *card, void **buffer, 13154a71df50SFrank Blaschka int *length) 13164a71df50SFrank Blaschka { 13174a71df50SFrank Blaschka struct ciw *ciw; 13184a71df50SFrank Blaschka char *rcd_buf; 13194a71df50SFrank Blaschka int ret; 13204a71df50SFrank Blaschka struct qeth_channel *channel = &card->data; 13214a71df50SFrank Blaschka unsigned long flags; 13224a71df50SFrank Blaschka 13234a71df50SFrank Blaschka /* 13244a71df50SFrank Blaschka * scan for RCD command in extended SenseID data 13254a71df50SFrank Blaschka */ 13264a71df50SFrank Blaschka ciw = ccw_device_get_ciw(channel->ccwdev, CIW_TYPE_RCD); 13274a71df50SFrank Blaschka if (!ciw || ciw->cmd == 0) 13284a71df50SFrank Blaschka return -EOPNOTSUPP; 13294a71df50SFrank Blaschka rcd_buf = kzalloc(ciw->count, GFP_KERNEL | GFP_DMA); 13304a71df50SFrank Blaschka if (!rcd_buf) 13314a71df50SFrank Blaschka return -ENOMEM; 13324a71df50SFrank Blaschka 13334a71df50SFrank Blaschka channel->ccw.cmd_code = ciw->cmd; 13344a71df50SFrank Blaschka channel->ccw.cda = (__u32) __pa(rcd_buf); 13354a71df50SFrank Blaschka channel->ccw.count = ciw->count; 13364a71df50SFrank Blaschka channel->ccw.flags = CCW_FLAG_SLI; 13374a71df50SFrank Blaschka channel->state = CH_STATE_RCD; 13384a71df50SFrank Blaschka spin_lock_irqsave(get_ccwdev_lock(channel->ccwdev), flags); 13394a71df50SFrank Blaschka ret = ccw_device_start_timeout(channel->ccwdev, &channel->ccw, 13404a71df50SFrank Blaschka QETH_RCD_PARM, LPM_ANYPATH, 0, 13414a71df50SFrank Blaschka QETH_RCD_TIMEOUT); 13424a71df50SFrank Blaschka spin_unlock_irqrestore(get_ccwdev_lock(channel->ccwdev), flags); 13434a71df50SFrank Blaschka if (!ret) 13444a71df50SFrank Blaschka wait_event(card->wait_q, 13454a71df50SFrank Blaschka (channel->state == CH_STATE_RCD_DONE || 13464a71df50SFrank Blaschka channel->state == CH_STATE_DOWN)); 13474a71df50SFrank Blaschka if (channel->state == CH_STATE_DOWN) 13484a71df50SFrank Blaschka ret = -EIO; 13494a71df50SFrank Blaschka else 13504a71df50SFrank Blaschka channel->state = CH_STATE_DOWN; 13514a71df50SFrank Blaschka if (ret) { 13524a71df50SFrank Blaschka kfree(rcd_buf); 13534a71df50SFrank Blaschka *buffer = NULL; 13544a71df50SFrank Blaschka *length = 0; 13554a71df50SFrank Blaschka } else { 13564a71df50SFrank Blaschka *length = ciw->count; 13574a71df50SFrank Blaschka *buffer = rcd_buf; 13584a71df50SFrank Blaschka } 13594a71df50SFrank Blaschka return ret; 13604a71df50SFrank Blaschka } 13614a71df50SFrank Blaschka 13624a71df50SFrank Blaschka static int qeth_get_unitaddr(struct qeth_card *card) 13634a71df50SFrank Blaschka { 13644a71df50SFrank Blaschka int length; 13654a71df50SFrank Blaschka char *prcd; 13664a71df50SFrank Blaschka int rc; 13674a71df50SFrank Blaschka 1368d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "getunit"); 13694a71df50SFrank Blaschka rc = qeth_read_conf_data(card, (void **) &prcd, &length); 13704a71df50SFrank Blaschka if (rc) { 13714a71df50SFrank Blaschka PRINT_ERR("qeth_read_conf_data for device %s returned %i\n", 13724a71df50SFrank Blaschka CARD_DDEV_ID(card), rc); 13734a71df50SFrank Blaschka return rc; 13744a71df50SFrank Blaschka } 13754a71df50SFrank Blaschka card->info.chpid = prcd[30]; 13764a71df50SFrank Blaschka card->info.unit_addr2 = prcd[31]; 13774a71df50SFrank Blaschka card->info.cula = prcd[63]; 13784a71df50SFrank Blaschka card->info.guestlan = ((prcd[0x10] == _ascebc['V']) && 13794a71df50SFrank Blaschka (prcd[0x11] == _ascebc['M'])); 13804a71df50SFrank Blaschka kfree(prcd); 13814a71df50SFrank Blaschka return 0; 13824a71df50SFrank Blaschka } 13834a71df50SFrank Blaschka 13844a71df50SFrank Blaschka static void qeth_init_tokens(struct qeth_card *card) 13854a71df50SFrank Blaschka { 13864a71df50SFrank Blaschka card->token.issuer_rm_w = 0x00010103UL; 13874a71df50SFrank Blaschka card->token.cm_filter_w = 0x00010108UL; 13884a71df50SFrank Blaschka card->token.cm_connection_w = 0x0001010aUL; 13894a71df50SFrank Blaschka card->token.ulp_filter_w = 0x0001010bUL; 13904a71df50SFrank Blaschka card->token.ulp_connection_w = 0x0001010dUL; 13914a71df50SFrank Blaschka } 13924a71df50SFrank Blaschka 13934a71df50SFrank Blaschka static void qeth_init_func_level(struct qeth_card *card) 13944a71df50SFrank Blaschka { 13954a71df50SFrank Blaschka if (card->ipato.enabled) { 13964a71df50SFrank Blaschka if (card->info.type == QETH_CARD_TYPE_IQD) 13974a71df50SFrank Blaschka card->info.func_level = 13984a71df50SFrank Blaschka QETH_IDX_FUNC_LEVEL_IQD_ENA_IPAT; 13994a71df50SFrank Blaschka else 14004a71df50SFrank Blaschka card->info.func_level = 14014a71df50SFrank Blaschka QETH_IDX_FUNC_LEVEL_OSAE_ENA_IPAT; 14024a71df50SFrank Blaschka } else { 14034a71df50SFrank Blaschka if (card->info.type == QETH_CARD_TYPE_IQD) 14044a71df50SFrank Blaschka /*FIXME:why do we have same values for dis and ena for 14054a71df50SFrank Blaschka osae??? */ 14064a71df50SFrank Blaschka card->info.func_level = 14074a71df50SFrank Blaschka QETH_IDX_FUNC_LEVEL_IQD_DIS_IPAT; 14084a71df50SFrank Blaschka else 14094a71df50SFrank Blaschka card->info.func_level = 14104a71df50SFrank Blaschka QETH_IDX_FUNC_LEVEL_OSAE_DIS_IPAT; 14114a71df50SFrank Blaschka } 14124a71df50SFrank Blaschka } 14134a71df50SFrank Blaschka 14144a71df50SFrank Blaschka static int qeth_idx_activate_get_answer(struct qeth_channel *channel, 14154a71df50SFrank Blaschka void (*idx_reply_cb)(struct qeth_channel *, 14164a71df50SFrank Blaschka struct qeth_cmd_buffer *)) 14174a71df50SFrank Blaschka { 14184a71df50SFrank Blaschka struct qeth_cmd_buffer *iob; 14194a71df50SFrank Blaschka unsigned long flags; 14204a71df50SFrank Blaschka int rc; 14214a71df50SFrank Blaschka struct qeth_card *card; 14224a71df50SFrank Blaschka 1423d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "idxanswr"); 14244a71df50SFrank Blaschka card = CARD_FROM_CDEV(channel->ccwdev); 14254a71df50SFrank Blaschka iob = qeth_get_buffer(channel); 14264a71df50SFrank Blaschka iob->callback = idx_reply_cb; 14274a71df50SFrank Blaschka memcpy(&channel->ccw, READ_CCW, sizeof(struct ccw1)); 14284a71df50SFrank Blaschka channel->ccw.count = QETH_BUFSIZE; 14294a71df50SFrank Blaschka channel->ccw.cda = (__u32) __pa(iob->data); 14304a71df50SFrank Blaschka 14314a71df50SFrank Blaschka wait_event(card->wait_q, 14324a71df50SFrank Blaschka atomic_cmpxchg(&channel->irq_pending, 0, 1) == 0); 1433d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 6, "noirqpnd"); 14344a71df50SFrank Blaschka spin_lock_irqsave(get_ccwdev_lock(channel->ccwdev), flags); 14354a71df50SFrank Blaschka rc = ccw_device_start(channel->ccwdev, 14364a71df50SFrank Blaschka &channel->ccw, (addr_t) iob, 0, 0); 14374a71df50SFrank Blaschka spin_unlock_irqrestore(get_ccwdev_lock(channel->ccwdev), flags); 14384a71df50SFrank Blaschka 14394a71df50SFrank Blaschka if (rc) { 144014cc21b6SFrank Blaschka QETH_DBF_MESSAGE(2, "Error2 in activating channel rc=%d\n", rc); 1441d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "2err%d", rc); 14424a71df50SFrank Blaschka atomic_set(&channel->irq_pending, 0); 14434a71df50SFrank Blaschka wake_up(&card->wait_q); 14444a71df50SFrank Blaschka return rc; 14454a71df50SFrank Blaschka } 14464a71df50SFrank Blaschka rc = wait_event_interruptible_timeout(card->wait_q, 14474a71df50SFrank Blaschka channel->state == CH_STATE_UP, QETH_TIMEOUT); 14484a71df50SFrank Blaschka if (rc == -ERESTARTSYS) 14494a71df50SFrank Blaschka return rc; 14504a71df50SFrank Blaschka if (channel->state != CH_STATE_UP) { 14514a71df50SFrank Blaschka rc = -ETIME; 1452d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "3err%d", rc); 14534a71df50SFrank Blaschka qeth_clear_cmd_buffers(channel); 14544a71df50SFrank Blaschka } else 14554a71df50SFrank Blaschka rc = 0; 14564a71df50SFrank Blaschka return rc; 14574a71df50SFrank Blaschka } 14584a71df50SFrank Blaschka 14594a71df50SFrank Blaschka static int qeth_idx_activate_channel(struct qeth_channel *channel, 14604a71df50SFrank Blaschka void (*idx_reply_cb)(struct qeth_channel *, 14614a71df50SFrank Blaschka struct qeth_cmd_buffer *)) 14624a71df50SFrank Blaschka { 14634a71df50SFrank Blaschka struct qeth_card *card; 14644a71df50SFrank Blaschka struct qeth_cmd_buffer *iob; 14654a71df50SFrank Blaschka unsigned long flags; 14664a71df50SFrank Blaschka __u16 temp; 14674a71df50SFrank Blaschka __u8 tmp; 14684a71df50SFrank Blaschka int rc; 1469f06f6f32SCornelia Huck struct ccw_dev_id temp_devid; 14704a71df50SFrank Blaschka 14714a71df50SFrank Blaschka card = CARD_FROM_CDEV(channel->ccwdev); 14724a71df50SFrank Blaschka 1473d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "idxactch"); 14744a71df50SFrank Blaschka 14754a71df50SFrank Blaschka iob = qeth_get_buffer(channel); 14764a71df50SFrank Blaschka iob->callback = idx_reply_cb; 14774a71df50SFrank Blaschka memcpy(&channel->ccw, WRITE_CCW, sizeof(struct ccw1)); 14784a71df50SFrank Blaschka channel->ccw.count = IDX_ACTIVATE_SIZE; 14794a71df50SFrank Blaschka channel->ccw.cda = (__u32) __pa(iob->data); 14804a71df50SFrank Blaschka if (channel == &card->write) { 14814a71df50SFrank Blaschka memcpy(iob->data, IDX_ACTIVATE_WRITE, IDX_ACTIVATE_SIZE); 14824a71df50SFrank Blaschka memcpy(QETH_TRANSPORT_HEADER_SEQ_NO(iob->data), 14834a71df50SFrank Blaschka &card->seqno.trans_hdr, QETH_SEQ_NO_LENGTH); 14844a71df50SFrank Blaschka card->seqno.trans_hdr++; 14854a71df50SFrank Blaschka } else { 14864a71df50SFrank Blaschka memcpy(iob->data, IDX_ACTIVATE_READ, IDX_ACTIVATE_SIZE); 14874a71df50SFrank Blaschka memcpy(QETH_TRANSPORT_HEADER_SEQ_NO(iob->data), 14884a71df50SFrank Blaschka &card->seqno.trans_hdr, QETH_SEQ_NO_LENGTH); 14894a71df50SFrank Blaschka } 14904a71df50SFrank Blaschka tmp = ((__u8)card->info.portno) | 0x80; 14914a71df50SFrank Blaschka memcpy(QETH_IDX_ACT_PNO(iob->data), &tmp, 1); 14924a71df50SFrank Blaschka memcpy(QETH_IDX_ACT_ISSUER_RM_TOKEN(iob->data), 14934a71df50SFrank Blaschka &card->token.issuer_rm_w, QETH_MPC_TOKEN_LENGTH); 14944a71df50SFrank Blaschka memcpy(QETH_IDX_ACT_FUNC_LEVEL(iob->data), 14954a71df50SFrank Blaschka &card->info.func_level, sizeof(__u16)); 1496f06f6f32SCornelia Huck ccw_device_get_id(CARD_DDEV(card), &temp_devid); 1497f06f6f32SCornelia Huck memcpy(QETH_IDX_ACT_QDIO_DEV_CUA(iob->data), &temp_devid.devno, 2); 14984a71df50SFrank Blaschka temp = (card->info.cula << 8) + card->info.unit_addr2; 14994a71df50SFrank Blaschka memcpy(QETH_IDX_ACT_QDIO_DEV_REALADDR(iob->data), &temp, 2); 15004a71df50SFrank Blaschka 15014a71df50SFrank Blaschka wait_event(card->wait_q, 15024a71df50SFrank Blaschka atomic_cmpxchg(&channel->irq_pending, 0, 1) == 0); 1503d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 6, "noirqpnd"); 15044a71df50SFrank Blaschka spin_lock_irqsave(get_ccwdev_lock(channel->ccwdev), flags); 15054a71df50SFrank Blaschka rc = ccw_device_start(channel->ccwdev, 15064a71df50SFrank Blaschka &channel->ccw, (addr_t) iob, 0, 0); 15074a71df50SFrank Blaschka spin_unlock_irqrestore(get_ccwdev_lock(channel->ccwdev), flags); 15084a71df50SFrank Blaschka 15094a71df50SFrank Blaschka if (rc) { 151014cc21b6SFrank Blaschka QETH_DBF_MESSAGE(2, "Error1 in activating channel. rc=%d\n", 151114cc21b6SFrank Blaschka rc); 1512d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "1err%d", rc); 15134a71df50SFrank Blaschka atomic_set(&channel->irq_pending, 0); 15144a71df50SFrank Blaschka wake_up(&card->wait_q); 15154a71df50SFrank Blaschka return rc; 15164a71df50SFrank Blaschka } 15174a71df50SFrank Blaschka rc = wait_event_interruptible_timeout(card->wait_q, 15184a71df50SFrank Blaschka channel->state == CH_STATE_ACTIVATING, QETH_TIMEOUT); 15194a71df50SFrank Blaschka if (rc == -ERESTARTSYS) 15204a71df50SFrank Blaschka return rc; 15214a71df50SFrank Blaschka if (channel->state != CH_STATE_ACTIVATING) { 15224a71df50SFrank Blaschka PRINT_WARN("IDX activate timed out!\n"); 1523d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "2err%d", -ETIME); 15244a71df50SFrank Blaschka qeth_clear_cmd_buffers(channel); 15254a71df50SFrank Blaschka return -ETIME; 15264a71df50SFrank Blaschka } 15274a71df50SFrank Blaschka return qeth_idx_activate_get_answer(channel, idx_reply_cb); 15284a71df50SFrank Blaschka } 15294a71df50SFrank Blaschka 15304a71df50SFrank Blaschka static int qeth_peer_func_level(int level) 15314a71df50SFrank Blaschka { 15324a71df50SFrank Blaschka if ((level & 0xff) == 8) 15334a71df50SFrank Blaschka return (level & 0xff) + 0x400; 15344a71df50SFrank Blaschka if (((level >> 8) & 3) == 1) 15354a71df50SFrank Blaschka return (level & 0xff) + 0x200; 15364a71df50SFrank Blaschka return level; 15374a71df50SFrank Blaschka } 15384a71df50SFrank Blaschka 15394a71df50SFrank Blaschka static void qeth_idx_write_cb(struct qeth_channel *channel, 15404a71df50SFrank Blaschka struct qeth_cmd_buffer *iob) 15414a71df50SFrank Blaschka { 15424a71df50SFrank Blaschka struct qeth_card *card; 15434a71df50SFrank Blaschka __u16 temp; 15444a71df50SFrank Blaschka 1545d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP , 2, "idxwrcb"); 15464a71df50SFrank Blaschka 15474a71df50SFrank Blaschka if (channel->state == CH_STATE_DOWN) { 15484a71df50SFrank Blaschka channel->state = CH_STATE_ACTIVATING; 15494a71df50SFrank Blaschka goto out; 15504a71df50SFrank Blaschka } 15514a71df50SFrank Blaschka card = CARD_FROM_CDEV(channel->ccwdev); 15524a71df50SFrank Blaschka 15534a71df50SFrank Blaschka if (!(QETH_IS_IDX_ACT_POS_REPLY(iob->data))) { 15544a71df50SFrank Blaschka if (QETH_IDX_ACT_CAUSE_CODE(iob->data) == 0x19) 15554a71df50SFrank Blaschka PRINT_ERR("IDX_ACTIVATE on write channel device %s: " 15564a71df50SFrank Blaschka "adapter exclusively used by another host\n", 15574a71df50SFrank Blaschka CARD_WDEV_ID(card)); 15584a71df50SFrank Blaschka else 15594a71df50SFrank Blaschka PRINT_ERR("IDX_ACTIVATE on write channel device %s: " 15604a71df50SFrank Blaschka "negative reply\n", CARD_WDEV_ID(card)); 15614a71df50SFrank Blaschka goto out; 15624a71df50SFrank Blaschka } 15634a71df50SFrank Blaschka memcpy(&temp, QETH_IDX_ACT_FUNC_LEVEL(iob->data), 2); 15644a71df50SFrank Blaschka if ((temp & ~0x0100) != qeth_peer_func_level(card->info.func_level)) { 15654a71df50SFrank Blaschka PRINT_WARN("IDX_ACTIVATE on write channel device %s: " 15664a71df50SFrank Blaschka "function level mismatch " 15674a71df50SFrank Blaschka "(sent: 0x%x, received: 0x%x)\n", 15684a71df50SFrank Blaschka CARD_WDEV_ID(card), card->info.func_level, temp); 15694a71df50SFrank Blaschka goto out; 15704a71df50SFrank Blaschka } 15714a71df50SFrank Blaschka channel->state = CH_STATE_UP; 15724a71df50SFrank Blaschka out: 15734a71df50SFrank Blaschka qeth_release_buffer(channel, iob); 15744a71df50SFrank Blaschka } 15754a71df50SFrank Blaschka 15764a71df50SFrank Blaschka static void qeth_idx_read_cb(struct qeth_channel *channel, 15774a71df50SFrank Blaschka struct qeth_cmd_buffer *iob) 15784a71df50SFrank Blaschka { 15794a71df50SFrank Blaschka struct qeth_card *card; 15804a71df50SFrank Blaschka __u16 temp; 15814a71df50SFrank Blaschka 1582d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP , 2, "idxrdcb"); 15834a71df50SFrank Blaschka if (channel->state == CH_STATE_DOWN) { 15844a71df50SFrank Blaschka channel->state = CH_STATE_ACTIVATING; 15854a71df50SFrank Blaschka goto out; 15864a71df50SFrank Blaschka } 15874a71df50SFrank Blaschka 15884a71df50SFrank Blaschka card = CARD_FROM_CDEV(channel->ccwdev); 15894a71df50SFrank Blaschka if (qeth_check_idx_response(iob->data)) 15904a71df50SFrank Blaschka goto out; 15914a71df50SFrank Blaschka 15924a71df50SFrank Blaschka if (!(QETH_IS_IDX_ACT_POS_REPLY(iob->data))) { 15934a71df50SFrank Blaschka if (QETH_IDX_ACT_CAUSE_CODE(iob->data) == 0x19) 15944a71df50SFrank Blaschka PRINT_ERR("IDX_ACTIVATE on read channel device %s: " 15954a71df50SFrank Blaschka "adapter exclusively used by another host\n", 15964a71df50SFrank Blaschka CARD_RDEV_ID(card)); 15974a71df50SFrank Blaschka else 15984a71df50SFrank Blaschka PRINT_ERR("IDX_ACTIVATE on read channel device %s: " 15994a71df50SFrank Blaschka "negative reply\n", CARD_RDEV_ID(card)); 16004a71df50SFrank Blaschka goto out; 16014a71df50SFrank Blaschka } 16024a71df50SFrank Blaschka 16034a71df50SFrank Blaschka /** 16044a71df50SFrank Blaschka * temporary fix for microcode bug 16054a71df50SFrank Blaschka * to revert it,replace OR by AND 16064a71df50SFrank Blaschka */ 16074a71df50SFrank Blaschka if ((!QETH_IDX_NO_PORTNAME_REQUIRED(iob->data)) || 16084a71df50SFrank Blaschka (card->info.type == QETH_CARD_TYPE_OSAE)) 16094a71df50SFrank Blaschka card->info.portname_required = 1; 16104a71df50SFrank Blaschka 16114a71df50SFrank Blaschka memcpy(&temp, QETH_IDX_ACT_FUNC_LEVEL(iob->data), 2); 16124a71df50SFrank Blaschka if (temp != qeth_peer_func_level(card->info.func_level)) { 16134a71df50SFrank Blaschka PRINT_WARN("IDX_ACTIVATE on read channel device %s: function " 16144a71df50SFrank Blaschka "level mismatch (sent: 0x%x, received: 0x%x)\n", 16154a71df50SFrank Blaschka CARD_RDEV_ID(card), card->info.func_level, temp); 16164a71df50SFrank Blaschka goto out; 16174a71df50SFrank Blaschka } 16184a71df50SFrank Blaschka memcpy(&card->token.issuer_rm_r, 16194a71df50SFrank Blaschka QETH_IDX_ACT_ISSUER_RM_TOKEN(iob->data), 16204a71df50SFrank Blaschka QETH_MPC_TOKEN_LENGTH); 16214a71df50SFrank Blaschka memcpy(&card->info.mcl_level[0], 16224a71df50SFrank Blaschka QETH_IDX_REPLY_LEVEL(iob->data), QETH_MCL_LENGTH); 16234a71df50SFrank Blaschka channel->state = CH_STATE_UP; 16244a71df50SFrank Blaschka out: 16254a71df50SFrank Blaschka qeth_release_buffer(channel, iob); 16264a71df50SFrank Blaschka } 16274a71df50SFrank Blaschka 16284a71df50SFrank Blaschka void qeth_prepare_control_data(struct qeth_card *card, int len, 16294a71df50SFrank Blaschka struct qeth_cmd_buffer *iob) 16304a71df50SFrank Blaschka { 16314a71df50SFrank Blaschka qeth_setup_ccw(&card->write, iob->data, len); 16324a71df50SFrank Blaschka iob->callback = qeth_release_buffer; 16334a71df50SFrank Blaschka 16344a71df50SFrank Blaschka memcpy(QETH_TRANSPORT_HEADER_SEQ_NO(iob->data), 16354a71df50SFrank Blaschka &card->seqno.trans_hdr, QETH_SEQ_NO_LENGTH); 16364a71df50SFrank Blaschka card->seqno.trans_hdr++; 16374a71df50SFrank Blaschka memcpy(QETH_PDU_HEADER_SEQ_NO(iob->data), 16384a71df50SFrank Blaschka &card->seqno.pdu_hdr, QETH_SEQ_NO_LENGTH); 16394a71df50SFrank Blaschka card->seqno.pdu_hdr++; 16404a71df50SFrank Blaschka memcpy(QETH_PDU_HEADER_ACK_SEQ_NO(iob->data), 16414a71df50SFrank Blaschka &card->seqno.pdu_hdr_ack, QETH_SEQ_NO_LENGTH); 1642d11ba0c4SPeter Tiedemann QETH_DBF_HEX(CTRL, 2, iob->data, QETH_DBF_CTRL_LEN); 16434a71df50SFrank Blaschka } 16444a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_prepare_control_data); 16454a71df50SFrank Blaschka 16464a71df50SFrank Blaschka int qeth_send_control_data(struct qeth_card *card, int len, 16474a71df50SFrank Blaschka struct qeth_cmd_buffer *iob, 16484a71df50SFrank Blaschka int (*reply_cb)(struct qeth_card *, struct qeth_reply *, 16494a71df50SFrank Blaschka unsigned long), 16504a71df50SFrank Blaschka void *reply_param) 16514a71df50SFrank Blaschka { 16524a71df50SFrank Blaschka int rc; 16534a71df50SFrank Blaschka unsigned long flags; 16544a71df50SFrank Blaschka struct qeth_reply *reply = NULL; 16554a71df50SFrank Blaschka unsigned long timeout; 16564a71df50SFrank Blaschka 1657d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 2, "sendctl"); 16584a71df50SFrank Blaschka 16594a71df50SFrank Blaschka reply = qeth_alloc_reply(card); 16604a71df50SFrank Blaschka if (!reply) { 16614a71df50SFrank Blaschka return -ENOMEM; 16624a71df50SFrank Blaschka } 16634a71df50SFrank Blaschka reply->callback = reply_cb; 16644a71df50SFrank Blaschka reply->param = reply_param; 16654a71df50SFrank Blaschka if (card->state == CARD_STATE_DOWN) 16664a71df50SFrank Blaschka reply->seqno = QETH_IDX_COMMAND_SEQNO; 16674a71df50SFrank Blaschka else 16684a71df50SFrank Blaschka reply->seqno = card->seqno.ipa++; 16694a71df50SFrank Blaschka init_waitqueue_head(&reply->wait_q); 16704a71df50SFrank Blaschka spin_lock_irqsave(&card->lock, flags); 16714a71df50SFrank Blaschka list_add_tail(&reply->list, &card->cmd_waiter_list); 16724a71df50SFrank Blaschka spin_unlock_irqrestore(&card->lock, flags); 1673d11ba0c4SPeter Tiedemann QETH_DBF_HEX(CTRL, 2, iob->data, QETH_DBF_CTRL_LEN); 16744a71df50SFrank Blaschka 16754a71df50SFrank Blaschka while (atomic_cmpxchg(&card->write.irq_pending, 0, 1)) ; 16764a71df50SFrank Blaschka qeth_prepare_control_data(card, len, iob); 16774a71df50SFrank Blaschka 16784a71df50SFrank Blaschka if (IS_IPA(iob->data)) 16794a71df50SFrank Blaschka timeout = jiffies + QETH_IPA_TIMEOUT; 16804a71df50SFrank Blaschka else 16814a71df50SFrank Blaschka timeout = jiffies + QETH_TIMEOUT; 16824a71df50SFrank Blaschka 1683d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 6, "noirqpnd"); 16844a71df50SFrank Blaschka spin_lock_irqsave(get_ccwdev_lock(card->write.ccwdev), flags); 16854a71df50SFrank Blaschka rc = ccw_device_start(card->write.ccwdev, &card->write.ccw, 16864a71df50SFrank Blaschka (addr_t) iob, 0, 0); 16874a71df50SFrank Blaschka spin_unlock_irqrestore(get_ccwdev_lock(card->write.ccwdev), flags); 16884a71df50SFrank Blaschka if (rc) { 16894a71df50SFrank Blaschka PRINT_WARN("qeth_send_control_data: " 16904a71df50SFrank Blaschka "ccw_device_start rc = %i\n", rc); 1691d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(TRACE, 2, " err%d", rc); 16924a71df50SFrank Blaschka spin_lock_irqsave(&card->lock, flags); 16934a71df50SFrank Blaschka list_del_init(&reply->list); 16944a71df50SFrank Blaschka qeth_put_reply(reply); 16954a71df50SFrank Blaschka spin_unlock_irqrestore(&card->lock, flags); 16964a71df50SFrank Blaschka qeth_release_buffer(iob->channel, iob); 16974a71df50SFrank Blaschka atomic_set(&card->write.irq_pending, 0); 16984a71df50SFrank Blaschka wake_up(&card->wait_q); 16994a71df50SFrank Blaschka return rc; 17004a71df50SFrank Blaschka } 17014a71df50SFrank Blaschka while (!atomic_read(&reply->received)) { 17024a71df50SFrank Blaschka if (time_after(jiffies, timeout)) { 17034a71df50SFrank Blaschka spin_lock_irqsave(&reply->card->lock, flags); 17044a71df50SFrank Blaschka list_del_init(&reply->list); 17054a71df50SFrank Blaschka spin_unlock_irqrestore(&reply->card->lock, flags); 17064a71df50SFrank Blaschka reply->rc = -ETIME; 17074a71df50SFrank Blaschka atomic_inc(&reply->received); 17084a71df50SFrank Blaschka wake_up(&reply->wait_q); 17094a71df50SFrank Blaschka } 17104a71df50SFrank Blaschka cpu_relax(); 17114a71df50SFrank Blaschka }; 17124a71df50SFrank Blaschka rc = reply->rc; 17134a71df50SFrank Blaschka qeth_put_reply(reply); 17144a71df50SFrank Blaschka return rc; 17154a71df50SFrank Blaschka } 17164a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_send_control_data); 17174a71df50SFrank Blaschka 17184a71df50SFrank Blaschka static int qeth_cm_enable_cb(struct qeth_card *card, struct qeth_reply *reply, 17194a71df50SFrank Blaschka unsigned long data) 17204a71df50SFrank Blaschka { 17214a71df50SFrank Blaschka struct qeth_cmd_buffer *iob; 17224a71df50SFrank Blaschka 1723d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "cmenblcb"); 17244a71df50SFrank Blaschka 17254a71df50SFrank Blaschka iob = (struct qeth_cmd_buffer *) data; 17264a71df50SFrank Blaschka memcpy(&card->token.cm_filter_r, 17274a71df50SFrank Blaschka QETH_CM_ENABLE_RESP_FILTER_TOKEN(iob->data), 17284a71df50SFrank Blaschka QETH_MPC_TOKEN_LENGTH); 1729d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, " rc%d", iob->rc); 17304a71df50SFrank Blaschka return 0; 17314a71df50SFrank Blaschka } 17324a71df50SFrank Blaschka 17334a71df50SFrank Blaschka static int qeth_cm_enable(struct qeth_card *card) 17344a71df50SFrank Blaschka { 17354a71df50SFrank Blaschka int rc; 17364a71df50SFrank Blaschka struct qeth_cmd_buffer *iob; 17374a71df50SFrank Blaschka 1738d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "cmenable"); 17394a71df50SFrank Blaschka 17404a71df50SFrank Blaschka iob = qeth_wait_for_buffer(&card->write); 17414a71df50SFrank Blaschka memcpy(iob->data, CM_ENABLE, CM_ENABLE_SIZE); 17424a71df50SFrank Blaschka memcpy(QETH_CM_ENABLE_ISSUER_RM_TOKEN(iob->data), 17434a71df50SFrank Blaschka &card->token.issuer_rm_r, QETH_MPC_TOKEN_LENGTH); 17444a71df50SFrank Blaschka memcpy(QETH_CM_ENABLE_FILTER_TOKEN(iob->data), 17454a71df50SFrank Blaschka &card->token.cm_filter_w, QETH_MPC_TOKEN_LENGTH); 17464a71df50SFrank Blaschka 17474a71df50SFrank Blaschka rc = qeth_send_control_data(card, CM_ENABLE_SIZE, iob, 17484a71df50SFrank Blaschka qeth_cm_enable_cb, NULL); 17494a71df50SFrank Blaschka return rc; 17504a71df50SFrank Blaschka } 17514a71df50SFrank Blaschka 17524a71df50SFrank Blaschka static int qeth_cm_setup_cb(struct qeth_card *card, struct qeth_reply *reply, 17534a71df50SFrank Blaschka unsigned long data) 17544a71df50SFrank Blaschka { 17554a71df50SFrank Blaschka 17564a71df50SFrank Blaschka struct qeth_cmd_buffer *iob; 17574a71df50SFrank Blaschka 1758d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "cmsetpcb"); 17594a71df50SFrank Blaschka 17604a71df50SFrank Blaschka iob = (struct qeth_cmd_buffer *) data; 17614a71df50SFrank Blaschka memcpy(&card->token.cm_connection_r, 17624a71df50SFrank Blaschka QETH_CM_SETUP_RESP_DEST_ADDR(iob->data), 17634a71df50SFrank Blaschka QETH_MPC_TOKEN_LENGTH); 1764d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, " rc%d", iob->rc); 17654a71df50SFrank Blaschka return 0; 17664a71df50SFrank Blaschka } 17674a71df50SFrank Blaschka 17684a71df50SFrank Blaschka static int qeth_cm_setup(struct qeth_card *card) 17694a71df50SFrank Blaschka { 17704a71df50SFrank Blaschka int rc; 17714a71df50SFrank Blaschka struct qeth_cmd_buffer *iob; 17724a71df50SFrank Blaschka 1773d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "cmsetup"); 17744a71df50SFrank Blaschka 17754a71df50SFrank Blaschka iob = qeth_wait_for_buffer(&card->write); 17764a71df50SFrank Blaschka memcpy(iob->data, CM_SETUP, CM_SETUP_SIZE); 17774a71df50SFrank Blaschka memcpy(QETH_CM_SETUP_DEST_ADDR(iob->data), 17784a71df50SFrank Blaschka &card->token.issuer_rm_r, QETH_MPC_TOKEN_LENGTH); 17794a71df50SFrank Blaschka memcpy(QETH_CM_SETUP_CONNECTION_TOKEN(iob->data), 17804a71df50SFrank Blaschka &card->token.cm_connection_w, QETH_MPC_TOKEN_LENGTH); 17814a71df50SFrank Blaschka memcpy(QETH_CM_SETUP_FILTER_TOKEN(iob->data), 17824a71df50SFrank Blaschka &card->token.cm_filter_r, QETH_MPC_TOKEN_LENGTH); 17834a71df50SFrank Blaschka rc = qeth_send_control_data(card, CM_SETUP_SIZE, iob, 17844a71df50SFrank Blaschka qeth_cm_setup_cb, NULL); 17854a71df50SFrank Blaschka return rc; 17864a71df50SFrank Blaschka 17874a71df50SFrank Blaschka } 17884a71df50SFrank Blaschka 17894a71df50SFrank Blaschka static inline int qeth_get_initial_mtu_for_card(struct qeth_card *card) 17904a71df50SFrank Blaschka { 17914a71df50SFrank Blaschka switch (card->info.type) { 17924a71df50SFrank Blaschka case QETH_CARD_TYPE_UNKNOWN: 17934a71df50SFrank Blaschka return 1500; 17944a71df50SFrank Blaschka case QETH_CARD_TYPE_IQD: 17954a71df50SFrank Blaschka return card->info.max_mtu; 17964a71df50SFrank Blaschka case QETH_CARD_TYPE_OSAE: 17974a71df50SFrank Blaschka switch (card->info.link_type) { 17984a71df50SFrank Blaschka case QETH_LINK_TYPE_HSTR: 17994a71df50SFrank Blaschka case QETH_LINK_TYPE_LANE_TR: 18004a71df50SFrank Blaschka return 2000; 18014a71df50SFrank Blaschka default: 18024a71df50SFrank Blaschka return 1492; 18034a71df50SFrank Blaschka } 18044a71df50SFrank Blaschka default: 18054a71df50SFrank Blaschka return 1500; 18064a71df50SFrank Blaschka } 18074a71df50SFrank Blaschka } 18084a71df50SFrank Blaschka 18094a71df50SFrank Blaschka static inline int qeth_get_max_mtu_for_card(int cardtype) 18104a71df50SFrank Blaschka { 18114a71df50SFrank Blaschka switch (cardtype) { 18124a71df50SFrank Blaschka 18134a71df50SFrank Blaschka case QETH_CARD_TYPE_UNKNOWN: 18144a71df50SFrank Blaschka case QETH_CARD_TYPE_OSAE: 18154a71df50SFrank Blaschka case QETH_CARD_TYPE_OSN: 18164a71df50SFrank Blaschka return 61440; 18174a71df50SFrank Blaschka case QETH_CARD_TYPE_IQD: 18184a71df50SFrank Blaschka return 57344; 18194a71df50SFrank Blaschka default: 18204a71df50SFrank Blaschka return 1500; 18214a71df50SFrank Blaschka } 18224a71df50SFrank Blaschka } 18234a71df50SFrank Blaschka 18244a71df50SFrank Blaschka static inline int qeth_get_mtu_out_of_mpc(int cardtype) 18254a71df50SFrank Blaschka { 18264a71df50SFrank Blaschka switch (cardtype) { 18274a71df50SFrank Blaschka case QETH_CARD_TYPE_IQD: 18284a71df50SFrank Blaschka return 1; 18294a71df50SFrank Blaschka default: 18304a71df50SFrank Blaschka return 0; 18314a71df50SFrank Blaschka } 18324a71df50SFrank Blaschka } 18334a71df50SFrank Blaschka 18344a71df50SFrank Blaschka static inline int qeth_get_mtu_outof_framesize(int framesize) 18354a71df50SFrank Blaschka { 18364a71df50SFrank Blaschka switch (framesize) { 18374a71df50SFrank Blaschka case 0x4000: 18384a71df50SFrank Blaschka return 8192; 18394a71df50SFrank Blaschka case 0x6000: 18404a71df50SFrank Blaschka return 16384; 18414a71df50SFrank Blaschka case 0xa000: 18424a71df50SFrank Blaschka return 32768; 18434a71df50SFrank Blaschka case 0xffff: 18444a71df50SFrank Blaschka return 57344; 18454a71df50SFrank Blaschka default: 18464a71df50SFrank Blaschka return 0; 18474a71df50SFrank Blaschka } 18484a71df50SFrank Blaschka } 18494a71df50SFrank Blaschka 18504a71df50SFrank Blaschka static inline int qeth_mtu_is_valid(struct qeth_card *card, int mtu) 18514a71df50SFrank Blaschka { 18524a71df50SFrank Blaschka switch (card->info.type) { 18534a71df50SFrank Blaschka case QETH_CARD_TYPE_OSAE: 18544a71df50SFrank Blaschka return ((mtu >= 576) && (mtu <= 61440)); 18554a71df50SFrank Blaschka case QETH_CARD_TYPE_IQD: 18564a71df50SFrank Blaschka return ((mtu >= 576) && 18574a71df50SFrank Blaschka (mtu <= card->info.max_mtu + 4096 - 32)); 18584a71df50SFrank Blaschka case QETH_CARD_TYPE_OSN: 18594a71df50SFrank Blaschka case QETH_CARD_TYPE_UNKNOWN: 18604a71df50SFrank Blaschka default: 18614a71df50SFrank Blaschka return 1; 18624a71df50SFrank Blaschka } 18634a71df50SFrank Blaschka } 18644a71df50SFrank Blaschka 18654a71df50SFrank Blaschka static int qeth_ulp_enable_cb(struct qeth_card *card, struct qeth_reply *reply, 18664a71df50SFrank Blaschka unsigned long data) 18674a71df50SFrank Blaschka { 18684a71df50SFrank Blaschka 18694a71df50SFrank Blaschka __u16 mtu, framesize; 18704a71df50SFrank Blaschka __u16 len; 18714a71df50SFrank Blaschka __u8 link_type; 18724a71df50SFrank Blaschka struct qeth_cmd_buffer *iob; 18734a71df50SFrank Blaschka 1874d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "ulpenacb"); 18754a71df50SFrank Blaschka 18764a71df50SFrank Blaschka iob = (struct qeth_cmd_buffer *) data; 18774a71df50SFrank Blaschka memcpy(&card->token.ulp_filter_r, 18784a71df50SFrank Blaschka QETH_ULP_ENABLE_RESP_FILTER_TOKEN(iob->data), 18794a71df50SFrank Blaschka QETH_MPC_TOKEN_LENGTH); 18804a71df50SFrank Blaschka if (qeth_get_mtu_out_of_mpc(card->info.type)) { 18814a71df50SFrank Blaschka memcpy(&framesize, QETH_ULP_ENABLE_RESP_MAX_MTU(iob->data), 2); 18824a71df50SFrank Blaschka mtu = qeth_get_mtu_outof_framesize(framesize); 18834a71df50SFrank Blaschka if (!mtu) { 18844a71df50SFrank Blaschka iob->rc = -EINVAL; 1885d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, " rc%d", iob->rc); 18864a71df50SFrank Blaschka return 0; 18874a71df50SFrank Blaschka } 18884a71df50SFrank Blaschka card->info.max_mtu = mtu; 18894a71df50SFrank Blaschka card->info.initial_mtu = mtu; 18904a71df50SFrank Blaschka card->qdio.in_buf_size = mtu + 2 * PAGE_SIZE; 18914a71df50SFrank Blaschka } else { 18924a71df50SFrank Blaschka card->info.initial_mtu = qeth_get_initial_mtu_for_card(card); 18934a71df50SFrank Blaschka card->info.max_mtu = qeth_get_max_mtu_for_card(card->info.type); 18944a71df50SFrank Blaschka card->qdio.in_buf_size = QETH_IN_BUF_SIZE_DEFAULT; 18954a71df50SFrank Blaschka } 18964a71df50SFrank Blaschka 18974a71df50SFrank Blaschka memcpy(&len, QETH_ULP_ENABLE_RESP_DIFINFO_LEN(iob->data), 2); 18984a71df50SFrank Blaschka if (len >= QETH_MPC_DIFINFO_LEN_INDICATES_LINK_TYPE) { 18994a71df50SFrank Blaschka memcpy(&link_type, 19004a71df50SFrank Blaschka QETH_ULP_ENABLE_RESP_LINK_TYPE(iob->data), 1); 19014a71df50SFrank Blaschka card->info.link_type = link_type; 19024a71df50SFrank Blaschka } else 19034a71df50SFrank Blaschka card->info.link_type = 0; 1904d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, " rc%d", iob->rc); 19054a71df50SFrank Blaschka return 0; 19064a71df50SFrank Blaschka } 19074a71df50SFrank Blaschka 19084a71df50SFrank Blaschka static int qeth_ulp_enable(struct qeth_card *card) 19094a71df50SFrank Blaschka { 19104a71df50SFrank Blaschka int rc; 19114a71df50SFrank Blaschka char prot_type; 19124a71df50SFrank Blaschka struct qeth_cmd_buffer *iob; 19134a71df50SFrank Blaschka 19144a71df50SFrank Blaschka /*FIXME: trace view callbacks*/ 1915d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "ulpenabl"); 19164a71df50SFrank Blaschka 19174a71df50SFrank Blaschka iob = qeth_wait_for_buffer(&card->write); 19184a71df50SFrank Blaschka memcpy(iob->data, ULP_ENABLE, ULP_ENABLE_SIZE); 19194a71df50SFrank Blaschka 19204a71df50SFrank Blaschka *(QETH_ULP_ENABLE_LINKNUM(iob->data)) = 19214a71df50SFrank Blaschka (__u8) card->info.portno; 19224a71df50SFrank Blaschka if (card->options.layer2) 19234a71df50SFrank Blaschka if (card->info.type == QETH_CARD_TYPE_OSN) 19244a71df50SFrank Blaschka prot_type = QETH_PROT_OSN2; 19254a71df50SFrank Blaschka else 19264a71df50SFrank Blaschka prot_type = QETH_PROT_LAYER2; 19274a71df50SFrank Blaschka else 19284a71df50SFrank Blaschka prot_type = QETH_PROT_TCPIP; 19294a71df50SFrank Blaschka 19304a71df50SFrank Blaschka memcpy(QETH_ULP_ENABLE_PROT_TYPE(iob->data), &prot_type, 1); 19314a71df50SFrank Blaschka memcpy(QETH_ULP_ENABLE_DEST_ADDR(iob->data), 19324a71df50SFrank Blaschka &card->token.cm_connection_r, QETH_MPC_TOKEN_LENGTH); 19334a71df50SFrank Blaschka memcpy(QETH_ULP_ENABLE_FILTER_TOKEN(iob->data), 19344a71df50SFrank Blaschka &card->token.ulp_filter_w, QETH_MPC_TOKEN_LENGTH); 19354a71df50SFrank Blaschka memcpy(QETH_ULP_ENABLE_PORTNAME_AND_LL(iob->data), 19364a71df50SFrank Blaschka card->info.portname, 9); 19374a71df50SFrank Blaschka rc = qeth_send_control_data(card, ULP_ENABLE_SIZE, iob, 19384a71df50SFrank Blaschka qeth_ulp_enable_cb, NULL); 19394a71df50SFrank Blaschka return rc; 19404a71df50SFrank Blaschka 19414a71df50SFrank Blaschka } 19424a71df50SFrank Blaschka 19434a71df50SFrank Blaschka static int qeth_ulp_setup_cb(struct qeth_card *card, struct qeth_reply *reply, 19444a71df50SFrank Blaschka unsigned long data) 19454a71df50SFrank Blaschka { 19464a71df50SFrank Blaschka struct qeth_cmd_buffer *iob; 19474a71df50SFrank Blaschka 1948d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "ulpstpcb"); 19494a71df50SFrank Blaschka 19504a71df50SFrank Blaschka iob = (struct qeth_cmd_buffer *) data; 19514a71df50SFrank Blaschka memcpy(&card->token.ulp_connection_r, 19524a71df50SFrank Blaschka QETH_ULP_SETUP_RESP_CONNECTION_TOKEN(iob->data), 19534a71df50SFrank Blaschka QETH_MPC_TOKEN_LENGTH); 1954d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, " rc%d", iob->rc); 19554a71df50SFrank Blaschka return 0; 19564a71df50SFrank Blaschka } 19574a71df50SFrank Blaschka 19584a71df50SFrank Blaschka static int qeth_ulp_setup(struct qeth_card *card) 19594a71df50SFrank Blaschka { 19604a71df50SFrank Blaschka int rc; 19614a71df50SFrank Blaschka __u16 temp; 19624a71df50SFrank Blaschka struct qeth_cmd_buffer *iob; 19634a71df50SFrank Blaschka struct ccw_dev_id dev_id; 19644a71df50SFrank Blaschka 1965d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "ulpsetup"); 19664a71df50SFrank Blaschka 19674a71df50SFrank Blaschka iob = qeth_wait_for_buffer(&card->write); 19684a71df50SFrank Blaschka memcpy(iob->data, ULP_SETUP, ULP_SETUP_SIZE); 19694a71df50SFrank Blaschka 19704a71df50SFrank Blaschka memcpy(QETH_ULP_SETUP_DEST_ADDR(iob->data), 19714a71df50SFrank Blaschka &card->token.cm_connection_r, QETH_MPC_TOKEN_LENGTH); 19724a71df50SFrank Blaschka memcpy(QETH_ULP_SETUP_CONNECTION_TOKEN(iob->data), 19734a71df50SFrank Blaschka &card->token.ulp_connection_w, QETH_MPC_TOKEN_LENGTH); 19744a71df50SFrank Blaschka memcpy(QETH_ULP_SETUP_FILTER_TOKEN(iob->data), 19754a71df50SFrank Blaschka &card->token.ulp_filter_r, QETH_MPC_TOKEN_LENGTH); 19764a71df50SFrank Blaschka 19774a71df50SFrank Blaschka ccw_device_get_id(CARD_DDEV(card), &dev_id); 19784a71df50SFrank Blaschka memcpy(QETH_ULP_SETUP_CUA(iob->data), &dev_id.devno, 2); 19794a71df50SFrank Blaschka temp = (card->info.cula << 8) + card->info.unit_addr2; 19804a71df50SFrank Blaschka memcpy(QETH_ULP_SETUP_REAL_DEVADDR(iob->data), &temp, 2); 19814a71df50SFrank Blaschka rc = qeth_send_control_data(card, ULP_SETUP_SIZE, iob, 19824a71df50SFrank Blaschka qeth_ulp_setup_cb, NULL); 19834a71df50SFrank Blaschka return rc; 19844a71df50SFrank Blaschka } 19854a71df50SFrank Blaschka 19864a71df50SFrank Blaschka static int qeth_alloc_qdio_buffers(struct qeth_card *card) 19874a71df50SFrank Blaschka { 19884a71df50SFrank Blaschka int i, j; 19894a71df50SFrank Blaschka 1990d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "allcqdbf"); 19914a71df50SFrank Blaschka 19924a71df50SFrank Blaschka if (atomic_cmpxchg(&card->qdio.state, QETH_QDIO_UNINITIALIZED, 19934a71df50SFrank Blaschka QETH_QDIO_ALLOCATED) != QETH_QDIO_UNINITIALIZED) 19944a71df50SFrank Blaschka return 0; 19954a71df50SFrank Blaschka 19964a71df50SFrank Blaschka card->qdio.in_q = kmalloc(sizeof(struct qeth_qdio_q), 1997508b3c4fSUrsula Braun GFP_KERNEL); 19984a71df50SFrank Blaschka if (!card->qdio.in_q) 19994a71df50SFrank Blaschka goto out_nomem; 2000d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "inq"); 2001d11ba0c4SPeter Tiedemann QETH_DBF_HEX(SETUP, 2, &card->qdio.in_q, sizeof(void *)); 20024a71df50SFrank Blaschka memset(card->qdio.in_q, 0, sizeof(struct qeth_qdio_q)); 20034a71df50SFrank Blaschka /* give inbound qeth_qdio_buffers their qdio_buffers */ 20044a71df50SFrank Blaschka for (i = 0; i < QDIO_MAX_BUFFERS_PER_Q; ++i) 20054a71df50SFrank Blaschka card->qdio.in_q->bufs[i].buffer = 20064a71df50SFrank Blaschka &card->qdio.in_q->qdio_bufs[i]; 20074a71df50SFrank Blaschka /* inbound buffer pool */ 20084a71df50SFrank Blaschka if (qeth_alloc_buffer_pool(card)) 20094a71df50SFrank Blaschka goto out_freeinq; 20104a71df50SFrank Blaschka /* outbound */ 20114a71df50SFrank Blaschka card->qdio.out_qs = 20124a71df50SFrank Blaschka kmalloc(card->qdio.no_out_queues * 20134a71df50SFrank Blaschka sizeof(struct qeth_qdio_out_q *), GFP_KERNEL); 20144a71df50SFrank Blaschka if (!card->qdio.out_qs) 20154a71df50SFrank Blaschka goto out_freepool; 20164a71df50SFrank Blaschka for (i = 0; i < card->qdio.no_out_queues; ++i) { 20174a71df50SFrank Blaschka card->qdio.out_qs[i] = kmalloc(sizeof(struct qeth_qdio_out_q), 2018508b3c4fSUrsula Braun GFP_KERNEL); 20194a71df50SFrank Blaschka if (!card->qdio.out_qs[i]) 20204a71df50SFrank Blaschka goto out_freeoutq; 2021d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "outq %i", i); 2022d11ba0c4SPeter Tiedemann QETH_DBF_HEX(SETUP, 2, &card->qdio.out_qs[i], sizeof(void *)); 20234a71df50SFrank Blaschka memset(card->qdio.out_qs[i], 0, sizeof(struct qeth_qdio_out_q)); 20244a71df50SFrank Blaschka card->qdio.out_qs[i]->queue_no = i; 20254a71df50SFrank Blaschka /* give outbound qeth_qdio_buffers their qdio_buffers */ 20264a71df50SFrank Blaschka for (j = 0; j < QDIO_MAX_BUFFERS_PER_Q; ++j) { 20274a71df50SFrank Blaschka card->qdio.out_qs[i]->bufs[j].buffer = 20284a71df50SFrank Blaschka &card->qdio.out_qs[i]->qdio_bufs[j]; 20294a71df50SFrank Blaschka skb_queue_head_init(&card->qdio.out_qs[i]->bufs[j]. 20304a71df50SFrank Blaschka skb_list); 20314a71df50SFrank Blaschka lockdep_set_class( 20324a71df50SFrank Blaschka &card->qdio.out_qs[i]->bufs[j].skb_list.lock, 20334a71df50SFrank Blaschka &qdio_out_skb_queue_key); 20344a71df50SFrank Blaschka INIT_LIST_HEAD(&card->qdio.out_qs[i]->bufs[j].ctx_list); 20354a71df50SFrank Blaschka } 20364a71df50SFrank Blaschka } 20374a71df50SFrank Blaschka return 0; 20384a71df50SFrank Blaschka 20394a71df50SFrank Blaschka out_freeoutq: 20404a71df50SFrank Blaschka while (i > 0) 20414a71df50SFrank Blaschka kfree(card->qdio.out_qs[--i]); 20424a71df50SFrank Blaschka kfree(card->qdio.out_qs); 20434a71df50SFrank Blaschka card->qdio.out_qs = NULL; 20444a71df50SFrank Blaschka out_freepool: 20454a71df50SFrank Blaschka qeth_free_buffer_pool(card); 20464a71df50SFrank Blaschka out_freeinq: 20474a71df50SFrank Blaschka kfree(card->qdio.in_q); 20484a71df50SFrank Blaschka card->qdio.in_q = NULL; 20494a71df50SFrank Blaschka out_nomem: 20504a71df50SFrank Blaschka atomic_set(&card->qdio.state, QETH_QDIO_UNINITIALIZED); 20514a71df50SFrank Blaschka return -ENOMEM; 20524a71df50SFrank Blaschka } 20534a71df50SFrank Blaschka 20544a71df50SFrank Blaschka static void qeth_create_qib_param_field(struct qeth_card *card, 20554a71df50SFrank Blaschka char *param_field) 20564a71df50SFrank Blaschka { 20574a71df50SFrank Blaschka 20584a71df50SFrank Blaschka param_field[0] = _ascebc['P']; 20594a71df50SFrank Blaschka param_field[1] = _ascebc['C']; 20604a71df50SFrank Blaschka param_field[2] = _ascebc['I']; 20614a71df50SFrank Blaschka param_field[3] = _ascebc['T']; 20624a71df50SFrank Blaschka *((unsigned int *) (¶m_field[4])) = QETH_PCI_THRESHOLD_A(card); 20634a71df50SFrank Blaschka *((unsigned int *) (¶m_field[8])) = QETH_PCI_THRESHOLD_B(card); 20644a71df50SFrank Blaschka *((unsigned int *) (¶m_field[12])) = QETH_PCI_TIMER_VALUE(card); 20654a71df50SFrank Blaschka } 20664a71df50SFrank Blaschka 20674a71df50SFrank Blaschka static void qeth_create_qib_param_field_blkt(struct qeth_card *card, 20684a71df50SFrank Blaschka char *param_field) 20694a71df50SFrank Blaschka { 20704a71df50SFrank Blaschka param_field[16] = _ascebc['B']; 20714a71df50SFrank Blaschka param_field[17] = _ascebc['L']; 20724a71df50SFrank Blaschka param_field[18] = _ascebc['K']; 20734a71df50SFrank Blaschka param_field[19] = _ascebc['T']; 20744a71df50SFrank Blaschka *((unsigned int *) (¶m_field[20])) = card->info.blkt.time_total; 20754a71df50SFrank Blaschka *((unsigned int *) (¶m_field[24])) = card->info.blkt.inter_packet; 20764a71df50SFrank Blaschka *((unsigned int *) (¶m_field[28])) = 20774a71df50SFrank Blaschka card->info.blkt.inter_packet_jumbo; 20784a71df50SFrank Blaschka } 20794a71df50SFrank Blaschka 20804a71df50SFrank Blaschka static int qeth_qdio_activate(struct qeth_card *card) 20814a71df50SFrank Blaschka { 2082d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 3, "qdioact"); 2083779e6e1cSJan Glauber return qdio_activate(CARD_DDEV(card)); 20844a71df50SFrank Blaschka } 20854a71df50SFrank Blaschka 20864a71df50SFrank Blaschka static int qeth_dm_act(struct qeth_card *card) 20874a71df50SFrank Blaschka { 20884a71df50SFrank Blaschka int rc; 20894a71df50SFrank Blaschka struct qeth_cmd_buffer *iob; 20904a71df50SFrank Blaschka 2091d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "dmact"); 20924a71df50SFrank Blaschka 20934a71df50SFrank Blaschka iob = qeth_wait_for_buffer(&card->write); 20944a71df50SFrank Blaschka memcpy(iob->data, DM_ACT, DM_ACT_SIZE); 20954a71df50SFrank Blaschka 20964a71df50SFrank Blaschka memcpy(QETH_DM_ACT_DEST_ADDR(iob->data), 20974a71df50SFrank Blaschka &card->token.cm_connection_r, QETH_MPC_TOKEN_LENGTH); 20984a71df50SFrank Blaschka memcpy(QETH_DM_ACT_CONNECTION_TOKEN(iob->data), 20994a71df50SFrank Blaschka &card->token.ulp_connection_r, QETH_MPC_TOKEN_LENGTH); 21004a71df50SFrank Blaschka rc = qeth_send_control_data(card, DM_ACT_SIZE, iob, NULL, NULL); 21014a71df50SFrank Blaschka return rc; 21024a71df50SFrank Blaschka } 21034a71df50SFrank Blaschka 21044a71df50SFrank Blaschka static int qeth_mpc_initialize(struct qeth_card *card) 21054a71df50SFrank Blaschka { 21064a71df50SFrank Blaschka int rc; 21074a71df50SFrank Blaschka 2108d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "mpcinit"); 21094a71df50SFrank Blaschka 21104a71df50SFrank Blaschka rc = qeth_issue_next_read(card); 21114a71df50SFrank Blaschka if (rc) { 2112d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "1err%d", rc); 21134a71df50SFrank Blaschka return rc; 21144a71df50SFrank Blaschka } 21154a71df50SFrank Blaschka rc = qeth_cm_enable(card); 21164a71df50SFrank Blaschka if (rc) { 2117d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "2err%d", rc); 21184a71df50SFrank Blaschka goto out_qdio; 21194a71df50SFrank Blaschka } 21204a71df50SFrank Blaschka rc = qeth_cm_setup(card); 21214a71df50SFrank Blaschka if (rc) { 2122d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "3err%d", rc); 21234a71df50SFrank Blaschka goto out_qdio; 21244a71df50SFrank Blaschka } 21254a71df50SFrank Blaschka rc = qeth_ulp_enable(card); 21264a71df50SFrank Blaschka if (rc) { 2127d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "4err%d", rc); 21284a71df50SFrank Blaschka goto out_qdio; 21294a71df50SFrank Blaschka } 21304a71df50SFrank Blaschka rc = qeth_ulp_setup(card); 21314a71df50SFrank Blaschka if (rc) { 2132d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "5err%d", rc); 21334a71df50SFrank Blaschka goto out_qdio; 21344a71df50SFrank Blaschka } 21354a71df50SFrank Blaschka rc = qeth_alloc_qdio_buffers(card); 21364a71df50SFrank Blaschka if (rc) { 2137d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "5err%d", rc); 21384a71df50SFrank Blaschka goto out_qdio; 21394a71df50SFrank Blaschka } 21404a71df50SFrank Blaschka rc = qeth_qdio_establish(card); 21414a71df50SFrank Blaschka if (rc) { 2142d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "6err%d", rc); 21434a71df50SFrank Blaschka qeth_free_qdio_buffers(card); 21444a71df50SFrank Blaschka goto out_qdio; 21454a71df50SFrank Blaschka } 21464a71df50SFrank Blaschka rc = qeth_qdio_activate(card); 21474a71df50SFrank Blaschka if (rc) { 2148d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "7err%d", rc); 21494a71df50SFrank Blaschka goto out_qdio; 21504a71df50SFrank Blaschka } 21514a71df50SFrank Blaschka rc = qeth_dm_act(card); 21524a71df50SFrank Blaschka if (rc) { 2153d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "8err%d", rc); 21544a71df50SFrank Blaschka goto out_qdio; 21554a71df50SFrank Blaschka } 21564a71df50SFrank Blaschka 21574a71df50SFrank Blaschka return 0; 21584a71df50SFrank Blaschka out_qdio: 21594a71df50SFrank Blaschka qeth_qdio_clear_card(card, card->info.type != QETH_CARD_TYPE_IQD); 21604a71df50SFrank Blaschka return rc; 21614a71df50SFrank Blaschka } 21624a71df50SFrank Blaschka 21634a71df50SFrank Blaschka static void qeth_print_status_with_portname(struct qeth_card *card) 21644a71df50SFrank Blaschka { 21654a71df50SFrank Blaschka char dbf_text[15]; 21664a71df50SFrank Blaschka int i; 21674a71df50SFrank Blaschka 21684a71df50SFrank Blaschka sprintf(dbf_text, "%s", card->info.portname + 1); 21694a71df50SFrank Blaschka for (i = 0; i < 8; i++) 21704a71df50SFrank Blaschka dbf_text[i] = 21714a71df50SFrank Blaschka (char) _ebcasc[(__u8) dbf_text[i]]; 21724a71df50SFrank Blaschka dbf_text[8] = 0; 21734a71df50SFrank Blaschka PRINT_INFO("Device %s/%s/%s is a%s card%s%s%s\n" 21744a71df50SFrank Blaschka "with link type %s (portname: %s)\n", 21754a71df50SFrank Blaschka CARD_RDEV_ID(card), 21764a71df50SFrank Blaschka CARD_WDEV_ID(card), 21774a71df50SFrank Blaschka CARD_DDEV_ID(card), 21784a71df50SFrank Blaschka qeth_get_cardname(card), 21794a71df50SFrank Blaschka (card->info.mcl_level[0]) ? " (level: " : "", 21804a71df50SFrank Blaschka (card->info.mcl_level[0]) ? card->info.mcl_level : "", 21814a71df50SFrank Blaschka (card->info.mcl_level[0]) ? ")" : "", 21824a71df50SFrank Blaschka qeth_get_cardname_short(card), 21834a71df50SFrank Blaschka dbf_text); 21844a71df50SFrank Blaschka 21854a71df50SFrank Blaschka } 21864a71df50SFrank Blaschka 21874a71df50SFrank Blaschka static void qeth_print_status_no_portname(struct qeth_card *card) 21884a71df50SFrank Blaschka { 21894a71df50SFrank Blaschka if (card->info.portname[0]) 21904a71df50SFrank Blaschka PRINT_INFO("Device %s/%s/%s is a%s " 21914a71df50SFrank Blaschka "card%s%s%s\nwith link type %s " 21924a71df50SFrank Blaschka "(no portname needed by interface).\n", 21934a71df50SFrank Blaschka CARD_RDEV_ID(card), 21944a71df50SFrank Blaschka CARD_WDEV_ID(card), 21954a71df50SFrank Blaschka CARD_DDEV_ID(card), 21964a71df50SFrank Blaschka qeth_get_cardname(card), 21974a71df50SFrank Blaschka (card->info.mcl_level[0]) ? " (level: " : "", 21984a71df50SFrank Blaschka (card->info.mcl_level[0]) ? card->info.mcl_level : "", 21994a71df50SFrank Blaschka (card->info.mcl_level[0]) ? ")" : "", 22004a71df50SFrank Blaschka qeth_get_cardname_short(card)); 22014a71df50SFrank Blaschka else 22024a71df50SFrank Blaschka PRINT_INFO("Device %s/%s/%s is a%s " 22034a71df50SFrank Blaschka "card%s%s%s\nwith link type %s.\n", 22044a71df50SFrank Blaschka CARD_RDEV_ID(card), 22054a71df50SFrank Blaschka CARD_WDEV_ID(card), 22064a71df50SFrank Blaschka CARD_DDEV_ID(card), 22074a71df50SFrank Blaschka qeth_get_cardname(card), 22084a71df50SFrank Blaschka (card->info.mcl_level[0]) ? " (level: " : "", 22094a71df50SFrank Blaschka (card->info.mcl_level[0]) ? card->info.mcl_level : "", 22104a71df50SFrank Blaschka (card->info.mcl_level[0]) ? ")" : "", 22114a71df50SFrank Blaschka qeth_get_cardname_short(card)); 22124a71df50SFrank Blaschka } 22134a71df50SFrank Blaschka 22144a71df50SFrank Blaschka void qeth_print_status_message(struct qeth_card *card) 22154a71df50SFrank Blaschka { 22164a71df50SFrank Blaschka switch (card->info.type) { 22174a71df50SFrank Blaschka case QETH_CARD_TYPE_OSAE: 22184a71df50SFrank Blaschka /* VM will use a non-zero first character 22194a71df50SFrank Blaschka * to indicate a HiperSockets like reporting 22204a71df50SFrank Blaschka * of the level OSA sets the first character to zero 22214a71df50SFrank Blaschka * */ 22224a71df50SFrank Blaschka if (!card->info.mcl_level[0]) { 22234a71df50SFrank Blaschka sprintf(card->info.mcl_level, "%02x%02x", 22244a71df50SFrank Blaschka card->info.mcl_level[2], 22254a71df50SFrank Blaschka card->info.mcl_level[3]); 22264a71df50SFrank Blaschka 22274a71df50SFrank Blaschka card->info.mcl_level[QETH_MCL_LENGTH] = 0; 22284a71df50SFrank Blaschka break; 22294a71df50SFrank Blaschka } 22304a71df50SFrank Blaschka /* fallthrough */ 22314a71df50SFrank Blaschka case QETH_CARD_TYPE_IQD: 22324a71df50SFrank Blaschka if (card->info.guestlan) { 22334a71df50SFrank Blaschka card->info.mcl_level[0] = (char) _ebcasc[(__u8) 22344a71df50SFrank Blaschka card->info.mcl_level[0]]; 22354a71df50SFrank Blaschka card->info.mcl_level[1] = (char) _ebcasc[(__u8) 22364a71df50SFrank Blaschka card->info.mcl_level[1]]; 22374a71df50SFrank Blaschka card->info.mcl_level[2] = (char) _ebcasc[(__u8) 22384a71df50SFrank Blaschka card->info.mcl_level[2]]; 22394a71df50SFrank Blaschka card->info.mcl_level[3] = (char) _ebcasc[(__u8) 22404a71df50SFrank Blaschka card->info.mcl_level[3]]; 22414a71df50SFrank Blaschka card->info.mcl_level[QETH_MCL_LENGTH] = 0; 22424a71df50SFrank Blaschka } 22434a71df50SFrank Blaschka break; 22444a71df50SFrank Blaschka default: 22454a71df50SFrank Blaschka memset(&card->info.mcl_level[0], 0, QETH_MCL_LENGTH + 1); 22464a71df50SFrank Blaschka } 22474a71df50SFrank Blaschka if (card->info.portname_required) 22484a71df50SFrank Blaschka qeth_print_status_with_portname(card); 22494a71df50SFrank Blaschka else 22504a71df50SFrank Blaschka qeth_print_status_no_portname(card); 22514a71df50SFrank Blaschka } 22524a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_print_status_message); 22534a71df50SFrank Blaschka 22544a71df50SFrank Blaschka static void qeth_initialize_working_pool_list(struct qeth_card *card) 22554a71df50SFrank Blaschka { 22564a71df50SFrank Blaschka struct qeth_buffer_pool_entry *entry; 22574a71df50SFrank Blaschka 2258d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 5, "inwrklst"); 22594a71df50SFrank Blaschka 22604a71df50SFrank Blaschka list_for_each_entry(entry, 22614a71df50SFrank Blaschka &card->qdio.init_pool.entry_list, init_list) { 22624a71df50SFrank Blaschka qeth_put_buffer_pool_entry(card, entry); 22634a71df50SFrank Blaschka } 22644a71df50SFrank Blaschka } 22654a71df50SFrank Blaschka 22664a71df50SFrank Blaschka static inline struct qeth_buffer_pool_entry *qeth_find_free_buffer_pool_entry( 22674a71df50SFrank Blaschka struct qeth_card *card) 22684a71df50SFrank Blaschka { 22694a71df50SFrank Blaschka struct list_head *plh; 22704a71df50SFrank Blaschka struct qeth_buffer_pool_entry *entry; 22714a71df50SFrank Blaschka int i, free; 22724a71df50SFrank Blaschka struct page *page; 22734a71df50SFrank Blaschka 22744a71df50SFrank Blaschka if (list_empty(&card->qdio.in_buf_pool.entry_list)) 22754a71df50SFrank Blaschka return NULL; 22764a71df50SFrank Blaschka 22774a71df50SFrank Blaschka list_for_each(plh, &card->qdio.in_buf_pool.entry_list) { 22784a71df50SFrank Blaschka entry = list_entry(plh, struct qeth_buffer_pool_entry, list); 22794a71df50SFrank Blaschka free = 1; 22804a71df50SFrank Blaschka for (i = 0; i < QETH_MAX_BUFFER_ELEMENTS(card); ++i) { 22814a71df50SFrank Blaschka if (page_count(virt_to_page(entry->elements[i])) > 1) { 22824a71df50SFrank Blaschka free = 0; 22834a71df50SFrank Blaschka break; 22844a71df50SFrank Blaschka } 22854a71df50SFrank Blaschka } 22864a71df50SFrank Blaschka if (free) { 22874a71df50SFrank Blaschka list_del_init(&entry->list); 22884a71df50SFrank Blaschka return entry; 22894a71df50SFrank Blaschka } 22904a71df50SFrank Blaschka } 22914a71df50SFrank Blaschka 22924a71df50SFrank Blaschka /* no free buffer in pool so take first one and swap pages */ 22934a71df50SFrank Blaschka entry = list_entry(card->qdio.in_buf_pool.entry_list.next, 22944a71df50SFrank Blaschka struct qeth_buffer_pool_entry, list); 22954a71df50SFrank Blaschka for (i = 0; i < QETH_MAX_BUFFER_ELEMENTS(card); ++i) { 22964a71df50SFrank Blaschka if (page_count(virt_to_page(entry->elements[i])) > 1) { 2297508b3c4fSUrsula Braun page = alloc_page(GFP_ATOMIC); 22984a71df50SFrank Blaschka if (!page) { 22994a71df50SFrank Blaschka return NULL; 23004a71df50SFrank Blaschka } else { 23014a71df50SFrank Blaschka free_page((unsigned long)entry->elements[i]); 23024a71df50SFrank Blaschka entry->elements[i] = page_address(page); 23034a71df50SFrank Blaschka if (card->options.performance_stats) 23044a71df50SFrank Blaschka card->perf_stats.sg_alloc_page_rx++; 23054a71df50SFrank Blaschka } 23064a71df50SFrank Blaschka } 23074a71df50SFrank Blaschka } 23084a71df50SFrank Blaschka list_del_init(&entry->list); 23094a71df50SFrank Blaschka return entry; 23104a71df50SFrank Blaschka } 23114a71df50SFrank Blaschka 23124a71df50SFrank Blaschka static int qeth_init_input_buffer(struct qeth_card *card, 23134a71df50SFrank Blaschka struct qeth_qdio_buffer *buf) 23144a71df50SFrank Blaschka { 23154a71df50SFrank Blaschka struct qeth_buffer_pool_entry *pool_entry; 23164a71df50SFrank Blaschka int i; 23174a71df50SFrank Blaschka 23184a71df50SFrank Blaschka pool_entry = qeth_find_free_buffer_pool_entry(card); 23194a71df50SFrank Blaschka if (!pool_entry) 23204a71df50SFrank Blaschka return 1; 23214a71df50SFrank Blaschka 23224a71df50SFrank Blaschka /* 23234a71df50SFrank Blaschka * since the buffer is accessed only from the input_tasklet 23244a71df50SFrank Blaschka * there shouldn't be a need to synchronize; also, since we use 23254a71df50SFrank Blaschka * the QETH_IN_BUF_REQUEUE_THRESHOLD we should never run out off 23264a71df50SFrank Blaschka * buffers 23274a71df50SFrank Blaschka */ 23284a71df50SFrank Blaschka BUG_ON(!pool_entry); 23294a71df50SFrank Blaschka 23304a71df50SFrank Blaschka buf->pool_entry = pool_entry; 23314a71df50SFrank Blaschka for (i = 0; i < QETH_MAX_BUFFER_ELEMENTS(card); ++i) { 23324a71df50SFrank Blaschka buf->buffer->element[i].length = PAGE_SIZE; 23334a71df50SFrank Blaschka buf->buffer->element[i].addr = pool_entry->elements[i]; 23344a71df50SFrank Blaschka if (i == QETH_MAX_BUFFER_ELEMENTS(card) - 1) 23354a71df50SFrank Blaschka buf->buffer->element[i].flags = SBAL_FLAGS_LAST_ENTRY; 23364a71df50SFrank Blaschka else 23374a71df50SFrank Blaschka buf->buffer->element[i].flags = 0; 23384a71df50SFrank Blaschka } 23394a71df50SFrank Blaschka return 0; 23404a71df50SFrank Blaschka } 23414a71df50SFrank Blaschka 23424a71df50SFrank Blaschka int qeth_init_qdio_queues(struct qeth_card *card) 23434a71df50SFrank Blaschka { 23444a71df50SFrank Blaschka int i, j; 23454a71df50SFrank Blaschka int rc; 23464a71df50SFrank Blaschka 2347d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "initqdqs"); 23484a71df50SFrank Blaschka 23494a71df50SFrank Blaschka /* inbound queue */ 23504a71df50SFrank Blaschka memset(card->qdio.in_q->qdio_bufs, 0, 23514a71df50SFrank Blaschka QDIO_MAX_BUFFERS_PER_Q * sizeof(struct qdio_buffer)); 23524a71df50SFrank Blaschka qeth_initialize_working_pool_list(card); 23534a71df50SFrank Blaschka /*give only as many buffers to hardware as we have buffer pool entries*/ 23544a71df50SFrank Blaschka for (i = 0; i < card->qdio.in_buf_pool.buf_count - 1; ++i) 23554a71df50SFrank Blaschka qeth_init_input_buffer(card, &card->qdio.in_q->bufs[i]); 23564a71df50SFrank Blaschka card->qdio.in_q->next_buf_to_init = 23574a71df50SFrank Blaschka card->qdio.in_buf_pool.buf_count - 1; 23584a71df50SFrank Blaschka rc = do_QDIO(CARD_DDEV(card), QDIO_FLAG_SYNC_INPUT, 0, 0, 2359779e6e1cSJan Glauber card->qdio.in_buf_pool.buf_count - 1); 23604a71df50SFrank Blaschka if (rc) { 2361d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "1err%d", rc); 23624a71df50SFrank Blaschka return rc; 23634a71df50SFrank Blaschka } 23644a71df50SFrank Blaschka /* outbound queue */ 23654a71df50SFrank Blaschka for (i = 0; i < card->qdio.no_out_queues; ++i) { 23664a71df50SFrank Blaschka memset(card->qdio.out_qs[i]->qdio_bufs, 0, 23674a71df50SFrank Blaschka QDIO_MAX_BUFFERS_PER_Q * sizeof(struct qdio_buffer)); 23684a71df50SFrank Blaschka for (j = 0; j < QDIO_MAX_BUFFERS_PER_Q; ++j) { 23694a71df50SFrank Blaschka qeth_clear_output_buffer(card->qdio.out_qs[i], 23704a71df50SFrank Blaschka &card->qdio.out_qs[i]->bufs[j]); 23714a71df50SFrank Blaschka } 23724a71df50SFrank Blaschka card->qdio.out_qs[i]->card = card; 23734a71df50SFrank Blaschka card->qdio.out_qs[i]->next_buf_to_fill = 0; 23744a71df50SFrank Blaschka card->qdio.out_qs[i]->do_pack = 0; 23754a71df50SFrank Blaschka atomic_set(&card->qdio.out_qs[i]->used_buffers, 0); 23764a71df50SFrank Blaschka atomic_set(&card->qdio.out_qs[i]->set_pci_flags_count, 0); 23774a71df50SFrank Blaschka atomic_set(&card->qdio.out_qs[i]->state, 23784a71df50SFrank Blaschka QETH_OUT_Q_UNLOCKED); 23794a71df50SFrank Blaschka } 23804a71df50SFrank Blaschka return 0; 23814a71df50SFrank Blaschka } 23824a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_init_qdio_queues); 23834a71df50SFrank Blaschka 23844a71df50SFrank Blaschka static inline __u8 qeth_get_ipa_adp_type(enum qeth_link_types link_type) 23854a71df50SFrank Blaschka { 23864a71df50SFrank Blaschka switch (link_type) { 23874a71df50SFrank Blaschka case QETH_LINK_TYPE_HSTR: 23884a71df50SFrank Blaschka return 2; 23894a71df50SFrank Blaschka default: 23904a71df50SFrank Blaschka return 1; 23914a71df50SFrank Blaschka } 23924a71df50SFrank Blaschka } 23934a71df50SFrank Blaschka 23944a71df50SFrank Blaschka static void qeth_fill_ipacmd_header(struct qeth_card *card, 23954a71df50SFrank Blaschka struct qeth_ipa_cmd *cmd, __u8 command, 23964a71df50SFrank Blaschka enum qeth_prot_versions prot) 23974a71df50SFrank Blaschka { 23984a71df50SFrank Blaschka memset(cmd, 0, sizeof(struct qeth_ipa_cmd)); 23994a71df50SFrank Blaschka cmd->hdr.command = command; 24004a71df50SFrank Blaschka cmd->hdr.initiator = IPA_CMD_INITIATOR_HOST; 24014a71df50SFrank Blaschka cmd->hdr.seqno = card->seqno.ipa; 24024a71df50SFrank Blaschka cmd->hdr.adapter_type = qeth_get_ipa_adp_type(card->info.link_type); 24034a71df50SFrank Blaschka cmd->hdr.rel_adapter_no = (__u8) card->info.portno; 24044a71df50SFrank Blaschka if (card->options.layer2) 24054a71df50SFrank Blaschka cmd->hdr.prim_version_no = 2; 24064a71df50SFrank Blaschka else 24074a71df50SFrank Blaschka cmd->hdr.prim_version_no = 1; 24084a71df50SFrank Blaschka cmd->hdr.param_count = 1; 24094a71df50SFrank Blaschka cmd->hdr.prot_version = prot; 24104a71df50SFrank Blaschka cmd->hdr.ipa_supported = 0; 24114a71df50SFrank Blaschka cmd->hdr.ipa_enabled = 0; 24124a71df50SFrank Blaschka } 24134a71df50SFrank Blaschka 24144a71df50SFrank Blaschka struct qeth_cmd_buffer *qeth_get_ipacmd_buffer(struct qeth_card *card, 24154a71df50SFrank Blaschka enum qeth_ipa_cmds ipacmd, enum qeth_prot_versions prot) 24164a71df50SFrank Blaschka { 24174a71df50SFrank Blaschka struct qeth_cmd_buffer *iob; 24184a71df50SFrank Blaschka struct qeth_ipa_cmd *cmd; 24194a71df50SFrank Blaschka 24204a71df50SFrank Blaschka iob = qeth_wait_for_buffer(&card->write); 24214a71df50SFrank Blaschka cmd = (struct qeth_ipa_cmd *)(iob->data+IPA_PDU_HEADER_SIZE); 24224a71df50SFrank Blaschka qeth_fill_ipacmd_header(card, cmd, ipacmd, prot); 24234a71df50SFrank Blaschka 24244a71df50SFrank Blaschka return iob; 24254a71df50SFrank Blaschka } 24264a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_get_ipacmd_buffer); 24274a71df50SFrank Blaschka 24284a71df50SFrank Blaschka void qeth_prepare_ipa_cmd(struct qeth_card *card, struct qeth_cmd_buffer *iob, 24294a71df50SFrank Blaschka char prot_type) 24304a71df50SFrank Blaschka { 24314a71df50SFrank Blaschka memcpy(iob->data, IPA_PDU_HEADER, IPA_PDU_HEADER_SIZE); 24324a71df50SFrank Blaschka memcpy(QETH_IPA_CMD_PROT_TYPE(iob->data), &prot_type, 1); 24334a71df50SFrank Blaschka memcpy(QETH_IPA_CMD_DEST_ADDR(iob->data), 24344a71df50SFrank Blaschka &card->token.ulp_connection_r, QETH_MPC_TOKEN_LENGTH); 24354a71df50SFrank Blaschka } 24364a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_prepare_ipa_cmd); 24374a71df50SFrank Blaschka 24384a71df50SFrank Blaschka int qeth_send_ipa_cmd(struct qeth_card *card, struct qeth_cmd_buffer *iob, 24394a71df50SFrank Blaschka int (*reply_cb)(struct qeth_card *, struct qeth_reply*, 24404a71df50SFrank Blaschka unsigned long), 24414a71df50SFrank Blaschka void *reply_param) 24424a71df50SFrank Blaschka { 24434a71df50SFrank Blaschka int rc; 24444a71df50SFrank Blaschka char prot_type; 24454a71df50SFrank Blaschka 2446d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 4, "sendipa"); 24474a71df50SFrank Blaschka 24484a71df50SFrank Blaschka if (card->options.layer2) 24494a71df50SFrank Blaschka if (card->info.type == QETH_CARD_TYPE_OSN) 24504a71df50SFrank Blaschka prot_type = QETH_PROT_OSN2; 24514a71df50SFrank Blaschka else 24524a71df50SFrank Blaschka prot_type = QETH_PROT_LAYER2; 24534a71df50SFrank Blaschka else 24544a71df50SFrank Blaschka prot_type = QETH_PROT_TCPIP; 24554a71df50SFrank Blaschka qeth_prepare_ipa_cmd(card, iob, prot_type); 2456d11ba0c4SPeter Tiedemann rc = qeth_send_control_data(card, IPA_CMD_LENGTH, 2457d11ba0c4SPeter Tiedemann iob, reply_cb, reply_param); 24584a71df50SFrank Blaschka return rc; 24594a71df50SFrank Blaschka } 24604a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_send_ipa_cmd); 24614a71df50SFrank Blaschka 24624a71df50SFrank Blaschka static int qeth_send_startstoplan(struct qeth_card *card, 24634a71df50SFrank Blaschka enum qeth_ipa_cmds ipacmd, enum qeth_prot_versions prot) 24644a71df50SFrank Blaschka { 24654a71df50SFrank Blaschka int rc; 24664a71df50SFrank Blaschka struct qeth_cmd_buffer *iob; 24674a71df50SFrank Blaschka 24684a71df50SFrank Blaschka iob = qeth_get_ipacmd_buffer(card, ipacmd, prot); 24694a71df50SFrank Blaschka rc = qeth_send_ipa_cmd(card, iob, NULL, NULL); 24704a71df50SFrank Blaschka 24714a71df50SFrank Blaschka return rc; 24724a71df50SFrank Blaschka } 24734a71df50SFrank Blaschka 24744a71df50SFrank Blaschka int qeth_send_startlan(struct qeth_card *card) 24754a71df50SFrank Blaschka { 24764a71df50SFrank Blaschka int rc; 24774a71df50SFrank Blaschka 2478d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "strtlan"); 24794a71df50SFrank Blaschka 24804a71df50SFrank Blaschka rc = qeth_send_startstoplan(card, IPA_CMD_STARTLAN, 0); 24814a71df50SFrank Blaschka return rc; 24824a71df50SFrank Blaschka } 24834a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_send_startlan); 24844a71df50SFrank Blaschka 24854a71df50SFrank Blaschka int qeth_send_stoplan(struct qeth_card *card) 24864a71df50SFrank Blaschka { 24874a71df50SFrank Blaschka int rc = 0; 24884a71df50SFrank Blaschka 24894a71df50SFrank Blaschka /* 24904a71df50SFrank Blaschka * TODO: according to the IPA format document page 14, 24914a71df50SFrank Blaschka * TCP/IP (we!) never issue a STOPLAN 24924a71df50SFrank Blaschka * is this right ?!? 24934a71df50SFrank Blaschka */ 2494d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "stoplan"); 24954a71df50SFrank Blaschka 24964a71df50SFrank Blaschka rc = qeth_send_startstoplan(card, IPA_CMD_STOPLAN, 0); 24974a71df50SFrank Blaschka return rc; 24984a71df50SFrank Blaschka } 24994a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_send_stoplan); 25004a71df50SFrank Blaschka 25014a71df50SFrank Blaschka int qeth_default_setadapterparms_cb(struct qeth_card *card, 25024a71df50SFrank Blaschka struct qeth_reply *reply, unsigned long data) 25034a71df50SFrank Blaschka { 25044a71df50SFrank Blaschka struct qeth_ipa_cmd *cmd; 25054a71df50SFrank Blaschka 2506d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 4, "defadpcb"); 25074a71df50SFrank Blaschka 25084a71df50SFrank Blaschka cmd = (struct qeth_ipa_cmd *) data; 25094a71df50SFrank Blaschka if (cmd->hdr.return_code == 0) 25104a71df50SFrank Blaschka cmd->hdr.return_code = 25114a71df50SFrank Blaschka cmd->data.setadapterparms.hdr.return_code; 25124a71df50SFrank Blaschka return 0; 25134a71df50SFrank Blaschka } 25144a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_default_setadapterparms_cb); 25154a71df50SFrank Blaschka 25164a71df50SFrank Blaschka static int qeth_query_setadapterparms_cb(struct qeth_card *card, 25174a71df50SFrank Blaschka struct qeth_reply *reply, unsigned long data) 25184a71df50SFrank Blaschka { 25194a71df50SFrank Blaschka struct qeth_ipa_cmd *cmd; 25204a71df50SFrank Blaschka 2521d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 3, "quyadpcb"); 25224a71df50SFrank Blaschka 25234a71df50SFrank Blaschka cmd = (struct qeth_ipa_cmd *) data; 25244a71df50SFrank Blaschka if (cmd->data.setadapterparms.data.query_cmds_supp.lan_type & 0x7f) 25254a71df50SFrank Blaschka card->info.link_type = 25264a71df50SFrank Blaschka cmd->data.setadapterparms.data.query_cmds_supp.lan_type; 25274a71df50SFrank Blaschka card->options.adp.supported_funcs = 25284a71df50SFrank Blaschka cmd->data.setadapterparms.data.query_cmds_supp.supported_cmds; 25294a71df50SFrank Blaschka return qeth_default_setadapterparms_cb(card, reply, (unsigned long)cmd); 25304a71df50SFrank Blaschka } 25314a71df50SFrank Blaschka 25324a71df50SFrank Blaschka struct qeth_cmd_buffer *qeth_get_adapter_cmd(struct qeth_card *card, 25334a71df50SFrank Blaschka __u32 command, __u32 cmdlen) 25344a71df50SFrank Blaschka { 25354a71df50SFrank Blaschka struct qeth_cmd_buffer *iob; 25364a71df50SFrank Blaschka struct qeth_ipa_cmd *cmd; 25374a71df50SFrank Blaschka 25384a71df50SFrank Blaschka iob = qeth_get_ipacmd_buffer(card, IPA_CMD_SETADAPTERPARMS, 25394a71df50SFrank Blaschka QETH_PROT_IPV4); 25404a71df50SFrank Blaschka cmd = (struct qeth_ipa_cmd *)(iob->data+IPA_PDU_HEADER_SIZE); 25414a71df50SFrank Blaschka cmd->data.setadapterparms.hdr.cmdlength = cmdlen; 25424a71df50SFrank Blaschka cmd->data.setadapterparms.hdr.command_code = command; 25434a71df50SFrank Blaschka cmd->data.setadapterparms.hdr.used_total = 1; 25444a71df50SFrank Blaschka cmd->data.setadapterparms.hdr.seq_no = 1; 25454a71df50SFrank Blaschka 25464a71df50SFrank Blaschka return iob; 25474a71df50SFrank Blaschka } 25484a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_get_adapter_cmd); 25494a71df50SFrank Blaschka 25504a71df50SFrank Blaschka int qeth_query_setadapterparms(struct qeth_card *card) 25514a71df50SFrank Blaschka { 25524a71df50SFrank Blaschka int rc; 25534a71df50SFrank Blaschka struct qeth_cmd_buffer *iob; 25544a71df50SFrank Blaschka 2555d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 3, "queryadp"); 25564a71df50SFrank Blaschka iob = qeth_get_adapter_cmd(card, IPA_SETADP_QUERY_COMMANDS_SUPPORTED, 25574a71df50SFrank Blaschka sizeof(struct qeth_ipacmd_setadpparms)); 25584a71df50SFrank Blaschka rc = qeth_send_ipa_cmd(card, iob, qeth_query_setadapterparms_cb, NULL); 25594a71df50SFrank Blaschka return rc; 25604a71df50SFrank Blaschka } 25614a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_query_setadapterparms); 25624a71df50SFrank Blaschka 25634a71df50SFrank Blaschka int qeth_check_qdio_errors(struct qdio_buffer *buf, unsigned int qdio_error, 2564779e6e1cSJan Glauber const char *dbftext) 25654a71df50SFrank Blaschka { 2566779e6e1cSJan Glauber if (qdio_error) { 2567d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 2, dbftext); 2568d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(QERR, 2, dbftext); 2569d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(QERR, 2, " F15=%02X", 25704a71df50SFrank Blaschka buf->element[15].flags & 0xff); 2571d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(QERR, 2, " F14=%02X", 25724a71df50SFrank Blaschka buf->element[14].flags & 0xff); 2573d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(QERR, 2, " qerr=%X", qdio_error); 25744a71df50SFrank Blaschka return 1; 25754a71df50SFrank Blaschka } 25764a71df50SFrank Blaschka return 0; 25774a71df50SFrank Blaschka } 25784a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_check_qdio_errors); 25794a71df50SFrank Blaschka 25804a71df50SFrank Blaschka void qeth_queue_input_buffer(struct qeth_card *card, int index) 25814a71df50SFrank Blaschka { 25824a71df50SFrank Blaschka struct qeth_qdio_q *queue = card->qdio.in_q; 25834a71df50SFrank Blaschka int count; 25844a71df50SFrank Blaschka int i; 25854a71df50SFrank Blaschka int rc; 25864a71df50SFrank Blaschka int newcount = 0; 25874a71df50SFrank Blaschka 25884a71df50SFrank Blaschka count = (index < queue->next_buf_to_init)? 25894a71df50SFrank Blaschka card->qdio.in_buf_pool.buf_count - 25904a71df50SFrank Blaschka (queue->next_buf_to_init - index) : 25914a71df50SFrank Blaschka card->qdio.in_buf_pool.buf_count - 25924a71df50SFrank Blaschka (queue->next_buf_to_init + QDIO_MAX_BUFFERS_PER_Q - index); 25934a71df50SFrank Blaschka /* only requeue at a certain threshold to avoid SIGAs */ 25944a71df50SFrank Blaschka if (count >= QETH_IN_BUF_REQUEUE_THRESHOLD(card)) { 25954a71df50SFrank Blaschka for (i = queue->next_buf_to_init; 25964a71df50SFrank Blaschka i < queue->next_buf_to_init + count; ++i) { 25974a71df50SFrank Blaschka if (qeth_init_input_buffer(card, 25984a71df50SFrank Blaschka &queue->bufs[i % QDIO_MAX_BUFFERS_PER_Q])) { 25994a71df50SFrank Blaschka break; 26004a71df50SFrank Blaschka } else { 26014a71df50SFrank Blaschka newcount++; 26024a71df50SFrank Blaschka } 26034a71df50SFrank Blaschka } 26044a71df50SFrank Blaschka 26054a71df50SFrank Blaschka if (newcount < count) { 26064a71df50SFrank Blaschka /* we are in memory shortage so we switch back to 26074a71df50SFrank Blaschka traditional skb allocation and drop packages */ 26084a71df50SFrank Blaschka atomic_set(&card->force_alloc_skb, 3); 26094a71df50SFrank Blaschka count = newcount; 26104a71df50SFrank Blaschka } else { 26114a71df50SFrank Blaschka atomic_add_unless(&card->force_alloc_skb, -1, 0); 26124a71df50SFrank Blaschka } 26134a71df50SFrank Blaschka 26144a71df50SFrank Blaschka /* 26154a71df50SFrank Blaschka * according to old code it should be avoided to requeue all 26164a71df50SFrank Blaschka * 128 buffers in order to benefit from PCI avoidance. 26174a71df50SFrank Blaschka * this function keeps at least one buffer (the buffer at 26184a71df50SFrank Blaschka * 'index') un-requeued -> this buffer is the first buffer that 26194a71df50SFrank Blaschka * will be requeued the next time 26204a71df50SFrank Blaschka */ 26214a71df50SFrank Blaschka if (card->options.performance_stats) { 26224a71df50SFrank Blaschka card->perf_stats.inbound_do_qdio_cnt++; 26234a71df50SFrank Blaschka card->perf_stats.inbound_do_qdio_start_time = 26244a71df50SFrank Blaschka qeth_get_micros(); 26254a71df50SFrank Blaschka } 2626779e6e1cSJan Glauber rc = do_QDIO(CARD_DDEV(card), QDIO_FLAG_SYNC_INPUT, 0, 2627779e6e1cSJan Glauber queue->next_buf_to_init, count); 26284a71df50SFrank Blaschka if (card->options.performance_stats) 26294a71df50SFrank Blaschka card->perf_stats.inbound_do_qdio_time += 26304a71df50SFrank Blaschka qeth_get_micros() - 26314a71df50SFrank Blaschka card->perf_stats.inbound_do_qdio_start_time; 26324a71df50SFrank Blaschka if (rc) { 26334a71df50SFrank Blaschka PRINT_WARN("qeth_queue_input_buffer's do_QDIO " 26344a71df50SFrank Blaschka "return %i (device %s).\n", 26354a71df50SFrank Blaschka rc, CARD_DDEV_ID(card)); 2636d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 2, "qinberr"); 2637d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(TRACE, 2, "%s", CARD_BUS_ID(card)); 26384a71df50SFrank Blaschka } 26394a71df50SFrank Blaschka queue->next_buf_to_init = (queue->next_buf_to_init + count) % 26404a71df50SFrank Blaschka QDIO_MAX_BUFFERS_PER_Q; 26414a71df50SFrank Blaschka } 26424a71df50SFrank Blaschka } 26434a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_queue_input_buffer); 26444a71df50SFrank Blaschka 26454a71df50SFrank Blaschka static int qeth_handle_send_error(struct qeth_card *card, 2646779e6e1cSJan Glauber struct qeth_qdio_out_buffer *buffer, unsigned int qdio_err) 26474a71df50SFrank Blaschka { 26484a71df50SFrank Blaschka int sbalf15 = buffer->buffer->element[15].flags & 0xff; 2649779e6e1cSJan Glauber int cc = qdio_err & 3; 26504a71df50SFrank Blaschka 2651d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 6, "hdsnderr"); 2652779e6e1cSJan Glauber qeth_check_qdio_errors(buffer->buffer, qdio_err, "qouterr"); 26534a71df50SFrank Blaschka switch (cc) { 26544a71df50SFrank Blaschka case 0: 26554a71df50SFrank Blaschka if (qdio_err) { 2656d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 1, "lnkfail"); 2657d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(TRACE, 1, "%s", CARD_BUS_ID(card)); 2658d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(TRACE, 1, "%04x %02x", 26594a71df50SFrank Blaschka (u16)qdio_err, (u8)sbalf15); 26604a71df50SFrank Blaschka return QETH_SEND_ERROR_LINK_FAILURE; 26614a71df50SFrank Blaschka } 26624a71df50SFrank Blaschka return QETH_SEND_ERROR_NONE; 26634a71df50SFrank Blaschka case 2: 2664779e6e1cSJan Glauber if (qdio_err & QDIO_ERROR_SIGA_BUSY) { 2665d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 1, "SIGAcc2B"); 2666d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(TRACE, 1, "%s", CARD_BUS_ID(card)); 26674a71df50SFrank Blaschka return QETH_SEND_ERROR_KICK_IT; 26684a71df50SFrank Blaschka } 26694a71df50SFrank Blaschka if ((sbalf15 >= 15) && (sbalf15 <= 31)) 26704a71df50SFrank Blaschka return QETH_SEND_ERROR_RETRY; 26714a71df50SFrank Blaschka return QETH_SEND_ERROR_LINK_FAILURE; 26724a71df50SFrank Blaschka /* look at qdio_error and sbalf 15 */ 26734a71df50SFrank Blaschka case 1: 2674d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 1, "SIGAcc1"); 2675d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(TRACE, 1, "%s", CARD_BUS_ID(card)); 26764a71df50SFrank Blaschka return QETH_SEND_ERROR_LINK_FAILURE; 26774a71df50SFrank Blaschka case 3: 26784a71df50SFrank Blaschka default: 2679d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 1, "SIGAcc3"); 2680d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(TRACE, 1, "%s", CARD_BUS_ID(card)); 26814a71df50SFrank Blaschka return QETH_SEND_ERROR_KICK_IT; 26824a71df50SFrank Blaschka } 26834a71df50SFrank Blaschka } 26844a71df50SFrank Blaschka 26854a71df50SFrank Blaschka /* 26864a71df50SFrank Blaschka * Switched to packing state if the number of used buffers on a queue 26874a71df50SFrank Blaschka * reaches a certain limit. 26884a71df50SFrank Blaschka */ 26894a71df50SFrank Blaschka static void qeth_switch_to_packing_if_needed(struct qeth_qdio_out_q *queue) 26904a71df50SFrank Blaschka { 26914a71df50SFrank Blaschka if (!queue->do_pack) { 26924a71df50SFrank Blaschka if (atomic_read(&queue->used_buffers) 26934a71df50SFrank Blaschka >= QETH_HIGH_WATERMARK_PACK){ 26944a71df50SFrank Blaschka /* switch non-PACKING -> PACKING */ 2695d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 6, "np->pack"); 26964a71df50SFrank Blaschka if (queue->card->options.performance_stats) 26974a71df50SFrank Blaschka queue->card->perf_stats.sc_dp_p++; 26984a71df50SFrank Blaschka queue->do_pack = 1; 26994a71df50SFrank Blaschka } 27004a71df50SFrank Blaschka } 27014a71df50SFrank Blaschka } 27024a71df50SFrank Blaschka 27034a71df50SFrank Blaschka /* 27044a71df50SFrank Blaschka * Switches from packing to non-packing mode. If there is a packing 27054a71df50SFrank Blaschka * buffer on the queue this buffer will be prepared to be flushed. 27064a71df50SFrank Blaschka * In that case 1 is returned to inform the caller. If no buffer 27074a71df50SFrank Blaschka * has to be flushed, zero is returned. 27084a71df50SFrank Blaschka */ 27094a71df50SFrank Blaschka static int qeth_switch_to_nonpacking_if_needed(struct qeth_qdio_out_q *queue) 27104a71df50SFrank Blaschka { 27114a71df50SFrank Blaschka struct qeth_qdio_out_buffer *buffer; 27124a71df50SFrank Blaschka int flush_count = 0; 27134a71df50SFrank Blaschka 27144a71df50SFrank Blaschka if (queue->do_pack) { 27154a71df50SFrank Blaschka if (atomic_read(&queue->used_buffers) 27164a71df50SFrank Blaschka <= QETH_LOW_WATERMARK_PACK) { 27174a71df50SFrank Blaschka /* switch PACKING -> non-PACKING */ 2718d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 6, "pack->np"); 27194a71df50SFrank Blaschka if (queue->card->options.performance_stats) 27204a71df50SFrank Blaschka queue->card->perf_stats.sc_p_dp++; 27214a71df50SFrank Blaschka queue->do_pack = 0; 27224a71df50SFrank Blaschka /* flush packing buffers */ 27234a71df50SFrank Blaschka buffer = &queue->bufs[queue->next_buf_to_fill]; 27244a71df50SFrank Blaschka if ((atomic_read(&buffer->state) == 27254a71df50SFrank Blaschka QETH_QDIO_BUF_EMPTY) && 27264a71df50SFrank Blaschka (buffer->next_element_to_fill > 0)) { 27274a71df50SFrank Blaschka atomic_set(&buffer->state, 27284a71df50SFrank Blaschka QETH_QDIO_BUF_PRIMED); 27294a71df50SFrank Blaschka flush_count++; 27304a71df50SFrank Blaschka queue->next_buf_to_fill = 27314a71df50SFrank Blaschka (queue->next_buf_to_fill + 1) % 27324a71df50SFrank Blaschka QDIO_MAX_BUFFERS_PER_Q; 27334a71df50SFrank Blaschka } 27344a71df50SFrank Blaschka } 27354a71df50SFrank Blaschka } 27364a71df50SFrank Blaschka return flush_count; 27374a71df50SFrank Blaschka } 27384a71df50SFrank Blaschka 27394a71df50SFrank Blaschka /* 27404a71df50SFrank Blaschka * Called to flush a packing buffer if no more pci flags are on the queue. 27414a71df50SFrank Blaschka * Checks if there is a packing buffer and prepares it to be flushed. 27424a71df50SFrank Blaschka * In that case returns 1, otherwise zero. 27434a71df50SFrank Blaschka */ 27444a71df50SFrank Blaschka static int qeth_flush_buffers_on_no_pci(struct qeth_qdio_out_q *queue) 27454a71df50SFrank Blaschka { 27464a71df50SFrank Blaschka struct qeth_qdio_out_buffer *buffer; 27474a71df50SFrank Blaschka 27484a71df50SFrank Blaschka buffer = &queue->bufs[queue->next_buf_to_fill]; 27494a71df50SFrank Blaschka if ((atomic_read(&buffer->state) == QETH_QDIO_BUF_EMPTY) && 27504a71df50SFrank Blaschka (buffer->next_element_to_fill > 0)) { 27514a71df50SFrank Blaschka /* it's a packing buffer */ 27524a71df50SFrank Blaschka atomic_set(&buffer->state, QETH_QDIO_BUF_PRIMED); 27534a71df50SFrank Blaschka queue->next_buf_to_fill = 27544a71df50SFrank Blaschka (queue->next_buf_to_fill + 1) % QDIO_MAX_BUFFERS_PER_Q; 27554a71df50SFrank Blaschka return 1; 27564a71df50SFrank Blaschka } 27574a71df50SFrank Blaschka return 0; 27584a71df50SFrank Blaschka } 27594a71df50SFrank Blaschka 2760779e6e1cSJan Glauber static void qeth_flush_buffers(struct qeth_qdio_out_q *queue, int index, 2761779e6e1cSJan Glauber int count) 27624a71df50SFrank Blaschka { 27634a71df50SFrank Blaschka struct qeth_qdio_out_buffer *buf; 27644a71df50SFrank Blaschka int rc; 27654a71df50SFrank Blaschka int i; 27664a71df50SFrank Blaschka unsigned int qdio_flags; 27674a71df50SFrank Blaschka 27684a71df50SFrank Blaschka for (i = index; i < index + count; ++i) { 27694a71df50SFrank Blaschka buf = &queue->bufs[i % QDIO_MAX_BUFFERS_PER_Q]; 27704a71df50SFrank Blaschka buf->buffer->element[buf->next_element_to_fill - 1].flags |= 27714a71df50SFrank Blaschka SBAL_FLAGS_LAST_ENTRY; 27724a71df50SFrank Blaschka 27734a71df50SFrank Blaschka if (queue->card->info.type == QETH_CARD_TYPE_IQD) 27744a71df50SFrank Blaschka continue; 27754a71df50SFrank Blaschka 27764a71df50SFrank Blaschka if (!queue->do_pack) { 27774a71df50SFrank Blaschka if ((atomic_read(&queue->used_buffers) >= 27784a71df50SFrank Blaschka (QETH_HIGH_WATERMARK_PACK - 27794a71df50SFrank Blaschka QETH_WATERMARK_PACK_FUZZ)) && 27804a71df50SFrank Blaschka !atomic_read(&queue->set_pci_flags_count)) { 27814a71df50SFrank Blaschka /* it's likely that we'll go to packing 27824a71df50SFrank Blaschka * mode soon */ 27834a71df50SFrank Blaschka atomic_inc(&queue->set_pci_flags_count); 27844a71df50SFrank Blaschka buf->buffer->element[0].flags |= 0x40; 27854a71df50SFrank Blaschka } 27864a71df50SFrank Blaschka } else { 27874a71df50SFrank Blaschka if (!atomic_read(&queue->set_pci_flags_count)) { 27884a71df50SFrank Blaschka /* 27894a71df50SFrank Blaschka * there's no outstanding PCI any more, so we 27904a71df50SFrank Blaschka * have to request a PCI to be sure the the PCI 27914a71df50SFrank Blaschka * will wake at some time in the future then we 27924a71df50SFrank Blaschka * can flush packed buffers that might still be 27934a71df50SFrank Blaschka * hanging around, which can happen if no 27944a71df50SFrank Blaschka * further send was requested by the stack 27954a71df50SFrank Blaschka */ 27964a71df50SFrank Blaschka atomic_inc(&queue->set_pci_flags_count); 27974a71df50SFrank Blaschka buf->buffer->element[0].flags |= 0x40; 27984a71df50SFrank Blaschka } 27994a71df50SFrank Blaschka } 28004a71df50SFrank Blaschka } 28014a71df50SFrank Blaschka 28024a71df50SFrank Blaschka queue->card->dev->trans_start = jiffies; 28034a71df50SFrank Blaschka if (queue->card->options.performance_stats) { 28044a71df50SFrank Blaschka queue->card->perf_stats.outbound_do_qdio_cnt++; 28054a71df50SFrank Blaschka queue->card->perf_stats.outbound_do_qdio_start_time = 28064a71df50SFrank Blaschka qeth_get_micros(); 28074a71df50SFrank Blaschka } 28084a71df50SFrank Blaschka qdio_flags = QDIO_FLAG_SYNC_OUTPUT; 28094a71df50SFrank Blaschka if (atomic_read(&queue->set_pci_flags_count)) 28104a71df50SFrank Blaschka qdio_flags |= QDIO_FLAG_PCI_OUT; 28114a71df50SFrank Blaschka rc = do_QDIO(CARD_DDEV(queue->card), qdio_flags, 2812779e6e1cSJan Glauber queue->queue_no, index, count); 28134a71df50SFrank Blaschka if (queue->card->options.performance_stats) 28144a71df50SFrank Blaschka queue->card->perf_stats.outbound_do_qdio_time += 28154a71df50SFrank Blaschka qeth_get_micros() - 28164a71df50SFrank Blaschka queue->card->perf_stats.outbound_do_qdio_start_time; 28174a71df50SFrank Blaschka if (rc) { 2818d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 2, "flushbuf"); 2819d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(TRACE, 2, " err%d", rc); 2820d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(TRACE, 2, "%s", CARD_DDEV_ID(queue->card)); 28214a71df50SFrank Blaschka queue->card->stats.tx_errors += count; 28224a71df50SFrank Blaschka /* this must not happen under normal circumstances. if it 28234a71df50SFrank Blaschka * happens something is really wrong -> recover */ 28244a71df50SFrank Blaschka qeth_schedule_recovery(queue->card); 28254a71df50SFrank Blaschka return; 28264a71df50SFrank Blaschka } 28274a71df50SFrank Blaschka atomic_add(count, &queue->used_buffers); 28284a71df50SFrank Blaschka if (queue->card->options.performance_stats) 28294a71df50SFrank Blaschka queue->card->perf_stats.bufs_sent += count; 28304a71df50SFrank Blaschka } 28314a71df50SFrank Blaschka 28324a71df50SFrank Blaschka static void qeth_check_outbound_queue(struct qeth_qdio_out_q *queue) 28334a71df50SFrank Blaschka { 28344a71df50SFrank Blaschka int index; 28354a71df50SFrank Blaschka int flush_cnt = 0; 28364a71df50SFrank Blaschka int q_was_packing = 0; 28374a71df50SFrank Blaschka 28384a71df50SFrank Blaschka /* 28394a71df50SFrank Blaschka * check if weed have to switch to non-packing mode or if 28404a71df50SFrank Blaschka * we have to get a pci flag out on the queue 28414a71df50SFrank Blaschka */ 28424a71df50SFrank Blaschka if ((atomic_read(&queue->used_buffers) <= QETH_LOW_WATERMARK_PACK) || 28434a71df50SFrank Blaschka !atomic_read(&queue->set_pci_flags_count)) { 28444a71df50SFrank Blaschka if (atomic_xchg(&queue->state, QETH_OUT_Q_LOCKED_FLUSH) == 28454a71df50SFrank Blaschka QETH_OUT_Q_UNLOCKED) { 28464a71df50SFrank Blaschka /* 28474a71df50SFrank Blaschka * If we get in here, there was no action in 28484a71df50SFrank Blaschka * do_send_packet. So, we check if there is a 28494a71df50SFrank Blaschka * packing buffer to be flushed here. 28504a71df50SFrank Blaschka */ 28514a71df50SFrank Blaschka netif_stop_queue(queue->card->dev); 28524a71df50SFrank Blaschka index = queue->next_buf_to_fill; 28534a71df50SFrank Blaschka q_was_packing = queue->do_pack; 28544a71df50SFrank Blaschka /* queue->do_pack may change */ 28554a71df50SFrank Blaschka barrier(); 28564a71df50SFrank Blaschka flush_cnt += qeth_switch_to_nonpacking_if_needed(queue); 28574a71df50SFrank Blaschka if (!flush_cnt && 28584a71df50SFrank Blaschka !atomic_read(&queue->set_pci_flags_count)) 28594a71df50SFrank Blaschka flush_cnt += 28604a71df50SFrank Blaschka qeth_flush_buffers_on_no_pci(queue); 28614a71df50SFrank Blaschka if (queue->card->options.performance_stats && 28624a71df50SFrank Blaschka q_was_packing) 28634a71df50SFrank Blaschka queue->card->perf_stats.bufs_sent_pack += 28644a71df50SFrank Blaschka flush_cnt; 28654a71df50SFrank Blaschka if (flush_cnt) 2866779e6e1cSJan Glauber qeth_flush_buffers(queue, index, flush_cnt); 28674a71df50SFrank Blaschka atomic_set(&queue->state, QETH_OUT_Q_UNLOCKED); 28684a71df50SFrank Blaschka } 28694a71df50SFrank Blaschka } 28704a71df50SFrank Blaschka } 28714a71df50SFrank Blaschka 2872779e6e1cSJan Glauber void qeth_qdio_output_handler(struct ccw_device *ccwdev, 2873779e6e1cSJan Glauber unsigned int qdio_error, int __queue, int first_element, 2874779e6e1cSJan Glauber int count, unsigned long card_ptr) 28754a71df50SFrank Blaschka { 28764a71df50SFrank Blaschka struct qeth_card *card = (struct qeth_card *) card_ptr; 28774a71df50SFrank Blaschka struct qeth_qdio_out_q *queue = card->qdio.out_qs[__queue]; 28784a71df50SFrank Blaschka struct qeth_qdio_out_buffer *buffer; 28794a71df50SFrank Blaschka int i; 28804a71df50SFrank Blaschka 2881d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 6, "qdouhdl"); 2882779e6e1cSJan Glauber if (qdio_error & QDIO_ERROR_ACTIVATE_CHECK_CONDITION) { 2883d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 2, "achkcond"); 2884d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(TRACE, 2, "%s", CARD_BUS_ID(card)); 28854a71df50SFrank Blaschka netif_stop_queue(card->dev); 28864a71df50SFrank Blaschka qeth_schedule_recovery(card); 28874a71df50SFrank Blaschka return; 28884a71df50SFrank Blaschka } 28894a71df50SFrank Blaschka if (card->options.performance_stats) { 28904a71df50SFrank Blaschka card->perf_stats.outbound_handler_cnt++; 28914a71df50SFrank Blaschka card->perf_stats.outbound_handler_start_time = 28924a71df50SFrank Blaschka qeth_get_micros(); 28934a71df50SFrank Blaschka } 28944a71df50SFrank Blaschka for (i = first_element; i < (first_element + count); ++i) { 28954a71df50SFrank Blaschka buffer = &queue->bufs[i % QDIO_MAX_BUFFERS_PER_Q]; 28964a71df50SFrank Blaschka /*we only handle the KICK_IT error by doing a recovery */ 2897779e6e1cSJan Glauber if (qeth_handle_send_error(card, buffer, qdio_error) 28984a71df50SFrank Blaschka == QETH_SEND_ERROR_KICK_IT){ 28994a71df50SFrank Blaschka netif_stop_queue(card->dev); 29004a71df50SFrank Blaschka qeth_schedule_recovery(card); 29014a71df50SFrank Blaschka return; 29024a71df50SFrank Blaschka } 29034a71df50SFrank Blaschka qeth_clear_output_buffer(queue, buffer); 29044a71df50SFrank Blaschka } 29054a71df50SFrank Blaschka atomic_sub(count, &queue->used_buffers); 29064a71df50SFrank Blaschka /* check if we need to do something on this outbound queue */ 29074a71df50SFrank Blaschka if (card->info.type != QETH_CARD_TYPE_IQD) 29084a71df50SFrank Blaschka qeth_check_outbound_queue(queue); 29094a71df50SFrank Blaschka 29104a71df50SFrank Blaschka netif_wake_queue(queue->card->dev); 29114a71df50SFrank Blaschka if (card->options.performance_stats) 29124a71df50SFrank Blaschka card->perf_stats.outbound_handler_time += qeth_get_micros() - 29134a71df50SFrank Blaschka card->perf_stats.outbound_handler_start_time; 29144a71df50SFrank Blaschka } 29154a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_qdio_output_handler); 29164a71df50SFrank Blaschka 29174a71df50SFrank Blaschka int qeth_get_cast_type(struct qeth_card *card, struct sk_buff *skb) 29184a71df50SFrank Blaschka { 29194a71df50SFrank Blaschka int cast_type = RTN_UNSPEC; 29204a71df50SFrank Blaschka 29214a71df50SFrank Blaschka if (card->info.type == QETH_CARD_TYPE_OSN) 29224a71df50SFrank Blaschka return cast_type; 29234a71df50SFrank Blaschka 29244a71df50SFrank Blaschka if (skb->dst && skb->dst->neighbour) { 29254a71df50SFrank Blaschka cast_type = skb->dst->neighbour->type; 29264a71df50SFrank Blaschka if ((cast_type == RTN_BROADCAST) || 29274a71df50SFrank Blaschka (cast_type == RTN_MULTICAST) || 29284a71df50SFrank Blaschka (cast_type == RTN_ANYCAST)) 29294a71df50SFrank Blaschka return cast_type; 29304a71df50SFrank Blaschka else 29314a71df50SFrank Blaschka return RTN_UNSPEC; 29324a71df50SFrank Blaschka } 29334a71df50SFrank Blaschka /* try something else */ 29344a71df50SFrank Blaschka if (skb->protocol == ETH_P_IPV6) 29354a71df50SFrank Blaschka return (skb_network_header(skb)[24] == 0xff) ? 29364a71df50SFrank Blaschka RTN_MULTICAST : 0; 29374a71df50SFrank Blaschka else if (skb->protocol == ETH_P_IP) 29384a71df50SFrank Blaschka return ((skb_network_header(skb)[16] & 0xf0) == 0xe0) ? 29394a71df50SFrank Blaschka RTN_MULTICAST : 0; 29404a71df50SFrank Blaschka /* ... */ 29414a71df50SFrank Blaschka if (!memcmp(skb->data, skb->dev->broadcast, 6)) 29424a71df50SFrank Blaschka return RTN_BROADCAST; 29434a71df50SFrank Blaschka else { 29444a71df50SFrank Blaschka u16 hdr_mac; 29454a71df50SFrank Blaschka 29464a71df50SFrank Blaschka hdr_mac = *((u16 *)skb->data); 29474a71df50SFrank Blaschka /* tr multicast? */ 29484a71df50SFrank Blaschka switch (card->info.link_type) { 29494a71df50SFrank Blaschka case QETH_LINK_TYPE_HSTR: 29504a71df50SFrank Blaschka case QETH_LINK_TYPE_LANE_TR: 29514a71df50SFrank Blaschka if ((hdr_mac == QETH_TR_MAC_NC) || 29524a71df50SFrank Blaschka (hdr_mac == QETH_TR_MAC_C)) 29534a71df50SFrank Blaschka return RTN_MULTICAST; 29544a71df50SFrank Blaschka break; 29554a71df50SFrank Blaschka /* eth or so multicast? */ 29564a71df50SFrank Blaschka default: 29574a71df50SFrank Blaschka if ((hdr_mac == QETH_ETH_MAC_V4) || 29584a71df50SFrank Blaschka (hdr_mac == QETH_ETH_MAC_V6)) 29594a71df50SFrank Blaschka return RTN_MULTICAST; 29604a71df50SFrank Blaschka } 29614a71df50SFrank Blaschka } 29624a71df50SFrank Blaschka return cast_type; 29634a71df50SFrank Blaschka } 29644a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_get_cast_type); 29654a71df50SFrank Blaschka 29664a71df50SFrank Blaschka int qeth_get_priority_queue(struct qeth_card *card, struct sk_buff *skb, 29674a71df50SFrank Blaschka int ipv, int cast_type) 29684a71df50SFrank Blaschka { 29694a71df50SFrank Blaschka if (!ipv && (card->info.type == QETH_CARD_TYPE_OSAE)) 29704a71df50SFrank Blaschka return card->qdio.default_out_queue; 29714a71df50SFrank Blaschka switch (card->qdio.no_out_queues) { 29724a71df50SFrank Blaschka case 4: 29734a71df50SFrank Blaschka if (cast_type && card->info.is_multicast_different) 29744a71df50SFrank Blaschka return card->info.is_multicast_different & 29754a71df50SFrank Blaschka (card->qdio.no_out_queues - 1); 29764a71df50SFrank Blaschka if (card->qdio.do_prio_queueing && (ipv == 4)) { 29774a71df50SFrank Blaschka const u8 tos = ip_hdr(skb)->tos; 29784a71df50SFrank Blaschka 29794a71df50SFrank Blaschka if (card->qdio.do_prio_queueing == 29804a71df50SFrank Blaschka QETH_PRIO_Q_ING_TOS) { 29814a71df50SFrank Blaschka if (tos & IP_TOS_NOTIMPORTANT) 29824a71df50SFrank Blaschka return 3; 29834a71df50SFrank Blaschka if (tos & IP_TOS_HIGHRELIABILITY) 29844a71df50SFrank Blaschka return 2; 29854a71df50SFrank Blaschka if (tos & IP_TOS_HIGHTHROUGHPUT) 29864a71df50SFrank Blaschka return 1; 29874a71df50SFrank Blaschka if (tos & IP_TOS_LOWDELAY) 29884a71df50SFrank Blaschka return 0; 29894a71df50SFrank Blaschka } 29904a71df50SFrank Blaschka if (card->qdio.do_prio_queueing == 29914a71df50SFrank Blaschka QETH_PRIO_Q_ING_PREC) 29924a71df50SFrank Blaschka return 3 - (tos >> 6); 29934a71df50SFrank Blaschka } else if (card->qdio.do_prio_queueing && (ipv == 6)) { 29944a71df50SFrank Blaschka /* TODO: IPv6!!! */ 29954a71df50SFrank Blaschka } 29964a71df50SFrank Blaschka return card->qdio.default_out_queue; 29974a71df50SFrank Blaschka case 1: /* fallthrough for single-out-queue 1920-device */ 29984a71df50SFrank Blaschka default: 29994a71df50SFrank Blaschka return card->qdio.default_out_queue; 30004a71df50SFrank Blaschka } 30014a71df50SFrank Blaschka } 30024a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_get_priority_queue); 30034a71df50SFrank Blaschka 30044a71df50SFrank Blaschka int qeth_get_elements_no(struct qeth_card *card, void *hdr, 30054a71df50SFrank Blaschka struct sk_buff *skb, int elems) 30064a71df50SFrank Blaschka { 30074a71df50SFrank Blaschka int elements_needed = 0; 30084a71df50SFrank Blaschka 30094a71df50SFrank Blaschka if (skb_shinfo(skb)->nr_frags > 0) 30104a71df50SFrank Blaschka elements_needed = (skb_shinfo(skb)->nr_frags + 1); 30114a71df50SFrank Blaschka if (elements_needed == 0) 3012683d718aSFrank Blaschka elements_needed = 1 + (((((unsigned long) skb->data) % 3013683d718aSFrank Blaschka PAGE_SIZE) + skb->len) >> PAGE_SHIFT); 30144a71df50SFrank Blaschka if ((elements_needed + elems) > QETH_MAX_BUFFER_ELEMENTS(card)) { 301514cc21b6SFrank Blaschka QETH_DBF_MESSAGE(2, "Invalid size of IP packet " 30164a71df50SFrank Blaschka "(Number=%d / Length=%d). Discarded.\n", 30174a71df50SFrank Blaschka (elements_needed+elems), skb->len); 30184a71df50SFrank Blaschka return 0; 30194a71df50SFrank Blaschka } 30204a71df50SFrank Blaschka return elements_needed; 30214a71df50SFrank Blaschka } 30224a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_get_elements_no); 30234a71df50SFrank Blaschka 3024f90b744eSFrank Blaschka static inline void __qeth_fill_buffer(struct sk_buff *skb, 3025683d718aSFrank Blaschka struct qdio_buffer *buffer, int is_tso, int *next_element_to_fill, 3026683d718aSFrank Blaschka int offset) 30274a71df50SFrank Blaschka { 3028e1f03ae8SFrank Blaschka int length = skb->len; 30294a71df50SFrank Blaschka int length_here; 30304a71df50SFrank Blaschka int element; 30314a71df50SFrank Blaschka char *data; 30324a71df50SFrank Blaschka int first_lap ; 30334a71df50SFrank Blaschka 30344a71df50SFrank Blaschka element = *next_element_to_fill; 30354a71df50SFrank Blaschka data = skb->data; 30364a71df50SFrank Blaschka first_lap = (is_tso == 0 ? 1 : 0); 30374a71df50SFrank Blaschka 3038683d718aSFrank Blaschka if (offset >= 0) { 3039683d718aSFrank Blaschka data = skb->data + offset; 3040e1f03ae8SFrank Blaschka length -= offset; 3041683d718aSFrank Blaschka first_lap = 0; 3042683d718aSFrank Blaschka } 3043683d718aSFrank Blaschka 30444a71df50SFrank Blaschka while (length > 0) { 30454a71df50SFrank Blaschka /* length_here is the remaining amount of data in this page */ 30464a71df50SFrank Blaschka length_here = PAGE_SIZE - ((unsigned long) data % PAGE_SIZE); 30474a71df50SFrank Blaschka if (length < length_here) 30484a71df50SFrank Blaschka length_here = length; 30494a71df50SFrank Blaschka 30504a71df50SFrank Blaschka buffer->element[element].addr = data; 30514a71df50SFrank Blaschka buffer->element[element].length = length_here; 30524a71df50SFrank Blaschka length -= length_here; 30534a71df50SFrank Blaschka if (!length) { 30544a71df50SFrank Blaschka if (first_lap) 30554a71df50SFrank Blaschka buffer->element[element].flags = 0; 30564a71df50SFrank Blaschka else 30574a71df50SFrank Blaschka buffer->element[element].flags = 30584a71df50SFrank Blaschka SBAL_FLAGS_LAST_FRAG; 30594a71df50SFrank Blaschka } else { 30604a71df50SFrank Blaschka if (first_lap) 30614a71df50SFrank Blaschka buffer->element[element].flags = 30624a71df50SFrank Blaschka SBAL_FLAGS_FIRST_FRAG; 30634a71df50SFrank Blaschka else 30644a71df50SFrank Blaschka buffer->element[element].flags = 30654a71df50SFrank Blaschka SBAL_FLAGS_MIDDLE_FRAG; 30664a71df50SFrank Blaschka } 30674a71df50SFrank Blaschka data += length_here; 30684a71df50SFrank Blaschka element++; 30694a71df50SFrank Blaschka first_lap = 0; 30704a71df50SFrank Blaschka } 30714a71df50SFrank Blaschka *next_element_to_fill = element; 30724a71df50SFrank Blaschka } 30734a71df50SFrank Blaschka 3074f90b744eSFrank Blaschka static inline int qeth_fill_buffer(struct qeth_qdio_out_q *queue, 3075683d718aSFrank Blaschka struct qeth_qdio_out_buffer *buf, struct sk_buff *skb, 3076683d718aSFrank Blaschka struct qeth_hdr *hdr, int offset, int hd_len) 30774a71df50SFrank Blaschka { 30784a71df50SFrank Blaschka struct qdio_buffer *buffer; 30794a71df50SFrank Blaschka int flush_cnt = 0, hdr_len, large_send = 0; 30804a71df50SFrank Blaschka 30814a71df50SFrank Blaschka buffer = buf->buffer; 30824a71df50SFrank Blaschka atomic_inc(&skb->users); 30834a71df50SFrank Blaschka skb_queue_tail(&buf->skb_list, skb); 30844a71df50SFrank Blaschka 30854a71df50SFrank Blaschka /*check first on TSO ....*/ 3086683d718aSFrank Blaschka if (hdr->hdr.l3.id == QETH_HEADER_TYPE_TSO) { 30874a71df50SFrank Blaschka int element = buf->next_element_to_fill; 30884a71df50SFrank Blaschka 3089683d718aSFrank Blaschka hdr_len = sizeof(struct qeth_hdr_tso) + 3090683d718aSFrank Blaschka ((struct qeth_hdr_tso *)hdr)->ext.dg_hdr_len; 30914a71df50SFrank Blaschka /*fill first buffer entry only with header information */ 30924a71df50SFrank Blaschka buffer->element[element].addr = skb->data; 30934a71df50SFrank Blaschka buffer->element[element].length = hdr_len; 30944a71df50SFrank Blaschka buffer->element[element].flags = SBAL_FLAGS_FIRST_FRAG; 30954a71df50SFrank Blaschka buf->next_element_to_fill++; 30964a71df50SFrank Blaschka skb->data += hdr_len; 30974a71df50SFrank Blaschka skb->len -= hdr_len; 30984a71df50SFrank Blaschka large_send = 1; 30994a71df50SFrank Blaschka } 3100683d718aSFrank Blaschka 3101683d718aSFrank Blaschka if (offset >= 0) { 3102683d718aSFrank Blaschka int element = buf->next_element_to_fill; 3103683d718aSFrank Blaschka buffer->element[element].addr = hdr; 3104683d718aSFrank Blaschka buffer->element[element].length = sizeof(struct qeth_hdr) + 3105683d718aSFrank Blaschka hd_len; 3106683d718aSFrank Blaschka buffer->element[element].flags = SBAL_FLAGS_FIRST_FRAG; 3107683d718aSFrank Blaschka buf->is_header[element] = 1; 3108683d718aSFrank Blaschka buf->next_element_to_fill++; 3109683d718aSFrank Blaschka } 3110683d718aSFrank Blaschka 31114a71df50SFrank Blaschka if (skb_shinfo(skb)->nr_frags == 0) 31124a71df50SFrank Blaschka __qeth_fill_buffer(skb, buffer, large_send, 3113683d718aSFrank Blaschka (int *)&buf->next_element_to_fill, offset); 31144a71df50SFrank Blaschka else 31154a71df50SFrank Blaschka __qeth_fill_buffer_frag(skb, buffer, large_send, 31164a71df50SFrank Blaschka (int *)&buf->next_element_to_fill); 31174a71df50SFrank Blaschka 31184a71df50SFrank Blaschka if (!queue->do_pack) { 3119d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 6, "fillbfnp"); 31204a71df50SFrank Blaschka /* set state to PRIMED -> will be flushed */ 31214a71df50SFrank Blaschka atomic_set(&buf->state, QETH_QDIO_BUF_PRIMED); 31224a71df50SFrank Blaschka flush_cnt = 1; 31234a71df50SFrank Blaschka } else { 3124d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 6, "fillbfpa"); 31254a71df50SFrank Blaschka if (queue->card->options.performance_stats) 31264a71df50SFrank Blaschka queue->card->perf_stats.skbs_sent_pack++; 31274a71df50SFrank Blaschka if (buf->next_element_to_fill >= 31284a71df50SFrank Blaschka QETH_MAX_BUFFER_ELEMENTS(queue->card)) { 31294a71df50SFrank Blaschka /* 31304a71df50SFrank Blaschka * packed buffer if full -> set state PRIMED 31314a71df50SFrank Blaschka * -> will be flushed 31324a71df50SFrank Blaschka */ 31334a71df50SFrank Blaschka atomic_set(&buf->state, QETH_QDIO_BUF_PRIMED); 31344a71df50SFrank Blaschka flush_cnt = 1; 31354a71df50SFrank Blaschka } 31364a71df50SFrank Blaschka } 31374a71df50SFrank Blaschka return flush_cnt; 31384a71df50SFrank Blaschka } 31394a71df50SFrank Blaschka 31404a71df50SFrank Blaschka int qeth_do_send_packet_fast(struct qeth_card *card, 31414a71df50SFrank Blaschka struct qeth_qdio_out_q *queue, struct sk_buff *skb, 31424a71df50SFrank Blaschka struct qeth_hdr *hdr, int elements_needed, 3143683d718aSFrank Blaschka struct qeth_eddp_context *ctx, int offset, int hd_len) 31444a71df50SFrank Blaschka { 31454a71df50SFrank Blaschka struct qeth_qdio_out_buffer *buffer; 31464a71df50SFrank Blaschka int buffers_needed = 0; 31474a71df50SFrank Blaschka int flush_cnt = 0; 31484a71df50SFrank Blaschka int index; 31494a71df50SFrank Blaschka 31504a71df50SFrank Blaschka /* spin until we get the queue ... */ 31514a71df50SFrank Blaschka while (atomic_cmpxchg(&queue->state, QETH_OUT_Q_UNLOCKED, 31524a71df50SFrank Blaschka QETH_OUT_Q_LOCKED) != QETH_OUT_Q_UNLOCKED); 31534a71df50SFrank Blaschka /* ... now we've got the queue */ 31544a71df50SFrank Blaschka index = queue->next_buf_to_fill; 31554a71df50SFrank Blaschka buffer = &queue->bufs[queue->next_buf_to_fill]; 31564a71df50SFrank Blaschka /* 31574a71df50SFrank Blaschka * check if buffer is empty to make sure that we do not 'overtake' 31584a71df50SFrank Blaschka * ourselves and try to fill a buffer that is already primed 31594a71df50SFrank Blaschka */ 31604a71df50SFrank Blaschka if (atomic_read(&buffer->state) != QETH_QDIO_BUF_EMPTY) 31614a71df50SFrank Blaschka goto out; 31624a71df50SFrank Blaschka if (ctx == NULL) 31634a71df50SFrank Blaschka queue->next_buf_to_fill = (queue->next_buf_to_fill + 1) % 31644a71df50SFrank Blaschka QDIO_MAX_BUFFERS_PER_Q; 31654a71df50SFrank Blaschka else { 31664a71df50SFrank Blaschka buffers_needed = qeth_eddp_check_buffers_for_context(queue, 31674a71df50SFrank Blaschka ctx); 31684a71df50SFrank Blaschka if (buffers_needed < 0) 31694a71df50SFrank Blaschka goto out; 31704a71df50SFrank Blaschka queue->next_buf_to_fill = 31714a71df50SFrank Blaschka (queue->next_buf_to_fill + buffers_needed) % 31724a71df50SFrank Blaschka QDIO_MAX_BUFFERS_PER_Q; 31734a71df50SFrank Blaschka } 31744a71df50SFrank Blaschka atomic_set(&queue->state, QETH_OUT_Q_UNLOCKED); 31754a71df50SFrank Blaschka if (ctx == NULL) { 3176683d718aSFrank Blaschka qeth_fill_buffer(queue, buffer, skb, hdr, offset, hd_len); 3177779e6e1cSJan Glauber qeth_flush_buffers(queue, index, 1); 31784a71df50SFrank Blaschka } else { 31794a71df50SFrank Blaschka flush_cnt = qeth_eddp_fill_buffer(queue, ctx, index); 31804a71df50SFrank Blaschka WARN_ON(buffers_needed != flush_cnt); 3181779e6e1cSJan Glauber qeth_flush_buffers(queue, index, flush_cnt); 31824a71df50SFrank Blaschka } 31834a71df50SFrank Blaschka return 0; 31844a71df50SFrank Blaschka out: 31854a71df50SFrank Blaschka atomic_set(&queue->state, QETH_OUT_Q_UNLOCKED); 31864a71df50SFrank Blaschka return -EBUSY; 31874a71df50SFrank Blaschka } 31884a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_do_send_packet_fast); 31894a71df50SFrank Blaschka 31904a71df50SFrank Blaschka int qeth_do_send_packet(struct qeth_card *card, struct qeth_qdio_out_q *queue, 31914a71df50SFrank Blaschka struct sk_buff *skb, struct qeth_hdr *hdr, 31924a71df50SFrank Blaschka int elements_needed, struct qeth_eddp_context *ctx) 31934a71df50SFrank Blaschka { 31944a71df50SFrank Blaschka struct qeth_qdio_out_buffer *buffer; 31954a71df50SFrank Blaschka int start_index; 31964a71df50SFrank Blaschka int flush_count = 0; 31974a71df50SFrank Blaschka int do_pack = 0; 31984a71df50SFrank Blaschka int tmp; 31994a71df50SFrank Blaschka int rc = 0; 32004a71df50SFrank Blaschka 32014a71df50SFrank Blaschka /* spin until we get the queue ... */ 32024a71df50SFrank Blaschka while (atomic_cmpxchg(&queue->state, QETH_OUT_Q_UNLOCKED, 32034a71df50SFrank Blaschka QETH_OUT_Q_LOCKED) != QETH_OUT_Q_UNLOCKED); 32044a71df50SFrank Blaschka start_index = queue->next_buf_to_fill; 32054a71df50SFrank Blaschka buffer = &queue->bufs[queue->next_buf_to_fill]; 32064a71df50SFrank Blaschka /* 32074a71df50SFrank Blaschka * check if buffer is empty to make sure that we do not 'overtake' 32084a71df50SFrank Blaschka * ourselves and try to fill a buffer that is already primed 32094a71df50SFrank Blaschka */ 32104a71df50SFrank Blaschka if (atomic_read(&buffer->state) != QETH_QDIO_BUF_EMPTY) { 32114a71df50SFrank Blaschka atomic_set(&queue->state, QETH_OUT_Q_UNLOCKED); 32124a71df50SFrank Blaschka return -EBUSY; 32134a71df50SFrank Blaschka } 32144a71df50SFrank Blaschka /* check if we need to switch packing state of this queue */ 32154a71df50SFrank Blaschka qeth_switch_to_packing_if_needed(queue); 32164a71df50SFrank Blaschka if (queue->do_pack) { 32174a71df50SFrank Blaschka do_pack = 1; 32184a71df50SFrank Blaschka if (ctx == NULL) { 32194a71df50SFrank Blaschka /* does packet fit in current buffer? */ 32204a71df50SFrank Blaschka if ((QETH_MAX_BUFFER_ELEMENTS(card) - 32214a71df50SFrank Blaschka buffer->next_element_to_fill) < elements_needed) { 32224a71df50SFrank Blaschka /* ... no -> set state PRIMED */ 32234a71df50SFrank Blaschka atomic_set(&buffer->state, 32244a71df50SFrank Blaschka QETH_QDIO_BUF_PRIMED); 32254a71df50SFrank Blaschka flush_count++; 32264a71df50SFrank Blaschka queue->next_buf_to_fill = 32274a71df50SFrank Blaschka (queue->next_buf_to_fill + 1) % 32284a71df50SFrank Blaschka QDIO_MAX_BUFFERS_PER_Q; 32294a71df50SFrank Blaschka buffer = &queue->bufs[queue->next_buf_to_fill]; 32304a71df50SFrank Blaschka /* we did a step forward, so check buffer state 32314a71df50SFrank Blaschka * again */ 32324a71df50SFrank Blaschka if (atomic_read(&buffer->state) != 32334a71df50SFrank Blaschka QETH_QDIO_BUF_EMPTY){ 3234779e6e1cSJan Glauber qeth_flush_buffers(queue, start_index, 3235779e6e1cSJan Glauber flush_count); 32364a71df50SFrank Blaschka atomic_set(&queue->state, 32374a71df50SFrank Blaschka QETH_OUT_Q_UNLOCKED); 32384a71df50SFrank Blaschka return -EBUSY; 32394a71df50SFrank Blaschka } 32404a71df50SFrank Blaschka } 32414a71df50SFrank Blaschka } else { 32424a71df50SFrank Blaschka /* check if we have enough elements (including following 32434a71df50SFrank Blaschka * free buffers) to handle eddp context */ 32444a71df50SFrank Blaschka if (qeth_eddp_check_buffers_for_context(queue, ctx) 32454a71df50SFrank Blaschka < 0) { 32464a71df50SFrank Blaschka rc = -EBUSY; 32474a71df50SFrank Blaschka goto out; 32484a71df50SFrank Blaschka } 32494a71df50SFrank Blaschka } 32504a71df50SFrank Blaschka } 32514a71df50SFrank Blaschka if (ctx == NULL) 3252683d718aSFrank Blaschka tmp = qeth_fill_buffer(queue, buffer, skb, hdr, -1, 0); 32534a71df50SFrank Blaschka else { 32544a71df50SFrank Blaschka tmp = qeth_eddp_fill_buffer(queue, ctx, 32554a71df50SFrank Blaschka queue->next_buf_to_fill); 32564a71df50SFrank Blaschka if (tmp < 0) { 32574a71df50SFrank Blaschka rc = -EBUSY; 32584a71df50SFrank Blaschka goto out; 32594a71df50SFrank Blaschka } 32604a71df50SFrank Blaschka } 32614a71df50SFrank Blaschka queue->next_buf_to_fill = (queue->next_buf_to_fill + tmp) % 32624a71df50SFrank Blaschka QDIO_MAX_BUFFERS_PER_Q; 32634a71df50SFrank Blaschka flush_count += tmp; 32644a71df50SFrank Blaschka out: 32654a71df50SFrank Blaschka if (flush_count) 3266779e6e1cSJan Glauber qeth_flush_buffers(queue, start_index, flush_count); 32674a71df50SFrank Blaschka else if (!atomic_read(&queue->set_pci_flags_count)) 32684a71df50SFrank Blaschka atomic_xchg(&queue->state, QETH_OUT_Q_LOCKED_FLUSH); 32694a71df50SFrank Blaschka /* 32704a71df50SFrank Blaschka * queue->state will go from LOCKED -> UNLOCKED or from 32714a71df50SFrank Blaschka * LOCKED_FLUSH -> LOCKED if output_handler wanted to 'notify' us 32724a71df50SFrank Blaschka * (switch packing state or flush buffer to get another pci flag out). 32734a71df50SFrank Blaschka * In that case we will enter this loop 32744a71df50SFrank Blaschka */ 32754a71df50SFrank Blaschka while (atomic_dec_return(&queue->state)) { 32764a71df50SFrank Blaschka flush_count = 0; 32774a71df50SFrank Blaschka start_index = queue->next_buf_to_fill; 32784a71df50SFrank Blaschka /* check if we can go back to non-packing state */ 32794a71df50SFrank Blaschka flush_count += qeth_switch_to_nonpacking_if_needed(queue); 32804a71df50SFrank Blaschka /* 32814a71df50SFrank Blaschka * check if we need to flush a packing buffer to get a pci 32824a71df50SFrank Blaschka * flag out on the queue 32834a71df50SFrank Blaschka */ 32844a71df50SFrank Blaschka if (!flush_count && !atomic_read(&queue->set_pci_flags_count)) 32854a71df50SFrank Blaschka flush_count += qeth_flush_buffers_on_no_pci(queue); 32864a71df50SFrank Blaschka if (flush_count) 3287779e6e1cSJan Glauber qeth_flush_buffers(queue, start_index, flush_count); 32884a71df50SFrank Blaschka } 32894a71df50SFrank Blaschka /* at this point the queue is UNLOCKED again */ 32904a71df50SFrank Blaschka if (queue->card->options.performance_stats && do_pack) 32914a71df50SFrank Blaschka queue->card->perf_stats.bufs_sent_pack += flush_count; 32924a71df50SFrank Blaschka 32934a71df50SFrank Blaschka return rc; 32944a71df50SFrank Blaschka } 32954a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_do_send_packet); 32964a71df50SFrank Blaschka 32974a71df50SFrank Blaschka static int qeth_setadp_promisc_mode_cb(struct qeth_card *card, 32984a71df50SFrank Blaschka struct qeth_reply *reply, unsigned long data) 32994a71df50SFrank Blaschka { 33004a71df50SFrank Blaschka struct qeth_ipa_cmd *cmd; 33014a71df50SFrank Blaschka struct qeth_ipacmd_setadpparms *setparms; 33024a71df50SFrank Blaschka 3303d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 4, "prmadpcb"); 33044a71df50SFrank Blaschka 33054a71df50SFrank Blaschka cmd = (struct qeth_ipa_cmd *) data; 33064a71df50SFrank Blaschka setparms = &(cmd->data.setadapterparms); 33074a71df50SFrank Blaschka 33084a71df50SFrank Blaschka qeth_default_setadapterparms_cb(card, reply, (unsigned long)cmd); 33094a71df50SFrank Blaschka if (cmd->hdr.return_code) { 3310d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(TRACE, 4, "prmrc%2.2x", cmd->hdr.return_code); 33114a71df50SFrank Blaschka setparms->data.mode = SET_PROMISC_MODE_OFF; 33124a71df50SFrank Blaschka } 33134a71df50SFrank Blaschka card->info.promisc_mode = setparms->data.mode; 33144a71df50SFrank Blaschka return 0; 33154a71df50SFrank Blaschka } 33164a71df50SFrank Blaschka 33174a71df50SFrank Blaschka void qeth_setadp_promisc_mode(struct qeth_card *card) 33184a71df50SFrank Blaschka { 33194a71df50SFrank Blaschka enum qeth_ipa_promisc_modes mode; 33204a71df50SFrank Blaschka struct net_device *dev = card->dev; 33214a71df50SFrank Blaschka struct qeth_cmd_buffer *iob; 33224a71df50SFrank Blaschka struct qeth_ipa_cmd *cmd; 33234a71df50SFrank Blaschka 3324d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 4, "setprom"); 33254a71df50SFrank Blaschka 33264a71df50SFrank Blaschka if (((dev->flags & IFF_PROMISC) && 33274a71df50SFrank Blaschka (card->info.promisc_mode == SET_PROMISC_MODE_ON)) || 33284a71df50SFrank Blaschka (!(dev->flags & IFF_PROMISC) && 33294a71df50SFrank Blaschka (card->info.promisc_mode == SET_PROMISC_MODE_OFF))) 33304a71df50SFrank Blaschka return; 33314a71df50SFrank Blaschka mode = SET_PROMISC_MODE_OFF; 33324a71df50SFrank Blaschka if (dev->flags & IFF_PROMISC) 33334a71df50SFrank Blaschka mode = SET_PROMISC_MODE_ON; 3334d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(TRACE, 4, "mode:%x", mode); 33354a71df50SFrank Blaschka 33364a71df50SFrank Blaschka iob = qeth_get_adapter_cmd(card, IPA_SETADP_SET_PROMISC_MODE, 33374a71df50SFrank Blaschka sizeof(struct qeth_ipacmd_setadpparms)); 33384a71df50SFrank Blaschka cmd = (struct qeth_ipa_cmd *)(iob->data + IPA_PDU_HEADER_SIZE); 33394a71df50SFrank Blaschka cmd->data.setadapterparms.data.mode = mode; 33404a71df50SFrank Blaschka qeth_send_ipa_cmd(card, iob, qeth_setadp_promisc_mode_cb, NULL); 33414a71df50SFrank Blaschka } 33424a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_setadp_promisc_mode); 33434a71df50SFrank Blaschka 33444a71df50SFrank Blaschka int qeth_change_mtu(struct net_device *dev, int new_mtu) 33454a71df50SFrank Blaschka { 33464a71df50SFrank Blaschka struct qeth_card *card; 33474a71df50SFrank Blaschka char dbf_text[15]; 33484a71df50SFrank Blaschka 3349509e2562SHeiko Carstens card = dev->ml_priv; 33504a71df50SFrank Blaschka 3351d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 4, "chgmtu"); 33524a71df50SFrank Blaschka sprintf(dbf_text, "%8x", new_mtu); 3353d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 4, dbf_text); 33544a71df50SFrank Blaschka 33554a71df50SFrank Blaschka if (new_mtu < 64) 33564a71df50SFrank Blaschka return -EINVAL; 33574a71df50SFrank Blaschka if (new_mtu > 65535) 33584a71df50SFrank Blaschka return -EINVAL; 33594a71df50SFrank Blaschka if ((!qeth_is_supported(card, IPA_IP_FRAGMENTATION)) && 33604a71df50SFrank Blaschka (!qeth_mtu_is_valid(card, new_mtu))) 33614a71df50SFrank Blaschka return -EINVAL; 33624a71df50SFrank Blaschka dev->mtu = new_mtu; 33634a71df50SFrank Blaschka return 0; 33644a71df50SFrank Blaschka } 33654a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_change_mtu); 33664a71df50SFrank Blaschka 33674a71df50SFrank Blaschka struct net_device_stats *qeth_get_stats(struct net_device *dev) 33684a71df50SFrank Blaschka { 33694a71df50SFrank Blaschka struct qeth_card *card; 33704a71df50SFrank Blaschka 3371509e2562SHeiko Carstens card = dev->ml_priv; 33724a71df50SFrank Blaschka 3373d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 5, "getstat"); 33744a71df50SFrank Blaschka 33754a71df50SFrank Blaschka return &card->stats; 33764a71df50SFrank Blaschka } 33774a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_get_stats); 33784a71df50SFrank Blaschka 33794a71df50SFrank Blaschka static int qeth_setadpparms_change_macaddr_cb(struct qeth_card *card, 33804a71df50SFrank Blaschka struct qeth_reply *reply, unsigned long data) 33814a71df50SFrank Blaschka { 33824a71df50SFrank Blaschka struct qeth_ipa_cmd *cmd; 33834a71df50SFrank Blaschka 3384d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 4, "chgmaccb"); 33854a71df50SFrank Blaschka 33864a71df50SFrank Blaschka cmd = (struct qeth_ipa_cmd *) data; 33874a71df50SFrank Blaschka if (!card->options.layer2 || 33884a71df50SFrank Blaschka !(card->info.mac_bits & QETH_LAYER2_MAC_READ)) { 33894a71df50SFrank Blaschka memcpy(card->dev->dev_addr, 33904a71df50SFrank Blaschka &cmd->data.setadapterparms.data.change_addr.addr, 33914a71df50SFrank Blaschka OSA_ADDR_LEN); 33924a71df50SFrank Blaschka card->info.mac_bits |= QETH_LAYER2_MAC_READ; 33934a71df50SFrank Blaschka } 33944a71df50SFrank Blaschka qeth_default_setadapterparms_cb(card, reply, (unsigned long) cmd); 33954a71df50SFrank Blaschka return 0; 33964a71df50SFrank Blaschka } 33974a71df50SFrank Blaschka 33984a71df50SFrank Blaschka int qeth_setadpparms_change_macaddr(struct qeth_card *card) 33994a71df50SFrank Blaschka { 34004a71df50SFrank Blaschka int rc; 34014a71df50SFrank Blaschka struct qeth_cmd_buffer *iob; 34024a71df50SFrank Blaschka struct qeth_ipa_cmd *cmd; 34034a71df50SFrank Blaschka 3404d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 4, "chgmac"); 34054a71df50SFrank Blaschka 34064a71df50SFrank Blaschka iob = qeth_get_adapter_cmd(card, IPA_SETADP_ALTER_MAC_ADDRESS, 34074a71df50SFrank Blaschka sizeof(struct qeth_ipacmd_setadpparms)); 34084a71df50SFrank Blaschka cmd = (struct qeth_ipa_cmd *)(iob->data+IPA_PDU_HEADER_SIZE); 34094a71df50SFrank Blaschka cmd->data.setadapterparms.data.change_addr.cmd = CHANGE_ADDR_READ_MAC; 34104a71df50SFrank Blaschka cmd->data.setadapterparms.data.change_addr.addr_size = OSA_ADDR_LEN; 34114a71df50SFrank Blaschka memcpy(&cmd->data.setadapterparms.data.change_addr.addr, 34124a71df50SFrank Blaschka card->dev->dev_addr, OSA_ADDR_LEN); 34134a71df50SFrank Blaschka rc = qeth_send_ipa_cmd(card, iob, qeth_setadpparms_change_macaddr_cb, 34144a71df50SFrank Blaschka NULL); 34154a71df50SFrank Blaschka return rc; 34164a71df50SFrank Blaschka } 34174a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_setadpparms_change_macaddr); 34184a71df50SFrank Blaschka 34194a71df50SFrank Blaschka void qeth_tx_timeout(struct net_device *dev) 34204a71df50SFrank Blaschka { 34214a71df50SFrank Blaschka struct qeth_card *card; 34224a71df50SFrank Blaschka 3423509e2562SHeiko Carstens card = dev->ml_priv; 34244a71df50SFrank Blaschka card->stats.tx_errors++; 34254a71df50SFrank Blaschka qeth_schedule_recovery(card); 34264a71df50SFrank Blaschka } 34274a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_tx_timeout); 34284a71df50SFrank Blaschka 34294a71df50SFrank Blaschka int qeth_mdio_read(struct net_device *dev, int phy_id, int regnum) 34304a71df50SFrank Blaschka { 3431509e2562SHeiko Carstens struct qeth_card *card = dev->ml_priv; 34324a71df50SFrank Blaschka int rc = 0; 34334a71df50SFrank Blaschka 34344a71df50SFrank Blaschka switch (regnum) { 34354a71df50SFrank Blaschka case MII_BMCR: /* Basic mode control register */ 34364a71df50SFrank Blaschka rc = BMCR_FULLDPLX; 34374a71df50SFrank Blaschka if ((card->info.link_type != QETH_LINK_TYPE_GBIT_ETH) && 34384a71df50SFrank Blaschka (card->info.link_type != QETH_LINK_TYPE_OSN) && 34394a71df50SFrank Blaschka (card->info.link_type != QETH_LINK_TYPE_10GBIT_ETH)) 34404a71df50SFrank Blaschka rc |= BMCR_SPEED100; 34414a71df50SFrank Blaschka break; 34424a71df50SFrank Blaschka case MII_BMSR: /* Basic mode status register */ 34434a71df50SFrank Blaschka rc = BMSR_ERCAP | BMSR_ANEGCOMPLETE | BMSR_LSTATUS | 34444a71df50SFrank Blaschka BMSR_10HALF | BMSR_10FULL | BMSR_100HALF | BMSR_100FULL | 34454a71df50SFrank Blaschka BMSR_100BASE4; 34464a71df50SFrank Blaschka break; 34474a71df50SFrank Blaschka case MII_PHYSID1: /* PHYS ID 1 */ 34484a71df50SFrank Blaschka rc = (dev->dev_addr[0] << 16) | (dev->dev_addr[1] << 8) | 34494a71df50SFrank Blaschka dev->dev_addr[2]; 34504a71df50SFrank Blaschka rc = (rc >> 5) & 0xFFFF; 34514a71df50SFrank Blaschka break; 34524a71df50SFrank Blaschka case MII_PHYSID2: /* PHYS ID 2 */ 34534a71df50SFrank Blaschka rc = (dev->dev_addr[2] << 10) & 0xFFFF; 34544a71df50SFrank Blaschka break; 34554a71df50SFrank Blaschka case MII_ADVERTISE: /* Advertisement control reg */ 34564a71df50SFrank Blaschka rc = ADVERTISE_ALL; 34574a71df50SFrank Blaschka break; 34584a71df50SFrank Blaschka case MII_LPA: /* Link partner ability reg */ 34594a71df50SFrank Blaschka rc = LPA_10HALF | LPA_10FULL | LPA_100HALF | LPA_100FULL | 34604a71df50SFrank Blaschka LPA_100BASE4 | LPA_LPACK; 34614a71df50SFrank Blaschka break; 34624a71df50SFrank Blaschka case MII_EXPANSION: /* Expansion register */ 34634a71df50SFrank Blaschka break; 34644a71df50SFrank Blaschka case MII_DCOUNTER: /* disconnect counter */ 34654a71df50SFrank Blaschka break; 34664a71df50SFrank Blaschka case MII_FCSCOUNTER: /* false carrier counter */ 34674a71df50SFrank Blaschka break; 34684a71df50SFrank Blaschka case MII_NWAYTEST: /* N-way auto-neg test register */ 34694a71df50SFrank Blaschka break; 34704a71df50SFrank Blaschka case MII_RERRCOUNTER: /* rx error counter */ 34714a71df50SFrank Blaschka rc = card->stats.rx_errors; 34724a71df50SFrank Blaschka break; 34734a71df50SFrank Blaschka case MII_SREVISION: /* silicon revision */ 34744a71df50SFrank Blaschka break; 34754a71df50SFrank Blaschka case MII_RESV1: /* reserved 1 */ 34764a71df50SFrank Blaschka break; 34774a71df50SFrank Blaschka case MII_LBRERROR: /* loopback, rx, bypass error */ 34784a71df50SFrank Blaschka break; 34794a71df50SFrank Blaschka case MII_PHYADDR: /* physical address */ 34804a71df50SFrank Blaschka break; 34814a71df50SFrank Blaschka case MII_RESV2: /* reserved 2 */ 34824a71df50SFrank Blaschka break; 34834a71df50SFrank Blaschka case MII_TPISTATUS: /* TPI status for 10mbps */ 34844a71df50SFrank Blaschka break; 34854a71df50SFrank Blaschka case MII_NCONFIG: /* network interface config */ 34864a71df50SFrank Blaschka break; 34874a71df50SFrank Blaschka default: 34884a71df50SFrank Blaschka break; 34894a71df50SFrank Blaschka } 34904a71df50SFrank Blaschka return rc; 34914a71df50SFrank Blaschka } 34924a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_mdio_read); 34934a71df50SFrank Blaschka 34944a71df50SFrank Blaschka static int qeth_send_ipa_snmp_cmd(struct qeth_card *card, 34954a71df50SFrank Blaschka struct qeth_cmd_buffer *iob, int len, 34964a71df50SFrank Blaschka int (*reply_cb)(struct qeth_card *, struct qeth_reply *, 34974a71df50SFrank Blaschka unsigned long), 34984a71df50SFrank Blaschka void *reply_param) 34994a71df50SFrank Blaschka { 35004a71df50SFrank Blaschka u16 s1, s2; 35014a71df50SFrank Blaschka 3502d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 4, "sendsnmp"); 35034a71df50SFrank Blaschka 35044a71df50SFrank Blaschka memcpy(iob->data, IPA_PDU_HEADER, IPA_PDU_HEADER_SIZE); 35054a71df50SFrank Blaschka memcpy(QETH_IPA_CMD_DEST_ADDR(iob->data), 35064a71df50SFrank Blaschka &card->token.ulp_connection_r, QETH_MPC_TOKEN_LENGTH); 35074a71df50SFrank Blaschka /* adjust PDU length fields in IPA_PDU_HEADER */ 35084a71df50SFrank Blaschka s1 = (u32) IPA_PDU_HEADER_SIZE + len; 35094a71df50SFrank Blaschka s2 = (u32) len; 35104a71df50SFrank Blaschka memcpy(QETH_IPA_PDU_LEN_TOTAL(iob->data), &s1, 2); 35114a71df50SFrank Blaschka memcpy(QETH_IPA_PDU_LEN_PDU1(iob->data), &s2, 2); 35124a71df50SFrank Blaschka memcpy(QETH_IPA_PDU_LEN_PDU2(iob->data), &s2, 2); 35134a71df50SFrank Blaschka memcpy(QETH_IPA_PDU_LEN_PDU3(iob->data), &s2, 2); 35144a71df50SFrank Blaschka return qeth_send_control_data(card, IPA_PDU_HEADER_SIZE + len, iob, 35154a71df50SFrank Blaschka reply_cb, reply_param); 35164a71df50SFrank Blaschka } 35174a71df50SFrank Blaschka 35184a71df50SFrank Blaschka static int qeth_snmp_command_cb(struct qeth_card *card, 35194a71df50SFrank Blaschka struct qeth_reply *reply, unsigned long sdata) 35204a71df50SFrank Blaschka { 35214a71df50SFrank Blaschka struct qeth_ipa_cmd *cmd; 35224a71df50SFrank Blaschka struct qeth_arp_query_info *qinfo; 35234a71df50SFrank Blaschka struct qeth_snmp_cmd *snmp; 35244a71df50SFrank Blaschka unsigned char *data; 35254a71df50SFrank Blaschka __u16 data_len; 35264a71df50SFrank Blaschka 3527d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 3, "snpcmdcb"); 35284a71df50SFrank Blaschka 35294a71df50SFrank Blaschka cmd = (struct qeth_ipa_cmd *) sdata; 35304a71df50SFrank Blaschka data = (unsigned char *)((char *)cmd - reply->offset); 35314a71df50SFrank Blaschka qinfo = (struct qeth_arp_query_info *) reply->param; 35324a71df50SFrank Blaschka snmp = &cmd->data.setadapterparms.data.snmp; 35334a71df50SFrank Blaschka 35344a71df50SFrank Blaschka if (cmd->hdr.return_code) { 3535d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(TRACE, 4, "scer1%i", cmd->hdr.return_code); 35364a71df50SFrank Blaschka return 0; 35374a71df50SFrank Blaschka } 35384a71df50SFrank Blaschka if (cmd->data.setadapterparms.hdr.return_code) { 35394a71df50SFrank Blaschka cmd->hdr.return_code = 35404a71df50SFrank Blaschka cmd->data.setadapterparms.hdr.return_code; 3541d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(TRACE, 4, "scer2%i", cmd->hdr.return_code); 35424a71df50SFrank Blaschka return 0; 35434a71df50SFrank Blaschka } 35444a71df50SFrank Blaschka data_len = *((__u16 *)QETH_IPA_PDU_LEN_PDU1(data)); 35454a71df50SFrank Blaschka if (cmd->data.setadapterparms.hdr.seq_no == 1) 35464a71df50SFrank Blaschka data_len -= (__u16)((char *)&snmp->data - (char *)cmd); 35474a71df50SFrank Blaschka else 35484a71df50SFrank Blaschka data_len -= (__u16)((char *)&snmp->request - (char *)cmd); 35494a71df50SFrank Blaschka 35504a71df50SFrank Blaschka /* check if there is enough room in userspace */ 35514a71df50SFrank Blaschka if ((qinfo->udata_len - qinfo->udata_offset) < data_len) { 3552d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(TRACE, 4, "scer3%i", -ENOMEM); 35534a71df50SFrank Blaschka cmd->hdr.return_code = -ENOMEM; 35544a71df50SFrank Blaschka return 0; 35554a71df50SFrank Blaschka } 3556d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(TRACE, 4, "snore%i", 35574a71df50SFrank Blaschka cmd->data.setadapterparms.hdr.used_total); 3558d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(TRACE, 4, "sseqn%i", 35594a71df50SFrank Blaschka cmd->data.setadapterparms.hdr.seq_no); 35604a71df50SFrank Blaschka /*copy entries to user buffer*/ 35614a71df50SFrank Blaschka if (cmd->data.setadapterparms.hdr.seq_no == 1) { 35624a71df50SFrank Blaschka memcpy(qinfo->udata + qinfo->udata_offset, 35634a71df50SFrank Blaschka (char *)snmp, 35644a71df50SFrank Blaschka data_len + offsetof(struct qeth_snmp_cmd, data)); 35654a71df50SFrank Blaschka qinfo->udata_offset += offsetof(struct qeth_snmp_cmd, data); 35664a71df50SFrank Blaschka } else { 35674a71df50SFrank Blaschka memcpy(qinfo->udata + qinfo->udata_offset, 35684a71df50SFrank Blaschka (char *)&snmp->request, data_len); 35694a71df50SFrank Blaschka } 35704a71df50SFrank Blaschka qinfo->udata_offset += data_len; 35714a71df50SFrank Blaschka /* check if all replies received ... */ 3572d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(TRACE, 4, "srtot%i", 35734a71df50SFrank Blaschka cmd->data.setadapterparms.hdr.used_total); 3574d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(TRACE, 4, "srseq%i", 35754a71df50SFrank Blaschka cmd->data.setadapterparms.hdr.seq_no); 35764a71df50SFrank Blaschka if (cmd->data.setadapterparms.hdr.seq_no < 35774a71df50SFrank Blaschka cmd->data.setadapterparms.hdr.used_total) 35784a71df50SFrank Blaschka return 1; 35794a71df50SFrank Blaschka return 0; 35804a71df50SFrank Blaschka } 35814a71df50SFrank Blaschka 35824a71df50SFrank Blaschka int qeth_snmp_command(struct qeth_card *card, char __user *udata) 35834a71df50SFrank Blaschka { 35844a71df50SFrank Blaschka struct qeth_cmd_buffer *iob; 35854a71df50SFrank Blaschka struct qeth_ipa_cmd *cmd; 35864a71df50SFrank Blaschka struct qeth_snmp_ureq *ureq; 35874a71df50SFrank Blaschka int req_len; 35884a71df50SFrank Blaschka struct qeth_arp_query_info qinfo = {0, }; 35894a71df50SFrank Blaschka int rc = 0; 35904a71df50SFrank Blaschka 3591d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 3, "snmpcmd"); 35924a71df50SFrank Blaschka 35934a71df50SFrank Blaschka if (card->info.guestlan) 35944a71df50SFrank Blaschka return -EOPNOTSUPP; 35954a71df50SFrank Blaschka 35964a71df50SFrank Blaschka if ((!qeth_adp_supported(card, IPA_SETADP_SET_SNMP_CONTROL)) && 35974a71df50SFrank Blaschka (!card->options.layer2)) { 35984a71df50SFrank Blaschka return -EOPNOTSUPP; 35994a71df50SFrank Blaschka } 36004a71df50SFrank Blaschka /* skip 4 bytes (data_len struct member) to get req_len */ 36014a71df50SFrank Blaschka if (copy_from_user(&req_len, udata + sizeof(int), sizeof(int))) 36024a71df50SFrank Blaschka return -EFAULT; 36034a71df50SFrank Blaschka ureq = kmalloc(req_len+sizeof(struct qeth_snmp_ureq_hdr), GFP_KERNEL); 36044a71df50SFrank Blaschka if (!ureq) { 3605d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 2, "snmpnome"); 36064a71df50SFrank Blaschka return -ENOMEM; 36074a71df50SFrank Blaschka } 36084a71df50SFrank Blaschka if (copy_from_user(ureq, udata, 36094a71df50SFrank Blaschka req_len + sizeof(struct qeth_snmp_ureq_hdr))) { 36104a71df50SFrank Blaschka kfree(ureq); 36114a71df50SFrank Blaschka return -EFAULT; 36124a71df50SFrank Blaschka } 36134a71df50SFrank Blaschka qinfo.udata_len = ureq->hdr.data_len; 36144a71df50SFrank Blaschka qinfo.udata = kzalloc(qinfo.udata_len, GFP_KERNEL); 36154a71df50SFrank Blaschka if (!qinfo.udata) { 36164a71df50SFrank Blaschka kfree(ureq); 36174a71df50SFrank Blaschka return -ENOMEM; 36184a71df50SFrank Blaschka } 36194a71df50SFrank Blaschka qinfo.udata_offset = sizeof(struct qeth_snmp_ureq_hdr); 36204a71df50SFrank Blaschka 36214a71df50SFrank Blaschka iob = qeth_get_adapter_cmd(card, IPA_SETADP_SET_SNMP_CONTROL, 36224a71df50SFrank Blaschka QETH_SNMP_SETADP_CMDLENGTH + req_len); 36234a71df50SFrank Blaschka cmd = (struct qeth_ipa_cmd *)(iob->data+IPA_PDU_HEADER_SIZE); 36244a71df50SFrank Blaschka memcpy(&cmd->data.setadapterparms.data.snmp, &ureq->cmd, req_len); 36254a71df50SFrank Blaschka rc = qeth_send_ipa_snmp_cmd(card, iob, QETH_SETADP_BASE_LEN + req_len, 36264a71df50SFrank Blaschka qeth_snmp_command_cb, (void *)&qinfo); 36274a71df50SFrank Blaschka if (rc) 362814cc21b6SFrank Blaschka QETH_DBF_MESSAGE(2, "SNMP command failed on %s: (0x%x)\n", 36294a71df50SFrank Blaschka QETH_CARD_IFNAME(card), rc); 36304a71df50SFrank Blaschka else { 36314a71df50SFrank Blaschka if (copy_to_user(udata, qinfo.udata, qinfo.udata_len)) 36324a71df50SFrank Blaschka rc = -EFAULT; 36334a71df50SFrank Blaschka } 36344a71df50SFrank Blaschka 36354a71df50SFrank Blaschka kfree(ureq); 36364a71df50SFrank Blaschka kfree(qinfo.udata); 36374a71df50SFrank Blaschka return rc; 36384a71df50SFrank Blaschka } 36394a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_snmp_command); 36404a71df50SFrank Blaschka 36414a71df50SFrank Blaschka static inline int qeth_get_qdio_q_format(struct qeth_card *card) 36424a71df50SFrank Blaschka { 36434a71df50SFrank Blaschka switch (card->info.type) { 36444a71df50SFrank Blaschka case QETH_CARD_TYPE_IQD: 36454a71df50SFrank Blaschka return 2; 36464a71df50SFrank Blaschka default: 36474a71df50SFrank Blaschka return 0; 36484a71df50SFrank Blaschka } 36494a71df50SFrank Blaschka } 36504a71df50SFrank Blaschka 36514a71df50SFrank Blaschka static int qeth_qdio_establish(struct qeth_card *card) 36524a71df50SFrank Blaschka { 36534a71df50SFrank Blaschka struct qdio_initialize init_data; 36544a71df50SFrank Blaschka char *qib_param_field; 36554a71df50SFrank Blaschka struct qdio_buffer **in_sbal_ptrs; 36564a71df50SFrank Blaschka struct qdio_buffer **out_sbal_ptrs; 36574a71df50SFrank Blaschka int i, j, k; 36584a71df50SFrank Blaschka int rc = 0; 36594a71df50SFrank Blaschka 3660d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "qdioest"); 36614a71df50SFrank Blaschka 36624a71df50SFrank Blaschka qib_param_field = kzalloc(QDIO_MAX_BUFFERS_PER_Q * sizeof(char), 36634a71df50SFrank Blaschka GFP_KERNEL); 36644a71df50SFrank Blaschka if (!qib_param_field) 36654a71df50SFrank Blaschka return -ENOMEM; 36664a71df50SFrank Blaschka 36674a71df50SFrank Blaschka qeth_create_qib_param_field(card, qib_param_field); 36684a71df50SFrank Blaschka qeth_create_qib_param_field_blkt(card, qib_param_field); 36694a71df50SFrank Blaschka 36704a71df50SFrank Blaschka in_sbal_ptrs = kmalloc(QDIO_MAX_BUFFERS_PER_Q * sizeof(void *), 36714a71df50SFrank Blaschka GFP_KERNEL); 36724a71df50SFrank Blaschka if (!in_sbal_ptrs) { 36734a71df50SFrank Blaschka kfree(qib_param_field); 36744a71df50SFrank Blaschka return -ENOMEM; 36754a71df50SFrank Blaschka } 36764a71df50SFrank Blaschka for (i = 0; i < QDIO_MAX_BUFFERS_PER_Q; ++i) 36774a71df50SFrank Blaschka in_sbal_ptrs[i] = (struct qdio_buffer *) 36784a71df50SFrank Blaschka virt_to_phys(card->qdio.in_q->bufs[i].buffer); 36794a71df50SFrank Blaschka 36804a71df50SFrank Blaschka out_sbal_ptrs = 36814a71df50SFrank Blaschka kmalloc(card->qdio.no_out_queues * QDIO_MAX_BUFFERS_PER_Q * 36824a71df50SFrank Blaschka sizeof(void *), GFP_KERNEL); 36834a71df50SFrank Blaschka if (!out_sbal_ptrs) { 36844a71df50SFrank Blaschka kfree(in_sbal_ptrs); 36854a71df50SFrank Blaschka kfree(qib_param_field); 36864a71df50SFrank Blaschka return -ENOMEM; 36874a71df50SFrank Blaschka } 36884a71df50SFrank Blaschka for (i = 0, k = 0; i < card->qdio.no_out_queues; ++i) 36894a71df50SFrank Blaschka for (j = 0; j < QDIO_MAX_BUFFERS_PER_Q; ++j, ++k) { 36904a71df50SFrank Blaschka out_sbal_ptrs[k] = (struct qdio_buffer *)virt_to_phys( 36914a71df50SFrank Blaschka card->qdio.out_qs[i]->bufs[j].buffer); 36924a71df50SFrank Blaschka } 36934a71df50SFrank Blaschka 36944a71df50SFrank Blaschka memset(&init_data, 0, sizeof(struct qdio_initialize)); 36954a71df50SFrank Blaschka init_data.cdev = CARD_DDEV(card); 36964a71df50SFrank Blaschka init_data.q_format = qeth_get_qdio_q_format(card); 36974a71df50SFrank Blaschka init_data.qib_param_field_format = 0; 36984a71df50SFrank Blaschka init_data.qib_param_field = qib_param_field; 36994a71df50SFrank Blaschka init_data.no_input_qs = 1; 37004a71df50SFrank Blaschka init_data.no_output_qs = card->qdio.no_out_queues; 37014a71df50SFrank Blaschka init_data.input_handler = card->discipline.input_handler; 37024a71df50SFrank Blaschka init_data.output_handler = card->discipline.output_handler; 37034a71df50SFrank Blaschka init_data.int_parm = (unsigned long) card; 37044a71df50SFrank Blaschka init_data.flags = QDIO_INBOUND_0COPY_SBALS | 37054a71df50SFrank Blaschka QDIO_OUTBOUND_0COPY_SBALS | 37064a71df50SFrank Blaschka QDIO_USE_OUTBOUND_PCIS; 37074a71df50SFrank Blaschka init_data.input_sbal_addr_array = (void **) in_sbal_ptrs; 37084a71df50SFrank Blaschka init_data.output_sbal_addr_array = (void **) out_sbal_ptrs; 37094a71df50SFrank Blaschka 37104a71df50SFrank Blaschka if (atomic_cmpxchg(&card->qdio.state, QETH_QDIO_ALLOCATED, 37114a71df50SFrank Blaschka QETH_QDIO_ESTABLISHED) == QETH_QDIO_ALLOCATED) { 37124a71df50SFrank Blaschka rc = qdio_initialize(&init_data); 37134a71df50SFrank Blaschka if (rc) 37144a71df50SFrank Blaschka atomic_set(&card->qdio.state, QETH_QDIO_ALLOCATED); 37154a71df50SFrank Blaschka } 37164a71df50SFrank Blaschka kfree(out_sbal_ptrs); 37174a71df50SFrank Blaschka kfree(in_sbal_ptrs); 37184a71df50SFrank Blaschka kfree(qib_param_field); 37194a71df50SFrank Blaschka return rc; 37204a71df50SFrank Blaschka } 37214a71df50SFrank Blaschka 37224a71df50SFrank Blaschka static void qeth_core_free_card(struct qeth_card *card) 37234a71df50SFrank Blaschka { 37244a71df50SFrank Blaschka 3725d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "freecrd"); 3726d11ba0c4SPeter Tiedemann QETH_DBF_HEX(SETUP, 2, &card, sizeof(void *)); 37274a71df50SFrank Blaschka qeth_clean_channel(&card->read); 37284a71df50SFrank Blaschka qeth_clean_channel(&card->write); 37294a71df50SFrank Blaschka if (card->dev) 37304a71df50SFrank Blaschka free_netdev(card->dev); 37314a71df50SFrank Blaschka kfree(card->ip_tbd_list); 37324a71df50SFrank Blaschka qeth_free_qdio_buffers(card); 37334a71df50SFrank Blaschka kfree(card); 37344a71df50SFrank Blaschka } 37354a71df50SFrank Blaschka 37364a71df50SFrank Blaschka static struct ccw_device_id qeth_ids[] = { 37374a71df50SFrank Blaschka {CCW_DEVICE(0x1731, 0x01), .driver_info = QETH_CARD_TYPE_OSAE}, 37384a71df50SFrank Blaschka {CCW_DEVICE(0x1731, 0x05), .driver_info = QETH_CARD_TYPE_IQD}, 37394a71df50SFrank Blaschka {CCW_DEVICE(0x1731, 0x06), .driver_info = QETH_CARD_TYPE_OSN}, 37404a71df50SFrank Blaschka {}, 37414a71df50SFrank Blaschka }; 37424a71df50SFrank Blaschka MODULE_DEVICE_TABLE(ccw, qeth_ids); 37434a71df50SFrank Blaschka 37444a71df50SFrank Blaschka static struct ccw_driver qeth_ccw_driver = { 37454a71df50SFrank Blaschka .name = "qeth", 37464a71df50SFrank Blaschka .ids = qeth_ids, 37474a71df50SFrank Blaschka .probe = ccwgroup_probe_ccwdev, 37484a71df50SFrank Blaschka .remove = ccwgroup_remove_ccwdev, 37494a71df50SFrank Blaschka }; 37504a71df50SFrank Blaschka 37514a71df50SFrank Blaschka static int qeth_core_driver_group(const char *buf, struct device *root_dev, 37524a71df50SFrank Blaschka unsigned long driver_id) 37534a71df50SFrank Blaschka { 3754022b660aSUrsula Braun return ccwgroup_create_from_string(root_dev, driver_id, 3755022b660aSUrsula Braun &qeth_ccw_driver, 3, buf); 37564a71df50SFrank Blaschka } 37574a71df50SFrank Blaschka 37584a71df50SFrank Blaschka int qeth_core_hardsetup_card(struct qeth_card *card) 37594a71df50SFrank Blaschka { 3760779e6e1cSJan Glauber struct qdio_ssqd_desc *qdio_ssqd; 37614a71df50SFrank Blaschka int retries = 3; 3762779e6e1cSJan Glauber int mpno = 0; 37634a71df50SFrank Blaschka int rc; 37644a71df50SFrank Blaschka 3765d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "hrdsetup"); 37664a71df50SFrank Blaschka atomic_set(&card->force_alloc_skb, 0); 37674a71df50SFrank Blaschka retry: 37684a71df50SFrank Blaschka if (retries < 3) { 37694a71df50SFrank Blaschka PRINT_WARN("Retrying to do IDX activates.\n"); 37704a71df50SFrank Blaschka ccw_device_set_offline(CARD_DDEV(card)); 37714a71df50SFrank Blaschka ccw_device_set_offline(CARD_WDEV(card)); 37724a71df50SFrank Blaschka ccw_device_set_offline(CARD_RDEV(card)); 37734a71df50SFrank Blaschka ccw_device_set_online(CARD_RDEV(card)); 37744a71df50SFrank Blaschka ccw_device_set_online(CARD_WDEV(card)); 37754a71df50SFrank Blaschka ccw_device_set_online(CARD_DDEV(card)); 37764a71df50SFrank Blaschka } 37774a71df50SFrank Blaschka rc = qeth_qdio_clear_card(card, card->info.type != QETH_CARD_TYPE_IQD); 37784a71df50SFrank Blaschka if (rc == -ERESTARTSYS) { 3779d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "break1"); 37804a71df50SFrank Blaschka return rc; 37814a71df50SFrank Blaschka } else if (rc) { 3782d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "1err%d", rc); 37834a71df50SFrank Blaschka if (--retries < 0) 37844a71df50SFrank Blaschka goto out; 37854a71df50SFrank Blaschka else 37864a71df50SFrank Blaschka goto retry; 37874a71df50SFrank Blaschka } 37884a71df50SFrank Blaschka 37894a71df50SFrank Blaschka rc = qeth_get_unitaddr(card); 37904a71df50SFrank Blaschka if (rc) { 3791d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "2err%d", rc); 37924a71df50SFrank Blaschka return rc; 37934a71df50SFrank Blaschka } 3794779e6e1cSJan Glauber 3795779e6e1cSJan Glauber qdio_ssqd = qdio_get_ssqd_desc(CARD_DDEV(card)); 3796779e6e1cSJan Glauber if (qdio_ssqd) 3797779e6e1cSJan Glauber mpno = qdio_ssqd->pcnt; 3798a74b08c7SUrsula Braun if (mpno) 3799a74b08c7SUrsula Braun mpno = min(mpno - 1, QETH_MAX_PORTNO); 38004a71df50SFrank Blaschka if (card->info.portno > mpno) { 380114cc21b6SFrank Blaschka QETH_DBF_MESSAGE(2, "Device %s does not offer port number %d" 380214cc21b6SFrank Blaschka "\n.", CARD_BUS_ID(card), card->info.portno); 38034a71df50SFrank Blaschka rc = -ENODEV; 38044a71df50SFrank Blaschka goto out; 38054a71df50SFrank Blaschka } 38064a71df50SFrank Blaschka qeth_init_tokens(card); 38074a71df50SFrank Blaschka qeth_init_func_level(card); 38084a71df50SFrank Blaschka rc = qeth_idx_activate_channel(&card->read, qeth_idx_read_cb); 38094a71df50SFrank Blaschka if (rc == -ERESTARTSYS) { 3810d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "break2"); 38114a71df50SFrank Blaschka return rc; 38124a71df50SFrank Blaschka } else if (rc) { 3813d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "3err%d", rc); 38144a71df50SFrank Blaschka if (--retries < 0) 38154a71df50SFrank Blaschka goto out; 38164a71df50SFrank Blaschka else 38174a71df50SFrank Blaschka goto retry; 38184a71df50SFrank Blaschka } 38194a71df50SFrank Blaschka rc = qeth_idx_activate_channel(&card->write, qeth_idx_write_cb); 38204a71df50SFrank Blaschka if (rc == -ERESTARTSYS) { 3821d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "break3"); 38224a71df50SFrank Blaschka return rc; 38234a71df50SFrank Blaschka } else if (rc) { 3824d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "4err%d", rc); 38254a71df50SFrank Blaschka if (--retries < 0) 38264a71df50SFrank Blaschka goto out; 38274a71df50SFrank Blaschka else 38284a71df50SFrank Blaschka goto retry; 38294a71df50SFrank Blaschka } 38304a71df50SFrank Blaschka rc = qeth_mpc_initialize(card); 38314a71df50SFrank Blaschka if (rc) { 3832d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "5err%d", rc); 38334a71df50SFrank Blaschka goto out; 38344a71df50SFrank Blaschka } 38354a71df50SFrank Blaschka return 0; 38364a71df50SFrank Blaschka out: 38374a71df50SFrank Blaschka PRINT_ERR("Initialization in hardsetup failed! rc=%d\n", rc); 38384a71df50SFrank Blaschka return rc; 38394a71df50SFrank Blaschka } 38404a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_core_hardsetup_card); 38414a71df50SFrank Blaschka 38424a71df50SFrank Blaschka static inline int qeth_create_skb_frag(struct qdio_buffer_element *element, 38434a71df50SFrank Blaschka struct sk_buff **pskb, int offset, int *pfrag, int data_len) 38444a71df50SFrank Blaschka { 38454a71df50SFrank Blaschka struct page *page = virt_to_page(element->addr); 38464a71df50SFrank Blaschka if (*pskb == NULL) { 38474a71df50SFrank Blaschka /* the upper protocol layers assume that there is data in the 38484a71df50SFrank Blaschka * skb itself. Copy a small amount (64 bytes) to make them 38494a71df50SFrank Blaschka * happy. */ 38504a71df50SFrank Blaschka *pskb = dev_alloc_skb(64 + ETH_HLEN); 38514a71df50SFrank Blaschka if (!(*pskb)) 38524a71df50SFrank Blaschka return -ENOMEM; 38534a71df50SFrank Blaschka skb_reserve(*pskb, ETH_HLEN); 38544a71df50SFrank Blaschka if (data_len <= 64) { 38554a71df50SFrank Blaschka memcpy(skb_put(*pskb, data_len), element->addr + offset, 38564a71df50SFrank Blaschka data_len); 38574a71df50SFrank Blaschka } else { 38584a71df50SFrank Blaschka get_page(page); 38594a71df50SFrank Blaschka memcpy(skb_put(*pskb, 64), element->addr + offset, 64); 38604a71df50SFrank Blaschka skb_fill_page_desc(*pskb, *pfrag, page, offset + 64, 38614a71df50SFrank Blaschka data_len - 64); 38624a71df50SFrank Blaschka (*pskb)->data_len += data_len - 64; 38634a71df50SFrank Blaschka (*pskb)->len += data_len - 64; 38644a71df50SFrank Blaschka (*pskb)->truesize += data_len - 64; 38654a71df50SFrank Blaschka (*pfrag)++; 38664a71df50SFrank Blaschka } 38674a71df50SFrank Blaschka } else { 38684a71df50SFrank Blaschka get_page(page); 38694a71df50SFrank Blaschka skb_fill_page_desc(*pskb, *pfrag, page, offset, data_len); 38704a71df50SFrank Blaschka (*pskb)->data_len += data_len; 38714a71df50SFrank Blaschka (*pskb)->len += data_len; 38724a71df50SFrank Blaschka (*pskb)->truesize += data_len; 38734a71df50SFrank Blaschka (*pfrag)++; 38744a71df50SFrank Blaschka } 38754a71df50SFrank Blaschka return 0; 38764a71df50SFrank Blaschka } 38774a71df50SFrank Blaschka 38784a71df50SFrank Blaschka struct sk_buff *qeth_core_get_next_skb(struct qeth_card *card, 38794a71df50SFrank Blaschka struct qdio_buffer *buffer, 38804a71df50SFrank Blaschka struct qdio_buffer_element **__element, int *__offset, 38814a71df50SFrank Blaschka struct qeth_hdr **hdr) 38824a71df50SFrank Blaschka { 38834a71df50SFrank Blaschka struct qdio_buffer_element *element = *__element; 38844a71df50SFrank Blaschka int offset = *__offset; 38854a71df50SFrank Blaschka struct sk_buff *skb = NULL; 38864a71df50SFrank Blaschka int skb_len; 38874a71df50SFrank Blaschka void *data_ptr; 38884a71df50SFrank Blaschka int data_len; 38894a71df50SFrank Blaschka int headroom = 0; 38904a71df50SFrank Blaschka int use_rx_sg = 0; 38914a71df50SFrank Blaschka int frag = 0; 38924a71df50SFrank Blaschka 38934a71df50SFrank Blaschka /* qeth_hdr must not cross element boundaries */ 38944a71df50SFrank Blaschka if (element->length < offset + sizeof(struct qeth_hdr)) { 38954a71df50SFrank Blaschka if (qeth_is_last_sbale(element)) 38964a71df50SFrank Blaschka return NULL; 38974a71df50SFrank Blaschka element++; 38984a71df50SFrank Blaschka offset = 0; 38994a71df50SFrank Blaschka if (element->length < sizeof(struct qeth_hdr)) 39004a71df50SFrank Blaschka return NULL; 39014a71df50SFrank Blaschka } 39024a71df50SFrank Blaschka *hdr = element->addr + offset; 39034a71df50SFrank Blaschka 39044a71df50SFrank Blaschka offset += sizeof(struct qeth_hdr); 39054a71df50SFrank Blaschka if (card->options.layer2) { 39064a71df50SFrank Blaschka if (card->info.type == QETH_CARD_TYPE_OSN) { 39074a71df50SFrank Blaschka skb_len = (*hdr)->hdr.osn.pdu_length; 39084a71df50SFrank Blaschka headroom = sizeof(struct qeth_hdr); 39094a71df50SFrank Blaschka } else { 39104a71df50SFrank Blaschka skb_len = (*hdr)->hdr.l2.pkt_length; 39114a71df50SFrank Blaschka } 39124a71df50SFrank Blaschka } else { 39134a71df50SFrank Blaschka skb_len = (*hdr)->hdr.l3.length; 3914b403e685SFrank Blaschka if ((card->info.link_type == QETH_LINK_TYPE_LANE_TR) || 3915b403e685SFrank Blaschka (card->info.link_type == QETH_LINK_TYPE_HSTR)) 3916b403e685SFrank Blaschka headroom = TR_HLEN; 3917b403e685SFrank Blaschka else 3918b403e685SFrank Blaschka headroom = ETH_HLEN; 39194a71df50SFrank Blaschka } 39204a71df50SFrank Blaschka 39214a71df50SFrank Blaschka if (!skb_len) 39224a71df50SFrank Blaschka return NULL; 39234a71df50SFrank Blaschka 39244a71df50SFrank Blaschka if ((skb_len >= card->options.rx_sg_cb) && 39254a71df50SFrank Blaschka (!(card->info.type == QETH_CARD_TYPE_OSN)) && 39264a71df50SFrank Blaschka (!atomic_read(&card->force_alloc_skb))) { 39274a71df50SFrank Blaschka use_rx_sg = 1; 39284a71df50SFrank Blaschka } else { 39294a71df50SFrank Blaschka skb = dev_alloc_skb(skb_len + headroom); 39304a71df50SFrank Blaschka if (!skb) 39314a71df50SFrank Blaschka goto no_mem; 39324a71df50SFrank Blaschka if (headroom) 39334a71df50SFrank Blaschka skb_reserve(skb, headroom); 39344a71df50SFrank Blaschka } 39354a71df50SFrank Blaschka 39364a71df50SFrank Blaschka data_ptr = element->addr + offset; 39374a71df50SFrank Blaschka while (skb_len) { 39384a71df50SFrank Blaschka data_len = min(skb_len, (int)(element->length - offset)); 39394a71df50SFrank Blaschka if (data_len) { 39404a71df50SFrank Blaschka if (use_rx_sg) { 39414a71df50SFrank Blaschka if (qeth_create_skb_frag(element, &skb, offset, 39424a71df50SFrank Blaschka &frag, data_len)) 39434a71df50SFrank Blaschka goto no_mem; 39444a71df50SFrank Blaschka } else { 39454a71df50SFrank Blaschka memcpy(skb_put(skb, data_len), data_ptr, 39464a71df50SFrank Blaschka data_len); 39474a71df50SFrank Blaschka } 39484a71df50SFrank Blaschka } 39494a71df50SFrank Blaschka skb_len -= data_len; 39504a71df50SFrank Blaschka if (skb_len) { 39514a71df50SFrank Blaschka if (qeth_is_last_sbale(element)) { 3952d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 4, "unexeob"); 3953d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(TRACE, 4, "%s", 39544a71df50SFrank Blaschka CARD_BUS_ID(card)); 3955d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(QERR, 2, "unexeob"); 3956d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(QERR, 2, "%s", 39574a71df50SFrank Blaschka CARD_BUS_ID(card)); 3958d11ba0c4SPeter Tiedemann QETH_DBF_HEX(MISC, 4, buffer, sizeof(*buffer)); 39594a71df50SFrank Blaschka dev_kfree_skb_any(skb); 39604a71df50SFrank Blaschka card->stats.rx_errors++; 39614a71df50SFrank Blaschka return NULL; 39624a71df50SFrank Blaschka } 39634a71df50SFrank Blaschka element++; 39644a71df50SFrank Blaschka offset = 0; 39654a71df50SFrank Blaschka data_ptr = element->addr; 39664a71df50SFrank Blaschka } else { 39674a71df50SFrank Blaschka offset += data_len; 39684a71df50SFrank Blaschka } 39694a71df50SFrank Blaschka } 39704a71df50SFrank Blaschka *__element = element; 39714a71df50SFrank Blaschka *__offset = offset; 39724a71df50SFrank Blaschka if (use_rx_sg && card->options.performance_stats) { 39734a71df50SFrank Blaschka card->perf_stats.sg_skbs_rx++; 39744a71df50SFrank Blaschka card->perf_stats.sg_frags_rx += skb_shinfo(skb)->nr_frags; 39754a71df50SFrank Blaschka } 39764a71df50SFrank Blaschka return skb; 39774a71df50SFrank Blaschka no_mem: 39784a71df50SFrank Blaschka if (net_ratelimit()) { 3979d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 2, "noskbmem"); 3980d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(TRACE, 2, "%s", CARD_BUS_ID(card)); 39814a71df50SFrank Blaschka } 39824a71df50SFrank Blaschka card->stats.rx_dropped++; 39834a71df50SFrank Blaschka return NULL; 39844a71df50SFrank Blaschka } 39854a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_core_get_next_skb); 39864a71df50SFrank Blaschka 39874a71df50SFrank Blaschka static void qeth_unregister_dbf_views(void) 39884a71df50SFrank Blaschka { 3989d11ba0c4SPeter Tiedemann int x; 3990d11ba0c4SPeter Tiedemann for (x = 0; x < QETH_DBF_INFOS; x++) { 3991d11ba0c4SPeter Tiedemann debug_unregister(qeth_dbf[x].id); 3992d11ba0c4SPeter Tiedemann qeth_dbf[x].id = NULL; 3993d11ba0c4SPeter Tiedemann } 39944a71df50SFrank Blaschka } 39954a71df50SFrank Blaschka 3996345aa66eSPeter Tiedemann void qeth_dbf_longtext(enum qeth_dbf_names dbf_nix, int level, char *fmt, ...) 3997cd023216SPeter Tiedemann { 3998cd023216SPeter Tiedemann char dbf_txt_buf[32]; 3999345aa66eSPeter Tiedemann va_list args; 4000cd023216SPeter Tiedemann 4001cd023216SPeter Tiedemann if (level > (qeth_dbf[dbf_nix].id)->level) 4002cd023216SPeter Tiedemann return; 4003345aa66eSPeter Tiedemann va_start(args, fmt); 4004345aa66eSPeter Tiedemann vsnprintf(dbf_txt_buf, sizeof(dbf_txt_buf), fmt, args); 4005345aa66eSPeter Tiedemann va_end(args); 4006cd023216SPeter Tiedemann debug_text_event(qeth_dbf[dbf_nix].id, level, dbf_txt_buf); 4007cd023216SPeter Tiedemann } 4008cd023216SPeter Tiedemann EXPORT_SYMBOL_GPL(qeth_dbf_longtext); 4009cd023216SPeter Tiedemann 40104a71df50SFrank Blaschka static int qeth_register_dbf_views(void) 40114a71df50SFrank Blaschka { 4012d11ba0c4SPeter Tiedemann int ret; 4013d11ba0c4SPeter Tiedemann int x; 40144a71df50SFrank Blaschka 4015d11ba0c4SPeter Tiedemann for (x = 0; x < QETH_DBF_INFOS; x++) { 4016d11ba0c4SPeter Tiedemann /* register the areas */ 4017d11ba0c4SPeter Tiedemann qeth_dbf[x].id = debug_register(qeth_dbf[x].name, 4018d11ba0c4SPeter Tiedemann qeth_dbf[x].pages, 4019d11ba0c4SPeter Tiedemann qeth_dbf[x].areas, 4020d11ba0c4SPeter Tiedemann qeth_dbf[x].len); 4021d11ba0c4SPeter Tiedemann if (qeth_dbf[x].id == NULL) { 40224a71df50SFrank Blaschka qeth_unregister_dbf_views(); 40234a71df50SFrank Blaschka return -ENOMEM; 40244a71df50SFrank Blaschka } 40254a71df50SFrank Blaschka 4026d11ba0c4SPeter Tiedemann /* register a view */ 4027d11ba0c4SPeter Tiedemann ret = debug_register_view(qeth_dbf[x].id, qeth_dbf[x].view); 4028d11ba0c4SPeter Tiedemann if (ret) { 4029d11ba0c4SPeter Tiedemann qeth_unregister_dbf_views(); 4030d11ba0c4SPeter Tiedemann return ret; 4031d11ba0c4SPeter Tiedemann } 40324a71df50SFrank Blaschka 4033d11ba0c4SPeter Tiedemann /* set a passing level */ 4034d11ba0c4SPeter Tiedemann debug_set_level(qeth_dbf[x].id, qeth_dbf[x].level); 4035d11ba0c4SPeter Tiedemann } 40364a71df50SFrank Blaschka 40374a71df50SFrank Blaschka return 0; 40384a71df50SFrank Blaschka } 40394a71df50SFrank Blaschka 40404a71df50SFrank Blaschka int qeth_core_load_discipline(struct qeth_card *card, 40414a71df50SFrank Blaschka enum qeth_discipline_id discipline) 40424a71df50SFrank Blaschka { 40434a71df50SFrank Blaschka int rc = 0; 40444a71df50SFrank Blaschka switch (discipline) { 40454a71df50SFrank Blaschka case QETH_DISCIPLINE_LAYER3: 40464a71df50SFrank Blaschka card->discipline.ccwgdriver = try_then_request_module( 40474a71df50SFrank Blaschka symbol_get(qeth_l3_ccwgroup_driver), 40484a71df50SFrank Blaschka "qeth_l3"); 40494a71df50SFrank Blaschka break; 40504a71df50SFrank Blaschka case QETH_DISCIPLINE_LAYER2: 40514a71df50SFrank Blaschka card->discipline.ccwgdriver = try_then_request_module( 40524a71df50SFrank Blaschka symbol_get(qeth_l2_ccwgroup_driver), 40534a71df50SFrank Blaschka "qeth_l2"); 40544a71df50SFrank Blaschka break; 40554a71df50SFrank Blaschka } 40564a71df50SFrank Blaschka if (!card->discipline.ccwgdriver) { 40574a71df50SFrank Blaschka PRINT_ERR("Support for discipline %d not present\n", 40584a71df50SFrank Blaschka discipline); 40594a71df50SFrank Blaschka rc = -EINVAL; 40604a71df50SFrank Blaschka } 40614a71df50SFrank Blaschka return rc; 40624a71df50SFrank Blaschka } 40634a71df50SFrank Blaschka 40644a71df50SFrank Blaschka void qeth_core_free_discipline(struct qeth_card *card) 40654a71df50SFrank Blaschka { 40664a71df50SFrank Blaschka if (card->options.layer2) 40674a71df50SFrank Blaschka symbol_put(qeth_l2_ccwgroup_driver); 40684a71df50SFrank Blaschka else 40694a71df50SFrank Blaschka symbol_put(qeth_l3_ccwgroup_driver); 40704a71df50SFrank Blaschka card->discipline.ccwgdriver = NULL; 40714a71df50SFrank Blaschka } 40724a71df50SFrank Blaschka 40734a71df50SFrank Blaschka static int qeth_core_probe_device(struct ccwgroup_device *gdev) 40744a71df50SFrank Blaschka { 40754a71df50SFrank Blaschka struct qeth_card *card; 40764a71df50SFrank Blaschka struct device *dev; 40774a71df50SFrank Blaschka int rc; 40784a71df50SFrank Blaschka unsigned long flags; 40794a71df50SFrank Blaschka 4080d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "probedev"); 40814a71df50SFrank Blaschka 40824a71df50SFrank Blaschka dev = &gdev->dev; 40834a71df50SFrank Blaschka if (!get_device(dev)) 40844a71df50SFrank Blaschka return -ENODEV; 40854a71df50SFrank Blaschka 40862a0217d5SKay Sievers QETH_DBF_TEXT_(SETUP, 2, "%s", dev_name(&gdev->dev)); 40874a71df50SFrank Blaschka 40884a71df50SFrank Blaschka card = qeth_alloc_card(); 40894a71df50SFrank Blaschka if (!card) { 4090d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "1err%d", -ENOMEM); 40914a71df50SFrank Blaschka rc = -ENOMEM; 40924a71df50SFrank Blaschka goto err_dev; 40934a71df50SFrank Blaschka } 40944a71df50SFrank Blaschka card->read.ccwdev = gdev->cdev[0]; 40954a71df50SFrank Blaschka card->write.ccwdev = gdev->cdev[1]; 40964a71df50SFrank Blaschka card->data.ccwdev = gdev->cdev[2]; 40974a71df50SFrank Blaschka dev_set_drvdata(&gdev->dev, card); 40984a71df50SFrank Blaschka card->gdev = gdev; 40994a71df50SFrank Blaschka gdev->cdev[0]->handler = qeth_irq; 41004a71df50SFrank Blaschka gdev->cdev[1]->handler = qeth_irq; 41014a71df50SFrank Blaschka gdev->cdev[2]->handler = qeth_irq; 41024a71df50SFrank Blaschka 41034a71df50SFrank Blaschka rc = qeth_determine_card_type(card); 41044a71df50SFrank Blaschka if (rc) { 4105d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "3err%d", rc); 41064a71df50SFrank Blaschka goto err_card; 41074a71df50SFrank Blaschka } 41084a71df50SFrank Blaschka rc = qeth_setup_card(card); 41094a71df50SFrank Blaschka if (rc) { 4110d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "2err%d", rc); 41114a71df50SFrank Blaschka goto err_card; 41124a71df50SFrank Blaschka } 41134a71df50SFrank Blaschka 41144a71df50SFrank Blaschka if (card->info.type == QETH_CARD_TYPE_OSN) { 41154a71df50SFrank Blaschka rc = qeth_core_create_osn_attributes(dev); 41164a71df50SFrank Blaschka if (rc) 41174a71df50SFrank Blaschka goto err_card; 41184a71df50SFrank Blaschka rc = qeth_core_load_discipline(card, QETH_DISCIPLINE_LAYER2); 41194a71df50SFrank Blaschka if (rc) { 41204a71df50SFrank Blaschka qeth_core_remove_osn_attributes(dev); 41214a71df50SFrank Blaschka goto err_card; 41224a71df50SFrank Blaschka } 41234a71df50SFrank Blaschka rc = card->discipline.ccwgdriver->probe(card->gdev); 41244a71df50SFrank Blaschka if (rc) { 41254a71df50SFrank Blaschka qeth_core_free_discipline(card); 41264a71df50SFrank Blaschka qeth_core_remove_osn_attributes(dev); 41274a71df50SFrank Blaschka goto err_card; 41284a71df50SFrank Blaschka } 41294a71df50SFrank Blaschka } else { 41304a71df50SFrank Blaschka rc = qeth_core_create_device_attributes(dev); 41314a71df50SFrank Blaschka if (rc) 41324a71df50SFrank Blaschka goto err_card; 41334a71df50SFrank Blaschka } 41344a71df50SFrank Blaschka 41354a71df50SFrank Blaschka write_lock_irqsave(&qeth_core_card_list.rwlock, flags); 41364a71df50SFrank Blaschka list_add_tail(&card->list, &qeth_core_card_list.list); 41374a71df50SFrank Blaschka write_unlock_irqrestore(&qeth_core_card_list.rwlock, flags); 41384a71df50SFrank Blaschka return 0; 41394a71df50SFrank Blaschka 41404a71df50SFrank Blaschka err_card: 41414a71df50SFrank Blaschka qeth_core_free_card(card); 41424a71df50SFrank Blaschka err_dev: 41434a71df50SFrank Blaschka put_device(dev); 41444a71df50SFrank Blaschka return rc; 41454a71df50SFrank Blaschka } 41464a71df50SFrank Blaschka 41474a71df50SFrank Blaschka static void qeth_core_remove_device(struct ccwgroup_device *gdev) 41484a71df50SFrank Blaschka { 41494a71df50SFrank Blaschka unsigned long flags; 41504a71df50SFrank Blaschka struct qeth_card *card = dev_get_drvdata(&gdev->dev); 41514a71df50SFrank Blaschka 415228a7e4c9SUrsula Braun QETH_DBF_TEXT(SETUP, 2, "removedv"); 41534a71df50SFrank Blaschka if (card->discipline.ccwgdriver) { 41544a71df50SFrank Blaschka card->discipline.ccwgdriver->remove(gdev); 41554a71df50SFrank Blaschka qeth_core_free_discipline(card); 41564a71df50SFrank Blaschka } 41574a71df50SFrank Blaschka 41584a71df50SFrank Blaschka if (card->info.type == QETH_CARD_TYPE_OSN) { 41594a71df50SFrank Blaschka qeth_core_remove_osn_attributes(&gdev->dev); 41604a71df50SFrank Blaschka } else { 41614a71df50SFrank Blaschka qeth_core_remove_device_attributes(&gdev->dev); 41624a71df50SFrank Blaschka } 41634a71df50SFrank Blaschka write_lock_irqsave(&qeth_core_card_list.rwlock, flags); 41644a71df50SFrank Blaschka list_del(&card->list); 41654a71df50SFrank Blaschka write_unlock_irqrestore(&qeth_core_card_list.rwlock, flags); 41664a71df50SFrank Blaschka qeth_core_free_card(card); 41674a71df50SFrank Blaschka dev_set_drvdata(&gdev->dev, NULL); 41684a71df50SFrank Blaschka put_device(&gdev->dev); 41694a71df50SFrank Blaschka return; 41704a71df50SFrank Blaschka } 41714a71df50SFrank Blaschka 41724a71df50SFrank Blaschka static int qeth_core_set_online(struct ccwgroup_device *gdev) 41734a71df50SFrank Blaschka { 41744a71df50SFrank Blaschka struct qeth_card *card = dev_get_drvdata(&gdev->dev); 41754a71df50SFrank Blaschka int rc = 0; 41764a71df50SFrank Blaschka int def_discipline; 41774a71df50SFrank Blaschka 41784a71df50SFrank Blaschka if (!card->discipline.ccwgdriver) { 41794a71df50SFrank Blaschka if (card->info.type == QETH_CARD_TYPE_IQD) 41804a71df50SFrank Blaschka def_discipline = QETH_DISCIPLINE_LAYER3; 41814a71df50SFrank Blaschka else 41824a71df50SFrank Blaschka def_discipline = QETH_DISCIPLINE_LAYER2; 41834a71df50SFrank Blaschka rc = qeth_core_load_discipline(card, def_discipline); 41844a71df50SFrank Blaschka if (rc) 41854a71df50SFrank Blaschka goto err; 41864a71df50SFrank Blaschka rc = card->discipline.ccwgdriver->probe(card->gdev); 41874a71df50SFrank Blaschka if (rc) 41884a71df50SFrank Blaschka goto err; 41894a71df50SFrank Blaschka } 41904a71df50SFrank Blaschka rc = card->discipline.ccwgdriver->set_online(gdev); 41914a71df50SFrank Blaschka err: 41924a71df50SFrank Blaschka return rc; 41934a71df50SFrank Blaschka } 41944a71df50SFrank Blaschka 41954a71df50SFrank Blaschka static int qeth_core_set_offline(struct ccwgroup_device *gdev) 41964a71df50SFrank Blaschka { 41974a71df50SFrank Blaschka struct qeth_card *card = dev_get_drvdata(&gdev->dev); 41984a71df50SFrank Blaschka return card->discipline.ccwgdriver->set_offline(gdev); 41994a71df50SFrank Blaschka } 42004a71df50SFrank Blaschka 42014a71df50SFrank Blaschka static void qeth_core_shutdown(struct ccwgroup_device *gdev) 42024a71df50SFrank Blaschka { 42034a71df50SFrank Blaschka struct qeth_card *card = dev_get_drvdata(&gdev->dev); 42044a71df50SFrank Blaschka if (card->discipline.ccwgdriver && 42054a71df50SFrank Blaschka card->discipline.ccwgdriver->shutdown) 42064a71df50SFrank Blaschka card->discipline.ccwgdriver->shutdown(gdev); 42074a71df50SFrank Blaschka } 42084a71df50SFrank Blaschka 42094a71df50SFrank Blaschka static struct ccwgroup_driver qeth_core_ccwgroup_driver = { 42104a71df50SFrank Blaschka .owner = THIS_MODULE, 42114a71df50SFrank Blaschka .name = "qeth", 42124a71df50SFrank Blaschka .driver_id = 0xD8C5E3C8, 42134a71df50SFrank Blaschka .probe = qeth_core_probe_device, 42144a71df50SFrank Blaschka .remove = qeth_core_remove_device, 42154a71df50SFrank Blaschka .set_online = qeth_core_set_online, 42164a71df50SFrank Blaschka .set_offline = qeth_core_set_offline, 42174a71df50SFrank Blaschka .shutdown = qeth_core_shutdown, 42184a71df50SFrank Blaschka }; 42194a71df50SFrank Blaschka 42204a71df50SFrank Blaschka static ssize_t 42214a71df50SFrank Blaschka qeth_core_driver_group_store(struct device_driver *ddrv, const char *buf, 42224a71df50SFrank Blaschka size_t count) 42234a71df50SFrank Blaschka { 42244a71df50SFrank Blaschka int err; 42254a71df50SFrank Blaschka err = qeth_core_driver_group(buf, qeth_core_root_dev, 42264a71df50SFrank Blaschka qeth_core_ccwgroup_driver.driver_id); 42274a71df50SFrank Blaschka if (err) 42284a71df50SFrank Blaschka return err; 42294a71df50SFrank Blaschka else 42304a71df50SFrank Blaschka return count; 42314a71df50SFrank Blaschka } 42324a71df50SFrank Blaschka 42334a71df50SFrank Blaschka static DRIVER_ATTR(group, 0200, NULL, qeth_core_driver_group_store); 42344a71df50SFrank Blaschka 42354a71df50SFrank Blaschka static struct { 42364a71df50SFrank Blaschka const char str[ETH_GSTRING_LEN]; 42374a71df50SFrank Blaschka } qeth_ethtool_stats_keys[] = { 42384a71df50SFrank Blaschka /* 0 */{"rx skbs"}, 42394a71df50SFrank Blaschka {"rx buffers"}, 42404a71df50SFrank Blaschka {"tx skbs"}, 42414a71df50SFrank Blaschka {"tx buffers"}, 42424a71df50SFrank Blaschka {"tx skbs no packing"}, 42434a71df50SFrank Blaschka {"tx buffers no packing"}, 42444a71df50SFrank Blaschka {"tx skbs packing"}, 42454a71df50SFrank Blaschka {"tx buffers packing"}, 42464a71df50SFrank Blaschka {"tx sg skbs"}, 42474a71df50SFrank Blaschka {"tx sg frags"}, 42484a71df50SFrank Blaschka /* 10 */{"rx sg skbs"}, 42494a71df50SFrank Blaschka {"rx sg frags"}, 42504a71df50SFrank Blaschka {"rx sg page allocs"}, 42514a71df50SFrank Blaschka {"tx large kbytes"}, 42524a71df50SFrank Blaschka {"tx large count"}, 42534a71df50SFrank Blaschka {"tx pk state ch n->p"}, 42544a71df50SFrank Blaschka {"tx pk state ch p->n"}, 42554a71df50SFrank Blaschka {"tx pk watermark low"}, 42564a71df50SFrank Blaschka {"tx pk watermark high"}, 42574a71df50SFrank Blaschka {"queue 0 buffer usage"}, 42584a71df50SFrank Blaschka /* 20 */{"queue 1 buffer usage"}, 42594a71df50SFrank Blaschka {"queue 2 buffer usage"}, 42604a71df50SFrank Blaschka {"queue 3 buffer usage"}, 42614a71df50SFrank Blaschka {"rx handler time"}, 42624a71df50SFrank Blaschka {"rx handler count"}, 42634a71df50SFrank Blaschka {"rx do_QDIO time"}, 42644a71df50SFrank Blaschka {"rx do_QDIO count"}, 42654a71df50SFrank Blaschka {"tx handler time"}, 42664a71df50SFrank Blaschka {"tx handler count"}, 42674a71df50SFrank Blaschka {"tx time"}, 42684a71df50SFrank Blaschka /* 30 */{"tx count"}, 42694a71df50SFrank Blaschka {"tx do_QDIO time"}, 42704a71df50SFrank Blaschka {"tx do_QDIO count"}, 42714a71df50SFrank Blaschka }; 42724a71df50SFrank Blaschka 42734a71df50SFrank Blaschka int qeth_core_get_stats_count(struct net_device *dev) 42744a71df50SFrank Blaschka { 42754a71df50SFrank Blaschka return (sizeof(qeth_ethtool_stats_keys) / ETH_GSTRING_LEN); 42764a71df50SFrank Blaschka } 42774a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_core_get_stats_count); 42784a71df50SFrank Blaschka 42794a71df50SFrank Blaschka void qeth_core_get_ethtool_stats(struct net_device *dev, 42804a71df50SFrank Blaschka struct ethtool_stats *stats, u64 *data) 42814a71df50SFrank Blaschka { 4282509e2562SHeiko Carstens struct qeth_card *card = dev->ml_priv; 42834a71df50SFrank Blaschka data[0] = card->stats.rx_packets - 42844a71df50SFrank Blaschka card->perf_stats.initial_rx_packets; 42854a71df50SFrank Blaschka data[1] = card->perf_stats.bufs_rec; 42864a71df50SFrank Blaschka data[2] = card->stats.tx_packets - 42874a71df50SFrank Blaschka card->perf_stats.initial_tx_packets; 42884a71df50SFrank Blaschka data[3] = card->perf_stats.bufs_sent; 42894a71df50SFrank Blaschka data[4] = card->stats.tx_packets - card->perf_stats.initial_tx_packets 42904a71df50SFrank Blaschka - card->perf_stats.skbs_sent_pack; 42914a71df50SFrank Blaschka data[5] = card->perf_stats.bufs_sent - card->perf_stats.bufs_sent_pack; 42924a71df50SFrank Blaschka data[6] = card->perf_stats.skbs_sent_pack; 42934a71df50SFrank Blaschka data[7] = card->perf_stats.bufs_sent_pack; 42944a71df50SFrank Blaschka data[8] = card->perf_stats.sg_skbs_sent; 42954a71df50SFrank Blaschka data[9] = card->perf_stats.sg_frags_sent; 42964a71df50SFrank Blaschka data[10] = card->perf_stats.sg_skbs_rx; 42974a71df50SFrank Blaschka data[11] = card->perf_stats.sg_frags_rx; 42984a71df50SFrank Blaschka data[12] = card->perf_stats.sg_alloc_page_rx; 42994a71df50SFrank Blaschka data[13] = (card->perf_stats.large_send_bytes >> 10); 43004a71df50SFrank Blaschka data[14] = card->perf_stats.large_send_cnt; 43014a71df50SFrank Blaschka data[15] = card->perf_stats.sc_dp_p; 43024a71df50SFrank Blaschka data[16] = card->perf_stats.sc_p_dp; 43034a71df50SFrank Blaschka data[17] = QETH_LOW_WATERMARK_PACK; 43044a71df50SFrank Blaschka data[18] = QETH_HIGH_WATERMARK_PACK; 43054a71df50SFrank Blaschka data[19] = atomic_read(&card->qdio.out_qs[0]->used_buffers); 43064a71df50SFrank Blaschka data[20] = (card->qdio.no_out_queues > 1) ? 43074a71df50SFrank Blaschka atomic_read(&card->qdio.out_qs[1]->used_buffers) : 0; 43084a71df50SFrank Blaschka data[21] = (card->qdio.no_out_queues > 2) ? 43094a71df50SFrank Blaschka atomic_read(&card->qdio.out_qs[2]->used_buffers) : 0; 43104a71df50SFrank Blaschka data[22] = (card->qdio.no_out_queues > 3) ? 43114a71df50SFrank Blaschka atomic_read(&card->qdio.out_qs[3]->used_buffers) : 0; 43124a71df50SFrank Blaschka data[23] = card->perf_stats.inbound_time; 43134a71df50SFrank Blaschka data[24] = card->perf_stats.inbound_cnt; 43144a71df50SFrank Blaschka data[25] = card->perf_stats.inbound_do_qdio_time; 43154a71df50SFrank Blaschka data[26] = card->perf_stats.inbound_do_qdio_cnt; 43164a71df50SFrank Blaschka data[27] = card->perf_stats.outbound_handler_time; 43174a71df50SFrank Blaschka data[28] = card->perf_stats.outbound_handler_cnt; 43184a71df50SFrank Blaschka data[29] = card->perf_stats.outbound_time; 43194a71df50SFrank Blaschka data[30] = card->perf_stats.outbound_cnt; 43204a71df50SFrank Blaschka data[31] = card->perf_stats.outbound_do_qdio_time; 43214a71df50SFrank Blaschka data[32] = card->perf_stats.outbound_do_qdio_cnt; 43224a71df50SFrank Blaschka } 43234a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_core_get_ethtool_stats); 43244a71df50SFrank Blaschka 43254a71df50SFrank Blaschka void qeth_core_get_strings(struct net_device *dev, u32 stringset, u8 *data) 43264a71df50SFrank Blaschka { 43274a71df50SFrank Blaschka switch (stringset) { 43284a71df50SFrank Blaschka case ETH_SS_STATS: 43294a71df50SFrank Blaschka memcpy(data, &qeth_ethtool_stats_keys, 43304a71df50SFrank Blaschka sizeof(qeth_ethtool_stats_keys)); 43314a71df50SFrank Blaschka break; 43324a71df50SFrank Blaschka default: 43334a71df50SFrank Blaschka WARN_ON(1); 43344a71df50SFrank Blaschka break; 43354a71df50SFrank Blaschka } 43364a71df50SFrank Blaschka } 43374a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_core_get_strings); 43384a71df50SFrank Blaschka 43394a71df50SFrank Blaschka void qeth_core_get_drvinfo(struct net_device *dev, 43404a71df50SFrank Blaschka struct ethtool_drvinfo *info) 43414a71df50SFrank Blaschka { 4342509e2562SHeiko Carstens struct qeth_card *card = dev->ml_priv; 43434a71df50SFrank Blaschka if (card->options.layer2) 43444a71df50SFrank Blaschka strcpy(info->driver, "qeth_l2"); 43454a71df50SFrank Blaschka else 43464a71df50SFrank Blaschka strcpy(info->driver, "qeth_l3"); 43474a71df50SFrank Blaschka 43484a71df50SFrank Blaschka strcpy(info->version, "1.0"); 43494a71df50SFrank Blaschka strcpy(info->fw_version, card->info.mcl_level); 43504a71df50SFrank Blaschka sprintf(info->bus_info, "%s/%s/%s", 43514a71df50SFrank Blaschka CARD_RDEV_ID(card), 43524a71df50SFrank Blaschka CARD_WDEV_ID(card), 43534a71df50SFrank Blaschka CARD_DDEV_ID(card)); 43544a71df50SFrank Blaschka } 43554a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_core_get_drvinfo); 43564a71df50SFrank Blaschka 43573f9975aaSFrank Blaschka int qeth_core_ethtool_get_settings(struct net_device *netdev, 43583f9975aaSFrank Blaschka struct ethtool_cmd *ecmd) 43593f9975aaSFrank Blaschka { 4360509e2562SHeiko Carstens struct qeth_card *card = netdev->ml_priv; 43613f9975aaSFrank Blaschka enum qeth_link_types link_type; 43623f9975aaSFrank Blaschka 43633f9975aaSFrank Blaschka if ((card->info.type == QETH_CARD_TYPE_IQD) || (card->info.guestlan)) 43643f9975aaSFrank Blaschka link_type = QETH_LINK_TYPE_10GBIT_ETH; 43653f9975aaSFrank Blaschka else 43663f9975aaSFrank Blaschka link_type = card->info.link_type; 43673f9975aaSFrank Blaschka 43683f9975aaSFrank Blaschka ecmd->transceiver = XCVR_INTERNAL; 43693f9975aaSFrank Blaschka ecmd->supported = SUPPORTED_Autoneg; 43703f9975aaSFrank Blaschka ecmd->advertising = ADVERTISED_Autoneg; 43713f9975aaSFrank Blaschka ecmd->duplex = DUPLEX_FULL; 43723f9975aaSFrank Blaschka ecmd->autoneg = AUTONEG_ENABLE; 43733f9975aaSFrank Blaschka 43743f9975aaSFrank Blaschka switch (link_type) { 43753f9975aaSFrank Blaschka case QETH_LINK_TYPE_FAST_ETH: 43763f9975aaSFrank Blaschka case QETH_LINK_TYPE_LANE_ETH100: 43773f9975aaSFrank Blaschka ecmd->supported |= SUPPORTED_10baseT_Half | 43783f9975aaSFrank Blaschka SUPPORTED_10baseT_Full | 43793f9975aaSFrank Blaschka SUPPORTED_100baseT_Half | 43803f9975aaSFrank Blaschka SUPPORTED_100baseT_Full | 43813f9975aaSFrank Blaschka SUPPORTED_TP; 43823f9975aaSFrank Blaschka ecmd->advertising |= ADVERTISED_10baseT_Half | 43833f9975aaSFrank Blaschka ADVERTISED_10baseT_Full | 43843f9975aaSFrank Blaschka ADVERTISED_100baseT_Half | 43853f9975aaSFrank Blaschka ADVERTISED_100baseT_Full | 43863f9975aaSFrank Blaschka ADVERTISED_TP; 43873f9975aaSFrank Blaschka ecmd->speed = SPEED_100; 43883f9975aaSFrank Blaschka ecmd->port = PORT_TP; 43893f9975aaSFrank Blaschka break; 43903f9975aaSFrank Blaschka 43913f9975aaSFrank Blaschka case QETH_LINK_TYPE_GBIT_ETH: 43923f9975aaSFrank Blaschka case QETH_LINK_TYPE_LANE_ETH1000: 43933f9975aaSFrank Blaschka ecmd->supported |= SUPPORTED_10baseT_Half | 43943f9975aaSFrank Blaschka SUPPORTED_10baseT_Full | 43953f9975aaSFrank Blaschka SUPPORTED_100baseT_Half | 43963f9975aaSFrank Blaschka SUPPORTED_100baseT_Full | 43973f9975aaSFrank Blaschka SUPPORTED_1000baseT_Half | 43983f9975aaSFrank Blaschka SUPPORTED_1000baseT_Full | 43993f9975aaSFrank Blaschka SUPPORTED_FIBRE; 44003f9975aaSFrank Blaschka ecmd->advertising |= ADVERTISED_10baseT_Half | 44013f9975aaSFrank Blaschka ADVERTISED_10baseT_Full | 44023f9975aaSFrank Blaschka ADVERTISED_100baseT_Half | 44033f9975aaSFrank Blaschka ADVERTISED_100baseT_Full | 44043f9975aaSFrank Blaschka ADVERTISED_1000baseT_Half | 44053f9975aaSFrank Blaschka ADVERTISED_1000baseT_Full | 44063f9975aaSFrank Blaschka ADVERTISED_FIBRE; 44073f9975aaSFrank Blaschka ecmd->speed = SPEED_1000; 44083f9975aaSFrank Blaschka ecmd->port = PORT_FIBRE; 44093f9975aaSFrank Blaschka break; 44103f9975aaSFrank Blaschka 44113f9975aaSFrank Blaschka case QETH_LINK_TYPE_10GBIT_ETH: 44123f9975aaSFrank Blaschka ecmd->supported |= SUPPORTED_10baseT_Half | 44133f9975aaSFrank Blaschka SUPPORTED_10baseT_Full | 44143f9975aaSFrank Blaschka SUPPORTED_100baseT_Half | 44153f9975aaSFrank Blaschka SUPPORTED_100baseT_Full | 44163f9975aaSFrank Blaschka SUPPORTED_1000baseT_Half | 44173f9975aaSFrank Blaschka SUPPORTED_1000baseT_Full | 44183f9975aaSFrank Blaschka SUPPORTED_10000baseT_Full | 44193f9975aaSFrank Blaschka SUPPORTED_FIBRE; 44203f9975aaSFrank Blaschka ecmd->advertising |= ADVERTISED_10baseT_Half | 44213f9975aaSFrank Blaschka ADVERTISED_10baseT_Full | 44223f9975aaSFrank Blaschka ADVERTISED_100baseT_Half | 44233f9975aaSFrank Blaschka ADVERTISED_100baseT_Full | 44243f9975aaSFrank Blaschka ADVERTISED_1000baseT_Half | 44253f9975aaSFrank Blaschka ADVERTISED_1000baseT_Full | 44263f9975aaSFrank Blaschka ADVERTISED_10000baseT_Full | 44273f9975aaSFrank Blaschka ADVERTISED_FIBRE; 44283f9975aaSFrank Blaschka ecmd->speed = SPEED_10000; 44293f9975aaSFrank Blaschka ecmd->port = PORT_FIBRE; 44303f9975aaSFrank Blaschka break; 44313f9975aaSFrank Blaschka 44323f9975aaSFrank Blaschka default: 44333f9975aaSFrank Blaschka ecmd->supported |= SUPPORTED_10baseT_Half | 44343f9975aaSFrank Blaschka SUPPORTED_10baseT_Full | 44353f9975aaSFrank Blaschka SUPPORTED_TP; 44363f9975aaSFrank Blaschka ecmd->advertising |= ADVERTISED_10baseT_Half | 44373f9975aaSFrank Blaschka ADVERTISED_10baseT_Full | 44383f9975aaSFrank Blaschka ADVERTISED_TP; 44393f9975aaSFrank Blaschka ecmd->speed = SPEED_10; 44403f9975aaSFrank Blaschka ecmd->port = PORT_TP; 44413f9975aaSFrank Blaschka } 44423f9975aaSFrank Blaschka 44433f9975aaSFrank Blaschka return 0; 44443f9975aaSFrank Blaschka } 44453f9975aaSFrank Blaschka EXPORT_SYMBOL_GPL(qeth_core_ethtool_get_settings); 44463f9975aaSFrank Blaschka 44474a71df50SFrank Blaschka static int __init qeth_core_init(void) 44484a71df50SFrank Blaschka { 44494a71df50SFrank Blaschka int rc; 44504a71df50SFrank Blaschka 44514a71df50SFrank Blaschka PRINT_INFO("loading core functions\n"); 44524a71df50SFrank Blaschka INIT_LIST_HEAD(&qeth_core_card_list.list); 44534a71df50SFrank Blaschka rwlock_init(&qeth_core_card_list.rwlock); 44544a71df50SFrank Blaschka 44554a71df50SFrank Blaschka rc = qeth_register_dbf_views(); 44564a71df50SFrank Blaschka if (rc) 44574a71df50SFrank Blaschka goto out_err; 44584a71df50SFrank Blaschka rc = ccw_driver_register(&qeth_ccw_driver); 44594a71df50SFrank Blaschka if (rc) 44604a71df50SFrank Blaschka goto ccw_err; 44614a71df50SFrank Blaschka rc = ccwgroup_driver_register(&qeth_core_ccwgroup_driver); 44624a71df50SFrank Blaschka if (rc) 44634a71df50SFrank Blaschka goto ccwgroup_err; 44644a71df50SFrank Blaschka rc = driver_create_file(&qeth_core_ccwgroup_driver.driver, 44654a71df50SFrank Blaschka &driver_attr_group); 44664a71df50SFrank Blaschka if (rc) 44674a71df50SFrank Blaschka goto driver_err; 44684a71df50SFrank Blaschka qeth_core_root_dev = s390_root_dev_register("qeth"); 44694a71df50SFrank Blaschka rc = IS_ERR(qeth_core_root_dev) ? PTR_ERR(qeth_core_root_dev) : 0; 44704a71df50SFrank Blaschka if (rc) 44714a71df50SFrank Blaschka goto register_err; 44724a71df50SFrank Blaschka 4473683d718aSFrank Blaschka qeth_core_header_cache = kmem_cache_create("qeth_hdr", 4474683d718aSFrank Blaschka sizeof(struct qeth_hdr) + ETH_HLEN, 64, 0, NULL); 4475683d718aSFrank Blaschka if (!qeth_core_header_cache) { 4476683d718aSFrank Blaschka rc = -ENOMEM; 4477683d718aSFrank Blaschka goto slab_err; 4478683d718aSFrank Blaschka } 4479683d718aSFrank Blaschka 4480683d718aSFrank Blaschka return 0; 4481683d718aSFrank Blaschka slab_err: 4482683d718aSFrank Blaschka s390_root_dev_unregister(qeth_core_root_dev); 44834a71df50SFrank Blaschka register_err: 44844a71df50SFrank Blaschka driver_remove_file(&qeth_core_ccwgroup_driver.driver, 44854a71df50SFrank Blaschka &driver_attr_group); 44864a71df50SFrank Blaschka driver_err: 44874a71df50SFrank Blaschka ccwgroup_driver_unregister(&qeth_core_ccwgroup_driver); 44884a71df50SFrank Blaschka ccwgroup_err: 44894a71df50SFrank Blaschka ccw_driver_unregister(&qeth_ccw_driver); 44904a71df50SFrank Blaschka ccw_err: 44914a71df50SFrank Blaschka qeth_unregister_dbf_views(); 44924a71df50SFrank Blaschka out_err: 44934a71df50SFrank Blaschka PRINT_ERR("Initialization failed with code %d\n", rc); 44944a71df50SFrank Blaschka return rc; 44954a71df50SFrank Blaschka } 44964a71df50SFrank Blaschka 44974a71df50SFrank Blaschka static void __exit qeth_core_exit(void) 44984a71df50SFrank Blaschka { 44994a71df50SFrank Blaschka s390_root_dev_unregister(qeth_core_root_dev); 45004a71df50SFrank Blaschka driver_remove_file(&qeth_core_ccwgroup_driver.driver, 45014a71df50SFrank Blaschka &driver_attr_group); 45024a71df50SFrank Blaschka ccwgroup_driver_unregister(&qeth_core_ccwgroup_driver); 45034a71df50SFrank Blaschka ccw_driver_unregister(&qeth_ccw_driver); 4504683d718aSFrank Blaschka kmem_cache_destroy(qeth_core_header_cache); 45054a71df50SFrank Blaschka qeth_unregister_dbf_views(); 45064a71df50SFrank Blaschka PRINT_INFO("core functions removed\n"); 45074a71df50SFrank Blaschka } 45084a71df50SFrank Blaschka 45094a71df50SFrank Blaschka module_init(qeth_core_init); 45104a71df50SFrank Blaschka module_exit(qeth_core_exit); 45114a71df50SFrank Blaschka MODULE_AUTHOR("Frank Blaschka <frank.blaschka@de.ibm.com>"); 45124a71df50SFrank Blaschka MODULE_DESCRIPTION("qeth core functions"); 45134a71df50SFrank Blaschka MODULE_LICENSE("GPL"); 4514