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