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 27c044dc21SEugene Crosser static void qeth_bridgeport_query_support(struct qeth_card *card); 28c044dc21SEugene Crosser static void qeth_bridge_state_change(struct qeth_card *card, 29c044dc21SEugene Crosser struct qeth_ipa_cmd *cmd); 30c044dc21SEugene Crosser static void qeth_bridge_host_event(struct qeth_card *card, 31c044dc21SEugene Crosser struct qeth_ipa_cmd *cmd); 32caa1f0b1SHans Wippel static void qeth_l2_vnicc_set_defaults(struct qeth_card *card); 33a45b3fafSHans Wippel static void qeth_l2_vnicc_init(struct qeth_card *card); 34349d13d5SHans Wippel static bool qeth_l2_vnicc_recover_timeout(struct qeth_card *card, u32 vnicc, 35349d13d5SHans Wippel u32 *timeout); 364a71df50SFrank Blaschka 37742d4d40SJulian Wiedmann static int qeth_l2_setdelmac_makerc(struct qeth_card *card, u16 retcode) 384a71df50SFrank Blaschka { 39efbbc1d5SEugene Crosser int rc; 404a71df50SFrank Blaschka 41efbbc1d5SEugene Crosser if (retcode) 421aec42bcSThomas Richter QETH_CARD_TEXT_(card, 2, "err%04x", retcode); 43efbbc1d5SEugene Crosser switch (retcode) { 44efbbc1d5SEugene Crosser case IPA_RC_SUCCESS: 45efbbc1d5SEugene Crosser rc = 0; 46efbbc1d5SEugene Crosser break; 47efbbc1d5SEugene Crosser case IPA_RC_L2_UNSUPPORTED_CMD: 48ffb95251SEugene Crosser rc = -EOPNOTSUPP; 49efbbc1d5SEugene Crosser break; 50efbbc1d5SEugene Crosser case IPA_RC_L2_ADDR_TABLE_FULL: 51efbbc1d5SEugene Crosser rc = -ENOSPC; 52efbbc1d5SEugene Crosser break; 53efbbc1d5SEugene Crosser case IPA_RC_L2_DUP_MAC: 54efbbc1d5SEugene Crosser case IPA_RC_L2_DUP_LAYER3_MAC: 55efbbc1d5SEugene Crosser rc = -EEXIST; 56efbbc1d5SEugene Crosser break; 57efbbc1d5SEugene Crosser case IPA_RC_L2_MAC_NOT_AUTH_BY_HYP: 58efbbc1d5SEugene Crosser case IPA_RC_L2_MAC_NOT_AUTH_BY_ADP: 59efbbc1d5SEugene Crosser rc = -EPERM; 60efbbc1d5SEugene Crosser break; 61efbbc1d5SEugene Crosser case IPA_RC_L2_MAC_NOT_FOUND: 62efbbc1d5SEugene Crosser rc = -ENOENT; 63efbbc1d5SEugene Crosser break; 64efbbc1d5SEugene Crosser default: 65efbbc1d5SEugene Crosser rc = -EIO; 66efbbc1d5SEugene Crosser break; 674a71df50SFrank Blaschka } 68efbbc1d5SEugene Crosser return rc; 694a71df50SFrank Blaschka } 704a71df50SFrank Blaschka 71742d4d40SJulian Wiedmann static int qeth_l2_send_setdelmac_cb(struct qeth_card *card, 72742d4d40SJulian Wiedmann struct qeth_reply *reply, 73742d4d40SJulian Wiedmann unsigned long data) 74742d4d40SJulian Wiedmann { 75742d4d40SJulian Wiedmann struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *) data; 76742d4d40SJulian Wiedmann 77742d4d40SJulian Wiedmann return qeth_l2_setdelmac_makerc(card, cmd->hdr.return_code); 78742d4d40SJulian Wiedmann } 79742d4d40SJulian Wiedmann 80ac988d78SJulian Wiedmann static int qeth_l2_send_setdelmac(struct qeth_card *card, __u8 *mac, 81ac988d78SJulian Wiedmann enum qeth_ipa_cmds ipacmd) 82ac988d78SJulian Wiedmann { 83ac988d78SJulian Wiedmann struct qeth_ipa_cmd *cmd; 84ac988d78SJulian Wiedmann struct qeth_cmd_buffer *iob; 85ac988d78SJulian Wiedmann 86ac988d78SJulian Wiedmann QETH_CARD_TEXT(card, 2, "L2sdmac"); 87a59d121dSJulian Wiedmann iob = qeth_ipa_alloc_cmd(card, ipacmd, QETH_PROT_IPV4, 88a59d121dSJulian Wiedmann IPA_DATA_SIZEOF(setdelmac)); 89ac988d78SJulian Wiedmann if (!iob) 90ac988d78SJulian Wiedmann return -ENOMEM; 91ff5caa7aSJulian Wiedmann cmd = __ipa_cmd(iob); 9299f0b85dSJulian Wiedmann cmd->data.setdelmac.mac_length = ETH_ALEN; 9399f0b85dSJulian Wiedmann ether_addr_copy(cmd->data.setdelmac.mac, mac); 94742d4d40SJulian Wiedmann return qeth_send_ipa_cmd(card, iob, qeth_l2_send_setdelmac_cb, NULL); 95ac988d78SJulian Wiedmann } 96ac988d78SJulian Wiedmann 97ac988d78SJulian Wiedmann static int qeth_l2_send_setmac(struct qeth_card *card, __u8 *mac) 98ac988d78SJulian Wiedmann { 99ac988d78SJulian Wiedmann int rc; 100ac988d78SJulian Wiedmann 101ac988d78SJulian Wiedmann QETH_CARD_TEXT(card, 2, "L2Setmac"); 102ac988d78SJulian Wiedmann rc = qeth_l2_send_setdelmac(card, mac, IPA_CMD_SETVMAC); 103ac988d78SJulian Wiedmann if (rc == 0) { 104ac988d78SJulian Wiedmann dev_info(&card->gdev->dev, 105654e3d48SJulian Wiedmann "MAC address %pM successfully registered\n", mac); 106ac988d78SJulian Wiedmann } else { 107ac988d78SJulian Wiedmann switch (rc) { 108ac988d78SJulian Wiedmann case -EEXIST: 109ac988d78SJulian Wiedmann dev_warn(&card->gdev->dev, 110ac988d78SJulian Wiedmann "MAC address %pM already exists\n", mac); 111ac988d78SJulian Wiedmann break; 112ac988d78SJulian Wiedmann case -EPERM: 113ac988d78SJulian Wiedmann dev_warn(&card->gdev->dev, 114ac988d78SJulian Wiedmann "MAC address %pM is not authorized\n", mac); 115ac988d78SJulian Wiedmann break; 116ac988d78SJulian Wiedmann } 117ac988d78SJulian Wiedmann } 118ac988d78SJulian Wiedmann return rc; 119ac988d78SJulian Wiedmann } 120ac988d78SJulian Wiedmann 1218174aa8aSJulian Wiedmann static int qeth_l2_write_mac(struct qeth_card *card, u8 *mac) 1224a71df50SFrank Blaschka { 1239d0a58fbSVasily Gorbik enum qeth_ipa_cmds cmd = is_multicast_ether_addr(mac) ? 1248174aa8aSJulian Wiedmann IPA_CMD_SETGMAC : IPA_CMD_SETVMAC; 125efbbc1d5SEugene Crosser int rc; 126efbbc1d5SEugene Crosser 1278174aa8aSJulian Wiedmann QETH_CARD_TEXT(card, 2, "L2Wmac"); 1288174aa8aSJulian Wiedmann rc = qeth_l2_send_setdelmac(card, mac, cmd); 129efbbc1d5SEugene Crosser if (rc == -EEXIST) 130e19e5be8SJulian Wiedmann QETH_DBF_MESSAGE(2, "MAC already registered on device %x\n", 131e19e5be8SJulian Wiedmann CARD_DEVID(card)); 132efbbc1d5SEugene Crosser else if (rc) 133e19e5be8SJulian Wiedmann QETH_DBF_MESSAGE(2, "Failed to register MAC on device %x: %d\n", 134e19e5be8SJulian Wiedmann CARD_DEVID(card), rc); 135efbbc1d5SEugene Crosser return rc; 1364a71df50SFrank Blaschka } 1374a71df50SFrank Blaschka 1388174aa8aSJulian Wiedmann static int qeth_l2_remove_mac(struct qeth_card *card, u8 *mac) 1394a71df50SFrank Blaschka { 1409d0a58fbSVasily Gorbik enum qeth_ipa_cmds cmd = is_multicast_ether_addr(mac) ? 1418174aa8aSJulian Wiedmann IPA_CMD_DELGMAC : IPA_CMD_DELVMAC; 142efbbc1d5SEugene Crosser int rc; 143efbbc1d5SEugene Crosser 1448174aa8aSJulian Wiedmann QETH_CARD_TEXT(card, 2, "L2Rmac"); 1458174aa8aSJulian Wiedmann rc = qeth_l2_send_setdelmac(card, mac, cmd); 146efbbc1d5SEugene Crosser if (rc) 147e19e5be8SJulian Wiedmann QETH_DBF_MESSAGE(2, "Failed to delete MAC on device %u: %d\n", 148e19e5be8SJulian Wiedmann CARD_DEVID(card), rc); 149efbbc1d5SEugene Crosser return rc; 1504a71df50SFrank Blaschka } 1514a71df50SFrank Blaschka 152d0c74825SJulian Wiedmann static void qeth_l2_drain_rx_mode_cache(struct qeth_card *card) 1534a71df50SFrank Blaschka { 154fe5c8028SLakhvich Dmitriy struct qeth_mac *mac; 155fe5c8028SLakhvich Dmitriy struct hlist_node *tmp; 156fe5c8028SLakhvich Dmitriy int i; 1574a71df50SFrank Blaschka 158fe5c8028SLakhvich Dmitriy hash_for_each_safe(card->mac_htable, i, tmp, mac, hnode) { 159fe5c8028SLakhvich Dmitriy hash_del(&mac->hnode); 160fe5c8028SLakhvich Dmitriy kfree(mac); 1614a71df50SFrank Blaschka } 1624a71df50SFrank Blaschka } 1634a71df50SFrank Blaschka 164b0abc4f5SJulian Wiedmann static void qeth_l2_fill_header(struct qeth_qdio_out_q *queue, 165b0abc4f5SJulian Wiedmann struct qeth_hdr *hdr, struct sk_buff *skb, 166eca1d5c2SJulian Wiedmann int ipv, unsigned int data_len) 1674a71df50SFrank Blaschka { 168eca1d5c2SJulian Wiedmann int cast_type = qeth_get_ether_cast_type(skb); 1690aef8392SJulian Wiedmann struct vlan_ethhdr *veth = vlan_eth_hdr(skb); 1704a71df50SFrank Blaschka 171ae79fe03SJulian Wiedmann hdr->hdr.l2.pkt_length = data_len; 1724a71df50SFrank Blaschka 1730aef8392SJulian Wiedmann if (skb_is_gso(skb)) { 1740aef8392SJulian Wiedmann hdr->hdr.l2.id = QETH_HEADER_TYPE_L2_TSO; 1750aef8392SJulian Wiedmann } else { 1760aef8392SJulian Wiedmann hdr->hdr.l2.id = QETH_HEADER_TYPE_LAYER2; 177eeac0e20SJulian Wiedmann if (skb->ip_summed == CHECKSUM_PARTIAL) 178fc69660bSJulian Wiedmann qeth_tx_csum(skb, &hdr->hdr.l2.flags[1], ipv); 1790aef8392SJulian Wiedmann } 180fc69660bSJulian Wiedmann 1814a71df50SFrank Blaschka /* set byte byte 3 to casting flags */ 1824a71df50SFrank Blaschka if (cast_type == RTN_MULTICAST) 1834a71df50SFrank Blaschka hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_MULTICAST; 1844a71df50SFrank Blaschka else if (cast_type == RTN_BROADCAST) 1854a71df50SFrank Blaschka hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_BROADCAST; 1864a71df50SFrank Blaschka else 187ce73e10eSKlaus-Dieter Wacker hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_UNICAST; 1884a71df50SFrank Blaschka 1894a71df50SFrank Blaschka /* VSWITCH relies on the VLAN 1904a71df50SFrank Blaschka * information to be present in 1914a71df50SFrank Blaschka * the QDIO header */ 1924a71df50SFrank Blaschka if (veth->h_vlan_proto == __constant_htons(ETH_P_8021Q)) { 1934a71df50SFrank Blaschka hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_VLAN; 1944a71df50SFrank Blaschka hdr->hdr.l2.vlan_id = ntohs(veth->h_vlan_TCI); 1954a71df50SFrank Blaschka } 1964a71df50SFrank Blaschka } 1974a71df50SFrank Blaschka 198742d4d40SJulian Wiedmann static int qeth_l2_setdelvlan_makerc(struct qeth_card *card, u16 retcode) 1994a71df50SFrank Blaschka { 2002aa48671SJulian Wiedmann if (retcode) 2012aa48671SJulian Wiedmann QETH_CARD_TEXT_(card, 2, "err%04x", retcode); 2022aa48671SJulian Wiedmann 2032aa48671SJulian Wiedmann switch (retcode) { 2042aa48671SJulian Wiedmann case IPA_RC_SUCCESS: 2052aa48671SJulian Wiedmann return 0; 2062aa48671SJulian Wiedmann case IPA_RC_L2_INVALID_VLAN_ID: 2072aa48671SJulian Wiedmann return -EINVAL; 2082aa48671SJulian Wiedmann case IPA_RC_L2_DUP_VLAN_ID: 2092aa48671SJulian Wiedmann return -EEXIST; 2102aa48671SJulian Wiedmann case IPA_RC_L2_VLAN_ID_NOT_FOUND: 2112aa48671SJulian Wiedmann return -ENOENT; 2122aa48671SJulian Wiedmann case IPA_RC_L2_VLAN_ID_NOT_ALLOWED: 2132aa48671SJulian Wiedmann return -EPERM; 2142aa48671SJulian Wiedmann default: 2152aa48671SJulian Wiedmann return -EIO; 2162aa48671SJulian Wiedmann } 2172aa48671SJulian Wiedmann } 2182aa48671SJulian Wiedmann 2192aa48671SJulian Wiedmann static int qeth_l2_send_setdelvlan_cb(struct qeth_card *card, 2202aa48671SJulian Wiedmann struct qeth_reply *reply, 2212aa48671SJulian Wiedmann unsigned long data) 2222aa48671SJulian Wiedmann { 2232aa48671SJulian Wiedmann struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *) data; 2244a71df50SFrank Blaschka 225847a50fdSCarsten Otte QETH_CARD_TEXT(card, 2, "L2sdvcb"); 2264a71df50SFrank Blaschka if (cmd->hdr.return_code) { 227e19e5be8SJulian Wiedmann QETH_DBF_MESSAGE(2, "Error in processing VLAN %u on device %x: %#x.\n", 2282aa48671SJulian Wiedmann cmd->data.setdelvlan.vlan_id, 229e19e5be8SJulian Wiedmann CARD_DEVID(card), cmd->hdr.return_code); 230847a50fdSCarsten Otte QETH_CARD_TEXT_(card, 2, "L2VL%4x", cmd->hdr.command); 2314a71df50SFrank Blaschka } 232742d4d40SJulian Wiedmann return qeth_l2_setdelvlan_makerc(card, cmd->hdr.return_code); 2334a71df50SFrank Blaschka } 2344a71df50SFrank Blaschka 2354a71df50SFrank Blaschka static int qeth_l2_send_setdelvlan(struct qeth_card *card, __u16 i, 2364a71df50SFrank Blaschka enum qeth_ipa_cmds ipacmd) 2374a71df50SFrank Blaschka { 2384a71df50SFrank Blaschka struct qeth_ipa_cmd *cmd; 2394a71df50SFrank Blaschka struct qeth_cmd_buffer *iob; 2404a71df50SFrank Blaschka 241847a50fdSCarsten Otte QETH_CARD_TEXT_(card, 4, "L2sdv%x", ipacmd); 242a59d121dSJulian Wiedmann iob = qeth_ipa_alloc_cmd(card, ipacmd, QETH_PROT_IPV4, 243a59d121dSJulian Wiedmann IPA_DATA_SIZEOF(setdelvlan)); 2441aec42bcSThomas Richter if (!iob) 2451aec42bcSThomas Richter return -ENOMEM; 246ff5caa7aSJulian Wiedmann cmd = __ipa_cmd(iob); 2474a71df50SFrank Blaschka cmd->data.setdelvlan.vlan_id = i; 248742d4d40SJulian Wiedmann return qeth_send_ipa_cmd(card, iob, qeth_l2_send_setdelvlan_cb, NULL); 2494a71df50SFrank Blaschka } 2504a71df50SFrank Blaschka 25180d5c368SPatrick McHardy static int qeth_l2_vlan_rx_add_vid(struct net_device *dev, 25280d5c368SPatrick McHardy __be16 proto, u16 vid) 2534a71df50SFrank Blaschka { 254509e2562SHeiko Carstens struct qeth_card *card = dev->ml_priv; 2554a71df50SFrank Blaschka 256847a50fdSCarsten Otte QETH_CARD_TEXT_(card, 4, "aid:%d", vid); 25710651db7SUrsula Braun if (!vid) 2588e586137SJiri Pirko return 0; 259e6e771b3SJulian Wiedmann 2605fc692a7SJulian Wiedmann return qeth_l2_send_setdelvlan(card, vid, IPA_CMD_SETVLAN); 2614a71df50SFrank Blaschka } 2624a71df50SFrank Blaschka 26380d5c368SPatrick McHardy static int qeth_l2_vlan_rx_kill_vid(struct net_device *dev, 26480d5c368SPatrick McHardy __be16 proto, u16 vid) 2654a71df50SFrank Blaschka { 266509e2562SHeiko Carstens struct qeth_card *card = dev->ml_priv; 2674a71df50SFrank Blaschka 268847a50fdSCarsten Otte QETH_CARD_TEXT_(card, 4, "kid:%d", vid); 2695fc692a7SJulian Wiedmann if (!vid) 2705fc692a7SJulian Wiedmann return 0; 271e6e771b3SJulian Wiedmann 2725fc692a7SJulian Wiedmann return qeth_l2_send_setdelvlan(card, vid, IPA_CMD_DELVLAN); 2734a71df50SFrank Blaschka } 2744a71df50SFrank Blaschka 275d4560150SJulian Wiedmann static void qeth_l2_stop_card(struct qeth_card *card) 2764a71df50SFrank Blaschka { 27757a688aaSJulian Wiedmann QETH_CARD_TEXT(card, 2, "stopcard"); 2784a71df50SFrank Blaschka 2794a71df50SFrank Blaschka qeth_set_allowed_threads(card, 0, 1); 2800f7aedbdSJulian Wiedmann 281d0c74825SJulian Wiedmann cancel_work_sync(&card->rx_mode_work); 282d0c74825SJulian Wiedmann qeth_l2_drain_rx_mode_cache(card); 283d0c74825SJulian Wiedmann 2844a71df50SFrank Blaschka if (card->state == CARD_STATE_SOFTSETUP) { 2854a71df50SFrank Blaschka qeth_clear_ipacmd_list(card); 2864a71df50SFrank Blaschka card->state = CARD_STATE_HARDSETUP; 2874a71df50SFrank Blaschka } 2884a71df50SFrank Blaschka if (card->state == CARD_STATE_HARDSETUP) { 28941c47da3SJulian Wiedmann qeth_drain_output_queues(card); 2904a71df50SFrank Blaschka card->state = CARD_STATE_DOWN; 2914a71df50SFrank Blaschka } 292ad160872SJulian Wiedmann 2938b5026bcSJulian Wiedmann qeth_qdio_clear_card(card, 0); 294aa3ad392SJulian Wiedmann qeth_clear_working_pool_list(card); 295c0a2e4d1SJulian Wiedmann flush_workqueue(card->event_wq); 2967bd2275cSJulian Wiedmann card->info.mac_bits &= ~QETH_LAYER2_MAC_REGISTERED; 2970f399305SJulian Wiedmann card->info.promisc_mode = 0; 2984a71df50SFrank Blaschka } 2994a71df50SFrank Blaschka 3004a71df50SFrank Blaschka static int qeth_l2_request_initial_mac(struct qeth_card *card) 3014a71df50SFrank Blaschka { 3024a71df50SFrank Blaschka int rc = 0; 3034a71df50SFrank Blaschka 30457a688aaSJulian Wiedmann QETH_CARD_TEXT(card, 2, "l2reqmac"); 3054a71df50SFrank Blaschka 306ec61bd2fSJulian Wiedmann if (MACHINE_IS_VM) { 307ec61bd2fSJulian Wiedmann rc = qeth_vm_request_mac(card); 308ec61bd2fSJulian Wiedmann if (!rc) 309ec61bd2fSJulian Wiedmann goto out; 310e19e5be8SJulian Wiedmann QETH_DBF_MESSAGE(2, "z/VM MAC Service failed on device %x: %#x\n", 311e19e5be8SJulian Wiedmann CARD_DEVID(card), rc); 31257a688aaSJulian Wiedmann QETH_CARD_TEXT_(card, 2, "err%04x", rc); 313ec61bd2fSJulian Wiedmann /* fall back to alternative mechanism: */ 314ec61bd2fSJulian Wiedmann } 315ec61bd2fSJulian Wiedmann 316b144b99fSJulian Wiedmann if (!IS_OSN(card)) { 3174a71df50SFrank Blaschka rc = qeth_setadpparms_change_macaddr(card); 3184b7ae122SJulian Wiedmann if (!rc) 31921b1702aSJulian Wiedmann goto out; 320e19e5be8SJulian Wiedmann QETH_DBF_MESSAGE(2, "READ_MAC Assist failed on device %x: %#x\n", 321e19e5be8SJulian Wiedmann CARD_DEVID(card), rc); 32257a688aaSJulian Wiedmann QETH_CARD_TEXT_(card, 2, "1err%04x", rc); 32321b1702aSJulian Wiedmann /* fall back once more: */ 3244a71df50SFrank Blaschka } 32521b1702aSJulian Wiedmann 32621b1702aSJulian Wiedmann /* some devices don't support a custom MAC address: */ 327379ac99eSJulian Wiedmann if (IS_OSM(card) || IS_OSX(card)) 32821b1702aSJulian Wiedmann return (rc) ? rc : -EADDRNOTAVAIL; 32921b1702aSJulian Wiedmann eth_hw_addr_random(card->dev); 33021b1702aSJulian Wiedmann 331ec61bd2fSJulian Wiedmann out: 33257a688aaSJulian Wiedmann QETH_CARD_HEX(card, 2, card->dev->dev_addr, card->dev->addr_len); 3334a71df50SFrank Blaschka return 0; 3344a71df50SFrank Blaschka } 3354a71df50SFrank Blaschka 336654e3d48SJulian Wiedmann static void qeth_l2_register_dev_addr(struct qeth_card *card) 337654e3d48SJulian Wiedmann { 338654e3d48SJulian Wiedmann if (!is_valid_ether_addr(card->dev->dev_addr)) 339654e3d48SJulian Wiedmann qeth_l2_request_initial_mac(card); 340654e3d48SJulian Wiedmann 341654e3d48SJulian Wiedmann if (!IS_OSN(card) && !qeth_l2_send_setmac(card, card->dev->dev_addr)) 342654e3d48SJulian Wiedmann card->info.mac_bits |= QETH_LAYER2_MAC_REGISTERED; 343654e3d48SJulian Wiedmann } 344654e3d48SJulian Wiedmann 345e22355eaSJulian Wiedmann static int qeth_l2_validate_addr(struct net_device *dev) 346e22355eaSJulian Wiedmann { 347e22355eaSJulian Wiedmann struct qeth_card *card = dev->ml_priv; 348e22355eaSJulian Wiedmann 3498024cc9eSJulian Wiedmann if (card->info.mac_bits & QETH_LAYER2_MAC_REGISTERED) 350e22355eaSJulian Wiedmann return eth_validate_addr(dev); 351e22355eaSJulian Wiedmann 352e22355eaSJulian Wiedmann QETH_CARD_TEXT(card, 4, "nomacadr"); 353e22355eaSJulian Wiedmann return -EPERM; 354e22355eaSJulian Wiedmann } 355e22355eaSJulian Wiedmann 3564a71df50SFrank Blaschka static int qeth_l2_set_mac_address(struct net_device *dev, void *p) 3574a71df50SFrank Blaschka { 3584a71df50SFrank Blaschka struct sockaddr *addr = p; 359509e2562SHeiko Carstens struct qeth_card *card = dev->ml_priv; 360bcacfcbcSJulian Wiedmann u8 old_addr[ETH_ALEN]; 3614a71df50SFrank Blaschka int rc = 0; 3624a71df50SFrank Blaschka 363847a50fdSCarsten Otte QETH_CARD_TEXT(card, 3, "setmac"); 3644a71df50SFrank Blaschka 3658024cc9eSJulian Wiedmann if (IS_OSM(card) || IS_OSX(card)) { 366847a50fdSCarsten Otte QETH_CARD_TEXT(card, 3, "setmcTYP"); 3674a71df50SFrank Blaschka return -EOPNOTSUPP; 3684a71df50SFrank Blaschka } 36999f0b85dSJulian Wiedmann QETH_CARD_HEX(card, 3, addr->sa_data, ETH_ALEN); 370bcacfcbcSJulian Wiedmann if (!is_valid_ether_addr(addr->sa_data)) 371bcacfcbcSJulian Wiedmann return -EADDRNOTAVAIL; 372bcacfcbcSJulian Wiedmann 373bcacfcbcSJulian Wiedmann /* don't register the same address twice */ 374bcacfcbcSJulian Wiedmann if (ether_addr_equal_64bits(dev->dev_addr, addr->sa_data) && 375bcacfcbcSJulian Wiedmann (card->info.mac_bits & QETH_LAYER2_MAC_REGISTERED)) 376e6e771b3SJulian Wiedmann return 0; 377bcacfcbcSJulian Wiedmann 378bcacfcbcSJulian Wiedmann /* add the new address, switch over, drop the old */ 3794a71df50SFrank Blaschka rc = qeth_l2_send_setmac(card, addr->sa_data); 380bcacfcbcSJulian Wiedmann if (rc) 381e6e771b3SJulian Wiedmann return rc; 382bcacfcbcSJulian Wiedmann ether_addr_copy(old_addr, dev->dev_addr); 383bcacfcbcSJulian Wiedmann ether_addr_copy(dev->dev_addr, addr->sa_data); 384bcacfcbcSJulian Wiedmann 385bcacfcbcSJulian Wiedmann if (card->info.mac_bits & QETH_LAYER2_MAC_REGISTERED) 386bcacfcbcSJulian Wiedmann qeth_l2_remove_mac(card, old_addr); 387bcacfcbcSJulian Wiedmann card->info.mac_bits |= QETH_LAYER2_MAC_REGISTERED; 388e6e771b3SJulian Wiedmann return 0; 3894a71df50SFrank Blaschka } 3904a71df50SFrank Blaschka 39159b757a9SJulian Wiedmann static void qeth_l2_promisc_to_bridge(struct qeth_card *card, bool enable) 3920db587b0SEugene Crosser { 3930db587b0SEugene Crosser int role; 3940db587b0SEugene Crosser int rc; 3950db587b0SEugene Crosser 3960db587b0SEugene Crosser QETH_CARD_TEXT(card, 3, "pmisc2br"); 3970db587b0SEugene Crosser 39859b757a9SJulian Wiedmann if (enable) { 3990db587b0SEugene Crosser if (card->options.sbp.reflect_promisc_primary) 4000db587b0SEugene Crosser role = QETH_SBP_ROLE_PRIMARY; 4010db587b0SEugene Crosser else 4020db587b0SEugene Crosser role = QETH_SBP_ROLE_SECONDARY; 4030db587b0SEugene Crosser } else 4040db587b0SEugene Crosser role = QETH_SBP_ROLE_NONE; 4050db587b0SEugene Crosser 4060db587b0SEugene Crosser rc = qeth_bridgeport_setrole(card, role); 40759b757a9SJulian Wiedmann QETH_CARD_TEXT_(card, 2, "bpm%c%04x", enable ? '+' : '-', rc); 4080db587b0SEugene Crosser if (!rc) { 4090db587b0SEugene Crosser card->options.sbp.role = role; 41059b757a9SJulian Wiedmann card->info.promisc_mode = enable; 41159b757a9SJulian Wiedmann } 4120db587b0SEugene Crosser } 413fe5c8028SLakhvich Dmitriy 41459b757a9SJulian Wiedmann static void qeth_l2_set_promisc_mode(struct qeth_card *card) 41559b757a9SJulian Wiedmann { 41659b757a9SJulian Wiedmann bool enable = card->dev->flags & IFF_PROMISC; 41759b757a9SJulian Wiedmann 41859b757a9SJulian Wiedmann if (card->info.promisc_mode == enable) 41959b757a9SJulian Wiedmann return; 42059b757a9SJulian Wiedmann 421c8183f54SJulian Wiedmann if (qeth_adp_supported(card, IPA_SETADP_SET_PROMISC_MODE)) { 42259b757a9SJulian Wiedmann qeth_setadp_promisc_mode(card, enable); 423c8183f54SJulian Wiedmann } else { 424c8183f54SJulian Wiedmann mutex_lock(&card->sbp_lock); 425c8183f54SJulian Wiedmann if (card->options.sbp.reflect_promisc) 42659b757a9SJulian Wiedmann qeth_l2_promisc_to_bridge(card, enable); 427c8183f54SJulian Wiedmann mutex_unlock(&card->sbp_lock); 428c8183f54SJulian Wiedmann } 429fe5c8028SLakhvich Dmitriy } 43059b757a9SJulian Wiedmann 431fe5c8028SLakhvich Dmitriy /* New MAC address is added to the hash table and marked to be written on card 432fe5c8028SLakhvich Dmitriy * only if there is not in the hash table storage already 433fe5c8028SLakhvich Dmitriy * 434fe5c8028SLakhvich Dmitriy */ 4354641b027SJulian Wiedmann static void qeth_l2_add_mac(struct qeth_card *card, struct netdev_hw_addr *ha) 436fe5c8028SLakhvich Dmitriy { 437cef6ff22SJulian Wiedmann u32 mac_hash = get_unaligned((u32 *)(&ha->addr[2])); 438fe5c8028SLakhvich Dmitriy struct qeth_mac *mac; 439fe5c8028SLakhvich Dmitriy 440cef6ff22SJulian Wiedmann hash_for_each_possible(card->mac_htable, mac, hnode, mac_hash) { 44199f0b85dSJulian Wiedmann if (ether_addr_equal_64bits(ha->addr, mac->mac_addr)) { 4425f78e29cSLakhvich Dmitriy mac->disp_flag = QETH_DISP_ADDR_DO_NOTHING; 443fe5c8028SLakhvich Dmitriy return; 444fe5c8028SLakhvich Dmitriy } 4450db587b0SEugene Crosser } 4460db587b0SEugene Crosser 447fe5c8028SLakhvich Dmitriy mac = kzalloc(sizeof(struct qeth_mac), GFP_ATOMIC); 448fe5c8028SLakhvich Dmitriy if (!mac) 449fe5c8028SLakhvich Dmitriy return; 450fe5c8028SLakhvich Dmitriy 45199f0b85dSJulian Wiedmann ether_addr_copy(mac->mac_addr, ha->addr); 4525f78e29cSLakhvich Dmitriy mac->disp_flag = QETH_DISP_ADDR_ADD; 453fe5c8028SLakhvich Dmitriy 454cef6ff22SJulian Wiedmann hash_add(card->mac_htable, &mac->hnode, mac_hash); 455fe5c8028SLakhvich Dmitriy } 456fe5c8028SLakhvich Dmitriy 457d0c74825SJulian Wiedmann static void qeth_l2_rx_mode_work(struct work_struct *work) 4584a71df50SFrank Blaschka { 459d0c74825SJulian Wiedmann struct qeth_card *card = container_of(work, struct qeth_card, 460d0c74825SJulian Wiedmann rx_mode_work); 461d0c74825SJulian Wiedmann struct net_device *dev = card->dev; 462ccffad25SJiri Pirko struct netdev_hw_addr *ha; 463fe5c8028SLakhvich Dmitriy struct qeth_mac *mac; 464fe5c8028SLakhvich Dmitriy struct hlist_node *tmp; 465fe5c8028SLakhvich Dmitriy int i; 466fe5c8028SLakhvich Dmitriy int rc; 4674a71df50SFrank Blaschka 468847a50fdSCarsten Otte QETH_CARD_TEXT(card, 3, "setmulti"); 469fe5c8028SLakhvich Dmitriy 470d0c74825SJulian Wiedmann netif_addr_lock_bh(dev); 47122bedad3SJiri Pirko netdev_for_each_mc_addr(ha, dev) 4724641b027SJulian Wiedmann qeth_l2_add_mac(card, ha); 47332e7bfc4SJiri Pirko netdev_for_each_uc_addr(ha, dev) 4744641b027SJulian Wiedmann qeth_l2_add_mac(card, ha); 475d0c74825SJulian Wiedmann netif_addr_unlock_bh(dev); 476fe5c8028SLakhvich Dmitriy 477fe5c8028SLakhvich Dmitriy hash_for_each_safe(card->mac_htable, i, tmp, mac, hnode) { 47800c163f1SJulian Wiedmann switch (mac->disp_flag) { 47900c163f1SJulian Wiedmann case QETH_DISP_ADDR_DELETE: 4808174aa8aSJulian Wiedmann qeth_l2_remove_mac(card, mac->mac_addr); 481fe5c8028SLakhvich Dmitriy hash_del(&mac->hnode); 482fe5c8028SLakhvich Dmitriy kfree(mac); 48300c163f1SJulian Wiedmann break; 48400c163f1SJulian Wiedmann case QETH_DISP_ADDR_ADD: 4858174aa8aSJulian Wiedmann rc = qeth_l2_write_mac(card, mac->mac_addr); 486fe5c8028SLakhvich Dmitriy if (rc) { 487fe5c8028SLakhvich Dmitriy hash_del(&mac->hnode); 488fe5c8028SLakhvich Dmitriy kfree(mac); 48900c163f1SJulian Wiedmann break; 49000c163f1SJulian Wiedmann } 49100c163f1SJulian Wiedmann /* fall through */ 49200c163f1SJulian Wiedmann default: 49300c163f1SJulian Wiedmann /* for next call to set_rx_mode(): */ 4945f78e29cSLakhvich Dmitriy mac->disp_flag = QETH_DISP_ADDR_DELETE; 49500c163f1SJulian Wiedmann } 496fe5c8028SLakhvich Dmitriy } 4977db2266aSFrank Blaschka 49859b757a9SJulian Wiedmann qeth_l2_set_promisc_mode(card); 4994a71df50SFrank Blaschka } 5004a71df50SFrank Blaschka 5017286384bSJulian Wiedmann static int qeth_l2_xmit_osn(struct qeth_card *card, struct sk_buff *skb, 5027286384bSJulian Wiedmann struct qeth_qdio_out_q *queue) 5037286384bSJulian Wiedmann { 50469d7ce80SJulian Wiedmann struct qeth_hdr *hdr = (struct qeth_hdr *)skb->data; 50569d7ce80SJulian Wiedmann addr_t end = (addr_t)(skb->data + sizeof(*hdr)); 50669d7ce80SJulian Wiedmann addr_t start = (addr_t)skb->data; 50769d7ce80SJulian Wiedmann unsigned int elements = 0; 50869d7ce80SJulian Wiedmann unsigned int hd_len = 0; 50969d7ce80SJulian Wiedmann int rc; 5107286384bSJulian Wiedmann 5117286384bSJulian Wiedmann if (skb->protocol == htons(ETH_P_IPV6)) 5127286384bSJulian Wiedmann return -EPROTONOSUPPORT; 5137286384bSJulian Wiedmann 51469d7ce80SJulian Wiedmann if (qeth_get_elements_for_range(start, end) > 1) { 51569d7ce80SJulian Wiedmann /* Misaligned HW header, move it to its own buffer element. */ 51669d7ce80SJulian Wiedmann hdr = kmem_cache_alloc(qeth_core_header_cache, GFP_ATOMIC); 51769d7ce80SJulian Wiedmann if (!hdr) 51869d7ce80SJulian Wiedmann return -ENOMEM; 51969d7ce80SJulian Wiedmann hd_len = sizeof(*hdr); 52069d7ce80SJulian Wiedmann skb_copy_from_linear_data(skb, (char *)hdr, hd_len); 52169d7ce80SJulian Wiedmann elements++; 52269d7ce80SJulian Wiedmann } 52369d7ce80SJulian Wiedmann 52469d7ce80SJulian Wiedmann elements += qeth_count_elements(skb, hd_len); 5254e26c5feSJulian Wiedmann if (elements > queue->max_elements) { 52669d7ce80SJulian Wiedmann rc = -E2BIG; 52769d7ce80SJulian Wiedmann goto out; 52869d7ce80SJulian Wiedmann } 52969d7ce80SJulian Wiedmann 53069d7ce80SJulian Wiedmann rc = qeth_do_send_packet(card, queue, skb, hdr, hd_len, hd_len, 53169d7ce80SJulian Wiedmann elements); 53269d7ce80SJulian Wiedmann out: 53369d7ce80SJulian Wiedmann if (rc && hd_len) 53469d7ce80SJulian Wiedmann kmem_cache_free(qeth_core_header_cache, hdr); 53569d7ce80SJulian Wiedmann return rc; 5367286384bSJulian Wiedmann } 5377286384bSJulian Wiedmann 538e38db6beSJulian Wiedmann static netdev_tx_t qeth_l2_hard_start_xmit(struct sk_buff *skb, 539e38db6beSJulian Wiedmann struct net_device *dev) 5404a71df50SFrank Blaschka { 541509e2562SHeiko Carstens struct qeth_card *card = dev->ml_priv; 5423a18d754SJulian Wiedmann u16 txq = skb_get_queue_mapping(skb); 543290b8348SStefan Raspl struct qeth_qdio_out_q *queue; 5447286384bSJulian Wiedmann int rc; 5454a71df50SFrank Blaschka 546eeac0e20SJulian Wiedmann if (!skb_is_gso(skb)) 547eeac0e20SJulian Wiedmann qdisc_skb_cb(skb)->pkt_len = skb->len; 5483a18d754SJulian Wiedmann if (IS_IQD(card)) 54954a50941SJulian Wiedmann txq = qeth_iqd_translate_txq(dev, txq); 55073dc2dafSJulian Wiedmann queue = card->qdio.out_qs[txq]; 551b0abc4f5SJulian Wiedmann 5525f89eca5SJulian Wiedmann if (IS_OSN(card)) 5537286384bSJulian Wiedmann rc = qeth_l2_xmit_osn(card, skb, queue); 5545f89eca5SJulian Wiedmann else 55573dc2dafSJulian Wiedmann rc = qeth_xmit(card, skb, queue, qeth_get_ip_version(skb), 55658aa2491SJulian Wiedmann qeth_l2_fill_header); 5574a71df50SFrank Blaschka 558eeac0e20SJulian Wiedmann if (!rc) 5597286384bSJulian Wiedmann return NETDEV_TX_OK; 5604a71df50SFrank Blaschka 561b0abc4f5SJulian Wiedmann QETH_TXQ_STAT_INC(queue, tx_dropped); 562104b4859SJulian Wiedmann kfree_skb(skb); 5634a71df50SFrank Blaschka return NETDEV_TX_OK; 5644a71df50SFrank Blaschka } 5654a71df50SFrank Blaschka 5663a18d754SJulian Wiedmann static u16 qeth_l2_select_queue(struct net_device *dev, struct sk_buff *skb, 5673a18d754SJulian Wiedmann struct net_device *sb_dev) 5683a18d754SJulian Wiedmann { 56973dc2dafSJulian Wiedmann struct qeth_card *card = dev->ml_priv; 57073dc2dafSJulian Wiedmann 57173dc2dafSJulian Wiedmann if (IS_IQD(card)) 57273dc2dafSJulian Wiedmann return qeth_iqd_select_queue(dev, skb, 57358aa2491SJulian Wiedmann qeth_get_ether_cast_type(skb), 5743a18d754SJulian Wiedmann sb_dev); 57573dc2dafSJulian Wiedmann return qeth_get_priority_queue(card, skb); 5763a18d754SJulian Wiedmann } 5773a18d754SJulian Wiedmann 5782d2ebb3eSJulian Wiedmann static const struct device_type qeth_l2_devtype = { 5792d2ebb3eSJulian Wiedmann .name = "qeth_layer2", 5802d2ebb3eSJulian Wiedmann .groups = qeth_l2_attr_groups, 5812d2ebb3eSJulian Wiedmann }; 5822d2ebb3eSJulian Wiedmann 5834a71df50SFrank Blaschka static int qeth_l2_probe_device(struct ccwgroup_device *gdev) 5844a71df50SFrank Blaschka { 5854a71df50SFrank Blaschka struct qeth_card *card = dev_get_drvdata(&gdev->dev); 5869111e788SUrsula Braun int rc; 5874a71df50SFrank Blaschka 58812b409ddSJulian Wiedmann qeth_l2_vnicc_set_defaults(card); 589c8183f54SJulian Wiedmann mutex_init(&card->sbp_lock); 59012b409ddSJulian Wiedmann 5912d2ebb3eSJulian Wiedmann if (gdev->dev.type == &qeth_generic_devtype) { 5929111e788SUrsula Braun rc = qeth_l2_create_device_attributes(&gdev->dev); 5939111e788SUrsula Braun if (rc) 5949111e788SUrsula Braun return rc; 5952d2ebb3eSJulian Wiedmann } 5965fc692a7SJulian Wiedmann 597fe5c8028SLakhvich Dmitriy hash_init(card->mac_htable); 598d0c74825SJulian Wiedmann INIT_WORK(&card->rx_mode_work, qeth_l2_rx_mode_work); 5994a71df50SFrank Blaschka return 0; 6004a71df50SFrank Blaschka } 6014a71df50SFrank Blaschka 6024a71df50SFrank Blaschka static void qeth_l2_remove_device(struct ccwgroup_device *cgdev) 6034a71df50SFrank Blaschka { 6044a71df50SFrank Blaschka struct qeth_card *card = dev_get_drvdata(&cgdev->dev); 6054a71df50SFrank Blaschka 6062d2ebb3eSJulian Wiedmann if (cgdev->dev.type == &qeth_generic_devtype) 607b4d72c08SEugene Crosser qeth_l2_remove_device_attributes(&cgdev->dev); 608f2148565SUrsula Braun qeth_set_allowed_threads(card, 0, 1); 6094a71df50SFrank Blaschka wait_event(card->wait_q, qeth_threads_running(card, 0xffffffff) == 0); 6104a71df50SFrank Blaschka 61170919e23SUrsula Braun if (cgdev->state == CCWGROUP_ONLINE) 61291003f35SJulian Wiedmann qeth_set_offline(card, false); 613c2780c1aSJulian Wiedmann 614c2780c1aSJulian Wiedmann cancel_work_sync(&card->close_dev_work); 61530356d08SJulian Wiedmann if (qeth_netdev_is_registered(card->dev)) 6164a71df50SFrank Blaschka unregister_netdev(card->dev); 6174a71df50SFrank Blaschka } 6184a71df50SFrank Blaschka 619d0c74825SJulian Wiedmann static void qeth_l2_set_rx_mode(struct net_device *dev) 620d0c74825SJulian Wiedmann { 621d0c74825SJulian Wiedmann struct qeth_card *card = dev->ml_priv; 622d0c74825SJulian Wiedmann 623d0c74825SJulian Wiedmann schedule_work(&card->rx_mode_work); 624d0c74825SJulian Wiedmann } 625d0c74825SJulian Wiedmann 6263d58cefdSFrank Blaschka static const struct net_device_ops qeth_l2_netdev_ops = { 627e22355eaSJulian Wiedmann .ndo_open = qeth_open, 628e22355eaSJulian Wiedmann .ndo_stop = qeth_stop, 629b0abc4f5SJulian Wiedmann .ndo_get_stats64 = qeth_get_stats64, 6308403b13cSFrank Blaschka .ndo_start_xmit = qeth_l2_hard_start_xmit, 6316d69b1f1SJulian Wiedmann .ndo_features_check = qeth_features_check, 6323a18d754SJulian Wiedmann .ndo_select_queue = qeth_l2_select_queue, 633e22355eaSJulian Wiedmann .ndo_validate_addr = qeth_l2_validate_addr, 634fe5c8028SLakhvich Dmitriy .ndo_set_rx_mode = qeth_l2_set_rx_mode, 635942d6984SJulian Wiedmann .ndo_do_ioctl = qeth_do_ioctl, 6368403b13cSFrank Blaschka .ndo_set_mac_address = qeth_l2_set_mac_address, 6378403b13cSFrank Blaschka .ndo_vlan_rx_add_vid = qeth_l2_vlan_rx_add_vid, 6388403b13cSFrank Blaschka .ndo_vlan_rx_kill_vid = qeth_l2_vlan_rx_kill_vid, 6398403b13cSFrank Blaschka .ndo_tx_timeout = qeth_tx_timeout, 6408f43fb00SThomas Richter .ndo_fix_features = qeth_fix_features, 6418f43fb00SThomas Richter .ndo_set_features = qeth_set_features 6428403b13cSFrank Blaschka }; 6438403b13cSFrank Blaschka 6448024cc9eSJulian Wiedmann static const struct net_device_ops qeth_osn_netdev_ops = { 6458024cc9eSJulian Wiedmann .ndo_open = qeth_open, 6468024cc9eSJulian Wiedmann .ndo_stop = qeth_stop, 6478024cc9eSJulian Wiedmann .ndo_get_stats64 = qeth_get_stats64, 6488024cc9eSJulian Wiedmann .ndo_start_xmit = qeth_l2_hard_start_xmit, 6498024cc9eSJulian Wiedmann .ndo_validate_addr = eth_validate_addr, 6508024cc9eSJulian Wiedmann .ndo_tx_timeout = qeth_tx_timeout, 6518024cc9eSJulian Wiedmann }; 6528024cc9eSJulian Wiedmann 6539fae5c3bSJulian Wiedmann static int qeth_l2_setup_netdev(struct qeth_card *card, bool carrier_ok) 6544a71df50SFrank Blaschka { 655d3d1b205SJulian Wiedmann int rc; 6564a71df50SFrank Blaschka 6578024cc9eSJulian Wiedmann if (IS_OSN(card)) { 6588024cc9eSJulian Wiedmann card->dev->netdev_ops = &qeth_osn_netdev_ops; 65925e2c341SJulian Wiedmann card->dev->flags |= IFF_NOARP; 6608024cc9eSJulian Wiedmann goto add_napi; 6618024cc9eSJulian Wiedmann } 6628024cc9eSJulian Wiedmann 6635f89eca5SJulian Wiedmann card->dev->needed_headroom = sizeof(struct qeth_hdr); 6648024cc9eSJulian Wiedmann card->dev->netdev_ops = &qeth_l2_netdev_ops; 6658024cc9eSJulian Wiedmann card->dev->priv_flags |= IFF_UNICAST_FLT; 6669400c53fSJulian Wiedmann 6675fc692a7SJulian Wiedmann if (IS_OSM(card)) { 6689400c53fSJulian Wiedmann card->dev->features |= NETIF_F_VLAN_CHALLENGED; 6695fc692a7SJulian Wiedmann } else { 6705fc692a7SJulian Wiedmann if (!IS_VM_NIC(card)) 6715fc692a7SJulian Wiedmann card->dev->hw_features |= NETIF_F_HW_VLAN_CTAG_FILTER; 672f646968fSPatrick McHardy card->dev->features |= NETIF_F_HW_VLAN_CTAG_FILTER; 6735fc692a7SJulian Wiedmann } 6740f342945SJulian Wiedmann 675379ac99eSJulian Wiedmann if (IS_OSD(card) && !IS_VM_NIC(card)) { 6766d69b1f1SJulian Wiedmann card->dev->features |= NETIF_F_SG; 6778f43fb00SThomas Richter /* OSA 3S and earlier has no RX/TX support */ 6789bdc4411SHans Wippel if (qeth_is_supported(card, IPA_OUTBOUND_CHECKSUM)) { 6798f43fb00SThomas Richter card->dev->hw_features |= NETIF_F_IP_CSUM; 6809bdc4411SHans Wippel card->dev->vlan_features |= NETIF_F_IP_CSUM; 6819bdc4411SHans Wippel } 6824d7def2aSThomas Richter } 683571f9dd8SKittipon Meesompop if (qeth_is_supported6(card, IPA_OUTBOUND_CHECKSUM_V6)) { 684571f9dd8SKittipon Meesompop card->dev->hw_features |= NETIF_F_IPV6_CSUM; 685571f9dd8SKittipon Meesompop card->dev->vlan_features |= NETIF_F_IPV6_CSUM; 686571f9dd8SKittipon Meesompop } 687d7e6ed97SKittipon Meesompop if (qeth_is_supported(card, IPA_INBOUND_CHECKSUM) || 688d7e6ed97SKittipon Meesompop qeth_is_supported6(card, IPA_INBOUND_CHECKSUM_V6)) { 689d7e6ed97SKittipon Meesompop card->dev->hw_features |= NETIF_F_RXCSUM; 690d7e6ed97SKittipon Meesompop card->dev->vlan_features |= NETIF_F_RXCSUM; 691d7e6ed97SKittipon Meesompop } 6920aef8392SJulian Wiedmann if (qeth_is_supported(card, IPA_OUTBOUND_TSO)) { 6930aef8392SJulian Wiedmann card->dev->hw_features |= NETIF_F_TSO; 6940aef8392SJulian Wiedmann card->dev->vlan_features |= NETIF_F_TSO; 6950aef8392SJulian Wiedmann } 6960aef8392SJulian Wiedmann if (qeth_is_supported6(card, IPA_OUTBOUND_TSO)) { 6970aef8392SJulian Wiedmann card->dev->hw_features |= NETIF_F_TSO6; 6980aef8392SJulian Wiedmann card->dev->vlan_features |= NETIF_F_TSO6; 6990aef8392SJulian Wiedmann } 7000aef8392SJulian Wiedmann 7010aef8392SJulian Wiedmann if (card->dev->hw_features & (NETIF_F_TSO | NETIF_F_TSO6)) { 7020aef8392SJulian Wiedmann card->dev->needed_headroom = sizeof(struct qeth_hdr_tso); 7030aef8392SJulian Wiedmann netif_set_gso_max_size(card->dev, 7040aef8392SJulian Wiedmann PAGE_SIZE * (QDIO_MAX_ELEMENTS_PER_BUFFER - 1)); 7050aef8392SJulian Wiedmann } 7060d6f02d3SJulian Wiedmann 7078024cc9eSJulian Wiedmann add_napi: 708d73ef324SJulian Wiedmann netif_napi_add(card->dev, &card->napi, qeth_poll, QETH_NAPI_WEIGHT); 709d3d1b205SJulian Wiedmann rc = register_netdev(card->dev); 7109fae5c3bSJulian Wiedmann if (!rc && carrier_ok) 7119fae5c3bSJulian Wiedmann netif_carrier_on(card->dev); 7129fae5c3bSJulian Wiedmann 713d3d1b205SJulian Wiedmann if (rc) 714d3d1b205SJulian Wiedmann card->dev->netdev_ops = NULL; 715d3d1b205SJulian Wiedmann return rc; 7164a71df50SFrank Blaschka } 7174a71df50SFrank Blaschka 718521c10eaSJulian Wiedmann static void qeth_l2_trace_features(struct qeth_card *card) 719521c10eaSJulian Wiedmann { 720a45b3fafSHans Wippel /* Set BridgePort features */ 721a45b3fafSHans Wippel QETH_CARD_TEXT(card, 2, "featuSBP"); 722521c10eaSJulian Wiedmann QETH_CARD_HEX(card, 2, &card->options.sbp.supported_funcs, 723521c10eaSJulian Wiedmann sizeof(card->options.sbp.supported_funcs)); 724a45b3fafSHans Wippel /* VNIC Characteristics features */ 725a45b3fafSHans Wippel QETH_CARD_TEXT(card, 2, "feaVNICC"); 726a45b3fafSHans Wippel QETH_CARD_HEX(card, 2, &card->options.vnicc.sup_chars, 727a45b3fafSHans Wippel sizeof(card->options.vnicc.sup_chars)); 728521c10eaSJulian Wiedmann } 729521c10eaSJulian Wiedmann 7308ca769e2SJulian Wiedmann static void qeth_l2_setup_bridgeport_attrs(struct qeth_card *card) 7318ca769e2SJulian Wiedmann { 7328ca769e2SJulian Wiedmann if (!card->options.sbp.reflect_promisc && 7338ca769e2SJulian Wiedmann card->options.sbp.role != QETH_SBP_ROLE_NONE) { 7348ca769e2SJulian Wiedmann /* Conditional to avoid spurious error messages */ 7358ca769e2SJulian Wiedmann qeth_bridgeport_setrole(card, card->options.sbp.role); 7368ca769e2SJulian Wiedmann /* Let the callback function refresh the stored role value. */ 7378ca769e2SJulian Wiedmann qeth_bridgeport_query_ports(card, &card->options.sbp.role, 7388ca769e2SJulian Wiedmann NULL); 7398ca769e2SJulian Wiedmann } 7408ca769e2SJulian Wiedmann if (card->options.sbp.hostnotification) { 7418ca769e2SJulian Wiedmann if (qeth_bridgeport_an_set(card, 1)) 7428ca769e2SJulian Wiedmann card->options.sbp.hostnotification = 0; 7438ca769e2SJulian Wiedmann } else { 7448ca769e2SJulian Wiedmann qeth_bridgeport_an_set(card, 0); 7458ca769e2SJulian Wiedmann } 7468ca769e2SJulian Wiedmann } 7478ca769e2SJulian Wiedmann 74891003f35SJulian Wiedmann static int qeth_l2_set_online(struct qeth_card *card) 7494a71df50SFrank Blaschka { 75091003f35SJulian Wiedmann struct ccwgroup_device *gdev = card->gdev; 751fa3d2e60SJulian Wiedmann struct net_device *dev = card->dev; 7524a71df50SFrank Blaschka int rc = 0; 7539fae5c3bSJulian Wiedmann bool carrier_ok; 7544a71df50SFrank Blaschka 7559fae5c3bSJulian Wiedmann rc = qeth_core_hardsetup_card(card, &carrier_ok); 7564a71df50SFrank Blaschka if (rc) { 75757a688aaSJulian Wiedmann QETH_CARD_TEXT_(card, 2, "2err%04x", rc); 758aa909224SUrsula Braun rc = -ENODEV; 7594a71df50SFrank Blaschka goto out_remove; 7604a71df50SFrank Blaschka } 761654e3d48SJulian Wiedmann 762c8183f54SJulian Wiedmann mutex_lock(&card->sbp_lock); 763d7ef489fSJulian Wiedmann qeth_bridgeport_query_support(card); 7648ca769e2SJulian Wiedmann if (card->options.sbp.supported_funcs) { 7658ca769e2SJulian Wiedmann qeth_l2_setup_bridgeport_attrs(card); 766d7ef489fSJulian Wiedmann dev_info(&card->gdev->dev, 767d7ef489fSJulian Wiedmann "The device represents a Bridge Capable Port\n"); 7688ca769e2SJulian Wiedmann } 769c8183f54SJulian Wiedmann mutex_unlock(&card->sbp_lock); 770d7ef489fSJulian Wiedmann 771d7ef489fSJulian Wiedmann qeth_l2_register_dev_addr(card); 772d7ef489fSJulian Wiedmann 773a45b3fafSHans Wippel /* for the rx_bcast characteristic, init VNICC after setmac */ 774a45b3fafSHans Wippel qeth_l2_vnicc_init(card); 775a45b3fafSHans Wippel 776a45b3fafSHans Wippel qeth_trace_features(card); 777a45b3fafSHans Wippel qeth_l2_trace_features(card); 778a45b3fafSHans Wippel 7794a71df50SFrank Blaschka card->state = CARD_STATE_HARDSETUP; 7804a71df50SFrank Blaschka qeth_print_status_message(card); 7814a71df50SFrank Blaschka 7824a71df50SFrank Blaschka /* softsetup */ 78357a688aaSJulian Wiedmann QETH_CARD_TEXT(card, 2, "softsetp"); 7844a71df50SFrank Blaschka 7854a71df50SFrank Blaschka card->state = CARD_STATE_SOFTSETUP; 7864a71df50SFrank Blaschka 7874a71df50SFrank Blaschka qeth_set_allowed_threads(card, 0xffffffff, 0); 788d025da9eSJulian Wiedmann 789fa3d2e60SJulian Wiedmann if (!qeth_netdev_is_registered(dev)) { 790fa3d2e60SJulian Wiedmann rc = qeth_l2_setup_netdev(card, carrier_ok); 791fa3d2e60SJulian Wiedmann if (rc) 792fa3d2e60SJulian Wiedmann goto out_remove; 7934a71df50SFrank Blaschka } else { 7944a71df50SFrank Blaschka rtnl_lock(); 795fa3d2e60SJulian Wiedmann if (carrier_ok) 796fa3d2e60SJulian Wiedmann netif_carrier_on(dev); 797fa3d2e60SJulian Wiedmann else 798fa3d2e60SJulian Wiedmann netif_carrier_off(dev); 799fa3d2e60SJulian Wiedmann 800e6e771b3SJulian Wiedmann netif_device_attach(dev); 801fa3d2e60SJulian Wiedmann qeth_enable_hw_features(dev); 802fa3d2e60SJulian Wiedmann 803d7d543f2SJulian Wiedmann if (card->info.open_when_online) { 804d7d543f2SJulian Wiedmann card->info.open_when_online = 0; 805fa3d2e60SJulian Wiedmann dev_open(dev, NULL); 806fa3d2e60SJulian Wiedmann } 807fa3d2e60SJulian Wiedmann rtnl_unlock(); 8084a71df50SFrank Blaschka } 8094a71df50SFrank Blaschka /* let user_space know that device is online */ 8104a71df50SFrank Blaschka kobject_uevent(&gdev->dev.kobj, KOBJ_CHANGE); 8114a71df50SFrank Blaschka return 0; 812aa909224SUrsula Braun 8134a71df50SFrank Blaschka out_remove: 814d4560150SJulian Wiedmann qeth_l2_stop_card(card); 815f9e50b02SJulian Wiedmann qeth_stop_channel(&card->data); 816f9e50b02SJulian Wiedmann qeth_stop_channel(&card->write); 817f9e50b02SJulian Wiedmann qeth_stop_channel(&card->read); 81822ae2790SUrsula Braun qdio_free(CARD_DDEV(card)); 819aa909224SUrsula Braun return rc; 8204a71df50SFrank Blaschka } 8214a71df50SFrank Blaschka 82291003f35SJulian Wiedmann static void qeth_l2_set_offline(struct qeth_card *card) 8234a71df50SFrank Blaschka { 824d4560150SJulian Wiedmann qeth_l2_stop_card(card); 8254a71df50SFrank Blaschka } 8264a71df50SFrank Blaschka 8274a71df50SFrank Blaschka static int __init qeth_l2_init(void) 8284a71df50SFrank Blaschka { 82974eacdb9SFrank Blaschka pr_info("register layer 2 discipline\n"); 8304a71df50SFrank Blaschka return 0; 8314a71df50SFrank Blaschka } 8324a71df50SFrank Blaschka 8334a71df50SFrank Blaschka static void __exit qeth_l2_exit(void) 8344a71df50SFrank Blaschka { 83574eacdb9SFrank Blaschka pr_info("unregister layer 2 discipline\n"); 8364a71df50SFrank Blaschka } 8374a71df50SFrank Blaschka 838c044dc21SEugene Crosser /* Returns zero if the command is successfully "consumed" */ 839c044dc21SEugene Crosser static int qeth_l2_control_event(struct qeth_card *card, 840c044dc21SEugene Crosser struct qeth_ipa_cmd *cmd) 841c044dc21SEugene Crosser { 842c044dc21SEugene Crosser switch (cmd->hdr.command) { 8439c23f4daSEugene Crosser case IPA_CMD_SETBRIDGEPORT_OSA: 8449c23f4daSEugene Crosser case IPA_CMD_SETBRIDGEPORT_IQD: 845c044dc21SEugene Crosser if (cmd->data.sbp.hdr.command_code == 846c044dc21SEugene Crosser IPA_SBP_BRIDGE_PORT_STATE_CHANGE) { 847c044dc21SEugene Crosser qeth_bridge_state_change(card, cmd); 848c044dc21SEugene Crosser return 0; 849c044dc21SEugene Crosser } else 850c044dc21SEugene Crosser return 1; 851c044dc21SEugene Crosser case IPA_CMD_ADDRESS_CHANGE_NOTIF: 852c044dc21SEugene Crosser qeth_bridge_host_event(card, cmd); 853c044dc21SEugene Crosser return 0; 854c044dc21SEugene Crosser default: 855c044dc21SEugene Crosser return 1; 856c044dc21SEugene Crosser } 857c044dc21SEugene Crosser } 858c044dc21SEugene Crosser 859c041f2d4SSebastian Ott struct qeth_discipline qeth_l2_discipline = { 8602d2ebb3eSJulian Wiedmann .devtype = &qeth_l2_devtype, 861c041f2d4SSebastian Ott .setup = qeth_l2_probe_device, 8624a71df50SFrank Blaschka .remove = qeth_l2_remove_device, 8634a71df50SFrank Blaschka .set_online = qeth_l2_set_online, 8644a71df50SFrank Blaschka .set_offline = qeth_l2_set_offline, 865942d6984SJulian Wiedmann .do_ioctl = NULL, 866c044dc21SEugene Crosser .control_event_handler = qeth_l2_control_event, 8674a71df50SFrank Blaschka }; 868c041f2d4SSebastian Ott EXPORT_SYMBOL_GPL(qeth_l2_discipline); 8694a71df50SFrank Blaschka 8700ce37ec2SJulian Wiedmann static void qeth_osn_assist_cb(struct qeth_card *card, 87112fc286fSJulian Wiedmann struct qeth_cmd_buffer *iob, 87212fc286fSJulian Wiedmann unsigned int data_length) 8734a71df50SFrank Blaschka { 874308946b0SJulian Wiedmann qeth_notify_cmd(iob, 0); 875c3b2218dSJulian Wiedmann qeth_put_cmd(iob); 8764a71df50SFrank Blaschka } 8774a71df50SFrank Blaschka 8784a71df50SFrank Blaschka int qeth_osn_assist(struct net_device *dev, void *data, int data_len) 8794a71df50SFrank Blaschka { 8804a71df50SFrank Blaschka struct qeth_cmd_buffer *iob; 8814a71df50SFrank Blaschka struct qeth_card *card; 8824a71df50SFrank Blaschka 883a59d121dSJulian Wiedmann if (data_len < 0) 884a59d121dSJulian Wiedmann return -EINVAL; 8854a71df50SFrank Blaschka if (!dev) 8864a71df50SFrank Blaschka return -ENODEV; 887509e2562SHeiko Carstens card = dev->ml_priv; 8884a71df50SFrank Blaschka if (!card) 8894a71df50SFrank Blaschka return -ENODEV; 890847a50fdSCarsten Otte QETH_CARD_TEXT(card, 2, "osnsdmc"); 891c3521254SEugene Crosser if (!qeth_card_hw_is_reachable(card)) 8924a71df50SFrank Blaschka return -ENODEV; 893a59d121dSJulian Wiedmann 894a59d121dSJulian Wiedmann iob = qeth_alloc_cmd(&card->write, IPA_PDU_HEADER_SIZE + data_len, 1, 895a59d121dSJulian Wiedmann QETH_IPA_TIMEOUT); 8961273a800SJulian Wiedmann if (!iob) 8971273a800SJulian Wiedmann return -ENOMEM; 8981273a800SJulian Wiedmann 8997f92316cSJulian Wiedmann qeth_prepare_ipa_cmd(card, iob, (u16) data_len, NULL); 9007f92316cSJulian Wiedmann 901ff5caa7aSJulian Wiedmann memcpy(__ipa_cmd(iob), data, data_len); 9020ce37ec2SJulian Wiedmann iob->callback = qeth_osn_assist_cb; 9030ce37ec2SJulian Wiedmann return qeth_send_ipa_cmd(card, iob, NULL, NULL); 9044a71df50SFrank Blaschka } 9054a71df50SFrank Blaschka EXPORT_SYMBOL(qeth_osn_assist); 9064a71df50SFrank Blaschka 9074a71df50SFrank Blaschka int qeth_osn_register(unsigned char *read_dev_no, struct net_device **dev, 9084a71df50SFrank Blaschka int (*assist_cb)(struct net_device *, void *), 9094a71df50SFrank Blaschka int (*data_cb)(struct sk_buff *)) 9104a71df50SFrank Blaschka { 9114a71df50SFrank Blaschka struct qeth_card *card; 912d7d18da1SJulian Wiedmann char bus_id[16]; 913d7d18da1SJulian Wiedmann u16 devno; 9144a71df50SFrank Blaschka 915d7d18da1SJulian Wiedmann memcpy(&devno, read_dev_no, 2); 916d7d18da1SJulian Wiedmann sprintf(bus_id, "0.0.%04x", devno); 917d7d18da1SJulian Wiedmann card = qeth_get_card_by_busid(bus_id); 918d7d18da1SJulian Wiedmann if (!card || !IS_OSN(card)) 9194a71df50SFrank Blaschka return -ENODEV; 920d7d18da1SJulian Wiedmann *dev = card->dev; 921d7d18da1SJulian Wiedmann 922847a50fdSCarsten Otte QETH_CARD_TEXT(card, 2, "osnreg"); 9234a71df50SFrank Blaschka if ((assist_cb == NULL) || (data_cb == NULL)) 9244a71df50SFrank Blaschka return -EINVAL; 9254a71df50SFrank Blaschka card->osn_info.assist_cb = assist_cb; 9264a71df50SFrank Blaschka card->osn_info.data_cb = data_cb; 9274a71df50SFrank Blaschka return 0; 9284a71df50SFrank Blaschka } 9294a71df50SFrank Blaschka EXPORT_SYMBOL(qeth_osn_register); 9304a71df50SFrank Blaschka 9314a71df50SFrank Blaschka void qeth_osn_deregister(struct net_device *dev) 9324a71df50SFrank Blaschka { 9334a71df50SFrank Blaschka struct qeth_card *card; 9344a71df50SFrank Blaschka 9354a71df50SFrank Blaschka if (!dev) 9364a71df50SFrank Blaschka return; 937509e2562SHeiko Carstens card = dev->ml_priv; 9384a71df50SFrank Blaschka if (!card) 9394a71df50SFrank Blaschka return; 940847a50fdSCarsten Otte QETH_CARD_TEXT(card, 2, "osndereg"); 9414a71df50SFrank Blaschka card->osn_info.assist_cb = NULL; 9424a71df50SFrank Blaschka card->osn_info.data_cb = NULL; 9434a71df50SFrank Blaschka return; 9444a71df50SFrank Blaschka } 9454a71df50SFrank Blaschka EXPORT_SYMBOL(qeth_osn_deregister); 9464a71df50SFrank Blaschka 947b4d72c08SEugene Crosser /* SETBRIDGEPORT support, async notifications */ 948b4d72c08SEugene Crosser 9499f48b9dbSEugene Crosser enum qeth_an_event_type {anev_reg_unreg, anev_abort, anev_reset}; 9509f48b9dbSEugene Crosser 9519f48b9dbSEugene Crosser /** 9529f48b9dbSEugene Crosser * qeth_bridge_emit_host_event() - bridgeport address change notification 9539f48b9dbSEugene Crosser * @card: qeth_card structure pointer, for udev events. 9549f48b9dbSEugene Crosser * @evtype: "normal" register/unregister, or abort, or reset. For abort 9559f48b9dbSEugene Crosser * and reset token and addr_lnid are unused and may be NULL. 9569f48b9dbSEugene Crosser * @code: event bitmask: high order bit 0x80 value 1 means removal of an 9579f48b9dbSEugene Crosser * object, 0 - addition of an object. 9589f48b9dbSEugene Crosser * 0x01 - VLAN, 0x02 - MAC, 0x03 - VLAN and MAC. 9599f48b9dbSEugene Crosser * @token: "network token" structure identifying physical address of the port. 9609f48b9dbSEugene Crosser * @addr_lnid: pointer to structure with MAC address and VLAN ID. 9619f48b9dbSEugene Crosser * 9629f48b9dbSEugene Crosser * This function is called when registrations and deregistrations are 9639f48b9dbSEugene Crosser * reported by the hardware, and also when notifications are enabled - 9649f48b9dbSEugene Crosser * for all currently registered addresses. 9659f48b9dbSEugene Crosser */ 9669f48b9dbSEugene Crosser static void qeth_bridge_emit_host_event(struct qeth_card *card, 9679f48b9dbSEugene Crosser enum qeth_an_event_type evtype, 9689f48b9dbSEugene Crosser u8 code, struct net_if_token *token, struct mac_addr_lnid *addr_lnid) 9699f48b9dbSEugene Crosser { 9709f48b9dbSEugene Crosser char str[7][32]; 9719f48b9dbSEugene Crosser char *env[8]; 9729f48b9dbSEugene Crosser int i = 0; 9739f48b9dbSEugene Crosser 9749f48b9dbSEugene Crosser switch (evtype) { 9759f48b9dbSEugene Crosser case anev_reg_unreg: 9769f48b9dbSEugene Crosser snprintf(str[i], sizeof(str[i]), "BRIDGEDHOST=%s", 9779f48b9dbSEugene Crosser (code & IPA_ADDR_CHANGE_CODE_REMOVAL) 9789f48b9dbSEugene Crosser ? "deregister" : "register"); 9799f48b9dbSEugene Crosser env[i] = str[i]; i++; 9809f48b9dbSEugene Crosser if (code & IPA_ADDR_CHANGE_CODE_VLANID) { 9819f48b9dbSEugene Crosser snprintf(str[i], sizeof(str[i]), "VLAN=%d", 9829f48b9dbSEugene Crosser addr_lnid->lnid); 9839f48b9dbSEugene Crosser env[i] = str[i]; i++; 9849f48b9dbSEugene Crosser } 9859f48b9dbSEugene Crosser if (code & IPA_ADDR_CHANGE_CODE_MACADDR) { 9869846e70bSEugene Crosser snprintf(str[i], sizeof(str[i]), "MAC=%pM", 9879846e70bSEugene Crosser addr_lnid->mac); 9889f48b9dbSEugene Crosser env[i] = str[i]; i++; 9899f48b9dbSEugene Crosser } 9909f48b9dbSEugene Crosser snprintf(str[i], sizeof(str[i]), "NTOK_BUSID=%x.%x.%04x", 9919f48b9dbSEugene Crosser token->cssid, token->ssid, token->devnum); 9929f48b9dbSEugene Crosser env[i] = str[i]; i++; 9939f48b9dbSEugene Crosser snprintf(str[i], sizeof(str[i]), "NTOK_IID=%02x", token->iid); 9949f48b9dbSEugene Crosser env[i] = str[i]; i++; 9959f48b9dbSEugene Crosser snprintf(str[i], sizeof(str[i]), "NTOK_CHPID=%02x", 9969f48b9dbSEugene Crosser token->chpid); 9979f48b9dbSEugene Crosser env[i] = str[i]; i++; 9989f48b9dbSEugene Crosser snprintf(str[i], sizeof(str[i]), "NTOK_CHID=%04x", token->chid); 9999f48b9dbSEugene Crosser env[i] = str[i]; i++; 10009f48b9dbSEugene Crosser break; 10019f48b9dbSEugene Crosser case anev_abort: 10029f48b9dbSEugene Crosser snprintf(str[i], sizeof(str[i]), "BRIDGEDHOST=abort"); 10039f48b9dbSEugene Crosser env[i] = str[i]; i++; 10049f48b9dbSEugene Crosser break; 10059f48b9dbSEugene Crosser case anev_reset: 10069f48b9dbSEugene Crosser snprintf(str[i], sizeof(str[i]), "BRIDGEDHOST=reset"); 10079f48b9dbSEugene Crosser env[i] = str[i]; i++; 10089f48b9dbSEugene Crosser break; 10099f48b9dbSEugene Crosser } 10109f48b9dbSEugene Crosser env[i] = NULL; 10119f48b9dbSEugene Crosser kobject_uevent_env(&card->gdev->dev.kobj, KOBJ_CHANGE, env); 10129f48b9dbSEugene Crosser } 10139f48b9dbSEugene Crosser 1014b4d72c08SEugene Crosser struct qeth_bridge_state_data { 1015b4d72c08SEugene Crosser struct work_struct worker; 1016b4d72c08SEugene Crosser struct qeth_card *card; 1017b4d72c08SEugene Crosser struct qeth_sbp_state_change qports; 1018b4d72c08SEugene Crosser }; 1019b4d72c08SEugene Crosser 1020b4d72c08SEugene Crosser static void qeth_bridge_state_change_worker(struct work_struct *work) 1021b4d72c08SEugene Crosser { 1022b4d72c08SEugene Crosser struct qeth_bridge_state_data *data = 1023b4d72c08SEugene Crosser container_of(work, struct qeth_bridge_state_data, worker); 1024b4d72c08SEugene Crosser /* We are only interested in the first entry - local port */ 1025b4d72c08SEugene Crosser struct qeth_sbp_port_entry *entry = &data->qports.entry[0]; 1026b4d72c08SEugene Crosser char env_locrem[32]; 1027b4d72c08SEugene Crosser char env_role[32]; 1028b4d72c08SEugene Crosser char env_state[32]; 1029b4d72c08SEugene Crosser char *env[] = { 1030b4d72c08SEugene Crosser env_locrem, 1031b4d72c08SEugene Crosser env_role, 1032b4d72c08SEugene Crosser env_state, 1033b4d72c08SEugene Crosser NULL 1034b4d72c08SEugene Crosser }; 1035b4d72c08SEugene Crosser 1036b4d72c08SEugene Crosser /* Role should not change by itself, but if it did, */ 1037b4d72c08SEugene Crosser /* information from the hardware is authoritative. */ 1038c8183f54SJulian Wiedmann mutex_lock(&data->card->sbp_lock); 1039b4d72c08SEugene Crosser data->card->options.sbp.role = entry->role; 1040c8183f54SJulian Wiedmann mutex_unlock(&data->card->sbp_lock); 1041b4d72c08SEugene Crosser 1042b4d72c08SEugene Crosser snprintf(env_locrem, sizeof(env_locrem), "BRIDGEPORT=statechange"); 1043b4d72c08SEugene Crosser snprintf(env_role, sizeof(env_role), "ROLE=%s", 1044b4d72c08SEugene Crosser (entry->role == QETH_SBP_ROLE_NONE) ? "none" : 1045b4d72c08SEugene Crosser (entry->role == QETH_SBP_ROLE_PRIMARY) ? "primary" : 1046b4d72c08SEugene Crosser (entry->role == QETH_SBP_ROLE_SECONDARY) ? "secondary" : 1047b4d72c08SEugene Crosser "<INVALID>"); 1048b4d72c08SEugene Crosser snprintf(env_state, sizeof(env_state), "STATE=%s", 1049b4d72c08SEugene Crosser (entry->state == QETH_SBP_STATE_INACTIVE) ? "inactive" : 1050b4d72c08SEugene Crosser (entry->state == QETH_SBP_STATE_STANDBY) ? "standby" : 1051b4d72c08SEugene Crosser (entry->state == QETH_SBP_STATE_ACTIVE) ? "active" : 1052b4d72c08SEugene Crosser "<INVALID>"); 1053b4d72c08SEugene Crosser kobject_uevent_env(&data->card->gdev->dev.kobj, 1054b4d72c08SEugene Crosser KOBJ_CHANGE, env); 1055b4d72c08SEugene Crosser kfree(data); 1056b4d72c08SEugene Crosser } 1057b4d72c08SEugene Crosser 1058c044dc21SEugene Crosser static void qeth_bridge_state_change(struct qeth_card *card, 1059c044dc21SEugene Crosser struct qeth_ipa_cmd *cmd) 1060b4d72c08SEugene Crosser { 1061b4d72c08SEugene Crosser struct qeth_sbp_state_change *qports = 1062b4d72c08SEugene Crosser &cmd->data.sbp.data.state_change; 1063b4d72c08SEugene Crosser struct qeth_bridge_state_data *data; 1064b4d72c08SEugene Crosser int extrasize; 1065b4d72c08SEugene Crosser 1066b4d72c08SEugene Crosser QETH_CARD_TEXT(card, 2, "brstchng"); 1067b4d72c08SEugene Crosser if (qports->entry_length != sizeof(struct qeth_sbp_port_entry)) { 10688a593148SThomas Richter QETH_CARD_TEXT_(card, 2, "BPsz%04x", qports->entry_length); 1069b4d72c08SEugene Crosser return; 1070b4d72c08SEugene Crosser } 1071b4d72c08SEugene Crosser extrasize = sizeof(struct qeth_sbp_port_entry) * qports->num_entries; 1072b4d72c08SEugene Crosser data = kzalloc(sizeof(struct qeth_bridge_state_data) + extrasize, 1073b4d72c08SEugene Crosser GFP_ATOMIC); 1074b4d72c08SEugene Crosser if (!data) { 1075b4d72c08SEugene Crosser QETH_CARD_TEXT(card, 2, "BPSalloc"); 1076b4d72c08SEugene Crosser return; 1077b4d72c08SEugene Crosser } 1078b4d72c08SEugene Crosser INIT_WORK(&data->worker, qeth_bridge_state_change_worker); 1079b4d72c08SEugene Crosser data->card = card; 1080b4d72c08SEugene Crosser memcpy(&data->qports, qports, 1081b4d72c08SEugene Crosser sizeof(struct qeth_sbp_state_change) + extrasize); 1082c0a2e4d1SJulian Wiedmann queue_work(card->event_wq, &data->worker); 1083b4d72c08SEugene Crosser } 1084b4d72c08SEugene Crosser 10859f48b9dbSEugene Crosser struct qeth_bridge_host_data { 10869f48b9dbSEugene Crosser struct work_struct worker; 10879f48b9dbSEugene Crosser struct qeth_card *card; 10889f48b9dbSEugene Crosser struct qeth_ipacmd_addr_change hostevs; 10899f48b9dbSEugene Crosser }; 10909f48b9dbSEugene Crosser 10919f48b9dbSEugene Crosser static void qeth_bridge_host_event_worker(struct work_struct *work) 10929f48b9dbSEugene Crosser { 10939f48b9dbSEugene Crosser struct qeth_bridge_host_data *data = 10949f48b9dbSEugene Crosser container_of(work, struct qeth_bridge_host_data, worker); 10959f48b9dbSEugene Crosser int i; 10969f48b9dbSEugene Crosser 10979f48b9dbSEugene Crosser if (data->hostevs.lost_event_mask) { 10989f48b9dbSEugene Crosser dev_info(&data->card->gdev->dev, 10999c23f4daSEugene Crosser "Address notification from the Bridge Port stopped %s (%s)\n", 11009f48b9dbSEugene Crosser data->card->dev->name, 11019f48b9dbSEugene Crosser (data->hostevs.lost_event_mask == 0x01) 11029f48b9dbSEugene Crosser ? "Overflow" 11039f48b9dbSEugene Crosser : (data->hostevs.lost_event_mask == 0x02) 11049f48b9dbSEugene Crosser ? "Bridge port state change" 11059f48b9dbSEugene Crosser : "Unknown reason"); 1106c8183f54SJulian Wiedmann mutex_lock(&data->card->sbp_lock); 11079f48b9dbSEugene Crosser data->card->options.sbp.hostnotification = 0; 1108c8183f54SJulian Wiedmann mutex_unlock(&data->card->sbp_lock); 11099f48b9dbSEugene Crosser qeth_bridge_emit_host_event(data->card, anev_abort, 11109f48b9dbSEugene Crosser 0, NULL, NULL); 11119f48b9dbSEugene Crosser } else 11129f48b9dbSEugene Crosser for (i = 0; i < data->hostevs.num_entries; i++) { 11139f48b9dbSEugene Crosser struct qeth_ipacmd_addr_change_entry *entry = 11149f48b9dbSEugene Crosser &data->hostevs.entry[i]; 11159f48b9dbSEugene Crosser qeth_bridge_emit_host_event(data->card, 11169f48b9dbSEugene Crosser anev_reg_unreg, 11179f48b9dbSEugene Crosser entry->change_code, 11189f48b9dbSEugene Crosser &entry->token, &entry->addr_lnid); 11199f48b9dbSEugene Crosser } 11209f48b9dbSEugene Crosser kfree(data); 11219f48b9dbSEugene Crosser } 11229f48b9dbSEugene Crosser 1123c044dc21SEugene Crosser static void qeth_bridge_host_event(struct qeth_card *card, 1124c044dc21SEugene Crosser struct qeth_ipa_cmd *cmd) 11259f48b9dbSEugene Crosser { 11269f48b9dbSEugene Crosser struct qeth_ipacmd_addr_change *hostevs = 11279f48b9dbSEugene Crosser &cmd->data.addrchange; 11289f48b9dbSEugene Crosser struct qeth_bridge_host_data *data; 11299f48b9dbSEugene Crosser int extrasize; 11309f48b9dbSEugene Crosser 11319f48b9dbSEugene Crosser QETH_CARD_TEXT(card, 2, "brhostev"); 11329f48b9dbSEugene Crosser if (cmd->hdr.return_code != 0x0000) { 11339f48b9dbSEugene Crosser if (cmd->hdr.return_code == 0x0010) { 11349f48b9dbSEugene Crosser if (hostevs->lost_event_mask == 0x00) 11359f48b9dbSEugene Crosser hostevs->lost_event_mask = 0xff; 11369f48b9dbSEugene Crosser } else { 11379f48b9dbSEugene Crosser QETH_CARD_TEXT_(card, 2, "BPHe%04x", 11389f48b9dbSEugene Crosser cmd->hdr.return_code); 11399f48b9dbSEugene Crosser return; 11409f48b9dbSEugene Crosser } 11419f48b9dbSEugene Crosser } 11429f48b9dbSEugene Crosser extrasize = sizeof(struct qeth_ipacmd_addr_change_entry) * 11439f48b9dbSEugene Crosser hostevs->num_entries; 11449f48b9dbSEugene Crosser data = kzalloc(sizeof(struct qeth_bridge_host_data) + extrasize, 11459f48b9dbSEugene Crosser GFP_ATOMIC); 11469f48b9dbSEugene Crosser if (!data) { 11479f48b9dbSEugene Crosser QETH_CARD_TEXT(card, 2, "BPHalloc"); 11489f48b9dbSEugene Crosser return; 11499f48b9dbSEugene Crosser } 11509f48b9dbSEugene Crosser INIT_WORK(&data->worker, qeth_bridge_host_event_worker); 11519f48b9dbSEugene Crosser data->card = card; 11529f48b9dbSEugene Crosser memcpy(&data->hostevs, hostevs, 11539f48b9dbSEugene Crosser sizeof(struct qeth_ipacmd_addr_change) + extrasize); 1154c0a2e4d1SJulian Wiedmann queue_work(card->event_wq, &data->worker); 11559f48b9dbSEugene Crosser } 11569f48b9dbSEugene Crosser 1157b4d72c08SEugene Crosser /* SETBRIDGEPORT support; sending commands */ 1158b4d72c08SEugene Crosser 1159b4d72c08SEugene Crosser struct _qeth_sbp_cbctl { 1160b4d72c08SEugene Crosser union { 1161b4d72c08SEugene Crosser u32 supported; 1162b4d72c08SEugene Crosser struct { 1163b4d72c08SEugene Crosser enum qeth_sbp_roles *role; 1164b4d72c08SEugene Crosser enum qeth_sbp_states *state; 1165b4d72c08SEugene Crosser } qports; 1166b4d72c08SEugene Crosser } data; 1167b4d72c08SEugene Crosser }; 1168b4d72c08SEugene Crosser 1169b4d72c08SEugene Crosser static int qeth_bridgeport_makerc(struct qeth_card *card, 11701709ff8dSJulian Wiedmann struct qeth_ipa_cmd *cmd) 1171b4d72c08SEugene Crosser { 11721709ff8dSJulian Wiedmann struct qeth_ipacmd_setbridgeport *sbp = &cmd->data.sbp; 11731709ff8dSJulian Wiedmann enum qeth_ipa_sbp_cmd setcmd = sbp->hdr.command_code; 11741709ff8dSJulian Wiedmann u16 ipa_rc = cmd->hdr.return_code; 11751709ff8dSJulian Wiedmann u16 sbp_rc = sbp->hdr.return_code; 1176b4d72c08SEugene Crosser int rc; 1177b4d72c08SEugene Crosser 11781709ff8dSJulian Wiedmann if (ipa_rc == IPA_RC_SUCCESS && sbp_rc == IPA_RC_SUCCESS) 11791709ff8dSJulian Wiedmann return 0; 11801709ff8dSJulian Wiedmann 11811709ff8dSJulian Wiedmann if ((IS_IQD(card) && ipa_rc == IPA_RC_SUCCESS) || 11821709ff8dSJulian Wiedmann (!IS_IQD(card) && ipa_rc == sbp_rc)) { 11831709ff8dSJulian Wiedmann switch (sbp_rc) { 11842063a5f5SKittipon Meesompop case IPA_RC_SUCCESS: 1185b4d72c08SEugene Crosser rc = 0; 1186b4d72c08SEugene Crosser break; 11872063a5f5SKittipon Meesompop case IPA_RC_L2_UNSUPPORTED_CMD: 11882063a5f5SKittipon Meesompop case IPA_RC_UNSUPPORTED_COMMAND: 1189ffb95251SEugene Crosser rc = -EOPNOTSUPP; 1190b4d72c08SEugene Crosser break; 11912063a5f5SKittipon Meesompop case IPA_RC_SBP_OSA_NOT_CONFIGURED: 11922063a5f5SKittipon Meesompop case IPA_RC_SBP_IQD_NOT_CONFIGURED: 1193b4d72c08SEugene Crosser rc = -ENODEV; /* maybe not the best code here? */ 1194b4d72c08SEugene Crosser dev_err(&card->gdev->dev, 11959c23f4daSEugene Crosser "The device is not configured as a Bridge Port\n"); 1196b4d72c08SEugene Crosser break; 11972063a5f5SKittipon Meesompop case IPA_RC_SBP_OSA_OS_MISMATCH: 11982063a5f5SKittipon Meesompop case IPA_RC_SBP_IQD_OS_MISMATCH: 11991b05cf62SEugene Crosser rc = -EPERM; 12001b05cf62SEugene Crosser dev_err(&card->gdev->dev, 12011b05cf62SEugene Crosser "A Bridge Port is already configured by a different operating system\n"); 12021b05cf62SEugene Crosser break; 12032063a5f5SKittipon Meesompop case IPA_RC_SBP_OSA_ANO_DEV_PRIMARY: 12042063a5f5SKittipon Meesompop case IPA_RC_SBP_IQD_ANO_DEV_PRIMARY: 1205b4d72c08SEugene Crosser switch (setcmd) { 1206b4d72c08SEugene Crosser case IPA_SBP_SET_PRIMARY_BRIDGE_PORT: 1207b4d72c08SEugene Crosser rc = -EEXIST; 1208b4d72c08SEugene Crosser dev_err(&card->gdev->dev, 12099c23f4daSEugene Crosser "The LAN already has a primary Bridge Port\n"); 1210b4d72c08SEugene Crosser break; 1211b4d72c08SEugene Crosser case IPA_SBP_SET_SECONDARY_BRIDGE_PORT: 1212b4d72c08SEugene Crosser rc = -EBUSY; 1213b4d72c08SEugene Crosser dev_err(&card->gdev->dev, 12149c23f4daSEugene Crosser "The device is already a primary Bridge Port\n"); 1215b4d72c08SEugene Crosser break; 1216b4d72c08SEugene Crosser default: 1217b4d72c08SEugene Crosser rc = -EIO; 1218b4d72c08SEugene Crosser } 1219b4d72c08SEugene Crosser break; 12202063a5f5SKittipon Meesompop case IPA_RC_SBP_OSA_CURRENT_SECOND: 12212063a5f5SKittipon Meesompop case IPA_RC_SBP_IQD_CURRENT_SECOND: 1222b4d72c08SEugene Crosser rc = -EBUSY; 1223b4d72c08SEugene Crosser dev_err(&card->gdev->dev, 12249c23f4daSEugene Crosser "The device is already a secondary Bridge Port\n"); 1225b4d72c08SEugene Crosser break; 12262063a5f5SKittipon Meesompop case IPA_RC_SBP_OSA_LIMIT_SECOND: 12272063a5f5SKittipon Meesompop case IPA_RC_SBP_IQD_LIMIT_SECOND: 1228b4d72c08SEugene Crosser rc = -EEXIST; 1229b4d72c08SEugene Crosser dev_err(&card->gdev->dev, 12309c23f4daSEugene Crosser "The LAN cannot have more secondary Bridge Ports\n"); 1231b4d72c08SEugene Crosser break; 12322063a5f5SKittipon Meesompop case IPA_RC_SBP_OSA_CURRENT_PRIMARY: 12332063a5f5SKittipon Meesompop case IPA_RC_SBP_IQD_CURRENT_PRIMARY: 1234b4d72c08SEugene Crosser rc = -EBUSY; 1235b4d72c08SEugene Crosser dev_err(&card->gdev->dev, 12369c23f4daSEugene Crosser "The device is already a primary Bridge Port\n"); 1237b4d72c08SEugene Crosser break; 12382063a5f5SKittipon Meesompop case IPA_RC_SBP_OSA_NOT_AUTHD_BY_ZMAN: 12392063a5f5SKittipon Meesompop case IPA_RC_SBP_IQD_NOT_AUTHD_BY_ZMAN: 1240b4d72c08SEugene Crosser rc = -EACCES; 1241b4d72c08SEugene Crosser dev_err(&card->gdev->dev, 12429c23f4daSEugene Crosser "The device is not authorized to be a Bridge Port\n"); 1243b4d72c08SEugene Crosser break; 1244b4d72c08SEugene Crosser default: 1245b4d72c08SEugene Crosser rc = -EIO; 1246b4d72c08SEugene Crosser } 12471709ff8dSJulian Wiedmann } else { 12481709ff8dSJulian Wiedmann switch (ipa_rc) { 1249b4d72c08SEugene Crosser case IPA_RC_NOTSUPP: 1250ffb95251SEugene Crosser rc = -EOPNOTSUPP; 1251b4d72c08SEugene Crosser break; 1252b4d72c08SEugene Crosser case IPA_RC_UNSUPPORTED_COMMAND: 1253ffb95251SEugene Crosser rc = -EOPNOTSUPP; 1254b4d72c08SEugene Crosser break; 1255b4d72c08SEugene Crosser default: 1256b4d72c08SEugene Crosser rc = -EIO; 1257b4d72c08SEugene Crosser } 12581709ff8dSJulian Wiedmann } 12599c23f4daSEugene Crosser 1260b4d72c08SEugene Crosser if (rc) { 12611709ff8dSJulian Wiedmann QETH_CARD_TEXT_(card, 2, "SBPi%04x", ipa_rc); 12621709ff8dSJulian Wiedmann QETH_CARD_TEXT_(card, 2, "SBPc%04x", sbp_rc); 1263b4d72c08SEugene Crosser } 1264b4d72c08SEugene Crosser return rc; 1265b4d72c08SEugene Crosser } 1266b4d72c08SEugene Crosser 1267d65626adSJulian Wiedmann static struct qeth_cmd_buffer *qeth_sbp_build_cmd(struct qeth_card *card, 1268d65626adSJulian Wiedmann enum qeth_ipa_sbp_cmd sbp_cmd, 1269b9150461SJulian Wiedmann unsigned int data_length) 12709c23f4daSEugene Crosser { 1271379ac99eSJulian Wiedmann enum qeth_ipa_cmds ipa_cmd = IS_IQD(card) ? IPA_CMD_SETBRIDGEPORT_IQD : 12729c23f4daSEugene Crosser IPA_CMD_SETBRIDGEPORT_OSA; 1273b9150461SJulian Wiedmann struct qeth_ipacmd_sbp_hdr *hdr; 1274d65626adSJulian Wiedmann struct qeth_cmd_buffer *iob; 1275d65626adSJulian Wiedmann 1276b9150461SJulian Wiedmann iob = qeth_ipa_alloc_cmd(card, ipa_cmd, QETH_PROT_NONE, 1277b9150461SJulian Wiedmann data_length + 1278b9150461SJulian Wiedmann offsetof(struct qeth_ipacmd_setbridgeport, 1279b9150461SJulian Wiedmann data)); 1280d65626adSJulian Wiedmann if (!iob) 1281d65626adSJulian Wiedmann return iob; 1282b9150461SJulian Wiedmann 1283b9150461SJulian Wiedmann hdr = &__ipa_cmd(iob)->data.sbp.hdr; 1284b9150461SJulian Wiedmann hdr->cmdlength = sizeof(*hdr) + data_length; 1285b9150461SJulian Wiedmann hdr->command_code = sbp_cmd; 1286b9150461SJulian Wiedmann hdr->used_total = 1; 1287b9150461SJulian Wiedmann hdr->seq_no = 1; 1288d65626adSJulian Wiedmann return iob; 12899c23f4daSEugene Crosser } 12909c23f4daSEugene Crosser 1291b4d72c08SEugene Crosser static int qeth_bridgeport_query_support_cb(struct qeth_card *card, 1292b4d72c08SEugene Crosser struct qeth_reply *reply, unsigned long data) 1293b4d72c08SEugene Crosser { 1294b4d72c08SEugene Crosser struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *) data; 1295b4d72c08SEugene Crosser struct _qeth_sbp_cbctl *cbctl = (struct _qeth_sbp_cbctl *)reply->param; 12961709ff8dSJulian Wiedmann int rc; 12971709ff8dSJulian Wiedmann 1298b4d72c08SEugene Crosser QETH_CARD_TEXT(card, 2, "brqsupcb"); 12991709ff8dSJulian Wiedmann rc = qeth_bridgeport_makerc(card, cmd); 13001709ff8dSJulian Wiedmann if (rc) 13011709ff8dSJulian Wiedmann return rc; 13021709ff8dSJulian Wiedmann 1303b4d72c08SEugene Crosser cbctl->data.supported = 1304b4d72c08SEugene Crosser cmd->data.sbp.data.query_cmds_supp.supported_cmds; 1305b4d72c08SEugene Crosser return 0; 1306b4d72c08SEugene Crosser } 1307b4d72c08SEugene Crosser 1308b4d72c08SEugene Crosser /** 1309b4d72c08SEugene Crosser * qeth_bridgeport_query_support() - store bitmask of supported subfunctions. 1310b4d72c08SEugene Crosser * @card: qeth_card structure pointer. 1311b4d72c08SEugene Crosser * 1312b4d72c08SEugene Crosser * Sets bitmask of supported setbridgeport subfunctions in the qeth_card 1313b4d72c08SEugene Crosser * strucutre: card->options.sbp.supported_funcs. 1314b4d72c08SEugene Crosser */ 1315c044dc21SEugene Crosser static void qeth_bridgeport_query_support(struct qeth_card *card) 1316b4d72c08SEugene Crosser { 1317b4d72c08SEugene Crosser struct qeth_cmd_buffer *iob; 1318b4d72c08SEugene Crosser struct _qeth_sbp_cbctl cbctl; 1319b4d72c08SEugene Crosser 1320b4d72c08SEugene Crosser QETH_CARD_TEXT(card, 2, "brqsuppo"); 1321d65626adSJulian Wiedmann iob = qeth_sbp_build_cmd(card, IPA_SBP_QUERY_COMMANDS_SUPPORTED, 1322b9150461SJulian Wiedmann SBP_DATA_SIZEOF(query_cmds_supp)); 13231aec42bcSThomas Richter if (!iob) 13241aec42bcSThomas Richter return; 13251709ff8dSJulian Wiedmann 1326b4d72c08SEugene Crosser if (qeth_send_ipa_cmd(card, iob, qeth_bridgeport_query_support_cb, 13271709ff8dSJulian Wiedmann &cbctl)) { 1328b4d72c08SEugene Crosser card->options.sbp.role = QETH_SBP_ROLE_NONE; 13291709ff8dSJulian Wiedmann card->options.sbp.supported_funcs = 0; 1330b4d72c08SEugene Crosser return; 1331b4d72c08SEugene Crosser } 1332b4d72c08SEugene Crosser card->options.sbp.supported_funcs = cbctl.data.supported; 1333b4d72c08SEugene Crosser } 1334b4d72c08SEugene Crosser 1335b4d72c08SEugene Crosser static int qeth_bridgeport_query_ports_cb(struct qeth_card *card, 1336b4d72c08SEugene Crosser struct qeth_reply *reply, unsigned long data) 1337b4d72c08SEugene Crosser { 1338b4d72c08SEugene Crosser struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *) data; 1339b4d72c08SEugene Crosser struct qeth_sbp_query_ports *qports = &cmd->data.sbp.data.query_ports; 1340b4d72c08SEugene Crosser struct _qeth_sbp_cbctl *cbctl = (struct _qeth_sbp_cbctl *)reply->param; 13411709ff8dSJulian Wiedmann int rc; 1342b4d72c08SEugene Crosser 1343b4d72c08SEugene Crosser QETH_CARD_TEXT(card, 2, "brqprtcb"); 13441709ff8dSJulian Wiedmann rc = qeth_bridgeport_makerc(card, cmd); 13451709ff8dSJulian Wiedmann if (rc) 13461709ff8dSJulian Wiedmann return rc; 13471709ff8dSJulian Wiedmann 1348b4d72c08SEugene Crosser if (qports->entry_length != sizeof(struct qeth_sbp_port_entry)) { 1349b4d72c08SEugene Crosser QETH_CARD_TEXT_(card, 2, "SBPs%04x", qports->entry_length); 13501709ff8dSJulian Wiedmann return -EINVAL; 1351b4d72c08SEugene Crosser } 1352b4d72c08SEugene Crosser /* first entry contains the state of the local port */ 1353b4d72c08SEugene Crosser if (qports->num_entries > 0) { 1354b4d72c08SEugene Crosser if (cbctl->data.qports.role) 1355b4d72c08SEugene Crosser *cbctl->data.qports.role = qports->entry[0].role; 1356b4d72c08SEugene Crosser if (cbctl->data.qports.state) 1357b4d72c08SEugene Crosser *cbctl->data.qports.state = qports->entry[0].state; 1358b4d72c08SEugene Crosser } 1359b4d72c08SEugene Crosser return 0; 1360b4d72c08SEugene Crosser } 1361b4d72c08SEugene Crosser 1362b4d72c08SEugene Crosser /** 1363b4d72c08SEugene Crosser * qeth_bridgeport_query_ports() - query local bridgeport status. 1364b4d72c08SEugene Crosser * @card: qeth_card structure pointer. 1365b4d72c08SEugene Crosser * @role: Role of the port: 0-none, 1-primary, 2-secondary. 1366b4d72c08SEugene Crosser * @state: State of the port: 0-inactive, 1-standby, 2-active. 1367b4d72c08SEugene Crosser * 1368b4d72c08SEugene Crosser * Returns negative errno-compatible error indication or 0 on success. 1369b4d72c08SEugene Crosser * 1370b4d72c08SEugene Crosser * 'role' and 'state' are not updated in case of hardware operation failure. 1371b4d72c08SEugene Crosser */ 1372b4d72c08SEugene Crosser int qeth_bridgeport_query_ports(struct qeth_card *card, 1373b4d72c08SEugene Crosser enum qeth_sbp_roles *role, enum qeth_sbp_states *state) 1374b4d72c08SEugene Crosser { 1375b4d72c08SEugene Crosser struct qeth_cmd_buffer *iob; 1376b4d72c08SEugene Crosser struct _qeth_sbp_cbctl cbctl = { 1377b4d72c08SEugene Crosser .data = { 1378b4d72c08SEugene Crosser .qports = { 1379b4d72c08SEugene Crosser .role = role, 1380b4d72c08SEugene Crosser .state = state, 1381b4d72c08SEugene Crosser }, 1382b4d72c08SEugene Crosser }, 1383b4d72c08SEugene Crosser }; 1384b4d72c08SEugene Crosser 1385b4d72c08SEugene Crosser QETH_CARD_TEXT(card, 2, "brqports"); 1386b4d72c08SEugene Crosser if (!(card->options.sbp.supported_funcs & IPA_SBP_QUERY_BRIDGE_PORTS)) 1387b4d72c08SEugene Crosser return -EOPNOTSUPP; 1388d65626adSJulian Wiedmann iob = qeth_sbp_build_cmd(card, IPA_SBP_QUERY_BRIDGE_PORTS, 0); 13891aec42bcSThomas Richter if (!iob) 13901aec42bcSThomas Richter return -ENOMEM; 13911709ff8dSJulian Wiedmann 13921709ff8dSJulian Wiedmann return qeth_send_ipa_cmd(card, iob, qeth_bridgeport_query_ports_cb, 13931709ff8dSJulian Wiedmann &cbctl); 1394b4d72c08SEugene Crosser } 1395b4d72c08SEugene Crosser 1396b4d72c08SEugene Crosser static int qeth_bridgeport_set_cb(struct qeth_card *card, 1397b4d72c08SEugene Crosser struct qeth_reply *reply, unsigned long data) 1398b4d72c08SEugene Crosser { 1399b4d72c08SEugene Crosser struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *)data; 14001709ff8dSJulian Wiedmann 1401b4d72c08SEugene Crosser QETH_CARD_TEXT(card, 2, "brsetrcb"); 14021709ff8dSJulian Wiedmann return qeth_bridgeport_makerc(card, cmd); 1403b4d72c08SEugene Crosser } 1404b4d72c08SEugene Crosser 1405b4d72c08SEugene Crosser /** 1406b4d72c08SEugene Crosser * qeth_bridgeport_setrole() - Assign primary role to the port. 1407b4d72c08SEugene Crosser * @card: qeth_card structure pointer. 1408b4d72c08SEugene Crosser * @role: Role to assign. 1409b4d72c08SEugene Crosser * 1410b4d72c08SEugene Crosser * Returns negative errno-compatible error indication or 0 on success. 1411b4d72c08SEugene Crosser */ 1412b4d72c08SEugene Crosser int qeth_bridgeport_setrole(struct qeth_card *card, enum qeth_sbp_roles role) 1413b4d72c08SEugene Crosser { 1414b4d72c08SEugene Crosser struct qeth_cmd_buffer *iob; 1415b4d72c08SEugene Crosser enum qeth_ipa_sbp_cmd setcmd; 1416b9150461SJulian Wiedmann unsigned int cmdlength = 0; 1417b4d72c08SEugene Crosser 1418b4d72c08SEugene Crosser QETH_CARD_TEXT(card, 2, "brsetrol"); 1419b4d72c08SEugene Crosser switch (role) { 1420b4d72c08SEugene Crosser case QETH_SBP_ROLE_NONE: 1421b4d72c08SEugene Crosser setcmd = IPA_SBP_RESET_BRIDGE_PORT_ROLE; 1422b4d72c08SEugene Crosser break; 1423b4d72c08SEugene Crosser case QETH_SBP_ROLE_PRIMARY: 1424b4d72c08SEugene Crosser setcmd = IPA_SBP_SET_PRIMARY_BRIDGE_PORT; 1425b9150461SJulian Wiedmann cmdlength = SBP_DATA_SIZEOF(set_primary); 1426b4d72c08SEugene Crosser break; 1427b4d72c08SEugene Crosser case QETH_SBP_ROLE_SECONDARY: 1428b4d72c08SEugene Crosser setcmd = IPA_SBP_SET_SECONDARY_BRIDGE_PORT; 1429b4d72c08SEugene Crosser break; 1430b4d72c08SEugene Crosser default: 1431b4d72c08SEugene Crosser return -EINVAL; 1432b4d72c08SEugene Crosser } 1433b4d72c08SEugene Crosser if (!(card->options.sbp.supported_funcs & setcmd)) 1434b4d72c08SEugene Crosser return -EOPNOTSUPP; 1435d65626adSJulian Wiedmann iob = qeth_sbp_build_cmd(card, setcmd, cmdlength); 14361aec42bcSThomas Richter if (!iob) 14371aec42bcSThomas Richter return -ENOMEM; 14381709ff8dSJulian Wiedmann 14391709ff8dSJulian Wiedmann return qeth_send_ipa_cmd(card, iob, qeth_bridgeport_set_cb, NULL); 1440b4d72c08SEugene Crosser } 1441b4d72c08SEugene Crosser 14429f48b9dbSEugene Crosser /** 14439f48b9dbSEugene Crosser * qeth_anset_makerc() - derive "traditional" error from hardware codes. 14449f48b9dbSEugene Crosser * @card: qeth_card structure pointer, for debug messages. 14459f48b9dbSEugene Crosser * 14469f48b9dbSEugene Crosser * Returns negative errno-compatible error indication or 0 on success. 14479f48b9dbSEugene Crosser */ 14489f48b9dbSEugene Crosser static int qeth_anset_makerc(struct qeth_card *card, int pnso_rc, u16 response) 14499f48b9dbSEugene Crosser { 14509f48b9dbSEugene Crosser int rc; 14519f48b9dbSEugene Crosser 14529f48b9dbSEugene Crosser if (pnso_rc == 0) 14539f48b9dbSEugene Crosser switch (response) { 14549f48b9dbSEugene Crosser case 0x0001: 14559f48b9dbSEugene Crosser rc = 0; 14569f48b9dbSEugene Crosser break; 14579f48b9dbSEugene Crosser case 0x0004: 14589f48b9dbSEugene Crosser case 0x0100: 14599f48b9dbSEugene Crosser case 0x0106: 1460ffb95251SEugene Crosser rc = -EOPNOTSUPP; 14619f48b9dbSEugene Crosser dev_err(&card->gdev->dev, 14629f48b9dbSEugene Crosser "Setting address notification failed\n"); 14639f48b9dbSEugene Crosser break; 14649f48b9dbSEugene Crosser case 0x0107: 14659f48b9dbSEugene Crosser rc = -EAGAIN; 14669f48b9dbSEugene Crosser break; 14679f48b9dbSEugene Crosser default: 14689f48b9dbSEugene Crosser rc = -EIO; 14699f48b9dbSEugene Crosser } 14709f48b9dbSEugene Crosser else 14719f48b9dbSEugene Crosser rc = -EIO; 14729f48b9dbSEugene Crosser 14739f48b9dbSEugene Crosser if (rc) { 14749f48b9dbSEugene Crosser QETH_CARD_TEXT_(card, 2, "SBPp%04x", pnso_rc); 14759f48b9dbSEugene Crosser QETH_CARD_TEXT_(card, 2, "SBPr%04x", response); 14769f48b9dbSEugene Crosser } 14779f48b9dbSEugene Crosser return rc; 14789f48b9dbSEugene Crosser } 14799f48b9dbSEugene Crosser 14809f48b9dbSEugene Crosser static void qeth_bridgeport_an_set_cb(void *priv, 14819f48b9dbSEugene Crosser enum qdio_brinfo_entry_type type, void *entry) 14829f48b9dbSEugene Crosser { 14839f48b9dbSEugene Crosser struct qeth_card *card = (struct qeth_card *)priv; 14849f48b9dbSEugene Crosser struct qdio_brinfo_entry_l2 *l2entry; 14859f48b9dbSEugene Crosser u8 code; 14869f48b9dbSEugene Crosser 14879f48b9dbSEugene Crosser if (type != l2_addr_lnid) { 14889f48b9dbSEugene Crosser WARN_ON_ONCE(1); 14899f48b9dbSEugene Crosser return; 14909f48b9dbSEugene Crosser } 14919f48b9dbSEugene Crosser 14929f48b9dbSEugene Crosser l2entry = (struct qdio_brinfo_entry_l2 *)entry; 14939f48b9dbSEugene Crosser code = IPA_ADDR_CHANGE_CODE_MACADDR; 149433572619SAlexandra Winter if (l2entry->addr_lnid.lnid < VLAN_N_VID) 14959f48b9dbSEugene Crosser code |= IPA_ADDR_CHANGE_CODE_VLANID; 14969f48b9dbSEugene Crosser qeth_bridge_emit_host_event(card, anev_reg_unreg, code, 14979f48b9dbSEugene Crosser (struct net_if_token *)&l2entry->nit, 14989f48b9dbSEugene Crosser (struct mac_addr_lnid *)&l2entry->addr_lnid); 14999f48b9dbSEugene Crosser } 15009f48b9dbSEugene Crosser 15019f48b9dbSEugene Crosser /** 15029f48b9dbSEugene Crosser * qeth_bridgeport_an_set() - Enable or disable bridgeport address notification 15039f48b9dbSEugene Crosser * @card: qeth_card structure pointer. 15049f48b9dbSEugene Crosser * @enable: 0 - disable, non-zero - enable notifications 15059f48b9dbSEugene Crosser * 15069f48b9dbSEugene Crosser * Returns negative errno-compatible error indication or 0 on success. 15079f48b9dbSEugene Crosser * 15089f48b9dbSEugene Crosser * On enable, emits a series of address notifications udev events for all 15099f48b9dbSEugene Crosser * currently registered hosts. 15109f48b9dbSEugene Crosser */ 15119f48b9dbSEugene Crosser int qeth_bridgeport_an_set(struct qeth_card *card, int enable) 15129f48b9dbSEugene Crosser { 15139f48b9dbSEugene Crosser int rc; 15149f48b9dbSEugene Crosser u16 response; 15159f48b9dbSEugene Crosser struct ccw_device *ddev; 15169f48b9dbSEugene Crosser struct subchannel_id schid; 15179f48b9dbSEugene Crosser 15189f48b9dbSEugene Crosser if (!card) 15199f48b9dbSEugene Crosser return -EINVAL; 15209f48b9dbSEugene Crosser if (!card->options.sbp.supported_funcs) 15219f48b9dbSEugene Crosser return -EOPNOTSUPP; 15229f48b9dbSEugene Crosser ddev = CARD_DDEV(card); 15239f48b9dbSEugene Crosser ccw_device_get_schid(ddev, &schid); 15249f48b9dbSEugene Crosser 15259f48b9dbSEugene Crosser if (enable) { 15269f48b9dbSEugene Crosser qeth_bridge_emit_host_event(card, anev_reset, 0, NULL, NULL); 15279f48b9dbSEugene Crosser rc = qdio_pnso_brinfo(schid, 1, &response, 15289f48b9dbSEugene Crosser qeth_bridgeport_an_set_cb, card); 15299f48b9dbSEugene Crosser } else 15309f48b9dbSEugene Crosser rc = qdio_pnso_brinfo(schid, 0, &response, NULL, NULL); 15319f48b9dbSEugene Crosser return qeth_anset_makerc(card, rc, response); 15329f48b9dbSEugene Crosser } 15339f48b9dbSEugene Crosser 1534caa1f0b1SHans Wippel static bool qeth_bridgeport_is_in_use(struct qeth_card *card) 1535caa1f0b1SHans Wippel { 1536caa1f0b1SHans Wippel return (card->options.sbp.role || card->options.sbp.reflect_promisc || 1537caa1f0b1SHans Wippel card->options.sbp.hostnotification); 1538caa1f0b1SHans Wippel } 1539caa1f0b1SHans Wippel 1540a45b3fafSHans Wippel /* VNIC Characteristics support */ 1541a45b3fafSHans Wippel 1542a45b3fafSHans Wippel /* handle VNICC IPA command return codes; convert to error codes */ 1543742d4d40SJulian Wiedmann static int qeth_l2_vnicc_makerc(struct qeth_card *card, u16 ipa_rc) 1544a45b3fafSHans Wippel { 1545a45b3fafSHans Wippel int rc; 1546a45b3fafSHans Wippel 1547a45b3fafSHans Wippel switch (ipa_rc) { 1548a45b3fafSHans Wippel case IPA_RC_SUCCESS: 1549a45b3fafSHans Wippel return ipa_rc; 1550a45b3fafSHans Wippel case IPA_RC_L2_UNSUPPORTED_CMD: 1551a45b3fafSHans Wippel case IPA_RC_NOTSUPP: 1552a45b3fafSHans Wippel rc = -EOPNOTSUPP; 1553a45b3fafSHans Wippel break; 1554a45b3fafSHans Wippel case IPA_RC_VNICC_OOSEQ: 1555a45b3fafSHans Wippel rc = -EALREADY; 1556a45b3fafSHans Wippel break; 1557a45b3fafSHans Wippel case IPA_RC_VNICC_VNICBP: 1558a45b3fafSHans Wippel rc = -EBUSY; 1559a45b3fafSHans Wippel break; 1560a45b3fafSHans Wippel case IPA_RC_L2_ADDR_TABLE_FULL: 1561a45b3fafSHans Wippel rc = -ENOSPC; 1562a45b3fafSHans Wippel break; 1563a45b3fafSHans Wippel case IPA_RC_L2_MAC_NOT_AUTH_BY_ADP: 1564a45b3fafSHans Wippel rc = -EACCES; 1565a45b3fafSHans Wippel break; 1566a45b3fafSHans Wippel default: 1567a45b3fafSHans Wippel rc = -EIO; 1568a45b3fafSHans Wippel } 1569a45b3fafSHans Wippel 1570a45b3fafSHans Wippel QETH_CARD_TEXT_(card, 2, "err%04x", ipa_rc); 1571a45b3fafSHans Wippel return rc; 1572a45b3fafSHans Wippel } 1573a45b3fafSHans Wippel 1574a45b3fafSHans Wippel /* generic VNICC request call back control */ 1575a45b3fafSHans Wippel struct _qeth_l2_vnicc_request_cbctl { 1576caa1f0b1SHans Wippel struct { 1577349d13d5SHans Wippel union{ 1578caa1f0b1SHans Wippel u32 *sup_cmds; 1579349d13d5SHans Wippel u32 *timeout; 1580349d13d5SHans Wippel }; 1581caa1f0b1SHans Wippel } result; 1582a45b3fafSHans Wippel }; 1583a45b3fafSHans Wippel 1584a45b3fafSHans Wippel /* generic VNICC request call back */ 1585a45b3fafSHans Wippel static int qeth_l2_vnicc_request_cb(struct qeth_card *card, 1586a45b3fafSHans Wippel struct qeth_reply *reply, 1587a45b3fafSHans Wippel unsigned long data) 1588a45b3fafSHans Wippel { 1589caa1f0b1SHans Wippel struct _qeth_l2_vnicc_request_cbctl *cbctl = 1590caa1f0b1SHans Wippel (struct _qeth_l2_vnicc_request_cbctl *) reply->param; 1591a45b3fafSHans Wippel struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *) data; 1592a45b3fafSHans Wippel struct qeth_ipacmd_vnicc *rep = &cmd->data.vnicc; 15932744d811SJulian Wiedmann u32 sub_cmd = cmd->data.vnicc.hdr.sub_command; 1594a45b3fafSHans Wippel 1595a45b3fafSHans Wippel QETH_CARD_TEXT(card, 2, "vniccrcb"); 1596a45b3fafSHans Wippel if (cmd->hdr.return_code) 1597742d4d40SJulian Wiedmann return qeth_l2_vnicc_makerc(card, cmd->hdr.return_code); 1598a45b3fafSHans Wippel /* return results to caller */ 15992cfb4810SJulian Wiedmann card->options.vnicc.sup_chars = rep->vnicc_cmds.supported; 16002cfb4810SJulian Wiedmann card->options.vnicc.cur_chars = rep->vnicc_cmds.enabled; 1601a45b3fafSHans Wippel 16022744d811SJulian Wiedmann if (sub_cmd == IPA_VNICC_QUERY_CMDS) 16032cfb4810SJulian Wiedmann *cbctl->result.sup_cmds = rep->data.query_cmds.sup_cmds; 16042744d811SJulian Wiedmann else if (sub_cmd == IPA_VNICC_GET_TIMEOUT) 16052cfb4810SJulian Wiedmann *cbctl->result.timeout = rep->data.getset_timeout.timeout; 1606349d13d5SHans Wippel 1607a45b3fafSHans Wippel return 0; 1608a45b3fafSHans Wippel } 1609a45b3fafSHans Wippel 16102cfb4810SJulian Wiedmann static struct qeth_cmd_buffer *qeth_l2_vnicc_build_cmd(struct qeth_card *card, 16112cfb4810SJulian Wiedmann u32 vnicc_cmd, 16122cfb4810SJulian Wiedmann unsigned int data_length) 1613a45b3fafSHans Wippel { 16142cfb4810SJulian Wiedmann struct qeth_ipacmd_vnicc_hdr *hdr; 1615a45b3fafSHans Wippel struct qeth_cmd_buffer *iob; 1616a45b3fafSHans Wippel 16172cfb4810SJulian Wiedmann iob = qeth_ipa_alloc_cmd(card, IPA_CMD_VNICC, QETH_PROT_NONE, 16182cfb4810SJulian Wiedmann data_length + 16192cfb4810SJulian Wiedmann offsetof(struct qeth_ipacmd_vnicc, data)); 1620a45b3fafSHans Wippel if (!iob) 16212cfb4810SJulian Wiedmann return NULL; 1622a45b3fafSHans Wippel 16232cfb4810SJulian Wiedmann hdr = &__ipa_cmd(iob)->data.vnicc.hdr; 16242cfb4810SJulian Wiedmann hdr->data_length = sizeof(*hdr) + data_length; 16252cfb4810SJulian Wiedmann hdr->sub_command = vnicc_cmd; 16262cfb4810SJulian Wiedmann return iob; 1627a45b3fafSHans Wippel } 1628a45b3fafSHans Wippel 1629a45b3fafSHans Wippel /* VNICC query VNIC characteristics request */ 1630a45b3fafSHans Wippel static int qeth_l2_vnicc_query_chars(struct qeth_card *card) 1631a45b3fafSHans Wippel { 16322cfb4810SJulian Wiedmann struct qeth_cmd_buffer *iob; 16332cfb4810SJulian Wiedmann 16342cfb4810SJulian Wiedmann QETH_CARD_TEXT(card, 2, "vniccqch"); 16352cfb4810SJulian Wiedmann iob = qeth_l2_vnicc_build_cmd(card, IPA_VNICC_QUERY_CHARS, 0); 16362cfb4810SJulian Wiedmann if (!iob) 16372cfb4810SJulian Wiedmann return -ENOMEM; 1638a45b3fafSHans Wippel 16392744d811SJulian Wiedmann return qeth_send_ipa_cmd(card, iob, qeth_l2_vnicc_request_cb, NULL); 1640a45b3fafSHans Wippel } 1641a45b3fafSHans Wippel 1642caa1f0b1SHans Wippel /* VNICC query sub commands request */ 1643caa1f0b1SHans Wippel static int qeth_l2_vnicc_query_cmds(struct qeth_card *card, u32 vnic_char, 1644caa1f0b1SHans Wippel u32 *sup_cmds) 1645caa1f0b1SHans Wippel { 1646caa1f0b1SHans Wippel struct _qeth_l2_vnicc_request_cbctl cbctl; 16472cfb4810SJulian Wiedmann struct qeth_cmd_buffer *iob; 16482cfb4810SJulian Wiedmann 16492cfb4810SJulian Wiedmann QETH_CARD_TEXT(card, 2, "vniccqcm"); 16502cfb4810SJulian Wiedmann iob = qeth_l2_vnicc_build_cmd(card, IPA_VNICC_QUERY_CMDS, 16512cfb4810SJulian Wiedmann VNICC_DATA_SIZEOF(query_cmds)); 16522cfb4810SJulian Wiedmann if (!iob) 16532cfb4810SJulian Wiedmann return -ENOMEM; 16542cfb4810SJulian Wiedmann 16552cfb4810SJulian Wiedmann __ipa_cmd(iob)->data.vnicc.data.query_cmds.vnic_char = vnic_char; 1656caa1f0b1SHans Wippel 1657caa1f0b1SHans Wippel /* prepare callback control */ 1658caa1f0b1SHans Wippel cbctl.result.sup_cmds = sup_cmds; 1659caa1f0b1SHans Wippel 16602cfb4810SJulian Wiedmann return qeth_send_ipa_cmd(card, iob, qeth_l2_vnicc_request_cb, &cbctl); 1661caa1f0b1SHans Wippel } 1662caa1f0b1SHans Wippel 1663caa1f0b1SHans Wippel /* VNICC enable/disable characteristic request */ 1664caa1f0b1SHans Wippel static int qeth_l2_vnicc_set_char(struct qeth_card *card, u32 vnic_char, 1665caa1f0b1SHans Wippel u32 cmd) 1666caa1f0b1SHans Wippel { 16672cfb4810SJulian Wiedmann struct qeth_cmd_buffer *iob; 16682cfb4810SJulian Wiedmann 16692cfb4810SJulian Wiedmann QETH_CARD_TEXT(card, 2, "vniccedc"); 16702cfb4810SJulian Wiedmann iob = qeth_l2_vnicc_build_cmd(card, cmd, VNICC_DATA_SIZEOF(set_char)); 16712cfb4810SJulian Wiedmann if (!iob) 16722cfb4810SJulian Wiedmann return -ENOMEM; 16732cfb4810SJulian Wiedmann 16742cfb4810SJulian Wiedmann __ipa_cmd(iob)->data.vnicc.data.set_char.vnic_char = vnic_char; 1675caa1f0b1SHans Wippel 16762744d811SJulian Wiedmann return qeth_send_ipa_cmd(card, iob, qeth_l2_vnicc_request_cb, NULL); 1677caa1f0b1SHans Wippel } 1678caa1f0b1SHans Wippel 1679349d13d5SHans Wippel /* VNICC get/set timeout for characteristic request */ 1680349d13d5SHans Wippel static int qeth_l2_vnicc_getset_timeout(struct qeth_card *card, u32 vnicc, 1681349d13d5SHans Wippel u32 cmd, u32 *timeout) 1682349d13d5SHans Wippel { 16832cfb4810SJulian Wiedmann struct qeth_vnicc_getset_timeout *getset_timeout; 1684349d13d5SHans Wippel struct _qeth_l2_vnicc_request_cbctl cbctl; 16852cfb4810SJulian Wiedmann struct qeth_cmd_buffer *iob; 16862cfb4810SJulian Wiedmann 16872cfb4810SJulian Wiedmann QETH_CARD_TEXT(card, 2, "vniccgst"); 16882cfb4810SJulian Wiedmann iob = qeth_l2_vnicc_build_cmd(card, cmd, 16892cfb4810SJulian Wiedmann VNICC_DATA_SIZEOF(getset_timeout)); 16902cfb4810SJulian Wiedmann if (!iob) 16912cfb4810SJulian Wiedmann return -ENOMEM; 16922cfb4810SJulian Wiedmann 16932cfb4810SJulian Wiedmann getset_timeout = &__ipa_cmd(iob)->data.vnicc.data.getset_timeout; 16942cfb4810SJulian Wiedmann getset_timeout->vnic_char = vnicc; 16952cfb4810SJulian Wiedmann 16962cfb4810SJulian Wiedmann if (cmd == IPA_VNICC_SET_TIMEOUT) 16972cfb4810SJulian Wiedmann getset_timeout->timeout = *timeout; 1698349d13d5SHans Wippel 1699349d13d5SHans Wippel /* prepare callback control */ 1700349d13d5SHans Wippel if (cmd == IPA_VNICC_GET_TIMEOUT) 1701349d13d5SHans Wippel cbctl.result.timeout = timeout; 1702349d13d5SHans Wippel 17032cfb4810SJulian Wiedmann return qeth_send_ipa_cmd(card, iob, qeth_l2_vnicc_request_cb, &cbctl); 1704349d13d5SHans Wippel } 1705349d13d5SHans Wippel 1706caa1f0b1SHans Wippel /* set current VNICC flag state; called from sysfs store function */ 1707caa1f0b1SHans Wippel int qeth_l2_vnicc_set_state(struct qeth_card *card, u32 vnicc, bool state) 1708caa1f0b1SHans Wippel { 1709caa1f0b1SHans Wippel int rc = 0; 1710caa1f0b1SHans Wippel u32 cmd; 1711caa1f0b1SHans Wippel 1712caa1f0b1SHans Wippel QETH_CARD_TEXT(card, 2, "vniccsch"); 1713caa1f0b1SHans Wippel 1714caa1f0b1SHans Wippel /* do not change anything if BridgePort is enabled */ 1715caa1f0b1SHans Wippel if (qeth_bridgeport_is_in_use(card)) 1716caa1f0b1SHans Wippel return -EBUSY; 1717caa1f0b1SHans Wippel 1718caa1f0b1SHans Wippel /* check if characteristic and enable/disable are supported */ 1719caa1f0b1SHans Wippel if (!(card->options.vnicc.sup_chars & vnicc) || 1720caa1f0b1SHans Wippel !(card->options.vnicc.set_char_sup & vnicc)) 1721caa1f0b1SHans Wippel return -EOPNOTSUPP; 1722caa1f0b1SHans Wippel 1723caa1f0b1SHans Wippel /* set enable/disable command and store wanted characteristic */ 1724caa1f0b1SHans Wippel if (state) { 1725caa1f0b1SHans Wippel cmd = IPA_VNICC_ENABLE; 1726caa1f0b1SHans Wippel card->options.vnicc.wanted_chars |= vnicc; 1727caa1f0b1SHans Wippel } else { 1728caa1f0b1SHans Wippel cmd = IPA_VNICC_DISABLE; 1729caa1f0b1SHans Wippel card->options.vnicc.wanted_chars &= ~vnicc; 1730caa1f0b1SHans Wippel } 1731caa1f0b1SHans Wippel 1732caa1f0b1SHans Wippel /* do we need to do anything? */ 1733caa1f0b1SHans Wippel if (card->options.vnicc.cur_chars == card->options.vnicc.wanted_chars) 1734caa1f0b1SHans Wippel return rc; 1735caa1f0b1SHans Wippel 1736caa1f0b1SHans Wippel /* if card is not ready, simply stop here */ 1737caa1f0b1SHans Wippel if (!qeth_card_hw_is_reachable(card)) { 1738caa1f0b1SHans Wippel if (state) 1739caa1f0b1SHans Wippel card->options.vnicc.cur_chars |= vnicc; 1740caa1f0b1SHans Wippel else 1741caa1f0b1SHans Wippel card->options.vnicc.cur_chars &= ~vnicc; 1742caa1f0b1SHans Wippel return rc; 1743caa1f0b1SHans Wippel } 1744caa1f0b1SHans Wippel 1745caa1f0b1SHans Wippel rc = qeth_l2_vnicc_set_char(card, vnicc, cmd); 1746caa1f0b1SHans Wippel if (rc) 1747caa1f0b1SHans Wippel card->options.vnicc.wanted_chars = 1748caa1f0b1SHans Wippel card->options.vnicc.cur_chars; 1749349d13d5SHans Wippel else { 1750349d13d5SHans Wippel /* successful online VNICC change; handle special cases */ 1751349d13d5SHans Wippel if (state && vnicc == QETH_VNICC_RX_BCAST) 1752caa1f0b1SHans Wippel card->options.vnicc.rx_bcast_enabled = true; 1753349d13d5SHans Wippel if (!state && vnicc == QETH_VNICC_LEARNING) 1754349d13d5SHans Wippel qeth_l2_vnicc_recover_timeout(card, vnicc, 1755349d13d5SHans Wippel &card->options.vnicc.learning_timeout); 1756349d13d5SHans Wippel } 1757caa1f0b1SHans Wippel 1758caa1f0b1SHans Wippel return rc; 1759caa1f0b1SHans Wippel } 1760caa1f0b1SHans Wippel 1761caa1f0b1SHans Wippel /* get current VNICC flag state; called from sysfs show function */ 1762caa1f0b1SHans Wippel int qeth_l2_vnicc_get_state(struct qeth_card *card, u32 vnicc, bool *state) 1763caa1f0b1SHans Wippel { 1764caa1f0b1SHans Wippel int rc = 0; 1765caa1f0b1SHans Wippel 1766caa1f0b1SHans Wippel QETH_CARD_TEXT(card, 2, "vniccgch"); 1767caa1f0b1SHans Wippel 1768caa1f0b1SHans Wippel /* do not get anything if BridgePort is enabled */ 1769caa1f0b1SHans Wippel if (qeth_bridgeport_is_in_use(card)) 1770caa1f0b1SHans Wippel return -EBUSY; 1771caa1f0b1SHans Wippel 1772caa1f0b1SHans Wippel /* check if characteristic is supported */ 1773caa1f0b1SHans Wippel if (!(card->options.vnicc.sup_chars & vnicc)) 1774caa1f0b1SHans Wippel return -EOPNOTSUPP; 1775caa1f0b1SHans Wippel 1776caa1f0b1SHans Wippel /* if card is ready, query current VNICC state */ 1777caa1f0b1SHans Wippel if (qeth_card_hw_is_reachable(card)) 1778caa1f0b1SHans Wippel rc = qeth_l2_vnicc_query_chars(card); 1779caa1f0b1SHans Wippel 1780caa1f0b1SHans Wippel *state = (card->options.vnicc.cur_chars & vnicc) ? true : false; 1781caa1f0b1SHans Wippel return rc; 1782caa1f0b1SHans Wippel } 1783caa1f0b1SHans Wippel 1784349d13d5SHans Wippel /* set VNICC timeout; called from sysfs store function. Currently, only learning 1785349d13d5SHans Wippel * supports timeout 1786349d13d5SHans Wippel */ 1787349d13d5SHans Wippel int qeth_l2_vnicc_set_timeout(struct qeth_card *card, u32 timeout) 1788349d13d5SHans Wippel { 1789349d13d5SHans Wippel int rc = 0; 1790349d13d5SHans Wippel 1791349d13d5SHans Wippel QETH_CARD_TEXT(card, 2, "vniccsto"); 1792349d13d5SHans Wippel 1793349d13d5SHans Wippel /* do not change anything if BridgePort is enabled */ 1794349d13d5SHans Wippel if (qeth_bridgeport_is_in_use(card)) 1795349d13d5SHans Wippel return -EBUSY; 1796349d13d5SHans Wippel 1797349d13d5SHans Wippel /* check if characteristic and set_timeout are supported */ 1798349d13d5SHans Wippel if (!(card->options.vnicc.sup_chars & QETH_VNICC_LEARNING) || 1799349d13d5SHans Wippel !(card->options.vnicc.getset_timeout_sup & QETH_VNICC_LEARNING)) 1800349d13d5SHans Wippel return -EOPNOTSUPP; 1801349d13d5SHans Wippel 1802349d13d5SHans Wippel /* do we need to do anything? */ 1803349d13d5SHans Wippel if (card->options.vnicc.learning_timeout == timeout) 1804349d13d5SHans Wippel return rc; 1805349d13d5SHans Wippel 1806349d13d5SHans Wippel /* if card is not ready, simply store the value internally and return */ 1807349d13d5SHans Wippel if (!qeth_card_hw_is_reachable(card)) { 1808349d13d5SHans Wippel card->options.vnicc.learning_timeout = timeout; 1809349d13d5SHans Wippel return rc; 1810349d13d5SHans Wippel } 1811349d13d5SHans Wippel 1812349d13d5SHans Wippel /* send timeout value to card; if successful, store value internally */ 1813349d13d5SHans Wippel rc = qeth_l2_vnicc_getset_timeout(card, QETH_VNICC_LEARNING, 1814349d13d5SHans Wippel IPA_VNICC_SET_TIMEOUT, &timeout); 1815349d13d5SHans Wippel if (!rc) 1816349d13d5SHans Wippel card->options.vnicc.learning_timeout = timeout; 1817349d13d5SHans Wippel 1818349d13d5SHans Wippel return rc; 1819349d13d5SHans Wippel } 1820349d13d5SHans Wippel 1821349d13d5SHans Wippel /* get current VNICC timeout; called from sysfs show function. Currently, only 1822349d13d5SHans Wippel * learning supports timeout 1823349d13d5SHans Wippel */ 1824349d13d5SHans Wippel int qeth_l2_vnicc_get_timeout(struct qeth_card *card, u32 *timeout) 1825349d13d5SHans Wippel { 1826349d13d5SHans Wippel int rc = 0; 1827349d13d5SHans Wippel 1828349d13d5SHans Wippel QETH_CARD_TEXT(card, 2, "vniccgto"); 1829349d13d5SHans Wippel 1830349d13d5SHans Wippel /* do not get anything if BridgePort is enabled */ 1831349d13d5SHans Wippel if (qeth_bridgeport_is_in_use(card)) 1832349d13d5SHans Wippel return -EBUSY; 1833349d13d5SHans Wippel 1834349d13d5SHans Wippel /* check if characteristic and get_timeout are supported */ 1835349d13d5SHans Wippel if (!(card->options.vnicc.sup_chars & QETH_VNICC_LEARNING) || 1836349d13d5SHans Wippel !(card->options.vnicc.getset_timeout_sup & QETH_VNICC_LEARNING)) 1837349d13d5SHans Wippel return -EOPNOTSUPP; 1838349d13d5SHans Wippel /* if card is ready, get timeout. Otherwise, just return stored value */ 1839349d13d5SHans Wippel *timeout = card->options.vnicc.learning_timeout; 1840349d13d5SHans Wippel if (qeth_card_hw_is_reachable(card)) 1841349d13d5SHans Wippel rc = qeth_l2_vnicc_getset_timeout(card, QETH_VNICC_LEARNING, 1842349d13d5SHans Wippel IPA_VNICC_GET_TIMEOUT, 1843349d13d5SHans Wippel timeout); 1844349d13d5SHans Wippel 1845349d13d5SHans Wippel return rc; 1846349d13d5SHans Wippel } 1847349d13d5SHans Wippel 1848caa1f0b1SHans Wippel /* check if VNICC is currently enabled */ 1849caa1f0b1SHans Wippel bool qeth_l2_vnicc_is_in_use(struct qeth_card *card) 1850caa1f0b1SHans Wippel { 1851e8a66d80SAlexandra Winter if (!card->options.vnicc.sup_chars) 1852caa1f0b1SHans Wippel return false; 1853caa1f0b1SHans Wippel /* default values are only OK if rx_bcast was not enabled by user 1854caa1f0b1SHans Wippel * or the card is offline. 1855caa1f0b1SHans Wippel */ 1856caa1f0b1SHans Wippel if (card->options.vnicc.cur_chars == QETH_VNICC_DEFAULT) { 1857caa1f0b1SHans Wippel if (!card->options.vnicc.rx_bcast_enabled || 1858caa1f0b1SHans Wippel !qeth_card_hw_is_reachable(card)) 1859caa1f0b1SHans Wippel return false; 1860caa1f0b1SHans Wippel } 1861caa1f0b1SHans Wippel return true; 1862caa1f0b1SHans Wippel } 1863caa1f0b1SHans Wippel 1864349d13d5SHans Wippel /* recover user timeout setting */ 1865349d13d5SHans Wippel static bool qeth_l2_vnicc_recover_timeout(struct qeth_card *card, u32 vnicc, 1866349d13d5SHans Wippel u32 *timeout) 1867349d13d5SHans Wippel { 1868349d13d5SHans Wippel if (card->options.vnicc.sup_chars & vnicc && 1869349d13d5SHans Wippel card->options.vnicc.getset_timeout_sup & vnicc && 1870349d13d5SHans Wippel !qeth_l2_vnicc_getset_timeout(card, vnicc, IPA_VNICC_SET_TIMEOUT, 1871349d13d5SHans Wippel timeout)) 1872349d13d5SHans Wippel return false; 1873349d13d5SHans Wippel *timeout = QETH_VNICC_DEFAULT_TIMEOUT; 1874349d13d5SHans Wippel return true; 1875349d13d5SHans Wippel } 1876349d13d5SHans Wippel 1877caa1f0b1SHans Wippel /* recover user characteristic setting */ 1878caa1f0b1SHans Wippel static bool qeth_l2_vnicc_recover_char(struct qeth_card *card, u32 vnicc, 1879caa1f0b1SHans Wippel bool enable) 1880caa1f0b1SHans Wippel { 1881caa1f0b1SHans Wippel u32 cmd = enable ? IPA_VNICC_ENABLE : IPA_VNICC_DISABLE; 1882caa1f0b1SHans Wippel 1883caa1f0b1SHans Wippel if (card->options.vnicc.sup_chars & vnicc && 1884caa1f0b1SHans Wippel card->options.vnicc.set_char_sup & vnicc && 1885caa1f0b1SHans Wippel !qeth_l2_vnicc_set_char(card, vnicc, cmd)) 1886caa1f0b1SHans Wippel return false; 1887caa1f0b1SHans Wippel card->options.vnicc.wanted_chars &= ~vnicc; 1888caa1f0b1SHans Wippel card->options.vnicc.wanted_chars |= QETH_VNICC_DEFAULT & vnicc; 1889caa1f0b1SHans Wippel return true; 1890caa1f0b1SHans Wippel } 1891caa1f0b1SHans Wippel 1892a45b3fafSHans Wippel /* (re-)initialize VNICC */ 1893a45b3fafSHans Wippel static void qeth_l2_vnicc_init(struct qeth_card *card) 1894a45b3fafSHans Wippel { 1895349d13d5SHans Wippel u32 *timeout = &card->options.vnicc.learning_timeout; 1896b528965bSAlexandra Winter bool enable, error = false; 1897caa1f0b1SHans Wippel unsigned int chars_len, i; 1898caa1f0b1SHans Wippel unsigned long chars_tmp; 1899caa1f0b1SHans Wippel u32 sup_cmds, vnicc; 1900caa1f0b1SHans Wippel 1901a45b3fafSHans Wippel QETH_CARD_TEXT(card, 2, "vniccini"); 1902caa1f0b1SHans Wippel /* reset rx_bcast */ 1903caa1f0b1SHans Wippel card->options.vnicc.rx_bcast_enabled = 0; 1904a45b3fafSHans Wippel /* initial query and storage of VNIC characteristics */ 1905a45b3fafSHans Wippel if (qeth_l2_vnicc_query_chars(card)) { 1906349d13d5SHans Wippel if (card->options.vnicc.wanted_chars != QETH_VNICC_DEFAULT || 1907349d13d5SHans Wippel *timeout != QETH_VNICC_DEFAULT_TIMEOUT) 1908caa1f0b1SHans Wippel dev_err(&card->gdev->dev, "Configuring the VNIC characteristics failed\n"); 1909caa1f0b1SHans Wippel /* fail quietly if user didn't change the default config */ 1910a45b3fafSHans Wippel card->options.vnicc.sup_chars = 0; 1911a45b3fafSHans Wippel card->options.vnicc.cur_chars = 0; 1912caa1f0b1SHans Wippel card->options.vnicc.wanted_chars = QETH_VNICC_DEFAULT; 1913caa1f0b1SHans Wippel return; 1914a45b3fafSHans Wippel } 1915caa1f0b1SHans Wippel /* get supported commands for each supported characteristic */ 1916caa1f0b1SHans Wippel chars_tmp = card->options.vnicc.sup_chars; 1917caa1f0b1SHans Wippel chars_len = sizeof(card->options.vnicc.sup_chars) * BITS_PER_BYTE; 1918caa1f0b1SHans Wippel for_each_set_bit(i, &chars_tmp, chars_len) { 1919caa1f0b1SHans Wippel vnicc = BIT(i); 1920b528965bSAlexandra Winter if (qeth_l2_vnicc_query_cmds(card, vnicc, &sup_cmds)) { 1921b528965bSAlexandra Winter sup_cmds = 0; 1922b528965bSAlexandra Winter error = true; 1923b528965bSAlexandra Winter } 1924be40a86cSAlexandra Winter if ((sup_cmds & IPA_VNICC_SET_TIMEOUT) && 1925be40a86cSAlexandra Winter (sup_cmds & IPA_VNICC_GET_TIMEOUT)) 1926be40a86cSAlexandra Winter card->options.vnicc.getset_timeout_sup |= vnicc; 1927be40a86cSAlexandra Winter else 1928349d13d5SHans Wippel card->options.vnicc.getset_timeout_sup &= ~vnicc; 1929be40a86cSAlexandra Winter if ((sup_cmds & IPA_VNICC_ENABLE) && 1930be40a86cSAlexandra Winter (sup_cmds & IPA_VNICC_DISABLE)) 1931be40a86cSAlexandra Winter card->options.vnicc.set_char_sup |= vnicc; 1932be40a86cSAlexandra Winter else 1933caa1f0b1SHans Wippel card->options.vnicc.set_char_sup &= ~vnicc; 1934caa1f0b1SHans Wippel } 1935caa1f0b1SHans Wippel /* enforce assumed default values and recover settings, if changed */ 1936b528965bSAlexandra Winter error |= qeth_l2_vnicc_recover_timeout(card, QETH_VNICC_LEARNING, 1937349d13d5SHans Wippel timeout); 1938d1b9ae18SAlexandra Winter /* Change chars, if necessary */ 1939d1b9ae18SAlexandra Winter chars_tmp = card->options.vnicc.wanted_chars ^ 1940d1b9ae18SAlexandra Winter card->options.vnicc.cur_chars; 1941caa1f0b1SHans Wippel chars_len = sizeof(card->options.vnicc.wanted_chars) * BITS_PER_BYTE; 1942caa1f0b1SHans Wippel for_each_set_bit(i, &chars_tmp, chars_len) { 1943caa1f0b1SHans Wippel vnicc = BIT(i); 1944caa1f0b1SHans Wippel enable = card->options.vnicc.wanted_chars & vnicc; 1945caa1f0b1SHans Wippel error |= qeth_l2_vnicc_recover_char(card, vnicc, enable); 1946caa1f0b1SHans Wippel } 1947caa1f0b1SHans Wippel if (error) 1948caa1f0b1SHans Wippel dev_err(&card->gdev->dev, "Configuring the VNIC characteristics failed\n"); 1949caa1f0b1SHans Wippel } 1950caa1f0b1SHans Wippel 1951caa1f0b1SHans Wippel /* configure default values of VNIC characteristics */ 1952caa1f0b1SHans Wippel static void qeth_l2_vnicc_set_defaults(struct qeth_card *card) 1953caa1f0b1SHans Wippel { 1954caa1f0b1SHans Wippel /* characteristics values */ 1955caa1f0b1SHans Wippel card->options.vnicc.sup_chars = QETH_VNICC_ALL; 1956caa1f0b1SHans Wippel card->options.vnicc.cur_chars = QETH_VNICC_DEFAULT; 1957349d13d5SHans Wippel card->options.vnicc.learning_timeout = QETH_VNICC_DEFAULT_TIMEOUT; 1958caa1f0b1SHans Wippel /* supported commands */ 1959caa1f0b1SHans Wippel card->options.vnicc.set_char_sup = QETH_VNICC_ALL; 1960349d13d5SHans Wippel card->options.vnicc.getset_timeout_sup = QETH_VNICC_LEARNING; 1961caa1f0b1SHans Wippel /* settings wanted by users */ 1962caa1f0b1SHans Wippel card->options.vnicc.wanted_chars = QETH_VNICC_DEFAULT; 1963a45b3fafSHans Wippel } 1964a45b3fafSHans Wippel 19654a71df50SFrank Blaschka module_init(qeth_l2_init); 19664a71df50SFrank Blaschka module_exit(qeth_l2_exit); 19674a71df50SFrank Blaschka MODULE_AUTHOR("Frank Blaschka <frank.blaschka@de.ibm.com>"); 19684a71df50SFrank Blaschka MODULE_DESCRIPTION("qeth layer 2 discipline"); 19694a71df50SFrank Blaschka MODULE_LICENSE("GPL"); 1970