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 *); 29fe5c8028SLakhvich Dmitriy static void qeth_l2_set_rx_mode(struct net_device *); 30c044dc21SEugene Crosser static void qeth_bridgeport_query_support(struct qeth_card *card); 31c044dc21SEugene Crosser static void qeth_bridge_state_change(struct qeth_card *card, 32c044dc21SEugene Crosser struct qeth_ipa_cmd *cmd); 33c044dc21SEugene Crosser static void qeth_bridge_host_event(struct qeth_card *card, 34c044dc21SEugene Crosser struct qeth_ipa_cmd *cmd); 35caa1f0b1SHans Wippel static void qeth_l2_vnicc_set_defaults(struct qeth_card *card); 36a45b3fafSHans Wippel static void qeth_l2_vnicc_init(struct qeth_card *card); 37349d13d5SHans Wippel static bool qeth_l2_vnicc_recover_timeout(struct qeth_card *card, u32 vnicc, 38349d13d5SHans Wippel u32 *timeout); 394a71df50SFrank Blaschka 404a71df50SFrank Blaschka static struct net_device *qeth_l2_netdev_by_devno(unsigned char *read_dev_no) 414a71df50SFrank Blaschka { 424a71df50SFrank Blaschka struct qeth_card *card; 434a71df50SFrank Blaschka struct net_device *ndev; 44f06f6f32SCornelia Huck __u16 temp_dev_no; 454a71df50SFrank Blaschka unsigned long flags; 46f06f6f32SCornelia Huck struct ccw_dev_id read_devid; 474a71df50SFrank Blaschka 484a71df50SFrank Blaschka ndev = NULL; 494a71df50SFrank Blaschka memcpy(&temp_dev_no, read_dev_no, 2); 504a71df50SFrank Blaschka read_lock_irqsave(&qeth_core_card_list.rwlock, flags); 514a71df50SFrank Blaschka list_for_each_entry(card, &qeth_core_card_list.list, list) { 52f06f6f32SCornelia Huck ccw_device_get_id(CARD_RDEV(card), &read_devid); 53f06f6f32SCornelia Huck if (read_devid.devno == temp_dev_no) { 544a71df50SFrank Blaschka ndev = card->dev; 554a71df50SFrank Blaschka break; 564a71df50SFrank Blaschka } 574a71df50SFrank Blaschka } 584a71df50SFrank Blaschka read_unlock_irqrestore(&qeth_core_card_list.rwlock, flags); 594a71df50SFrank Blaschka return ndev; 604a71df50SFrank Blaschka } 614a71df50SFrank Blaschka 622aa48671SJulian Wiedmann static int qeth_setdelmac_makerc(struct qeth_card *card, int retcode) 634a71df50SFrank Blaschka { 64efbbc1d5SEugene Crosser int rc; 654a71df50SFrank Blaschka 66efbbc1d5SEugene Crosser if (retcode) 671aec42bcSThomas Richter QETH_CARD_TEXT_(card, 2, "err%04x", retcode); 68efbbc1d5SEugene Crosser switch (retcode) { 69efbbc1d5SEugene Crosser case IPA_RC_SUCCESS: 70efbbc1d5SEugene Crosser rc = 0; 71efbbc1d5SEugene Crosser break; 72efbbc1d5SEugene Crosser case IPA_RC_L2_UNSUPPORTED_CMD: 73ffb95251SEugene Crosser rc = -EOPNOTSUPP; 74efbbc1d5SEugene Crosser break; 75efbbc1d5SEugene Crosser case IPA_RC_L2_ADDR_TABLE_FULL: 76efbbc1d5SEugene Crosser rc = -ENOSPC; 77efbbc1d5SEugene Crosser break; 78efbbc1d5SEugene Crosser case IPA_RC_L2_DUP_MAC: 79efbbc1d5SEugene Crosser case IPA_RC_L2_DUP_LAYER3_MAC: 80efbbc1d5SEugene Crosser rc = -EEXIST; 81efbbc1d5SEugene Crosser break; 82efbbc1d5SEugene Crosser case IPA_RC_L2_MAC_NOT_AUTH_BY_HYP: 83efbbc1d5SEugene Crosser case IPA_RC_L2_MAC_NOT_AUTH_BY_ADP: 84efbbc1d5SEugene Crosser rc = -EPERM; 85efbbc1d5SEugene Crosser break; 86efbbc1d5SEugene Crosser case IPA_RC_L2_MAC_NOT_FOUND: 87efbbc1d5SEugene Crosser rc = -ENOENT; 88efbbc1d5SEugene Crosser break; 891aec42bcSThomas Richter case -ENOMEM: 901aec42bcSThomas Richter rc = -ENOMEM; 911aec42bcSThomas Richter break; 92efbbc1d5SEugene Crosser default: 93efbbc1d5SEugene Crosser rc = -EIO; 94efbbc1d5SEugene Crosser break; 954a71df50SFrank Blaschka } 96efbbc1d5SEugene Crosser return rc; 974a71df50SFrank Blaschka } 984a71df50SFrank Blaschka 99ac988d78SJulian Wiedmann static int qeth_l2_send_setdelmac(struct qeth_card *card, __u8 *mac, 100ac988d78SJulian Wiedmann enum qeth_ipa_cmds ipacmd) 101ac988d78SJulian Wiedmann { 102ac988d78SJulian Wiedmann struct qeth_ipa_cmd *cmd; 103ac988d78SJulian Wiedmann struct qeth_cmd_buffer *iob; 104ac988d78SJulian Wiedmann 105ac988d78SJulian Wiedmann QETH_CARD_TEXT(card, 2, "L2sdmac"); 106ac988d78SJulian Wiedmann iob = qeth_get_ipacmd_buffer(card, ipacmd, QETH_PROT_IPV4); 107ac988d78SJulian Wiedmann if (!iob) 108ac988d78SJulian Wiedmann return -ENOMEM; 109ff5caa7aSJulian Wiedmann cmd = __ipa_cmd(iob); 11099f0b85dSJulian Wiedmann cmd->data.setdelmac.mac_length = ETH_ALEN; 11199f0b85dSJulian Wiedmann ether_addr_copy(cmd->data.setdelmac.mac, mac); 1122aa48671SJulian Wiedmann return qeth_setdelmac_makerc(card, qeth_send_ipa_cmd(card, iob, 113ac988d78SJulian Wiedmann NULL, NULL)); 114ac988d78SJulian Wiedmann } 115ac988d78SJulian Wiedmann 116ac988d78SJulian Wiedmann static int qeth_l2_send_setmac(struct qeth_card *card, __u8 *mac) 117ac988d78SJulian Wiedmann { 118ac988d78SJulian Wiedmann int rc; 119ac988d78SJulian Wiedmann 120ac988d78SJulian Wiedmann QETH_CARD_TEXT(card, 2, "L2Setmac"); 121ac988d78SJulian Wiedmann rc = qeth_l2_send_setdelmac(card, mac, IPA_CMD_SETVMAC); 122ac988d78SJulian Wiedmann if (rc == 0) { 123ac988d78SJulian Wiedmann dev_info(&card->gdev->dev, 124ac988d78SJulian Wiedmann "MAC address %pM successfully registered on device %s\n", 125bcacfcbcSJulian Wiedmann mac, card->dev->name); 126ac988d78SJulian Wiedmann } else { 127ac988d78SJulian Wiedmann switch (rc) { 128ac988d78SJulian Wiedmann case -EEXIST: 129ac988d78SJulian Wiedmann dev_warn(&card->gdev->dev, 130ac988d78SJulian Wiedmann "MAC address %pM already exists\n", mac); 131ac988d78SJulian Wiedmann break; 132ac988d78SJulian Wiedmann case -EPERM: 133ac988d78SJulian Wiedmann dev_warn(&card->gdev->dev, 134ac988d78SJulian Wiedmann "MAC address %pM is not authorized\n", mac); 135ac988d78SJulian Wiedmann break; 136ac988d78SJulian Wiedmann } 137ac988d78SJulian Wiedmann } 138ac988d78SJulian Wiedmann return rc; 139ac988d78SJulian Wiedmann } 140ac988d78SJulian Wiedmann 1418174aa8aSJulian Wiedmann static int qeth_l2_write_mac(struct qeth_card *card, u8 *mac) 1424a71df50SFrank Blaschka { 1438174aa8aSJulian Wiedmann enum qeth_ipa_cmds cmd = is_multicast_ether_addr_64bits(mac) ? 1448174aa8aSJulian Wiedmann IPA_CMD_SETGMAC : IPA_CMD_SETVMAC; 145efbbc1d5SEugene Crosser int rc; 146efbbc1d5SEugene Crosser 1478174aa8aSJulian Wiedmann QETH_CARD_TEXT(card, 2, "L2Wmac"); 1488174aa8aSJulian Wiedmann rc = qeth_l2_send_setdelmac(card, mac, cmd); 149efbbc1d5SEugene Crosser if (rc == -EEXIST) 1508174aa8aSJulian Wiedmann QETH_DBF_MESSAGE(2, "MAC %pM already registered on %s\n", 151efbbc1d5SEugene Crosser mac, QETH_CARD_IFNAME(card)); 152efbbc1d5SEugene Crosser else if (rc) 1538174aa8aSJulian Wiedmann QETH_DBF_MESSAGE(2, "Failed to register MAC %pM on %s: %d\n", 154efbbc1d5SEugene Crosser mac, QETH_CARD_IFNAME(card), rc); 155efbbc1d5SEugene Crosser return rc; 1564a71df50SFrank Blaschka } 1574a71df50SFrank Blaschka 1588174aa8aSJulian Wiedmann static int qeth_l2_remove_mac(struct qeth_card *card, u8 *mac) 1594a71df50SFrank Blaschka { 1608174aa8aSJulian Wiedmann enum qeth_ipa_cmds cmd = is_multicast_ether_addr_64bits(mac) ? 1618174aa8aSJulian Wiedmann IPA_CMD_DELGMAC : IPA_CMD_DELVMAC; 162efbbc1d5SEugene Crosser int rc; 163efbbc1d5SEugene Crosser 1648174aa8aSJulian Wiedmann QETH_CARD_TEXT(card, 2, "L2Rmac"); 1658174aa8aSJulian Wiedmann rc = qeth_l2_send_setdelmac(card, mac, cmd); 166efbbc1d5SEugene Crosser if (rc) 1678174aa8aSJulian Wiedmann QETH_DBF_MESSAGE(2, "Failed to delete MAC %pM on %s: %d\n", 168efbbc1d5SEugene Crosser mac, QETH_CARD_IFNAME(card), rc); 169efbbc1d5SEugene Crosser return rc; 1704a71df50SFrank Blaschka } 1714a71df50SFrank Blaschka 172c07cbf2eSJulian Wiedmann static void qeth_l2_del_all_macs(struct qeth_card *card) 1734a71df50SFrank Blaschka { 174fe5c8028SLakhvich Dmitriy struct qeth_mac *mac; 175fe5c8028SLakhvich Dmitriy struct hlist_node *tmp; 176fe5c8028SLakhvich Dmitriy int i; 1774a71df50SFrank Blaschka 1784a71df50SFrank Blaschka spin_lock_bh(&card->mclock); 179fe5c8028SLakhvich Dmitriy hash_for_each_safe(card->mac_htable, i, tmp, mac, hnode) { 180fe5c8028SLakhvich Dmitriy hash_del(&mac->hnode); 181fe5c8028SLakhvich Dmitriy kfree(mac); 1824a71df50SFrank Blaschka } 1834a71df50SFrank Blaschka spin_unlock_bh(&card->mclock); 1844a71df50SFrank Blaschka } 1854a71df50SFrank Blaschka 186cef6ff22SJulian Wiedmann static int qeth_l2_get_cast_type(struct qeth_card *card, struct sk_buff *skb) 1874a71df50SFrank Blaschka { 188ce73e10eSKlaus-Dieter Wacker if (card->info.type == QETH_CARD_TYPE_OSN) 189ce73e10eSKlaus-Dieter Wacker return RTN_UNSPEC; 190ce73e10eSKlaus-Dieter Wacker if (is_broadcast_ether_addr(skb->data)) 191ce73e10eSKlaus-Dieter Wacker return RTN_BROADCAST; 192ce73e10eSKlaus-Dieter Wacker if (is_multicast_ether_addr(skb->data)) 193ce73e10eSKlaus-Dieter Wacker return RTN_MULTICAST; 194ce73e10eSKlaus-Dieter Wacker return RTN_UNSPEC; 1954a71df50SFrank Blaschka } 1964a71df50SFrank Blaschka 197ae79fe03SJulian Wiedmann static void qeth_l2_fill_header(struct qeth_hdr *hdr, struct sk_buff *skb, 198ae79fe03SJulian Wiedmann int cast_type, unsigned int data_len) 1994a71df50SFrank Blaschka { 200683d718aSFrank Blaschka struct vlan_ethhdr *veth = (struct vlan_ethhdr *)skb_mac_header(skb); 2014a71df50SFrank Blaschka 2024a71df50SFrank Blaschka memset(hdr, 0, sizeof(struct qeth_hdr)); 2034a71df50SFrank Blaschka hdr->hdr.l2.id = QETH_HEADER_TYPE_LAYER2; 204ae79fe03SJulian Wiedmann hdr->hdr.l2.pkt_length = data_len; 2054a71df50SFrank Blaschka 2064a71df50SFrank Blaschka /* set byte byte 3 to casting flags */ 2074a71df50SFrank Blaschka if (cast_type == RTN_MULTICAST) 2084a71df50SFrank Blaschka hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_MULTICAST; 2094a71df50SFrank Blaschka else if (cast_type == RTN_BROADCAST) 2104a71df50SFrank Blaschka hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_BROADCAST; 2114a71df50SFrank Blaschka else 212ce73e10eSKlaus-Dieter Wacker hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_UNICAST; 2134a71df50SFrank Blaschka 2144a71df50SFrank Blaschka /* VSWITCH relies on the VLAN 2154a71df50SFrank Blaschka * information to be present in 2164a71df50SFrank Blaschka * the QDIO header */ 2174a71df50SFrank Blaschka if (veth->h_vlan_proto == __constant_htons(ETH_P_8021Q)) { 2184a71df50SFrank Blaschka hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_VLAN; 2194a71df50SFrank Blaschka hdr->hdr.l2.vlan_id = ntohs(veth->h_vlan_TCI); 2204a71df50SFrank Blaschka } 2214a71df50SFrank Blaschka } 2224a71df50SFrank Blaschka 2232aa48671SJulian Wiedmann static int qeth_setdelvlan_makerc(struct qeth_card *card, int retcode) 2244a71df50SFrank Blaschka { 2252aa48671SJulian Wiedmann if (retcode) 2262aa48671SJulian Wiedmann QETH_CARD_TEXT_(card, 2, "err%04x", retcode); 2272aa48671SJulian Wiedmann 2282aa48671SJulian Wiedmann switch (retcode) { 2292aa48671SJulian Wiedmann case IPA_RC_SUCCESS: 2302aa48671SJulian Wiedmann return 0; 2312aa48671SJulian Wiedmann case IPA_RC_L2_INVALID_VLAN_ID: 2322aa48671SJulian Wiedmann return -EINVAL; 2332aa48671SJulian Wiedmann case IPA_RC_L2_DUP_VLAN_ID: 2342aa48671SJulian Wiedmann return -EEXIST; 2352aa48671SJulian Wiedmann case IPA_RC_L2_VLAN_ID_NOT_FOUND: 2362aa48671SJulian Wiedmann return -ENOENT; 2372aa48671SJulian Wiedmann case IPA_RC_L2_VLAN_ID_NOT_ALLOWED: 2382aa48671SJulian Wiedmann return -EPERM; 2392aa48671SJulian Wiedmann case -ENOMEM: 2402aa48671SJulian Wiedmann return -ENOMEM; 2412aa48671SJulian Wiedmann default: 2422aa48671SJulian Wiedmann return -EIO; 2432aa48671SJulian Wiedmann } 2442aa48671SJulian Wiedmann } 2452aa48671SJulian Wiedmann 2462aa48671SJulian Wiedmann static int qeth_l2_send_setdelvlan_cb(struct qeth_card *card, 2472aa48671SJulian Wiedmann struct qeth_reply *reply, 2482aa48671SJulian Wiedmann unsigned long data) 2492aa48671SJulian Wiedmann { 2502aa48671SJulian Wiedmann struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *) data; 2514a71df50SFrank Blaschka 252847a50fdSCarsten Otte QETH_CARD_TEXT(card, 2, "L2sdvcb"); 2534a71df50SFrank Blaschka if (cmd->hdr.return_code) { 2542aa48671SJulian Wiedmann QETH_DBF_MESSAGE(2, "Error in processing VLAN %i on %s: 0x%x.\n", 2552aa48671SJulian Wiedmann cmd->data.setdelvlan.vlan_id, 2564a71df50SFrank Blaschka QETH_CARD_IFNAME(card), cmd->hdr.return_code); 257847a50fdSCarsten Otte QETH_CARD_TEXT_(card, 2, "L2VL%4x", cmd->hdr.command); 258847a50fdSCarsten Otte QETH_CARD_TEXT_(card, 2, "err%d", cmd->hdr.return_code); 2594a71df50SFrank Blaschka } 2604a71df50SFrank Blaschka return 0; 2614a71df50SFrank Blaschka } 2624a71df50SFrank Blaschka 2634a71df50SFrank Blaschka static int qeth_l2_send_setdelvlan(struct qeth_card *card, __u16 i, 2644a71df50SFrank Blaschka enum qeth_ipa_cmds ipacmd) 2654a71df50SFrank Blaschka { 2664a71df50SFrank Blaschka struct qeth_ipa_cmd *cmd; 2674a71df50SFrank Blaschka struct qeth_cmd_buffer *iob; 2684a71df50SFrank Blaschka 269847a50fdSCarsten Otte QETH_CARD_TEXT_(card, 4, "L2sdv%x", ipacmd); 2704a71df50SFrank Blaschka iob = qeth_get_ipacmd_buffer(card, ipacmd, QETH_PROT_IPV4); 2711aec42bcSThomas Richter if (!iob) 2721aec42bcSThomas Richter return -ENOMEM; 273ff5caa7aSJulian Wiedmann cmd = __ipa_cmd(iob); 2744a71df50SFrank Blaschka cmd->data.setdelvlan.vlan_id = i; 2752aa48671SJulian Wiedmann return qeth_setdelvlan_makerc(card, qeth_send_ipa_cmd(card, iob, 2762aa48671SJulian Wiedmann qeth_l2_send_setdelvlan_cb, NULL)); 2774a71df50SFrank Blaschka } 2784a71df50SFrank Blaschka 27970919e23SUrsula Braun static void qeth_l2_process_vlans(struct qeth_card *card) 2804a71df50SFrank Blaschka { 2814a71df50SFrank Blaschka struct qeth_vlan_vid *id; 282d4ac0246SJulian Wiedmann 283847a50fdSCarsten Otte QETH_CARD_TEXT(card, 3, "L2prcvln"); 284d4ac0246SJulian Wiedmann mutex_lock(&card->vid_list_mutex); 2854a71df50SFrank Blaschka list_for_each_entry(id, &card->vid_list, list) { 28670919e23SUrsula Braun qeth_l2_send_setdelvlan(card, id->vid, IPA_CMD_SETVLAN); 2874a71df50SFrank Blaschka } 288d4ac0246SJulian Wiedmann mutex_unlock(&card->vid_list_mutex); 2894a71df50SFrank Blaschka } 2904a71df50SFrank Blaschka 29180d5c368SPatrick McHardy static int qeth_l2_vlan_rx_add_vid(struct net_device *dev, 29280d5c368SPatrick McHardy __be16 proto, u16 vid) 2934a71df50SFrank Blaschka { 294509e2562SHeiko Carstens struct qeth_card *card = dev->ml_priv; 2954a71df50SFrank Blaschka struct qeth_vlan_vid *id; 2961aec42bcSThomas Richter int rc; 2974a71df50SFrank Blaschka 298847a50fdSCarsten Otte QETH_CARD_TEXT_(card, 4, "aid:%d", vid); 29910651db7SUrsula Braun if (!vid) 3008e586137SJiri Pirko return 0; 3018e98ac48SUrsula Braun if (qeth_wait_for_threads(card, QETH_RECOVER_THREAD)) { 302847a50fdSCarsten Otte QETH_CARD_TEXT(card, 3, "aidREC"); 3038e586137SJiri Pirko return 0; 3048e98ac48SUrsula Braun } 305d4ac0246SJulian Wiedmann id = kmalloc(sizeof(*id), GFP_KERNEL); 3064a71df50SFrank Blaschka if (id) { 3074a71df50SFrank Blaschka id->vid = vid; 3081aec42bcSThomas Richter rc = qeth_l2_send_setdelvlan(card, vid, IPA_CMD_SETVLAN); 3091aec42bcSThomas Richter if (rc) { 3101aec42bcSThomas Richter kfree(id); 3111aec42bcSThomas Richter return rc; 3121aec42bcSThomas Richter } 313d4ac0246SJulian Wiedmann mutex_lock(&card->vid_list_mutex); 3144a71df50SFrank Blaschka list_add_tail(&id->list, &card->vid_list); 315d4ac0246SJulian Wiedmann mutex_unlock(&card->vid_list_mutex); 3168e586137SJiri Pirko } else { 3178e586137SJiri Pirko return -ENOMEM; 3184a71df50SFrank Blaschka } 3198e586137SJiri Pirko return 0; 3204a71df50SFrank Blaschka } 3214a71df50SFrank Blaschka 32280d5c368SPatrick McHardy static int qeth_l2_vlan_rx_kill_vid(struct net_device *dev, 32380d5c368SPatrick McHardy __be16 proto, u16 vid) 3244a71df50SFrank Blaschka { 3254a71df50SFrank Blaschka struct qeth_vlan_vid *id, *tmpid = NULL; 326509e2562SHeiko Carstens struct qeth_card *card = dev->ml_priv; 3271aec42bcSThomas Richter int rc = 0; 3284a71df50SFrank Blaschka 329847a50fdSCarsten Otte QETH_CARD_TEXT_(card, 4, "kid:%d", vid); 3308e98ac48SUrsula Braun if (qeth_wait_for_threads(card, QETH_RECOVER_THREAD)) { 331847a50fdSCarsten Otte QETH_CARD_TEXT(card, 3, "kidREC"); 3328e586137SJiri Pirko return 0; 3338e98ac48SUrsula Braun } 334d4ac0246SJulian Wiedmann mutex_lock(&card->vid_list_mutex); 3354a71df50SFrank Blaschka list_for_each_entry(id, &card->vid_list, list) { 3364a71df50SFrank Blaschka if (id->vid == vid) { 3374a71df50SFrank Blaschka list_del(&id->list); 3384a71df50SFrank Blaschka tmpid = id; 3394a71df50SFrank Blaschka break; 3404a71df50SFrank Blaschka } 3414a71df50SFrank Blaschka } 342d4ac0246SJulian Wiedmann mutex_unlock(&card->vid_list_mutex); 3434a71df50SFrank Blaschka if (tmpid) { 3441aec42bcSThomas Richter rc = qeth_l2_send_setdelvlan(card, vid, IPA_CMD_DELVLAN); 3454a71df50SFrank Blaschka kfree(tmpid); 3464a71df50SFrank Blaschka } 347fe5c8028SLakhvich Dmitriy qeth_l2_set_rx_mode(card->dev); 3481aec42bcSThomas Richter return rc; 3494a71df50SFrank Blaschka } 3504a71df50SFrank Blaschka 351b2f4de8bSPeter Senna Tschudin static void qeth_l2_stop_card(struct qeth_card *card, int recovery_mode) 3524a71df50SFrank Blaschka { 353d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP , 2, "stopcard"); 354d11ba0c4SPeter Tiedemann QETH_DBF_HEX(SETUP, 2, &card, sizeof(void *)); 3554a71df50SFrank Blaschka 3564a71df50SFrank Blaschka qeth_set_allowed_threads(card, 0, 1); 3574a71df50SFrank Blaschka if (card->read.state == CH_STATE_UP && 3584a71df50SFrank Blaschka card->write.state == CH_STATE_UP && 3594a71df50SFrank Blaschka (card->state == CARD_STATE_UP)) { 3604a71df50SFrank Blaschka if (recovery_mode && 3614a71df50SFrank Blaschka card->info.type != QETH_CARD_TYPE_OSN) { 3624a71df50SFrank Blaschka qeth_l2_stop(card->dev); 3634a71df50SFrank Blaschka } else { 3644a71df50SFrank Blaschka rtnl_lock(); 3654a71df50SFrank Blaschka dev_close(card->dev); 3664a71df50SFrank Blaschka rtnl_unlock(); 3674a71df50SFrank Blaschka } 36870919e23SUrsula Braun card->info.mac_bits &= ~QETH_LAYER2_MAC_REGISTERED; 3694a71df50SFrank Blaschka card->state = CARD_STATE_SOFTSETUP; 3704a71df50SFrank Blaschka } 3714a71df50SFrank Blaschka if (card->state == CARD_STATE_SOFTSETUP) { 372c07cbf2eSJulian Wiedmann qeth_l2_del_all_macs(card); 3734a71df50SFrank Blaschka qeth_clear_ipacmd_list(card); 3744a71df50SFrank Blaschka card->state = CARD_STATE_HARDSETUP; 3754a71df50SFrank Blaschka } 3764a71df50SFrank Blaschka if (card->state == CARD_STATE_HARDSETUP) { 3774a71df50SFrank Blaschka qeth_qdio_clear_card(card, 0); 3784a71df50SFrank Blaschka qeth_clear_qdio_buffers(card); 3794a71df50SFrank Blaschka qeth_clear_working_pool_list(card); 3804a71df50SFrank Blaschka card->state = CARD_STATE_DOWN; 3814a71df50SFrank Blaschka } 3824a71df50SFrank Blaschka if (card->state == CARD_STATE_DOWN) { 3834a71df50SFrank Blaschka qeth_clear_cmd_buffers(&card->read); 3844a71df50SFrank Blaschka qeth_clear_cmd_buffers(&card->write); 3854a71df50SFrank Blaschka } 3864a71df50SFrank Blaschka } 3874a71df50SFrank Blaschka 388a1c3ed4cSFrank Blaschka static int qeth_l2_process_inbound_buffer(struct qeth_card *card, 389a1c3ed4cSFrank Blaschka int budget, int *done) 3904a71df50SFrank Blaschka { 391a1c3ed4cSFrank Blaschka int work_done = 0; 3924a71df50SFrank Blaschka struct sk_buff *skb; 3934a71df50SFrank Blaschka struct qeth_hdr *hdr; 3944a71df50SFrank Blaschka unsigned int len; 3954a71df50SFrank Blaschka 396a1c3ed4cSFrank Blaschka *done = 0; 39718af5c17SStefan Raspl WARN_ON_ONCE(!budget); 398a1c3ed4cSFrank Blaschka while (budget) { 399a1c3ed4cSFrank Blaschka skb = qeth_core_get_next_skb(card, 400b3332930SFrank Blaschka &card->qdio.in_q->bufs[card->rx.b_index], 401a1c3ed4cSFrank Blaschka &card->rx.b_element, &card->rx.e_offset, &hdr); 402a1c3ed4cSFrank Blaschka if (!skb) { 403a1c3ed4cSFrank Blaschka *done = 1; 404a1c3ed4cSFrank Blaschka break; 4054a71df50SFrank Blaschka } 4064a71df50SFrank Blaschka switch (hdr->hdr.l2.id) { 4074a71df50SFrank Blaschka case QETH_HEADER_TYPE_LAYER2: 4084a71df50SFrank Blaschka skb->protocol = eth_type_trans(skb, skb->dev); 4096195b936SJulian Wiedmann qeth_rx_csum(card, skb, hdr->hdr.l2.flags[1]); 41012883725SUrsula Braun if (skb->protocol == htons(ETH_P_802_2)) 4114a71df50SFrank Blaschka *((__u32 *)skb->cb) = ++card->seqno.pkt_seqno; 4124a71df50SFrank Blaschka len = skb->len; 4139abfa8cbSThomas Richter napi_gro_receive(&card->napi, skb); 4144a71df50SFrank Blaschka break; 4154a71df50SFrank Blaschka case QETH_HEADER_TYPE_OSN: 4162d488c2fSUrsula Braun if (card->info.type == QETH_CARD_TYPE_OSN) { 4174a71df50SFrank Blaschka skb_push(skb, sizeof(struct qeth_hdr)); 4184a71df50SFrank Blaschka skb_copy_to_linear_data(skb, hdr, 4194a71df50SFrank Blaschka sizeof(struct qeth_hdr)); 4204a71df50SFrank Blaschka len = skb->len; 4214a71df50SFrank Blaschka card->osn_info.data_cb(skb); 4224a71df50SFrank Blaschka break; 4232d488c2fSUrsula Braun } 4242d488c2fSUrsula Braun /* else unknown */ 4254a71df50SFrank Blaschka default: 4264a71df50SFrank Blaschka dev_kfree_skb_any(skb); 427847a50fdSCarsten Otte QETH_CARD_TEXT(card, 3, "inbunkno"); 428d11ba0c4SPeter Tiedemann QETH_DBF_HEX(CTRL, 3, hdr, QETH_DBF_CTRL_LEN); 4294a71df50SFrank Blaschka continue; 4304a71df50SFrank Blaschka } 431a1c3ed4cSFrank Blaschka work_done++; 432a1c3ed4cSFrank Blaschka budget--; 4334a71df50SFrank Blaschka card->stats.rx_packets++; 4344a71df50SFrank Blaschka card->stats.rx_bytes += len; 4354a71df50SFrank Blaschka } 436a1c3ed4cSFrank Blaschka return work_done; 437a1c3ed4cSFrank Blaschka } 438a1c3ed4cSFrank Blaschka 4394a71df50SFrank Blaschka static int qeth_l2_request_initial_mac(struct qeth_card *card) 4404a71df50SFrank Blaschka { 4414a71df50SFrank Blaschka int rc = 0; 4424a71df50SFrank Blaschka char vendor_pre[] = {0x02, 0x00, 0x00}; 4434a71df50SFrank Blaschka 444ec61bd2fSJulian Wiedmann QETH_DBF_TEXT(SETUP, 2, "l2reqmac"); 445d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "doL2%s", CARD_BUS_ID(card)); 4464a71df50SFrank Blaschka 447ec61bd2fSJulian Wiedmann if (MACHINE_IS_VM) { 448ec61bd2fSJulian Wiedmann rc = qeth_vm_request_mac(card); 449ec61bd2fSJulian Wiedmann if (!rc) 450ec61bd2fSJulian Wiedmann goto out; 451ec61bd2fSJulian Wiedmann QETH_DBF_MESSAGE(2, "z/VM MAC Service failed on device %s: x%x\n", 452ec61bd2fSJulian Wiedmann CARD_BUS_ID(card), rc); 453ec61bd2fSJulian Wiedmann QETH_DBF_TEXT_(SETUP, 2, "err%04x", rc); 454ec61bd2fSJulian Wiedmann /* fall back to alternative mechanism: */ 455ec61bd2fSJulian Wiedmann } 456ec61bd2fSJulian Wiedmann 4575113fec0SUrsula Braun if (card->info.type == QETH_CARD_TYPE_IQD || 4585113fec0SUrsula Braun card->info.type == QETH_CARD_TYPE_OSM || 4595113fec0SUrsula Braun card->info.type == QETH_CARD_TYPE_OSX || 4605113fec0SUrsula Braun card->info.guestlan) { 4614a71df50SFrank Blaschka rc = qeth_setadpparms_change_macaddr(card); 4624a71df50SFrank Blaschka if (rc) { 46314cc21b6SFrank Blaschka QETH_DBF_MESSAGE(2, "couldn't get MAC address on " 46414cc21b6SFrank Blaschka "device %s: x%x\n", CARD_BUS_ID(card), rc); 4651aec42bcSThomas Richter QETH_DBF_TEXT_(SETUP, 2, "1err%04x", rc); 4664a71df50SFrank Blaschka return rc; 4674a71df50SFrank Blaschka } 4684a71df50SFrank Blaschka } else { 4691833611dSJoe Perches eth_random_addr(card->dev->dev_addr); 4704a71df50SFrank Blaschka memcpy(card->dev->dev_addr, vendor_pre, 3); 4714a71df50SFrank Blaschka } 472ec61bd2fSJulian Wiedmann out: 473ec61bd2fSJulian Wiedmann QETH_DBF_HEX(SETUP, 2, card->dev->dev_addr, card->dev->addr_len); 4744a71df50SFrank Blaschka return 0; 4754a71df50SFrank Blaschka } 4764a71df50SFrank Blaschka 4774a71df50SFrank Blaschka static int qeth_l2_set_mac_address(struct net_device *dev, void *p) 4784a71df50SFrank Blaschka { 4794a71df50SFrank Blaschka struct sockaddr *addr = p; 480509e2562SHeiko Carstens struct qeth_card *card = dev->ml_priv; 481bcacfcbcSJulian Wiedmann u8 old_addr[ETH_ALEN]; 4824a71df50SFrank Blaschka int rc = 0; 4834a71df50SFrank Blaschka 484847a50fdSCarsten Otte QETH_CARD_TEXT(card, 3, "setmac"); 4854a71df50SFrank Blaschka 4865113fec0SUrsula Braun if (card->info.type == QETH_CARD_TYPE_OSN || 4875113fec0SUrsula Braun card->info.type == QETH_CARD_TYPE_OSM || 4885113fec0SUrsula Braun card->info.type == QETH_CARD_TYPE_OSX) { 489847a50fdSCarsten Otte QETH_CARD_TEXT(card, 3, "setmcTYP"); 4904a71df50SFrank Blaschka return -EOPNOTSUPP; 4914a71df50SFrank Blaschka } 49299f0b85dSJulian Wiedmann QETH_CARD_HEX(card, 3, addr->sa_data, ETH_ALEN); 493bcacfcbcSJulian Wiedmann if (!is_valid_ether_addr(addr->sa_data)) 494bcacfcbcSJulian Wiedmann return -EADDRNOTAVAIL; 495bcacfcbcSJulian Wiedmann 4968e98ac48SUrsula Braun if (qeth_wait_for_threads(card, QETH_RECOVER_THREAD)) { 497847a50fdSCarsten Otte QETH_CARD_TEXT(card, 3, "setmcREC"); 4988e98ac48SUrsula Braun return -ERESTARTSYS; 4998e98ac48SUrsula Braun } 500bcacfcbcSJulian Wiedmann 501bcacfcbcSJulian Wiedmann if (!qeth_card_hw_is_reachable(card)) { 502bcacfcbcSJulian Wiedmann ether_addr_copy(dev->dev_addr, addr->sa_data); 503bcacfcbcSJulian Wiedmann return 0; 504bcacfcbcSJulian Wiedmann } 505bcacfcbcSJulian Wiedmann 506bcacfcbcSJulian Wiedmann /* don't register the same address twice */ 507bcacfcbcSJulian Wiedmann if (ether_addr_equal_64bits(dev->dev_addr, addr->sa_data) && 508bcacfcbcSJulian Wiedmann (card->info.mac_bits & QETH_LAYER2_MAC_REGISTERED)) 509bcacfcbcSJulian Wiedmann return 0; 510bcacfcbcSJulian Wiedmann 511bcacfcbcSJulian Wiedmann /* add the new address, switch over, drop the old */ 5124a71df50SFrank Blaschka rc = qeth_l2_send_setmac(card, addr->sa_data); 513bcacfcbcSJulian Wiedmann if (rc) 514bcacfcbcSJulian Wiedmann return rc; 515bcacfcbcSJulian Wiedmann ether_addr_copy(old_addr, dev->dev_addr); 516bcacfcbcSJulian Wiedmann ether_addr_copy(dev->dev_addr, addr->sa_data); 517bcacfcbcSJulian Wiedmann 518bcacfcbcSJulian Wiedmann if (card->info.mac_bits & QETH_LAYER2_MAC_REGISTERED) 519bcacfcbcSJulian Wiedmann qeth_l2_remove_mac(card, old_addr); 520bcacfcbcSJulian Wiedmann card->info.mac_bits |= QETH_LAYER2_MAC_REGISTERED; 521bcacfcbcSJulian Wiedmann return 0; 5224a71df50SFrank Blaschka } 5234a71df50SFrank Blaschka 5240db587b0SEugene Crosser static void qeth_promisc_to_bridge(struct qeth_card *card) 5250db587b0SEugene Crosser { 5260db587b0SEugene Crosser struct net_device *dev = card->dev; 5270db587b0SEugene Crosser enum qeth_ipa_promisc_modes promisc_mode; 5280db587b0SEugene Crosser int role; 5290db587b0SEugene Crosser int rc; 5300db587b0SEugene Crosser 5310db587b0SEugene Crosser QETH_CARD_TEXT(card, 3, "pmisc2br"); 5320db587b0SEugene Crosser 5330db587b0SEugene Crosser if (!card->options.sbp.reflect_promisc) 5340db587b0SEugene Crosser return; 5350db587b0SEugene Crosser promisc_mode = (dev->flags & IFF_PROMISC) ? SET_PROMISC_MODE_ON 5360db587b0SEugene Crosser : SET_PROMISC_MODE_OFF; 5370db587b0SEugene Crosser if (promisc_mode == card->info.promisc_mode) 5380db587b0SEugene Crosser return; 5390db587b0SEugene Crosser 5400db587b0SEugene Crosser if (promisc_mode == SET_PROMISC_MODE_ON) { 5410db587b0SEugene Crosser if (card->options.sbp.reflect_promisc_primary) 5420db587b0SEugene Crosser role = QETH_SBP_ROLE_PRIMARY; 5430db587b0SEugene Crosser else 5440db587b0SEugene Crosser role = QETH_SBP_ROLE_SECONDARY; 5450db587b0SEugene Crosser } else 5460db587b0SEugene Crosser role = QETH_SBP_ROLE_NONE; 5470db587b0SEugene Crosser 5480db587b0SEugene Crosser rc = qeth_bridgeport_setrole(card, role); 5490db587b0SEugene Crosser QETH_DBF_TEXT_(SETUP, 2, "bpm%c%04x", 5500db587b0SEugene Crosser (promisc_mode == SET_PROMISC_MODE_ON) ? '+' : '-', rc); 5510db587b0SEugene Crosser if (!rc) { 5520db587b0SEugene Crosser card->options.sbp.role = role; 5530db587b0SEugene Crosser card->info.promisc_mode = promisc_mode; 5540db587b0SEugene Crosser } 555fe5c8028SLakhvich Dmitriy 556fe5c8028SLakhvich Dmitriy } 557fe5c8028SLakhvich Dmitriy /* New MAC address is added to the hash table and marked to be written on card 558fe5c8028SLakhvich Dmitriy * only if there is not in the hash table storage already 559fe5c8028SLakhvich Dmitriy * 560fe5c8028SLakhvich Dmitriy */ 5614641b027SJulian Wiedmann static void qeth_l2_add_mac(struct qeth_card *card, struct netdev_hw_addr *ha) 562fe5c8028SLakhvich Dmitriy { 563cef6ff22SJulian Wiedmann u32 mac_hash = get_unaligned((u32 *)(&ha->addr[2])); 564fe5c8028SLakhvich Dmitriy struct qeth_mac *mac; 565fe5c8028SLakhvich Dmitriy 566cef6ff22SJulian Wiedmann hash_for_each_possible(card->mac_htable, mac, hnode, mac_hash) { 56799f0b85dSJulian Wiedmann if (ether_addr_equal_64bits(ha->addr, mac->mac_addr)) { 5685f78e29cSLakhvich Dmitriy mac->disp_flag = QETH_DISP_ADDR_DO_NOTHING; 569fe5c8028SLakhvich Dmitriy return; 570fe5c8028SLakhvich Dmitriy } 5710db587b0SEugene Crosser } 5720db587b0SEugene Crosser 573fe5c8028SLakhvich Dmitriy mac = kzalloc(sizeof(struct qeth_mac), GFP_ATOMIC); 574fe5c8028SLakhvich Dmitriy if (!mac) 575fe5c8028SLakhvich Dmitriy return; 576fe5c8028SLakhvich Dmitriy 57799f0b85dSJulian Wiedmann ether_addr_copy(mac->mac_addr, ha->addr); 5785f78e29cSLakhvich Dmitriy mac->disp_flag = QETH_DISP_ADDR_ADD; 579fe5c8028SLakhvich Dmitriy 580cef6ff22SJulian Wiedmann hash_add(card->mac_htable, &mac->hnode, mac_hash); 581fe5c8028SLakhvich Dmitriy } 582fe5c8028SLakhvich Dmitriy 583fe5c8028SLakhvich Dmitriy static void qeth_l2_set_rx_mode(struct net_device *dev) 5844a71df50SFrank Blaschka { 585509e2562SHeiko Carstens struct qeth_card *card = dev->ml_priv; 586ccffad25SJiri Pirko struct netdev_hw_addr *ha; 587fe5c8028SLakhvich Dmitriy struct qeth_mac *mac; 588fe5c8028SLakhvich Dmitriy struct hlist_node *tmp; 589fe5c8028SLakhvich Dmitriy int i; 590fe5c8028SLakhvich Dmitriy int rc; 5914a71df50SFrank Blaschka 5924a71df50SFrank Blaschka if (card->info.type == QETH_CARD_TYPE_OSN) 5934a71df50SFrank Blaschka return; 5944a71df50SFrank Blaschka 595847a50fdSCarsten Otte QETH_CARD_TEXT(card, 3, "setmulti"); 5968e98ac48SUrsula Braun if (qeth_threads_running(card, QETH_RECOVER_THREAD) && 5978e98ac48SUrsula Braun (card->state != CARD_STATE_UP)) 5988e98ac48SUrsula Braun return; 599fe5c8028SLakhvich Dmitriy 6004a71df50SFrank Blaschka spin_lock_bh(&card->mclock); 601fe5c8028SLakhvich Dmitriy 60222bedad3SJiri Pirko netdev_for_each_mc_addr(ha, dev) 6034641b027SJulian Wiedmann qeth_l2_add_mac(card, ha); 60432e7bfc4SJiri Pirko netdev_for_each_uc_addr(ha, dev) 6054641b027SJulian Wiedmann qeth_l2_add_mac(card, ha); 606fe5c8028SLakhvich Dmitriy 607fe5c8028SLakhvich Dmitriy hash_for_each_safe(card->mac_htable, i, tmp, mac, hnode) { 60800c163f1SJulian Wiedmann switch (mac->disp_flag) { 60900c163f1SJulian Wiedmann case QETH_DISP_ADDR_DELETE: 6108174aa8aSJulian Wiedmann qeth_l2_remove_mac(card, mac->mac_addr); 611fe5c8028SLakhvich Dmitriy hash_del(&mac->hnode); 612fe5c8028SLakhvich Dmitriy kfree(mac); 61300c163f1SJulian Wiedmann break; 61400c163f1SJulian Wiedmann case QETH_DISP_ADDR_ADD: 6158174aa8aSJulian Wiedmann rc = qeth_l2_write_mac(card, mac->mac_addr); 616fe5c8028SLakhvich Dmitriy if (rc) { 617fe5c8028SLakhvich Dmitriy hash_del(&mac->hnode); 618fe5c8028SLakhvich Dmitriy kfree(mac); 61900c163f1SJulian Wiedmann break; 62000c163f1SJulian Wiedmann } 62100c163f1SJulian Wiedmann /* fall through */ 62200c163f1SJulian Wiedmann default: 62300c163f1SJulian Wiedmann /* for next call to set_rx_mode(): */ 6245f78e29cSLakhvich Dmitriy mac->disp_flag = QETH_DISP_ADDR_DELETE; 62500c163f1SJulian Wiedmann } 626fe5c8028SLakhvich Dmitriy } 6277db2266aSFrank Blaschka 6284a71df50SFrank Blaschka spin_unlock_bh(&card->mclock); 629fe5c8028SLakhvich Dmitriy 6300db587b0SEugene Crosser if (qeth_adp_supported(card, IPA_SETADP_SET_PROMISC_MODE)) 6314a71df50SFrank Blaschka qeth_setadp_promisc_mode(card); 6320db587b0SEugene Crosser else 6330db587b0SEugene Crosser qeth_promisc_to_bridge(card); 6344a71df50SFrank Blaschka } 6354a71df50SFrank Blaschka 6367286384bSJulian Wiedmann static int qeth_l2_xmit_iqd(struct qeth_card *card, struct sk_buff *skb, 6377286384bSJulian Wiedmann struct qeth_qdio_out_q *queue, int cast_type) 6387286384bSJulian Wiedmann { 6397286384bSJulian Wiedmann unsigned int data_offset = ETH_HLEN; 6407286384bSJulian Wiedmann struct qeth_hdr *hdr; 6417286384bSJulian Wiedmann int rc; 6427286384bSJulian Wiedmann 6437286384bSJulian Wiedmann hdr = kmem_cache_alloc(qeth_core_header_cache, GFP_ATOMIC); 6447286384bSJulian Wiedmann if (!hdr) 6457286384bSJulian Wiedmann return -ENOMEM; 646ae79fe03SJulian Wiedmann qeth_l2_fill_header(hdr, skb, cast_type, skb->len); 6477286384bSJulian Wiedmann skb_copy_from_linear_data(skb, ((char *)hdr) + sizeof(*hdr), 6487286384bSJulian Wiedmann data_offset); 6497286384bSJulian Wiedmann 6507286384bSJulian Wiedmann if (!qeth_get_elements_no(card, skb, 1, data_offset)) { 6517286384bSJulian Wiedmann rc = -E2BIG; 6527286384bSJulian Wiedmann goto out; 6537286384bSJulian Wiedmann } 6547c2e9ba3SJulian Wiedmann rc = qeth_do_send_packet_fast(queue, skb, hdr, data_offset, 655f1588177SJulian Wiedmann sizeof(*hdr) + data_offset); 6567286384bSJulian Wiedmann out: 6577286384bSJulian Wiedmann if (rc) 6587286384bSJulian Wiedmann kmem_cache_free(qeth_core_header_cache, hdr); 6597286384bSJulian Wiedmann return rc; 6607286384bSJulian Wiedmann } 6617286384bSJulian Wiedmann 6627286384bSJulian Wiedmann static int qeth_l2_xmit_osa(struct qeth_card *card, struct sk_buff *skb, 6637286384bSJulian Wiedmann struct qeth_qdio_out_q *queue, int cast_type) 6647286384bSJulian Wiedmann { 6650d6f02d3SJulian Wiedmann int push_len = sizeof(struct qeth_hdr); 6667286384bSJulian Wiedmann unsigned int elements, nr_frags; 6670d6f02d3SJulian Wiedmann unsigned int hdr_elements = 0; 6680d6f02d3SJulian Wiedmann struct qeth_hdr *hdr = NULL; 6690d6f02d3SJulian Wiedmann unsigned int hd_len = 0; 6707286384bSJulian Wiedmann int rc; 6717286384bSJulian Wiedmann 6727286384bSJulian Wiedmann /* fix hardware limitation: as long as we do not have sbal 6737286384bSJulian Wiedmann * chaining we can not send long frag lists 6747286384bSJulian Wiedmann */ 6757286384bSJulian Wiedmann if (!qeth_get_elements_no(card, skb, 0, 0)) { 6767286384bSJulian Wiedmann rc = skb_linearize(skb); 6777286384bSJulian Wiedmann 6787286384bSJulian Wiedmann if (card->options.performance_stats) { 6797286384bSJulian Wiedmann if (rc) 6807286384bSJulian Wiedmann card->perf_stats.tx_linfail++; 6817286384bSJulian Wiedmann else 6827286384bSJulian Wiedmann card->perf_stats.tx_lin++; 6837286384bSJulian Wiedmann } 6847286384bSJulian Wiedmann if (rc) 6857286384bSJulian Wiedmann return rc; 6867286384bSJulian Wiedmann } 6877286384bSJulian Wiedmann nr_frags = skb_shinfo(skb)->nr_frags; 6887286384bSJulian Wiedmann 6890d6f02d3SJulian Wiedmann rc = skb_cow_head(skb, push_len); 6900d6f02d3SJulian Wiedmann if (rc) 6910d6f02d3SJulian Wiedmann return rc; 6920d6f02d3SJulian Wiedmann push_len = qeth_push_hdr(skb, &hdr, push_len); 6930d6f02d3SJulian Wiedmann if (push_len < 0) 6940d6f02d3SJulian Wiedmann return push_len; 6950d6f02d3SJulian Wiedmann if (!push_len) { 6960d6f02d3SJulian Wiedmann /* hdr was allocated from cache */ 6970d6f02d3SJulian Wiedmann hd_len = sizeof(*hdr); 6980d6f02d3SJulian Wiedmann hdr_elements = 1; 6990d6f02d3SJulian Wiedmann } 7000d6f02d3SJulian Wiedmann qeth_l2_fill_header(hdr, skb, cast_type, skb->len - push_len); 7016195b936SJulian Wiedmann if (skb->ip_summed == CHECKSUM_PARTIAL) { 7026195b936SJulian Wiedmann qeth_tx_csum(skb, &hdr->hdr.l2.flags[1]); 7036195b936SJulian Wiedmann if (card->options.performance_stats) 7046195b936SJulian Wiedmann card->perf_stats.tx_csum++; 7056195b936SJulian Wiedmann } 7067286384bSJulian Wiedmann 7070d6f02d3SJulian Wiedmann elements = qeth_get_elements_no(card, skb, hdr_elements, 0); 7087286384bSJulian Wiedmann if (!elements) { 7097286384bSJulian Wiedmann rc = -E2BIG; 7107286384bSJulian Wiedmann goto out; 7117286384bSJulian Wiedmann } 7120d6f02d3SJulian Wiedmann elements += hdr_elements; 7130d6f02d3SJulian Wiedmann 7140d6f02d3SJulian Wiedmann /* TODO: remove the skb_orphan() once TX completion is fast enough */ 7150d6f02d3SJulian Wiedmann skb_orphan(skb); 7160d6f02d3SJulian Wiedmann rc = qeth_do_send_packet(card, queue, skb, hdr, 0, hd_len, elements); 7177286384bSJulian Wiedmann out: 7187286384bSJulian Wiedmann if (!rc) { 7197286384bSJulian Wiedmann if (card->options.performance_stats && nr_frags) { 7207286384bSJulian Wiedmann card->perf_stats.sg_skbs_sent++; 7217286384bSJulian Wiedmann /* nr_frags + skb->data */ 7227286384bSJulian Wiedmann card->perf_stats.sg_frags_sent += nr_frags + 1; 7237286384bSJulian Wiedmann } 7247286384bSJulian Wiedmann } else { 7250d6f02d3SJulian Wiedmann if (hd_len) 7260d6f02d3SJulian Wiedmann kmem_cache_free(qeth_core_header_cache, hdr); 7270d6f02d3SJulian Wiedmann if (rc == -EBUSY) 7280d6f02d3SJulian Wiedmann /* roll back to ETH header */ 7290d6f02d3SJulian Wiedmann skb_pull(skb, push_len); 7307286384bSJulian Wiedmann } 7317286384bSJulian Wiedmann return rc; 7327286384bSJulian Wiedmann } 7337286384bSJulian Wiedmann 7347286384bSJulian Wiedmann static int qeth_l2_xmit_osn(struct qeth_card *card, struct sk_buff *skb, 7357286384bSJulian Wiedmann struct qeth_qdio_out_q *queue) 7367286384bSJulian Wiedmann { 7377286384bSJulian Wiedmann unsigned int elements; 7387286384bSJulian Wiedmann struct qeth_hdr *hdr; 7397286384bSJulian Wiedmann 7407286384bSJulian Wiedmann if (skb->protocol == htons(ETH_P_IPV6)) 7417286384bSJulian Wiedmann return -EPROTONOSUPPORT; 7427286384bSJulian Wiedmann 7437286384bSJulian Wiedmann hdr = (struct qeth_hdr *)skb->data; 7447286384bSJulian Wiedmann elements = qeth_get_elements_no(card, skb, 0, 0); 7457286384bSJulian Wiedmann if (!elements) 7467286384bSJulian Wiedmann return -E2BIG; 7477286384bSJulian Wiedmann if (qeth_hdr_chk_and_bounce(skb, &hdr, sizeof(*hdr))) 7487286384bSJulian Wiedmann return -EINVAL; 7499c3bfda9SJulian Wiedmann return qeth_do_send_packet(card, queue, skb, hdr, 0, 0, elements); 7507286384bSJulian Wiedmann } 7517286384bSJulian Wiedmann 752e38db6beSJulian Wiedmann static netdev_tx_t qeth_l2_hard_start_xmit(struct sk_buff *skb, 753e38db6beSJulian Wiedmann struct net_device *dev) 7544a71df50SFrank Blaschka { 755509e2562SHeiko Carstens struct qeth_card *card = dev->ml_priv; 756ce73e10eSKlaus-Dieter Wacker int cast_type = qeth_l2_get_cast_type(card, skb); 757290b8348SStefan Raspl struct qeth_qdio_out_q *queue; 7584a71df50SFrank Blaschka int tx_bytes = skb->len; 7597286384bSJulian Wiedmann int rc; 7604a71df50SFrank Blaschka 761290b8348SStefan Raspl if (card->qdio.do_prio_queueing || (cast_type && 762290b8348SStefan Raspl card->info.is_multicast_different)) 763290b8348SStefan Raspl queue = card->qdio.out_qs[qeth_get_priority_queue(card, skb, 764290b8348SStefan Raspl qeth_get_ip_version(skb), cast_type)]; 765290b8348SStefan Raspl else 766290b8348SStefan Raspl queue = card->qdio.out_qs[card->qdio.default_out_queue]; 767290b8348SStefan Raspl 7684a71df50SFrank Blaschka if ((card->state != CARD_STATE_UP) || !card->lan_online) { 7694a71df50SFrank Blaschka card->stats.tx_carrier_errors++; 7704a71df50SFrank Blaschka goto tx_drop; 7714a71df50SFrank Blaschka } 7724a71df50SFrank Blaschka 7734a71df50SFrank Blaschka if (card->options.performance_stats) { 7744a71df50SFrank Blaschka card->perf_stats.outbound_cnt++; 7754a71df50SFrank Blaschka card->perf_stats.outbound_start_time = qeth_get_micros(); 7764a71df50SFrank Blaschka } 7774a71df50SFrank Blaschka netif_stop_queue(dev); 7784a71df50SFrank Blaschka 7797286384bSJulian Wiedmann switch (card->info.type) { 7807286384bSJulian Wiedmann case QETH_CARD_TYPE_OSN: 7817286384bSJulian Wiedmann rc = qeth_l2_xmit_osn(card, skb, queue); 7827286384bSJulian Wiedmann break; 7837286384bSJulian Wiedmann case QETH_CARD_TYPE_IQD: 7847286384bSJulian Wiedmann rc = qeth_l2_xmit_iqd(card, skb, queue, cast_type); 7857286384bSJulian Wiedmann break; 7867286384bSJulian Wiedmann default: 7877286384bSJulian Wiedmann rc = qeth_l2_xmit_osa(card, skb, queue, cast_type); 788683d718aSFrank Blaschka } 7894a71df50SFrank Blaschka 7904a71df50SFrank Blaschka if (!rc) { 7914a71df50SFrank Blaschka card->stats.tx_packets++; 7924a71df50SFrank Blaschka card->stats.tx_bytes += tx_bytes; 7934a71df50SFrank Blaschka if (card->options.performance_stats) 7944a71df50SFrank Blaschka card->perf_stats.outbound_time += qeth_get_micros() - 7954a71df50SFrank Blaschka card->perf_stats.outbound_start_time; 7967286384bSJulian Wiedmann netif_wake_queue(dev); 7977286384bSJulian Wiedmann return NETDEV_TX_OK; 7987286384bSJulian Wiedmann } else if (rc == -EBUSY) { 7997286384bSJulian Wiedmann return NETDEV_TX_BUSY; 8007286384bSJulian Wiedmann } /* else fall through */ 8014a71df50SFrank Blaschka 8024a71df50SFrank Blaschka tx_drop: 8034a71df50SFrank Blaschka card->stats.tx_dropped++; 8044a71df50SFrank Blaschka card->stats.tx_errors++; 8054a71df50SFrank Blaschka dev_kfree_skb_any(skb); 806d0ec0f54SFrank Blaschka netif_wake_queue(dev); 8074a71df50SFrank Blaschka return NETDEV_TX_OK; 8084a71df50SFrank Blaschka } 8094a71df50SFrank Blaschka 81039423440SUrsula Braun static int __qeth_l2_open(struct net_device *dev) 8114a71df50SFrank Blaschka { 812509e2562SHeiko Carstens struct qeth_card *card = dev->ml_priv; 813a1c3ed4cSFrank Blaschka int rc = 0; 8144a71df50SFrank Blaschka 815847a50fdSCarsten Otte QETH_CARD_TEXT(card, 4, "qethopen"); 81639423440SUrsula Braun if (card->state == CARD_STATE_UP) 81739423440SUrsula Braun return rc; 8184a71df50SFrank Blaschka if (card->state != CARD_STATE_SOFTSETUP) 8194a71df50SFrank Blaschka return -ENODEV; 8204a71df50SFrank Blaschka 8214a71df50SFrank Blaschka if ((card->info.type != QETH_CARD_TYPE_OSN) && 8224a71df50SFrank Blaschka (!(card->info.mac_bits & QETH_LAYER2_MAC_REGISTERED))) { 823847a50fdSCarsten Otte QETH_CARD_TEXT(card, 4, "nomacadr"); 8244a71df50SFrank Blaschka return -EPERM; 8254a71df50SFrank Blaschka } 8264a71df50SFrank Blaschka card->data.state = CH_STATE_UP; 8274a71df50SFrank Blaschka card->state = CARD_STATE_UP; 8284a71df50SFrank Blaschka netif_start_queue(dev); 8294a71df50SFrank Blaschka 830a1c3ed4cSFrank Blaschka if (qdio_stop_irq(card->data.ccwdev, 0) >= 0) { 831a1c3ed4cSFrank Blaschka napi_enable(&card->napi); 832a1c3ed4cSFrank Blaschka napi_schedule(&card->napi); 833a1c3ed4cSFrank Blaschka } else 834a1c3ed4cSFrank Blaschka rc = -EIO; 835a1c3ed4cSFrank Blaschka return rc; 8364a71df50SFrank Blaschka } 8374a71df50SFrank Blaschka 83839423440SUrsula Braun static int qeth_l2_open(struct net_device *dev) 83939423440SUrsula Braun { 84039423440SUrsula Braun struct qeth_card *card = dev->ml_priv; 84139423440SUrsula Braun 84239423440SUrsula Braun QETH_CARD_TEXT(card, 5, "qethope_"); 84339423440SUrsula Braun if (qeth_wait_for_threads(card, QETH_RECOVER_THREAD)) { 84439423440SUrsula Braun QETH_CARD_TEXT(card, 3, "openREC"); 84539423440SUrsula Braun return -ERESTARTSYS; 84639423440SUrsula Braun } 84739423440SUrsula Braun return __qeth_l2_open(dev); 84839423440SUrsula Braun } 84939423440SUrsula Braun 8504a71df50SFrank Blaschka static int qeth_l2_stop(struct net_device *dev) 8514a71df50SFrank Blaschka { 852509e2562SHeiko Carstens struct qeth_card *card = dev->ml_priv; 8534a71df50SFrank Blaschka 854847a50fdSCarsten Otte QETH_CARD_TEXT(card, 4, "qethstop"); 8554a71df50SFrank Blaschka netif_tx_disable(dev); 856a1c3ed4cSFrank Blaschka if (card->state == CARD_STATE_UP) { 8574a71df50SFrank Blaschka card->state = CARD_STATE_SOFTSETUP; 858a1c3ed4cSFrank Blaschka napi_disable(&card->napi); 859a1c3ed4cSFrank Blaschka } 8604a71df50SFrank Blaschka return 0; 8614a71df50SFrank Blaschka } 8624a71df50SFrank Blaschka 8632d2ebb3eSJulian Wiedmann static const struct device_type qeth_l2_devtype = { 8642d2ebb3eSJulian Wiedmann .name = "qeth_layer2", 8652d2ebb3eSJulian Wiedmann .groups = qeth_l2_attr_groups, 8662d2ebb3eSJulian Wiedmann }; 8672d2ebb3eSJulian Wiedmann 8684a71df50SFrank Blaschka static int qeth_l2_probe_device(struct ccwgroup_device *gdev) 8694a71df50SFrank Blaschka { 8704a71df50SFrank Blaschka struct qeth_card *card = dev_get_drvdata(&gdev->dev); 8719111e788SUrsula Braun int rc; 8724a71df50SFrank Blaschka 8732d2ebb3eSJulian Wiedmann if (gdev->dev.type == &qeth_generic_devtype) { 8749111e788SUrsula Braun rc = qeth_l2_create_device_attributes(&gdev->dev); 8759111e788SUrsula Braun if (rc) 8769111e788SUrsula Braun return rc; 8772d2ebb3eSJulian Wiedmann } 8784a71df50SFrank Blaschka INIT_LIST_HEAD(&card->vid_list); 879fe5c8028SLakhvich Dmitriy hash_init(card->mac_htable); 8804a71df50SFrank Blaschka card->options.layer2 = 1; 8811da74b1cSFrank Blaschka card->info.hwtrap = 0; 882caa1f0b1SHans Wippel qeth_l2_vnicc_set_defaults(card); 8834a71df50SFrank Blaschka return 0; 8844a71df50SFrank Blaschka } 8854a71df50SFrank Blaschka 8864a71df50SFrank Blaschka static void qeth_l2_remove_device(struct ccwgroup_device *cgdev) 8874a71df50SFrank Blaschka { 8884a71df50SFrank Blaschka struct qeth_card *card = dev_get_drvdata(&cgdev->dev); 8894a71df50SFrank Blaschka 8902d2ebb3eSJulian Wiedmann if (cgdev->dev.type == &qeth_generic_devtype) 891b4d72c08SEugene Crosser qeth_l2_remove_device_attributes(&cgdev->dev); 892f2148565SUrsula Braun qeth_set_allowed_threads(card, 0, 1); 8934a71df50SFrank Blaschka wait_event(card->wait_q, qeth_threads_running(card, 0xffffffff) == 0); 8944a71df50SFrank Blaschka 89570919e23SUrsula Braun if (cgdev->state == CCWGROUP_ONLINE) 8964a71df50SFrank Blaschka qeth_l2_set_offline(cgdev); 8974a71df50SFrank Blaschka 8984a71df50SFrank Blaschka if (card->dev) { 8994a71df50SFrank Blaschka unregister_netdev(card->dev); 9006be68739SJulian Wiedmann free_netdev(card->dev); 9014a71df50SFrank Blaschka card->dev = NULL; 9024a71df50SFrank Blaschka } 9034a71df50SFrank Blaschka return; 9044a71df50SFrank Blaschka } 9054a71df50SFrank Blaschka 9060fc0b732SStephen Hemminger static const struct ethtool_ops qeth_l2_ethtool_ops = { 9074a71df50SFrank Blaschka .get_link = ethtool_op_get_link, 9084a71df50SFrank Blaschka .get_strings = qeth_core_get_strings, 9094a71df50SFrank Blaschka .get_ethtool_stats = qeth_core_get_ethtool_stats, 910df8b4ec8SBen Hutchings .get_sset_count = qeth_core_get_sset_count, 9114a71df50SFrank Blaschka .get_drvinfo = qeth_core_get_drvinfo, 912993e19c0SJulian Wiedmann .get_link_ksettings = qeth_core_ethtool_get_link_ksettings, 9134a71df50SFrank Blaschka }; 9144a71df50SFrank Blaschka 9150fc0b732SStephen Hemminger static const struct ethtool_ops qeth_l2_osn_ops = { 9164a71df50SFrank Blaschka .get_strings = qeth_core_get_strings, 9174a71df50SFrank Blaschka .get_ethtool_stats = qeth_core_get_ethtool_stats, 918df8b4ec8SBen Hutchings .get_sset_count = qeth_core_get_sset_count, 9194a71df50SFrank Blaschka .get_drvinfo = qeth_core_get_drvinfo, 9204a71df50SFrank Blaschka }; 9214a71df50SFrank Blaschka 9223d58cefdSFrank Blaschka static const struct net_device_ops qeth_l2_netdev_ops = { 9238403b13cSFrank Blaschka .ndo_open = qeth_l2_open, 9248403b13cSFrank Blaschka .ndo_stop = qeth_l2_stop, 9258403b13cSFrank Blaschka .ndo_get_stats = qeth_get_stats, 9268403b13cSFrank Blaschka .ndo_start_xmit = qeth_l2_hard_start_xmit, 9276d69b1f1SJulian Wiedmann .ndo_features_check = qeth_features_check, 9288403b13cSFrank Blaschka .ndo_validate_addr = eth_validate_addr, 929fe5c8028SLakhvich Dmitriy .ndo_set_rx_mode = qeth_l2_set_rx_mode, 930942d6984SJulian Wiedmann .ndo_do_ioctl = qeth_do_ioctl, 9318403b13cSFrank Blaschka .ndo_set_mac_address = qeth_l2_set_mac_address, 9328403b13cSFrank Blaschka .ndo_change_mtu = qeth_change_mtu, 9338403b13cSFrank Blaschka .ndo_vlan_rx_add_vid = qeth_l2_vlan_rx_add_vid, 9348403b13cSFrank Blaschka .ndo_vlan_rx_kill_vid = qeth_l2_vlan_rx_kill_vid, 9358403b13cSFrank Blaschka .ndo_tx_timeout = qeth_tx_timeout, 9368f43fb00SThomas Richter .ndo_fix_features = qeth_fix_features, 9378f43fb00SThomas Richter .ndo_set_features = qeth_set_features 9388403b13cSFrank Blaschka }; 9398403b13cSFrank Blaschka 9404a71df50SFrank Blaschka static int qeth_l2_setup_netdev(struct qeth_card *card) 9414a71df50SFrank Blaschka { 9424a71df50SFrank Blaschka switch (card->info.type) { 9434a71df50SFrank Blaschka case QETH_CARD_TYPE_IQD: 944c835a677STom Gundersen card->dev = alloc_netdev(0, "hsi%d", NET_NAME_UNKNOWN, 945c835a677STom Gundersen ether_setup); 9464a71df50SFrank Blaschka break; 9474a71df50SFrank Blaschka case QETH_CARD_TYPE_OSN: 948c835a677STom Gundersen card->dev = alloc_netdev(0, "osn%d", NET_NAME_UNKNOWN, 949c835a677STom Gundersen ether_setup); 9504a71df50SFrank Blaschka break; 9514a71df50SFrank Blaschka default: 9524a71df50SFrank Blaschka card->dev = alloc_etherdev(0); 9534a71df50SFrank Blaschka } 9544a71df50SFrank Blaschka 9554a71df50SFrank Blaschka if (!card->dev) 9564a71df50SFrank Blaschka return -ENODEV; 9574a71df50SFrank Blaschka 958509e2562SHeiko Carstens card->dev->ml_priv = card; 959d3aacac4SJulian Wiedmann card->dev->priv_flags |= IFF_UNICAST_FLT; 9604a71df50SFrank Blaschka card->dev->watchdog_timeo = QETH_TX_TIMEOUT; 9614a71df50SFrank Blaschka card->dev->mtu = card->info.initial_mtu; 96246b3ef4cSJarod Wilson card->dev->min_mtu = 64; 96346b3ef4cSJarod Wilson card->dev->max_mtu = ETH_MAX_MTU; 96471c46897SUrsula Braun card->dev->dev_port = card->info.portno; 9658403b13cSFrank Blaschka card->dev->netdev_ops = &qeth_l2_netdev_ops; 96625e2c341SJulian Wiedmann if (card->info.type == QETH_CARD_TYPE_OSN) { 96725e2c341SJulian Wiedmann card->dev->ethtool_ops = &qeth_l2_osn_ops; 96825e2c341SJulian Wiedmann card->dev->flags |= IFF_NOARP; 96925e2c341SJulian Wiedmann } else { 97025e2c341SJulian Wiedmann card->dev->ethtool_ops = &qeth_l2_ethtool_ops; 97125e2c341SJulian Wiedmann } 9729400c53fSJulian Wiedmann 9739400c53fSJulian Wiedmann if (card->info.type == QETH_CARD_TYPE_OSM) 9749400c53fSJulian Wiedmann card->dev->features |= NETIF_F_VLAN_CHALLENGED; 9759400c53fSJulian Wiedmann else 976f646968fSPatrick McHardy card->dev->features |= NETIF_F_HW_VLAN_CTAG_FILTER; 9770f342945SJulian Wiedmann 9780f342945SJulian Wiedmann if (card->info.type != QETH_CARD_TYPE_OSN && 9790f342945SJulian Wiedmann card->info.type != QETH_CARD_TYPE_IQD) { 9800f342945SJulian Wiedmann card->dev->priv_flags &= ~IFF_TX_SKB_SHARING; 9810f342945SJulian Wiedmann card->dev->needed_headroom = sizeof(struct qeth_hdr); 9820f342945SJulian Wiedmann card->dev->hw_features |= NETIF_F_SG; 9830f342945SJulian Wiedmann card->dev->vlan_features |= NETIF_F_SG; 9840f342945SJulian Wiedmann } 9850f342945SJulian Wiedmann 9864d7def2aSThomas Richter if (card->info.type == QETH_CARD_TYPE_OSD && !card->info.guestlan) { 9876d69b1f1SJulian Wiedmann card->dev->features |= NETIF_F_SG; 9888f43fb00SThomas Richter /* OSA 3S and earlier has no RX/TX support */ 9899bdc4411SHans Wippel if (qeth_is_supported(card, IPA_OUTBOUND_CHECKSUM)) { 9908f43fb00SThomas Richter card->dev->hw_features |= NETIF_F_IP_CSUM; 9919bdc4411SHans Wippel card->dev->vlan_features |= NETIF_F_IP_CSUM; 9929bdc4411SHans Wippel } 9939bdc4411SHans Wippel if (qeth_is_supported(card, IPA_INBOUND_CHECKSUM)) { 9948f43fb00SThomas Richter card->dev->hw_features |= NETIF_F_RXCSUM; 9959bdc4411SHans Wippel card->dev->vlan_features |= NETIF_F_RXCSUM; 9969bdc4411SHans Wippel } 9974d7def2aSThomas Richter } 9980d6f02d3SJulian Wiedmann 9994a71df50SFrank Blaschka card->info.broadcast_capable = 1; 10004a71df50SFrank Blaschka qeth_l2_request_initial_mac(card); 10014a71df50SFrank Blaschka SET_NETDEV_DEV(card->dev, &card->gdev->dev); 1002d73ef324SJulian Wiedmann netif_napi_add(card->dev, &card->napi, qeth_poll, QETH_NAPI_WEIGHT); 1003e5ebe632SUrsula Braun netif_carrier_off(card->dev); 10044a71df50SFrank Blaschka return register_netdev(card->dev); 10054a71df50SFrank Blaschka } 10064a71df50SFrank Blaschka 10074d7def2aSThomas Richter static int qeth_l2_start_ipassists(struct qeth_card *card) 10084d7def2aSThomas Richter { 10094d7def2aSThomas Richter /* configure isolation level */ 10104d7def2aSThomas Richter if (qeth_set_access_ctrl_online(card, 0)) 10114d7def2aSThomas Richter return -ENODEV; 10124d7def2aSThomas Richter return 0; 10134d7def2aSThomas Richter } 10144d7def2aSThomas Richter 1015521c10eaSJulian Wiedmann static void qeth_l2_trace_features(struct qeth_card *card) 1016521c10eaSJulian Wiedmann { 1017a45b3fafSHans Wippel /* Set BridgePort features */ 1018a45b3fafSHans Wippel QETH_CARD_TEXT(card, 2, "featuSBP"); 1019521c10eaSJulian Wiedmann QETH_CARD_HEX(card, 2, &card->options.sbp.supported_funcs, 1020521c10eaSJulian Wiedmann sizeof(card->options.sbp.supported_funcs)); 1021a45b3fafSHans Wippel /* VNIC Characteristics features */ 1022a45b3fafSHans Wippel QETH_CARD_TEXT(card, 2, "feaVNICC"); 1023a45b3fafSHans Wippel QETH_CARD_HEX(card, 2, &card->options.vnicc.sup_chars, 1024a45b3fafSHans Wippel sizeof(card->options.vnicc.sup_chars)); 1025521c10eaSJulian Wiedmann } 1026521c10eaSJulian Wiedmann 10274a71df50SFrank Blaschka static int __qeth_l2_set_online(struct ccwgroup_device *gdev, int recovery_mode) 10284a71df50SFrank Blaschka { 10294a71df50SFrank Blaschka struct qeth_card *card = dev_get_drvdata(&gdev->dev); 10304a71df50SFrank Blaschka int rc = 0; 10314a71df50SFrank Blaschka enum qeth_card_states recover_flag; 10324a71df50SFrank Blaschka 10339dc48cccSUrsula Braun mutex_lock(&card->discipline_mutex); 1034c4949f07SFrank Blaschka mutex_lock(&card->conf_mutex); 1035d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "setonlin"); 1036d11ba0c4SPeter Tiedemann QETH_DBF_HEX(SETUP, 2, &card, sizeof(void *)); 10374a71df50SFrank Blaschka 10384a71df50SFrank Blaschka recover_flag = card->state; 10394a71df50SFrank Blaschka rc = qeth_core_hardsetup_card(card); 10404a71df50SFrank Blaschka if (rc) { 10411aec42bcSThomas Richter QETH_DBF_TEXT_(SETUP, 2, "2err%04x", rc); 1042aa909224SUrsula Braun rc = -ENODEV; 10434a71df50SFrank Blaschka goto out_remove; 10444a71df50SFrank Blaschka } 1045c044dc21SEugene Crosser qeth_bridgeport_query_support(card); 1046c044dc21SEugene Crosser if (card->options.sbp.supported_funcs) 1047c044dc21SEugene Crosser dev_info(&card->gdev->dev, 10489c23f4daSEugene Crosser "The device represents a Bridge Capable Port\n"); 10494a71df50SFrank Blaschka 1050aa909224SUrsula Braun if (!card->dev && qeth_l2_setup_netdev(card)) { 1051aa909224SUrsula Braun rc = -ENODEV; 10524a71df50SFrank Blaschka goto out_remove; 1053aa909224SUrsula Braun } 10544a71df50SFrank Blaschka 1055bcacfcbcSJulian Wiedmann if (card->info.type != QETH_CARD_TYPE_OSN && 1056bcacfcbcSJulian Wiedmann !qeth_l2_send_setmac(card, card->dev->dev_addr)) 1057bcacfcbcSJulian Wiedmann card->info.mac_bits |= QETH_LAYER2_MAC_REGISTERED; 10584a71df50SFrank Blaschka 10591da74b1cSFrank Blaschka if (qeth_is_diagass_supported(card, QETH_DIAGS_CMD_TRAP)) { 10601da74b1cSFrank Blaschka if (card->info.hwtrap && 10611da74b1cSFrank Blaschka qeth_hw_trap(card, QETH_DIAGS_TRAP_ARM)) 10621da74b1cSFrank Blaschka card->info.hwtrap = 0; 10631da74b1cSFrank Blaschka } else 10641da74b1cSFrank Blaschka card->info.hwtrap = 0; 10651da74b1cSFrank Blaschka 1066a45b3fafSHans Wippel /* for the rx_bcast characteristic, init VNICC after setmac */ 1067a45b3fafSHans Wippel qeth_l2_vnicc_init(card); 1068a45b3fafSHans Wippel 1069a45b3fafSHans Wippel qeth_trace_features(card); 1070a45b3fafSHans Wippel qeth_l2_trace_features(card); 1071a45b3fafSHans Wippel 1072b4d72c08SEugene Crosser qeth_l2_setup_bridgeport_attrs(card); 1073b4d72c08SEugene Crosser 10744a71df50SFrank Blaschka card->state = CARD_STATE_HARDSETUP; 10754a71df50SFrank Blaschka qeth_print_status_message(card); 10764a71df50SFrank Blaschka 10774a71df50SFrank Blaschka /* softsetup */ 1078d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "softsetp"); 10794a71df50SFrank Blaschka 10805113fec0SUrsula Braun if ((card->info.type == QETH_CARD_TYPE_OSD) || 10810f54761dSStefan Raspl (card->info.type == QETH_CARD_TYPE_OSX)) { 10828f43fb00SThomas Richter rc = qeth_l2_start_ipassists(card); 10838f43fb00SThomas Richter if (rc) 10840f54761dSStefan Raspl goto out_remove; 10850f54761dSStefan Raspl } 10865113fec0SUrsula Braun 10879400c53fSJulian Wiedmann if (card->info.type != QETH_CARD_TYPE_OSN) 108870919e23SUrsula Braun qeth_l2_process_vlans(card); 10894a71df50SFrank Blaschka 10904a71df50SFrank Blaschka netif_tx_disable(card->dev); 10914a71df50SFrank Blaschka 10924a71df50SFrank Blaschka rc = qeth_init_qdio_queues(card); 10934a71df50SFrank Blaschka if (rc) { 1094d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "6err%d", rc); 1095aa909224SUrsula Braun rc = -ENODEV; 10964a71df50SFrank Blaschka goto out_remove; 10974a71df50SFrank Blaschka } 10984a71df50SFrank Blaschka card->state = CARD_STATE_SOFTSETUP; 10992b6203bbSUrsula Braun if (card->lan_online) 11004a71df50SFrank Blaschka netif_carrier_on(card->dev); 11012b6203bbSUrsula Braun else 11022b6203bbSUrsula Braun netif_carrier_off(card->dev); 11034a71df50SFrank Blaschka 11044a71df50SFrank Blaschka qeth_set_allowed_threads(card, 0xffffffff, 0); 11054a71df50SFrank Blaschka if (recover_flag == CARD_STATE_RECOVER) { 11064a71df50SFrank Blaschka if (recovery_mode && 11074a71df50SFrank Blaschka card->info.type != QETH_CARD_TYPE_OSN) { 110839423440SUrsula Braun __qeth_l2_open(card->dev); 11094a71df50SFrank Blaschka } else { 11104a71df50SFrank Blaschka rtnl_lock(); 11114a71df50SFrank Blaschka dev_open(card->dev); 11124a71df50SFrank Blaschka rtnl_unlock(); 11134a71df50SFrank Blaschka } 11144a71df50SFrank Blaschka /* this also sets saved unicast addresses */ 1115fe5c8028SLakhvich Dmitriy qeth_l2_set_rx_mode(card->dev); 1116e830baa9SHans Wippel rtnl_lock(); 1117e830baa9SHans Wippel qeth_recover_features(card->dev); 1118e830baa9SHans Wippel rtnl_unlock(); 11194a71df50SFrank Blaschka } 11204a71df50SFrank Blaschka /* let user_space know that device is online */ 11214a71df50SFrank Blaschka kobject_uevent(&gdev->dev.kobj, KOBJ_CHANGE); 1122c4949f07SFrank Blaschka mutex_unlock(&card->conf_mutex); 11239dc48cccSUrsula Braun mutex_unlock(&card->discipline_mutex); 11244a71df50SFrank Blaschka return 0; 1125aa909224SUrsula Braun 11264a71df50SFrank Blaschka out_remove: 11274a71df50SFrank Blaschka qeth_l2_stop_card(card, 0); 11284a71df50SFrank Blaschka ccw_device_set_offline(CARD_DDEV(card)); 11294a71df50SFrank Blaschka ccw_device_set_offline(CARD_WDEV(card)); 11304a71df50SFrank Blaschka ccw_device_set_offline(CARD_RDEV(card)); 113122ae2790SUrsula Braun qdio_free(CARD_DDEV(card)); 11324a71df50SFrank Blaschka if (recover_flag == CARD_STATE_RECOVER) 11334a71df50SFrank Blaschka card->state = CARD_STATE_RECOVER; 11344a71df50SFrank Blaschka else 11354a71df50SFrank Blaschka card->state = CARD_STATE_DOWN; 1136c4949f07SFrank Blaschka mutex_unlock(&card->conf_mutex); 11379dc48cccSUrsula Braun mutex_unlock(&card->discipline_mutex); 1138aa909224SUrsula Braun return rc; 11394a71df50SFrank Blaschka } 11404a71df50SFrank Blaschka 11414a71df50SFrank Blaschka static int qeth_l2_set_online(struct ccwgroup_device *gdev) 11424a71df50SFrank Blaschka { 11434a71df50SFrank Blaschka return __qeth_l2_set_online(gdev, 0); 11444a71df50SFrank Blaschka } 11454a71df50SFrank Blaschka 11464a71df50SFrank Blaschka static int __qeth_l2_set_offline(struct ccwgroup_device *cgdev, 11474a71df50SFrank Blaschka int recovery_mode) 11484a71df50SFrank Blaschka { 11494a71df50SFrank Blaschka struct qeth_card *card = dev_get_drvdata(&cgdev->dev); 11504a71df50SFrank Blaschka int rc = 0, rc2 = 0, rc3 = 0; 11514a71df50SFrank Blaschka enum qeth_card_states recover_flag; 11524a71df50SFrank Blaschka 11539dc48cccSUrsula Braun mutex_lock(&card->discipline_mutex); 1154c4949f07SFrank Blaschka mutex_lock(&card->conf_mutex); 1155d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 3, "setoffl"); 1156d11ba0c4SPeter Tiedemann QETH_DBF_HEX(SETUP, 3, &card, sizeof(void *)); 11574a71df50SFrank Blaschka 11584a71df50SFrank Blaschka if (card->dev && netif_carrier_ok(card->dev)) 11594a71df50SFrank Blaschka netif_carrier_off(card->dev); 11604a71df50SFrank Blaschka recover_flag = card->state; 11611da74b1cSFrank Blaschka if ((!recovery_mode && card->info.hwtrap) || card->info.hwtrap == 2) { 11621da74b1cSFrank Blaschka qeth_hw_trap(card, QETH_DIAGS_TRAP_DISARM); 11631da74b1cSFrank Blaschka card->info.hwtrap = 1; 11641da74b1cSFrank Blaschka } 11650f5623c9SUrsula Braun qeth_l2_stop_card(card, recovery_mode); 11664a71df50SFrank Blaschka rc = ccw_device_set_offline(CARD_DDEV(card)); 11674a71df50SFrank Blaschka rc2 = ccw_device_set_offline(CARD_WDEV(card)); 11684a71df50SFrank Blaschka rc3 = ccw_device_set_offline(CARD_RDEV(card)); 11694a71df50SFrank Blaschka if (!rc) 11704a71df50SFrank Blaschka rc = (rc2) ? rc2 : rc3; 11714a71df50SFrank Blaschka if (rc) 1172d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "1err%d", rc); 117322ae2790SUrsula Braun qdio_free(CARD_DDEV(card)); 11744a71df50SFrank Blaschka if (recover_flag == CARD_STATE_UP) 11754a71df50SFrank Blaschka card->state = CARD_STATE_RECOVER; 11764a71df50SFrank Blaschka /* let user_space know that device is offline */ 11774a71df50SFrank Blaschka kobject_uevent(&cgdev->dev.kobj, KOBJ_CHANGE); 1178c4949f07SFrank Blaschka mutex_unlock(&card->conf_mutex); 11799dc48cccSUrsula Braun mutex_unlock(&card->discipline_mutex); 11804a71df50SFrank Blaschka return 0; 11814a71df50SFrank Blaschka } 11824a71df50SFrank Blaschka 11834a71df50SFrank Blaschka static int qeth_l2_set_offline(struct ccwgroup_device *cgdev) 11844a71df50SFrank Blaschka { 11854a71df50SFrank Blaschka return __qeth_l2_set_offline(cgdev, 0); 11864a71df50SFrank Blaschka } 11874a71df50SFrank Blaschka 11884a71df50SFrank Blaschka static int qeth_l2_recover(void *ptr) 11894a71df50SFrank Blaschka { 11904a71df50SFrank Blaschka struct qeth_card *card; 11914a71df50SFrank Blaschka int rc = 0; 11924a71df50SFrank Blaschka 11934a71df50SFrank Blaschka card = (struct qeth_card *) ptr; 1194847a50fdSCarsten Otte QETH_CARD_TEXT(card, 2, "recover1"); 11954a71df50SFrank Blaschka if (!qeth_do_run_thread(card, QETH_RECOVER_THREAD)) 11964a71df50SFrank Blaschka return 0; 1197847a50fdSCarsten Otte QETH_CARD_TEXT(card, 2, "recover2"); 119874eacdb9SFrank Blaschka dev_warn(&card->gdev->dev, 119974eacdb9SFrank Blaschka "A recovery process has been started for the device\n"); 120065d8013cSStefan Raspl qeth_set_recovery_task(card); 12014a71df50SFrank Blaschka __qeth_l2_set_offline(card->gdev, 1); 12024a71df50SFrank Blaschka rc = __qeth_l2_set_online(card->gdev, 1); 12034a71df50SFrank Blaschka if (!rc) 120474eacdb9SFrank Blaschka dev_info(&card->gdev->dev, 120574eacdb9SFrank Blaschka "Device successfully recovered!\n"); 120628a7e4c9SUrsula Braun else { 12070f54761dSStefan Raspl qeth_close_dev(card); 120874eacdb9SFrank Blaschka dev_warn(&card->gdev->dev, "The qeth device driver " 120974eacdb9SFrank Blaschka "failed to recover an error on the device\n"); 121028a7e4c9SUrsula Braun } 121165d8013cSStefan Raspl qeth_clear_recovery_task(card); 1212a1c3ed4cSFrank Blaschka qeth_clear_thread_start_bit(card, QETH_RECOVER_THREAD); 1213a1c3ed4cSFrank Blaschka qeth_clear_thread_running_bit(card, QETH_RECOVER_THREAD); 12144a71df50SFrank Blaschka return 0; 12154a71df50SFrank Blaschka } 12164a71df50SFrank Blaschka 12174a71df50SFrank Blaschka static int __init qeth_l2_init(void) 12184a71df50SFrank Blaschka { 121974eacdb9SFrank Blaschka pr_info("register layer 2 discipline\n"); 12204a71df50SFrank Blaschka return 0; 12214a71df50SFrank Blaschka } 12224a71df50SFrank Blaschka 12234a71df50SFrank Blaschka static void __exit qeth_l2_exit(void) 12244a71df50SFrank Blaschka { 122574eacdb9SFrank Blaschka pr_info("unregister layer 2 discipline\n"); 12264a71df50SFrank Blaschka } 12274a71df50SFrank Blaschka 1228bbcfcdc8SFrank Blaschka static int qeth_l2_pm_suspend(struct ccwgroup_device *gdev) 1229bbcfcdc8SFrank Blaschka { 1230bbcfcdc8SFrank Blaschka struct qeth_card *card = dev_get_drvdata(&gdev->dev); 1231bbcfcdc8SFrank Blaschka 1232bbcfcdc8SFrank Blaschka if (card->dev) 1233bbcfcdc8SFrank Blaschka netif_device_detach(card->dev); 1234bbcfcdc8SFrank Blaschka qeth_set_allowed_threads(card, 0, 1); 1235bbcfcdc8SFrank Blaschka wait_event(card->wait_q, qeth_threads_running(card, 0xffffffff) == 0); 1236bbcfcdc8SFrank Blaschka if (gdev->state == CCWGROUP_OFFLINE) 1237bbcfcdc8SFrank Blaschka return 0; 1238bbcfcdc8SFrank Blaschka if (card->state == CARD_STATE_UP) { 12391da74b1cSFrank Blaschka if (card->info.hwtrap) 12401da74b1cSFrank Blaschka qeth_hw_trap(card, QETH_DIAGS_TRAP_DISARM); 1241bbcfcdc8SFrank Blaschka __qeth_l2_set_offline(card->gdev, 1); 1242bbcfcdc8SFrank Blaschka } else 1243bbcfcdc8SFrank Blaschka __qeth_l2_set_offline(card->gdev, 0); 1244bbcfcdc8SFrank Blaschka return 0; 1245bbcfcdc8SFrank Blaschka } 1246bbcfcdc8SFrank Blaschka 1247bbcfcdc8SFrank Blaschka static int qeth_l2_pm_resume(struct ccwgroup_device *gdev) 1248bbcfcdc8SFrank Blaschka { 1249bbcfcdc8SFrank Blaschka struct qeth_card *card = dev_get_drvdata(&gdev->dev); 1250bbcfcdc8SFrank Blaschka int rc = 0; 1251bbcfcdc8SFrank Blaschka 1252bbcfcdc8SFrank Blaschka if (gdev->state == CCWGROUP_OFFLINE) 1253bbcfcdc8SFrank Blaschka goto out; 1254bbcfcdc8SFrank Blaschka 1255bbcfcdc8SFrank Blaschka if (card->state == CARD_STATE_RECOVER) { 1256bbcfcdc8SFrank Blaschka rc = __qeth_l2_set_online(card->gdev, 1); 1257bbcfcdc8SFrank Blaschka if (rc) { 1258bbcfcdc8SFrank Blaschka rtnl_lock(); 1259bbcfcdc8SFrank Blaschka dev_close(card->dev); 1260bbcfcdc8SFrank Blaschka rtnl_unlock(); 1261bbcfcdc8SFrank Blaschka } 1262bbcfcdc8SFrank Blaschka } else 1263bbcfcdc8SFrank Blaschka rc = __qeth_l2_set_online(card->gdev, 0); 1264bbcfcdc8SFrank Blaschka out: 1265bbcfcdc8SFrank Blaschka qeth_set_allowed_threads(card, 0xffffffff, 0); 1266bbcfcdc8SFrank Blaschka if (card->dev) 1267bbcfcdc8SFrank Blaschka netif_device_attach(card->dev); 1268bbcfcdc8SFrank Blaschka if (rc) 1269bbcfcdc8SFrank Blaschka dev_warn(&card->gdev->dev, "The qeth device driver " 1270bbcfcdc8SFrank Blaschka "failed to recover an error on the device\n"); 1271bbcfcdc8SFrank Blaschka return rc; 1272bbcfcdc8SFrank Blaschka } 1273bbcfcdc8SFrank Blaschka 1274c044dc21SEugene Crosser /* Returns zero if the command is successfully "consumed" */ 1275c044dc21SEugene Crosser static int qeth_l2_control_event(struct qeth_card *card, 1276c044dc21SEugene Crosser struct qeth_ipa_cmd *cmd) 1277c044dc21SEugene Crosser { 1278c044dc21SEugene Crosser switch (cmd->hdr.command) { 12799c23f4daSEugene Crosser case IPA_CMD_SETBRIDGEPORT_OSA: 12809c23f4daSEugene Crosser case IPA_CMD_SETBRIDGEPORT_IQD: 1281c044dc21SEugene Crosser if (cmd->data.sbp.hdr.command_code == 1282c044dc21SEugene Crosser IPA_SBP_BRIDGE_PORT_STATE_CHANGE) { 1283c044dc21SEugene Crosser qeth_bridge_state_change(card, cmd); 1284c044dc21SEugene Crosser return 0; 1285c044dc21SEugene Crosser } else 1286c044dc21SEugene Crosser return 1; 1287c044dc21SEugene Crosser case IPA_CMD_ADDRESS_CHANGE_NOTIF: 1288c044dc21SEugene Crosser qeth_bridge_host_event(card, cmd); 1289c044dc21SEugene Crosser return 0; 1290c044dc21SEugene Crosser default: 1291c044dc21SEugene Crosser return 1; 1292c044dc21SEugene Crosser } 1293c044dc21SEugene Crosser } 1294c044dc21SEugene Crosser 1295c041f2d4SSebastian Ott struct qeth_discipline qeth_l2_discipline = { 12962d2ebb3eSJulian Wiedmann .devtype = &qeth_l2_devtype, 1297d73ef324SJulian Wiedmann .process_rx_buffer = qeth_l2_process_inbound_buffer, 1298c041f2d4SSebastian Ott .recover = qeth_l2_recover, 1299c041f2d4SSebastian Ott .setup = qeth_l2_probe_device, 13004a71df50SFrank Blaschka .remove = qeth_l2_remove_device, 13014a71df50SFrank Blaschka .set_online = qeth_l2_set_online, 13024a71df50SFrank Blaschka .set_offline = qeth_l2_set_offline, 1303bbcfcdc8SFrank Blaschka .freeze = qeth_l2_pm_suspend, 1304bbcfcdc8SFrank Blaschka .thaw = qeth_l2_pm_resume, 1305bbcfcdc8SFrank Blaschka .restore = qeth_l2_pm_resume, 1306942d6984SJulian Wiedmann .do_ioctl = NULL, 1307c044dc21SEugene Crosser .control_event_handler = qeth_l2_control_event, 13084a71df50SFrank Blaschka }; 1309c041f2d4SSebastian Ott EXPORT_SYMBOL_GPL(qeth_l2_discipline); 13104a71df50SFrank Blaschka 13114a71df50SFrank Blaschka static int qeth_osn_send_control_data(struct qeth_card *card, int len, 13124a71df50SFrank Blaschka struct qeth_cmd_buffer *iob) 13134a71df50SFrank Blaschka { 13144a71df50SFrank Blaschka unsigned long flags; 13154a71df50SFrank Blaschka int rc = 0; 13164a71df50SFrank Blaschka 1317847a50fdSCarsten Otte QETH_CARD_TEXT(card, 5, "osndctrd"); 13184a71df50SFrank Blaschka 13194a71df50SFrank Blaschka wait_event(card->wait_q, 13204a71df50SFrank Blaschka atomic_cmpxchg(&card->write.irq_pending, 0, 1) == 0); 13214a71df50SFrank Blaschka qeth_prepare_control_data(card, len, iob); 1322847a50fdSCarsten Otte QETH_CARD_TEXT(card, 6, "osnoirqp"); 13234a71df50SFrank Blaschka spin_lock_irqsave(get_ccwdev_lock(card->write.ccwdev), flags); 1324db71bbbdSJulian Wiedmann rc = ccw_device_start_timeout(CARD_WDEV(card), &card->write.ccw, 1325db71bbbdSJulian Wiedmann (addr_t) iob, 0, 0, QETH_IPA_TIMEOUT); 13264a71df50SFrank Blaschka spin_unlock_irqrestore(get_ccwdev_lock(card->write.ccwdev), flags); 13274a71df50SFrank Blaschka if (rc) { 132814cc21b6SFrank Blaschka QETH_DBF_MESSAGE(2, "qeth_osn_send_control_data: " 13294a71df50SFrank Blaschka "ccw_device_start rc = %i\n", rc); 1330847a50fdSCarsten Otte QETH_CARD_TEXT_(card, 2, " err%d", rc); 13314a71df50SFrank Blaschka qeth_release_buffer(iob->channel, iob); 13324a71df50SFrank Blaschka atomic_set(&card->write.irq_pending, 0); 13334a71df50SFrank Blaschka wake_up(&card->wait_q); 13344a71df50SFrank Blaschka } 13354a71df50SFrank Blaschka return rc; 13364a71df50SFrank Blaschka } 13374a71df50SFrank Blaschka 13384a71df50SFrank Blaschka static int qeth_osn_send_ipa_cmd(struct qeth_card *card, 13394a71df50SFrank Blaschka struct qeth_cmd_buffer *iob, int data_len) 13404a71df50SFrank Blaschka { 13414a71df50SFrank Blaschka u16 s1, s2; 13424a71df50SFrank Blaschka 1343847a50fdSCarsten Otte QETH_CARD_TEXT(card, 4, "osndipa"); 13444a71df50SFrank Blaschka 13454a71df50SFrank Blaschka qeth_prepare_ipa_cmd(card, iob, QETH_PROT_OSN2); 13464a71df50SFrank Blaschka s1 = (u16)(IPA_PDU_HEADER_SIZE + data_len); 13474a71df50SFrank Blaschka s2 = (u16)data_len; 13484a71df50SFrank Blaschka memcpy(QETH_IPA_PDU_LEN_TOTAL(iob->data), &s1, 2); 13494a71df50SFrank Blaschka memcpy(QETH_IPA_PDU_LEN_PDU1(iob->data), &s2, 2); 13504a71df50SFrank Blaschka memcpy(QETH_IPA_PDU_LEN_PDU2(iob->data), &s2, 2); 13514a71df50SFrank Blaschka memcpy(QETH_IPA_PDU_LEN_PDU3(iob->data), &s2, 2); 13524a71df50SFrank Blaschka return qeth_osn_send_control_data(card, s1, iob); 13534a71df50SFrank Blaschka } 13544a71df50SFrank Blaschka 13554a71df50SFrank Blaschka int qeth_osn_assist(struct net_device *dev, void *data, int data_len) 13564a71df50SFrank Blaschka { 13574a71df50SFrank Blaschka struct qeth_cmd_buffer *iob; 13584a71df50SFrank Blaschka struct qeth_card *card; 13594a71df50SFrank Blaschka 13604a71df50SFrank Blaschka if (!dev) 13614a71df50SFrank Blaschka return -ENODEV; 1362509e2562SHeiko Carstens card = dev->ml_priv; 13634a71df50SFrank Blaschka if (!card) 13644a71df50SFrank Blaschka return -ENODEV; 1365847a50fdSCarsten Otte QETH_CARD_TEXT(card, 2, "osnsdmc"); 1366c3521254SEugene Crosser if (!qeth_card_hw_is_reachable(card)) 13674a71df50SFrank Blaschka return -ENODEV; 13684a71df50SFrank Blaschka iob = qeth_wait_for_buffer(&card->write); 1369ff5caa7aSJulian Wiedmann memcpy(__ipa_cmd(iob), data, data_len); 1370ff5caa7aSJulian Wiedmann return qeth_osn_send_ipa_cmd(card, iob, data_len); 13714a71df50SFrank Blaschka } 13724a71df50SFrank Blaschka EXPORT_SYMBOL(qeth_osn_assist); 13734a71df50SFrank Blaschka 13744a71df50SFrank Blaschka int qeth_osn_register(unsigned char *read_dev_no, struct net_device **dev, 13754a71df50SFrank Blaschka int (*assist_cb)(struct net_device *, void *), 13764a71df50SFrank Blaschka int (*data_cb)(struct sk_buff *)) 13774a71df50SFrank Blaschka { 13784a71df50SFrank Blaschka struct qeth_card *card; 13794a71df50SFrank Blaschka 13804a71df50SFrank Blaschka *dev = qeth_l2_netdev_by_devno(read_dev_no); 13814a71df50SFrank Blaschka if (*dev == NULL) 13824a71df50SFrank Blaschka return -ENODEV; 1383509e2562SHeiko Carstens card = (*dev)->ml_priv; 13844a71df50SFrank Blaschka if (!card) 13854a71df50SFrank Blaschka return -ENODEV; 1386847a50fdSCarsten Otte QETH_CARD_TEXT(card, 2, "osnreg"); 13874a71df50SFrank Blaschka if ((assist_cb == NULL) || (data_cb == NULL)) 13884a71df50SFrank Blaschka return -EINVAL; 13894a71df50SFrank Blaschka card->osn_info.assist_cb = assist_cb; 13904a71df50SFrank Blaschka card->osn_info.data_cb = data_cb; 13914a71df50SFrank Blaschka return 0; 13924a71df50SFrank Blaschka } 13934a71df50SFrank Blaschka EXPORT_SYMBOL(qeth_osn_register); 13944a71df50SFrank Blaschka 13954a71df50SFrank Blaschka void qeth_osn_deregister(struct net_device *dev) 13964a71df50SFrank Blaschka { 13974a71df50SFrank Blaschka struct qeth_card *card; 13984a71df50SFrank Blaschka 13994a71df50SFrank Blaschka if (!dev) 14004a71df50SFrank Blaschka return; 1401509e2562SHeiko Carstens card = dev->ml_priv; 14024a71df50SFrank Blaschka if (!card) 14034a71df50SFrank Blaschka return; 1404847a50fdSCarsten Otte QETH_CARD_TEXT(card, 2, "osndereg"); 14054a71df50SFrank Blaschka card->osn_info.assist_cb = NULL; 14064a71df50SFrank Blaschka card->osn_info.data_cb = NULL; 14074a71df50SFrank Blaschka return; 14084a71df50SFrank Blaschka } 14094a71df50SFrank Blaschka EXPORT_SYMBOL(qeth_osn_deregister); 14104a71df50SFrank Blaschka 1411b4d72c08SEugene Crosser /* SETBRIDGEPORT support, async notifications */ 1412b4d72c08SEugene Crosser 14139f48b9dbSEugene Crosser enum qeth_an_event_type {anev_reg_unreg, anev_abort, anev_reset}; 14149f48b9dbSEugene Crosser 14159f48b9dbSEugene Crosser /** 14169f48b9dbSEugene Crosser * qeth_bridge_emit_host_event() - bridgeport address change notification 14179f48b9dbSEugene Crosser * @card: qeth_card structure pointer, for udev events. 14189f48b9dbSEugene Crosser * @evtype: "normal" register/unregister, or abort, or reset. For abort 14199f48b9dbSEugene Crosser * and reset token and addr_lnid are unused and may be NULL. 14209f48b9dbSEugene Crosser * @code: event bitmask: high order bit 0x80 value 1 means removal of an 14219f48b9dbSEugene Crosser * object, 0 - addition of an object. 14229f48b9dbSEugene Crosser * 0x01 - VLAN, 0x02 - MAC, 0x03 - VLAN and MAC. 14239f48b9dbSEugene Crosser * @token: "network token" structure identifying physical address of the port. 14249f48b9dbSEugene Crosser * @addr_lnid: pointer to structure with MAC address and VLAN ID. 14259f48b9dbSEugene Crosser * 14269f48b9dbSEugene Crosser * This function is called when registrations and deregistrations are 14279f48b9dbSEugene Crosser * reported by the hardware, and also when notifications are enabled - 14289f48b9dbSEugene Crosser * for all currently registered addresses. 14299f48b9dbSEugene Crosser */ 14309f48b9dbSEugene Crosser static void qeth_bridge_emit_host_event(struct qeth_card *card, 14319f48b9dbSEugene Crosser enum qeth_an_event_type evtype, 14329f48b9dbSEugene Crosser u8 code, struct net_if_token *token, struct mac_addr_lnid *addr_lnid) 14339f48b9dbSEugene Crosser { 14349f48b9dbSEugene Crosser char str[7][32]; 14359f48b9dbSEugene Crosser char *env[8]; 14369f48b9dbSEugene Crosser int i = 0; 14379f48b9dbSEugene Crosser 14389f48b9dbSEugene Crosser switch (evtype) { 14399f48b9dbSEugene Crosser case anev_reg_unreg: 14409f48b9dbSEugene Crosser snprintf(str[i], sizeof(str[i]), "BRIDGEDHOST=%s", 14419f48b9dbSEugene Crosser (code & IPA_ADDR_CHANGE_CODE_REMOVAL) 14429f48b9dbSEugene Crosser ? "deregister" : "register"); 14439f48b9dbSEugene Crosser env[i] = str[i]; i++; 14449f48b9dbSEugene Crosser if (code & IPA_ADDR_CHANGE_CODE_VLANID) { 14459f48b9dbSEugene Crosser snprintf(str[i], sizeof(str[i]), "VLAN=%d", 14469f48b9dbSEugene Crosser addr_lnid->lnid); 14479f48b9dbSEugene Crosser env[i] = str[i]; i++; 14489f48b9dbSEugene Crosser } 14499f48b9dbSEugene Crosser if (code & IPA_ADDR_CHANGE_CODE_MACADDR) { 14509846e70bSEugene Crosser snprintf(str[i], sizeof(str[i]), "MAC=%pM", 14519846e70bSEugene Crosser addr_lnid->mac); 14529f48b9dbSEugene Crosser env[i] = str[i]; i++; 14539f48b9dbSEugene Crosser } 14549f48b9dbSEugene Crosser snprintf(str[i], sizeof(str[i]), "NTOK_BUSID=%x.%x.%04x", 14559f48b9dbSEugene Crosser token->cssid, token->ssid, token->devnum); 14569f48b9dbSEugene Crosser env[i] = str[i]; i++; 14579f48b9dbSEugene Crosser snprintf(str[i], sizeof(str[i]), "NTOK_IID=%02x", token->iid); 14589f48b9dbSEugene Crosser env[i] = str[i]; i++; 14599f48b9dbSEugene Crosser snprintf(str[i], sizeof(str[i]), "NTOK_CHPID=%02x", 14609f48b9dbSEugene Crosser token->chpid); 14619f48b9dbSEugene Crosser env[i] = str[i]; i++; 14629f48b9dbSEugene Crosser snprintf(str[i], sizeof(str[i]), "NTOK_CHID=%04x", token->chid); 14639f48b9dbSEugene Crosser env[i] = str[i]; i++; 14649f48b9dbSEugene Crosser break; 14659f48b9dbSEugene Crosser case anev_abort: 14669f48b9dbSEugene Crosser snprintf(str[i], sizeof(str[i]), "BRIDGEDHOST=abort"); 14679f48b9dbSEugene Crosser env[i] = str[i]; i++; 14689f48b9dbSEugene Crosser break; 14699f48b9dbSEugene Crosser case anev_reset: 14709f48b9dbSEugene Crosser snprintf(str[i], sizeof(str[i]), "BRIDGEDHOST=reset"); 14719f48b9dbSEugene Crosser env[i] = str[i]; i++; 14729f48b9dbSEugene Crosser break; 14739f48b9dbSEugene Crosser } 14749f48b9dbSEugene Crosser env[i] = NULL; 14759f48b9dbSEugene Crosser kobject_uevent_env(&card->gdev->dev.kobj, KOBJ_CHANGE, env); 14769f48b9dbSEugene Crosser } 14779f48b9dbSEugene Crosser 1478b4d72c08SEugene Crosser struct qeth_bridge_state_data { 1479b4d72c08SEugene Crosser struct work_struct worker; 1480b4d72c08SEugene Crosser struct qeth_card *card; 1481b4d72c08SEugene Crosser struct qeth_sbp_state_change qports; 1482b4d72c08SEugene Crosser }; 1483b4d72c08SEugene Crosser 1484b4d72c08SEugene Crosser static void qeth_bridge_state_change_worker(struct work_struct *work) 1485b4d72c08SEugene Crosser { 1486b4d72c08SEugene Crosser struct qeth_bridge_state_data *data = 1487b4d72c08SEugene Crosser container_of(work, struct qeth_bridge_state_data, worker); 1488b4d72c08SEugene Crosser /* We are only interested in the first entry - local port */ 1489b4d72c08SEugene Crosser struct qeth_sbp_port_entry *entry = &data->qports.entry[0]; 1490b4d72c08SEugene Crosser char env_locrem[32]; 1491b4d72c08SEugene Crosser char env_role[32]; 1492b4d72c08SEugene Crosser char env_state[32]; 1493b4d72c08SEugene Crosser char *env[] = { 1494b4d72c08SEugene Crosser env_locrem, 1495b4d72c08SEugene Crosser env_role, 1496b4d72c08SEugene Crosser env_state, 1497b4d72c08SEugene Crosser NULL 1498b4d72c08SEugene Crosser }; 1499b4d72c08SEugene Crosser 1500b4d72c08SEugene Crosser /* Role should not change by itself, but if it did, */ 1501b4d72c08SEugene Crosser /* information from the hardware is authoritative. */ 1502b4d72c08SEugene Crosser mutex_lock(&data->card->conf_mutex); 1503b4d72c08SEugene Crosser data->card->options.sbp.role = entry->role; 1504b4d72c08SEugene Crosser mutex_unlock(&data->card->conf_mutex); 1505b4d72c08SEugene Crosser 1506b4d72c08SEugene Crosser snprintf(env_locrem, sizeof(env_locrem), "BRIDGEPORT=statechange"); 1507b4d72c08SEugene Crosser snprintf(env_role, sizeof(env_role), "ROLE=%s", 1508b4d72c08SEugene Crosser (entry->role == QETH_SBP_ROLE_NONE) ? "none" : 1509b4d72c08SEugene Crosser (entry->role == QETH_SBP_ROLE_PRIMARY) ? "primary" : 1510b4d72c08SEugene Crosser (entry->role == QETH_SBP_ROLE_SECONDARY) ? "secondary" : 1511b4d72c08SEugene Crosser "<INVALID>"); 1512b4d72c08SEugene Crosser snprintf(env_state, sizeof(env_state), "STATE=%s", 1513b4d72c08SEugene Crosser (entry->state == QETH_SBP_STATE_INACTIVE) ? "inactive" : 1514b4d72c08SEugene Crosser (entry->state == QETH_SBP_STATE_STANDBY) ? "standby" : 1515b4d72c08SEugene Crosser (entry->state == QETH_SBP_STATE_ACTIVE) ? "active" : 1516b4d72c08SEugene Crosser "<INVALID>"); 1517b4d72c08SEugene Crosser kobject_uevent_env(&data->card->gdev->dev.kobj, 1518b4d72c08SEugene Crosser KOBJ_CHANGE, env); 1519b4d72c08SEugene Crosser kfree(data); 1520b4d72c08SEugene Crosser } 1521b4d72c08SEugene Crosser 1522c044dc21SEugene Crosser static void qeth_bridge_state_change(struct qeth_card *card, 1523c044dc21SEugene Crosser struct qeth_ipa_cmd *cmd) 1524b4d72c08SEugene Crosser { 1525b4d72c08SEugene Crosser struct qeth_sbp_state_change *qports = 1526b4d72c08SEugene Crosser &cmd->data.sbp.data.state_change; 1527b4d72c08SEugene Crosser struct qeth_bridge_state_data *data; 1528b4d72c08SEugene Crosser int extrasize; 1529b4d72c08SEugene Crosser 1530b4d72c08SEugene Crosser QETH_CARD_TEXT(card, 2, "brstchng"); 1531b4d72c08SEugene Crosser if (qports->entry_length != sizeof(struct qeth_sbp_port_entry)) { 15328a593148SThomas Richter QETH_CARD_TEXT_(card, 2, "BPsz%04x", qports->entry_length); 1533b4d72c08SEugene Crosser return; 1534b4d72c08SEugene Crosser } 1535b4d72c08SEugene Crosser extrasize = sizeof(struct qeth_sbp_port_entry) * qports->num_entries; 1536b4d72c08SEugene Crosser data = kzalloc(sizeof(struct qeth_bridge_state_data) + extrasize, 1537b4d72c08SEugene Crosser GFP_ATOMIC); 1538b4d72c08SEugene Crosser if (!data) { 1539b4d72c08SEugene Crosser QETH_CARD_TEXT(card, 2, "BPSalloc"); 1540b4d72c08SEugene Crosser return; 1541b4d72c08SEugene Crosser } 1542b4d72c08SEugene Crosser INIT_WORK(&data->worker, qeth_bridge_state_change_worker); 1543b4d72c08SEugene Crosser data->card = card; 1544b4d72c08SEugene Crosser memcpy(&data->qports, qports, 1545b4d72c08SEugene Crosser sizeof(struct qeth_sbp_state_change) + extrasize); 1546b4d72c08SEugene Crosser queue_work(qeth_wq, &data->worker); 1547b4d72c08SEugene Crosser } 1548b4d72c08SEugene Crosser 15499f48b9dbSEugene Crosser struct qeth_bridge_host_data { 15509f48b9dbSEugene Crosser struct work_struct worker; 15519f48b9dbSEugene Crosser struct qeth_card *card; 15529f48b9dbSEugene Crosser struct qeth_ipacmd_addr_change hostevs; 15539f48b9dbSEugene Crosser }; 15549f48b9dbSEugene Crosser 15559f48b9dbSEugene Crosser static void qeth_bridge_host_event_worker(struct work_struct *work) 15569f48b9dbSEugene Crosser { 15579f48b9dbSEugene Crosser struct qeth_bridge_host_data *data = 15589f48b9dbSEugene Crosser container_of(work, struct qeth_bridge_host_data, worker); 15599f48b9dbSEugene Crosser int i; 15609f48b9dbSEugene Crosser 15619f48b9dbSEugene Crosser if (data->hostevs.lost_event_mask) { 15629f48b9dbSEugene Crosser dev_info(&data->card->gdev->dev, 15639c23f4daSEugene Crosser "Address notification from the Bridge Port stopped %s (%s)\n", 15649f48b9dbSEugene Crosser data->card->dev->name, 15659f48b9dbSEugene Crosser (data->hostevs.lost_event_mask == 0x01) 15669f48b9dbSEugene Crosser ? "Overflow" 15679f48b9dbSEugene Crosser : (data->hostevs.lost_event_mask == 0x02) 15689f48b9dbSEugene Crosser ? "Bridge port state change" 15699f48b9dbSEugene Crosser : "Unknown reason"); 15709f48b9dbSEugene Crosser mutex_lock(&data->card->conf_mutex); 15719f48b9dbSEugene Crosser data->card->options.sbp.hostnotification = 0; 15729f48b9dbSEugene Crosser mutex_unlock(&data->card->conf_mutex); 15739f48b9dbSEugene Crosser qeth_bridge_emit_host_event(data->card, anev_abort, 15749f48b9dbSEugene Crosser 0, NULL, NULL); 15759f48b9dbSEugene Crosser } else 15769f48b9dbSEugene Crosser for (i = 0; i < data->hostevs.num_entries; i++) { 15779f48b9dbSEugene Crosser struct qeth_ipacmd_addr_change_entry *entry = 15789f48b9dbSEugene Crosser &data->hostevs.entry[i]; 15799f48b9dbSEugene Crosser qeth_bridge_emit_host_event(data->card, 15809f48b9dbSEugene Crosser anev_reg_unreg, 15819f48b9dbSEugene Crosser entry->change_code, 15829f48b9dbSEugene Crosser &entry->token, &entry->addr_lnid); 15839f48b9dbSEugene Crosser } 15849f48b9dbSEugene Crosser kfree(data); 15859f48b9dbSEugene Crosser } 15869f48b9dbSEugene Crosser 1587c044dc21SEugene Crosser static void qeth_bridge_host_event(struct qeth_card *card, 1588c044dc21SEugene Crosser struct qeth_ipa_cmd *cmd) 15899f48b9dbSEugene Crosser { 15909f48b9dbSEugene Crosser struct qeth_ipacmd_addr_change *hostevs = 15919f48b9dbSEugene Crosser &cmd->data.addrchange; 15929f48b9dbSEugene Crosser struct qeth_bridge_host_data *data; 15939f48b9dbSEugene Crosser int extrasize; 15949f48b9dbSEugene Crosser 15959f48b9dbSEugene Crosser QETH_CARD_TEXT(card, 2, "brhostev"); 15969f48b9dbSEugene Crosser if (cmd->hdr.return_code != 0x0000) { 15979f48b9dbSEugene Crosser if (cmd->hdr.return_code == 0x0010) { 15989f48b9dbSEugene Crosser if (hostevs->lost_event_mask == 0x00) 15999f48b9dbSEugene Crosser hostevs->lost_event_mask = 0xff; 16009f48b9dbSEugene Crosser } else { 16019f48b9dbSEugene Crosser QETH_CARD_TEXT_(card, 2, "BPHe%04x", 16029f48b9dbSEugene Crosser cmd->hdr.return_code); 16039f48b9dbSEugene Crosser return; 16049f48b9dbSEugene Crosser } 16059f48b9dbSEugene Crosser } 16069f48b9dbSEugene Crosser extrasize = sizeof(struct qeth_ipacmd_addr_change_entry) * 16079f48b9dbSEugene Crosser hostevs->num_entries; 16089f48b9dbSEugene Crosser data = kzalloc(sizeof(struct qeth_bridge_host_data) + extrasize, 16099f48b9dbSEugene Crosser GFP_ATOMIC); 16109f48b9dbSEugene Crosser if (!data) { 16119f48b9dbSEugene Crosser QETH_CARD_TEXT(card, 2, "BPHalloc"); 16129f48b9dbSEugene Crosser return; 16139f48b9dbSEugene Crosser } 16149f48b9dbSEugene Crosser INIT_WORK(&data->worker, qeth_bridge_host_event_worker); 16159f48b9dbSEugene Crosser data->card = card; 16169f48b9dbSEugene Crosser memcpy(&data->hostevs, hostevs, 16179f48b9dbSEugene Crosser sizeof(struct qeth_ipacmd_addr_change) + extrasize); 16189f48b9dbSEugene Crosser queue_work(qeth_wq, &data->worker); 16199f48b9dbSEugene Crosser } 16209f48b9dbSEugene Crosser 1621b4d72c08SEugene Crosser /* SETBRIDGEPORT support; sending commands */ 1622b4d72c08SEugene Crosser 1623b4d72c08SEugene Crosser struct _qeth_sbp_cbctl { 1624b4d72c08SEugene Crosser u16 ipa_rc; 1625b4d72c08SEugene Crosser u16 cmd_rc; 1626b4d72c08SEugene Crosser union { 1627b4d72c08SEugene Crosser u32 supported; 1628b4d72c08SEugene Crosser struct { 1629b4d72c08SEugene Crosser enum qeth_sbp_roles *role; 1630b4d72c08SEugene Crosser enum qeth_sbp_states *state; 1631b4d72c08SEugene Crosser } qports; 1632b4d72c08SEugene Crosser } data; 1633b4d72c08SEugene Crosser }; 1634b4d72c08SEugene Crosser 1635b4d72c08SEugene Crosser /** 1636b4d72c08SEugene Crosser * qeth_bridgeport_makerc() - derive "traditional" error from hardware codes. 1637b4d72c08SEugene Crosser * @card: qeth_card structure pointer, for debug messages. 1638b4d72c08SEugene Crosser * @cbctl: state structure with hardware return codes. 1639b4d72c08SEugene Crosser * @setcmd: IPA command code 1640b4d72c08SEugene Crosser * 1641b4d72c08SEugene Crosser * Returns negative errno-compatible error indication or 0 on success. 1642b4d72c08SEugene Crosser */ 1643b4d72c08SEugene Crosser static int qeth_bridgeport_makerc(struct qeth_card *card, 1644b4d72c08SEugene Crosser struct _qeth_sbp_cbctl *cbctl, enum qeth_ipa_sbp_cmd setcmd) 1645b4d72c08SEugene Crosser { 1646b4d72c08SEugene Crosser int rc; 16479c23f4daSEugene Crosser int is_iqd = (card->info.type == QETH_CARD_TYPE_IQD); 1648b4d72c08SEugene Crosser 16499c23f4daSEugene Crosser if ((is_iqd && (cbctl->ipa_rc == IPA_RC_SUCCESS)) || 16509c23f4daSEugene Crosser (!is_iqd && (cbctl->ipa_rc == cbctl->cmd_rc))) 1651b4d72c08SEugene Crosser switch (cbctl->cmd_rc) { 16522063a5f5SKittipon Meesompop case IPA_RC_SUCCESS: 1653b4d72c08SEugene Crosser rc = 0; 1654b4d72c08SEugene Crosser break; 16552063a5f5SKittipon Meesompop case IPA_RC_L2_UNSUPPORTED_CMD: 16562063a5f5SKittipon Meesompop case IPA_RC_UNSUPPORTED_COMMAND: 1657ffb95251SEugene Crosser rc = -EOPNOTSUPP; 1658b4d72c08SEugene Crosser break; 16592063a5f5SKittipon Meesompop case IPA_RC_SBP_OSA_NOT_CONFIGURED: 16602063a5f5SKittipon Meesompop case IPA_RC_SBP_IQD_NOT_CONFIGURED: 1661b4d72c08SEugene Crosser rc = -ENODEV; /* maybe not the best code here? */ 1662b4d72c08SEugene Crosser dev_err(&card->gdev->dev, 16639c23f4daSEugene Crosser "The device is not configured as a Bridge Port\n"); 1664b4d72c08SEugene Crosser break; 16652063a5f5SKittipon Meesompop case IPA_RC_SBP_OSA_OS_MISMATCH: 16662063a5f5SKittipon Meesompop case IPA_RC_SBP_IQD_OS_MISMATCH: 16671b05cf62SEugene Crosser rc = -EPERM; 16681b05cf62SEugene Crosser dev_err(&card->gdev->dev, 16691b05cf62SEugene Crosser "A Bridge Port is already configured by a different operating system\n"); 16701b05cf62SEugene Crosser break; 16712063a5f5SKittipon Meesompop case IPA_RC_SBP_OSA_ANO_DEV_PRIMARY: 16722063a5f5SKittipon Meesompop case IPA_RC_SBP_IQD_ANO_DEV_PRIMARY: 1673b4d72c08SEugene Crosser switch (setcmd) { 1674b4d72c08SEugene Crosser case IPA_SBP_SET_PRIMARY_BRIDGE_PORT: 1675b4d72c08SEugene Crosser rc = -EEXIST; 1676b4d72c08SEugene Crosser dev_err(&card->gdev->dev, 16779c23f4daSEugene Crosser "The LAN already has a primary Bridge Port\n"); 1678b4d72c08SEugene Crosser break; 1679b4d72c08SEugene Crosser case IPA_SBP_SET_SECONDARY_BRIDGE_PORT: 1680b4d72c08SEugene Crosser rc = -EBUSY; 1681b4d72c08SEugene Crosser dev_err(&card->gdev->dev, 16829c23f4daSEugene Crosser "The device is already a primary Bridge Port\n"); 1683b4d72c08SEugene Crosser break; 1684b4d72c08SEugene Crosser default: 1685b4d72c08SEugene Crosser rc = -EIO; 1686b4d72c08SEugene Crosser } 1687b4d72c08SEugene Crosser break; 16882063a5f5SKittipon Meesompop case IPA_RC_SBP_OSA_CURRENT_SECOND: 16892063a5f5SKittipon Meesompop case IPA_RC_SBP_IQD_CURRENT_SECOND: 1690b4d72c08SEugene Crosser rc = -EBUSY; 1691b4d72c08SEugene Crosser dev_err(&card->gdev->dev, 16929c23f4daSEugene Crosser "The device is already a secondary Bridge Port\n"); 1693b4d72c08SEugene Crosser break; 16942063a5f5SKittipon Meesompop case IPA_RC_SBP_OSA_LIMIT_SECOND: 16952063a5f5SKittipon Meesompop case IPA_RC_SBP_IQD_LIMIT_SECOND: 1696b4d72c08SEugene Crosser rc = -EEXIST; 1697b4d72c08SEugene Crosser dev_err(&card->gdev->dev, 16989c23f4daSEugene Crosser "The LAN cannot have more secondary Bridge Ports\n"); 1699b4d72c08SEugene Crosser break; 17002063a5f5SKittipon Meesompop case IPA_RC_SBP_OSA_CURRENT_PRIMARY: 17012063a5f5SKittipon Meesompop case IPA_RC_SBP_IQD_CURRENT_PRIMARY: 1702b4d72c08SEugene Crosser rc = -EBUSY; 1703b4d72c08SEugene Crosser dev_err(&card->gdev->dev, 17049c23f4daSEugene Crosser "The device is already a primary Bridge Port\n"); 1705b4d72c08SEugene Crosser break; 17062063a5f5SKittipon Meesompop case IPA_RC_SBP_OSA_NOT_AUTHD_BY_ZMAN: 17072063a5f5SKittipon Meesompop case IPA_RC_SBP_IQD_NOT_AUTHD_BY_ZMAN: 1708b4d72c08SEugene Crosser rc = -EACCES; 1709b4d72c08SEugene Crosser dev_err(&card->gdev->dev, 17109c23f4daSEugene Crosser "The device is not authorized to be a Bridge Port\n"); 1711b4d72c08SEugene Crosser break; 1712b4d72c08SEugene Crosser default: 1713b4d72c08SEugene Crosser rc = -EIO; 1714b4d72c08SEugene Crosser } 17159c23f4daSEugene Crosser else 17169c23f4daSEugene Crosser switch (cbctl->ipa_rc) { 1717b4d72c08SEugene Crosser case IPA_RC_NOTSUPP: 1718ffb95251SEugene Crosser rc = -EOPNOTSUPP; 1719b4d72c08SEugene Crosser break; 1720b4d72c08SEugene Crosser case IPA_RC_UNSUPPORTED_COMMAND: 1721ffb95251SEugene Crosser rc = -EOPNOTSUPP; 1722b4d72c08SEugene Crosser break; 1723b4d72c08SEugene Crosser default: 1724b4d72c08SEugene Crosser rc = -EIO; 1725b4d72c08SEugene Crosser } 17269c23f4daSEugene Crosser 1727b4d72c08SEugene Crosser if (rc) { 1728b4d72c08SEugene Crosser QETH_CARD_TEXT_(card, 2, "SBPi%04x", cbctl->ipa_rc); 1729b4d72c08SEugene Crosser QETH_CARD_TEXT_(card, 2, "SBPc%04x", cbctl->cmd_rc); 1730b4d72c08SEugene Crosser } 1731b4d72c08SEugene Crosser return rc; 1732b4d72c08SEugene Crosser } 1733b4d72c08SEugene Crosser 1734d65626adSJulian Wiedmann static struct qeth_cmd_buffer *qeth_sbp_build_cmd(struct qeth_card *card, 1735d65626adSJulian Wiedmann enum qeth_ipa_sbp_cmd sbp_cmd, 1736d65626adSJulian Wiedmann unsigned int cmd_length) 17379c23f4daSEugene Crosser { 1738d65626adSJulian Wiedmann enum qeth_ipa_cmds ipa_cmd = (card->info.type == QETH_CARD_TYPE_IQD) ? 17399c23f4daSEugene Crosser IPA_CMD_SETBRIDGEPORT_IQD : 17409c23f4daSEugene Crosser IPA_CMD_SETBRIDGEPORT_OSA; 1741d65626adSJulian Wiedmann struct qeth_cmd_buffer *iob; 1742d65626adSJulian Wiedmann struct qeth_ipa_cmd *cmd; 1743d65626adSJulian Wiedmann 1744d65626adSJulian Wiedmann iob = qeth_get_ipacmd_buffer(card, ipa_cmd, 0); 1745d65626adSJulian Wiedmann if (!iob) 1746d65626adSJulian Wiedmann return iob; 1747ff5caa7aSJulian Wiedmann cmd = __ipa_cmd(iob); 1748d65626adSJulian Wiedmann cmd->data.sbp.hdr.cmdlength = sizeof(struct qeth_ipacmd_sbp_hdr) + 1749d65626adSJulian Wiedmann cmd_length; 1750d65626adSJulian Wiedmann cmd->data.sbp.hdr.command_code = sbp_cmd; 1751d65626adSJulian Wiedmann cmd->data.sbp.hdr.used_total = 1; 1752d65626adSJulian Wiedmann cmd->data.sbp.hdr.seq_no = 1; 1753d65626adSJulian Wiedmann return iob; 17549c23f4daSEugene Crosser } 17559c23f4daSEugene Crosser 1756b4d72c08SEugene Crosser static int qeth_bridgeport_query_support_cb(struct qeth_card *card, 1757b4d72c08SEugene Crosser struct qeth_reply *reply, unsigned long data) 1758b4d72c08SEugene Crosser { 1759b4d72c08SEugene Crosser struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *) data; 1760b4d72c08SEugene Crosser struct _qeth_sbp_cbctl *cbctl = (struct _qeth_sbp_cbctl *)reply->param; 1761b4d72c08SEugene Crosser QETH_CARD_TEXT(card, 2, "brqsupcb"); 1762b4d72c08SEugene Crosser cbctl->ipa_rc = cmd->hdr.return_code; 1763b4d72c08SEugene Crosser cbctl->cmd_rc = cmd->data.sbp.hdr.return_code; 1764b4d72c08SEugene Crosser if ((cbctl->ipa_rc == 0) && (cbctl->cmd_rc == 0)) { 1765b4d72c08SEugene Crosser cbctl->data.supported = 1766b4d72c08SEugene Crosser cmd->data.sbp.data.query_cmds_supp.supported_cmds; 1767b4d72c08SEugene Crosser } else { 1768b4d72c08SEugene Crosser cbctl->data.supported = 0; 1769b4d72c08SEugene Crosser } 1770b4d72c08SEugene Crosser return 0; 1771b4d72c08SEugene Crosser } 1772b4d72c08SEugene Crosser 1773b4d72c08SEugene Crosser /** 1774b4d72c08SEugene Crosser * qeth_bridgeport_query_support() - store bitmask of supported subfunctions. 1775b4d72c08SEugene Crosser * @card: qeth_card structure pointer. 1776b4d72c08SEugene Crosser * 1777b4d72c08SEugene Crosser * Sets bitmask of supported setbridgeport subfunctions in the qeth_card 1778b4d72c08SEugene Crosser * strucutre: card->options.sbp.supported_funcs. 1779b4d72c08SEugene Crosser */ 1780c044dc21SEugene Crosser static void qeth_bridgeport_query_support(struct qeth_card *card) 1781b4d72c08SEugene Crosser { 1782b4d72c08SEugene Crosser struct qeth_cmd_buffer *iob; 1783b4d72c08SEugene Crosser struct _qeth_sbp_cbctl cbctl; 1784b4d72c08SEugene Crosser 1785b4d72c08SEugene Crosser QETH_CARD_TEXT(card, 2, "brqsuppo"); 1786d65626adSJulian Wiedmann iob = qeth_sbp_build_cmd(card, IPA_SBP_QUERY_COMMANDS_SUPPORTED, 1787d65626adSJulian Wiedmann sizeof(struct qeth_sbp_query_cmds_supp)); 17881aec42bcSThomas Richter if (!iob) 17891aec42bcSThomas Richter return; 1790b4d72c08SEugene Crosser if (qeth_send_ipa_cmd(card, iob, qeth_bridgeport_query_support_cb, 1791b4d72c08SEugene Crosser (void *)&cbctl) || 1792b4d72c08SEugene Crosser qeth_bridgeport_makerc(card, &cbctl, 1793b4d72c08SEugene Crosser IPA_SBP_QUERY_COMMANDS_SUPPORTED)) { 1794b4d72c08SEugene Crosser /* non-zero makerc signifies failure, and produce messages */ 1795b4d72c08SEugene Crosser card->options.sbp.role = QETH_SBP_ROLE_NONE; 1796b4d72c08SEugene Crosser return; 1797b4d72c08SEugene Crosser } 1798b4d72c08SEugene Crosser card->options.sbp.supported_funcs = cbctl.data.supported; 1799b4d72c08SEugene Crosser } 1800b4d72c08SEugene Crosser 1801b4d72c08SEugene Crosser static int qeth_bridgeport_query_ports_cb(struct qeth_card *card, 1802b4d72c08SEugene Crosser struct qeth_reply *reply, unsigned long data) 1803b4d72c08SEugene Crosser { 1804b4d72c08SEugene Crosser struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *) data; 1805b4d72c08SEugene Crosser struct qeth_sbp_query_ports *qports = &cmd->data.sbp.data.query_ports; 1806b4d72c08SEugene Crosser struct _qeth_sbp_cbctl *cbctl = (struct _qeth_sbp_cbctl *)reply->param; 1807b4d72c08SEugene Crosser 1808b4d72c08SEugene Crosser QETH_CARD_TEXT(card, 2, "brqprtcb"); 1809b4d72c08SEugene Crosser cbctl->ipa_rc = cmd->hdr.return_code; 1810b4d72c08SEugene Crosser cbctl->cmd_rc = cmd->data.sbp.hdr.return_code; 1811b4d72c08SEugene Crosser if ((cbctl->ipa_rc != 0) || (cbctl->cmd_rc != 0)) 1812b4d72c08SEugene Crosser return 0; 1813b4d72c08SEugene Crosser if (qports->entry_length != sizeof(struct qeth_sbp_port_entry)) { 1814b4d72c08SEugene Crosser cbctl->cmd_rc = 0xffff; 1815b4d72c08SEugene Crosser QETH_CARD_TEXT_(card, 2, "SBPs%04x", qports->entry_length); 1816b4d72c08SEugene Crosser return 0; 1817b4d72c08SEugene Crosser } 1818b4d72c08SEugene Crosser /* first entry contains the state of the local port */ 1819b4d72c08SEugene Crosser if (qports->num_entries > 0) { 1820b4d72c08SEugene Crosser if (cbctl->data.qports.role) 1821b4d72c08SEugene Crosser *cbctl->data.qports.role = qports->entry[0].role; 1822b4d72c08SEugene Crosser if (cbctl->data.qports.state) 1823b4d72c08SEugene Crosser *cbctl->data.qports.state = qports->entry[0].state; 1824b4d72c08SEugene Crosser } 1825b4d72c08SEugene Crosser return 0; 1826b4d72c08SEugene Crosser } 1827b4d72c08SEugene Crosser 1828b4d72c08SEugene Crosser /** 1829b4d72c08SEugene Crosser * qeth_bridgeport_query_ports() - query local bridgeport status. 1830b4d72c08SEugene Crosser * @card: qeth_card structure pointer. 1831b4d72c08SEugene Crosser * @role: Role of the port: 0-none, 1-primary, 2-secondary. 1832b4d72c08SEugene Crosser * @state: State of the port: 0-inactive, 1-standby, 2-active. 1833b4d72c08SEugene Crosser * 1834b4d72c08SEugene Crosser * Returns negative errno-compatible error indication or 0 on success. 1835b4d72c08SEugene Crosser * 1836b4d72c08SEugene Crosser * 'role' and 'state' are not updated in case of hardware operation failure. 1837b4d72c08SEugene Crosser */ 1838b4d72c08SEugene Crosser int qeth_bridgeport_query_ports(struct qeth_card *card, 1839b4d72c08SEugene Crosser enum qeth_sbp_roles *role, enum qeth_sbp_states *state) 1840b4d72c08SEugene Crosser { 1841b4d72c08SEugene Crosser int rc = 0; 1842b4d72c08SEugene Crosser struct qeth_cmd_buffer *iob; 1843b4d72c08SEugene Crosser struct _qeth_sbp_cbctl cbctl = { 1844b4d72c08SEugene Crosser .data = { 1845b4d72c08SEugene Crosser .qports = { 1846b4d72c08SEugene Crosser .role = role, 1847b4d72c08SEugene Crosser .state = state, 1848b4d72c08SEugene Crosser }, 1849b4d72c08SEugene Crosser }, 1850b4d72c08SEugene Crosser }; 1851b4d72c08SEugene Crosser 1852b4d72c08SEugene Crosser QETH_CARD_TEXT(card, 2, "brqports"); 1853b4d72c08SEugene Crosser if (!(card->options.sbp.supported_funcs & IPA_SBP_QUERY_BRIDGE_PORTS)) 1854b4d72c08SEugene Crosser return -EOPNOTSUPP; 1855d65626adSJulian Wiedmann iob = qeth_sbp_build_cmd(card, IPA_SBP_QUERY_BRIDGE_PORTS, 0); 18561aec42bcSThomas Richter if (!iob) 18571aec42bcSThomas Richter return -ENOMEM; 1858b4d72c08SEugene Crosser rc = qeth_send_ipa_cmd(card, iob, qeth_bridgeport_query_ports_cb, 1859b4d72c08SEugene Crosser (void *)&cbctl); 1860c88394e7SEugene Crosser if (rc < 0) 1861b4d72c08SEugene Crosser return rc; 1862c88394e7SEugene Crosser return qeth_bridgeport_makerc(card, &cbctl, IPA_SBP_QUERY_BRIDGE_PORTS); 1863b4d72c08SEugene Crosser } 1864b4d72c08SEugene Crosser EXPORT_SYMBOL_GPL(qeth_bridgeport_query_ports); 1865b4d72c08SEugene Crosser 1866b4d72c08SEugene Crosser static int qeth_bridgeport_set_cb(struct qeth_card *card, 1867b4d72c08SEugene Crosser struct qeth_reply *reply, unsigned long data) 1868b4d72c08SEugene Crosser { 1869b4d72c08SEugene Crosser struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *)data; 1870b4d72c08SEugene Crosser struct _qeth_sbp_cbctl *cbctl = (struct _qeth_sbp_cbctl *)reply->param; 1871b4d72c08SEugene Crosser QETH_CARD_TEXT(card, 2, "brsetrcb"); 1872b4d72c08SEugene Crosser cbctl->ipa_rc = cmd->hdr.return_code; 1873b4d72c08SEugene Crosser cbctl->cmd_rc = cmd->data.sbp.hdr.return_code; 1874b4d72c08SEugene Crosser return 0; 1875b4d72c08SEugene Crosser } 1876b4d72c08SEugene Crosser 1877b4d72c08SEugene Crosser /** 1878b4d72c08SEugene Crosser * qeth_bridgeport_setrole() - Assign primary role to the port. 1879b4d72c08SEugene Crosser * @card: qeth_card structure pointer. 1880b4d72c08SEugene Crosser * @role: Role to assign. 1881b4d72c08SEugene Crosser * 1882b4d72c08SEugene Crosser * Returns negative errno-compatible error indication or 0 on success. 1883b4d72c08SEugene Crosser */ 1884b4d72c08SEugene Crosser int qeth_bridgeport_setrole(struct qeth_card *card, enum qeth_sbp_roles role) 1885b4d72c08SEugene Crosser { 1886b4d72c08SEugene Crosser int rc = 0; 1887b4d72c08SEugene Crosser int cmdlength; 1888b4d72c08SEugene Crosser struct qeth_cmd_buffer *iob; 1889b4d72c08SEugene Crosser struct _qeth_sbp_cbctl cbctl; 1890b4d72c08SEugene Crosser enum qeth_ipa_sbp_cmd setcmd; 1891b4d72c08SEugene Crosser 1892b4d72c08SEugene Crosser QETH_CARD_TEXT(card, 2, "brsetrol"); 1893b4d72c08SEugene Crosser switch (role) { 1894b4d72c08SEugene Crosser case QETH_SBP_ROLE_NONE: 1895b4d72c08SEugene Crosser setcmd = IPA_SBP_RESET_BRIDGE_PORT_ROLE; 1896d65626adSJulian Wiedmann cmdlength = sizeof(struct qeth_sbp_reset_role); 1897b4d72c08SEugene Crosser break; 1898b4d72c08SEugene Crosser case QETH_SBP_ROLE_PRIMARY: 1899b4d72c08SEugene Crosser setcmd = IPA_SBP_SET_PRIMARY_BRIDGE_PORT; 1900d65626adSJulian Wiedmann cmdlength = sizeof(struct qeth_sbp_set_primary); 1901b4d72c08SEugene Crosser break; 1902b4d72c08SEugene Crosser case QETH_SBP_ROLE_SECONDARY: 1903b4d72c08SEugene Crosser setcmd = IPA_SBP_SET_SECONDARY_BRIDGE_PORT; 1904d65626adSJulian Wiedmann cmdlength = sizeof(struct qeth_sbp_set_secondary); 1905b4d72c08SEugene Crosser break; 1906b4d72c08SEugene Crosser default: 1907b4d72c08SEugene Crosser return -EINVAL; 1908b4d72c08SEugene Crosser } 1909b4d72c08SEugene Crosser if (!(card->options.sbp.supported_funcs & setcmd)) 1910b4d72c08SEugene Crosser return -EOPNOTSUPP; 1911d65626adSJulian Wiedmann iob = qeth_sbp_build_cmd(card, setcmd, cmdlength); 19121aec42bcSThomas Richter if (!iob) 19131aec42bcSThomas Richter return -ENOMEM; 1914b4d72c08SEugene Crosser rc = qeth_send_ipa_cmd(card, iob, qeth_bridgeport_set_cb, 1915b4d72c08SEugene Crosser (void *)&cbctl); 1916c88394e7SEugene Crosser if (rc < 0) 1917b4d72c08SEugene Crosser return rc; 1918c88394e7SEugene Crosser return qeth_bridgeport_makerc(card, &cbctl, setcmd); 1919b4d72c08SEugene Crosser } 1920b4d72c08SEugene Crosser 19219f48b9dbSEugene Crosser /** 19229f48b9dbSEugene Crosser * qeth_anset_makerc() - derive "traditional" error from hardware codes. 19239f48b9dbSEugene Crosser * @card: qeth_card structure pointer, for debug messages. 19249f48b9dbSEugene Crosser * 19259f48b9dbSEugene Crosser * Returns negative errno-compatible error indication or 0 on success. 19269f48b9dbSEugene Crosser */ 19279f48b9dbSEugene Crosser static int qeth_anset_makerc(struct qeth_card *card, int pnso_rc, u16 response) 19289f48b9dbSEugene Crosser { 19299f48b9dbSEugene Crosser int rc; 19309f48b9dbSEugene Crosser 19319f48b9dbSEugene Crosser if (pnso_rc == 0) 19329f48b9dbSEugene Crosser switch (response) { 19339f48b9dbSEugene Crosser case 0x0001: 19349f48b9dbSEugene Crosser rc = 0; 19359f48b9dbSEugene Crosser break; 19369f48b9dbSEugene Crosser case 0x0004: 19379f48b9dbSEugene Crosser case 0x0100: 19389f48b9dbSEugene Crosser case 0x0106: 1939ffb95251SEugene Crosser rc = -EOPNOTSUPP; 19409f48b9dbSEugene Crosser dev_err(&card->gdev->dev, 19419f48b9dbSEugene Crosser "Setting address notification failed\n"); 19429f48b9dbSEugene Crosser break; 19439f48b9dbSEugene Crosser case 0x0107: 19449f48b9dbSEugene Crosser rc = -EAGAIN; 19459f48b9dbSEugene Crosser break; 19469f48b9dbSEugene Crosser default: 19479f48b9dbSEugene Crosser rc = -EIO; 19489f48b9dbSEugene Crosser } 19499f48b9dbSEugene Crosser else 19509f48b9dbSEugene Crosser rc = -EIO; 19519f48b9dbSEugene Crosser 19529f48b9dbSEugene Crosser if (rc) { 19539f48b9dbSEugene Crosser QETH_CARD_TEXT_(card, 2, "SBPp%04x", pnso_rc); 19549f48b9dbSEugene Crosser QETH_CARD_TEXT_(card, 2, "SBPr%04x", response); 19559f48b9dbSEugene Crosser } 19569f48b9dbSEugene Crosser return rc; 19579f48b9dbSEugene Crosser } 19589f48b9dbSEugene Crosser 19599f48b9dbSEugene Crosser static void qeth_bridgeport_an_set_cb(void *priv, 19609f48b9dbSEugene Crosser enum qdio_brinfo_entry_type type, void *entry) 19619f48b9dbSEugene Crosser { 19629f48b9dbSEugene Crosser struct qeth_card *card = (struct qeth_card *)priv; 19639f48b9dbSEugene Crosser struct qdio_brinfo_entry_l2 *l2entry; 19649f48b9dbSEugene Crosser u8 code; 19659f48b9dbSEugene Crosser 19669f48b9dbSEugene Crosser if (type != l2_addr_lnid) { 19679f48b9dbSEugene Crosser WARN_ON_ONCE(1); 19689f48b9dbSEugene Crosser return; 19699f48b9dbSEugene Crosser } 19709f48b9dbSEugene Crosser 19719f48b9dbSEugene Crosser l2entry = (struct qdio_brinfo_entry_l2 *)entry; 19729f48b9dbSEugene Crosser code = IPA_ADDR_CHANGE_CODE_MACADDR; 19739f48b9dbSEugene Crosser if (l2entry->addr_lnid.lnid) 19749f48b9dbSEugene Crosser code |= IPA_ADDR_CHANGE_CODE_VLANID; 19759f48b9dbSEugene Crosser qeth_bridge_emit_host_event(card, anev_reg_unreg, code, 19769f48b9dbSEugene Crosser (struct net_if_token *)&l2entry->nit, 19779f48b9dbSEugene Crosser (struct mac_addr_lnid *)&l2entry->addr_lnid); 19789f48b9dbSEugene Crosser } 19799f48b9dbSEugene Crosser 19809f48b9dbSEugene Crosser /** 19819f48b9dbSEugene Crosser * qeth_bridgeport_an_set() - Enable or disable bridgeport address notification 19829f48b9dbSEugene Crosser * @card: qeth_card structure pointer. 19839f48b9dbSEugene Crosser * @enable: 0 - disable, non-zero - enable notifications 19849f48b9dbSEugene Crosser * 19859f48b9dbSEugene Crosser * Returns negative errno-compatible error indication or 0 on success. 19869f48b9dbSEugene Crosser * 19879f48b9dbSEugene Crosser * On enable, emits a series of address notifications udev events for all 19889f48b9dbSEugene Crosser * currently registered hosts. 19899f48b9dbSEugene Crosser */ 19909f48b9dbSEugene Crosser int qeth_bridgeport_an_set(struct qeth_card *card, int enable) 19919f48b9dbSEugene Crosser { 19929f48b9dbSEugene Crosser int rc; 19939f48b9dbSEugene Crosser u16 response; 19949f48b9dbSEugene Crosser struct ccw_device *ddev; 19959f48b9dbSEugene Crosser struct subchannel_id schid; 19969f48b9dbSEugene Crosser 19979f48b9dbSEugene Crosser if (!card) 19989f48b9dbSEugene Crosser return -EINVAL; 19999f48b9dbSEugene Crosser if (!card->options.sbp.supported_funcs) 20009f48b9dbSEugene Crosser return -EOPNOTSUPP; 20019f48b9dbSEugene Crosser ddev = CARD_DDEV(card); 20029f48b9dbSEugene Crosser ccw_device_get_schid(ddev, &schid); 20039f48b9dbSEugene Crosser 20049f48b9dbSEugene Crosser if (enable) { 20059f48b9dbSEugene Crosser qeth_bridge_emit_host_event(card, anev_reset, 0, NULL, NULL); 20069f48b9dbSEugene Crosser rc = qdio_pnso_brinfo(schid, 1, &response, 20079f48b9dbSEugene Crosser qeth_bridgeport_an_set_cb, card); 20089f48b9dbSEugene Crosser } else 20099f48b9dbSEugene Crosser rc = qdio_pnso_brinfo(schid, 0, &response, NULL, NULL); 20109f48b9dbSEugene Crosser return qeth_anset_makerc(card, rc, response); 20119f48b9dbSEugene Crosser } 20129f48b9dbSEugene Crosser EXPORT_SYMBOL_GPL(qeth_bridgeport_an_set); 20139f48b9dbSEugene Crosser 2014caa1f0b1SHans Wippel static bool qeth_bridgeport_is_in_use(struct qeth_card *card) 2015caa1f0b1SHans Wippel { 2016caa1f0b1SHans Wippel return (card->options.sbp.role || card->options.sbp.reflect_promisc || 2017caa1f0b1SHans Wippel card->options.sbp.hostnotification); 2018caa1f0b1SHans Wippel } 2019caa1f0b1SHans Wippel 2020a45b3fafSHans Wippel /* VNIC Characteristics support */ 2021a45b3fafSHans Wippel 2022a45b3fafSHans Wippel /* handle VNICC IPA command return codes; convert to error codes */ 2023a45b3fafSHans Wippel static int qeth_l2_vnicc_makerc(struct qeth_card *card, int ipa_rc) 2024a45b3fafSHans Wippel { 2025a45b3fafSHans Wippel int rc; 2026a45b3fafSHans Wippel 2027a45b3fafSHans Wippel switch (ipa_rc) { 2028a45b3fafSHans Wippel case IPA_RC_SUCCESS: 2029a45b3fafSHans Wippel return ipa_rc; 2030a45b3fafSHans Wippel case IPA_RC_L2_UNSUPPORTED_CMD: 2031a45b3fafSHans Wippel case IPA_RC_NOTSUPP: 2032a45b3fafSHans Wippel rc = -EOPNOTSUPP; 2033a45b3fafSHans Wippel break; 2034a45b3fafSHans Wippel case IPA_RC_VNICC_OOSEQ: 2035a45b3fafSHans Wippel rc = -EALREADY; 2036a45b3fafSHans Wippel break; 2037a45b3fafSHans Wippel case IPA_RC_VNICC_VNICBP: 2038a45b3fafSHans Wippel rc = -EBUSY; 2039a45b3fafSHans Wippel break; 2040a45b3fafSHans Wippel case IPA_RC_L2_ADDR_TABLE_FULL: 2041a45b3fafSHans Wippel rc = -ENOSPC; 2042a45b3fafSHans Wippel break; 2043a45b3fafSHans Wippel case IPA_RC_L2_MAC_NOT_AUTH_BY_ADP: 2044a45b3fafSHans Wippel rc = -EACCES; 2045a45b3fafSHans Wippel break; 2046a45b3fafSHans Wippel default: 2047a45b3fafSHans Wippel rc = -EIO; 2048a45b3fafSHans Wippel } 2049a45b3fafSHans Wippel 2050a45b3fafSHans Wippel QETH_CARD_TEXT_(card, 2, "err%04x", ipa_rc); 2051a45b3fafSHans Wippel return rc; 2052a45b3fafSHans Wippel } 2053a45b3fafSHans Wippel 2054a45b3fafSHans Wippel /* generic VNICC request call back control */ 2055a45b3fafSHans Wippel struct _qeth_l2_vnicc_request_cbctl { 2056a45b3fafSHans Wippel u32 sub_cmd; 2057caa1f0b1SHans Wippel struct { 2058caa1f0b1SHans Wippel u32 vnic_char; 2059349d13d5SHans Wippel u32 timeout; 2060caa1f0b1SHans Wippel } param; 2061caa1f0b1SHans Wippel struct { 2062349d13d5SHans Wippel union{ 2063caa1f0b1SHans Wippel u32 *sup_cmds; 2064349d13d5SHans Wippel u32 *timeout; 2065349d13d5SHans Wippel }; 2066caa1f0b1SHans Wippel } result; 2067a45b3fafSHans Wippel }; 2068a45b3fafSHans Wippel 2069a45b3fafSHans Wippel /* generic VNICC request call back */ 2070a45b3fafSHans Wippel static int qeth_l2_vnicc_request_cb(struct qeth_card *card, 2071a45b3fafSHans Wippel struct qeth_reply *reply, 2072a45b3fafSHans Wippel unsigned long data) 2073a45b3fafSHans Wippel { 2074caa1f0b1SHans Wippel struct _qeth_l2_vnicc_request_cbctl *cbctl = 2075caa1f0b1SHans Wippel (struct _qeth_l2_vnicc_request_cbctl *) reply->param; 2076a45b3fafSHans Wippel struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *) data; 2077a45b3fafSHans Wippel struct qeth_ipacmd_vnicc *rep = &cmd->data.vnicc; 2078a45b3fafSHans Wippel 2079a45b3fafSHans Wippel QETH_CARD_TEXT(card, 2, "vniccrcb"); 2080a45b3fafSHans Wippel if (cmd->hdr.return_code) 2081a45b3fafSHans Wippel return 0; 2082a45b3fafSHans Wippel /* return results to caller */ 2083a45b3fafSHans Wippel card->options.vnicc.sup_chars = rep->hdr.sup; 2084a45b3fafSHans Wippel card->options.vnicc.cur_chars = rep->hdr.cur; 2085a45b3fafSHans Wippel 2086caa1f0b1SHans Wippel if (cbctl->sub_cmd == IPA_VNICC_QUERY_CMDS) 2087caa1f0b1SHans Wippel *cbctl->result.sup_cmds = rep->query_cmds.sup_cmds; 2088caa1f0b1SHans Wippel 2089349d13d5SHans Wippel if (cbctl->sub_cmd == IPA_VNICC_GET_TIMEOUT) 2090349d13d5SHans Wippel *cbctl->result.timeout = rep->getset_timeout.timeout; 2091349d13d5SHans Wippel 2092a45b3fafSHans Wippel return 0; 2093a45b3fafSHans Wippel } 2094a45b3fafSHans Wippel 2095a45b3fafSHans Wippel /* generic VNICC request */ 2096a45b3fafSHans Wippel static int qeth_l2_vnicc_request(struct qeth_card *card, 2097a45b3fafSHans Wippel struct _qeth_l2_vnicc_request_cbctl *cbctl) 2098a45b3fafSHans Wippel { 2099a45b3fafSHans Wippel struct qeth_ipacmd_vnicc *req; 2100a45b3fafSHans Wippel struct qeth_cmd_buffer *iob; 2101a45b3fafSHans Wippel struct qeth_ipa_cmd *cmd; 2102a45b3fafSHans Wippel int rc; 2103a45b3fafSHans Wippel 2104a45b3fafSHans Wippel QETH_CARD_TEXT(card, 2, "vniccreq"); 2105a45b3fafSHans Wippel 2106a45b3fafSHans Wippel /* get new buffer for request */ 2107a45b3fafSHans Wippel iob = qeth_get_ipacmd_buffer(card, IPA_CMD_VNICC, 0); 2108a45b3fafSHans Wippel if (!iob) 2109a45b3fafSHans Wippel return -ENOMEM; 2110a45b3fafSHans Wippel 2111a45b3fafSHans Wippel /* create header for request */ 2112ff5caa7aSJulian Wiedmann cmd = __ipa_cmd(iob); 2113a45b3fafSHans Wippel req = &cmd->data.vnicc; 2114a45b3fafSHans Wippel 2115a45b3fafSHans Wippel /* create sub command header for request */ 2116a45b3fafSHans Wippel req->sub_hdr.data_length = sizeof(req->sub_hdr); 2117a45b3fafSHans Wippel req->sub_hdr.sub_command = cbctl->sub_cmd; 2118a45b3fafSHans Wippel 2119a45b3fafSHans Wippel /* create sub command specific request fields */ 2120a45b3fafSHans Wippel switch (cbctl->sub_cmd) { 2121a45b3fafSHans Wippel case IPA_VNICC_QUERY_CHARS: 2122a45b3fafSHans Wippel break; 2123caa1f0b1SHans Wippel case IPA_VNICC_QUERY_CMDS: 2124caa1f0b1SHans Wippel req->sub_hdr.data_length += sizeof(req->query_cmds); 2125caa1f0b1SHans Wippel req->query_cmds.vnic_char = cbctl->param.vnic_char; 2126caa1f0b1SHans Wippel break; 2127caa1f0b1SHans Wippel case IPA_VNICC_ENABLE: 2128caa1f0b1SHans Wippel case IPA_VNICC_DISABLE: 2129caa1f0b1SHans Wippel req->sub_hdr.data_length += sizeof(req->set_char); 2130caa1f0b1SHans Wippel req->set_char.vnic_char = cbctl->param.vnic_char; 2131caa1f0b1SHans Wippel break; 2132349d13d5SHans Wippel case IPA_VNICC_SET_TIMEOUT: 2133349d13d5SHans Wippel req->getset_timeout.timeout = cbctl->param.timeout; 2134349d13d5SHans Wippel /* fallthrough */ 2135349d13d5SHans Wippel case IPA_VNICC_GET_TIMEOUT: 2136349d13d5SHans Wippel req->sub_hdr.data_length += sizeof(req->getset_timeout); 2137349d13d5SHans Wippel req->getset_timeout.vnic_char = cbctl->param.vnic_char; 2138349d13d5SHans Wippel break; 2139a45b3fafSHans Wippel default: 2140a45b3fafSHans Wippel qeth_release_buffer(iob->channel, iob); 2141a45b3fafSHans Wippel return -EOPNOTSUPP; 2142a45b3fafSHans Wippel } 2143a45b3fafSHans Wippel 2144a45b3fafSHans Wippel /* send request */ 2145a45b3fafSHans Wippel rc = qeth_send_ipa_cmd(card, iob, qeth_l2_vnicc_request_cb, 2146a45b3fafSHans Wippel (void *) cbctl); 2147a45b3fafSHans Wippel 2148a45b3fafSHans Wippel return qeth_l2_vnicc_makerc(card, rc); 2149a45b3fafSHans Wippel } 2150a45b3fafSHans Wippel 2151a45b3fafSHans Wippel /* VNICC query VNIC characteristics request */ 2152a45b3fafSHans Wippel static int qeth_l2_vnicc_query_chars(struct qeth_card *card) 2153a45b3fafSHans Wippel { 2154a45b3fafSHans Wippel struct _qeth_l2_vnicc_request_cbctl cbctl; 2155a45b3fafSHans Wippel 2156a45b3fafSHans Wippel /* prepare callback control */ 2157a45b3fafSHans Wippel cbctl.sub_cmd = IPA_VNICC_QUERY_CHARS; 2158a45b3fafSHans Wippel 2159a45b3fafSHans Wippel QETH_CARD_TEXT(card, 2, "vniccqch"); 2160a45b3fafSHans Wippel return qeth_l2_vnicc_request(card, &cbctl); 2161a45b3fafSHans Wippel } 2162a45b3fafSHans Wippel 2163caa1f0b1SHans Wippel /* VNICC query sub commands request */ 2164caa1f0b1SHans Wippel static int qeth_l2_vnicc_query_cmds(struct qeth_card *card, u32 vnic_char, 2165caa1f0b1SHans Wippel u32 *sup_cmds) 2166caa1f0b1SHans Wippel { 2167caa1f0b1SHans Wippel struct _qeth_l2_vnicc_request_cbctl cbctl; 2168caa1f0b1SHans Wippel 2169caa1f0b1SHans Wippel /* prepare callback control */ 2170caa1f0b1SHans Wippel cbctl.sub_cmd = IPA_VNICC_QUERY_CMDS; 2171caa1f0b1SHans Wippel cbctl.param.vnic_char = vnic_char; 2172caa1f0b1SHans Wippel cbctl.result.sup_cmds = sup_cmds; 2173caa1f0b1SHans Wippel 2174caa1f0b1SHans Wippel QETH_CARD_TEXT(card, 2, "vniccqcm"); 2175caa1f0b1SHans Wippel return qeth_l2_vnicc_request(card, &cbctl); 2176caa1f0b1SHans Wippel } 2177caa1f0b1SHans Wippel 2178caa1f0b1SHans Wippel /* VNICC enable/disable characteristic request */ 2179caa1f0b1SHans Wippel static int qeth_l2_vnicc_set_char(struct qeth_card *card, u32 vnic_char, 2180caa1f0b1SHans Wippel u32 cmd) 2181caa1f0b1SHans Wippel { 2182caa1f0b1SHans Wippel struct _qeth_l2_vnicc_request_cbctl cbctl; 2183caa1f0b1SHans Wippel 2184caa1f0b1SHans Wippel /* prepare callback control */ 2185caa1f0b1SHans Wippel cbctl.sub_cmd = cmd; 2186caa1f0b1SHans Wippel cbctl.param.vnic_char = vnic_char; 2187caa1f0b1SHans Wippel 2188caa1f0b1SHans Wippel QETH_CARD_TEXT(card, 2, "vniccedc"); 2189caa1f0b1SHans Wippel return qeth_l2_vnicc_request(card, &cbctl); 2190caa1f0b1SHans Wippel } 2191caa1f0b1SHans Wippel 2192349d13d5SHans Wippel /* VNICC get/set timeout for characteristic request */ 2193349d13d5SHans Wippel static int qeth_l2_vnicc_getset_timeout(struct qeth_card *card, u32 vnicc, 2194349d13d5SHans Wippel u32 cmd, u32 *timeout) 2195349d13d5SHans Wippel { 2196349d13d5SHans Wippel struct _qeth_l2_vnicc_request_cbctl cbctl; 2197349d13d5SHans Wippel 2198349d13d5SHans Wippel /* prepare callback control */ 2199349d13d5SHans Wippel cbctl.sub_cmd = cmd; 2200349d13d5SHans Wippel cbctl.param.vnic_char = vnicc; 2201349d13d5SHans Wippel if (cmd == IPA_VNICC_SET_TIMEOUT) 2202349d13d5SHans Wippel cbctl.param.timeout = *timeout; 2203349d13d5SHans Wippel if (cmd == IPA_VNICC_GET_TIMEOUT) 2204349d13d5SHans Wippel cbctl.result.timeout = timeout; 2205349d13d5SHans Wippel 2206349d13d5SHans Wippel QETH_CARD_TEXT(card, 2, "vniccgst"); 2207349d13d5SHans Wippel return qeth_l2_vnicc_request(card, &cbctl); 2208349d13d5SHans Wippel } 2209349d13d5SHans Wippel 2210caa1f0b1SHans Wippel /* set current VNICC flag state; called from sysfs store function */ 2211caa1f0b1SHans Wippel int qeth_l2_vnicc_set_state(struct qeth_card *card, u32 vnicc, bool state) 2212caa1f0b1SHans Wippel { 2213caa1f0b1SHans Wippel int rc = 0; 2214caa1f0b1SHans Wippel u32 cmd; 2215caa1f0b1SHans Wippel 2216caa1f0b1SHans Wippel QETH_CARD_TEXT(card, 2, "vniccsch"); 2217caa1f0b1SHans Wippel 2218caa1f0b1SHans Wippel /* do not change anything if BridgePort is enabled */ 2219caa1f0b1SHans Wippel if (qeth_bridgeport_is_in_use(card)) 2220caa1f0b1SHans Wippel return -EBUSY; 2221caa1f0b1SHans Wippel 2222caa1f0b1SHans Wippel /* check if characteristic and enable/disable are supported */ 2223caa1f0b1SHans Wippel if (!(card->options.vnicc.sup_chars & vnicc) || 2224caa1f0b1SHans Wippel !(card->options.vnicc.set_char_sup & vnicc)) 2225caa1f0b1SHans Wippel return -EOPNOTSUPP; 2226caa1f0b1SHans Wippel 2227caa1f0b1SHans Wippel /* set enable/disable command and store wanted characteristic */ 2228caa1f0b1SHans Wippel if (state) { 2229caa1f0b1SHans Wippel cmd = IPA_VNICC_ENABLE; 2230caa1f0b1SHans Wippel card->options.vnicc.wanted_chars |= vnicc; 2231caa1f0b1SHans Wippel } else { 2232caa1f0b1SHans Wippel cmd = IPA_VNICC_DISABLE; 2233caa1f0b1SHans Wippel card->options.vnicc.wanted_chars &= ~vnicc; 2234caa1f0b1SHans Wippel } 2235caa1f0b1SHans Wippel 2236caa1f0b1SHans Wippel /* do we need to do anything? */ 2237caa1f0b1SHans Wippel if (card->options.vnicc.cur_chars == card->options.vnicc.wanted_chars) 2238caa1f0b1SHans Wippel return rc; 2239caa1f0b1SHans Wippel 2240caa1f0b1SHans Wippel /* if card is not ready, simply stop here */ 2241caa1f0b1SHans Wippel if (!qeth_card_hw_is_reachable(card)) { 2242caa1f0b1SHans Wippel if (state) 2243caa1f0b1SHans Wippel card->options.vnicc.cur_chars |= vnicc; 2244caa1f0b1SHans Wippel else 2245caa1f0b1SHans Wippel card->options.vnicc.cur_chars &= ~vnicc; 2246caa1f0b1SHans Wippel return rc; 2247caa1f0b1SHans Wippel } 2248caa1f0b1SHans Wippel 2249caa1f0b1SHans Wippel rc = qeth_l2_vnicc_set_char(card, vnicc, cmd); 2250caa1f0b1SHans Wippel if (rc) 2251caa1f0b1SHans Wippel card->options.vnicc.wanted_chars = 2252caa1f0b1SHans Wippel card->options.vnicc.cur_chars; 2253349d13d5SHans Wippel else { 2254349d13d5SHans Wippel /* successful online VNICC change; handle special cases */ 2255349d13d5SHans Wippel if (state && vnicc == QETH_VNICC_RX_BCAST) 2256caa1f0b1SHans Wippel card->options.vnicc.rx_bcast_enabled = true; 2257349d13d5SHans Wippel if (!state && vnicc == QETH_VNICC_LEARNING) 2258349d13d5SHans Wippel qeth_l2_vnicc_recover_timeout(card, vnicc, 2259349d13d5SHans Wippel &card->options.vnicc.learning_timeout); 2260349d13d5SHans Wippel } 2261caa1f0b1SHans Wippel 2262caa1f0b1SHans Wippel return rc; 2263caa1f0b1SHans Wippel } 2264caa1f0b1SHans Wippel 2265caa1f0b1SHans Wippel /* get current VNICC flag state; called from sysfs show function */ 2266caa1f0b1SHans Wippel int qeth_l2_vnicc_get_state(struct qeth_card *card, u32 vnicc, bool *state) 2267caa1f0b1SHans Wippel { 2268caa1f0b1SHans Wippel int rc = 0; 2269caa1f0b1SHans Wippel 2270caa1f0b1SHans Wippel QETH_CARD_TEXT(card, 2, "vniccgch"); 2271caa1f0b1SHans Wippel 2272caa1f0b1SHans Wippel /* do not get anything if BridgePort is enabled */ 2273caa1f0b1SHans Wippel if (qeth_bridgeport_is_in_use(card)) 2274caa1f0b1SHans Wippel return -EBUSY; 2275caa1f0b1SHans Wippel 2276caa1f0b1SHans Wippel /* check if characteristic is supported */ 2277caa1f0b1SHans Wippel if (!(card->options.vnicc.sup_chars & vnicc)) 2278caa1f0b1SHans Wippel return -EOPNOTSUPP; 2279caa1f0b1SHans Wippel 2280caa1f0b1SHans Wippel /* if card is ready, query current VNICC state */ 2281caa1f0b1SHans Wippel if (qeth_card_hw_is_reachable(card)) 2282caa1f0b1SHans Wippel rc = qeth_l2_vnicc_query_chars(card); 2283caa1f0b1SHans Wippel 2284caa1f0b1SHans Wippel *state = (card->options.vnicc.cur_chars & vnicc) ? true : false; 2285caa1f0b1SHans Wippel return rc; 2286caa1f0b1SHans Wippel } 2287caa1f0b1SHans Wippel 2288349d13d5SHans Wippel /* set VNICC timeout; called from sysfs store function. Currently, only learning 2289349d13d5SHans Wippel * supports timeout 2290349d13d5SHans Wippel */ 2291349d13d5SHans Wippel int qeth_l2_vnicc_set_timeout(struct qeth_card *card, u32 timeout) 2292349d13d5SHans Wippel { 2293349d13d5SHans Wippel int rc = 0; 2294349d13d5SHans Wippel 2295349d13d5SHans Wippel QETH_CARD_TEXT(card, 2, "vniccsto"); 2296349d13d5SHans Wippel 2297349d13d5SHans Wippel /* do not change anything if BridgePort is enabled */ 2298349d13d5SHans Wippel if (qeth_bridgeport_is_in_use(card)) 2299349d13d5SHans Wippel return -EBUSY; 2300349d13d5SHans Wippel 2301349d13d5SHans Wippel /* check if characteristic and set_timeout are supported */ 2302349d13d5SHans Wippel if (!(card->options.vnicc.sup_chars & QETH_VNICC_LEARNING) || 2303349d13d5SHans Wippel !(card->options.vnicc.getset_timeout_sup & QETH_VNICC_LEARNING)) 2304349d13d5SHans Wippel return -EOPNOTSUPP; 2305349d13d5SHans Wippel 2306349d13d5SHans Wippel /* do we need to do anything? */ 2307349d13d5SHans Wippel if (card->options.vnicc.learning_timeout == timeout) 2308349d13d5SHans Wippel return rc; 2309349d13d5SHans Wippel 2310349d13d5SHans Wippel /* if card is not ready, simply store the value internally and return */ 2311349d13d5SHans Wippel if (!qeth_card_hw_is_reachable(card)) { 2312349d13d5SHans Wippel card->options.vnicc.learning_timeout = timeout; 2313349d13d5SHans Wippel return rc; 2314349d13d5SHans Wippel } 2315349d13d5SHans Wippel 2316349d13d5SHans Wippel /* send timeout value to card; if successful, store value internally */ 2317349d13d5SHans Wippel rc = qeth_l2_vnicc_getset_timeout(card, QETH_VNICC_LEARNING, 2318349d13d5SHans Wippel IPA_VNICC_SET_TIMEOUT, &timeout); 2319349d13d5SHans Wippel if (!rc) 2320349d13d5SHans Wippel card->options.vnicc.learning_timeout = timeout; 2321349d13d5SHans Wippel 2322349d13d5SHans Wippel return rc; 2323349d13d5SHans Wippel } 2324349d13d5SHans Wippel 2325349d13d5SHans Wippel /* get current VNICC timeout; called from sysfs show function. Currently, only 2326349d13d5SHans Wippel * learning supports timeout 2327349d13d5SHans Wippel */ 2328349d13d5SHans Wippel int qeth_l2_vnicc_get_timeout(struct qeth_card *card, u32 *timeout) 2329349d13d5SHans Wippel { 2330349d13d5SHans Wippel int rc = 0; 2331349d13d5SHans Wippel 2332349d13d5SHans Wippel QETH_CARD_TEXT(card, 2, "vniccgto"); 2333349d13d5SHans Wippel 2334349d13d5SHans Wippel /* do not get anything if BridgePort is enabled */ 2335349d13d5SHans Wippel if (qeth_bridgeport_is_in_use(card)) 2336349d13d5SHans Wippel return -EBUSY; 2337349d13d5SHans Wippel 2338349d13d5SHans Wippel /* check if characteristic and get_timeout are supported */ 2339349d13d5SHans Wippel if (!(card->options.vnicc.sup_chars & QETH_VNICC_LEARNING) || 2340349d13d5SHans Wippel !(card->options.vnicc.getset_timeout_sup & QETH_VNICC_LEARNING)) 2341349d13d5SHans Wippel return -EOPNOTSUPP; 2342349d13d5SHans Wippel /* if card is ready, get timeout. Otherwise, just return stored value */ 2343349d13d5SHans Wippel *timeout = card->options.vnicc.learning_timeout; 2344349d13d5SHans Wippel if (qeth_card_hw_is_reachable(card)) 2345349d13d5SHans Wippel rc = qeth_l2_vnicc_getset_timeout(card, QETH_VNICC_LEARNING, 2346349d13d5SHans Wippel IPA_VNICC_GET_TIMEOUT, 2347349d13d5SHans Wippel timeout); 2348349d13d5SHans Wippel 2349349d13d5SHans Wippel return rc; 2350349d13d5SHans Wippel } 2351349d13d5SHans Wippel 2352caa1f0b1SHans Wippel /* check if VNICC is currently enabled */ 2353caa1f0b1SHans Wippel bool qeth_l2_vnicc_is_in_use(struct qeth_card *card) 2354caa1f0b1SHans Wippel { 2355caa1f0b1SHans Wippel /* if everything is turned off, VNICC is not active */ 2356caa1f0b1SHans Wippel if (!card->options.vnicc.cur_chars) 2357caa1f0b1SHans Wippel return false; 2358caa1f0b1SHans Wippel /* default values are only OK if rx_bcast was not enabled by user 2359caa1f0b1SHans Wippel * or the card is offline. 2360caa1f0b1SHans Wippel */ 2361caa1f0b1SHans Wippel if (card->options.vnicc.cur_chars == QETH_VNICC_DEFAULT) { 2362caa1f0b1SHans Wippel if (!card->options.vnicc.rx_bcast_enabled || 2363caa1f0b1SHans Wippel !qeth_card_hw_is_reachable(card)) 2364caa1f0b1SHans Wippel return false; 2365caa1f0b1SHans Wippel } 2366caa1f0b1SHans Wippel return true; 2367caa1f0b1SHans Wippel } 2368caa1f0b1SHans Wippel 2369349d13d5SHans Wippel /* recover user timeout setting */ 2370349d13d5SHans Wippel static bool qeth_l2_vnicc_recover_timeout(struct qeth_card *card, u32 vnicc, 2371349d13d5SHans Wippel u32 *timeout) 2372349d13d5SHans Wippel { 2373349d13d5SHans Wippel if (card->options.vnicc.sup_chars & vnicc && 2374349d13d5SHans Wippel card->options.vnicc.getset_timeout_sup & vnicc && 2375349d13d5SHans Wippel !qeth_l2_vnicc_getset_timeout(card, vnicc, IPA_VNICC_SET_TIMEOUT, 2376349d13d5SHans Wippel timeout)) 2377349d13d5SHans Wippel return false; 2378349d13d5SHans Wippel *timeout = QETH_VNICC_DEFAULT_TIMEOUT; 2379349d13d5SHans Wippel return true; 2380349d13d5SHans Wippel } 2381349d13d5SHans Wippel 2382caa1f0b1SHans Wippel /* recover user characteristic setting */ 2383caa1f0b1SHans Wippel static bool qeth_l2_vnicc_recover_char(struct qeth_card *card, u32 vnicc, 2384caa1f0b1SHans Wippel bool enable) 2385caa1f0b1SHans Wippel { 2386caa1f0b1SHans Wippel u32 cmd = enable ? IPA_VNICC_ENABLE : IPA_VNICC_DISABLE; 2387caa1f0b1SHans Wippel 2388caa1f0b1SHans Wippel if (card->options.vnicc.sup_chars & vnicc && 2389caa1f0b1SHans Wippel card->options.vnicc.set_char_sup & vnicc && 2390caa1f0b1SHans Wippel !qeth_l2_vnicc_set_char(card, vnicc, cmd)) 2391caa1f0b1SHans Wippel return false; 2392caa1f0b1SHans Wippel card->options.vnicc.wanted_chars &= ~vnicc; 2393caa1f0b1SHans Wippel card->options.vnicc.wanted_chars |= QETH_VNICC_DEFAULT & vnicc; 2394caa1f0b1SHans Wippel return true; 2395caa1f0b1SHans Wippel } 2396caa1f0b1SHans Wippel 2397a45b3fafSHans Wippel /* (re-)initialize VNICC */ 2398a45b3fafSHans Wippel static void qeth_l2_vnicc_init(struct qeth_card *card) 2399a45b3fafSHans Wippel { 2400349d13d5SHans Wippel u32 *timeout = &card->options.vnicc.learning_timeout; 2401caa1f0b1SHans Wippel unsigned int chars_len, i; 2402caa1f0b1SHans Wippel unsigned long chars_tmp; 2403caa1f0b1SHans Wippel u32 sup_cmds, vnicc; 2404caa1f0b1SHans Wippel bool enable, error; 2405caa1f0b1SHans Wippel 2406a45b3fafSHans Wippel QETH_CARD_TEXT(card, 2, "vniccini"); 2407caa1f0b1SHans Wippel /* reset rx_bcast */ 2408caa1f0b1SHans Wippel card->options.vnicc.rx_bcast_enabled = 0; 2409a45b3fafSHans Wippel /* initial query and storage of VNIC characteristics */ 2410a45b3fafSHans Wippel if (qeth_l2_vnicc_query_chars(card)) { 2411349d13d5SHans Wippel if (card->options.vnicc.wanted_chars != QETH_VNICC_DEFAULT || 2412349d13d5SHans Wippel *timeout != QETH_VNICC_DEFAULT_TIMEOUT) 2413caa1f0b1SHans Wippel dev_err(&card->gdev->dev, "Configuring the VNIC characteristics failed\n"); 2414caa1f0b1SHans Wippel /* fail quietly if user didn't change the default config */ 2415a45b3fafSHans Wippel card->options.vnicc.sup_chars = 0; 2416a45b3fafSHans Wippel card->options.vnicc.cur_chars = 0; 2417caa1f0b1SHans Wippel card->options.vnicc.wanted_chars = QETH_VNICC_DEFAULT; 2418caa1f0b1SHans Wippel return; 2419a45b3fafSHans Wippel } 2420caa1f0b1SHans Wippel /* get supported commands for each supported characteristic */ 2421caa1f0b1SHans Wippel chars_tmp = card->options.vnicc.sup_chars; 2422caa1f0b1SHans Wippel chars_len = sizeof(card->options.vnicc.sup_chars) * BITS_PER_BYTE; 2423caa1f0b1SHans Wippel for_each_set_bit(i, &chars_tmp, chars_len) { 2424caa1f0b1SHans Wippel vnicc = BIT(i); 2425caa1f0b1SHans Wippel qeth_l2_vnicc_query_cmds(card, vnicc, &sup_cmds); 2426349d13d5SHans Wippel if (!(sup_cmds & IPA_VNICC_SET_TIMEOUT) || 2427349d13d5SHans Wippel !(sup_cmds & IPA_VNICC_GET_TIMEOUT)) 2428349d13d5SHans Wippel card->options.vnicc.getset_timeout_sup &= ~vnicc; 2429caa1f0b1SHans Wippel if (!(sup_cmds & IPA_VNICC_ENABLE) || 2430caa1f0b1SHans Wippel !(sup_cmds & IPA_VNICC_DISABLE)) 2431caa1f0b1SHans Wippel card->options.vnicc.set_char_sup &= ~vnicc; 2432caa1f0b1SHans Wippel } 2433caa1f0b1SHans Wippel /* enforce assumed default values and recover settings, if changed */ 2434349d13d5SHans Wippel error = qeth_l2_vnicc_recover_timeout(card, QETH_VNICC_LEARNING, 2435349d13d5SHans Wippel timeout); 2436caa1f0b1SHans Wippel chars_tmp = card->options.vnicc.wanted_chars ^ QETH_VNICC_DEFAULT; 2437caa1f0b1SHans Wippel chars_tmp |= QETH_VNICC_BRIDGE_INVISIBLE; 2438caa1f0b1SHans Wippel chars_len = sizeof(card->options.vnicc.wanted_chars) * BITS_PER_BYTE; 2439caa1f0b1SHans Wippel for_each_set_bit(i, &chars_tmp, chars_len) { 2440caa1f0b1SHans Wippel vnicc = BIT(i); 2441caa1f0b1SHans Wippel enable = card->options.vnicc.wanted_chars & vnicc; 2442caa1f0b1SHans Wippel error |= qeth_l2_vnicc_recover_char(card, vnicc, enable); 2443caa1f0b1SHans Wippel } 2444caa1f0b1SHans Wippel if (error) 2445caa1f0b1SHans Wippel dev_err(&card->gdev->dev, "Configuring the VNIC characteristics failed\n"); 2446caa1f0b1SHans Wippel } 2447caa1f0b1SHans Wippel 2448caa1f0b1SHans Wippel /* configure default values of VNIC characteristics */ 2449caa1f0b1SHans Wippel static void qeth_l2_vnicc_set_defaults(struct qeth_card *card) 2450caa1f0b1SHans Wippel { 2451caa1f0b1SHans Wippel /* characteristics values */ 2452caa1f0b1SHans Wippel card->options.vnicc.sup_chars = QETH_VNICC_ALL; 2453caa1f0b1SHans Wippel card->options.vnicc.cur_chars = QETH_VNICC_DEFAULT; 2454349d13d5SHans Wippel card->options.vnicc.learning_timeout = QETH_VNICC_DEFAULT_TIMEOUT; 2455caa1f0b1SHans Wippel /* supported commands */ 2456caa1f0b1SHans Wippel card->options.vnicc.set_char_sup = QETH_VNICC_ALL; 2457349d13d5SHans Wippel card->options.vnicc.getset_timeout_sup = QETH_VNICC_LEARNING; 2458caa1f0b1SHans Wippel /* settings wanted by users */ 2459caa1f0b1SHans Wippel card->options.vnicc.wanted_chars = QETH_VNICC_DEFAULT; 2460a45b3fafSHans Wippel } 2461a45b3fafSHans Wippel 24624a71df50SFrank Blaschka module_init(qeth_l2_init); 24634a71df50SFrank Blaschka module_exit(qeth_l2_exit); 24644a71df50SFrank Blaschka MODULE_AUTHOR("Frank Blaschka <frank.blaschka@de.ibm.com>"); 24654a71df50SFrank Blaschka MODULE_DESCRIPTION("qeth layer 2 discipline"); 24664a71df50SFrank Blaschka MODULE_LICENSE("GPL"); 2467