1ab9953ffSGreg Kroah-Hartman // SPDX-License-Identifier: GPL-2.0 24a71df50SFrank Blaschka /* 3bbcfcdc8SFrank Blaschka * Copyright IBM Corp. 2007, 2009 44a71df50SFrank Blaschka * Author(s): Utz Bacher <utz.bacher@de.ibm.com>, 54a71df50SFrank Blaschka * Frank Pavlic <fpavlic@de.ibm.com>, 64a71df50SFrank Blaschka * Thomas Spatzier <tspat@de.ibm.com>, 74a71df50SFrank Blaschka * Frank Blaschka <frank.blaschka@de.ibm.com> 84a71df50SFrank Blaschka */ 94a71df50SFrank Blaschka 1074eacdb9SFrank Blaschka #define KMSG_COMPONENT "qeth" 1174eacdb9SFrank Blaschka #define pr_fmt(fmt) KMSG_COMPONENT ": " fmt 1274eacdb9SFrank Blaschka 134a71df50SFrank Blaschka #include <linux/module.h> 144a71df50SFrank Blaschka #include <linux/moduleparam.h> 154a71df50SFrank Blaschka #include <linux/string.h> 164a71df50SFrank Blaschka #include <linux/errno.h> 174a71df50SFrank Blaschka #include <linux/kernel.h> 185a0e3ad6STejun Heo #include <linux/slab.h> 194a71df50SFrank Blaschka #include <linux/etherdevice.h> 20ccffad25SJiri Pirko #include <linux/list.h> 21fe5c8028SLakhvich Dmitriy #include <linux/hash.h> 22fe5c8028SLakhvich Dmitriy #include <linux/hashtable.h> 23ec61bd2fSJulian Wiedmann #include <asm/setup.h> 244a71df50SFrank Blaschka #include "qeth_core.h" 25b4d72c08SEugene Crosser #include "qeth_l2.h" 264a71df50SFrank Blaschka 274a71df50SFrank Blaschka static int qeth_l2_set_offline(struct ccwgroup_device *); 284a71df50SFrank Blaschka static int qeth_l2_stop(struct net_device *); 29c044dc21SEugene Crosser static void qeth_bridgeport_query_support(struct qeth_card *card); 30c044dc21SEugene Crosser static void qeth_bridge_state_change(struct qeth_card *card, 31c044dc21SEugene Crosser struct qeth_ipa_cmd *cmd); 32c044dc21SEugene Crosser static void qeth_bridge_host_event(struct qeth_card *card, 33c044dc21SEugene Crosser struct qeth_ipa_cmd *cmd); 34caa1f0b1SHans Wippel static void qeth_l2_vnicc_set_defaults(struct qeth_card *card); 35a45b3fafSHans Wippel static void qeth_l2_vnicc_init(struct qeth_card *card); 36349d13d5SHans Wippel static bool qeth_l2_vnicc_recover_timeout(struct qeth_card *card, u32 vnicc, 37349d13d5SHans Wippel u32 *timeout); 384a71df50SFrank Blaschka 394a71df50SFrank Blaschka static struct net_device *qeth_l2_netdev_by_devno(unsigned char *read_dev_no) 404a71df50SFrank Blaschka { 414a71df50SFrank Blaschka struct qeth_card *card; 424a71df50SFrank Blaschka struct net_device *ndev; 43f06f6f32SCornelia Huck __u16 temp_dev_no; 444a71df50SFrank Blaschka unsigned long flags; 45f06f6f32SCornelia Huck struct ccw_dev_id read_devid; 464a71df50SFrank Blaschka 474a71df50SFrank Blaschka ndev = NULL; 484a71df50SFrank Blaschka memcpy(&temp_dev_no, read_dev_no, 2); 494a71df50SFrank Blaschka read_lock_irqsave(&qeth_core_card_list.rwlock, flags); 504a71df50SFrank Blaschka list_for_each_entry(card, &qeth_core_card_list.list, list) { 51f06f6f32SCornelia Huck ccw_device_get_id(CARD_RDEV(card), &read_devid); 52f06f6f32SCornelia Huck if (read_devid.devno == temp_dev_no) { 534a71df50SFrank Blaschka ndev = card->dev; 544a71df50SFrank Blaschka break; 554a71df50SFrank Blaschka } 564a71df50SFrank Blaschka } 574a71df50SFrank Blaschka read_unlock_irqrestore(&qeth_core_card_list.rwlock, flags); 584a71df50SFrank Blaschka return ndev; 594a71df50SFrank Blaschka } 604a71df50SFrank Blaschka 612aa48671SJulian Wiedmann static int qeth_setdelmac_makerc(struct qeth_card *card, int retcode) 624a71df50SFrank Blaschka { 63efbbc1d5SEugene Crosser int rc; 644a71df50SFrank Blaschka 65efbbc1d5SEugene Crosser if (retcode) 661aec42bcSThomas Richter QETH_CARD_TEXT_(card, 2, "err%04x", retcode); 67efbbc1d5SEugene Crosser switch (retcode) { 68efbbc1d5SEugene Crosser case IPA_RC_SUCCESS: 69efbbc1d5SEugene Crosser rc = 0; 70efbbc1d5SEugene Crosser break; 71efbbc1d5SEugene Crosser case IPA_RC_L2_UNSUPPORTED_CMD: 72ffb95251SEugene Crosser rc = -EOPNOTSUPP; 73efbbc1d5SEugene Crosser break; 74efbbc1d5SEugene Crosser case IPA_RC_L2_ADDR_TABLE_FULL: 75efbbc1d5SEugene Crosser rc = -ENOSPC; 76efbbc1d5SEugene Crosser break; 77efbbc1d5SEugene Crosser case IPA_RC_L2_DUP_MAC: 78efbbc1d5SEugene Crosser case IPA_RC_L2_DUP_LAYER3_MAC: 79efbbc1d5SEugene Crosser rc = -EEXIST; 80efbbc1d5SEugene Crosser break; 81efbbc1d5SEugene Crosser case IPA_RC_L2_MAC_NOT_AUTH_BY_HYP: 82efbbc1d5SEugene Crosser case IPA_RC_L2_MAC_NOT_AUTH_BY_ADP: 83efbbc1d5SEugene Crosser rc = -EPERM; 84efbbc1d5SEugene Crosser break; 85efbbc1d5SEugene Crosser case IPA_RC_L2_MAC_NOT_FOUND: 86efbbc1d5SEugene Crosser rc = -ENOENT; 87efbbc1d5SEugene Crosser break; 881aec42bcSThomas Richter case -ENOMEM: 891aec42bcSThomas Richter rc = -ENOMEM; 901aec42bcSThomas Richter break; 91efbbc1d5SEugene Crosser default: 92efbbc1d5SEugene Crosser rc = -EIO; 93efbbc1d5SEugene Crosser break; 944a71df50SFrank Blaschka } 95efbbc1d5SEugene Crosser return rc; 964a71df50SFrank Blaschka } 974a71df50SFrank Blaschka 98ac988d78SJulian Wiedmann static int qeth_l2_send_setdelmac(struct qeth_card *card, __u8 *mac, 99ac988d78SJulian Wiedmann enum qeth_ipa_cmds ipacmd) 100ac988d78SJulian Wiedmann { 101ac988d78SJulian Wiedmann struct qeth_ipa_cmd *cmd; 102ac988d78SJulian Wiedmann struct qeth_cmd_buffer *iob; 103ac988d78SJulian Wiedmann 104ac988d78SJulian Wiedmann QETH_CARD_TEXT(card, 2, "L2sdmac"); 105ac988d78SJulian Wiedmann iob = qeth_get_ipacmd_buffer(card, ipacmd, QETH_PROT_IPV4); 106ac988d78SJulian Wiedmann if (!iob) 107ac988d78SJulian Wiedmann return -ENOMEM; 108ff5caa7aSJulian Wiedmann cmd = __ipa_cmd(iob); 10999f0b85dSJulian Wiedmann cmd->data.setdelmac.mac_length = ETH_ALEN; 11099f0b85dSJulian Wiedmann ether_addr_copy(cmd->data.setdelmac.mac, mac); 1112aa48671SJulian Wiedmann return qeth_setdelmac_makerc(card, qeth_send_ipa_cmd(card, iob, 112ac988d78SJulian Wiedmann NULL, NULL)); 113ac988d78SJulian Wiedmann } 114ac988d78SJulian Wiedmann 115ac988d78SJulian Wiedmann static int qeth_l2_send_setmac(struct qeth_card *card, __u8 *mac) 116ac988d78SJulian Wiedmann { 117ac988d78SJulian Wiedmann int rc; 118ac988d78SJulian Wiedmann 119ac988d78SJulian Wiedmann QETH_CARD_TEXT(card, 2, "L2Setmac"); 120ac988d78SJulian Wiedmann rc = qeth_l2_send_setdelmac(card, mac, IPA_CMD_SETVMAC); 121ac988d78SJulian Wiedmann if (rc == 0) { 122ac988d78SJulian Wiedmann dev_info(&card->gdev->dev, 123ac988d78SJulian Wiedmann "MAC address %pM successfully registered on device %s\n", 124bcacfcbcSJulian Wiedmann mac, card->dev->name); 125ac988d78SJulian Wiedmann } else { 126ac988d78SJulian Wiedmann switch (rc) { 127ac988d78SJulian Wiedmann case -EEXIST: 128ac988d78SJulian Wiedmann dev_warn(&card->gdev->dev, 129ac988d78SJulian Wiedmann "MAC address %pM already exists\n", mac); 130ac988d78SJulian Wiedmann break; 131ac988d78SJulian Wiedmann case -EPERM: 132ac988d78SJulian Wiedmann dev_warn(&card->gdev->dev, 133ac988d78SJulian Wiedmann "MAC address %pM is not authorized\n", mac); 134ac988d78SJulian Wiedmann break; 135ac988d78SJulian Wiedmann } 136ac988d78SJulian Wiedmann } 137ac988d78SJulian Wiedmann return rc; 138ac988d78SJulian Wiedmann } 139ac988d78SJulian Wiedmann 1408174aa8aSJulian Wiedmann static int qeth_l2_write_mac(struct qeth_card *card, u8 *mac) 1414a71df50SFrank Blaschka { 1429d0a58fbSVasily Gorbik enum qeth_ipa_cmds cmd = is_multicast_ether_addr(mac) ? 1438174aa8aSJulian Wiedmann IPA_CMD_SETGMAC : IPA_CMD_SETVMAC; 144efbbc1d5SEugene Crosser int rc; 145efbbc1d5SEugene Crosser 1468174aa8aSJulian Wiedmann QETH_CARD_TEXT(card, 2, "L2Wmac"); 1478174aa8aSJulian Wiedmann rc = qeth_l2_send_setdelmac(card, mac, cmd); 148efbbc1d5SEugene Crosser if (rc == -EEXIST) 149e19e5be8SJulian Wiedmann QETH_DBF_MESSAGE(2, "MAC already registered on device %x\n", 150e19e5be8SJulian Wiedmann CARD_DEVID(card)); 151efbbc1d5SEugene Crosser else if (rc) 152e19e5be8SJulian Wiedmann QETH_DBF_MESSAGE(2, "Failed to register MAC on device %x: %d\n", 153e19e5be8SJulian Wiedmann CARD_DEVID(card), rc); 154efbbc1d5SEugene Crosser return rc; 1554a71df50SFrank Blaschka } 1564a71df50SFrank Blaschka 1578174aa8aSJulian Wiedmann static int qeth_l2_remove_mac(struct qeth_card *card, u8 *mac) 1584a71df50SFrank Blaschka { 1599d0a58fbSVasily Gorbik enum qeth_ipa_cmds cmd = is_multicast_ether_addr(mac) ? 1608174aa8aSJulian Wiedmann IPA_CMD_DELGMAC : IPA_CMD_DELVMAC; 161efbbc1d5SEugene Crosser int rc; 162efbbc1d5SEugene Crosser 1638174aa8aSJulian Wiedmann QETH_CARD_TEXT(card, 2, "L2Rmac"); 1648174aa8aSJulian Wiedmann rc = qeth_l2_send_setdelmac(card, mac, cmd); 165efbbc1d5SEugene Crosser if (rc) 166e19e5be8SJulian Wiedmann QETH_DBF_MESSAGE(2, "Failed to delete MAC on device %u: %d\n", 167e19e5be8SJulian Wiedmann CARD_DEVID(card), rc); 168efbbc1d5SEugene Crosser return rc; 1694a71df50SFrank Blaschka } 1704a71df50SFrank Blaschka 171c07cbf2eSJulian Wiedmann static void qeth_l2_del_all_macs(struct qeth_card *card) 1724a71df50SFrank Blaschka { 173fe5c8028SLakhvich Dmitriy struct qeth_mac *mac; 174fe5c8028SLakhvich Dmitriy struct hlist_node *tmp; 175fe5c8028SLakhvich Dmitriy int i; 1764a71df50SFrank Blaschka 1774a71df50SFrank Blaschka spin_lock_bh(&card->mclock); 178fe5c8028SLakhvich Dmitriy hash_for_each_safe(card->mac_htable, i, tmp, mac, hnode) { 179fe5c8028SLakhvich Dmitriy hash_del(&mac->hnode); 180fe5c8028SLakhvich Dmitriy kfree(mac); 1814a71df50SFrank Blaschka } 1824a71df50SFrank Blaschka spin_unlock_bh(&card->mclock); 1834a71df50SFrank Blaschka } 1844a71df50SFrank Blaschka 185cef6ff22SJulian Wiedmann static int qeth_l2_get_cast_type(struct qeth_card *card, struct sk_buff *skb) 1864a71df50SFrank Blaschka { 187ce73e10eSKlaus-Dieter Wacker if (card->info.type == QETH_CARD_TYPE_OSN) 18886c0cdb9SJulian Wiedmann return RTN_UNICAST; 189ce73e10eSKlaus-Dieter Wacker if (is_broadcast_ether_addr(skb->data)) 190ce73e10eSKlaus-Dieter Wacker return RTN_BROADCAST; 191ce73e10eSKlaus-Dieter Wacker if (is_multicast_ether_addr(skb->data)) 192ce73e10eSKlaus-Dieter Wacker return RTN_MULTICAST; 19386c0cdb9SJulian Wiedmann return RTN_UNICAST; 1944a71df50SFrank Blaschka } 1954a71df50SFrank Blaschka 196fc69660bSJulian Wiedmann static void qeth_l2_fill_header(struct qeth_card *card, struct qeth_hdr *hdr, 197fc69660bSJulian Wiedmann struct sk_buff *skb, int ipv, int cast_type, 198fc69660bSJulian Wiedmann unsigned int data_len) 1994a71df50SFrank Blaschka { 2000aef8392SJulian Wiedmann struct vlan_ethhdr *veth = vlan_eth_hdr(skb); 2014a71df50SFrank Blaschka 202ae79fe03SJulian Wiedmann hdr->hdr.l2.pkt_length = data_len; 2034a71df50SFrank Blaschka 2040aef8392SJulian Wiedmann if (skb_is_gso(skb)) { 2050aef8392SJulian Wiedmann hdr->hdr.l2.id = QETH_HEADER_TYPE_L2_TSO; 2060aef8392SJulian Wiedmann } else { 2070aef8392SJulian Wiedmann hdr->hdr.l2.id = QETH_HEADER_TYPE_LAYER2; 208fc69660bSJulian Wiedmann if (skb->ip_summed == CHECKSUM_PARTIAL) { 209fc69660bSJulian Wiedmann qeth_tx_csum(skb, &hdr->hdr.l2.flags[1], ipv); 210fc69660bSJulian Wiedmann if (card->options.performance_stats) 211fc69660bSJulian Wiedmann card->perf_stats.tx_csum++; 212fc69660bSJulian Wiedmann } 2130aef8392SJulian Wiedmann } 214fc69660bSJulian Wiedmann 2154a71df50SFrank Blaschka /* set byte byte 3 to casting flags */ 2164a71df50SFrank Blaschka if (cast_type == RTN_MULTICAST) 2174a71df50SFrank Blaschka hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_MULTICAST; 2184a71df50SFrank Blaschka else if (cast_type == RTN_BROADCAST) 2194a71df50SFrank Blaschka hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_BROADCAST; 2204a71df50SFrank Blaschka else 221ce73e10eSKlaus-Dieter Wacker hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_UNICAST; 2224a71df50SFrank Blaschka 2234a71df50SFrank Blaschka /* VSWITCH relies on the VLAN 2244a71df50SFrank Blaschka * information to be present in 2254a71df50SFrank Blaschka * the QDIO header */ 2264a71df50SFrank Blaschka if (veth->h_vlan_proto == __constant_htons(ETH_P_8021Q)) { 2274a71df50SFrank Blaschka hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_VLAN; 2284a71df50SFrank Blaschka hdr->hdr.l2.vlan_id = ntohs(veth->h_vlan_TCI); 2294a71df50SFrank Blaschka } 2304a71df50SFrank Blaschka } 2314a71df50SFrank Blaschka 2322aa48671SJulian Wiedmann static int qeth_setdelvlan_makerc(struct qeth_card *card, int retcode) 2334a71df50SFrank Blaschka { 2342aa48671SJulian Wiedmann if (retcode) 2352aa48671SJulian Wiedmann QETH_CARD_TEXT_(card, 2, "err%04x", retcode); 2362aa48671SJulian Wiedmann 2372aa48671SJulian Wiedmann switch (retcode) { 2382aa48671SJulian Wiedmann case IPA_RC_SUCCESS: 2392aa48671SJulian Wiedmann return 0; 2402aa48671SJulian Wiedmann case IPA_RC_L2_INVALID_VLAN_ID: 2412aa48671SJulian Wiedmann return -EINVAL; 2422aa48671SJulian Wiedmann case IPA_RC_L2_DUP_VLAN_ID: 2432aa48671SJulian Wiedmann return -EEXIST; 2442aa48671SJulian Wiedmann case IPA_RC_L2_VLAN_ID_NOT_FOUND: 2452aa48671SJulian Wiedmann return -ENOENT; 2462aa48671SJulian Wiedmann case IPA_RC_L2_VLAN_ID_NOT_ALLOWED: 2472aa48671SJulian Wiedmann return -EPERM; 2482aa48671SJulian Wiedmann case -ENOMEM: 2492aa48671SJulian Wiedmann return -ENOMEM; 2502aa48671SJulian Wiedmann default: 2512aa48671SJulian Wiedmann return -EIO; 2522aa48671SJulian Wiedmann } 2532aa48671SJulian Wiedmann } 2542aa48671SJulian Wiedmann 2552aa48671SJulian Wiedmann static int qeth_l2_send_setdelvlan_cb(struct qeth_card *card, 2562aa48671SJulian Wiedmann struct qeth_reply *reply, 2572aa48671SJulian Wiedmann unsigned long data) 2582aa48671SJulian Wiedmann { 2592aa48671SJulian Wiedmann struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *) data; 2604a71df50SFrank Blaschka 261847a50fdSCarsten Otte QETH_CARD_TEXT(card, 2, "L2sdvcb"); 2624a71df50SFrank Blaschka if (cmd->hdr.return_code) { 263e19e5be8SJulian Wiedmann QETH_DBF_MESSAGE(2, "Error in processing VLAN %u on device %x: %#x.\n", 2642aa48671SJulian Wiedmann cmd->data.setdelvlan.vlan_id, 265e19e5be8SJulian Wiedmann CARD_DEVID(card), cmd->hdr.return_code); 266847a50fdSCarsten Otte QETH_CARD_TEXT_(card, 2, "L2VL%4x", cmd->hdr.command); 267847a50fdSCarsten Otte QETH_CARD_TEXT_(card, 2, "err%d", cmd->hdr.return_code); 2684a71df50SFrank Blaschka } 2694a71df50SFrank Blaschka return 0; 2704a71df50SFrank Blaschka } 2714a71df50SFrank Blaschka 2724a71df50SFrank Blaschka static int qeth_l2_send_setdelvlan(struct qeth_card *card, __u16 i, 2734a71df50SFrank Blaschka enum qeth_ipa_cmds ipacmd) 2744a71df50SFrank Blaschka { 2754a71df50SFrank Blaschka struct qeth_ipa_cmd *cmd; 2764a71df50SFrank Blaschka struct qeth_cmd_buffer *iob; 2774a71df50SFrank Blaschka 278847a50fdSCarsten Otte QETH_CARD_TEXT_(card, 4, "L2sdv%x", ipacmd); 2794a71df50SFrank Blaschka iob = qeth_get_ipacmd_buffer(card, ipacmd, QETH_PROT_IPV4); 2801aec42bcSThomas Richter if (!iob) 2811aec42bcSThomas Richter return -ENOMEM; 282ff5caa7aSJulian Wiedmann cmd = __ipa_cmd(iob); 2834a71df50SFrank Blaschka cmd->data.setdelvlan.vlan_id = i; 2842aa48671SJulian Wiedmann return qeth_setdelvlan_makerc(card, qeth_send_ipa_cmd(card, iob, 2852aa48671SJulian Wiedmann qeth_l2_send_setdelvlan_cb, NULL)); 2864a71df50SFrank Blaschka } 2874a71df50SFrank Blaschka 28870919e23SUrsula Braun static void qeth_l2_process_vlans(struct qeth_card *card) 2894a71df50SFrank Blaschka { 2904a71df50SFrank Blaschka struct qeth_vlan_vid *id; 291d4ac0246SJulian Wiedmann 292847a50fdSCarsten Otte QETH_CARD_TEXT(card, 3, "L2prcvln"); 293d4ac0246SJulian Wiedmann mutex_lock(&card->vid_list_mutex); 2944a71df50SFrank Blaschka list_for_each_entry(id, &card->vid_list, list) { 29570919e23SUrsula Braun qeth_l2_send_setdelvlan(card, id->vid, IPA_CMD_SETVLAN); 2964a71df50SFrank Blaschka } 297d4ac0246SJulian Wiedmann mutex_unlock(&card->vid_list_mutex); 2984a71df50SFrank Blaschka } 2994a71df50SFrank Blaschka 30080d5c368SPatrick McHardy static int qeth_l2_vlan_rx_add_vid(struct net_device *dev, 30180d5c368SPatrick McHardy __be16 proto, u16 vid) 3024a71df50SFrank Blaschka { 303509e2562SHeiko Carstens struct qeth_card *card = dev->ml_priv; 3044a71df50SFrank Blaschka struct qeth_vlan_vid *id; 3051aec42bcSThomas Richter int rc; 3064a71df50SFrank Blaschka 307847a50fdSCarsten Otte QETH_CARD_TEXT_(card, 4, "aid:%d", vid); 30810651db7SUrsula Braun if (!vid) 3098e586137SJiri Pirko return 0; 3108e98ac48SUrsula Braun if (qeth_wait_for_threads(card, QETH_RECOVER_THREAD)) { 311847a50fdSCarsten Otte QETH_CARD_TEXT(card, 3, "aidREC"); 3128e586137SJiri Pirko return 0; 3138e98ac48SUrsula Braun } 314d4ac0246SJulian Wiedmann id = kmalloc(sizeof(*id), GFP_KERNEL); 3154a71df50SFrank Blaschka if (id) { 3164a71df50SFrank Blaschka id->vid = vid; 3171aec42bcSThomas Richter rc = qeth_l2_send_setdelvlan(card, vid, IPA_CMD_SETVLAN); 3181aec42bcSThomas Richter if (rc) { 3191aec42bcSThomas Richter kfree(id); 3201aec42bcSThomas Richter return rc; 3211aec42bcSThomas Richter } 322d4ac0246SJulian Wiedmann mutex_lock(&card->vid_list_mutex); 3234a71df50SFrank Blaschka list_add_tail(&id->list, &card->vid_list); 324d4ac0246SJulian Wiedmann mutex_unlock(&card->vid_list_mutex); 3258e586137SJiri Pirko } else { 3268e586137SJiri Pirko return -ENOMEM; 3274a71df50SFrank Blaschka } 3288e586137SJiri Pirko return 0; 3294a71df50SFrank Blaschka } 3304a71df50SFrank Blaschka 33180d5c368SPatrick McHardy static int qeth_l2_vlan_rx_kill_vid(struct net_device *dev, 33280d5c368SPatrick McHardy __be16 proto, u16 vid) 3334a71df50SFrank Blaschka { 3344a71df50SFrank Blaschka struct qeth_vlan_vid *id, *tmpid = NULL; 335509e2562SHeiko Carstens struct qeth_card *card = dev->ml_priv; 3361aec42bcSThomas Richter int rc = 0; 3374a71df50SFrank Blaschka 338847a50fdSCarsten Otte QETH_CARD_TEXT_(card, 4, "kid:%d", vid); 3398e98ac48SUrsula Braun if (qeth_wait_for_threads(card, QETH_RECOVER_THREAD)) { 340847a50fdSCarsten Otte QETH_CARD_TEXT(card, 3, "kidREC"); 3418e586137SJiri Pirko return 0; 3428e98ac48SUrsula Braun } 343d4ac0246SJulian Wiedmann mutex_lock(&card->vid_list_mutex); 3444a71df50SFrank Blaschka list_for_each_entry(id, &card->vid_list, list) { 3454a71df50SFrank Blaschka if (id->vid == vid) { 3464a71df50SFrank Blaschka list_del(&id->list); 3474a71df50SFrank Blaschka tmpid = id; 3484a71df50SFrank Blaschka break; 3494a71df50SFrank Blaschka } 3504a71df50SFrank Blaschka } 351d4ac0246SJulian Wiedmann mutex_unlock(&card->vid_list_mutex); 3524a71df50SFrank Blaschka if (tmpid) { 3531aec42bcSThomas Richter rc = qeth_l2_send_setdelvlan(card, vid, IPA_CMD_DELVLAN); 3544a71df50SFrank Blaschka kfree(tmpid); 3554a71df50SFrank Blaschka } 3561aec42bcSThomas Richter return rc; 3574a71df50SFrank Blaschka } 3584a71df50SFrank Blaschka 359b2f4de8bSPeter Senna Tschudin static void qeth_l2_stop_card(struct qeth_card *card, int recovery_mode) 3604a71df50SFrank Blaschka { 361d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP , 2, "stopcard"); 362d11ba0c4SPeter Tiedemann QETH_DBF_HEX(SETUP, 2, &card, sizeof(void *)); 3634a71df50SFrank Blaschka 3644a71df50SFrank Blaschka qeth_set_allowed_threads(card, 0, 1); 3654a71df50SFrank Blaschka if (card->read.state == CH_STATE_UP && 3664a71df50SFrank Blaschka card->write.state == CH_STATE_UP && 3674a71df50SFrank Blaschka (card->state == CARD_STATE_UP)) { 3684a71df50SFrank Blaschka if (recovery_mode && 3694a71df50SFrank Blaschka card->info.type != QETH_CARD_TYPE_OSN) { 3704a71df50SFrank Blaschka qeth_l2_stop(card->dev); 3714a71df50SFrank Blaschka } else { 3724a71df50SFrank Blaschka rtnl_lock(); 3734a71df50SFrank Blaschka dev_close(card->dev); 3744a71df50SFrank Blaschka rtnl_unlock(); 3754a71df50SFrank Blaschka } 37670919e23SUrsula Braun card->info.mac_bits &= ~QETH_LAYER2_MAC_REGISTERED; 3774a71df50SFrank Blaschka card->state = CARD_STATE_SOFTSETUP; 3784a71df50SFrank Blaschka } 3794a71df50SFrank Blaschka if (card->state == CARD_STATE_SOFTSETUP) { 380c07cbf2eSJulian Wiedmann qeth_l2_del_all_macs(card); 3814a71df50SFrank Blaschka qeth_clear_ipacmd_list(card); 3824a71df50SFrank Blaschka card->state = CARD_STATE_HARDSETUP; 3834a71df50SFrank Blaschka } 3844a71df50SFrank Blaschka if (card->state == CARD_STATE_HARDSETUP) { 3854a71df50SFrank Blaschka qeth_qdio_clear_card(card, 0); 3864a71df50SFrank Blaschka qeth_clear_qdio_buffers(card); 3874a71df50SFrank Blaschka qeth_clear_working_pool_list(card); 3884a71df50SFrank Blaschka card->state = CARD_STATE_DOWN; 3894a71df50SFrank Blaschka } 3904a71df50SFrank Blaschka if (card->state == CARD_STATE_DOWN) { 3914a71df50SFrank Blaschka qeth_clear_cmd_buffers(&card->read); 3924a71df50SFrank Blaschka qeth_clear_cmd_buffers(&card->write); 3934a71df50SFrank Blaschka } 3944a71df50SFrank Blaschka } 3954a71df50SFrank Blaschka 396a1c3ed4cSFrank Blaschka static int qeth_l2_process_inbound_buffer(struct qeth_card *card, 397a1c3ed4cSFrank Blaschka int budget, int *done) 3984a71df50SFrank Blaschka { 399a1c3ed4cSFrank Blaschka int work_done = 0; 4004a71df50SFrank Blaschka struct sk_buff *skb; 4014a71df50SFrank Blaschka struct qeth_hdr *hdr; 4024a71df50SFrank Blaschka unsigned int len; 4034a71df50SFrank Blaschka 404a1c3ed4cSFrank Blaschka *done = 0; 40518af5c17SStefan Raspl WARN_ON_ONCE(!budget); 406a1c3ed4cSFrank Blaschka while (budget) { 407a1c3ed4cSFrank Blaschka skb = qeth_core_get_next_skb(card, 408b3332930SFrank Blaschka &card->qdio.in_q->bufs[card->rx.b_index], 409a1c3ed4cSFrank Blaschka &card->rx.b_element, &card->rx.e_offset, &hdr); 410a1c3ed4cSFrank Blaschka if (!skb) { 411a1c3ed4cSFrank Blaschka *done = 1; 412a1c3ed4cSFrank Blaschka break; 4134a71df50SFrank Blaschka } 4144a71df50SFrank Blaschka switch (hdr->hdr.l2.id) { 4154a71df50SFrank Blaschka case QETH_HEADER_TYPE_LAYER2: 4164a71df50SFrank Blaschka skb->protocol = eth_type_trans(skb, skb->dev); 4176195b936SJulian Wiedmann qeth_rx_csum(card, skb, hdr->hdr.l2.flags[1]); 41812883725SUrsula Braun if (skb->protocol == htons(ETH_P_802_2)) 4194a71df50SFrank Blaschka *((__u32 *)skb->cb) = ++card->seqno.pkt_seqno; 4204a71df50SFrank Blaschka len = skb->len; 4219abfa8cbSThomas Richter napi_gro_receive(&card->napi, skb); 4224a71df50SFrank Blaschka break; 4234a71df50SFrank Blaschka case QETH_HEADER_TYPE_OSN: 4242d488c2fSUrsula Braun if (card->info.type == QETH_CARD_TYPE_OSN) { 4254a71df50SFrank Blaschka skb_push(skb, sizeof(struct qeth_hdr)); 4264a71df50SFrank Blaschka skb_copy_to_linear_data(skb, hdr, 4274a71df50SFrank Blaschka sizeof(struct qeth_hdr)); 4284a71df50SFrank Blaschka len = skb->len; 4294a71df50SFrank Blaschka card->osn_info.data_cb(skb); 4304a71df50SFrank Blaschka break; 4312d488c2fSUrsula Braun } 4322d488c2fSUrsula Braun /* else unknown */ 4334a71df50SFrank Blaschka default: 4344a71df50SFrank Blaschka dev_kfree_skb_any(skb); 435847a50fdSCarsten Otte QETH_CARD_TEXT(card, 3, "inbunkno"); 4360ac1487cSJulian Wiedmann QETH_DBF_HEX(CTRL, 3, hdr, sizeof(*hdr)); 4374a71df50SFrank Blaschka continue; 4384a71df50SFrank Blaschka } 439a1c3ed4cSFrank Blaschka work_done++; 440a1c3ed4cSFrank Blaschka budget--; 4414a71df50SFrank Blaschka card->stats.rx_packets++; 4424a71df50SFrank Blaschka card->stats.rx_bytes += len; 4434a71df50SFrank Blaschka } 444a1c3ed4cSFrank Blaschka return work_done; 445a1c3ed4cSFrank Blaschka } 446a1c3ed4cSFrank Blaschka 4474a71df50SFrank Blaschka static int qeth_l2_request_initial_mac(struct qeth_card *card) 4484a71df50SFrank Blaschka { 4494a71df50SFrank Blaschka int rc = 0; 4504a71df50SFrank Blaschka 451ec61bd2fSJulian Wiedmann QETH_DBF_TEXT(SETUP, 2, "l2reqmac"); 452d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "doL2%s", CARD_BUS_ID(card)); 4534a71df50SFrank Blaschka 454ec61bd2fSJulian Wiedmann if (MACHINE_IS_VM) { 455ec61bd2fSJulian Wiedmann rc = qeth_vm_request_mac(card); 456ec61bd2fSJulian Wiedmann if (!rc) 457ec61bd2fSJulian Wiedmann goto out; 458e19e5be8SJulian Wiedmann QETH_DBF_MESSAGE(2, "z/VM MAC Service failed on device %x: %#x\n", 459e19e5be8SJulian Wiedmann CARD_DEVID(card), rc); 460ec61bd2fSJulian Wiedmann QETH_DBF_TEXT_(SETUP, 2, "err%04x", rc); 461ec61bd2fSJulian Wiedmann /* fall back to alternative mechanism: */ 462ec61bd2fSJulian Wiedmann } 463ec61bd2fSJulian Wiedmann 4645113fec0SUrsula Braun if (card->info.type == QETH_CARD_TYPE_IQD || 4655113fec0SUrsula Braun card->info.type == QETH_CARD_TYPE_OSM || 4665113fec0SUrsula Braun card->info.type == QETH_CARD_TYPE_OSX || 4675113fec0SUrsula Braun card->info.guestlan) { 4684a71df50SFrank Blaschka rc = qeth_setadpparms_change_macaddr(card); 46921b1702aSJulian Wiedmann if (!rc) 47021b1702aSJulian Wiedmann goto out; 471e19e5be8SJulian Wiedmann QETH_DBF_MESSAGE(2, "READ_MAC Assist failed on device %x: %#x\n", 472e19e5be8SJulian Wiedmann CARD_DEVID(card), rc); 4731aec42bcSThomas Richter QETH_DBF_TEXT_(SETUP, 2, "1err%04x", rc); 47421b1702aSJulian Wiedmann /* fall back once more: */ 4754a71df50SFrank Blaschka } 47621b1702aSJulian Wiedmann 47721b1702aSJulian Wiedmann /* some devices don't support a custom MAC address: */ 47821b1702aSJulian Wiedmann if (card->info.type == QETH_CARD_TYPE_OSM || 47921b1702aSJulian Wiedmann card->info.type == QETH_CARD_TYPE_OSX) 48021b1702aSJulian Wiedmann return (rc) ? rc : -EADDRNOTAVAIL; 48121b1702aSJulian Wiedmann eth_hw_addr_random(card->dev); 48221b1702aSJulian Wiedmann 483ec61bd2fSJulian Wiedmann out: 484ec61bd2fSJulian Wiedmann QETH_DBF_HEX(SETUP, 2, card->dev->dev_addr, card->dev->addr_len); 4854a71df50SFrank Blaschka return 0; 4864a71df50SFrank Blaschka } 4874a71df50SFrank Blaschka 4884a71df50SFrank Blaschka static int qeth_l2_set_mac_address(struct net_device *dev, void *p) 4894a71df50SFrank Blaschka { 4904a71df50SFrank Blaschka struct sockaddr *addr = p; 491509e2562SHeiko Carstens struct qeth_card *card = dev->ml_priv; 492bcacfcbcSJulian Wiedmann u8 old_addr[ETH_ALEN]; 4934a71df50SFrank Blaschka int rc = 0; 4944a71df50SFrank Blaschka 495847a50fdSCarsten Otte QETH_CARD_TEXT(card, 3, "setmac"); 4964a71df50SFrank Blaschka 4975113fec0SUrsula Braun if (card->info.type == QETH_CARD_TYPE_OSN || 4985113fec0SUrsula Braun card->info.type == QETH_CARD_TYPE_OSM || 4995113fec0SUrsula Braun card->info.type == QETH_CARD_TYPE_OSX) { 500847a50fdSCarsten Otte QETH_CARD_TEXT(card, 3, "setmcTYP"); 5014a71df50SFrank Blaschka return -EOPNOTSUPP; 5024a71df50SFrank Blaschka } 50399f0b85dSJulian Wiedmann QETH_CARD_HEX(card, 3, addr->sa_data, ETH_ALEN); 504bcacfcbcSJulian Wiedmann if (!is_valid_ether_addr(addr->sa_data)) 505bcacfcbcSJulian Wiedmann return -EADDRNOTAVAIL; 506bcacfcbcSJulian Wiedmann 5078e98ac48SUrsula Braun if (qeth_wait_for_threads(card, QETH_RECOVER_THREAD)) { 508847a50fdSCarsten Otte QETH_CARD_TEXT(card, 3, "setmcREC"); 5098e98ac48SUrsula Braun return -ERESTARTSYS; 5108e98ac48SUrsula Braun } 511bcacfcbcSJulian Wiedmann 5124789a218SJulian Wiedmann /* avoid racing against concurrent state change: */ 5134789a218SJulian Wiedmann if (!mutex_trylock(&card->conf_mutex)) 5144789a218SJulian Wiedmann return -EAGAIN; 5154789a218SJulian Wiedmann 516bcacfcbcSJulian Wiedmann if (!qeth_card_hw_is_reachable(card)) { 517bcacfcbcSJulian Wiedmann ether_addr_copy(dev->dev_addr, addr->sa_data); 5184789a218SJulian Wiedmann goto out_unlock; 519bcacfcbcSJulian Wiedmann } 520bcacfcbcSJulian Wiedmann 521bcacfcbcSJulian Wiedmann /* don't register the same address twice */ 522bcacfcbcSJulian Wiedmann if (ether_addr_equal_64bits(dev->dev_addr, addr->sa_data) && 523bcacfcbcSJulian Wiedmann (card->info.mac_bits & QETH_LAYER2_MAC_REGISTERED)) 5244789a218SJulian Wiedmann goto out_unlock; 525bcacfcbcSJulian Wiedmann 526bcacfcbcSJulian Wiedmann /* add the new address, switch over, drop the old */ 5274a71df50SFrank Blaschka rc = qeth_l2_send_setmac(card, addr->sa_data); 528bcacfcbcSJulian Wiedmann if (rc) 5294789a218SJulian Wiedmann goto out_unlock; 530bcacfcbcSJulian Wiedmann ether_addr_copy(old_addr, dev->dev_addr); 531bcacfcbcSJulian Wiedmann ether_addr_copy(dev->dev_addr, addr->sa_data); 532bcacfcbcSJulian Wiedmann 533bcacfcbcSJulian Wiedmann if (card->info.mac_bits & QETH_LAYER2_MAC_REGISTERED) 534bcacfcbcSJulian Wiedmann qeth_l2_remove_mac(card, old_addr); 535bcacfcbcSJulian Wiedmann card->info.mac_bits |= QETH_LAYER2_MAC_REGISTERED; 5364789a218SJulian Wiedmann 5374789a218SJulian Wiedmann out_unlock: 5384789a218SJulian Wiedmann mutex_unlock(&card->conf_mutex); 5394789a218SJulian Wiedmann return rc; 5404a71df50SFrank Blaschka } 5414a71df50SFrank Blaschka 5420db587b0SEugene Crosser static void qeth_promisc_to_bridge(struct qeth_card *card) 5430db587b0SEugene Crosser { 5440db587b0SEugene Crosser struct net_device *dev = card->dev; 5450db587b0SEugene Crosser enum qeth_ipa_promisc_modes promisc_mode; 5460db587b0SEugene Crosser int role; 5470db587b0SEugene Crosser int rc; 5480db587b0SEugene Crosser 5490db587b0SEugene Crosser QETH_CARD_TEXT(card, 3, "pmisc2br"); 5500db587b0SEugene Crosser 5510db587b0SEugene Crosser if (!card->options.sbp.reflect_promisc) 5520db587b0SEugene Crosser return; 5530db587b0SEugene Crosser promisc_mode = (dev->flags & IFF_PROMISC) ? SET_PROMISC_MODE_ON 5540db587b0SEugene Crosser : SET_PROMISC_MODE_OFF; 5550db587b0SEugene Crosser if (promisc_mode == card->info.promisc_mode) 5560db587b0SEugene Crosser return; 5570db587b0SEugene Crosser 5580db587b0SEugene Crosser if (promisc_mode == SET_PROMISC_MODE_ON) { 5590db587b0SEugene Crosser if (card->options.sbp.reflect_promisc_primary) 5600db587b0SEugene Crosser role = QETH_SBP_ROLE_PRIMARY; 5610db587b0SEugene Crosser else 5620db587b0SEugene Crosser role = QETH_SBP_ROLE_SECONDARY; 5630db587b0SEugene Crosser } else 5640db587b0SEugene Crosser role = QETH_SBP_ROLE_NONE; 5650db587b0SEugene Crosser 5660db587b0SEugene Crosser rc = qeth_bridgeport_setrole(card, role); 5670db587b0SEugene Crosser QETH_DBF_TEXT_(SETUP, 2, "bpm%c%04x", 5680db587b0SEugene Crosser (promisc_mode == SET_PROMISC_MODE_ON) ? '+' : '-', rc); 5690db587b0SEugene Crosser if (!rc) { 5700db587b0SEugene Crosser card->options.sbp.role = role; 5710db587b0SEugene Crosser card->info.promisc_mode = promisc_mode; 5720db587b0SEugene Crosser } 573fe5c8028SLakhvich Dmitriy 574fe5c8028SLakhvich Dmitriy } 575fe5c8028SLakhvich Dmitriy /* New MAC address is added to the hash table and marked to be written on card 576fe5c8028SLakhvich Dmitriy * only if there is not in the hash table storage already 577fe5c8028SLakhvich Dmitriy * 578fe5c8028SLakhvich Dmitriy */ 5794641b027SJulian Wiedmann static void qeth_l2_add_mac(struct qeth_card *card, struct netdev_hw_addr *ha) 580fe5c8028SLakhvich Dmitriy { 581cef6ff22SJulian Wiedmann u32 mac_hash = get_unaligned((u32 *)(&ha->addr[2])); 582fe5c8028SLakhvich Dmitriy struct qeth_mac *mac; 583fe5c8028SLakhvich Dmitriy 584cef6ff22SJulian Wiedmann hash_for_each_possible(card->mac_htable, mac, hnode, mac_hash) { 58599f0b85dSJulian Wiedmann if (ether_addr_equal_64bits(ha->addr, mac->mac_addr)) { 5865f78e29cSLakhvich Dmitriy mac->disp_flag = QETH_DISP_ADDR_DO_NOTHING; 587fe5c8028SLakhvich Dmitriy return; 588fe5c8028SLakhvich Dmitriy } 5890db587b0SEugene Crosser } 5900db587b0SEugene Crosser 591fe5c8028SLakhvich Dmitriy mac = kzalloc(sizeof(struct qeth_mac), GFP_ATOMIC); 592fe5c8028SLakhvich Dmitriy if (!mac) 593fe5c8028SLakhvich Dmitriy return; 594fe5c8028SLakhvich Dmitriy 59599f0b85dSJulian Wiedmann ether_addr_copy(mac->mac_addr, ha->addr); 5965f78e29cSLakhvich Dmitriy mac->disp_flag = QETH_DISP_ADDR_ADD; 597fe5c8028SLakhvich Dmitriy 598cef6ff22SJulian Wiedmann hash_add(card->mac_htable, &mac->hnode, mac_hash); 599fe5c8028SLakhvich Dmitriy } 600fe5c8028SLakhvich Dmitriy 601fe5c8028SLakhvich Dmitriy static void qeth_l2_set_rx_mode(struct net_device *dev) 6024a71df50SFrank Blaschka { 603509e2562SHeiko Carstens struct qeth_card *card = dev->ml_priv; 604ccffad25SJiri Pirko struct netdev_hw_addr *ha; 605fe5c8028SLakhvich Dmitriy struct qeth_mac *mac; 606fe5c8028SLakhvich Dmitriy struct hlist_node *tmp; 607fe5c8028SLakhvich Dmitriy int i; 608fe5c8028SLakhvich Dmitriy int rc; 6094a71df50SFrank Blaschka 6104a71df50SFrank Blaschka if (card->info.type == QETH_CARD_TYPE_OSN) 6114a71df50SFrank Blaschka return; 6124a71df50SFrank Blaschka 613847a50fdSCarsten Otte QETH_CARD_TEXT(card, 3, "setmulti"); 6148e98ac48SUrsula Braun if (qeth_threads_running(card, QETH_RECOVER_THREAD) && 6158e98ac48SUrsula Braun (card->state != CARD_STATE_UP)) 6168e98ac48SUrsula Braun return; 617fe5c8028SLakhvich Dmitriy 6184a71df50SFrank Blaschka spin_lock_bh(&card->mclock); 619fe5c8028SLakhvich Dmitriy 62022bedad3SJiri Pirko netdev_for_each_mc_addr(ha, dev) 6214641b027SJulian Wiedmann qeth_l2_add_mac(card, ha); 62232e7bfc4SJiri Pirko netdev_for_each_uc_addr(ha, dev) 6234641b027SJulian Wiedmann qeth_l2_add_mac(card, ha); 624fe5c8028SLakhvich Dmitriy 625fe5c8028SLakhvich Dmitriy hash_for_each_safe(card->mac_htable, i, tmp, mac, hnode) { 62600c163f1SJulian Wiedmann switch (mac->disp_flag) { 62700c163f1SJulian Wiedmann case QETH_DISP_ADDR_DELETE: 6288174aa8aSJulian Wiedmann qeth_l2_remove_mac(card, mac->mac_addr); 629fe5c8028SLakhvich Dmitriy hash_del(&mac->hnode); 630fe5c8028SLakhvich Dmitriy kfree(mac); 63100c163f1SJulian Wiedmann break; 63200c163f1SJulian Wiedmann case QETH_DISP_ADDR_ADD: 6338174aa8aSJulian Wiedmann rc = qeth_l2_write_mac(card, mac->mac_addr); 634fe5c8028SLakhvich Dmitriy if (rc) { 635fe5c8028SLakhvich Dmitriy hash_del(&mac->hnode); 636fe5c8028SLakhvich Dmitriy kfree(mac); 63700c163f1SJulian Wiedmann break; 63800c163f1SJulian Wiedmann } 63900c163f1SJulian Wiedmann /* fall through */ 64000c163f1SJulian Wiedmann default: 64100c163f1SJulian Wiedmann /* for next call to set_rx_mode(): */ 6425f78e29cSLakhvich Dmitriy mac->disp_flag = QETH_DISP_ADDR_DELETE; 64300c163f1SJulian Wiedmann } 644fe5c8028SLakhvich Dmitriy } 6457db2266aSFrank Blaschka 6464a71df50SFrank Blaschka spin_unlock_bh(&card->mclock); 647fe5c8028SLakhvich Dmitriy 6480db587b0SEugene Crosser if (qeth_adp_supported(card, IPA_SETADP_SET_PROMISC_MODE)) 6494a71df50SFrank Blaschka qeth_setadp_promisc_mode(card); 6500db587b0SEugene Crosser else 6510db587b0SEugene Crosser qeth_promisc_to_bridge(card); 6524a71df50SFrank Blaschka } 6534a71df50SFrank Blaschka 6547286384bSJulian Wiedmann static int qeth_l2_xmit_osn(struct qeth_card *card, struct sk_buff *skb, 6557286384bSJulian Wiedmann struct qeth_qdio_out_q *queue) 6567286384bSJulian Wiedmann { 65769d7ce80SJulian Wiedmann struct qeth_hdr *hdr = (struct qeth_hdr *)skb->data; 65869d7ce80SJulian Wiedmann addr_t end = (addr_t)(skb->data + sizeof(*hdr)); 65969d7ce80SJulian Wiedmann addr_t start = (addr_t)skb->data; 66069d7ce80SJulian Wiedmann unsigned int elements = 0; 66169d7ce80SJulian Wiedmann unsigned int hd_len = 0; 66269d7ce80SJulian Wiedmann int rc; 6637286384bSJulian Wiedmann 6647286384bSJulian Wiedmann if (skb->protocol == htons(ETH_P_IPV6)) 6657286384bSJulian Wiedmann return -EPROTONOSUPPORT; 6667286384bSJulian Wiedmann 66769d7ce80SJulian Wiedmann if (qeth_get_elements_for_range(start, end) > 1) { 66869d7ce80SJulian Wiedmann /* Misaligned HW header, move it to its own buffer element. */ 66969d7ce80SJulian Wiedmann hdr = kmem_cache_alloc(qeth_core_header_cache, GFP_ATOMIC); 67069d7ce80SJulian Wiedmann if (!hdr) 67169d7ce80SJulian Wiedmann return -ENOMEM; 67269d7ce80SJulian Wiedmann hd_len = sizeof(*hdr); 67369d7ce80SJulian Wiedmann skb_copy_from_linear_data(skb, (char *)hdr, hd_len); 67469d7ce80SJulian Wiedmann elements++; 67569d7ce80SJulian Wiedmann } 67669d7ce80SJulian Wiedmann 67769d7ce80SJulian Wiedmann elements += qeth_count_elements(skb, hd_len); 67869d7ce80SJulian Wiedmann if (elements > QETH_MAX_BUFFER_ELEMENTS(card)) { 67969d7ce80SJulian Wiedmann rc = -E2BIG; 68069d7ce80SJulian Wiedmann goto out; 68169d7ce80SJulian Wiedmann } 68269d7ce80SJulian Wiedmann 68369d7ce80SJulian Wiedmann rc = qeth_do_send_packet(card, queue, skb, hdr, hd_len, hd_len, 68469d7ce80SJulian Wiedmann elements); 68569d7ce80SJulian Wiedmann out: 68669d7ce80SJulian Wiedmann if (rc && hd_len) 68769d7ce80SJulian Wiedmann kmem_cache_free(qeth_core_header_cache, hdr); 68869d7ce80SJulian Wiedmann return rc; 6897286384bSJulian Wiedmann } 6907286384bSJulian Wiedmann 691e38db6beSJulian Wiedmann static netdev_tx_t qeth_l2_hard_start_xmit(struct sk_buff *skb, 692e38db6beSJulian Wiedmann struct net_device *dev) 6934a71df50SFrank Blaschka { 694509e2562SHeiko Carstens struct qeth_card *card = dev->ml_priv; 695ce73e10eSKlaus-Dieter Wacker int cast_type = qeth_l2_get_cast_type(card, skb); 696571f9dd8SKittipon Meesompop int ipv = qeth_get_ip_version(skb); 697290b8348SStefan Raspl struct qeth_qdio_out_q *queue; 6984a71df50SFrank Blaschka int tx_bytes = skb->len; 6997286384bSJulian Wiedmann int rc; 7004a71df50SFrank Blaschka 70191cc98f5SJulian Wiedmann if (card->state != CARD_STATE_UP) { 7024a71df50SFrank Blaschka card->stats.tx_carrier_errors++; 7034a71df50SFrank Blaschka goto tx_drop; 7044a71df50SFrank Blaschka } 7054a71df50SFrank Blaschka 70686c0cdb9SJulian Wiedmann queue = qeth_get_tx_queue(card, skb, ipv, cast_type); 70786c0cdb9SJulian Wiedmann 7084a71df50SFrank Blaschka if (card->options.performance_stats) { 7094a71df50SFrank Blaschka card->perf_stats.outbound_cnt++; 7104a71df50SFrank Blaschka card->perf_stats.outbound_start_time = qeth_get_micros(); 7114a71df50SFrank Blaschka } 7124a71df50SFrank Blaschka netif_stop_queue(dev); 7134a71df50SFrank Blaschka 7145f89eca5SJulian Wiedmann if (IS_OSN(card)) 7157286384bSJulian Wiedmann rc = qeth_l2_xmit_osn(card, skb, queue); 7165f89eca5SJulian Wiedmann else 717fc69660bSJulian Wiedmann rc = qeth_xmit(card, skb, queue, ipv, cast_type, 718fc69660bSJulian Wiedmann qeth_l2_fill_header); 7194a71df50SFrank Blaschka 7204a71df50SFrank Blaschka if (!rc) { 7214a71df50SFrank Blaschka card->stats.tx_packets++; 7224a71df50SFrank Blaschka card->stats.tx_bytes += tx_bytes; 7234a71df50SFrank Blaschka if (card->options.performance_stats) 7244a71df50SFrank Blaschka card->perf_stats.outbound_time += qeth_get_micros() - 7254a71df50SFrank Blaschka card->perf_stats.outbound_start_time; 7267286384bSJulian Wiedmann netif_wake_queue(dev); 7277286384bSJulian Wiedmann return NETDEV_TX_OK; 7287286384bSJulian Wiedmann } else if (rc == -EBUSY) { 7297286384bSJulian Wiedmann return NETDEV_TX_BUSY; 7307286384bSJulian Wiedmann } /* else fall through */ 7314a71df50SFrank Blaschka 7324a71df50SFrank Blaschka tx_drop: 7334a71df50SFrank Blaschka card->stats.tx_dropped++; 7344a71df50SFrank Blaschka card->stats.tx_errors++; 7354a71df50SFrank Blaschka dev_kfree_skb_any(skb); 736d0ec0f54SFrank Blaschka netif_wake_queue(dev); 7374a71df50SFrank Blaschka return NETDEV_TX_OK; 7384a71df50SFrank Blaschka } 7394a71df50SFrank Blaschka 74039423440SUrsula Braun static int __qeth_l2_open(struct net_device *dev) 7414a71df50SFrank Blaschka { 742509e2562SHeiko Carstens struct qeth_card *card = dev->ml_priv; 743a1c3ed4cSFrank Blaschka int rc = 0; 7444a71df50SFrank Blaschka 745847a50fdSCarsten Otte QETH_CARD_TEXT(card, 4, "qethopen"); 74639423440SUrsula Braun if (card->state == CARD_STATE_UP) 74739423440SUrsula Braun return rc; 7484a71df50SFrank Blaschka if (card->state != CARD_STATE_SOFTSETUP) 7494a71df50SFrank Blaschka return -ENODEV; 7504a71df50SFrank Blaschka 7514a71df50SFrank Blaschka if ((card->info.type != QETH_CARD_TYPE_OSN) && 7524a71df50SFrank Blaschka (!(card->info.mac_bits & QETH_LAYER2_MAC_REGISTERED))) { 753847a50fdSCarsten Otte QETH_CARD_TEXT(card, 4, "nomacadr"); 7544a71df50SFrank Blaschka return -EPERM; 7554a71df50SFrank Blaschka } 7564a71df50SFrank Blaschka card->data.state = CH_STATE_UP; 7574a71df50SFrank Blaschka card->state = CARD_STATE_UP; 7584a71df50SFrank Blaschka netif_start_queue(dev); 7594a71df50SFrank Blaschka 760a1c3ed4cSFrank Blaschka if (qdio_stop_irq(card->data.ccwdev, 0) >= 0) { 761a1c3ed4cSFrank Blaschka napi_enable(&card->napi); 7624d19db77SJulian Wiedmann local_bh_disable(); 763a1c3ed4cSFrank Blaschka napi_schedule(&card->napi); 7644d19db77SJulian Wiedmann /* kick-start the NAPI softirq: */ 7654d19db77SJulian Wiedmann local_bh_enable(); 766a1c3ed4cSFrank Blaschka } else 767a1c3ed4cSFrank Blaschka rc = -EIO; 768a1c3ed4cSFrank Blaschka return rc; 7694a71df50SFrank Blaschka } 7704a71df50SFrank Blaschka 77139423440SUrsula Braun static int qeth_l2_open(struct net_device *dev) 77239423440SUrsula Braun { 77339423440SUrsula Braun struct qeth_card *card = dev->ml_priv; 77439423440SUrsula Braun 77539423440SUrsula Braun QETH_CARD_TEXT(card, 5, "qethope_"); 77639423440SUrsula Braun if (qeth_wait_for_threads(card, QETH_RECOVER_THREAD)) { 77739423440SUrsula Braun QETH_CARD_TEXT(card, 3, "openREC"); 77839423440SUrsula Braun return -ERESTARTSYS; 77939423440SUrsula Braun } 78039423440SUrsula Braun return __qeth_l2_open(dev); 78139423440SUrsula Braun } 78239423440SUrsula Braun 7834a71df50SFrank Blaschka static int qeth_l2_stop(struct net_device *dev) 7844a71df50SFrank Blaschka { 785509e2562SHeiko Carstens struct qeth_card *card = dev->ml_priv; 7864a71df50SFrank Blaschka 787847a50fdSCarsten Otte QETH_CARD_TEXT(card, 4, "qethstop"); 7884a71df50SFrank Blaschka netif_tx_disable(dev); 789a1c3ed4cSFrank Blaschka if (card->state == CARD_STATE_UP) { 7904a71df50SFrank Blaschka card->state = CARD_STATE_SOFTSETUP; 791a1c3ed4cSFrank Blaschka napi_disable(&card->napi); 792a1c3ed4cSFrank Blaschka } 7934a71df50SFrank Blaschka return 0; 7944a71df50SFrank Blaschka } 7954a71df50SFrank Blaschka 7962d2ebb3eSJulian Wiedmann static const struct device_type qeth_l2_devtype = { 7972d2ebb3eSJulian Wiedmann .name = "qeth_layer2", 7982d2ebb3eSJulian Wiedmann .groups = qeth_l2_attr_groups, 7992d2ebb3eSJulian Wiedmann }; 8002d2ebb3eSJulian Wiedmann 8014a71df50SFrank Blaschka static int qeth_l2_probe_device(struct ccwgroup_device *gdev) 8024a71df50SFrank Blaschka { 8034a71df50SFrank Blaschka struct qeth_card *card = dev_get_drvdata(&gdev->dev); 8049111e788SUrsula Braun int rc; 8054a71df50SFrank Blaschka 8062d2ebb3eSJulian Wiedmann if (gdev->dev.type == &qeth_generic_devtype) { 8079111e788SUrsula Braun rc = qeth_l2_create_device_attributes(&gdev->dev); 8089111e788SUrsula Braun if (rc) 8099111e788SUrsula Braun return rc; 8102d2ebb3eSJulian Wiedmann } 8114a71df50SFrank Blaschka INIT_LIST_HEAD(&card->vid_list); 812fe5c8028SLakhvich Dmitriy hash_init(card->mac_htable); 8131da74b1cSFrank Blaschka card->info.hwtrap = 0; 814caa1f0b1SHans Wippel qeth_l2_vnicc_set_defaults(card); 8154a71df50SFrank Blaschka return 0; 8164a71df50SFrank Blaschka } 8174a71df50SFrank Blaschka 8184a71df50SFrank Blaschka static void qeth_l2_remove_device(struct ccwgroup_device *cgdev) 8194a71df50SFrank Blaschka { 8204a71df50SFrank Blaschka struct qeth_card *card = dev_get_drvdata(&cgdev->dev); 8214a71df50SFrank Blaschka 8222d2ebb3eSJulian Wiedmann if (cgdev->dev.type == &qeth_generic_devtype) 823b4d72c08SEugene Crosser qeth_l2_remove_device_attributes(&cgdev->dev); 824f2148565SUrsula Braun qeth_set_allowed_threads(card, 0, 1); 8254a71df50SFrank Blaschka wait_event(card->wait_q, qeth_threads_running(card, 0xffffffff) == 0); 8264a71df50SFrank Blaschka 82770919e23SUrsula Braun if (cgdev->state == CCWGROUP_ONLINE) 8284a71df50SFrank Blaschka qeth_l2_set_offline(cgdev); 82930356d08SJulian Wiedmann if (qeth_netdev_is_registered(card->dev)) 8304a71df50SFrank Blaschka unregister_netdev(card->dev); 8314a71df50SFrank Blaschka } 8324a71df50SFrank Blaschka 8330fc0b732SStephen Hemminger static const struct ethtool_ops qeth_l2_ethtool_ops = { 8344a71df50SFrank Blaschka .get_link = ethtool_op_get_link, 8354a71df50SFrank Blaschka .get_strings = qeth_core_get_strings, 8364a71df50SFrank Blaschka .get_ethtool_stats = qeth_core_get_ethtool_stats, 837df8b4ec8SBen Hutchings .get_sset_count = qeth_core_get_sset_count, 8384a71df50SFrank Blaschka .get_drvinfo = qeth_core_get_drvinfo, 839993e19c0SJulian Wiedmann .get_link_ksettings = qeth_core_ethtool_get_link_ksettings, 8404a71df50SFrank Blaschka }; 8414a71df50SFrank Blaschka 8420fc0b732SStephen Hemminger static const struct ethtool_ops qeth_l2_osn_ops = { 8434a71df50SFrank Blaschka .get_strings = qeth_core_get_strings, 8444a71df50SFrank Blaschka .get_ethtool_stats = qeth_core_get_ethtool_stats, 845df8b4ec8SBen Hutchings .get_sset_count = qeth_core_get_sset_count, 8464a71df50SFrank Blaschka .get_drvinfo = qeth_core_get_drvinfo, 8474a71df50SFrank Blaschka }; 8484a71df50SFrank Blaschka 8493d58cefdSFrank Blaschka static const struct net_device_ops qeth_l2_netdev_ops = { 8508403b13cSFrank Blaschka .ndo_open = qeth_l2_open, 8518403b13cSFrank Blaschka .ndo_stop = qeth_l2_stop, 8528403b13cSFrank Blaschka .ndo_get_stats = qeth_get_stats, 8538403b13cSFrank Blaschka .ndo_start_xmit = qeth_l2_hard_start_xmit, 8546d69b1f1SJulian Wiedmann .ndo_features_check = qeth_features_check, 8558403b13cSFrank Blaschka .ndo_validate_addr = eth_validate_addr, 856fe5c8028SLakhvich Dmitriy .ndo_set_rx_mode = qeth_l2_set_rx_mode, 857942d6984SJulian Wiedmann .ndo_do_ioctl = qeth_do_ioctl, 8588403b13cSFrank Blaschka .ndo_set_mac_address = qeth_l2_set_mac_address, 8598403b13cSFrank Blaschka .ndo_vlan_rx_add_vid = qeth_l2_vlan_rx_add_vid, 8608403b13cSFrank Blaschka .ndo_vlan_rx_kill_vid = qeth_l2_vlan_rx_kill_vid, 8618403b13cSFrank Blaschka .ndo_tx_timeout = qeth_tx_timeout, 8628f43fb00SThomas Richter .ndo_fix_features = qeth_fix_features, 8638f43fb00SThomas Richter .ndo_set_features = qeth_set_features 8648403b13cSFrank Blaschka }; 8658403b13cSFrank Blaschka 8664a71df50SFrank Blaschka static int qeth_l2_setup_netdev(struct qeth_card *card) 8674a71df50SFrank Blaschka { 868d3d1b205SJulian Wiedmann int rc; 8694a71df50SFrank Blaschka 87030356d08SJulian Wiedmann if (qeth_netdev_is_registered(card->dev)) 871d3d1b205SJulian Wiedmann return 0; 8724a71df50SFrank Blaschka 873d3aacac4SJulian Wiedmann card->dev->priv_flags |= IFF_UNICAST_FLT; 8748403b13cSFrank Blaschka card->dev->netdev_ops = &qeth_l2_netdev_ops; 87525e2c341SJulian Wiedmann if (card->info.type == QETH_CARD_TYPE_OSN) { 87625e2c341SJulian Wiedmann card->dev->ethtool_ops = &qeth_l2_osn_ops; 87725e2c341SJulian Wiedmann card->dev->flags |= IFF_NOARP; 87825e2c341SJulian Wiedmann } else { 87925e2c341SJulian Wiedmann card->dev->ethtool_ops = &qeth_l2_ethtool_ops; 8805f89eca5SJulian Wiedmann card->dev->needed_headroom = sizeof(struct qeth_hdr); 88125e2c341SJulian Wiedmann } 8829400c53fSJulian Wiedmann 8839400c53fSJulian Wiedmann if (card->info.type == QETH_CARD_TYPE_OSM) 8849400c53fSJulian Wiedmann card->dev->features |= NETIF_F_VLAN_CHALLENGED; 8859400c53fSJulian Wiedmann else 886f646968fSPatrick McHardy card->dev->features |= NETIF_F_HW_VLAN_CTAG_FILTER; 8870f342945SJulian Wiedmann 8884d7def2aSThomas Richter if (card->info.type == QETH_CARD_TYPE_OSD && !card->info.guestlan) { 8896d69b1f1SJulian Wiedmann card->dev->features |= NETIF_F_SG; 8908f43fb00SThomas Richter /* OSA 3S and earlier has no RX/TX support */ 8919bdc4411SHans Wippel if (qeth_is_supported(card, IPA_OUTBOUND_CHECKSUM)) { 8928f43fb00SThomas Richter card->dev->hw_features |= NETIF_F_IP_CSUM; 8939bdc4411SHans Wippel card->dev->vlan_features |= NETIF_F_IP_CSUM; 8949bdc4411SHans Wippel } 8954d7def2aSThomas Richter } 896571f9dd8SKittipon Meesompop if (qeth_is_supported6(card, IPA_OUTBOUND_CHECKSUM_V6)) { 897571f9dd8SKittipon Meesompop card->dev->hw_features |= NETIF_F_IPV6_CSUM; 898571f9dd8SKittipon Meesompop card->dev->vlan_features |= NETIF_F_IPV6_CSUM; 899571f9dd8SKittipon Meesompop } 900d7e6ed97SKittipon Meesompop if (qeth_is_supported(card, IPA_INBOUND_CHECKSUM) || 901d7e6ed97SKittipon Meesompop qeth_is_supported6(card, IPA_INBOUND_CHECKSUM_V6)) { 902d7e6ed97SKittipon Meesompop card->dev->hw_features |= NETIF_F_RXCSUM; 903d7e6ed97SKittipon Meesompop card->dev->vlan_features |= NETIF_F_RXCSUM; 904d7e6ed97SKittipon Meesompop } 9050aef8392SJulian Wiedmann if (qeth_is_supported(card, IPA_OUTBOUND_TSO)) { 9060aef8392SJulian Wiedmann card->dev->hw_features |= NETIF_F_TSO; 9070aef8392SJulian Wiedmann card->dev->vlan_features |= NETIF_F_TSO; 9080aef8392SJulian Wiedmann } 9090aef8392SJulian Wiedmann if (qeth_is_supported6(card, IPA_OUTBOUND_TSO)) { 9100aef8392SJulian Wiedmann card->dev->hw_features |= NETIF_F_TSO6; 9110aef8392SJulian Wiedmann card->dev->vlan_features |= NETIF_F_TSO6; 9120aef8392SJulian Wiedmann } 9130aef8392SJulian Wiedmann 9140aef8392SJulian Wiedmann if (card->dev->hw_features & (NETIF_F_TSO | NETIF_F_TSO6)) { 9150aef8392SJulian Wiedmann card->dev->needed_headroom = sizeof(struct qeth_hdr_tso); 9160aef8392SJulian Wiedmann netif_set_gso_max_size(card->dev, 9170aef8392SJulian Wiedmann PAGE_SIZE * (QDIO_MAX_ELEMENTS_PER_BUFFER - 1)); 9180aef8392SJulian Wiedmann } 9190d6f02d3SJulian Wiedmann 9204a71df50SFrank Blaschka qeth_l2_request_initial_mac(card); 921d73ef324SJulian Wiedmann netif_napi_add(card->dev, &card->napi, qeth_poll, QETH_NAPI_WEIGHT); 922d3d1b205SJulian Wiedmann rc = register_netdev(card->dev); 923d3d1b205SJulian Wiedmann if (rc) 924d3d1b205SJulian Wiedmann card->dev->netdev_ops = NULL; 925d3d1b205SJulian Wiedmann return rc; 9264a71df50SFrank Blaschka } 9274a71df50SFrank Blaschka 9284d7def2aSThomas Richter static int qeth_l2_start_ipassists(struct qeth_card *card) 9294d7def2aSThomas Richter { 9304d7def2aSThomas Richter /* configure isolation level */ 9314d7def2aSThomas Richter if (qeth_set_access_ctrl_online(card, 0)) 9324d7def2aSThomas Richter return -ENODEV; 9334d7def2aSThomas Richter return 0; 9344d7def2aSThomas Richter } 9354d7def2aSThomas Richter 936521c10eaSJulian Wiedmann static void qeth_l2_trace_features(struct qeth_card *card) 937521c10eaSJulian Wiedmann { 938a45b3fafSHans Wippel /* Set BridgePort features */ 939a45b3fafSHans Wippel QETH_CARD_TEXT(card, 2, "featuSBP"); 940521c10eaSJulian Wiedmann QETH_CARD_HEX(card, 2, &card->options.sbp.supported_funcs, 941521c10eaSJulian Wiedmann sizeof(card->options.sbp.supported_funcs)); 942a45b3fafSHans Wippel /* VNIC Characteristics features */ 943a45b3fafSHans Wippel QETH_CARD_TEXT(card, 2, "feaVNICC"); 944a45b3fafSHans Wippel QETH_CARD_HEX(card, 2, &card->options.vnicc.sup_chars, 945a45b3fafSHans Wippel sizeof(card->options.vnicc.sup_chars)); 946521c10eaSJulian Wiedmann } 947521c10eaSJulian Wiedmann 9484a71df50SFrank Blaschka static int __qeth_l2_set_online(struct ccwgroup_device *gdev, int recovery_mode) 9494a71df50SFrank Blaschka { 9504a71df50SFrank Blaschka struct qeth_card *card = dev_get_drvdata(&gdev->dev); 9514a71df50SFrank Blaschka int rc = 0; 9524a71df50SFrank Blaschka enum qeth_card_states recover_flag; 9534a71df50SFrank Blaschka 9549dc48cccSUrsula Braun mutex_lock(&card->discipline_mutex); 955c4949f07SFrank Blaschka mutex_lock(&card->conf_mutex); 956d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "setonlin"); 957d11ba0c4SPeter Tiedemann QETH_DBF_HEX(SETUP, 2, &card, sizeof(void *)); 9584a71df50SFrank Blaschka 9594a71df50SFrank Blaschka recover_flag = card->state; 9604a71df50SFrank Blaschka rc = qeth_core_hardsetup_card(card); 9614a71df50SFrank Blaschka if (rc) { 9621aec42bcSThomas Richter QETH_DBF_TEXT_(SETUP, 2, "2err%04x", rc); 963aa909224SUrsula Braun rc = -ENODEV; 9644a71df50SFrank Blaschka goto out_remove; 9654a71df50SFrank Blaschka } 966c044dc21SEugene Crosser qeth_bridgeport_query_support(card); 967c044dc21SEugene Crosser if (card->options.sbp.supported_funcs) 968c044dc21SEugene Crosser dev_info(&card->gdev->dev, 9699c23f4daSEugene Crosser "The device represents a Bridge Capable Port\n"); 9704a71df50SFrank Blaschka 971d3d1b205SJulian Wiedmann rc = qeth_l2_setup_netdev(card); 972d3d1b205SJulian Wiedmann if (rc) 9734a71df50SFrank Blaschka goto out_remove; 9744a71df50SFrank Blaschka 975bcacfcbcSJulian Wiedmann if (card->info.type != QETH_CARD_TYPE_OSN && 976bcacfcbcSJulian Wiedmann !qeth_l2_send_setmac(card, card->dev->dev_addr)) 977bcacfcbcSJulian Wiedmann card->info.mac_bits |= QETH_LAYER2_MAC_REGISTERED; 9784a71df50SFrank Blaschka 9791da74b1cSFrank Blaschka if (qeth_is_diagass_supported(card, QETH_DIAGS_CMD_TRAP)) { 9801da74b1cSFrank Blaschka if (card->info.hwtrap && 9811da74b1cSFrank Blaschka qeth_hw_trap(card, QETH_DIAGS_TRAP_ARM)) 9821da74b1cSFrank Blaschka card->info.hwtrap = 0; 9831da74b1cSFrank Blaschka } else 9841da74b1cSFrank Blaschka card->info.hwtrap = 0; 9851da74b1cSFrank Blaschka 986a45b3fafSHans Wippel /* for the rx_bcast characteristic, init VNICC after setmac */ 987a45b3fafSHans Wippel qeth_l2_vnicc_init(card); 988a45b3fafSHans Wippel 989a45b3fafSHans Wippel qeth_trace_features(card); 990a45b3fafSHans Wippel qeth_l2_trace_features(card); 991a45b3fafSHans Wippel 992b4d72c08SEugene Crosser qeth_l2_setup_bridgeport_attrs(card); 993b4d72c08SEugene Crosser 9944a71df50SFrank Blaschka card->state = CARD_STATE_HARDSETUP; 9954a71df50SFrank Blaschka qeth_print_status_message(card); 9964a71df50SFrank Blaschka 9974a71df50SFrank Blaschka /* softsetup */ 998d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "softsetp"); 9994a71df50SFrank Blaschka 10005113fec0SUrsula Braun if ((card->info.type == QETH_CARD_TYPE_OSD) || 10010f54761dSStefan Raspl (card->info.type == QETH_CARD_TYPE_OSX)) { 10028f43fb00SThomas Richter rc = qeth_l2_start_ipassists(card); 10038f43fb00SThomas Richter if (rc) 10040f54761dSStefan Raspl goto out_remove; 10050f54761dSStefan Raspl } 10065113fec0SUrsula Braun 10079400c53fSJulian Wiedmann if (card->info.type != QETH_CARD_TYPE_OSN) 100870919e23SUrsula Braun qeth_l2_process_vlans(card); 10094a71df50SFrank Blaschka 10104a71df50SFrank Blaschka netif_tx_disable(card->dev); 10114a71df50SFrank Blaschka 10124a71df50SFrank Blaschka rc = qeth_init_qdio_queues(card); 10134a71df50SFrank Blaschka if (rc) { 1014d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "6err%d", rc); 1015aa909224SUrsula Braun rc = -ENODEV; 10164a71df50SFrank Blaschka goto out_remove; 10174a71df50SFrank Blaschka } 10184a71df50SFrank Blaschka card->state = CARD_STATE_SOFTSETUP; 10194a71df50SFrank Blaschka 10204a71df50SFrank Blaschka qeth_set_allowed_threads(card, 0xffffffff, 0); 1021d025da9eSJulian Wiedmann 1022d025da9eSJulian Wiedmann qeth_enable_hw_features(card->dev); 10234a71df50SFrank Blaschka if (recover_flag == CARD_STATE_RECOVER) { 10244a71df50SFrank Blaschka if (recovery_mode && 10254a71df50SFrank Blaschka card->info.type != QETH_CARD_TYPE_OSN) { 102639423440SUrsula Braun __qeth_l2_open(card->dev); 10279aa17df3SJulian Wiedmann qeth_l2_set_rx_mode(card->dev); 10284a71df50SFrank Blaschka } else { 10294a71df50SFrank Blaschka rtnl_lock(); 10304a71df50SFrank Blaschka dev_open(card->dev); 10314a71df50SFrank Blaschka rtnl_unlock(); 10324a71df50SFrank Blaschka } 10334a71df50SFrank Blaschka } 10344a71df50SFrank Blaschka /* let user_space know that device is online */ 10354a71df50SFrank Blaschka kobject_uevent(&gdev->dev.kobj, KOBJ_CHANGE); 1036c4949f07SFrank Blaschka mutex_unlock(&card->conf_mutex); 10379dc48cccSUrsula Braun mutex_unlock(&card->discipline_mutex); 10384a71df50SFrank Blaschka return 0; 1039aa909224SUrsula Braun 10404a71df50SFrank Blaschka out_remove: 10414a71df50SFrank Blaschka qeth_l2_stop_card(card, 0); 10424a71df50SFrank Blaschka ccw_device_set_offline(CARD_DDEV(card)); 10434a71df50SFrank Blaschka ccw_device_set_offline(CARD_WDEV(card)); 10444a71df50SFrank Blaschka ccw_device_set_offline(CARD_RDEV(card)); 104522ae2790SUrsula Braun qdio_free(CARD_DDEV(card)); 10464a71df50SFrank Blaschka if (recover_flag == CARD_STATE_RECOVER) 10474a71df50SFrank Blaschka card->state = CARD_STATE_RECOVER; 10484a71df50SFrank Blaschka else 10494a71df50SFrank Blaschka card->state = CARD_STATE_DOWN; 1050c4949f07SFrank Blaschka mutex_unlock(&card->conf_mutex); 10519dc48cccSUrsula Braun mutex_unlock(&card->discipline_mutex); 1052aa909224SUrsula Braun return rc; 10534a71df50SFrank Blaschka } 10544a71df50SFrank Blaschka 10554a71df50SFrank Blaschka static int qeth_l2_set_online(struct ccwgroup_device *gdev) 10564a71df50SFrank Blaschka { 10574a71df50SFrank Blaschka return __qeth_l2_set_online(gdev, 0); 10584a71df50SFrank Blaschka } 10594a71df50SFrank Blaschka 10604a71df50SFrank Blaschka static int __qeth_l2_set_offline(struct ccwgroup_device *cgdev, 10614a71df50SFrank Blaschka int recovery_mode) 10624a71df50SFrank Blaschka { 10634a71df50SFrank Blaschka struct qeth_card *card = dev_get_drvdata(&cgdev->dev); 10644a71df50SFrank Blaschka int rc = 0, rc2 = 0, rc3 = 0; 10654a71df50SFrank Blaschka enum qeth_card_states recover_flag; 10664a71df50SFrank Blaschka 10679dc48cccSUrsula Braun mutex_lock(&card->discipline_mutex); 1068c4949f07SFrank Blaschka mutex_lock(&card->conf_mutex); 1069d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 3, "setoffl"); 1070d11ba0c4SPeter Tiedemann QETH_DBF_HEX(SETUP, 3, &card, sizeof(void *)); 10714a71df50SFrank Blaschka 10724a71df50SFrank Blaschka netif_carrier_off(card->dev); 10734a71df50SFrank Blaschka recover_flag = card->state; 10741da74b1cSFrank Blaschka if ((!recovery_mode && card->info.hwtrap) || card->info.hwtrap == 2) { 10751da74b1cSFrank Blaschka qeth_hw_trap(card, QETH_DIAGS_TRAP_DISARM); 10761da74b1cSFrank Blaschka card->info.hwtrap = 1; 10771da74b1cSFrank Blaschka } 10780f5623c9SUrsula Braun qeth_l2_stop_card(card, recovery_mode); 10794a71df50SFrank Blaschka rc = ccw_device_set_offline(CARD_DDEV(card)); 10804a71df50SFrank Blaschka rc2 = ccw_device_set_offline(CARD_WDEV(card)); 10814a71df50SFrank Blaschka rc3 = ccw_device_set_offline(CARD_RDEV(card)); 10824a71df50SFrank Blaschka if (!rc) 10834a71df50SFrank Blaschka rc = (rc2) ? rc2 : rc3; 10844a71df50SFrank Blaschka if (rc) 1085d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "1err%d", rc); 108622ae2790SUrsula Braun qdio_free(CARD_DDEV(card)); 10874a71df50SFrank Blaschka if (recover_flag == CARD_STATE_UP) 10884a71df50SFrank Blaschka card->state = CARD_STATE_RECOVER; 10894a71df50SFrank Blaschka /* let user_space know that device is offline */ 10904a71df50SFrank Blaschka kobject_uevent(&cgdev->dev.kobj, KOBJ_CHANGE); 1091c4949f07SFrank Blaschka mutex_unlock(&card->conf_mutex); 10929dc48cccSUrsula Braun mutex_unlock(&card->discipline_mutex); 10934a71df50SFrank Blaschka return 0; 10944a71df50SFrank Blaschka } 10954a71df50SFrank Blaschka 10964a71df50SFrank Blaschka static int qeth_l2_set_offline(struct ccwgroup_device *cgdev) 10974a71df50SFrank Blaschka { 10984a71df50SFrank Blaschka return __qeth_l2_set_offline(cgdev, 0); 10994a71df50SFrank Blaschka } 11004a71df50SFrank Blaschka 11014a71df50SFrank Blaschka static int qeth_l2_recover(void *ptr) 11024a71df50SFrank Blaschka { 11034a71df50SFrank Blaschka struct qeth_card *card; 11044a71df50SFrank Blaschka int rc = 0; 11054a71df50SFrank Blaschka 11064a71df50SFrank Blaschka card = (struct qeth_card *) ptr; 1107847a50fdSCarsten Otte QETH_CARD_TEXT(card, 2, "recover1"); 11084a71df50SFrank Blaschka if (!qeth_do_run_thread(card, QETH_RECOVER_THREAD)) 11094a71df50SFrank Blaschka return 0; 1110847a50fdSCarsten Otte QETH_CARD_TEXT(card, 2, "recover2"); 111174eacdb9SFrank Blaschka dev_warn(&card->gdev->dev, 111274eacdb9SFrank Blaschka "A recovery process has been started for the device\n"); 111365d8013cSStefan Raspl qeth_set_recovery_task(card); 11144a71df50SFrank Blaschka __qeth_l2_set_offline(card->gdev, 1); 11154a71df50SFrank Blaschka rc = __qeth_l2_set_online(card->gdev, 1); 11164a71df50SFrank Blaschka if (!rc) 111774eacdb9SFrank Blaschka dev_info(&card->gdev->dev, 111874eacdb9SFrank Blaschka "Device successfully recovered!\n"); 111928a7e4c9SUrsula Braun else { 11200f54761dSStefan Raspl qeth_close_dev(card); 112174eacdb9SFrank Blaschka dev_warn(&card->gdev->dev, "The qeth device driver " 112274eacdb9SFrank Blaschka "failed to recover an error on the device\n"); 112328a7e4c9SUrsula Braun } 112465d8013cSStefan Raspl qeth_clear_recovery_task(card); 1125a1c3ed4cSFrank Blaschka qeth_clear_thread_start_bit(card, QETH_RECOVER_THREAD); 1126a1c3ed4cSFrank Blaschka qeth_clear_thread_running_bit(card, QETH_RECOVER_THREAD); 11274a71df50SFrank Blaschka return 0; 11284a71df50SFrank Blaschka } 11294a71df50SFrank Blaschka 11304a71df50SFrank Blaschka static int __init qeth_l2_init(void) 11314a71df50SFrank Blaschka { 113274eacdb9SFrank Blaschka pr_info("register layer 2 discipline\n"); 11334a71df50SFrank Blaschka return 0; 11344a71df50SFrank Blaschka } 11354a71df50SFrank Blaschka 11364a71df50SFrank Blaschka static void __exit qeth_l2_exit(void) 11374a71df50SFrank Blaschka { 113874eacdb9SFrank Blaschka pr_info("unregister layer 2 discipline\n"); 11394a71df50SFrank Blaschka } 11404a71df50SFrank Blaschka 1141bbcfcdc8SFrank Blaschka static int qeth_l2_pm_suspend(struct ccwgroup_device *gdev) 1142bbcfcdc8SFrank Blaschka { 1143bbcfcdc8SFrank Blaschka struct qeth_card *card = dev_get_drvdata(&gdev->dev); 1144bbcfcdc8SFrank Blaschka 1145bbcfcdc8SFrank Blaschka netif_device_detach(card->dev); 1146bbcfcdc8SFrank Blaschka qeth_set_allowed_threads(card, 0, 1); 1147bbcfcdc8SFrank Blaschka wait_event(card->wait_q, qeth_threads_running(card, 0xffffffff) == 0); 1148bbcfcdc8SFrank Blaschka if (gdev->state == CCWGROUP_OFFLINE) 1149bbcfcdc8SFrank Blaschka return 0; 1150bbcfcdc8SFrank Blaschka if (card->state == CARD_STATE_UP) { 11511da74b1cSFrank Blaschka if (card->info.hwtrap) 11521da74b1cSFrank Blaschka qeth_hw_trap(card, QETH_DIAGS_TRAP_DISARM); 1153bbcfcdc8SFrank Blaschka __qeth_l2_set_offline(card->gdev, 1); 1154bbcfcdc8SFrank Blaschka } else 1155bbcfcdc8SFrank Blaschka __qeth_l2_set_offline(card->gdev, 0); 1156bbcfcdc8SFrank Blaschka return 0; 1157bbcfcdc8SFrank Blaschka } 1158bbcfcdc8SFrank Blaschka 1159bbcfcdc8SFrank Blaschka static int qeth_l2_pm_resume(struct ccwgroup_device *gdev) 1160bbcfcdc8SFrank Blaschka { 1161bbcfcdc8SFrank Blaschka struct qeth_card *card = dev_get_drvdata(&gdev->dev); 1162bbcfcdc8SFrank Blaschka int rc = 0; 1163bbcfcdc8SFrank Blaschka 1164bbcfcdc8SFrank Blaschka if (card->state == CARD_STATE_RECOVER) { 1165bbcfcdc8SFrank Blaschka rc = __qeth_l2_set_online(card->gdev, 1); 1166bbcfcdc8SFrank Blaschka if (rc) { 1167bbcfcdc8SFrank Blaschka rtnl_lock(); 1168bbcfcdc8SFrank Blaschka dev_close(card->dev); 1169bbcfcdc8SFrank Blaschka rtnl_unlock(); 1170bbcfcdc8SFrank Blaschka } 1171bbcfcdc8SFrank Blaschka } else 1172bbcfcdc8SFrank Blaschka rc = __qeth_l2_set_online(card->gdev, 0); 11736585ac4eSJulian Wiedmann 1174bbcfcdc8SFrank Blaschka qeth_set_allowed_threads(card, 0xffffffff, 0); 1175bbcfcdc8SFrank Blaschka netif_device_attach(card->dev); 1176bbcfcdc8SFrank Blaschka if (rc) 1177bbcfcdc8SFrank Blaschka dev_warn(&card->gdev->dev, "The qeth device driver " 1178bbcfcdc8SFrank Blaschka "failed to recover an error on the device\n"); 1179bbcfcdc8SFrank Blaschka return rc; 1180bbcfcdc8SFrank Blaschka } 1181bbcfcdc8SFrank Blaschka 1182c044dc21SEugene Crosser /* Returns zero if the command is successfully "consumed" */ 1183c044dc21SEugene Crosser static int qeth_l2_control_event(struct qeth_card *card, 1184c044dc21SEugene Crosser struct qeth_ipa_cmd *cmd) 1185c044dc21SEugene Crosser { 1186c044dc21SEugene Crosser switch (cmd->hdr.command) { 11879c23f4daSEugene Crosser case IPA_CMD_SETBRIDGEPORT_OSA: 11889c23f4daSEugene Crosser case IPA_CMD_SETBRIDGEPORT_IQD: 1189c044dc21SEugene Crosser if (cmd->data.sbp.hdr.command_code == 1190c044dc21SEugene Crosser IPA_SBP_BRIDGE_PORT_STATE_CHANGE) { 1191c044dc21SEugene Crosser qeth_bridge_state_change(card, cmd); 1192c044dc21SEugene Crosser return 0; 1193c044dc21SEugene Crosser } else 1194c044dc21SEugene Crosser return 1; 1195c044dc21SEugene Crosser case IPA_CMD_ADDRESS_CHANGE_NOTIF: 1196c044dc21SEugene Crosser qeth_bridge_host_event(card, cmd); 1197c044dc21SEugene Crosser return 0; 1198c044dc21SEugene Crosser default: 1199c044dc21SEugene Crosser return 1; 1200c044dc21SEugene Crosser } 1201c044dc21SEugene Crosser } 1202c044dc21SEugene Crosser 1203c041f2d4SSebastian Ott struct qeth_discipline qeth_l2_discipline = { 12042d2ebb3eSJulian Wiedmann .devtype = &qeth_l2_devtype, 1205d73ef324SJulian Wiedmann .process_rx_buffer = qeth_l2_process_inbound_buffer, 1206c041f2d4SSebastian Ott .recover = qeth_l2_recover, 1207c041f2d4SSebastian Ott .setup = qeth_l2_probe_device, 12084a71df50SFrank Blaschka .remove = qeth_l2_remove_device, 12094a71df50SFrank Blaschka .set_online = qeth_l2_set_online, 12104a71df50SFrank Blaschka .set_offline = qeth_l2_set_offline, 1211bbcfcdc8SFrank Blaschka .freeze = qeth_l2_pm_suspend, 1212bbcfcdc8SFrank Blaschka .thaw = qeth_l2_pm_resume, 1213bbcfcdc8SFrank Blaschka .restore = qeth_l2_pm_resume, 1214942d6984SJulian Wiedmann .do_ioctl = NULL, 1215c044dc21SEugene Crosser .control_event_handler = qeth_l2_control_event, 12164a71df50SFrank Blaschka }; 1217c041f2d4SSebastian Ott EXPORT_SYMBOL_GPL(qeth_l2_discipline); 12184a71df50SFrank Blaschka 12194a71df50SFrank Blaschka static int qeth_osn_send_control_data(struct qeth_card *card, int len, 12204a71df50SFrank Blaschka struct qeth_cmd_buffer *iob) 12214a71df50SFrank Blaschka { 1222750b1625SJulian Wiedmann struct qeth_channel *channel = iob->channel; 12234a71df50SFrank Blaschka int rc = 0; 12244a71df50SFrank Blaschka 1225847a50fdSCarsten Otte QETH_CARD_TEXT(card, 5, "osndctrd"); 12264a71df50SFrank Blaschka 12274a71df50SFrank Blaschka wait_event(card->wait_q, 1228750b1625SJulian Wiedmann atomic_cmpxchg(&channel->irq_pending, 0, 1) == 0); 12294a71df50SFrank Blaschka qeth_prepare_control_data(card, len, iob); 1230847a50fdSCarsten Otte QETH_CARD_TEXT(card, 6, "osnoirqp"); 1231ed47155bSJulian Wiedmann spin_lock_irq(get_ccwdev_lock(channel->ccwdev)); 1232f15cdaf2SJulian Wiedmann rc = ccw_device_start_timeout(channel->ccwdev, channel->ccw, 1233db71bbbdSJulian Wiedmann (addr_t) iob, 0, 0, QETH_IPA_TIMEOUT); 1234ed47155bSJulian Wiedmann spin_unlock_irq(get_ccwdev_lock(channel->ccwdev)); 12354a71df50SFrank Blaschka if (rc) { 123614cc21b6SFrank Blaschka QETH_DBF_MESSAGE(2, "qeth_osn_send_control_data: " 12374a71df50SFrank Blaschka "ccw_device_start rc = %i\n", rc); 1238847a50fdSCarsten Otte QETH_CARD_TEXT_(card, 2, " err%d", rc); 1239750b1625SJulian Wiedmann qeth_release_buffer(channel, iob); 1240750b1625SJulian Wiedmann atomic_set(&channel->irq_pending, 0); 12414a71df50SFrank Blaschka wake_up(&card->wait_q); 12424a71df50SFrank Blaschka } 12434a71df50SFrank Blaschka return rc; 12444a71df50SFrank Blaschka } 12454a71df50SFrank Blaschka 12464a71df50SFrank Blaschka static int qeth_osn_send_ipa_cmd(struct qeth_card *card, 12474a71df50SFrank Blaschka struct qeth_cmd_buffer *iob, int data_len) 12484a71df50SFrank Blaschka { 12494a71df50SFrank Blaschka u16 s1, s2; 12504a71df50SFrank Blaschka 1251847a50fdSCarsten Otte QETH_CARD_TEXT(card, 4, "osndipa"); 12524a71df50SFrank Blaschka 125373657a3eSJulian Wiedmann qeth_prepare_ipa_cmd(card, iob); 12544a71df50SFrank Blaschka s1 = (u16)(IPA_PDU_HEADER_SIZE + data_len); 12554a71df50SFrank Blaschka s2 = (u16)data_len; 12564a71df50SFrank Blaschka memcpy(QETH_IPA_PDU_LEN_TOTAL(iob->data), &s1, 2); 12574a71df50SFrank Blaschka memcpy(QETH_IPA_PDU_LEN_PDU1(iob->data), &s2, 2); 12584a71df50SFrank Blaschka memcpy(QETH_IPA_PDU_LEN_PDU2(iob->data), &s2, 2); 12594a71df50SFrank Blaschka memcpy(QETH_IPA_PDU_LEN_PDU3(iob->data), &s2, 2); 12604a71df50SFrank Blaschka return qeth_osn_send_control_data(card, s1, iob); 12614a71df50SFrank Blaschka } 12624a71df50SFrank Blaschka 12634a71df50SFrank Blaschka int qeth_osn_assist(struct net_device *dev, void *data, int data_len) 12644a71df50SFrank Blaschka { 12654a71df50SFrank Blaschka struct qeth_cmd_buffer *iob; 12664a71df50SFrank Blaschka struct qeth_card *card; 12674a71df50SFrank Blaschka 12684a71df50SFrank Blaschka if (!dev) 12694a71df50SFrank Blaschka return -ENODEV; 1270509e2562SHeiko Carstens card = dev->ml_priv; 12714a71df50SFrank Blaschka if (!card) 12724a71df50SFrank Blaschka return -ENODEV; 1273847a50fdSCarsten Otte QETH_CARD_TEXT(card, 2, "osnsdmc"); 1274c3521254SEugene Crosser if (!qeth_card_hw_is_reachable(card)) 12754a71df50SFrank Blaschka return -ENODEV; 12764a71df50SFrank Blaschka iob = qeth_wait_for_buffer(&card->write); 1277ff5caa7aSJulian Wiedmann memcpy(__ipa_cmd(iob), data, data_len); 1278ff5caa7aSJulian Wiedmann return qeth_osn_send_ipa_cmd(card, iob, data_len); 12794a71df50SFrank Blaschka } 12804a71df50SFrank Blaschka EXPORT_SYMBOL(qeth_osn_assist); 12814a71df50SFrank Blaschka 12824a71df50SFrank Blaschka int qeth_osn_register(unsigned char *read_dev_no, struct net_device **dev, 12834a71df50SFrank Blaschka int (*assist_cb)(struct net_device *, void *), 12844a71df50SFrank Blaschka int (*data_cb)(struct sk_buff *)) 12854a71df50SFrank Blaschka { 12864a71df50SFrank Blaschka struct qeth_card *card; 12874a71df50SFrank Blaschka 12884a71df50SFrank Blaschka *dev = qeth_l2_netdev_by_devno(read_dev_no); 12894a71df50SFrank Blaschka if (*dev == NULL) 12904a71df50SFrank Blaschka return -ENODEV; 1291509e2562SHeiko Carstens card = (*dev)->ml_priv; 12924a71df50SFrank Blaschka if (!card) 12934a71df50SFrank Blaschka return -ENODEV; 1294847a50fdSCarsten Otte QETH_CARD_TEXT(card, 2, "osnreg"); 12954a71df50SFrank Blaschka if ((assist_cb == NULL) || (data_cb == NULL)) 12964a71df50SFrank Blaschka return -EINVAL; 12974a71df50SFrank Blaschka card->osn_info.assist_cb = assist_cb; 12984a71df50SFrank Blaschka card->osn_info.data_cb = data_cb; 12994a71df50SFrank Blaschka return 0; 13004a71df50SFrank Blaschka } 13014a71df50SFrank Blaschka EXPORT_SYMBOL(qeth_osn_register); 13024a71df50SFrank Blaschka 13034a71df50SFrank Blaschka void qeth_osn_deregister(struct net_device *dev) 13044a71df50SFrank Blaschka { 13054a71df50SFrank Blaschka struct qeth_card *card; 13064a71df50SFrank Blaschka 13074a71df50SFrank Blaschka if (!dev) 13084a71df50SFrank Blaschka return; 1309509e2562SHeiko Carstens card = dev->ml_priv; 13104a71df50SFrank Blaschka if (!card) 13114a71df50SFrank Blaschka return; 1312847a50fdSCarsten Otte QETH_CARD_TEXT(card, 2, "osndereg"); 13134a71df50SFrank Blaschka card->osn_info.assist_cb = NULL; 13144a71df50SFrank Blaschka card->osn_info.data_cb = NULL; 13154a71df50SFrank Blaschka return; 13164a71df50SFrank Blaschka } 13174a71df50SFrank Blaschka EXPORT_SYMBOL(qeth_osn_deregister); 13184a71df50SFrank Blaschka 1319b4d72c08SEugene Crosser /* SETBRIDGEPORT support, async notifications */ 1320b4d72c08SEugene Crosser 13219f48b9dbSEugene Crosser enum qeth_an_event_type {anev_reg_unreg, anev_abort, anev_reset}; 13229f48b9dbSEugene Crosser 13239f48b9dbSEugene Crosser /** 13249f48b9dbSEugene Crosser * qeth_bridge_emit_host_event() - bridgeport address change notification 13259f48b9dbSEugene Crosser * @card: qeth_card structure pointer, for udev events. 13269f48b9dbSEugene Crosser * @evtype: "normal" register/unregister, or abort, or reset. For abort 13279f48b9dbSEugene Crosser * and reset token and addr_lnid are unused and may be NULL. 13289f48b9dbSEugene Crosser * @code: event bitmask: high order bit 0x80 value 1 means removal of an 13299f48b9dbSEugene Crosser * object, 0 - addition of an object. 13309f48b9dbSEugene Crosser * 0x01 - VLAN, 0x02 - MAC, 0x03 - VLAN and MAC. 13319f48b9dbSEugene Crosser * @token: "network token" structure identifying physical address of the port. 13329f48b9dbSEugene Crosser * @addr_lnid: pointer to structure with MAC address and VLAN ID. 13339f48b9dbSEugene Crosser * 13349f48b9dbSEugene Crosser * This function is called when registrations and deregistrations are 13359f48b9dbSEugene Crosser * reported by the hardware, and also when notifications are enabled - 13369f48b9dbSEugene Crosser * for all currently registered addresses. 13379f48b9dbSEugene Crosser */ 13389f48b9dbSEugene Crosser static void qeth_bridge_emit_host_event(struct qeth_card *card, 13399f48b9dbSEugene Crosser enum qeth_an_event_type evtype, 13409f48b9dbSEugene Crosser u8 code, struct net_if_token *token, struct mac_addr_lnid *addr_lnid) 13419f48b9dbSEugene Crosser { 13429f48b9dbSEugene Crosser char str[7][32]; 13439f48b9dbSEugene Crosser char *env[8]; 13449f48b9dbSEugene Crosser int i = 0; 13459f48b9dbSEugene Crosser 13469f48b9dbSEugene Crosser switch (evtype) { 13479f48b9dbSEugene Crosser case anev_reg_unreg: 13489f48b9dbSEugene Crosser snprintf(str[i], sizeof(str[i]), "BRIDGEDHOST=%s", 13499f48b9dbSEugene Crosser (code & IPA_ADDR_CHANGE_CODE_REMOVAL) 13509f48b9dbSEugene Crosser ? "deregister" : "register"); 13519f48b9dbSEugene Crosser env[i] = str[i]; i++; 13529f48b9dbSEugene Crosser if (code & IPA_ADDR_CHANGE_CODE_VLANID) { 13539f48b9dbSEugene Crosser snprintf(str[i], sizeof(str[i]), "VLAN=%d", 13549f48b9dbSEugene Crosser addr_lnid->lnid); 13559f48b9dbSEugene Crosser env[i] = str[i]; i++; 13569f48b9dbSEugene Crosser } 13579f48b9dbSEugene Crosser if (code & IPA_ADDR_CHANGE_CODE_MACADDR) { 13589846e70bSEugene Crosser snprintf(str[i], sizeof(str[i]), "MAC=%pM", 13599846e70bSEugene Crosser addr_lnid->mac); 13609f48b9dbSEugene Crosser env[i] = str[i]; i++; 13619f48b9dbSEugene Crosser } 13629f48b9dbSEugene Crosser snprintf(str[i], sizeof(str[i]), "NTOK_BUSID=%x.%x.%04x", 13639f48b9dbSEugene Crosser token->cssid, token->ssid, token->devnum); 13649f48b9dbSEugene Crosser env[i] = str[i]; i++; 13659f48b9dbSEugene Crosser snprintf(str[i], sizeof(str[i]), "NTOK_IID=%02x", token->iid); 13669f48b9dbSEugene Crosser env[i] = str[i]; i++; 13679f48b9dbSEugene Crosser snprintf(str[i], sizeof(str[i]), "NTOK_CHPID=%02x", 13689f48b9dbSEugene Crosser token->chpid); 13699f48b9dbSEugene Crosser env[i] = str[i]; i++; 13709f48b9dbSEugene Crosser snprintf(str[i], sizeof(str[i]), "NTOK_CHID=%04x", token->chid); 13719f48b9dbSEugene Crosser env[i] = str[i]; i++; 13729f48b9dbSEugene Crosser break; 13739f48b9dbSEugene Crosser case anev_abort: 13749f48b9dbSEugene Crosser snprintf(str[i], sizeof(str[i]), "BRIDGEDHOST=abort"); 13759f48b9dbSEugene Crosser env[i] = str[i]; i++; 13769f48b9dbSEugene Crosser break; 13779f48b9dbSEugene Crosser case anev_reset: 13789f48b9dbSEugene Crosser snprintf(str[i], sizeof(str[i]), "BRIDGEDHOST=reset"); 13799f48b9dbSEugene Crosser env[i] = str[i]; i++; 13809f48b9dbSEugene Crosser break; 13819f48b9dbSEugene Crosser } 13829f48b9dbSEugene Crosser env[i] = NULL; 13839f48b9dbSEugene Crosser kobject_uevent_env(&card->gdev->dev.kobj, KOBJ_CHANGE, env); 13849f48b9dbSEugene Crosser } 13859f48b9dbSEugene Crosser 1386b4d72c08SEugene Crosser struct qeth_bridge_state_data { 1387b4d72c08SEugene Crosser struct work_struct worker; 1388b4d72c08SEugene Crosser struct qeth_card *card; 1389b4d72c08SEugene Crosser struct qeth_sbp_state_change qports; 1390b4d72c08SEugene Crosser }; 1391b4d72c08SEugene Crosser 1392b4d72c08SEugene Crosser static void qeth_bridge_state_change_worker(struct work_struct *work) 1393b4d72c08SEugene Crosser { 1394b4d72c08SEugene Crosser struct qeth_bridge_state_data *data = 1395b4d72c08SEugene Crosser container_of(work, struct qeth_bridge_state_data, worker); 1396b4d72c08SEugene Crosser /* We are only interested in the first entry - local port */ 1397b4d72c08SEugene Crosser struct qeth_sbp_port_entry *entry = &data->qports.entry[0]; 1398b4d72c08SEugene Crosser char env_locrem[32]; 1399b4d72c08SEugene Crosser char env_role[32]; 1400b4d72c08SEugene Crosser char env_state[32]; 1401b4d72c08SEugene Crosser char *env[] = { 1402b4d72c08SEugene Crosser env_locrem, 1403b4d72c08SEugene Crosser env_role, 1404b4d72c08SEugene Crosser env_state, 1405b4d72c08SEugene Crosser NULL 1406b4d72c08SEugene Crosser }; 1407b4d72c08SEugene Crosser 1408b4d72c08SEugene Crosser /* Role should not change by itself, but if it did, */ 1409b4d72c08SEugene Crosser /* information from the hardware is authoritative. */ 1410b4d72c08SEugene Crosser mutex_lock(&data->card->conf_mutex); 1411b4d72c08SEugene Crosser data->card->options.sbp.role = entry->role; 1412b4d72c08SEugene Crosser mutex_unlock(&data->card->conf_mutex); 1413b4d72c08SEugene Crosser 1414b4d72c08SEugene Crosser snprintf(env_locrem, sizeof(env_locrem), "BRIDGEPORT=statechange"); 1415b4d72c08SEugene Crosser snprintf(env_role, sizeof(env_role), "ROLE=%s", 1416b4d72c08SEugene Crosser (entry->role == QETH_SBP_ROLE_NONE) ? "none" : 1417b4d72c08SEugene Crosser (entry->role == QETH_SBP_ROLE_PRIMARY) ? "primary" : 1418b4d72c08SEugene Crosser (entry->role == QETH_SBP_ROLE_SECONDARY) ? "secondary" : 1419b4d72c08SEugene Crosser "<INVALID>"); 1420b4d72c08SEugene Crosser snprintf(env_state, sizeof(env_state), "STATE=%s", 1421b4d72c08SEugene Crosser (entry->state == QETH_SBP_STATE_INACTIVE) ? "inactive" : 1422b4d72c08SEugene Crosser (entry->state == QETH_SBP_STATE_STANDBY) ? "standby" : 1423b4d72c08SEugene Crosser (entry->state == QETH_SBP_STATE_ACTIVE) ? "active" : 1424b4d72c08SEugene Crosser "<INVALID>"); 1425b4d72c08SEugene Crosser kobject_uevent_env(&data->card->gdev->dev.kobj, 1426b4d72c08SEugene Crosser KOBJ_CHANGE, env); 1427b4d72c08SEugene Crosser kfree(data); 1428b4d72c08SEugene Crosser } 1429b4d72c08SEugene Crosser 1430c044dc21SEugene Crosser static void qeth_bridge_state_change(struct qeth_card *card, 1431c044dc21SEugene Crosser struct qeth_ipa_cmd *cmd) 1432b4d72c08SEugene Crosser { 1433b4d72c08SEugene Crosser struct qeth_sbp_state_change *qports = 1434b4d72c08SEugene Crosser &cmd->data.sbp.data.state_change; 1435b4d72c08SEugene Crosser struct qeth_bridge_state_data *data; 1436b4d72c08SEugene Crosser int extrasize; 1437b4d72c08SEugene Crosser 1438b4d72c08SEugene Crosser QETH_CARD_TEXT(card, 2, "brstchng"); 1439b4d72c08SEugene Crosser if (qports->entry_length != sizeof(struct qeth_sbp_port_entry)) { 14408a593148SThomas Richter QETH_CARD_TEXT_(card, 2, "BPsz%04x", qports->entry_length); 1441b4d72c08SEugene Crosser return; 1442b4d72c08SEugene Crosser } 1443b4d72c08SEugene Crosser extrasize = sizeof(struct qeth_sbp_port_entry) * qports->num_entries; 1444b4d72c08SEugene Crosser data = kzalloc(sizeof(struct qeth_bridge_state_data) + extrasize, 1445b4d72c08SEugene Crosser GFP_ATOMIC); 1446b4d72c08SEugene Crosser if (!data) { 1447b4d72c08SEugene Crosser QETH_CARD_TEXT(card, 2, "BPSalloc"); 1448b4d72c08SEugene Crosser return; 1449b4d72c08SEugene Crosser } 1450b4d72c08SEugene Crosser INIT_WORK(&data->worker, qeth_bridge_state_change_worker); 1451b4d72c08SEugene Crosser data->card = card; 1452b4d72c08SEugene Crosser memcpy(&data->qports, qports, 1453b4d72c08SEugene Crosser sizeof(struct qeth_sbp_state_change) + extrasize); 1454b4d72c08SEugene Crosser queue_work(qeth_wq, &data->worker); 1455b4d72c08SEugene Crosser } 1456b4d72c08SEugene Crosser 14579f48b9dbSEugene Crosser struct qeth_bridge_host_data { 14589f48b9dbSEugene Crosser struct work_struct worker; 14599f48b9dbSEugene Crosser struct qeth_card *card; 14609f48b9dbSEugene Crosser struct qeth_ipacmd_addr_change hostevs; 14619f48b9dbSEugene Crosser }; 14629f48b9dbSEugene Crosser 14639f48b9dbSEugene Crosser static void qeth_bridge_host_event_worker(struct work_struct *work) 14649f48b9dbSEugene Crosser { 14659f48b9dbSEugene Crosser struct qeth_bridge_host_data *data = 14669f48b9dbSEugene Crosser container_of(work, struct qeth_bridge_host_data, worker); 14679f48b9dbSEugene Crosser int i; 14689f48b9dbSEugene Crosser 14699f48b9dbSEugene Crosser if (data->hostevs.lost_event_mask) { 14709f48b9dbSEugene Crosser dev_info(&data->card->gdev->dev, 14719c23f4daSEugene Crosser "Address notification from the Bridge Port stopped %s (%s)\n", 14729f48b9dbSEugene Crosser data->card->dev->name, 14739f48b9dbSEugene Crosser (data->hostevs.lost_event_mask == 0x01) 14749f48b9dbSEugene Crosser ? "Overflow" 14759f48b9dbSEugene Crosser : (data->hostevs.lost_event_mask == 0x02) 14769f48b9dbSEugene Crosser ? "Bridge port state change" 14779f48b9dbSEugene Crosser : "Unknown reason"); 14789f48b9dbSEugene Crosser mutex_lock(&data->card->conf_mutex); 14799f48b9dbSEugene Crosser data->card->options.sbp.hostnotification = 0; 14809f48b9dbSEugene Crosser mutex_unlock(&data->card->conf_mutex); 14819f48b9dbSEugene Crosser qeth_bridge_emit_host_event(data->card, anev_abort, 14829f48b9dbSEugene Crosser 0, NULL, NULL); 14839f48b9dbSEugene Crosser } else 14849f48b9dbSEugene Crosser for (i = 0; i < data->hostevs.num_entries; i++) { 14859f48b9dbSEugene Crosser struct qeth_ipacmd_addr_change_entry *entry = 14869f48b9dbSEugene Crosser &data->hostevs.entry[i]; 14879f48b9dbSEugene Crosser qeth_bridge_emit_host_event(data->card, 14889f48b9dbSEugene Crosser anev_reg_unreg, 14899f48b9dbSEugene Crosser entry->change_code, 14909f48b9dbSEugene Crosser &entry->token, &entry->addr_lnid); 14919f48b9dbSEugene Crosser } 14929f48b9dbSEugene Crosser kfree(data); 14939f48b9dbSEugene Crosser } 14949f48b9dbSEugene Crosser 1495c044dc21SEugene Crosser static void qeth_bridge_host_event(struct qeth_card *card, 1496c044dc21SEugene Crosser struct qeth_ipa_cmd *cmd) 14979f48b9dbSEugene Crosser { 14989f48b9dbSEugene Crosser struct qeth_ipacmd_addr_change *hostevs = 14999f48b9dbSEugene Crosser &cmd->data.addrchange; 15009f48b9dbSEugene Crosser struct qeth_bridge_host_data *data; 15019f48b9dbSEugene Crosser int extrasize; 15029f48b9dbSEugene Crosser 15039f48b9dbSEugene Crosser QETH_CARD_TEXT(card, 2, "brhostev"); 15049f48b9dbSEugene Crosser if (cmd->hdr.return_code != 0x0000) { 15059f48b9dbSEugene Crosser if (cmd->hdr.return_code == 0x0010) { 15069f48b9dbSEugene Crosser if (hostevs->lost_event_mask == 0x00) 15079f48b9dbSEugene Crosser hostevs->lost_event_mask = 0xff; 15089f48b9dbSEugene Crosser } else { 15099f48b9dbSEugene Crosser QETH_CARD_TEXT_(card, 2, "BPHe%04x", 15109f48b9dbSEugene Crosser cmd->hdr.return_code); 15119f48b9dbSEugene Crosser return; 15129f48b9dbSEugene Crosser } 15139f48b9dbSEugene Crosser } 15149f48b9dbSEugene Crosser extrasize = sizeof(struct qeth_ipacmd_addr_change_entry) * 15159f48b9dbSEugene Crosser hostevs->num_entries; 15169f48b9dbSEugene Crosser data = kzalloc(sizeof(struct qeth_bridge_host_data) + extrasize, 15179f48b9dbSEugene Crosser GFP_ATOMIC); 15189f48b9dbSEugene Crosser if (!data) { 15199f48b9dbSEugene Crosser QETH_CARD_TEXT(card, 2, "BPHalloc"); 15209f48b9dbSEugene Crosser return; 15219f48b9dbSEugene Crosser } 15229f48b9dbSEugene Crosser INIT_WORK(&data->worker, qeth_bridge_host_event_worker); 15239f48b9dbSEugene Crosser data->card = card; 15249f48b9dbSEugene Crosser memcpy(&data->hostevs, hostevs, 15259f48b9dbSEugene Crosser sizeof(struct qeth_ipacmd_addr_change) + extrasize); 15269f48b9dbSEugene Crosser queue_work(qeth_wq, &data->worker); 15279f48b9dbSEugene Crosser } 15289f48b9dbSEugene Crosser 1529b4d72c08SEugene Crosser /* SETBRIDGEPORT support; sending commands */ 1530b4d72c08SEugene Crosser 1531b4d72c08SEugene Crosser struct _qeth_sbp_cbctl { 1532b4d72c08SEugene Crosser u16 ipa_rc; 1533b4d72c08SEugene Crosser u16 cmd_rc; 1534b4d72c08SEugene Crosser union { 1535b4d72c08SEugene Crosser u32 supported; 1536b4d72c08SEugene Crosser struct { 1537b4d72c08SEugene Crosser enum qeth_sbp_roles *role; 1538b4d72c08SEugene Crosser enum qeth_sbp_states *state; 1539b4d72c08SEugene Crosser } qports; 1540b4d72c08SEugene Crosser } data; 1541b4d72c08SEugene Crosser }; 1542b4d72c08SEugene Crosser 1543b4d72c08SEugene Crosser /** 1544b4d72c08SEugene Crosser * qeth_bridgeport_makerc() - derive "traditional" error from hardware codes. 1545b4d72c08SEugene Crosser * @card: qeth_card structure pointer, for debug messages. 1546b4d72c08SEugene Crosser * @cbctl: state structure with hardware return codes. 1547b4d72c08SEugene Crosser * @setcmd: IPA command code 1548b4d72c08SEugene Crosser * 1549b4d72c08SEugene Crosser * Returns negative errno-compatible error indication or 0 on success. 1550b4d72c08SEugene Crosser */ 1551b4d72c08SEugene Crosser static int qeth_bridgeport_makerc(struct qeth_card *card, 1552b4d72c08SEugene Crosser struct _qeth_sbp_cbctl *cbctl, enum qeth_ipa_sbp_cmd setcmd) 1553b4d72c08SEugene Crosser { 1554b4d72c08SEugene Crosser int rc; 15559c23f4daSEugene Crosser int is_iqd = (card->info.type == QETH_CARD_TYPE_IQD); 1556b4d72c08SEugene Crosser 15579c23f4daSEugene Crosser if ((is_iqd && (cbctl->ipa_rc == IPA_RC_SUCCESS)) || 15589c23f4daSEugene Crosser (!is_iqd && (cbctl->ipa_rc == cbctl->cmd_rc))) 1559b4d72c08SEugene Crosser switch (cbctl->cmd_rc) { 15602063a5f5SKittipon Meesompop case IPA_RC_SUCCESS: 1561b4d72c08SEugene Crosser rc = 0; 1562b4d72c08SEugene Crosser break; 15632063a5f5SKittipon Meesompop case IPA_RC_L2_UNSUPPORTED_CMD: 15642063a5f5SKittipon Meesompop case IPA_RC_UNSUPPORTED_COMMAND: 1565ffb95251SEugene Crosser rc = -EOPNOTSUPP; 1566b4d72c08SEugene Crosser break; 15672063a5f5SKittipon Meesompop case IPA_RC_SBP_OSA_NOT_CONFIGURED: 15682063a5f5SKittipon Meesompop case IPA_RC_SBP_IQD_NOT_CONFIGURED: 1569b4d72c08SEugene Crosser rc = -ENODEV; /* maybe not the best code here? */ 1570b4d72c08SEugene Crosser dev_err(&card->gdev->dev, 15719c23f4daSEugene Crosser "The device is not configured as a Bridge Port\n"); 1572b4d72c08SEugene Crosser break; 15732063a5f5SKittipon Meesompop case IPA_RC_SBP_OSA_OS_MISMATCH: 15742063a5f5SKittipon Meesompop case IPA_RC_SBP_IQD_OS_MISMATCH: 15751b05cf62SEugene Crosser rc = -EPERM; 15761b05cf62SEugene Crosser dev_err(&card->gdev->dev, 15771b05cf62SEugene Crosser "A Bridge Port is already configured by a different operating system\n"); 15781b05cf62SEugene Crosser break; 15792063a5f5SKittipon Meesompop case IPA_RC_SBP_OSA_ANO_DEV_PRIMARY: 15802063a5f5SKittipon Meesompop case IPA_RC_SBP_IQD_ANO_DEV_PRIMARY: 1581b4d72c08SEugene Crosser switch (setcmd) { 1582b4d72c08SEugene Crosser case IPA_SBP_SET_PRIMARY_BRIDGE_PORT: 1583b4d72c08SEugene Crosser rc = -EEXIST; 1584b4d72c08SEugene Crosser dev_err(&card->gdev->dev, 15859c23f4daSEugene Crosser "The LAN already has a primary Bridge Port\n"); 1586b4d72c08SEugene Crosser break; 1587b4d72c08SEugene Crosser case IPA_SBP_SET_SECONDARY_BRIDGE_PORT: 1588b4d72c08SEugene Crosser rc = -EBUSY; 1589b4d72c08SEugene Crosser dev_err(&card->gdev->dev, 15909c23f4daSEugene Crosser "The device is already a primary Bridge Port\n"); 1591b4d72c08SEugene Crosser break; 1592b4d72c08SEugene Crosser default: 1593b4d72c08SEugene Crosser rc = -EIO; 1594b4d72c08SEugene Crosser } 1595b4d72c08SEugene Crosser break; 15962063a5f5SKittipon Meesompop case IPA_RC_SBP_OSA_CURRENT_SECOND: 15972063a5f5SKittipon Meesompop case IPA_RC_SBP_IQD_CURRENT_SECOND: 1598b4d72c08SEugene Crosser rc = -EBUSY; 1599b4d72c08SEugene Crosser dev_err(&card->gdev->dev, 16009c23f4daSEugene Crosser "The device is already a secondary Bridge Port\n"); 1601b4d72c08SEugene Crosser break; 16022063a5f5SKittipon Meesompop case IPA_RC_SBP_OSA_LIMIT_SECOND: 16032063a5f5SKittipon Meesompop case IPA_RC_SBP_IQD_LIMIT_SECOND: 1604b4d72c08SEugene Crosser rc = -EEXIST; 1605b4d72c08SEugene Crosser dev_err(&card->gdev->dev, 16069c23f4daSEugene Crosser "The LAN cannot have more secondary Bridge Ports\n"); 1607b4d72c08SEugene Crosser break; 16082063a5f5SKittipon Meesompop case IPA_RC_SBP_OSA_CURRENT_PRIMARY: 16092063a5f5SKittipon Meesompop case IPA_RC_SBP_IQD_CURRENT_PRIMARY: 1610b4d72c08SEugene Crosser rc = -EBUSY; 1611b4d72c08SEugene Crosser dev_err(&card->gdev->dev, 16129c23f4daSEugene Crosser "The device is already a primary Bridge Port\n"); 1613b4d72c08SEugene Crosser break; 16142063a5f5SKittipon Meesompop case IPA_RC_SBP_OSA_NOT_AUTHD_BY_ZMAN: 16152063a5f5SKittipon Meesompop case IPA_RC_SBP_IQD_NOT_AUTHD_BY_ZMAN: 1616b4d72c08SEugene Crosser rc = -EACCES; 1617b4d72c08SEugene Crosser dev_err(&card->gdev->dev, 16189c23f4daSEugene Crosser "The device is not authorized to be a Bridge Port\n"); 1619b4d72c08SEugene Crosser break; 1620b4d72c08SEugene Crosser default: 1621b4d72c08SEugene Crosser rc = -EIO; 1622b4d72c08SEugene Crosser } 16239c23f4daSEugene Crosser else 16249c23f4daSEugene Crosser switch (cbctl->ipa_rc) { 1625b4d72c08SEugene Crosser case IPA_RC_NOTSUPP: 1626ffb95251SEugene Crosser rc = -EOPNOTSUPP; 1627b4d72c08SEugene Crosser break; 1628b4d72c08SEugene Crosser case IPA_RC_UNSUPPORTED_COMMAND: 1629ffb95251SEugene Crosser rc = -EOPNOTSUPP; 1630b4d72c08SEugene Crosser break; 1631b4d72c08SEugene Crosser default: 1632b4d72c08SEugene Crosser rc = -EIO; 1633b4d72c08SEugene Crosser } 16349c23f4daSEugene Crosser 1635b4d72c08SEugene Crosser if (rc) { 1636b4d72c08SEugene Crosser QETH_CARD_TEXT_(card, 2, "SBPi%04x", cbctl->ipa_rc); 1637b4d72c08SEugene Crosser QETH_CARD_TEXT_(card, 2, "SBPc%04x", cbctl->cmd_rc); 1638b4d72c08SEugene Crosser } 1639b4d72c08SEugene Crosser return rc; 1640b4d72c08SEugene Crosser } 1641b4d72c08SEugene Crosser 1642d65626adSJulian Wiedmann static struct qeth_cmd_buffer *qeth_sbp_build_cmd(struct qeth_card *card, 1643d65626adSJulian Wiedmann enum qeth_ipa_sbp_cmd sbp_cmd, 1644d65626adSJulian Wiedmann unsigned int cmd_length) 16459c23f4daSEugene Crosser { 1646d65626adSJulian Wiedmann enum qeth_ipa_cmds ipa_cmd = (card->info.type == QETH_CARD_TYPE_IQD) ? 16479c23f4daSEugene Crosser IPA_CMD_SETBRIDGEPORT_IQD : 16489c23f4daSEugene Crosser IPA_CMD_SETBRIDGEPORT_OSA; 1649d65626adSJulian Wiedmann struct qeth_cmd_buffer *iob; 1650d65626adSJulian Wiedmann struct qeth_ipa_cmd *cmd; 1651d65626adSJulian Wiedmann 1652d65626adSJulian Wiedmann iob = qeth_get_ipacmd_buffer(card, ipa_cmd, 0); 1653d65626adSJulian Wiedmann if (!iob) 1654d65626adSJulian Wiedmann return iob; 1655ff5caa7aSJulian Wiedmann cmd = __ipa_cmd(iob); 1656d65626adSJulian Wiedmann cmd->data.sbp.hdr.cmdlength = sizeof(struct qeth_ipacmd_sbp_hdr) + 1657d65626adSJulian Wiedmann cmd_length; 1658d65626adSJulian Wiedmann cmd->data.sbp.hdr.command_code = sbp_cmd; 1659d65626adSJulian Wiedmann cmd->data.sbp.hdr.used_total = 1; 1660d65626adSJulian Wiedmann cmd->data.sbp.hdr.seq_no = 1; 1661d65626adSJulian Wiedmann return iob; 16629c23f4daSEugene Crosser } 16639c23f4daSEugene Crosser 1664b4d72c08SEugene Crosser static int qeth_bridgeport_query_support_cb(struct qeth_card *card, 1665b4d72c08SEugene Crosser struct qeth_reply *reply, unsigned long data) 1666b4d72c08SEugene Crosser { 1667b4d72c08SEugene Crosser struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *) data; 1668b4d72c08SEugene Crosser struct _qeth_sbp_cbctl *cbctl = (struct _qeth_sbp_cbctl *)reply->param; 1669b4d72c08SEugene Crosser QETH_CARD_TEXT(card, 2, "brqsupcb"); 1670b4d72c08SEugene Crosser cbctl->ipa_rc = cmd->hdr.return_code; 1671b4d72c08SEugene Crosser cbctl->cmd_rc = cmd->data.sbp.hdr.return_code; 1672b4d72c08SEugene Crosser if ((cbctl->ipa_rc == 0) && (cbctl->cmd_rc == 0)) { 1673b4d72c08SEugene Crosser cbctl->data.supported = 1674b4d72c08SEugene Crosser cmd->data.sbp.data.query_cmds_supp.supported_cmds; 1675b4d72c08SEugene Crosser } else { 1676b4d72c08SEugene Crosser cbctl->data.supported = 0; 1677b4d72c08SEugene Crosser } 1678b4d72c08SEugene Crosser return 0; 1679b4d72c08SEugene Crosser } 1680b4d72c08SEugene Crosser 1681b4d72c08SEugene Crosser /** 1682b4d72c08SEugene Crosser * qeth_bridgeport_query_support() - store bitmask of supported subfunctions. 1683b4d72c08SEugene Crosser * @card: qeth_card structure pointer. 1684b4d72c08SEugene Crosser * 1685b4d72c08SEugene Crosser * Sets bitmask of supported setbridgeport subfunctions in the qeth_card 1686b4d72c08SEugene Crosser * strucutre: card->options.sbp.supported_funcs. 1687b4d72c08SEugene Crosser */ 1688c044dc21SEugene Crosser static void qeth_bridgeport_query_support(struct qeth_card *card) 1689b4d72c08SEugene Crosser { 1690b4d72c08SEugene Crosser struct qeth_cmd_buffer *iob; 1691b4d72c08SEugene Crosser struct _qeth_sbp_cbctl cbctl; 1692b4d72c08SEugene Crosser 1693b4d72c08SEugene Crosser QETH_CARD_TEXT(card, 2, "brqsuppo"); 1694d65626adSJulian Wiedmann iob = qeth_sbp_build_cmd(card, IPA_SBP_QUERY_COMMANDS_SUPPORTED, 1695d65626adSJulian Wiedmann sizeof(struct qeth_sbp_query_cmds_supp)); 16961aec42bcSThomas Richter if (!iob) 16971aec42bcSThomas Richter return; 1698b4d72c08SEugene Crosser if (qeth_send_ipa_cmd(card, iob, qeth_bridgeport_query_support_cb, 1699b4d72c08SEugene Crosser (void *)&cbctl) || 1700b4d72c08SEugene Crosser qeth_bridgeport_makerc(card, &cbctl, 1701b4d72c08SEugene Crosser IPA_SBP_QUERY_COMMANDS_SUPPORTED)) { 1702b4d72c08SEugene Crosser /* non-zero makerc signifies failure, and produce messages */ 1703b4d72c08SEugene Crosser card->options.sbp.role = QETH_SBP_ROLE_NONE; 1704b4d72c08SEugene Crosser return; 1705b4d72c08SEugene Crosser } 1706b4d72c08SEugene Crosser card->options.sbp.supported_funcs = cbctl.data.supported; 1707b4d72c08SEugene Crosser } 1708b4d72c08SEugene Crosser 1709b4d72c08SEugene Crosser static int qeth_bridgeport_query_ports_cb(struct qeth_card *card, 1710b4d72c08SEugene Crosser struct qeth_reply *reply, unsigned long data) 1711b4d72c08SEugene Crosser { 1712b4d72c08SEugene Crosser struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *) data; 1713b4d72c08SEugene Crosser struct qeth_sbp_query_ports *qports = &cmd->data.sbp.data.query_ports; 1714b4d72c08SEugene Crosser struct _qeth_sbp_cbctl *cbctl = (struct _qeth_sbp_cbctl *)reply->param; 1715b4d72c08SEugene Crosser 1716b4d72c08SEugene Crosser QETH_CARD_TEXT(card, 2, "brqprtcb"); 1717b4d72c08SEugene Crosser cbctl->ipa_rc = cmd->hdr.return_code; 1718b4d72c08SEugene Crosser cbctl->cmd_rc = cmd->data.sbp.hdr.return_code; 1719b4d72c08SEugene Crosser if ((cbctl->ipa_rc != 0) || (cbctl->cmd_rc != 0)) 1720b4d72c08SEugene Crosser return 0; 1721b4d72c08SEugene Crosser if (qports->entry_length != sizeof(struct qeth_sbp_port_entry)) { 1722b4d72c08SEugene Crosser cbctl->cmd_rc = 0xffff; 1723b4d72c08SEugene Crosser QETH_CARD_TEXT_(card, 2, "SBPs%04x", qports->entry_length); 1724b4d72c08SEugene Crosser return 0; 1725b4d72c08SEugene Crosser } 1726b4d72c08SEugene Crosser /* first entry contains the state of the local port */ 1727b4d72c08SEugene Crosser if (qports->num_entries > 0) { 1728b4d72c08SEugene Crosser if (cbctl->data.qports.role) 1729b4d72c08SEugene Crosser *cbctl->data.qports.role = qports->entry[0].role; 1730b4d72c08SEugene Crosser if (cbctl->data.qports.state) 1731b4d72c08SEugene Crosser *cbctl->data.qports.state = qports->entry[0].state; 1732b4d72c08SEugene Crosser } 1733b4d72c08SEugene Crosser return 0; 1734b4d72c08SEugene Crosser } 1735b4d72c08SEugene Crosser 1736b4d72c08SEugene Crosser /** 1737b4d72c08SEugene Crosser * qeth_bridgeport_query_ports() - query local bridgeport status. 1738b4d72c08SEugene Crosser * @card: qeth_card structure pointer. 1739b4d72c08SEugene Crosser * @role: Role of the port: 0-none, 1-primary, 2-secondary. 1740b4d72c08SEugene Crosser * @state: State of the port: 0-inactive, 1-standby, 2-active. 1741b4d72c08SEugene Crosser * 1742b4d72c08SEugene Crosser * Returns negative errno-compatible error indication or 0 on success. 1743b4d72c08SEugene Crosser * 1744b4d72c08SEugene Crosser * 'role' and 'state' are not updated in case of hardware operation failure. 1745b4d72c08SEugene Crosser */ 1746b4d72c08SEugene Crosser int qeth_bridgeport_query_ports(struct qeth_card *card, 1747b4d72c08SEugene Crosser enum qeth_sbp_roles *role, enum qeth_sbp_states *state) 1748b4d72c08SEugene Crosser { 1749b4d72c08SEugene Crosser int rc = 0; 1750b4d72c08SEugene Crosser struct qeth_cmd_buffer *iob; 1751b4d72c08SEugene Crosser struct _qeth_sbp_cbctl cbctl = { 1752b4d72c08SEugene Crosser .data = { 1753b4d72c08SEugene Crosser .qports = { 1754b4d72c08SEugene Crosser .role = role, 1755b4d72c08SEugene Crosser .state = state, 1756b4d72c08SEugene Crosser }, 1757b4d72c08SEugene Crosser }, 1758b4d72c08SEugene Crosser }; 1759b4d72c08SEugene Crosser 1760b4d72c08SEugene Crosser QETH_CARD_TEXT(card, 2, "brqports"); 1761b4d72c08SEugene Crosser if (!(card->options.sbp.supported_funcs & IPA_SBP_QUERY_BRIDGE_PORTS)) 1762b4d72c08SEugene Crosser return -EOPNOTSUPP; 1763d65626adSJulian Wiedmann iob = qeth_sbp_build_cmd(card, IPA_SBP_QUERY_BRIDGE_PORTS, 0); 17641aec42bcSThomas Richter if (!iob) 17651aec42bcSThomas Richter return -ENOMEM; 1766b4d72c08SEugene Crosser rc = qeth_send_ipa_cmd(card, iob, qeth_bridgeport_query_ports_cb, 1767b4d72c08SEugene Crosser (void *)&cbctl); 1768c88394e7SEugene Crosser if (rc < 0) 1769b4d72c08SEugene Crosser return rc; 1770c88394e7SEugene Crosser return qeth_bridgeport_makerc(card, &cbctl, IPA_SBP_QUERY_BRIDGE_PORTS); 1771b4d72c08SEugene Crosser } 1772b4d72c08SEugene Crosser 1773b4d72c08SEugene Crosser static int qeth_bridgeport_set_cb(struct qeth_card *card, 1774b4d72c08SEugene Crosser struct qeth_reply *reply, unsigned long data) 1775b4d72c08SEugene Crosser { 1776b4d72c08SEugene Crosser struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *)data; 1777b4d72c08SEugene Crosser struct _qeth_sbp_cbctl *cbctl = (struct _qeth_sbp_cbctl *)reply->param; 1778b4d72c08SEugene Crosser QETH_CARD_TEXT(card, 2, "brsetrcb"); 1779b4d72c08SEugene Crosser cbctl->ipa_rc = cmd->hdr.return_code; 1780b4d72c08SEugene Crosser cbctl->cmd_rc = cmd->data.sbp.hdr.return_code; 1781b4d72c08SEugene Crosser return 0; 1782b4d72c08SEugene Crosser } 1783b4d72c08SEugene Crosser 1784b4d72c08SEugene Crosser /** 1785b4d72c08SEugene Crosser * qeth_bridgeport_setrole() - Assign primary role to the port. 1786b4d72c08SEugene Crosser * @card: qeth_card structure pointer. 1787b4d72c08SEugene Crosser * @role: Role to assign. 1788b4d72c08SEugene Crosser * 1789b4d72c08SEugene Crosser * Returns negative errno-compatible error indication or 0 on success. 1790b4d72c08SEugene Crosser */ 1791b4d72c08SEugene Crosser int qeth_bridgeport_setrole(struct qeth_card *card, enum qeth_sbp_roles role) 1792b4d72c08SEugene Crosser { 1793b4d72c08SEugene Crosser int rc = 0; 1794b4d72c08SEugene Crosser int cmdlength; 1795b4d72c08SEugene Crosser struct qeth_cmd_buffer *iob; 1796b4d72c08SEugene Crosser struct _qeth_sbp_cbctl cbctl; 1797b4d72c08SEugene Crosser enum qeth_ipa_sbp_cmd setcmd; 1798b4d72c08SEugene Crosser 1799b4d72c08SEugene Crosser QETH_CARD_TEXT(card, 2, "brsetrol"); 1800b4d72c08SEugene Crosser switch (role) { 1801b4d72c08SEugene Crosser case QETH_SBP_ROLE_NONE: 1802b4d72c08SEugene Crosser setcmd = IPA_SBP_RESET_BRIDGE_PORT_ROLE; 1803d65626adSJulian Wiedmann cmdlength = sizeof(struct qeth_sbp_reset_role); 1804b4d72c08SEugene Crosser break; 1805b4d72c08SEugene Crosser case QETH_SBP_ROLE_PRIMARY: 1806b4d72c08SEugene Crosser setcmd = IPA_SBP_SET_PRIMARY_BRIDGE_PORT; 1807d65626adSJulian Wiedmann cmdlength = sizeof(struct qeth_sbp_set_primary); 1808b4d72c08SEugene Crosser break; 1809b4d72c08SEugene Crosser case QETH_SBP_ROLE_SECONDARY: 1810b4d72c08SEugene Crosser setcmd = IPA_SBP_SET_SECONDARY_BRIDGE_PORT; 1811d65626adSJulian Wiedmann cmdlength = sizeof(struct qeth_sbp_set_secondary); 1812b4d72c08SEugene Crosser break; 1813b4d72c08SEugene Crosser default: 1814b4d72c08SEugene Crosser return -EINVAL; 1815b4d72c08SEugene Crosser } 1816b4d72c08SEugene Crosser if (!(card->options.sbp.supported_funcs & setcmd)) 1817b4d72c08SEugene Crosser return -EOPNOTSUPP; 1818d65626adSJulian Wiedmann iob = qeth_sbp_build_cmd(card, setcmd, cmdlength); 18191aec42bcSThomas Richter if (!iob) 18201aec42bcSThomas Richter return -ENOMEM; 1821b4d72c08SEugene Crosser rc = qeth_send_ipa_cmd(card, iob, qeth_bridgeport_set_cb, 1822b4d72c08SEugene Crosser (void *)&cbctl); 1823c88394e7SEugene Crosser if (rc < 0) 1824b4d72c08SEugene Crosser return rc; 1825c88394e7SEugene Crosser return qeth_bridgeport_makerc(card, &cbctl, setcmd); 1826b4d72c08SEugene Crosser } 1827b4d72c08SEugene Crosser 18289f48b9dbSEugene Crosser /** 18299f48b9dbSEugene Crosser * qeth_anset_makerc() - derive "traditional" error from hardware codes. 18309f48b9dbSEugene Crosser * @card: qeth_card structure pointer, for debug messages. 18319f48b9dbSEugene Crosser * 18329f48b9dbSEugene Crosser * Returns negative errno-compatible error indication or 0 on success. 18339f48b9dbSEugene Crosser */ 18349f48b9dbSEugene Crosser static int qeth_anset_makerc(struct qeth_card *card, int pnso_rc, u16 response) 18359f48b9dbSEugene Crosser { 18369f48b9dbSEugene Crosser int rc; 18379f48b9dbSEugene Crosser 18389f48b9dbSEugene Crosser if (pnso_rc == 0) 18399f48b9dbSEugene Crosser switch (response) { 18409f48b9dbSEugene Crosser case 0x0001: 18419f48b9dbSEugene Crosser rc = 0; 18429f48b9dbSEugene Crosser break; 18439f48b9dbSEugene Crosser case 0x0004: 18449f48b9dbSEugene Crosser case 0x0100: 18459f48b9dbSEugene Crosser case 0x0106: 1846ffb95251SEugene Crosser rc = -EOPNOTSUPP; 18479f48b9dbSEugene Crosser dev_err(&card->gdev->dev, 18489f48b9dbSEugene Crosser "Setting address notification failed\n"); 18499f48b9dbSEugene Crosser break; 18509f48b9dbSEugene Crosser case 0x0107: 18519f48b9dbSEugene Crosser rc = -EAGAIN; 18529f48b9dbSEugene Crosser break; 18539f48b9dbSEugene Crosser default: 18549f48b9dbSEugene Crosser rc = -EIO; 18559f48b9dbSEugene Crosser } 18569f48b9dbSEugene Crosser else 18579f48b9dbSEugene Crosser rc = -EIO; 18589f48b9dbSEugene Crosser 18599f48b9dbSEugene Crosser if (rc) { 18609f48b9dbSEugene Crosser QETH_CARD_TEXT_(card, 2, "SBPp%04x", pnso_rc); 18619f48b9dbSEugene Crosser QETH_CARD_TEXT_(card, 2, "SBPr%04x", response); 18629f48b9dbSEugene Crosser } 18639f48b9dbSEugene Crosser return rc; 18649f48b9dbSEugene Crosser } 18659f48b9dbSEugene Crosser 18669f48b9dbSEugene Crosser static void qeth_bridgeport_an_set_cb(void *priv, 18679f48b9dbSEugene Crosser enum qdio_brinfo_entry_type type, void *entry) 18689f48b9dbSEugene Crosser { 18699f48b9dbSEugene Crosser struct qeth_card *card = (struct qeth_card *)priv; 18709f48b9dbSEugene Crosser struct qdio_brinfo_entry_l2 *l2entry; 18719f48b9dbSEugene Crosser u8 code; 18729f48b9dbSEugene Crosser 18739f48b9dbSEugene Crosser if (type != l2_addr_lnid) { 18749f48b9dbSEugene Crosser WARN_ON_ONCE(1); 18759f48b9dbSEugene Crosser return; 18769f48b9dbSEugene Crosser } 18779f48b9dbSEugene Crosser 18789f48b9dbSEugene Crosser l2entry = (struct qdio_brinfo_entry_l2 *)entry; 18799f48b9dbSEugene Crosser code = IPA_ADDR_CHANGE_CODE_MACADDR; 18809f48b9dbSEugene Crosser if (l2entry->addr_lnid.lnid) 18819f48b9dbSEugene Crosser code |= IPA_ADDR_CHANGE_CODE_VLANID; 18829f48b9dbSEugene Crosser qeth_bridge_emit_host_event(card, anev_reg_unreg, code, 18839f48b9dbSEugene Crosser (struct net_if_token *)&l2entry->nit, 18849f48b9dbSEugene Crosser (struct mac_addr_lnid *)&l2entry->addr_lnid); 18859f48b9dbSEugene Crosser } 18869f48b9dbSEugene Crosser 18879f48b9dbSEugene Crosser /** 18889f48b9dbSEugene Crosser * qeth_bridgeport_an_set() - Enable or disable bridgeport address notification 18899f48b9dbSEugene Crosser * @card: qeth_card structure pointer. 18909f48b9dbSEugene Crosser * @enable: 0 - disable, non-zero - enable notifications 18919f48b9dbSEugene Crosser * 18929f48b9dbSEugene Crosser * Returns negative errno-compatible error indication or 0 on success. 18939f48b9dbSEugene Crosser * 18949f48b9dbSEugene Crosser * On enable, emits a series of address notifications udev events for all 18959f48b9dbSEugene Crosser * currently registered hosts. 18969f48b9dbSEugene Crosser */ 18979f48b9dbSEugene Crosser int qeth_bridgeport_an_set(struct qeth_card *card, int enable) 18989f48b9dbSEugene Crosser { 18999f48b9dbSEugene Crosser int rc; 19009f48b9dbSEugene Crosser u16 response; 19019f48b9dbSEugene Crosser struct ccw_device *ddev; 19029f48b9dbSEugene Crosser struct subchannel_id schid; 19039f48b9dbSEugene Crosser 19049f48b9dbSEugene Crosser if (!card) 19059f48b9dbSEugene Crosser return -EINVAL; 19069f48b9dbSEugene Crosser if (!card->options.sbp.supported_funcs) 19079f48b9dbSEugene Crosser return -EOPNOTSUPP; 19089f48b9dbSEugene Crosser ddev = CARD_DDEV(card); 19099f48b9dbSEugene Crosser ccw_device_get_schid(ddev, &schid); 19109f48b9dbSEugene Crosser 19119f48b9dbSEugene Crosser if (enable) { 19129f48b9dbSEugene Crosser qeth_bridge_emit_host_event(card, anev_reset, 0, NULL, NULL); 19139f48b9dbSEugene Crosser rc = qdio_pnso_brinfo(schid, 1, &response, 19149f48b9dbSEugene Crosser qeth_bridgeport_an_set_cb, card); 19159f48b9dbSEugene Crosser } else 19169f48b9dbSEugene Crosser rc = qdio_pnso_brinfo(schid, 0, &response, NULL, NULL); 19179f48b9dbSEugene Crosser return qeth_anset_makerc(card, rc, response); 19189f48b9dbSEugene Crosser } 19199f48b9dbSEugene Crosser 1920caa1f0b1SHans Wippel static bool qeth_bridgeport_is_in_use(struct qeth_card *card) 1921caa1f0b1SHans Wippel { 1922caa1f0b1SHans Wippel return (card->options.sbp.role || card->options.sbp.reflect_promisc || 1923caa1f0b1SHans Wippel card->options.sbp.hostnotification); 1924caa1f0b1SHans Wippel } 1925caa1f0b1SHans Wippel 1926a45b3fafSHans Wippel /* VNIC Characteristics support */ 1927a45b3fafSHans Wippel 1928a45b3fafSHans Wippel /* handle VNICC IPA command return codes; convert to error codes */ 1929a45b3fafSHans Wippel static int qeth_l2_vnicc_makerc(struct qeth_card *card, int ipa_rc) 1930a45b3fafSHans Wippel { 1931a45b3fafSHans Wippel int rc; 1932a45b3fafSHans Wippel 1933a45b3fafSHans Wippel switch (ipa_rc) { 1934a45b3fafSHans Wippel case IPA_RC_SUCCESS: 1935a45b3fafSHans Wippel return ipa_rc; 1936a45b3fafSHans Wippel case IPA_RC_L2_UNSUPPORTED_CMD: 1937a45b3fafSHans Wippel case IPA_RC_NOTSUPP: 1938a45b3fafSHans Wippel rc = -EOPNOTSUPP; 1939a45b3fafSHans Wippel break; 1940a45b3fafSHans Wippel case IPA_RC_VNICC_OOSEQ: 1941a45b3fafSHans Wippel rc = -EALREADY; 1942a45b3fafSHans Wippel break; 1943a45b3fafSHans Wippel case IPA_RC_VNICC_VNICBP: 1944a45b3fafSHans Wippel rc = -EBUSY; 1945a45b3fafSHans Wippel break; 1946a45b3fafSHans Wippel case IPA_RC_L2_ADDR_TABLE_FULL: 1947a45b3fafSHans Wippel rc = -ENOSPC; 1948a45b3fafSHans Wippel break; 1949a45b3fafSHans Wippel case IPA_RC_L2_MAC_NOT_AUTH_BY_ADP: 1950a45b3fafSHans Wippel rc = -EACCES; 1951a45b3fafSHans Wippel break; 1952a45b3fafSHans Wippel default: 1953a45b3fafSHans Wippel rc = -EIO; 1954a45b3fafSHans Wippel } 1955a45b3fafSHans Wippel 1956a45b3fafSHans Wippel QETH_CARD_TEXT_(card, 2, "err%04x", ipa_rc); 1957a45b3fafSHans Wippel return rc; 1958a45b3fafSHans Wippel } 1959a45b3fafSHans Wippel 1960a45b3fafSHans Wippel /* generic VNICC request call back control */ 1961a45b3fafSHans Wippel struct _qeth_l2_vnicc_request_cbctl { 1962a45b3fafSHans Wippel u32 sub_cmd; 1963caa1f0b1SHans Wippel struct { 1964caa1f0b1SHans Wippel u32 vnic_char; 1965349d13d5SHans Wippel u32 timeout; 1966caa1f0b1SHans Wippel } param; 1967caa1f0b1SHans Wippel struct { 1968349d13d5SHans Wippel union{ 1969caa1f0b1SHans Wippel u32 *sup_cmds; 1970349d13d5SHans Wippel u32 *timeout; 1971349d13d5SHans Wippel }; 1972caa1f0b1SHans Wippel } result; 1973a45b3fafSHans Wippel }; 1974a45b3fafSHans Wippel 1975a45b3fafSHans Wippel /* generic VNICC request call back */ 1976a45b3fafSHans Wippel static int qeth_l2_vnicc_request_cb(struct qeth_card *card, 1977a45b3fafSHans Wippel struct qeth_reply *reply, 1978a45b3fafSHans Wippel unsigned long data) 1979a45b3fafSHans Wippel { 1980caa1f0b1SHans Wippel struct _qeth_l2_vnicc_request_cbctl *cbctl = 1981caa1f0b1SHans Wippel (struct _qeth_l2_vnicc_request_cbctl *) reply->param; 1982a45b3fafSHans Wippel struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *) data; 1983a45b3fafSHans Wippel struct qeth_ipacmd_vnicc *rep = &cmd->data.vnicc; 1984a45b3fafSHans Wippel 1985a45b3fafSHans Wippel QETH_CARD_TEXT(card, 2, "vniccrcb"); 1986a45b3fafSHans Wippel if (cmd->hdr.return_code) 1987a45b3fafSHans Wippel return 0; 1988a45b3fafSHans Wippel /* return results to caller */ 1989a45b3fafSHans Wippel card->options.vnicc.sup_chars = rep->hdr.sup; 1990a45b3fafSHans Wippel card->options.vnicc.cur_chars = rep->hdr.cur; 1991a45b3fafSHans Wippel 1992caa1f0b1SHans Wippel if (cbctl->sub_cmd == IPA_VNICC_QUERY_CMDS) 1993caa1f0b1SHans Wippel *cbctl->result.sup_cmds = rep->query_cmds.sup_cmds; 1994caa1f0b1SHans Wippel 1995349d13d5SHans Wippel if (cbctl->sub_cmd == IPA_VNICC_GET_TIMEOUT) 1996349d13d5SHans Wippel *cbctl->result.timeout = rep->getset_timeout.timeout; 1997349d13d5SHans Wippel 1998a45b3fafSHans Wippel return 0; 1999a45b3fafSHans Wippel } 2000a45b3fafSHans Wippel 2001a45b3fafSHans Wippel /* generic VNICC request */ 2002a45b3fafSHans Wippel static int qeth_l2_vnicc_request(struct qeth_card *card, 2003a45b3fafSHans Wippel struct _qeth_l2_vnicc_request_cbctl *cbctl) 2004a45b3fafSHans Wippel { 2005a45b3fafSHans Wippel struct qeth_ipacmd_vnicc *req; 2006a45b3fafSHans Wippel struct qeth_cmd_buffer *iob; 2007a45b3fafSHans Wippel struct qeth_ipa_cmd *cmd; 2008a45b3fafSHans Wippel int rc; 2009a45b3fafSHans Wippel 2010a45b3fafSHans Wippel QETH_CARD_TEXT(card, 2, "vniccreq"); 2011a45b3fafSHans Wippel 2012a45b3fafSHans Wippel /* get new buffer for request */ 2013a45b3fafSHans Wippel iob = qeth_get_ipacmd_buffer(card, IPA_CMD_VNICC, 0); 2014a45b3fafSHans Wippel if (!iob) 2015a45b3fafSHans Wippel return -ENOMEM; 2016a45b3fafSHans Wippel 2017a45b3fafSHans Wippel /* create header for request */ 2018ff5caa7aSJulian Wiedmann cmd = __ipa_cmd(iob); 2019a45b3fafSHans Wippel req = &cmd->data.vnicc; 2020a45b3fafSHans Wippel 2021a45b3fafSHans Wippel /* create sub command header for request */ 2022a45b3fafSHans Wippel req->sub_hdr.data_length = sizeof(req->sub_hdr); 2023a45b3fafSHans Wippel req->sub_hdr.sub_command = cbctl->sub_cmd; 2024a45b3fafSHans Wippel 2025a45b3fafSHans Wippel /* create sub command specific request fields */ 2026a45b3fafSHans Wippel switch (cbctl->sub_cmd) { 2027a45b3fafSHans Wippel case IPA_VNICC_QUERY_CHARS: 2028a45b3fafSHans Wippel break; 2029caa1f0b1SHans Wippel case IPA_VNICC_QUERY_CMDS: 2030caa1f0b1SHans Wippel req->sub_hdr.data_length += sizeof(req->query_cmds); 2031caa1f0b1SHans Wippel req->query_cmds.vnic_char = cbctl->param.vnic_char; 2032caa1f0b1SHans Wippel break; 2033caa1f0b1SHans Wippel case IPA_VNICC_ENABLE: 2034caa1f0b1SHans Wippel case IPA_VNICC_DISABLE: 2035caa1f0b1SHans Wippel req->sub_hdr.data_length += sizeof(req->set_char); 2036caa1f0b1SHans Wippel req->set_char.vnic_char = cbctl->param.vnic_char; 2037caa1f0b1SHans Wippel break; 2038349d13d5SHans Wippel case IPA_VNICC_SET_TIMEOUT: 2039349d13d5SHans Wippel req->getset_timeout.timeout = cbctl->param.timeout; 2040349d13d5SHans Wippel /* fallthrough */ 2041349d13d5SHans Wippel case IPA_VNICC_GET_TIMEOUT: 2042349d13d5SHans Wippel req->sub_hdr.data_length += sizeof(req->getset_timeout); 2043349d13d5SHans Wippel req->getset_timeout.vnic_char = cbctl->param.vnic_char; 2044349d13d5SHans Wippel break; 2045a45b3fafSHans Wippel default: 2046a45b3fafSHans Wippel qeth_release_buffer(iob->channel, iob); 2047a45b3fafSHans Wippel return -EOPNOTSUPP; 2048a45b3fafSHans Wippel } 2049a45b3fafSHans Wippel 2050a45b3fafSHans Wippel /* send request */ 2051a45b3fafSHans Wippel rc = qeth_send_ipa_cmd(card, iob, qeth_l2_vnicc_request_cb, 2052a45b3fafSHans Wippel (void *) cbctl); 2053a45b3fafSHans Wippel 2054a45b3fafSHans Wippel return qeth_l2_vnicc_makerc(card, rc); 2055a45b3fafSHans Wippel } 2056a45b3fafSHans Wippel 2057a45b3fafSHans Wippel /* VNICC query VNIC characteristics request */ 2058a45b3fafSHans Wippel static int qeth_l2_vnicc_query_chars(struct qeth_card *card) 2059a45b3fafSHans Wippel { 2060a45b3fafSHans Wippel struct _qeth_l2_vnicc_request_cbctl cbctl; 2061a45b3fafSHans Wippel 2062a45b3fafSHans Wippel /* prepare callback control */ 2063a45b3fafSHans Wippel cbctl.sub_cmd = IPA_VNICC_QUERY_CHARS; 2064a45b3fafSHans Wippel 2065a45b3fafSHans Wippel QETH_CARD_TEXT(card, 2, "vniccqch"); 2066a45b3fafSHans Wippel return qeth_l2_vnicc_request(card, &cbctl); 2067a45b3fafSHans Wippel } 2068a45b3fafSHans Wippel 2069caa1f0b1SHans Wippel /* VNICC query sub commands request */ 2070caa1f0b1SHans Wippel static int qeth_l2_vnicc_query_cmds(struct qeth_card *card, u32 vnic_char, 2071caa1f0b1SHans Wippel u32 *sup_cmds) 2072caa1f0b1SHans Wippel { 2073caa1f0b1SHans Wippel struct _qeth_l2_vnicc_request_cbctl cbctl; 2074caa1f0b1SHans Wippel 2075caa1f0b1SHans Wippel /* prepare callback control */ 2076caa1f0b1SHans Wippel cbctl.sub_cmd = IPA_VNICC_QUERY_CMDS; 2077caa1f0b1SHans Wippel cbctl.param.vnic_char = vnic_char; 2078caa1f0b1SHans Wippel cbctl.result.sup_cmds = sup_cmds; 2079caa1f0b1SHans Wippel 2080caa1f0b1SHans Wippel QETH_CARD_TEXT(card, 2, "vniccqcm"); 2081caa1f0b1SHans Wippel return qeth_l2_vnicc_request(card, &cbctl); 2082caa1f0b1SHans Wippel } 2083caa1f0b1SHans Wippel 2084caa1f0b1SHans Wippel /* VNICC enable/disable characteristic request */ 2085caa1f0b1SHans Wippel static int qeth_l2_vnicc_set_char(struct qeth_card *card, u32 vnic_char, 2086caa1f0b1SHans Wippel u32 cmd) 2087caa1f0b1SHans Wippel { 2088caa1f0b1SHans Wippel struct _qeth_l2_vnicc_request_cbctl cbctl; 2089caa1f0b1SHans Wippel 2090caa1f0b1SHans Wippel /* prepare callback control */ 2091caa1f0b1SHans Wippel cbctl.sub_cmd = cmd; 2092caa1f0b1SHans Wippel cbctl.param.vnic_char = vnic_char; 2093caa1f0b1SHans Wippel 2094caa1f0b1SHans Wippel QETH_CARD_TEXT(card, 2, "vniccedc"); 2095caa1f0b1SHans Wippel return qeth_l2_vnicc_request(card, &cbctl); 2096caa1f0b1SHans Wippel } 2097caa1f0b1SHans Wippel 2098349d13d5SHans Wippel /* VNICC get/set timeout for characteristic request */ 2099349d13d5SHans Wippel static int qeth_l2_vnicc_getset_timeout(struct qeth_card *card, u32 vnicc, 2100349d13d5SHans Wippel u32 cmd, u32 *timeout) 2101349d13d5SHans Wippel { 2102349d13d5SHans Wippel struct _qeth_l2_vnicc_request_cbctl cbctl; 2103349d13d5SHans Wippel 2104349d13d5SHans Wippel /* prepare callback control */ 2105349d13d5SHans Wippel cbctl.sub_cmd = cmd; 2106349d13d5SHans Wippel cbctl.param.vnic_char = vnicc; 2107349d13d5SHans Wippel if (cmd == IPA_VNICC_SET_TIMEOUT) 2108349d13d5SHans Wippel cbctl.param.timeout = *timeout; 2109349d13d5SHans Wippel if (cmd == IPA_VNICC_GET_TIMEOUT) 2110349d13d5SHans Wippel cbctl.result.timeout = timeout; 2111349d13d5SHans Wippel 2112349d13d5SHans Wippel QETH_CARD_TEXT(card, 2, "vniccgst"); 2113349d13d5SHans Wippel return qeth_l2_vnicc_request(card, &cbctl); 2114349d13d5SHans Wippel } 2115349d13d5SHans Wippel 2116caa1f0b1SHans Wippel /* set current VNICC flag state; called from sysfs store function */ 2117caa1f0b1SHans Wippel int qeth_l2_vnicc_set_state(struct qeth_card *card, u32 vnicc, bool state) 2118caa1f0b1SHans Wippel { 2119caa1f0b1SHans Wippel int rc = 0; 2120caa1f0b1SHans Wippel u32 cmd; 2121caa1f0b1SHans Wippel 2122caa1f0b1SHans Wippel QETH_CARD_TEXT(card, 2, "vniccsch"); 2123caa1f0b1SHans Wippel 2124caa1f0b1SHans Wippel /* do not change anything if BridgePort is enabled */ 2125caa1f0b1SHans Wippel if (qeth_bridgeport_is_in_use(card)) 2126caa1f0b1SHans Wippel return -EBUSY; 2127caa1f0b1SHans Wippel 2128caa1f0b1SHans Wippel /* check if characteristic and enable/disable are supported */ 2129caa1f0b1SHans Wippel if (!(card->options.vnicc.sup_chars & vnicc) || 2130caa1f0b1SHans Wippel !(card->options.vnicc.set_char_sup & vnicc)) 2131caa1f0b1SHans Wippel return -EOPNOTSUPP; 2132caa1f0b1SHans Wippel 2133caa1f0b1SHans Wippel /* set enable/disable command and store wanted characteristic */ 2134caa1f0b1SHans Wippel if (state) { 2135caa1f0b1SHans Wippel cmd = IPA_VNICC_ENABLE; 2136caa1f0b1SHans Wippel card->options.vnicc.wanted_chars |= vnicc; 2137caa1f0b1SHans Wippel } else { 2138caa1f0b1SHans Wippel cmd = IPA_VNICC_DISABLE; 2139caa1f0b1SHans Wippel card->options.vnicc.wanted_chars &= ~vnicc; 2140caa1f0b1SHans Wippel } 2141caa1f0b1SHans Wippel 2142caa1f0b1SHans Wippel /* do we need to do anything? */ 2143caa1f0b1SHans Wippel if (card->options.vnicc.cur_chars == card->options.vnicc.wanted_chars) 2144caa1f0b1SHans Wippel return rc; 2145caa1f0b1SHans Wippel 2146caa1f0b1SHans Wippel /* if card is not ready, simply stop here */ 2147caa1f0b1SHans Wippel if (!qeth_card_hw_is_reachable(card)) { 2148caa1f0b1SHans Wippel if (state) 2149caa1f0b1SHans Wippel card->options.vnicc.cur_chars |= vnicc; 2150caa1f0b1SHans Wippel else 2151caa1f0b1SHans Wippel card->options.vnicc.cur_chars &= ~vnicc; 2152caa1f0b1SHans Wippel return rc; 2153caa1f0b1SHans Wippel } 2154caa1f0b1SHans Wippel 2155caa1f0b1SHans Wippel rc = qeth_l2_vnicc_set_char(card, vnicc, cmd); 2156caa1f0b1SHans Wippel if (rc) 2157caa1f0b1SHans Wippel card->options.vnicc.wanted_chars = 2158caa1f0b1SHans Wippel card->options.vnicc.cur_chars; 2159349d13d5SHans Wippel else { 2160349d13d5SHans Wippel /* successful online VNICC change; handle special cases */ 2161349d13d5SHans Wippel if (state && vnicc == QETH_VNICC_RX_BCAST) 2162caa1f0b1SHans Wippel card->options.vnicc.rx_bcast_enabled = true; 2163349d13d5SHans Wippel if (!state && vnicc == QETH_VNICC_LEARNING) 2164349d13d5SHans Wippel qeth_l2_vnicc_recover_timeout(card, vnicc, 2165349d13d5SHans Wippel &card->options.vnicc.learning_timeout); 2166349d13d5SHans Wippel } 2167caa1f0b1SHans Wippel 2168caa1f0b1SHans Wippel return rc; 2169caa1f0b1SHans Wippel } 2170caa1f0b1SHans Wippel 2171caa1f0b1SHans Wippel /* get current VNICC flag state; called from sysfs show function */ 2172caa1f0b1SHans Wippel int qeth_l2_vnicc_get_state(struct qeth_card *card, u32 vnicc, bool *state) 2173caa1f0b1SHans Wippel { 2174caa1f0b1SHans Wippel int rc = 0; 2175caa1f0b1SHans Wippel 2176caa1f0b1SHans Wippel QETH_CARD_TEXT(card, 2, "vniccgch"); 2177caa1f0b1SHans Wippel 2178caa1f0b1SHans Wippel /* do not get anything if BridgePort is enabled */ 2179caa1f0b1SHans Wippel if (qeth_bridgeport_is_in_use(card)) 2180caa1f0b1SHans Wippel return -EBUSY; 2181caa1f0b1SHans Wippel 2182caa1f0b1SHans Wippel /* check if characteristic is supported */ 2183caa1f0b1SHans Wippel if (!(card->options.vnicc.sup_chars & vnicc)) 2184caa1f0b1SHans Wippel return -EOPNOTSUPP; 2185caa1f0b1SHans Wippel 2186caa1f0b1SHans Wippel /* if card is ready, query current VNICC state */ 2187caa1f0b1SHans Wippel if (qeth_card_hw_is_reachable(card)) 2188caa1f0b1SHans Wippel rc = qeth_l2_vnicc_query_chars(card); 2189caa1f0b1SHans Wippel 2190caa1f0b1SHans Wippel *state = (card->options.vnicc.cur_chars & vnicc) ? true : false; 2191caa1f0b1SHans Wippel return rc; 2192caa1f0b1SHans Wippel } 2193caa1f0b1SHans Wippel 2194349d13d5SHans Wippel /* set VNICC timeout; called from sysfs store function. Currently, only learning 2195349d13d5SHans Wippel * supports timeout 2196349d13d5SHans Wippel */ 2197349d13d5SHans Wippel int qeth_l2_vnicc_set_timeout(struct qeth_card *card, u32 timeout) 2198349d13d5SHans Wippel { 2199349d13d5SHans Wippel int rc = 0; 2200349d13d5SHans Wippel 2201349d13d5SHans Wippel QETH_CARD_TEXT(card, 2, "vniccsto"); 2202349d13d5SHans Wippel 2203349d13d5SHans Wippel /* do not change anything if BridgePort is enabled */ 2204349d13d5SHans Wippel if (qeth_bridgeport_is_in_use(card)) 2205349d13d5SHans Wippel return -EBUSY; 2206349d13d5SHans Wippel 2207349d13d5SHans Wippel /* check if characteristic and set_timeout are supported */ 2208349d13d5SHans Wippel if (!(card->options.vnicc.sup_chars & QETH_VNICC_LEARNING) || 2209349d13d5SHans Wippel !(card->options.vnicc.getset_timeout_sup & QETH_VNICC_LEARNING)) 2210349d13d5SHans Wippel return -EOPNOTSUPP; 2211349d13d5SHans Wippel 2212349d13d5SHans Wippel /* do we need to do anything? */ 2213349d13d5SHans Wippel if (card->options.vnicc.learning_timeout == timeout) 2214349d13d5SHans Wippel return rc; 2215349d13d5SHans Wippel 2216349d13d5SHans Wippel /* if card is not ready, simply store the value internally and return */ 2217349d13d5SHans Wippel if (!qeth_card_hw_is_reachable(card)) { 2218349d13d5SHans Wippel card->options.vnicc.learning_timeout = timeout; 2219349d13d5SHans Wippel return rc; 2220349d13d5SHans Wippel } 2221349d13d5SHans Wippel 2222349d13d5SHans Wippel /* send timeout value to card; if successful, store value internally */ 2223349d13d5SHans Wippel rc = qeth_l2_vnicc_getset_timeout(card, QETH_VNICC_LEARNING, 2224349d13d5SHans Wippel IPA_VNICC_SET_TIMEOUT, &timeout); 2225349d13d5SHans Wippel if (!rc) 2226349d13d5SHans Wippel card->options.vnicc.learning_timeout = timeout; 2227349d13d5SHans Wippel 2228349d13d5SHans Wippel return rc; 2229349d13d5SHans Wippel } 2230349d13d5SHans Wippel 2231349d13d5SHans Wippel /* get current VNICC timeout; called from sysfs show function. Currently, only 2232349d13d5SHans Wippel * learning supports timeout 2233349d13d5SHans Wippel */ 2234349d13d5SHans Wippel int qeth_l2_vnicc_get_timeout(struct qeth_card *card, u32 *timeout) 2235349d13d5SHans Wippel { 2236349d13d5SHans Wippel int rc = 0; 2237349d13d5SHans Wippel 2238349d13d5SHans Wippel QETH_CARD_TEXT(card, 2, "vniccgto"); 2239349d13d5SHans Wippel 2240349d13d5SHans Wippel /* do not get anything if BridgePort is enabled */ 2241349d13d5SHans Wippel if (qeth_bridgeport_is_in_use(card)) 2242349d13d5SHans Wippel return -EBUSY; 2243349d13d5SHans Wippel 2244349d13d5SHans Wippel /* check if characteristic and get_timeout are supported */ 2245349d13d5SHans Wippel if (!(card->options.vnicc.sup_chars & QETH_VNICC_LEARNING) || 2246349d13d5SHans Wippel !(card->options.vnicc.getset_timeout_sup & QETH_VNICC_LEARNING)) 2247349d13d5SHans Wippel return -EOPNOTSUPP; 2248349d13d5SHans Wippel /* if card is ready, get timeout. Otherwise, just return stored value */ 2249349d13d5SHans Wippel *timeout = card->options.vnicc.learning_timeout; 2250349d13d5SHans Wippel if (qeth_card_hw_is_reachable(card)) 2251349d13d5SHans Wippel rc = qeth_l2_vnicc_getset_timeout(card, QETH_VNICC_LEARNING, 2252349d13d5SHans Wippel IPA_VNICC_GET_TIMEOUT, 2253349d13d5SHans Wippel timeout); 2254349d13d5SHans Wippel 2255349d13d5SHans Wippel return rc; 2256349d13d5SHans Wippel } 2257349d13d5SHans Wippel 2258caa1f0b1SHans Wippel /* check if VNICC is currently enabled */ 2259caa1f0b1SHans Wippel bool qeth_l2_vnicc_is_in_use(struct qeth_card *card) 2260caa1f0b1SHans Wippel { 2261caa1f0b1SHans Wippel /* if everything is turned off, VNICC is not active */ 2262caa1f0b1SHans Wippel if (!card->options.vnicc.cur_chars) 2263caa1f0b1SHans Wippel return false; 2264caa1f0b1SHans Wippel /* default values are only OK if rx_bcast was not enabled by user 2265caa1f0b1SHans Wippel * or the card is offline. 2266caa1f0b1SHans Wippel */ 2267caa1f0b1SHans Wippel if (card->options.vnicc.cur_chars == QETH_VNICC_DEFAULT) { 2268caa1f0b1SHans Wippel if (!card->options.vnicc.rx_bcast_enabled || 2269caa1f0b1SHans Wippel !qeth_card_hw_is_reachable(card)) 2270caa1f0b1SHans Wippel return false; 2271caa1f0b1SHans Wippel } 2272caa1f0b1SHans Wippel return true; 2273caa1f0b1SHans Wippel } 2274caa1f0b1SHans Wippel 2275349d13d5SHans Wippel /* recover user timeout setting */ 2276349d13d5SHans Wippel static bool qeth_l2_vnicc_recover_timeout(struct qeth_card *card, u32 vnicc, 2277349d13d5SHans Wippel u32 *timeout) 2278349d13d5SHans Wippel { 2279349d13d5SHans Wippel if (card->options.vnicc.sup_chars & vnicc && 2280349d13d5SHans Wippel card->options.vnicc.getset_timeout_sup & vnicc && 2281349d13d5SHans Wippel !qeth_l2_vnicc_getset_timeout(card, vnicc, IPA_VNICC_SET_TIMEOUT, 2282349d13d5SHans Wippel timeout)) 2283349d13d5SHans Wippel return false; 2284349d13d5SHans Wippel *timeout = QETH_VNICC_DEFAULT_TIMEOUT; 2285349d13d5SHans Wippel return true; 2286349d13d5SHans Wippel } 2287349d13d5SHans Wippel 2288caa1f0b1SHans Wippel /* recover user characteristic setting */ 2289caa1f0b1SHans Wippel static bool qeth_l2_vnicc_recover_char(struct qeth_card *card, u32 vnicc, 2290caa1f0b1SHans Wippel bool enable) 2291caa1f0b1SHans Wippel { 2292caa1f0b1SHans Wippel u32 cmd = enable ? IPA_VNICC_ENABLE : IPA_VNICC_DISABLE; 2293caa1f0b1SHans Wippel 2294caa1f0b1SHans Wippel if (card->options.vnicc.sup_chars & vnicc && 2295caa1f0b1SHans Wippel card->options.vnicc.set_char_sup & vnicc && 2296caa1f0b1SHans Wippel !qeth_l2_vnicc_set_char(card, vnicc, cmd)) 2297caa1f0b1SHans Wippel return false; 2298caa1f0b1SHans Wippel card->options.vnicc.wanted_chars &= ~vnicc; 2299caa1f0b1SHans Wippel card->options.vnicc.wanted_chars |= QETH_VNICC_DEFAULT & vnicc; 2300caa1f0b1SHans Wippel return true; 2301caa1f0b1SHans Wippel } 2302caa1f0b1SHans Wippel 2303a45b3fafSHans Wippel /* (re-)initialize VNICC */ 2304a45b3fafSHans Wippel static void qeth_l2_vnicc_init(struct qeth_card *card) 2305a45b3fafSHans Wippel { 2306349d13d5SHans Wippel u32 *timeout = &card->options.vnicc.learning_timeout; 2307caa1f0b1SHans Wippel unsigned int chars_len, i; 2308caa1f0b1SHans Wippel unsigned long chars_tmp; 2309caa1f0b1SHans Wippel u32 sup_cmds, vnicc; 2310caa1f0b1SHans Wippel bool enable, error; 2311caa1f0b1SHans Wippel 2312a45b3fafSHans Wippel QETH_CARD_TEXT(card, 2, "vniccini"); 2313caa1f0b1SHans Wippel /* reset rx_bcast */ 2314caa1f0b1SHans Wippel card->options.vnicc.rx_bcast_enabled = 0; 2315a45b3fafSHans Wippel /* initial query and storage of VNIC characteristics */ 2316a45b3fafSHans Wippel if (qeth_l2_vnicc_query_chars(card)) { 2317349d13d5SHans Wippel if (card->options.vnicc.wanted_chars != QETH_VNICC_DEFAULT || 2318349d13d5SHans Wippel *timeout != QETH_VNICC_DEFAULT_TIMEOUT) 2319caa1f0b1SHans Wippel dev_err(&card->gdev->dev, "Configuring the VNIC characteristics failed\n"); 2320caa1f0b1SHans Wippel /* fail quietly if user didn't change the default config */ 2321a45b3fafSHans Wippel card->options.vnicc.sup_chars = 0; 2322a45b3fafSHans Wippel card->options.vnicc.cur_chars = 0; 2323caa1f0b1SHans Wippel card->options.vnicc.wanted_chars = QETH_VNICC_DEFAULT; 2324caa1f0b1SHans Wippel return; 2325a45b3fafSHans Wippel } 2326caa1f0b1SHans Wippel /* get supported commands for each supported characteristic */ 2327caa1f0b1SHans Wippel chars_tmp = card->options.vnicc.sup_chars; 2328caa1f0b1SHans Wippel chars_len = sizeof(card->options.vnicc.sup_chars) * BITS_PER_BYTE; 2329caa1f0b1SHans Wippel for_each_set_bit(i, &chars_tmp, chars_len) { 2330caa1f0b1SHans Wippel vnicc = BIT(i); 2331caa1f0b1SHans Wippel qeth_l2_vnicc_query_cmds(card, vnicc, &sup_cmds); 2332349d13d5SHans Wippel if (!(sup_cmds & IPA_VNICC_SET_TIMEOUT) || 2333349d13d5SHans Wippel !(sup_cmds & IPA_VNICC_GET_TIMEOUT)) 2334349d13d5SHans Wippel card->options.vnicc.getset_timeout_sup &= ~vnicc; 2335caa1f0b1SHans Wippel if (!(sup_cmds & IPA_VNICC_ENABLE) || 2336caa1f0b1SHans Wippel !(sup_cmds & IPA_VNICC_DISABLE)) 2337caa1f0b1SHans Wippel card->options.vnicc.set_char_sup &= ~vnicc; 2338caa1f0b1SHans Wippel } 2339caa1f0b1SHans Wippel /* enforce assumed default values and recover settings, if changed */ 2340349d13d5SHans Wippel error = qeth_l2_vnicc_recover_timeout(card, QETH_VNICC_LEARNING, 2341349d13d5SHans Wippel timeout); 2342caa1f0b1SHans Wippel chars_tmp = card->options.vnicc.wanted_chars ^ QETH_VNICC_DEFAULT; 2343caa1f0b1SHans Wippel chars_tmp |= QETH_VNICC_BRIDGE_INVISIBLE; 2344caa1f0b1SHans Wippel chars_len = sizeof(card->options.vnicc.wanted_chars) * BITS_PER_BYTE; 2345caa1f0b1SHans Wippel for_each_set_bit(i, &chars_tmp, chars_len) { 2346caa1f0b1SHans Wippel vnicc = BIT(i); 2347caa1f0b1SHans Wippel enable = card->options.vnicc.wanted_chars & vnicc; 2348caa1f0b1SHans Wippel error |= qeth_l2_vnicc_recover_char(card, vnicc, enable); 2349caa1f0b1SHans Wippel } 2350caa1f0b1SHans Wippel if (error) 2351caa1f0b1SHans Wippel dev_err(&card->gdev->dev, "Configuring the VNIC characteristics failed\n"); 2352caa1f0b1SHans Wippel } 2353caa1f0b1SHans Wippel 2354caa1f0b1SHans Wippel /* configure default values of VNIC characteristics */ 2355caa1f0b1SHans Wippel static void qeth_l2_vnicc_set_defaults(struct qeth_card *card) 2356caa1f0b1SHans Wippel { 2357caa1f0b1SHans Wippel /* characteristics values */ 2358caa1f0b1SHans Wippel card->options.vnicc.sup_chars = QETH_VNICC_ALL; 2359caa1f0b1SHans Wippel card->options.vnicc.cur_chars = QETH_VNICC_DEFAULT; 2360349d13d5SHans Wippel card->options.vnicc.learning_timeout = QETH_VNICC_DEFAULT_TIMEOUT; 2361caa1f0b1SHans Wippel /* supported commands */ 2362caa1f0b1SHans Wippel card->options.vnicc.set_char_sup = QETH_VNICC_ALL; 2363349d13d5SHans Wippel card->options.vnicc.getset_timeout_sup = QETH_VNICC_LEARNING; 2364caa1f0b1SHans Wippel /* settings wanted by users */ 2365caa1f0b1SHans Wippel card->options.vnicc.wanted_chars = QETH_VNICC_DEFAULT; 2366a45b3fafSHans Wippel } 2367a45b3fafSHans Wippel 23684a71df50SFrank Blaschka module_init(qeth_l2_init); 23694a71df50SFrank Blaschka module_exit(qeth_l2_exit); 23704a71df50SFrank Blaschka MODULE_AUTHOR("Frank Blaschka <frank.blaschka@de.ibm.com>"); 23714a71df50SFrank Blaschka MODULE_DESCRIPTION("qeth layer 2 discipline"); 23724a71df50SFrank Blaschka MODULE_LICENSE("GPL"); 2373