1ab9953ffSGreg Kroah-Hartman // SPDX-License-Identifier: GPL-2.0 24a71df50SFrank Blaschka /* 3bbcfcdc8SFrank Blaschka * Copyright IBM Corp. 2007, 2009 44a71df50SFrank Blaschka * Author(s): Utz Bacher <utz.bacher@de.ibm.com>, 54a71df50SFrank Blaschka * Frank Pavlic <fpavlic@de.ibm.com>, 64a71df50SFrank Blaschka * Thomas Spatzier <tspat@de.ibm.com>, 74a71df50SFrank Blaschka * Frank Blaschka <frank.blaschka@de.ibm.com> 84a71df50SFrank Blaschka */ 94a71df50SFrank Blaschka 1074eacdb9SFrank Blaschka #define KMSG_COMPONENT "qeth" 1174eacdb9SFrank Blaschka #define pr_fmt(fmt) KMSG_COMPONENT ": " fmt 1274eacdb9SFrank Blaschka 134a71df50SFrank Blaschka #include <linux/module.h> 144a71df50SFrank Blaschka #include <linux/moduleparam.h> 154a71df50SFrank Blaschka #include <linux/string.h> 164a71df50SFrank Blaschka #include <linux/errno.h> 174a71df50SFrank Blaschka #include <linux/kernel.h> 185a0e3ad6STejun Heo #include <linux/slab.h> 194a71df50SFrank Blaschka #include <linux/etherdevice.h> 20ccffad25SJiri Pirko #include <linux/list.h> 21fe5c8028SLakhvich Dmitriy #include <linux/hash.h> 22fe5c8028SLakhvich Dmitriy #include <linux/hashtable.h> 23ec61bd2fSJulian Wiedmann #include <asm/setup.h> 244a71df50SFrank Blaschka #include "qeth_core.h" 25b4d72c08SEugene Crosser #include "qeth_l2.h" 264a71df50SFrank Blaschka 274a71df50SFrank Blaschka static int qeth_l2_set_offline(struct ccwgroup_device *); 28c044dc21SEugene Crosser static void qeth_bridgeport_query_support(struct qeth_card *card); 29c044dc21SEugene Crosser static void qeth_bridge_state_change(struct qeth_card *card, 30c044dc21SEugene Crosser struct qeth_ipa_cmd *cmd); 31c044dc21SEugene Crosser static void qeth_bridge_host_event(struct qeth_card *card, 32c044dc21SEugene Crosser struct qeth_ipa_cmd *cmd); 33caa1f0b1SHans Wippel static void qeth_l2_vnicc_set_defaults(struct qeth_card *card); 34a45b3fafSHans Wippel static void qeth_l2_vnicc_init(struct qeth_card *card); 35349d13d5SHans Wippel static bool qeth_l2_vnicc_recover_timeout(struct qeth_card *card, u32 vnicc, 36349d13d5SHans Wippel u32 *timeout); 374a71df50SFrank Blaschka 38742d4d40SJulian Wiedmann static int qeth_l2_setdelmac_makerc(struct qeth_card *card, u16 retcode) 394a71df50SFrank Blaschka { 40efbbc1d5SEugene Crosser int rc; 414a71df50SFrank Blaschka 42efbbc1d5SEugene Crosser if (retcode) 431aec42bcSThomas Richter QETH_CARD_TEXT_(card, 2, "err%04x", retcode); 44efbbc1d5SEugene Crosser switch (retcode) { 45efbbc1d5SEugene Crosser case IPA_RC_SUCCESS: 46efbbc1d5SEugene Crosser rc = 0; 47efbbc1d5SEugene Crosser break; 48efbbc1d5SEugene Crosser case IPA_RC_L2_UNSUPPORTED_CMD: 49ffb95251SEugene Crosser rc = -EOPNOTSUPP; 50efbbc1d5SEugene Crosser break; 51efbbc1d5SEugene Crosser case IPA_RC_L2_ADDR_TABLE_FULL: 52efbbc1d5SEugene Crosser rc = -ENOSPC; 53efbbc1d5SEugene Crosser break; 54efbbc1d5SEugene Crosser case IPA_RC_L2_DUP_MAC: 55efbbc1d5SEugene Crosser case IPA_RC_L2_DUP_LAYER3_MAC: 56efbbc1d5SEugene Crosser rc = -EEXIST; 57efbbc1d5SEugene Crosser break; 58efbbc1d5SEugene Crosser case IPA_RC_L2_MAC_NOT_AUTH_BY_HYP: 59efbbc1d5SEugene Crosser case IPA_RC_L2_MAC_NOT_AUTH_BY_ADP: 60efbbc1d5SEugene Crosser rc = -EPERM; 61efbbc1d5SEugene Crosser break; 62efbbc1d5SEugene Crosser case IPA_RC_L2_MAC_NOT_FOUND: 63efbbc1d5SEugene Crosser rc = -ENOENT; 64efbbc1d5SEugene Crosser break; 65efbbc1d5SEugene Crosser default: 66efbbc1d5SEugene Crosser rc = -EIO; 67efbbc1d5SEugene Crosser break; 684a71df50SFrank Blaschka } 69efbbc1d5SEugene Crosser return rc; 704a71df50SFrank Blaschka } 714a71df50SFrank Blaschka 72742d4d40SJulian Wiedmann static int qeth_l2_send_setdelmac_cb(struct qeth_card *card, 73742d4d40SJulian Wiedmann struct qeth_reply *reply, 74742d4d40SJulian Wiedmann unsigned long data) 75742d4d40SJulian Wiedmann { 76742d4d40SJulian Wiedmann struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *) data; 77742d4d40SJulian Wiedmann 78742d4d40SJulian Wiedmann return qeth_l2_setdelmac_makerc(card, cmd->hdr.return_code); 79742d4d40SJulian Wiedmann } 80742d4d40SJulian Wiedmann 81ac988d78SJulian Wiedmann static int qeth_l2_send_setdelmac(struct qeth_card *card, __u8 *mac, 82ac988d78SJulian Wiedmann enum qeth_ipa_cmds ipacmd) 83ac988d78SJulian Wiedmann { 84ac988d78SJulian Wiedmann struct qeth_ipa_cmd *cmd; 85ac988d78SJulian Wiedmann struct qeth_cmd_buffer *iob; 86ac988d78SJulian Wiedmann 87ac988d78SJulian Wiedmann QETH_CARD_TEXT(card, 2, "L2sdmac"); 88ac988d78SJulian Wiedmann iob = qeth_get_ipacmd_buffer(card, ipacmd, QETH_PROT_IPV4); 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 152c07cbf2eSJulian Wiedmann static void qeth_l2_del_all_macs(struct qeth_card *card) 1534a71df50SFrank Blaschka { 154fe5c8028SLakhvich Dmitriy struct qeth_mac *mac; 155fe5c8028SLakhvich Dmitriy struct hlist_node *tmp; 156fe5c8028SLakhvich Dmitriy int i; 1574a71df50SFrank Blaschka 1584a71df50SFrank Blaschka spin_lock_bh(&card->mclock); 159fe5c8028SLakhvich Dmitriy hash_for_each_safe(card->mac_htable, i, tmp, mac, hnode) { 160fe5c8028SLakhvich Dmitriy hash_del(&mac->hnode); 161fe5c8028SLakhvich Dmitriy kfree(mac); 1624a71df50SFrank Blaschka } 1634a71df50SFrank Blaschka spin_unlock_bh(&card->mclock); 1644a71df50SFrank Blaschka } 1654a71df50SFrank Blaschka 166cef6ff22SJulian Wiedmann static int qeth_l2_get_cast_type(struct qeth_card *card, struct sk_buff *skb) 1674a71df50SFrank Blaschka { 168ce73e10eSKlaus-Dieter Wacker if (card->info.type == QETH_CARD_TYPE_OSN) 16986c0cdb9SJulian Wiedmann return RTN_UNICAST; 170ce73e10eSKlaus-Dieter Wacker if (is_broadcast_ether_addr(skb->data)) 171ce73e10eSKlaus-Dieter Wacker return RTN_BROADCAST; 172ce73e10eSKlaus-Dieter Wacker if (is_multicast_ether_addr(skb->data)) 173ce73e10eSKlaus-Dieter Wacker return RTN_MULTICAST; 17486c0cdb9SJulian Wiedmann return RTN_UNICAST; 1754a71df50SFrank Blaschka } 1764a71df50SFrank Blaschka 177b0abc4f5SJulian Wiedmann static void qeth_l2_fill_header(struct qeth_qdio_out_q *queue, 178b0abc4f5SJulian Wiedmann struct qeth_hdr *hdr, struct sk_buff *skb, 179b0abc4f5SJulian Wiedmann int ipv, int cast_type, unsigned int data_len) 1804a71df50SFrank Blaschka { 1810aef8392SJulian Wiedmann struct vlan_ethhdr *veth = vlan_eth_hdr(skb); 1824a71df50SFrank Blaschka 183ae79fe03SJulian Wiedmann hdr->hdr.l2.pkt_length = data_len; 1844a71df50SFrank Blaschka 1850aef8392SJulian Wiedmann if (skb_is_gso(skb)) { 1860aef8392SJulian Wiedmann hdr->hdr.l2.id = QETH_HEADER_TYPE_L2_TSO; 1870aef8392SJulian Wiedmann } else { 1880aef8392SJulian Wiedmann hdr->hdr.l2.id = QETH_HEADER_TYPE_LAYER2; 189fc69660bSJulian Wiedmann if (skb->ip_summed == CHECKSUM_PARTIAL) { 190fc69660bSJulian Wiedmann qeth_tx_csum(skb, &hdr->hdr.l2.flags[1], ipv); 191b0abc4f5SJulian Wiedmann QETH_TXQ_STAT_INC(queue, skbs_csum); 192fc69660bSJulian Wiedmann } 1930aef8392SJulian Wiedmann } 194fc69660bSJulian Wiedmann 1954a71df50SFrank Blaschka /* set byte byte 3 to casting flags */ 1964a71df50SFrank Blaschka if (cast_type == RTN_MULTICAST) 1974a71df50SFrank Blaschka hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_MULTICAST; 1984a71df50SFrank Blaschka else if (cast_type == RTN_BROADCAST) 1994a71df50SFrank Blaschka hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_BROADCAST; 2004a71df50SFrank Blaschka else 201ce73e10eSKlaus-Dieter Wacker hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_UNICAST; 2024a71df50SFrank Blaschka 2034a71df50SFrank Blaschka /* VSWITCH relies on the VLAN 2044a71df50SFrank Blaschka * information to be present in 2054a71df50SFrank Blaschka * the QDIO header */ 2064a71df50SFrank Blaschka if (veth->h_vlan_proto == __constant_htons(ETH_P_8021Q)) { 2074a71df50SFrank Blaschka hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_VLAN; 2084a71df50SFrank Blaschka hdr->hdr.l2.vlan_id = ntohs(veth->h_vlan_TCI); 2094a71df50SFrank Blaschka } 2104a71df50SFrank Blaschka } 2114a71df50SFrank Blaschka 212742d4d40SJulian Wiedmann static int qeth_l2_setdelvlan_makerc(struct qeth_card *card, u16 retcode) 2134a71df50SFrank Blaschka { 2142aa48671SJulian Wiedmann if (retcode) 2152aa48671SJulian Wiedmann QETH_CARD_TEXT_(card, 2, "err%04x", retcode); 2162aa48671SJulian Wiedmann 2172aa48671SJulian Wiedmann switch (retcode) { 2182aa48671SJulian Wiedmann case IPA_RC_SUCCESS: 2192aa48671SJulian Wiedmann return 0; 2202aa48671SJulian Wiedmann case IPA_RC_L2_INVALID_VLAN_ID: 2212aa48671SJulian Wiedmann return -EINVAL; 2222aa48671SJulian Wiedmann case IPA_RC_L2_DUP_VLAN_ID: 2232aa48671SJulian Wiedmann return -EEXIST; 2242aa48671SJulian Wiedmann case IPA_RC_L2_VLAN_ID_NOT_FOUND: 2252aa48671SJulian Wiedmann return -ENOENT; 2262aa48671SJulian Wiedmann case IPA_RC_L2_VLAN_ID_NOT_ALLOWED: 2272aa48671SJulian Wiedmann return -EPERM; 2282aa48671SJulian Wiedmann default: 2292aa48671SJulian Wiedmann return -EIO; 2302aa48671SJulian Wiedmann } 2312aa48671SJulian Wiedmann } 2322aa48671SJulian Wiedmann 2332aa48671SJulian Wiedmann static int qeth_l2_send_setdelvlan_cb(struct qeth_card *card, 2342aa48671SJulian Wiedmann struct qeth_reply *reply, 2352aa48671SJulian Wiedmann unsigned long data) 2362aa48671SJulian Wiedmann { 2372aa48671SJulian Wiedmann struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *) data; 2384a71df50SFrank Blaschka 239847a50fdSCarsten Otte QETH_CARD_TEXT(card, 2, "L2sdvcb"); 2404a71df50SFrank Blaschka if (cmd->hdr.return_code) { 241e19e5be8SJulian Wiedmann QETH_DBF_MESSAGE(2, "Error in processing VLAN %u on device %x: %#x.\n", 2422aa48671SJulian Wiedmann cmd->data.setdelvlan.vlan_id, 243e19e5be8SJulian Wiedmann CARD_DEVID(card), cmd->hdr.return_code); 244847a50fdSCarsten Otte QETH_CARD_TEXT_(card, 2, "L2VL%4x", cmd->hdr.command); 2454a71df50SFrank Blaschka } 246742d4d40SJulian Wiedmann return qeth_l2_setdelvlan_makerc(card, cmd->hdr.return_code); 2474a71df50SFrank Blaschka } 2484a71df50SFrank Blaschka 2494a71df50SFrank Blaschka static int qeth_l2_send_setdelvlan(struct qeth_card *card, __u16 i, 2504a71df50SFrank Blaschka enum qeth_ipa_cmds ipacmd) 2514a71df50SFrank Blaschka { 2524a71df50SFrank Blaschka struct qeth_ipa_cmd *cmd; 2534a71df50SFrank Blaschka struct qeth_cmd_buffer *iob; 2544a71df50SFrank Blaschka 255847a50fdSCarsten Otte QETH_CARD_TEXT_(card, 4, "L2sdv%x", ipacmd); 2564a71df50SFrank Blaschka iob = qeth_get_ipacmd_buffer(card, ipacmd, QETH_PROT_IPV4); 2571aec42bcSThomas Richter if (!iob) 2581aec42bcSThomas Richter return -ENOMEM; 259ff5caa7aSJulian Wiedmann cmd = __ipa_cmd(iob); 2604a71df50SFrank Blaschka cmd->data.setdelvlan.vlan_id = i; 261742d4d40SJulian Wiedmann return qeth_send_ipa_cmd(card, iob, qeth_l2_send_setdelvlan_cb, NULL); 2624a71df50SFrank Blaschka } 2634a71df50SFrank Blaschka 26480d5c368SPatrick McHardy static int qeth_l2_vlan_rx_add_vid(struct net_device *dev, 26580d5c368SPatrick McHardy __be16 proto, u16 vid) 2664a71df50SFrank Blaschka { 267509e2562SHeiko Carstens struct qeth_card *card = dev->ml_priv; 2684a71df50SFrank Blaschka 269847a50fdSCarsten Otte QETH_CARD_TEXT_(card, 4, "aid:%d", vid); 27010651db7SUrsula Braun if (!vid) 2718e586137SJiri Pirko return 0; 272e6e771b3SJulian Wiedmann 2735fc692a7SJulian Wiedmann return qeth_l2_send_setdelvlan(card, vid, IPA_CMD_SETVLAN); 2744a71df50SFrank Blaschka } 2754a71df50SFrank Blaschka 27680d5c368SPatrick McHardy static int qeth_l2_vlan_rx_kill_vid(struct net_device *dev, 27780d5c368SPatrick McHardy __be16 proto, u16 vid) 2784a71df50SFrank Blaschka { 279509e2562SHeiko Carstens struct qeth_card *card = dev->ml_priv; 2804a71df50SFrank Blaschka 281847a50fdSCarsten Otte QETH_CARD_TEXT_(card, 4, "kid:%d", vid); 2825fc692a7SJulian Wiedmann if (!vid) 2835fc692a7SJulian Wiedmann return 0; 284e6e771b3SJulian Wiedmann 2855fc692a7SJulian Wiedmann return qeth_l2_send_setdelvlan(card, vid, IPA_CMD_DELVLAN); 2864a71df50SFrank Blaschka } 2874a71df50SFrank Blaschka 288b2f4de8bSPeter Senna Tschudin static void qeth_l2_stop_card(struct qeth_card *card, int recovery_mode) 2894a71df50SFrank Blaschka { 290d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP , 2, "stopcard"); 291d11ba0c4SPeter Tiedemann QETH_DBF_HEX(SETUP, 2, &card, sizeof(void *)); 2924a71df50SFrank Blaschka 2934a71df50SFrank Blaschka qeth_set_allowed_threads(card, 0, 1); 2944a71df50SFrank Blaschka if (card->read.state == CH_STATE_UP && 2954a71df50SFrank Blaschka card->write.state == CH_STATE_UP && 2964a71df50SFrank Blaschka (card->state == CARD_STATE_UP)) { 297e22355eaSJulian Wiedmann if (recovery_mode && !IS_OSN(card)) { 298e22355eaSJulian Wiedmann qeth_stop(card->dev); 2994a71df50SFrank Blaschka } else { 3004a71df50SFrank Blaschka rtnl_lock(); 3014a71df50SFrank Blaschka dev_close(card->dev); 3024a71df50SFrank Blaschka rtnl_unlock(); 3034a71df50SFrank Blaschka } 30470919e23SUrsula Braun card->info.mac_bits &= ~QETH_LAYER2_MAC_REGISTERED; 3054a71df50SFrank Blaschka card->state = CARD_STATE_SOFTSETUP; 3064a71df50SFrank Blaschka } 3074a71df50SFrank Blaschka if (card->state == CARD_STATE_SOFTSETUP) { 308c07cbf2eSJulian Wiedmann qeth_l2_del_all_macs(card); 3094a71df50SFrank Blaschka qeth_clear_ipacmd_list(card); 3104a71df50SFrank Blaschka card->state = CARD_STATE_HARDSETUP; 3114a71df50SFrank Blaschka } 3124a71df50SFrank Blaschka if (card->state == CARD_STATE_HARDSETUP) { 3134a71df50SFrank Blaschka qeth_qdio_clear_card(card, 0); 3144a71df50SFrank Blaschka qeth_clear_qdio_buffers(card); 3154a71df50SFrank Blaschka qeth_clear_working_pool_list(card); 3164a71df50SFrank Blaschka card->state = CARD_STATE_DOWN; 3174a71df50SFrank Blaschka } 3184a71df50SFrank Blaschka if (card->state == CARD_STATE_DOWN) { 3194a71df50SFrank Blaschka qeth_clear_cmd_buffers(&card->read); 3204a71df50SFrank Blaschka qeth_clear_cmd_buffers(&card->write); 3214a71df50SFrank Blaschka } 322c0a2e4d1SJulian Wiedmann 323c0a2e4d1SJulian Wiedmann flush_workqueue(card->event_wq); 3244a71df50SFrank Blaschka } 3254a71df50SFrank Blaschka 326a1c3ed4cSFrank Blaschka static int qeth_l2_process_inbound_buffer(struct qeth_card *card, 327a1c3ed4cSFrank Blaschka int budget, int *done) 3284a71df50SFrank Blaschka { 329a1c3ed4cSFrank Blaschka int work_done = 0; 3304a71df50SFrank Blaschka struct sk_buff *skb; 3314a71df50SFrank Blaschka struct qeth_hdr *hdr; 3324a71df50SFrank Blaschka unsigned int len; 3334a71df50SFrank Blaschka 334a1c3ed4cSFrank Blaschka *done = 0; 33518af5c17SStefan Raspl WARN_ON_ONCE(!budget); 336a1c3ed4cSFrank Blaschka while (budget) { 337a1c3ed4cSFrank Blaschka skb = qeth_core_get_next_skb(card, 338b3332930SFrank Blaschka &card->qdio.in_q->bufs[card->rx.b_index], 339a1c3ed4cSFrank Blaschka &card->rx.b_element, &card->rx.e_offset, &hdr); 340a1c3ed4cSFrank Blaschka if (!skb) { 341a1c3ed4cSFrank Blaschka *done = 1; 342a1c3ed4cSFrank Blaschka break; 3434a71df50SFrank Blaschka } 3444a71df50SFrank Blaschka switch (hdr->hdr.l2.id) { 3454a71df50SFrank Blaschka case QETH_HEADER_TYPE_LAYER2: 3464a71df50SFrank Blaschka skb->protocol = eth_type_trans(skb, skb->dev); 3476195b936SJulian Wiedmann qeth_rx_csum(card, skb, hdr->hdr.l2.flags[1]); 34812883725SUrsula Braun if (skb->protocol == htons(ETH_P_802_2)) 3494a71df50SFrank Blaschka *((__u32 *)skb->cb) = ++card->seqno.pkt_seqno; 3504a71df50SFrank Blaschka len = skb->len; 3519abfa8cbSThomas Richter napi_gro_receive(&card->napi, skb); 3524a71df50SFrank Blaschka break; 3534a71df50SFrank Blaschka case QETH_HEADER_TYPE_OSN: 3542d488c2fSUrsula Braun if (card->info.type == QETH_CARD_TYPE_OSN) { 3554a71df50SFrank Blaschka skb_push(skb, sizeof(struct qeth_hdr)); 3564a71df50SFrank Blaschka skb_copy_to_linear_data(skb, hdr, 3574a71df50SFrank Blaschka sizeof(struct qeth_hdr)); 3584a71df50SFrank Blaschka len = skb->len; 3594a71df50SFrank Blaschka card->osn_info.data_cb(skb); 3604a71df50SFrank Blaschka break; 3612d488c2fSUrsula Braun } 3622d488c2fSUrsula Braun /* else unknown */ 3634a71df50SFrank Blaschka default: 3644a71df50SFrank Blaschka dev_kfree_skb_any(skb); 365847a50fdSCarsten Otte QETH_CARD_TEXT(card, 3, "inbunkno"); 3660ac1487cSJulian Wiedmann QETH_DBF_HEX(CTRL, 3, hdr, sizeof(*hdr)); 3674a71df50SFrank Blaschka continue; 3684a71df50SFrank Blaschka } 369a1c3ed4cSFrank Blaschka work_done++; 370a1c3ed4cSFrank Blaschka budget--; 371b0abc4f5SJulian Wiedmann QETH_CARD_STAT_INC(card, rx_packets); 372b0abc4f5SJulian Wiedmann QETH_CARD_STAT_ADD(card, rx_bytes, len); 3734a71df50SFrank Blaschka } 374a1c3ed4cSFrank Blaschka return work_done; 375a1c3ed4cSFrank Blaschka } 376a1c3ed4cSFrank Blaschka 3774a71df50SFrank Blaschka static int qeth_l2_request_initial_mac(struct qeth_card *card) 3784a71df50SFrank Blaschka { 3794a71df50SFrank Blaschka int rc = 0; 3804a71df50SFrank Blaschka 381ec61bd2fSJulian Wiedmann QETH_DBF_TEXT(SETUP, 2, "l2reqmac"); 382d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "doL2%s", CARD_BUS_ID(card)); 3834a71df50SFrank Blaschka 384ec61bd2fSJulian Wiedmann if (MACHINE_IS_VM) { 385ec61bd2fSJulian Wiedmann rc = qeth_vm_request_mac(card); 386ec61bd2fSJulian Wiedmann if (!rc) 387ec61bd2fSJulian Wiedmann goto out; 388e19e5be8SJulian Wiedmann QETH_DBF_MESSAGE(2, "z/VM MAC Service failed on device %x: %#x\n", 389e19e5be8SJulian Wiedmann CARD_DEVID(card), rc); 390ec61bd2fSJulian Wiedmann QETH_DBF_TEXT_(SETUP, 2, "err%04x", rc); 391ec61bd2fSJulian Wiedmann /* fall back to alternative mechanism: */ 392ec61bd2fSJulian Wiedmann } 393ec61bd2fSJulian Wiedmann 394b144b99fSJulian Wiedmann if (!IS_OSN(card)) { 3954a71df50SFrank Blaschka rc = qeth_setadpparms_change_macaddr(card); 3964b7ae122SJulian Wiedmann if (!rc) 39721b1702aSJulian Wiedmann goto out; 398e19e5be8SJulian Wiedmann QETH_DBF_MESSAGE(2, "READ_MAC Assist failed on device %x: %#x\n", 399e19e5be8SJulian Wiedmann CARD_DEVID(card), rc); 4001aec42bcSThomas Richter QETH_DBF_TEXT_(SETUP, 2, "1err%04x", rc); 40121b1702aSJulian Wiedmann /* fall back once more: */ 4024a71df50SFrank Blaschka } 40321b1702aSJulian Wiedmann 40421b1702aSJulian Wiedmann /* some devices don't support a custom MAC address: */ 40521b1702aSJulian Wiedmann if (card->info.type == QETH_CARD_TYPE_OSM || 40621b1702aSJulian Wiedmann card->info.type == QETH_CARD_TYPE_OSX) 40721b1702aSJulian Wiedmann return (rc) ? rc : -EADDRNOTAVAIL; 40821b1702aSJulian Wiedmann eth_hw_addr_random(card->dev); 40921b1702aSJulian Wiedmann 410ec61bd2fSJulian Wiedmann out: 411ec61bd2fSJulian Wiedmann QETH_DBF_HEX(SETUP, 2, card->dev->dev_addr, card->dev->addr_len); 4124a71df50SFrank Blaschka return 0; 4134a71df50SFrank Blaschka } 4144a71df50SFrank Blaschka 415654e3d48SJulian Wiedmann static void qeth_l2_register_dev_addr(struct qeth_card *card) 416654e3d48SJulian Wiedmann { 417654e3d48SJulian Wiedmann if (!is_valid_ether_addr(card->dev->dev_addr)) 418654e3d48SJulian Wiedmann qeth_l2_request_initial_mac(card); 419654e3d48SJulian Wiedmann 420654e3d48SJulian Wiedmann if (!IS_OSN(card) && !qeth_l2_send_setmac(card, card->dev->dev_addr)) 421654e3d48SJulian Wiedmann card->info.mac_bits |= QETH_LAYER2_MAC_REGISTERED; 422654e3d48SJulian Wiedmann } 423654e3d48SJulian Wiedmann 424e22355eaSJulian Wiedmann static int qeth_l2_validate_addr(struct net_device *dev) 425e22355eaSJulian Wiedmann { 426e22355eaSJulian Wiedmann struct qeth_card *card = dev->ml_priv; 427e22355eaSJulian Wiedmann 4288024cc9eSJulian Wiedmann if (card->info.mac_bits & QETH_LAYER2_MAC_REGISTERED) 429e22355eaSJulian Wiedmann return eth_validate_addr(dev); 430e22355eaSJulian Wiedmann 431e22355eaSJulian Wiedmann QETH_CARD_TEXT(card, 4, "nomacadr"); 432e22355eaSJulian Wiedmann return -EPERM; 433e22355eaSJulian Wiedmann } 434e22355eaSJulian Wiedmann 4354a71df50SFrank Blaschka static int qeth_l2_set_mac_address(struct net_device *dev, void *p) 4364a71df50SFrank Blaschka { 4374a71df50SFrank Blaschka struct sockaddr *addr = p; 438509e2562SHeiko Carstens struct qeth_card *card = dev->ml_priv; 439bcacfcbcSJulian Wiedmann u8 old_addr[ETH_ALEN]; 4404a71df50SFrank Blaschka int rc = 0; 4414a71df50SFrank Blaschka 442847a50fdSCarsten Otte QETH_CARD_TEXT(card, 3, "setmac"); 4434a71df50SFrank Blaschka 4448024cc9eSJulian Wiedmann if (IS_OSM(card) || IS_OSX(card)) { 445847a50fdSCarsten Otte QETH_CARD_TEXT(card, 3, "setmcTYP"); 4464a71df50SFrank Blaschka return -EOPNOTSUPP; 4474a71df50SFrank Blaschka } 44899f0b85dSJulian Wiedmann QETH_CARD_HEX(card, 3, addr->sa_data, ETH_ALEN); 449bcacfcbcSJulian Wiedmann if (!is_valid_ether_addr(addr->sa_data)) 450bcacfcbcSJulian Wiedmann return -EADDRNOTAVAIL; 451bcacfcbcSJulian Wiedmann 452bcacfcbcSJulian Wiedmann /* don't register the same address twice */ 453bcacfcbcSJulian Wiedmann if (ether_addr_equal_64bits(dev->dev_addr, addr->sa_data) && 454bcacfcbcSJulian Wiedmann (card->info.mac_bits & QETH_LAYER2_MAC_REGISTERED)) 455e6e771b3SJulian Wiedmann return 0; 456bcacfcbcSJulian Wiedmann 457bcacfcbcSJulian Wiedmann /* add the new address, switch over, drop the old */ 4584a71df50SFrank Blaschka rc = qeth_l2_send_setmac(card, addr->sa_data); 459bcacfcbcSJulian Wiedmann if (rc) 460e6e771b3SJulian Wiedmann return rc; 461bcacfcbcSJulian Wiedmann ether_addr_copy(old_addr, dev->dev_addr); 462bcacfcbcSJulian Wiedmann ether_addr_copy(dev->dev_addr, addr->sa_data); 463bcacfcbcSJulian Wiedmann 464bcacfcbcSJulian Wiedmann if (card->info.mac_bits & QETH_LAYER2_MAC_REGISTERED) 465bcacfcbcSJulian Wiedmann qeth_l2_remove_mac(card, old_addr); 466bcacfcbcSJulian Wiedmann card->info.mac_bits |= QETH_LAYER2_MAC_REGISTERED; 467e6e771b3SJulian Wiedmann return 0; 4684a71df50SFrank Blaschka } 4694a71df50SFrank Blaschka 4700db587b0SEugene Crosser static void qeth_promisc_to_bridge(struct qeth_card *card) 4710db587b0SEugene Crosser { 4720db587b0SEugene Crosser struct net_device *dev = card->dev; 4730db587b0SEugene Crosser enum qeth_ipa_promisc_modes promisc_mode; 4740db587b0SEugene Crosser int role; 4750db587b0SEugene Crosser int rc; 4760db587b0SEugene Crosser 4770db587b0SEugene Crosser QETH_CARD_TEXT(card, 3, "pmisc2br"); 4780db587b0SEugene Crosser 4790db587b0SEugene Crosser if (!card->options.sbp.reflect_promisc) 4800db587b0SEugene Crosser return; 4810db587b0SEugene Crosser promisc_mode = (dev->flags & IFF_PROMISC) ? SET_PROMISC_MODE_ON 4820db587b0SEugene Crosser : SET_PROMISC_MODE_OFF; 4830db587b0SEugene Crosser if (promisc_mode == card->info.promisc_mode) 4840db587b0SEugene Crosser return; 4850db587b0SEugene Crosser 4860db587b0SEugene Crosser if (promisc_mode == SET_PROMISC_MODE_ON) { 4870db587b0SEugene Crosser if (card->options.sbp.reflect_promisc_primary) 4880db587b0SEugene Crosser role = QETH_SBP_ROLE_PRIMARY; 4890db587b0SEugene Crosser else 4900db587b0SEugene Crosser role = QETH_SBP_ROLE_SECONDARY; 4910db587b0SEugene Crosser } else 4920db587b0SEugene Crosser role = QETH_SBP_ROLE_NONE; 4930db587b0SEugene Crosser 4940db587b0SEugene Crosser rc = qeth_bridgeport_setrole(card, role); 4950db587b0SEugene Crosser QETH_DBF_TEXT_(SETUP, 2, "bpm%c%04x", 4960db587b0SEugene Crosser (promisc_mode == SET_PROMISC_MODE_ON) ? '+' : '-', rc); 4970db587b0SEugene Crosser if (!rc) { 4980db587b0SEugene Crosser card->options.sbp.role = role; 4990db587b0SEugene Crosser card->info.promisc_mode = promisc_mode; 5000db587b0SEugene Crosser } 501fe5c8028SLakhvich Dmitriy 502fe5c8028SLakhvich Dmitriy } 503fe5c8028SLakhvich Dmitriy /* New MAC address is added to the hash table and marked to be written on card 504fe5c8028SLakhvich Dmitriy * only if there is not in the hash table storage already 505fe5c8028SLakhvich Dmitriy * 506fe5c8028SLakhvich Dmitriy */ 5074641b027SJulian Wiedmann static void qeth_l2_add_mac(struct qeth_card *card, struct netdev_hw_addr *ha) 508fe5c8028SLakhvich Dmitriy { 509cef6ff22SJulian Wiedmann u32 mac_hash = get_unaligned((u32 *)(&ha->addr[2])); 510fe5c8028SLakhvich Dmitriy struct qeth_mac *mac; 511fe5c8028SLakhvich Dmitriy 512cef6ff22SJulian Wiedmann hash_for_each_possible(card->mac_htable, mac, hnode, mac_hash) { 51399f0b85dSJulian Wiedmann if (ether_addr_equal_64bits(ha->addr, mac->mac_addr)) { 5145f78e29cSLakhvich Dmitriy mac->disp_flag = QETH_DISP_ADDR_DO_NOTHING; 515fe5c8028SLakhvich Dmitriy return; 516fe5c8028SLakhvich Dmitriy } 5170db587b0SEugene Crosser } 5180db587b0SEugene Crosser 519fe5c8028SLakhvich Dmitriy mac = kzalloc(sizeof(struct qeth_mac), GFP_ATOMIC); 520fe5c8028SLakhvich Dmitriy if (!mac) 521fe5c8028SLakhvich Dmitriy return; 522fe5c8028SLakhvich Dmitriy 52399f0b85dSJulian Wiedmann ether_addr_copy(mac->mac_addr, ha->addr); 5245f78e29cSLakhvich Dmitriy mac->disp_flag = QETH_DISP_ADDR_ADD; 525fe5c8028SLakhvich Dmitriy 526cef6ff22SJulian Wiedmann hash_add(card->mac_htable, &mac->hnode, mac_hash); 527fe5c8028SLakhvich Dmitriy } 528fe5c8028SLakhvich Dmitriy 529fe5c8028SLakhvich Dmitriy static void qeth_l2_set_rx_mode(struct net_device *dev) 5304a71df50SFrank Blaschka { 531509e2562SHeiko Carstens struct qeth_card *card = dev->ml_priv; 532ccffad25SJiri Pirko struct netdev_hw_addr *ha; 533fe5c8028SLakhvich Dmitriy struct qeth_mac *mac; 534fe5c8028SLakhvich Dmitriy struct hlist_node *tmp; 535fe5c8028SLakhvich Dmitriy int i; 536fe5c8028SLakhvich Dmitriy int rc; 5374a71df50SFrank Blaschka 538847a50fdSCarsten Otte QETH_CARD_TEXT(card, 3, "setmulti"); 539fe5c8028SLakhvich Dmitriy 5404a71df50SFrank Blaschka spin_lock_bh(&card->mclock); 541fe5c8028SLakhvich Dmitriy 54222bedad3SJiri Pirko netdev_for_each_mc_addr(ha, dev) 5434641b027SJulian Wiedmann qeth_l2_add_mac(card, ha); 54432e7bfc4SJiri Pirko netdev_for_each_uc_addr(ha, dev) 5454641b027SJulian Wiedmann qeth_l2_add_mac(card, ha); 546fe5c8028SLakhvich Dmitriy 547fe5c8028SLakhvich Dmitriy hash_for_each_safe(card->mac_htable, i, tmp, mac, hnode) { 54800c163f1SJulian Wiedmann switch (mac->disp_flag) { 54900c163f1SJulian Wiedmann case QETH_DISP_ADDR_DELETE: 5508174aa8aSJulian Wiedmann qeth_l2_remove_mac(card, mac->mac_addr); 551fe5c8028SLakhvich Dmitriy hash_del(&mac->hnode); 552fe5c8028SLakhvich Dmitriy kfree(mac); 55300c163f1SJulian Wiedmann break; 55400c163f1SJulian Wiedmann case QETH_DISP_ADDR_ADD: 5558174aa8aSJulian Wiedmann rc = qeth_l2_write_mac(card, mac->mac_addr); 556fe5c8028SLakhvich Dmitriy if (rc) { 557fe5c8028SLakhvich Dmitriy hash_del(&mac->hnode); 558fe5c8028SLakhvich Dmitriy kfree(mac); 55900c163f1SJulian Wiedmann break; 56000c163f1SJulian Wiedmann } 56100c163f1SJulian Wiedmann /* fall through */ 56200c163f1SJulian Wiedmann default: 56300c163f1SJulian Wiedmann /* for next call to set_rx_mode(): */ 5645f78e29cSLakhvich Dmitriy mac->disp_flag = QETH_DISP_ADDR_DELETE; 56500c163f1SJulian Wiedmann } 566fe5c8028SLakhvich Dmitriy } 5677db2266aSFrank Blaschka 5684a71df50SFrank Blaschka spin_unlock_bh(&card->mclock); 569fe5c8028SLakhvich Dmitriy 5700db587b0SEugene Crosser if (qeth_adp_supported(card, IPA_SETADP_SET_PROMISC_MODE)) 5714a71df50SFrank Blaschka qeth_setadp_promisc_mode(card); 5720db587b0SEugene Crosser else 5730db587b0SEugene Crosser qeth_promisc_to_bridge(card); 5744a71df50SFrank Blaschka } 5754a71df50SFrank Blaschka 5767286384bSJulian Wiedmann static int qeth_l2_xmit_osn(struct qeth_card *card, struct sk_buff *skb, 5777286384bSJulian Wiedmann struct qeth_qdio_out_q *queue) 5787286384bSJulian Wiedmann { 57969d7ce80SJulian Wiedmann struct qeth_hdr *hdr = (struct qeth_hdr *)skb->data; 58069d7ce80SJulian Wiedmann addr_t end = (addr_t)(skb->data + sizeof(*hdr)); 58169d7ce80SJulian Wiedmann addr_t start = (addr_t)skb->data; 58269d7ce80SJulian Wiedmann unsigned int elements = 0; 58369d7ce80SJulian Wiedmann unsigned int hd_len = 0; 58469d7ce80SJulian Wiedmann int rc; 5857286384bSJulian Wiedmann 5867286384bSJulian Wiedmann if (skb->protocol == htons(ETH_P_IPV6)) 5877286384bSJulian Wiedmann return -EPROTONOSUPPORT; 5887286384bSJulian Wiedmann 58969d7ce80SJulian Wiedmann if (qeth_get_elements_for_range(start, end) > 1) { 59069d7ce80SJulian Wiedmann /* Misaligned HW header, move it to its own buffer element. */ 59169d7ce80SJulian Wiedmann hdr = kmem_cache_alloc(qeth_core_header_cache, GFP_ATOMIC); 59269d7ce80SJulian Wiedmann if (!hdr) 59369d7ce80SJulian Wiedmann return -ENOMEM; 59469d7ce80SJulian Wiedmann hd_len = sizeof(*hdr); 59569d7ce80SJulian Wiedmann skb_copy_from_linear_data(skb, (char *)hdr, hd_len); 59669d7ce80SJulian Wiedmann elements++; 59769d7ce80SJulian Wiedmann } 59869d7ce80SJulian Wiedmann 59969d7ce80SJulian Wiedmann elements += qeth_count_elements(skb, hd_len); 60069d7ce80SJulian Wiedmann if (elements > QETH_MAX_BUFFER_ELEMENTS(card)) { 60169d7ce80SJulian Wiedmann rc = -E2BIG; 60269d7ce80SJulian Wiedmann goto out; 60369d7ce80SJulian Wiedmann } 60469d7ce80SJulian Wiedmann 60569d7ce80SJulian Wiedmann rc = qeth_do_send_packet(card, queue, skb, hdr, hd_len, hd_len, 60669d7ce80SJulian Wiedmann elements); 60769d7ce80SJulian Wiedmann out: 60869d7ce80SJulian Wiedmann if (rc && hd_len) 60969d7ce80SJulian Wiedmann kmem_cache_free(qeth_core_header_cache, hdr); 61069d7ce80SJulian Wiedmann return rc; 6117286384bSJulian Wiedmann } 6127286384bSJulian Wiedmann 613e38db6beSJulian Wiedmann static netdev_tx_t qeth_l2_hard_start_xmit(struct sk_buff *skb, 614e38db6beSJulian Wiedmann struct net_device *dev) 6154a71df50SFrank Blaschka { 616509e2562SHeiko Carstens struct qeth_card *card = dev->ml_priv; 617ce73e10eSKlaus-Dieter Wacker int cast_type = qeth_l2_get_cast_type(card, skb); 618571f9dd8SKittipon Meesompop int ipv = qeth_get_ip_version(skb); 619290b8348SStefan Raspl struct qeth_qdio_out_q *queue; 6204a71df50SFrank Blaschka int tx_bytes = skb->len; 6217286384bSJulian Wiedmann int rc; 6224a71df50SFrank Blaschka 623b0abc4f5SJulian Wiedmann queue = qeth_get_tx_queue(card, skb, ipv, cast_type); 624b0abc4f5SJulian Wiedmann 62591cc98f5SJulian Wiedmann if (card->state != CARD_STATE_UP) { 626b0abc4f5SJulian Wiedmann QETH_TXQ_STAT_INC(queue, tx_carrier_errors); 6274a71df50SFrank Blaschka goto tx_drop; 6284a71df50SFrank Blaschka } 6294a71df50SFrank Blaschka 6304a71df50SFrank Blaschka netif_stop_queue(dev); 6314a71df50SFrank Blaschka 6325f89eca5SJulian Wiedmann if (IS_OSN(card)) 6337286384bSJulian Wiedmann rc = qeth_l2_xmit_osn(card, skb, queue); 6345f89eca5SJulian Wiedmann else 635fc69660bSJulian Wiedmann rc = qeth_xmit(card, skb, queue, ipv, cast_type, 636fc69660bSJulian Wiedmann qeth_l2_fill_header); 6374a71df50SFrank Blaschka 6384a71df50SFrank Blaschka if (!rc) { 639b0abc4f5SJulian Wiedmann QETH_TXQ_STAT_INC(queue, tx_packets); 640b0abc4f5SJulian Wiedmann QETH_TXQ_STAT_ADD(queue, tx_bytes, tx_bytes); 6417286384bSJulian Wiedmann netif_wake_queue(dev); 6427286384bSJulian Wiedmann return NETDEV_TX_OK; 6437286384bSJulian Wiedmann } else if (rc == -EBUSY) { 6447286384bSJulian Wiedmann return NETDEV_TX_BUSY; 6457286384bSJulian Wiedmann } /* else fall through */ 6464a71df50SFrank Blaschka 6474a71df50SFrank Blaschka tx_drop: 648b0abc4f5SJulian Wiedmann QETH_TXQ_STAT_INC(queue, tx_dropped); 649b0abc4f5SJulian Wiedmann QETH_TXQ_STAT_INC(queue, tx_errors); 6504a71df50SFrank Blaschka dev_kfree_skb_any(skb); 651d0ec0f54SFrank Blaschka netif_wake_queue(dev); 6524a71df50SFrank Blaschka return NETDEV_TX_OK; 6534a71df50SFrank Blaschka } 6544a71df50SFrank Blaschka 6552d2ebb3eSJulian Wiedmann static const struct device_type qeth_l2_devtype = { 6562d2ebb3eSJulian Wiedmann .name = "qeth_layer2", 6572d2ebb3eSJulian Wiedmann .groups = qeth_l2_attr_groups, 6582d2ebb3eSJulian Wiedmann }; 6592d2ebb3eSJulian Wiedmann 6604a71df50SFrank Blaschka static int qeth_l2_probe_device(struct ccwgroup_device *gdev) 6614a71df50SFrank Blaschka { 6624a71df50SFrank Blaschka struct qeth_card *card = dev_get_drvdata(&gdev->dev); 6639111e788SUrsula Braun int rc; 6644a71df50SFrank Blaschka 6652d2ebb3eSJulian Wiedmann if (gdev->dev.type == &qeth_generic_devtype) { 6669111e788SUrsula Braun rc = qeth_l2_create_device_attributes(&gdev->dev); 6679111e788SUrsula Braun if (rc) 6689111e788SUrsula Braun return rc; 6692d2ebb3eSJulian Wiedmann } 6705fc692a7SJulian Wiedmann 671fe5c8028SLakhvich Dmitriy hash_init(card->mac_htable); 6721da74b1cSFrank Blaschka card->info.hwtrap = 0; 673caa1f0b1SHans Wippel qeth_l2_vnicc_set_defaults(card); 6744a71df50SFrank Blaschka return 0; 6754a71df50SFrank Blaschka } 6764a71df50SFrank Blaschka 6774a71df50SFrank Blaschka static void qeth_l2_remove_device(struct ccwgroup_device *cgdev) 6784a71df50SFrank Blaschka { 6794a71df50SFrank Blaschka struct qeth_card *card = dev_get_drvdata(&cgdev->dev); 6804a71df50SFrank Blaschka 6812d2ebb3eSJulian Wiedmann if (cgdev->dev.type == &qeth_generic_devtype) 682b4d72c08SEugene Crosser qeth_l2_remove_device_attributes(&cgdev->dev); 683f2148565SUrsula Braun qeth_set_allowed_threads(card, 0, 1); 6844a71df50SFrank Blaschka wait_event(card->wait_q, qeth_threads_running(card, 0xffffffff) == 0); 6854a71df50SFrank Blaschka 68670919e23SUrsula Braun if (cgdev->state == CCWGROUP_ONLINE) 6874a71df50SFrank Blaschka qeth_l2_set_offline(cgdev); 688c2780c1aSJulian Wiedmann 689c2780c1aSJulian Wiedmann cancel_work_sync(&card->close_dev_work); 69030356d08SJulian Wiedmann if (qeth_netdev_is_registered(card->dev)) 6914a71df50SFrank Blaschka unregister_netdev(card->dev); 6924a71df50SFrank Blaschka } 6934a71df50SFrank Blaschka 6943d58cefdSFrank Blaschka static const struct net_device_ops qeth_l2_netdev_ops = { 695e22355eaSJulian Wiedmann .ndo_open = qeth_open, 696e22355eaSJulian Wiedmann .ndo_stop = qeth_stop, 697b0abc4f5SJulian Wiedmann .ndo_get_stats64 = qeth_get_stats64, 6988403b13cSFrank Blaschka .ndo_start_xmit = qeth_l2_hard_start_xmit, 6996d69b1f1SJulian Wiedmann .ndo_features_check = qeth_features_check, 700e22355eaSJulian Wiedmann .ndo_validate_addr = qeth_l2_validate_addr, 701fe5c8028SLakhvich Dmitriy .ndo_set_rx_mode = qeth_l2_set_rx_mode, 702942d6984SJulian Wiedmann .ndo_do_ioctl = qeth_do_ioctl, 7038403b13cSFrank Blaschka .ndo_set_mac_address = qeth_l2_set_mac_address, 7048403b13cSFrank Blaschka .ndo_vlan_rx_add_vid = qeth_l2_vlan_rx_add_vid, 7058403b13cSFrank Blaschka .ndo_vlan_rx_kill_vid = qeth_l2_vlan_rx_kill_vid, 7068403b13cSFrank Blaschka .ndo_tx_timeout = qeth_tx_timeout, 7078f43fb00SThomas Richter .ndo_fix_features = qeth_fix_features, 7088f43fb00SThomas Richter .ndo_set_features = qeth_set_features 7098403b13cSFrank Blaschka }; 7108403b13cSFrank Blaschka 7118024cc9eSJulian Wiedmann static const struct net_device_ops qeth_osn_netdev_ops = { 7128024cc9eSJulian Wiedmann .ndo_open = qeth_open, 7138024cc9eSJulian Wiedmann .ndo_stop = qeth_stop, 7148024cc9eSJulian Wiedmann .ndo_get_stats64 = qeth_get_stats64, 7158024cc9eSJulian Wiedmann .ndo_start_xmit = qeth_l2_hard_start_xmit, 7168024cc9eSJulian Wiedmann .ndo_validate_addr = eth_validate_addr, 7178024cc9eSJulian Wiedmann .ndo_tx_timeout = qeth_tx_timeout, 7188024cc9eSJulian Wiedmann }; 7198024cc9eSJulian Wiedmann 7209fae5c3bSJulian Wiedmann static int qeth_l2_setup_netdev(struct qeth_card *card, bool carrier_ok) 7214a71df50SFrank Blaschka { 722d3d1b205SJulian Wiedmann int rc; 7234a71df50SFrank Blaschka 7248024cc9eSJulian Wiedmann if (IS_OSN(card)) { 7258024cc9eSJulian Wiedmann card->dev->netdev_ops = &qeth_osn_netdev_ops; 72625e2c341SJulian Wiedmann card->dev->flags |= IFF_NOARP; 7278024cc9eSJulian Wiedmann goto add_napi; 7288024cc9eSJulian Wiedmann } 7298024cc9eSJulian Wiedmann 7305f89eca5SJulian Wiedmann card->dev->needed_headroom = sizeof(struct qeth_hdr); 7318024cc9eSJulian Wiedmann card->dev->netdev_ops = &qeth_l2_netdev_ops; 7328024cc9eSJulian Wiedmann card->dev->priv_flags |= IFF_UNICAST_FLT; 7339400c53fSJulian Wiedmann 7345fc692a7SJulian Wiedmann if (IS_OSM(card)) { 7359400c53fSJulian Wiedmann card->dev->features |= NETIF_F_VLAN_CHALLENGED; 7365fc692a7SJulian Wiedmann } else { 7375fc692a7SJulian Wiedmann if (!IS_VM_NIC(card)) 7385fc692a7SJulian Wiedmann card->dev->hw_features |= NETIF_F_HW_VLAN_CTAG_FILTER; 739f646968fSPatrick McHardy card->dev->features |= NETIF_F_HW_VLAN_CTAG_FILTER; 7405fc692a7SJulian Wiedmann } 7410f342945SJulian Wiedmann 7424d7def2aSThomas Richter if (card->info.type == QETH_CARD_TYPE_OSD && !card->info.guestlan) { 7436d69b1f1SJulian Wiedmann card->dev->features |= NETIF_F_SG; 7448f43fb00SThomas Richter /* OSA 3S and earlier has no RX/TX support */ 7459bdc4411SHans Wippel if (qeth_is_supported(card, IPA_OUTBOUND_CHECKSUM)) { 7468f43fb00SThomas Richter card->dev->hw_features |= NETIF_F_IP_CSUM; 7479bdc4411SHans Wippel card->dev->vlan_features |= NETIF_F_IP_CSUM; 7489bdc4411SHans Wippel } 7494d7def2aSThomas Richter } 750571f9dd8SKittipon Meesompop if (qeth_is_supported6(card, IPA_OUTBOUND_CHECKSUM_V6)) { 751571f9dd8SKittipon Meesompop card->dev->hw_features |= NETIF_F_IPV6_CSUM; 752571f9dd8SKittipon Meesompop card->dev->vlan_features |= NETIF_F_IPV6_CSUM; 753571f9dd8SKittipon Meesompop } 754d7e6ed97SKittipon Meesompop if (qeth_is_supported(card, IPA_INBOUND_CHECKSUM) || 755d7e6ed97SKittipon Meesompop qeth_is_supported6(card, IPA_INBOUND_CHECKSUM_V6)) { 756d7e6ed97SKittipon Meesompop card->dev->hw_features |= NETIF_F_RXCSUM; 757d7e6ed97SKittipon Meesompop card->dev->vlan_features |= NETIF_F_RXCSUM; 758d7e6ed97SKittipon Meesompop } 7590aef8392SJulian Wiedmann if (qeth_is_supported(card, IPA_OUTBOUND_TSO)) { 7600aef8392SJulian Wiedmann card->dev->hw_features |= NETIF_F_TSO; 7610aef8392SJulian Wiedmann card->dev->vlan_features |= NETIF_F_TSO; 7620aef8392SJulian Wiedmann } 7630aef8392SJulian Wiedmann if (qeth_is_supported6(card, IPA_OUTBOUND_TSO)) { 7640aef8392SJulian Wiedmann card->dev->hw_features |= NETIF_F_TSO6; 7650aef8392SJulian Wiedmann card->dev->vlan_features |= NETIF_F_TSO6; 7660aef8392SJulian Wiedmann } 7670aef8392SJulian Wiedmann 7680aef8392SJulian Wiedmann if (card->dev->hw_features & (NETIF_F_TSO | NETIF_F_TSO6)) { 7690aef8392SJulian Wiedmann card->dev->needed_headroom = sizeof(struct qeth_hdr_tso); 7700aef8392SJulian Wiedmann netif_set_gso_max_size(card->dev, 7710aef8392SJulian Wiedmann PAGE_SIZE * (QDIO_MAX_ELEMENTS_PER_BUFFER - 1)); 7720aef8392SJulian Wiedmann } 7730d6f02d3SJulian Wiedmann 7748024cc9eSJulian Wiedmann add_napi: 775d73ef324SJulian Wiedmann netif_napi_add(card->dev, &card->napi, qeth_poll, QETH_NAPI_WEIGHT); 776d3d1b205SJulian Wiedmann rc = register_netdev(card->dev); 7779fae5c3bSJulian Wiedmann if (!rc && carrier_ok) 7789fae5c3bSJulian Wiedmann netif_carrier_on(card->dev); 7799fae5c3bSJulian Wiedmann 780d3d1b205SJulian Wiedmann if (rc) 781d3d1b205SJulian Wiedmann card->dev->netdev_ops = NULL; 782d3d1b205SJulian Wiedmann return rc; 7834a71df50SFrank Blaschka } 7844a71df50SFrank Blaschka 7854d7def2aSThomas Richter static int qeth_l2_start_ipassists(struct qeth_card *card) 7864d7def2aSThomas Richter { 7874d7def2aSThomas Richter /* configure isolation level */ 7884d7def2aSThomas Richter if (qeth_set_access_ctrl_online(card, 0)) 7894d7def2aSThomas Richter return -ENODEV; 7904d7def2aSThomas Richter return 0; 7914d7def2aSThomas Richter } 7924d7def2aSThomas Richter 793521c10eaSJulian Wiedmann static void qeth_l2_trace_features(struct qeth_card *card) 794521c10eaSJulian Wiedmann { 795a45b3fafSHans Wippel /* Set BridgePort features */ 796a45b3fafSHans Wippel QETH_CARD_TEXT(card, 2, "featuSBP"); 797521c10eaSJulian Wiedmann QETH_CARD_HEX(card, 2, &card->options.sbp.supported_funcs, 798521c10eaSJulian Wiedmann sizeof(card->options.sbp.supported_funcs)); 799a45b3fafSHans Wippel /* VNIC Characteristics features */ 800a45b3fafSHans Wippel QETH_CARD_TEXT(card, 2, "feaVNICC"); 801a45b3fafSHans Wippel QETH_CARD_HEX(card, 2, &card->options.vnicc.sup_chars, 802a45b3fafSHans Wippel sizeof(card->options.vnicc.sup_chars)); 803521c10eaSJulian Wiedmann } 804521c10eaSJulian Wiedmann 8054a71df50SFrank Blaschka static int __qeth_l2_set_online(struct ccwgroup_device *gdev, int recovery_mode) 8064a71df50SFrank Blaschka { 8074a71df50SFrank Blaschka struct qeth_card *card = dev_get_drvdata(&gdev->dev); 808fa3d2e60SJulian Wiedmann struct net_device *dev = card->dev; 8094a71df50SFrank Blaschka int rc = 0; 8109fae5c3bSJulian Wiedmann bool carrier_ok; 8114a71df50SFrank Blaschka 8129dc48cccSUrsula Braun mutex_lock(&card->discipline_mutex); 813c4949f07SFrank Blaschka mutex_lock(&card->conf_mutex); 814d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "setonlin"); 815d11ba0c4SPeter Tiedemann QETH_DBF_HEX(SETUP, 2, &card, sizeof(void *)); 8164a71df50SFrank Blaschka 8179fae5c3bSJulian Wiedmann rc = qeth_core_hardsetup_card(card, &carrier_ok); 8184a71df50SFrank Blaschka if (rc) { 8191aec42bcSThomas Richter QETH_DBF_TEXT_(SETUP, 2, "2err%04x", rc); 820aa909224SUrsula Braun rc = -ENODEV; 8214a71df50SFrank Blaschka goto out_remove; 8224a71df50SFrank Blaschka } 823654e3d48SJulian Wiedmann 8241da74b1cSFrank Blaschka if (qeth_is_diagass_supported(card, QETH_DIAGS_CMD_TRAP)) { 8251da74b1cSFrank Blaschka if (card->info.hwtrap && 8261da74b1cSFrank Blaschka qeth_hw_trap(card, QETH_DIAGS_TRAP_ARM)) 8271da74b1cSFrank Blaschka card->info.hwtrap = 0; 8281da74b1cSFrank Blaschka } else 8291da74b1cSFrank Blaschka card->info.hwtrap = 0; 8301da74b1cSFrank Blaschka 831d7ef489fSJulian Wiedmann qeth_bridgeport_query_support(card); 832d7ef489fSJulian Wiedmann if (card->options.sbp.supported_funcs) 833d7ef489fSJulian Wiedmann dev_info(&card->gdev->dev, 834d7ef489fSJulian Wiedmann "The device represents a Bridge Capable Port\n"); 835d7ef489fSJulian Wiedmann 836d7ef489fSJulian Wiedmann qeth_l2_register_dev_addr(card); 837d7ef489fSJulian Wiedmann 838a45b3fafSHans Wippel /* for the rx_bcast characteristic, init VNICC after setmac */ 839a45b3fafSHans Wippel qeth_l2_vnicc_init(card); 840a45b3fafSHans Wippel 841a45b3fafSHans Wippel qeth_trace_features(card); 842a45b3fafSHans Wippel qeth_l2_trace_features(card); 843a45b3fafSHans Wippel 844b4d72c08SEugene Crosser qeth_l2_setup_bridgeport_attrs(card); 845b4d72c08SEugene Crosser 8464a71df50SFrank Blaschka card->state = CARD_STATE_HARDSETUP; 8474a71df50SFrank Blaschka qeth_print_status_message(card); 8484a71df50SFrank Blaschka 8494a71df50SFrank Blaschka /* softsetup */ 850d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "softsetp"); 8514a71df50SFrank Blaschka 8525113fec0SUrsula Braun if ((card->info.type == QETH_CARD_TYPE_OSD) || 8530f54761dSStefan Raspl (card->info.type == QETH_CARD_TYPE_OSX)) { 8548f43fb00SThomas Richter rc = qeth_l2_start_ipassists(card); 8558f43fb00SThomas Richter if (rc) 8560f54761dSStefan Raspl goto out_remove; 8570f54761dSStefan Raspl } 8585113fec0SUrsula Braun 8594a71df50SFrank Blaschka rc = qeth_init_qdio_queues(card); 8604a71df50SFrank Blaschka if (rc) { 861d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "6err%d", rc); 862aa909224SUrsula Braun rc = -ENODEV; 8634a71df50SFrank Blaschka goto out_remove; 8644a71df50SFrank Blaschka } 8654a71df50SFrank Blaschka card->state = CARD_STATE_SOFTSETUP; 8664a71df50SFrank Blaschka 8674a71df50SFrank Blaschka qeth_set_allowed_threads(card, 0xffffffff, 0); 868d025da9eSJulian Wiedmann 869fa3d2e60SJulian Wiedmann if (!qeth_netdev_is_registered(dev)) { 870fa3d2e60SJulian Wiedmann rc = qeth_l2_setup_netdev(card, carrier_ok); 871fa3d2e60SJulian Wiedmann if (rc) 872fa3d2e60SJulian Wiedmann goto out_remove; 8734a71df50SFrank Blaschka } else { 8744a71df50SFrank Blaschka rtnl_lock(); 875fa3d2e60SJulian Wiedmann if (carrier_ok) 876fa3d2e60SJulian Wiedmann netif_carrier_on(dev); 877fa3d2e60SJulian Wiedmann else 878fa3d2e60SJulian Wiedmann netif_carrier_off(dev); 879fa3d2e60SJulian Wiedmann 880e6e771b3SJulian Wiedmann netif_device_attach(dev); 881fa3d2e60SJulian Wiedmann qeth_enable_hw_features(dev); 882fa3d2e60SJulian Wiedmann 883d7d543f2SJulian Wiedmann if (card->info.open_when_online) { 884d7d543f2SJulian Wiedmann card->info.open_when_online = 0; 885fa3d2e60SJulian Wiedmann if (recovery_mode && !IS_OSN(card)) { 886fa3d2e60SJulian Wiedmann if (!qeth_l2_validate_addr(dev)) { 887e6e771b3SJulian Wiedmann qeth_open(dev); 888fa3d2e60SJulian Wiedmann qeth_l2_set_rx_mode(dev); 8894a71df50SFrank Blaschka } 890fa3d2e60SJulian Wiedmann } else { 891fa3d2e60SJulian Wiedmann dev_open(dev, NULL); 892fa3d2e60SJulian Wiedmann } 893fa3d2e60SJulian Wiedmann } 894fa3d2e60SJulian Wiedmann rtnl_unlock(); 8954a71df50SFrank Blaschka } 8964a71df50SFrank Blaschka /* let user_space know that device is online */ 8974a71df50SFrank Blaschka kobject_uevent(&gdev->dev.kobj, KOBJ_CHANGE); 898c4949f07SFrank Blaschka mutex_unlock(&card->conf_mutex); 8999dc48cccSUrsula Braun mutex_unlock(&card->discipline_mutex); 9004a71df50SFrank Blaschka return 0; 901aa909224SUrsula Braun 9024a71df50SFrank Blaschka out_remove: 9034a71df50SFrank Blaschka qeth_l2_stop_card(card, 0); 9044a71df50SFrank Blaschka ccw_device_set_offline(CARD_DDEV(card)); 9054a71df50SFrank Blaschka ccw_device_set_offline(CARD_WDEV(card)); 9064a71df50SFrank Blaschka ccw_device_set_offline(CARD_RDEV(card)); 90722ae2790SUrsula Braun qdio_free(CARD_DDEV(card)); 9084a71df50SFrank Blaschka card->state = CARD_STATE_DOWN; 909d7d543f2SJulian Wiedmann 910c4949f07SFrank Blaschka mutex_unlock(&card->conf_mutex); 9119dc48cccSUrsula Braun mutex_unlock(&card->discipline_mutex); 912aa909224SUrsula Braun return rc; 9134a71df50SFrank Blaschka } 9144a71df50SFrank Blaschka 9154a71df50SFrank Blaschka static int qeth_l2_set_online(struct ccwgroup_device *gdev) 9164a71df50SFrank Blaschka { 9174a71df50SFrank Blaschka return __qeth_l2_set_online(gdev, 0); 9184a71df50SFrank Blaschka } 9194a71df50SFrank Blaschka 9204a71df50SFrank Blaschka static int __qeth_l2_set_offline(struct ccwgroup_device *cgdev, 9214a71df50SFrank Blaschka int recovery_mode) 9224a71df50SFrank Blaschka { 9234a71df50SFrank Blaschka struct qeth_card *card = dev_get_drvdata(&cgdev->dev); 9244a71df50SFrank Blaschka int rc = 0, rc2 = 0, rc3 = 0; 9254a71df50SFrank Blaschka 9269dc48cccSUrsula Braun mutex_lock(&card->discipline_mutex); 927c4949f07SFrank Blaschka mutex_lock(&card->conf_mutex); 928d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 3, "setoffl"); 929d11ba0c4SPeter Tiedemann QETH_DBF_HEX(SETUP, 3, &card, sizeof(void *)); 9304a71df50SFrank Blaschka 931d7ef489fSJulian Wiedmann if ((!recovery_mode && card->info.hwtrap) || card->info.hwtrap == 2) { 932d7ef489fSJulian Wiedmann qeth_hw_trap(card, QETH_DIAGS_TRAP_DISARM); 933d7ef489fSJulian Wiedmann card->info.hwtrap = 1; 934d7ef489fSJulian Wiedmann } 935d7ef489fSJulian Wiedmann 936e6e771b3SJulian Wiedmann rtnl_lock(); 937d7d543f2SJulian Wiedmann card->info.open_when_online = card->dev->flags & IFF_UP; 938e6e771b3SJulian Wiedmann netif_device_detach(card->dev); 9394a71df50SFrank Blaschka netif_carrier_off(card->dev); 940e6e771b3SJulian Wiedmann rtnl_unlock(); 941e6e771b3SJulian Wiedmann 9420f5623c9SUrsula Braun qeth_l2_stop_card(card, recovery_mode); 9434a71df50SFrank Blaschka rc = ccw_device_set_offline(CARD_DDEV(card)); 9444a71df50SFrank Blaschka rc2 = ccw_device_set_offline(CARD_WDEV(card)); 9454a71df50SFrank Blaschka rc3 = ccw_device_set_offline(CARD_RDEV(card)); 9464a71df50SFrank Blaschka if (!rc) 9474a71df50SFrank Blaschka rc = (rc2) ? rc2 : rc3; 9484a71df50SFrank Blaschka if (rc) 949d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "1err%d", rc); 95022ae2790SUrsula Braun qdio_free(CARD_DDEV(card)); 951d7d543f2SJulian Wiedmann 9524a71df50SFrank Blaschka /* let user_space know that device is offline */ 9534a71df50SFrank Blaschka kobject_uevent(&cgdev->dev.kobj, KOBJ_CHANGE); 954c4949f07SFrank Blaschka mutex_unlock(&card->conf_mutex); 9559dc48cccSUrsula Braun mutex_unlock(&card->discipline_mutex); 9564a71df50SFrank Blaschka return 0; 9574a71df50SFrank Blaschka } 9584a71df50SFrank Blaschka 9594a71df50SFrank Blaschka static int qeth_l2_set_offline(struct ccwgroup_device *cgdev) 9604a71df50SFrank Blaschka { 9614a71df50SFrank Blaschka return __qeth_l2_set_offline(cgdev, 0); 9624a71df50SFrank Blaschka } 9634a71df50SFrank Blaschka 9644a71df50SFrank Blaschka static int qeth_l2_recover(void *ptr) 9654a71df50SFrank Blaschka { 9664a71df50SFrank Blaschka struct qeth_card *card; 9674a71df50SFrank Blaschka int rc = 0; 9684a71df50SFrank Blaschka 9694a71df50SFrank Blaschka card = (struct qeth_card *) ptr; 970847a50fdSCarsten Otte QETH_CARD_TEXT(card, 2, "recover1"); 9714a71df50SFrank Blaschka if (!qeth_do_run_thread(card, QETH_RECOVER_THREAD)) 9724a71df50SFrank Blaschka return 0; 973847a50fdSCarsten Otte QETH_CARD_TEXT(card, 2, "recover2"); 97474eacdb9SFrank Blaschka dev_warn(&card->gdev->dev, 97574eacdb9SFrank Blaschka "A recovery process has been started for the device\n"); 9764a71df50SFrank Blaschka __qeth_l2_set_offline(card->gdev, 1); 9774a71df50SFrank Blaschka rc = __qeth_l2_set_online(card->gdev, 1); 9784a71df50SFrank Blaschka if (!rc) 97974eacdb9SFrank Blaschka dev_info(&card->gdev->dev, 98074eacdb9SFrank Blaschka "Device successfully recovered!\n"); 98128a7e4c9SUrsula Braun else { 9820f54761dSStefan Raspl qeth_close_dev(card); 98374eacdb9SFrank Blaschka dev_warn(&card->gdev->dev, "The qeth device driver " 98474eacdb9SFrank Blaschka "failed to recover an error on the device\n"); 98528a7e4c9SUrsula Braun } 986a1c3ed4cSFrank Blaschka qeth_clear_thread_start_bit(card, QETH_RECOVER_THREAD); 987a1c3ed4cSFrank Blaschka qeth_clear_thread_running_bit(card, QETH_RECOVER_THREAD); 9884a71df50SFrank Blaschka return 0; 9894a71df50SFrank Blaschka } 9904a71df50SFrank Blaschka 9914a71df50SFrank Blaschka static int __init qeth_l2_init(void) 9924a71df50SFrank Blaschka { 99374eacdb9SFrank Blaschka pr_info("register layer 2 discipline\n"); 9944a71df50SFrank Blaschka return 0; 9954a71df50SFrank Blaschka } 9964a71df50SFrank Blaschka 9974a71df50SFrank Blaschka static void __exit qeth_l2_exit(void) 9984a71df50SFrank Blaschka { 99974eacdb9SFrank Blaschka pr_info("unregister layer 2 discipline\n"); 10004a71df50SFrank Blaschka } 10014a71df50SFrank Blaschka 1002bbcfcdc8SFrank Blaschka static int qeth_l2_pm_suspend(struct ccwgroup_device *gdev) 1003bbcfcdc8SFrank Blaschka { 1004bbcfcdc8SFrank Blaschka struct qeth_card *card = dev_get_drvdata(&gdev->dev); 1005bbcfcdc8SFrank Blaschka 1006bbcfcdc8SFrank Blaschka qeth_set_allowed_threads(card, 0, 1); 1007bbcfcdc8SFrank Blaschka wait_event(card->wait_q, qeth_threads_running(card, 0xffffffff) == 0); 1008bbcfcdc8SFrank Blaschka if (gdev->state == CCWGROUP_OFFLINE) 1009bbcfcdc8SFrank Blaschka return 0; 1010bbcfcdc8SFrank Blaschka if (card->state == CARD_STATE_UP) { 10111da74b1cSFrank Blaschka if (card->info.hwtrap) 10121da74b1cSFrank Blaschka qeth_hw_trap(card, QETH_DIAGS_TRAP_DISARM); 1013bbcfcdc8SFrank Blaschka __qeth_l2_set_offline(card->gdev, 1); 1014bbcfcdc8SFrank Blaschka } else 1015bbcfcdc8SFrank Blaschka __qeth_l2_set_offline(card->gdev, 0); 1016bbcfcdc8SFrank Blaschka return 0; 1017bbcfcdc8SFrank Blaschka } 1018bbcfcdc8SFrank Blaschka 1019bbcfcdc8SFrank Blaschka static int qeth_l2_pm_resume(struct ccwgroup_device *gdev) 1020bbcfcdc8SFrank Blaschka { 1021bbcfcdc8SFrank Blaschka struct qeth_card *card = dev_get_drvdata(&gdev->dev); 1022bbcfcdc8SFrank Blaschka int rc = 0; 1023bbcfcdc8SFrank Blaschka 1024d7d543f2SJulian Wiedmann if (card->info.open_when_online) { 1025bbcfcdc8SFrank Blaschka rc = __qeth_l2_set_online(card->gdev, 1); 1026bbcfcdc8SFrank Blaschka if (rc) { 1027bbcfcdc8SFrank Blaschka rtnl_lock(); 1028bbcfcdc8SFrank Blaschka dev_close(card->dev); 1029bbcfcdc8SFrank Blaschka rtnl_unlock(); 1030bbcfcdc8SFrank Blaschka } 1031bbcfcdc8SFrank Blaschka } else 1032bbcfcdc8SFrank Blaschka rc = __qeth_l2_set_online(card->gdev, 0); 10336585ac4eSJulian Wiedmann 1034bbcfcdc8SFrank Blaschka qeth_set_allowed_threads(card, 0xffffffff, 0); 1035bbcfcdc8SFrank Blaschka if (rc) 1036bbcfcdc8SFrank Blaschka dev_warn(&card->gdev->dev, "The qeth device driver " 1037bbcfcdc8SFrank Blaschka "failed to recover an error on the device\n"); 1038bbcfcdc8SFrank Blaschka return rc; 1039bbcfcdc8SFrank Blaschka } 1040bbcfcdc8SFrank Blaschka 1041c044dc21SEugene Crosser /* Returns zero if the command is successfully "consumed" */ 1042c044dc21SEugene Crosser static int qeth_l2_control_event(struct qeth_card *card, 1043c044dc21SEugene Crosser struct qeth_ipa_cmd *cmd) 1044c044dc21SEugene Crosser { 1045c044dc21SEugene Crosser switch (cmd->hdr.command) { 10469c23f4daSEugene Crosser case IPA_CMD_SETBRIDGEPORT_OSA: 10479c23f4daSEugene Crosser case IPA_CMD_SETBRIDGEPORT_IQD: 1048c044dc21SEugene Crosser if (cmd->data.sbp.hdr.command_code == 1049c044dc21SEugene Crosser IPA_SBP_BRIDGE_PORT_STATE_CHANGE) { 1050c044dc21SEugene Crosser qeth_bridge_state_change(card, cmd); 1051c044dc21SEugene Crosser return 0; 1052c044dc21SEugene Crosser } else 1053c044dc21SEugene Crosser return 1; 1054c044dc21SEugene Crosser case IPA_CMD_ADDRESS_CHANGE_NOTIF: 1055c044dc21SEugene Crosser qeth_bridge_host_event(card, cmd); 1056c044dc21SEugene Crosser return 0; 1057c044dc21SEugene Crosser default: 1058c044dc21SEugene Crosser return 1; 1059c044dc21SEugene Crosser } 1060c044dc21SEugene Crosser } 1061c044dc21SEugene Crosser 1062c041f2d4SSebastian Ott struct qeth_discipline qeth_l2_discipline = { 10632d2ebb3eSJulian Wiedmann .devtype = &qeth_l2_devtype, 1064d73ef324SJulian Wiedmann .process_rx_buffer = qeth_l2_process_inbound_buffer, 1065c041f2d4SSebastian Ott .recover = qeth_l2_recover, 1066c041f2d4SSebastian Ott .setup = qeth_l2_probe_device, 10674a71df50SFrank Blaschka .remove = qeth_l2_remove_device, 10684a71df50SFrank Blaschka .set_online = qeth_l2_set_online, 10694a71df50SFrank Blaschka .set_offline = qeth_l2_set_offline, 1070bbcfcdc8SFrank Blaschka .freeze = qeth_l2_pm_suspend, 1071bbcfcdc8SFrank Blaschka .thaw = qeth_l2_pm_resume, 1072bbcfcdc8SFrank Blaschka .restore = qeth_l2_pm_resume, 1073942d6984SJulian Wiedmann .do_ioctl = NULL, 1074c044dc21SEugene Crosser .control_event_handler = qeth_l2_control_event, 10754a71df50SFrank Blaschka }; 1076c041f2d4SSebastian Ott EXPORT_SYMBOL_GPL(qeth_l2_discipline); 10774a71df50SFrank Blaschka 10784a71df50SFrank Blaschka static int qeth_osn_send_control_data(struct qeth_card *card, int len, 10794a71df50SFrank Blaschka struct qeth_cmd_buffer *iob) 10804a71df50SFrank Blaschka { 1081750b1625SJulian Wiedmann struct qeth_channel *channel = iob->channel; 10824a71df50SFrank Blaschka int rc = 0; 10834a71df50SFrank Blaschka 1084847a50fdSCarsten Otte QETH_CARD_TEXT(card, 5, "osndctrd"); 10854a71df50SFrank Blaschka 10864a71df50SFrank Blaschka wait_event(card->wait_q, 1087750b1625SJulian Wiedmann atomic_cmpxchg(&channel->irq_pending, 0, 1) == 0); 10884a71df50SFrank Blaschka qeth_prepare_control_data(card, len, iob); 1089847a50fdSCarsten Otte QETH_CARD_TEXT(card, 6, "osnoirqp"); 1090ed47155bSJulian Wiedmann spin_lock_irq(get_ccwdev_lock(channel->ccwdev)); 1091f15cdaf2SJulian Wiedmann rc = ccw_device_start_timeout(channel->ccwdev, channel->ccw, 1092db71bbbdSJulian Wiedmann (addr_t) iob, 0, 0, QETH_IPA_TIMEOUT); 1093ed47155bSJulian Wiedmann spin_unlock_irq(get_ccwdev_lock(channel->ccwdev)); 10944a71df50SFrank Blaschka if (rc) { 109514cc21b6SFrank Blaschka QETH_DBF_MESSAGE(2, "qeth_osn_send_control_data: " 10964a71df50SFrank Blaschka "ccw_device_start rc = %i\n", rc); 1097847a50fdSCarsten Otte QETH_CARD_TEXT_(card, 2, " err%d", rc); 1098750b1625SJulian Wiedmann qeth_release_buffer(channel, iob); 1099750b1625SJulian Wiedmann atomic_set(&channel->irq_pending, 0); 11004a71df50SFrank Blaschka wake_up(&card->wait_q); 11014a71df50SFrank Blaschka } 11024a71df50SFrank Blaschka return rc; 11034a71df50SFrank Blaschka } 11044a71df50SFrank Blaschka 11054a71df50SFrank Blaschka static int qeth_osn_send_ipa_cmd(struct qeth_card *card, 1106c2153277SJulian Wiedmann struct qeth_cmd_buffer *iob) 11074a71df50SFrank Blaschka { 1108c2153277SJulian Wiedmann u16 length; 11094a71df50SFrank Blaschka 1110847a50fdSCarsten Otte QETH_CARD_TEXT(card, 4, "osndipa"); 11114a71df50SFrank Blaschka 1112c2153277SJulian Wiedmann memcpy(&length, QETH_IPA_PDU_LEN_TOTAL(iob->data), 2); 1113c2153277SJulian Wiedmann return qeth_osn_send_control_data(card, length, iob); 11144a71df50SFrank Blaschka } 11154a71df50SFrank Blaschka 11164a71df50SFrank Blaschka int qeth_osn_assist(struct net_device *dev, void *data, int data_len) 11174a71df50SFrank Blaschka { 11184a71df50SFrank Blaschka struct qeth_cmd_buffer *iob; 11194a71df50SFrank Blaschka struct qeth_card *card; 11204a71df50SFrank Blaschka 11214a71df50SFrank Blaschka if (!dev) 11224a71df50SFrank Blaschka return -ENODEV; 1123509e2562SHeiko Carstens card = dev->ml_priv; 11244a71df50SFrank Blaschka if (!card) 11254a71df50SFrank Blaschka return -ENODEV; 1126847a50fdSCarsten Otte QETH_CARD_TEXT(card, 2, "osnsdmc"); 1127c3521254SEugene Crosser if (!qeth_card_hw_is_reachable(card)) 11284a71df50SFrank Blaschka return -ENODEV; 11294a71df50SFrank Blaschka iob = qeth_wait_for_buffer(&card->write); 1130c2153277SJulian Wiedmann qeth_prepare_ipa_cmd(card, iob, (u16) data_len); 1131ff5caa7aSJulian Wiedmann memcpy(__ipa_cmd(iob), data, data_len); 1132c2153277SJulian Wiedmann return qeth_osn_send_ipa_cmd(card, iob); 11334a71df50SFrank Blaschka } 11344a71df50SFrank Blaschka EXPORT_SYMBOL(qeth_osn_assist); 11354a71df50SFrank Blaschka 11364a71df50SFrank Blaschka int qeth_osn_register(unsigned char *read_dev_no, struct net_device **dev, 11374a71df50SFrank Blaschka int (*assist_cb)(struct net_device *, void *), 11384a71df50SFrank Blaschka int (*data_cb)(struct sk_buff *)) 11394a71df50SFrank Blaschka { 11404a71df50SFrank Blaschka struct qeth_card *card; 1141d7d18da1SJulian Wiedmann char bus_id[16]; 1142d7d18da1SJulian Wiedmann u16 devno; 11434a71df50SFrank Blaschka 1144d7d18da1SJulian Wiedmann memcpy(&devno, read_dev_no, 2); 1145d7d18da1SJulian Wiedmann sprintf(bus_id, "0.0.%04x", devno); 1146d7d18da1SJulian Wiedmann card = qeth_get_card_by_busid(bus_id); 1147d7d18da1SJulian Wiedmann if (!card || !IS_OSN(card)) 11484a71df50SFrank Blaschka return -ENODEV; 1149d7d18da1SJulian Wiedmann *dev = card->dev; 1150d7d18da1SJulian Wiedmann 1151847a50fdSCarsten Otte QETH_CARD_TEXT(card, 2, "osnreg"); 11524a71df50SFrank Blaschka if ((assist_cb == NULL) || (data_cb == NULL)) 11534a71df50SFrank Blaschka return -EINVAL; 11544a71df50SFrank Blaschka card->osn_info.assist_cb = assist_cb; 11554a71df50SFrank Blaschka card->osn_info.data_cb = data_cb; 11564a71df50SFrank Blaschka return 0; 11574a71df50SFrank Blaschka } 11584a71df50SFrank Blaschka EXPORT_SYMBOL(qeth_osn_register); 11594a71df50SFrank Blaschka 11604a71df50SFrank Blaschka void qeth_osn_deregister(struct net_device *dev) 11614a71df50SFrank Blaschka { 11624a71df50SFrank Blaschka struct qeth_card *card; 11634a71df50SFrank Blaschka 11644a71df50SFrank Blaschka if (!dev) 11654a71df50SFrank Blaschka return; 1166509e2562SHeiko Carstens card = dev->ml_priv; 11674a71df50SFrank Blaschka if (!card) 11684a71df50SFrank Blaschka return; 1169847a50fdSCarsten Otte QETH_CARD_TEXT(card, 2, "osndereg"); 11704a71df50SFrank Blaschka card->osn_info.assist_cb = NULL; 11714a71df50SFrank Blaschka card->osn_info.data_cb = NULL; 11724a71df50SFrank Blaschka return; 11734a71df50SFrank Blaschka } 11744a71df50SFrank Blaschka EXPORT_SYMBOL(qeth_osn_deregister); 11754a71df50SFrank Blaschka 1176b4d72c08SEugene Crosser /* SETBRIDGEPORT support, async notifications */ 1177b4d72c08SEugene Crosser 11789f48b9dbSEugene Crosser enum qeth_an_event_type {anev_reg_unreg, anev_abort, anev_reset}; 11799f48b9dbSEugene Crosser 11809f48b9dbSEugene Crosser /** 11819f48b9dbSEugene Crosser * qeth_bridge_emit_host_event() - bridgeport address change notification 11829f48b9dbSEugene Crosser * @card: qeth_card structure pointer, for udev events. 11839f48b9dbSEugene Crosser * @evtype: "normal" register/unregister, or abort, or reset. For abort 11849f48b9dbSEugene Crosser * and reset token and addr_lnid are unused and may be NULL. 11859f48b9dbSEugene Crosser * @code: event bitmask: high order bit 0x80 value 1 means removal of an 11869f48b9dbSEugene Crosser * object, 0 - addition of an object. 11879f48b9dbSEugene Crosser * 0x01 - VLAN, 0x02 - MAC, 0x03 - VLAN and MAC. 11889f48b9dbSEugene Crosser * @token: "network token" structure identifying physical address of the port. 11899f48b9dbSEugene Crosser * @addr_lnid: pointer to structure with MAC address and VLAN ID. 11909f48b9dbSEugene Crosser * 11919f48b9dbSEugene Crosser * This function is called when registrations and deregistrations are 11929f48b9dbSEugene Crosser * reported by the hardware, and also when notifications are enabled - 11939f48b9dbSEugene Crosser * for all currently registered addresses. 11949f48b9dbSEugene Crosser */ 11959f48b9dbSEugene Crosser static void qeth_bridge_emit_host_event(struct qeth_card *card, 11969f48b9dbSEugene Crosser enum qeth_an_event_type evtype, 11979f48b9dbSEugene Crosser u8 code, struct net_if_token *token, struct mac_addr_lnid *addr_lnid) 11989f48b9dbSEugene Crosser { 11999f48b9dbSEugene Crosser char str[7][32]; 12009f48b9dbSEugene Crosser char *env[8]; 12019f48b9dbSEugene Crosser int i = 0; 12029f48b9dbSEugene Crosser 12039f48b9dbSEugene Crosser switch (evtype) { 12049f48b9dbSEugene Crosser case anev_reg_unreg: 12059f48b9dbSEugene Crosser snprintf(str[i], sizeof(str[i]), "BRIDGEDHOST=%s", 12069f48b9dbSEugene Crosser (code & IPA_ADDR_CHANGE_CODE_REMOVAL) 12079f48b9dbSEugene Crosser ? "deregister" : "register"); 12089f48b9dbSEugene Crosser env[i] = str[i]; i++; 12099f48b9dbSEugene Crosser if (code & IPA_ADDR_CHANGE_CODE_VLANID) { 12109f48b9dbSEugene Crosser snprintf(str[i], sizeof(str[i]), "VLAN=%d", 12119f48b9dbSEugene Crosser addr_lnid->lnid); 12129f48b9dbSEugene Crosser env[i] = str[i]; i++; 12139f48b9dbSEugene Crosser } 12149f48b9dbSEugene Crosser if (code & IPA_ADDR_CHANGE_CODE_MACADDR) { 12159846e70bSEugene Crosser snprintf(str[i], sizeof(str[i]), "MAC=%pM", 12169846e70bSEugene Crosser addr_lnid->mac); 12179f48b9dbSEugene Crosser env[i] = str[i]; i++; 12189f48b9dbSEugene Crosser } 12199f48b9dbSEugene Crosser snprintf(str[i], sizeof(str[i]), "NTOK_BUSID=%x.%x.%04x", 12209f48b9dbSEugene Crosser token->cssid, token->ssid, token->devnum); 12219f48b9dbSEugene Crosser env[i] = str[i]; i++; 12229f48b9dbSEugene Crosser snprintf(str[i], sizeof(str[i]), "NTOK_IID=%02x", token->iid); 12239f48b9dbSEugene Crosser env[i] = str[i]; i++; 12249f48b9dbSEugene Crosser snprintf(str[i], sizeof(str[i]), "NTOK_CHPID=%02x", 12259f48b9dbSEugene Crosser token->chpid); 12269f48b9dbSEugene Crosser env[i] = str[i]; i++; 12279f48b9dbSEugene Crosser snprintf(str[i], sizeof(str[i]), "NTOK_CHID=%04x", token->chid); 12289f48b9dbSEugene Crosser env[i] = str[i]; i++; 12299f48b9dbSEugene Crosser break; 12309f48b9dbSEugene Crosser case anev_abort: 12319f48b9dbSEugene Crosser snprintf(str[i], sizeof(str[i]), "BRIDGEDHOST=abort"); 12329f48b9dbSEugene Crosser env[i] = str[i]; i++; 12339f48b9dbSEugene Crosser break; 12349f48b9dbSEugene Crosser case anev_reset: 12359f48b9dbSEugene Crosser snprintf(str[i], sizeof(str[i]), "BRIDGEDHOST=reset"); 12369f48b9dbSEugene Crosser env[i] = str[i]; i++; 12379f48b9dbSEugene Crosser break; 12389f48b9dbSEugene Crosser } 12399f48b9dbSEugene Crosser env[i] = NULL; 12409f48b9dbSEugene Crosser kobject_uevent_env(&card->gdev->dev.kobj, KOBJ_CHANGE, env); 12419f48b9dbSEugene Crosser } 12429f48b9dbSEugene Crosser 1243b4d72c08SEugene Crosser struct qeth_bridge_state_data { 1244b4d72c08SEugene Crosser struct work_struct worker; 1245b4d72c08SEugene Crosser struct qeth_card *card; 1246b4d72c08SEugene Crosser struct qeth_sbp_state_change qports; 1247b4d72c08SEugene Crosser }; 1248b4d72c08SEugene Crosser 1249b4d72c08SEugene Crosser static void qeth_bridge_state_change_worker(struct work_struct *work) 1250b4d72c08SEugene Crosser { 1251b4d72c08SEugene Crosser struct qeth_bridge_state_data *data = 1252b4d72c08SEugene Crosser container_of(work, struct qeth_bridge_state_data, worker); 1253b4d72c08SEugene Crosser /* We are only interested in the first entry - local port */ 1254b4d72c08SEugene Crosser struct qeth_sbp_port_entry *entry = &data->qports.entry[0]; 1255b4d72c08SEugene Crosser char env_locrem[32]; 1256b4d72c08SEugene Crosser char env_role[32]; 1257b4d72c08SEugene Crosser char env_state[32]; 1258b4d72c08SEugene Crosser char *env[] = { 1259b4d72c08SEugene Crosser env_locrem, 1260b4d72c08SEugene Crosser env_role, 1261b4d72c08SEugene Crosser env_state, 1262b4d72c08SEugene Crosser NULL 1263b4d72c08SEugene Crosser }; 1264b4d72c08SEugene Crosser 1265b4d72c08SEugene Crosser /* Role should not change by itself, but if it did, */ 1266b4d72c08SEugene Crosser /* information from the hardware is authoritative. */ 1267b4d72c08SEugene Crosser mutex_lock(&data->card->conf_mutex); 1268b4d72c08SEugene Crosser data->card->options.sbp.role = entry->role; 1269b4d72c08SEugene Crosser mutex_unlock(&data->card->conf_mutex); 1270b4d72c08SEugene Crosser 1271b4d72c08SEugene Crosser snprintf(env_locrem, sizeof(env_locrem), "BRIDGEPORT=statechange"); 1272b4d72c08SEugene Crosser snprintf(env_role, sizeof(env_role), "ROLE=%s", 1273b4d72c08SEugene Crosser (entry->role == QETH_SBP_ROLE_NONE) ? "none" : 1274b4d72c08SEugene Crosser (entry->role == QETH_SBP_ROLE_PRIMARY) ? "primary" : 1275b4d72c08SEugene Crosser (entry->role == QETH_SBP_ROLE_SECONDARY) ? "secondary" : 1276b4d72c08SEugene Crosser "<INVALID>"); 1277b4d72c08SEugene Crosser snprintf(env_state, sizeof(env_state), "STATE=%s", 1278b4d72c08SEugene Crosser (entry->state == QETH_SBP_STATE_INACTIVE) ? "inactive" : 1279b4d72c08SEugene Crosser (entry->state == QETH_SBP_STATE_STANDBY) ? "standby" : 1280b4d72c08SEugene Crosser (entry->state == QETH_SBP_STATE_ACTIVE) ? "active" : 1281b4d72c08SEugene Crosser "<INVALID>"); 1282b4d72c08SEugene Crosser kobject_uevent_env(&data->card->gdev->dev.kobj, 1283b4d72c08SEugene Crosser KOBJ_CHANGE, env); 1284b4d72c08SEugene Crosser kfree(data); 1285b4d72c08SEugene Crosser } 1286b4d72c08SEugene Crosser 1287c044dc21SEugene Crosser static void qeth_bridge_state_change(struct qeth_card *card, 1288c044dc21SEugene Crosser struct qeth_ipa_cmd *cmd) 1289b4d72c08SEugene Crosser { 1290b4d72c08SEugene Crosser struct qeth_sbp_state_change *qports = 1291b4d72c08SEugene Crosser &cmd->data.sbp.data.state_change; 1292b4d72c08SEugene Crosser struct qeth_bridge_state_data *data; 1293b4d72c08SEugene Crosser int extrasize; 1294b4d72c08SEugene Crosser 1295b4d72c08SEugene Crosser QETH_CARD_TEXT(card, 2, "brstchng"); 1296b4d72c08SEugene Crosser if (qports->entry_length != sizeof(struct qeth_sbp_port_entry)) { 12978a593148SThomas Richter QETH_CARD_TEXT_(card, 2, "BPsz%04x", qports->entry_length); 1298b4d72c08SEugene Crosser return; 1299b4d72c08SEugene Crosser } 1300b4d72c08SEugene Crosser extrasize = sizeof(struct qeth_sbp_port_entry) * qports->num_entries; 1301b4d72c08SEugene Crosser data = kzalloc(sizeof(struct qeth_bridge_state_data) + extrasize, 1302b4d72c08SEugene Crosser GFP_ATOMIC); 1303b4d72c08SEugene Crosser if (!data) { 1304b4d72c08SEugene Crosser QETH_CARD_TEXT(card, 2, "BPSalloc"); 1305b4d72c08SEugene Crosser return; 1306b4d72c08SEugene Crosser } 1307b4d72c08SEugene Crosser INIT_WORK(&data->worker, qeth_bridge_state_change_worker); 1308b4d72c08SEugene Crosser data->card = card; 1309b4d72c08SEugene Crosser memcpy(&data->qports, qports, 1310b4d72c08SEugene Crosser sizeof(struct qeth_sbp_state_change) + extrasize); 1311c0a2e4d1SJulian Wiedmann queue_work(card->event_wq, &data->worker); 1312b4d72c08SEugene Crosser } 1313b4d72c08SEugene Crosser 13149f48b9dbSEugene Crosser struct qeth_bridge_host_data { 13159f48b9dbSEugene Crosser struct work_struct worker; 13169f48b9dbSEugene Crosser struct qeth_card *card; 13179f48b9dbSEugene Crosser struct qeth_ipacmd_addr_change hostevs; 13189f48b9dbSEugene Crosser }; 13199f48b9dbSEugene Crosser 13209f48b9dbSEugene Crosser static void qeth_bridge_host_event_worker(struct work_struct *work) 13219f48b9dbSEugene Crosser { 13229f48b9dbSEugene Crosser struct qeth_bridge_host_data *data = 13239f48b9dbSEugene Crosser container_of(work, struct qeth_bridge_host_data, worker); 13249f48b9dbSEugene Crosser int i; 13259f48b9dbSEugene Crosser 13269f48b9dbSEugene Crosser if (data->hostevs.lost_event_mask) { 13279f48b9dbSEugene Crosser dev_info(&data->card->gdev->dev, 13289c23f4daSEugene Crosser "Address notification from the Bridge Port stopped %s (%s)\n", 13299f48b9dbSEugene Crosser data->card->dev->name, 13309f48b9dbSEugene Crosser (data->hostevs.lost_event_mask == 0x01) 13319f48b9dbSEugene Crosser ? "Overflow" 13329f48b9dbSEugene Crosser : (data->hostevs.lost_event_mask == 0x02) 13339f48b9dbSEugene Crosser ? "Bridge port state change" 13349f48b9dbSEugene Crosser : "Unknown reason"); 13359f48b9dbSEugene Crosser mutex_lock(&data->card->conf_mutex); 13369f48b9dbSEugene Crosser data->card->options.sbp.hostnotification = 0; 13379f48b9dbSEugene Crosser mutex_unlock(&data->card->conf_mutex); 13389f48b9dbSEugene Crosser qeth_bridge_emit_host_event(data->card, anev_abort, 13399f48b9dbSEugene Crosser 0, NULL, NULL); 13409f48b9dbSEugene Crosser } else 13419f48b9dbSEugene Crosser for (i = 0; i < data->hostevs.num_entries; i++) { 13429f48b9dbSEugene Crosser struct qeth_ipacmd_addr_change_entry *entry = 13439f48b9dbSEugene Crosser &data->hostevs.entry[i]; 13449f48b9dbSEugene Crosser qeth_bridge_emit_host_event(data->card, 13459f48b9dbSEugene Crosser anev_reg_unreg, 13469f48b9dbSEugene Crosser entry->change_code, 13479f48b9dbSEugene Crosser &entry->token, &entry->addr_lnid); 13489f48b9dbSEugene Crosser } 13499f48b9dbSEugene Crosser kfree(data); 13509f48b9dbSEugene Crosser } 13519f48b9dbSEugene Crosser 1352c044dc21SEugene Crosser static void qeth_bridge_host_event(struct qeth_card *card, 1353c044dc21SEugene Crosser struct qeth_ipa_cmd *cmd) 13549f48b9dbSEugene Crosser { 13559f48b9dbSEugene Crosser struct qeth_ipacmd_addr_change *hostevs = 13569f48b9dbSEugene Crosser &cmd->data.addrchange; 13579f48b9dbSEugene Crosser struct qeth_bridge_host_data *data; 13589f48b9dbSEugene Crosser int extrasize; 13599f48b9dbSEugene Crosser 13609f48b9dbSEugene Crosser QETH_CARD_TEXT(card, 2, "brhostev"); 13619f48b9dbSEugene Crosser if (cmd->hdr.return_code != 0x0000) { 13629f48b9dbSEugene Crosser if (cmd->hdr.return_code == 0x0010) { 13639f48b9dbSEugene Crosser if (hostevs->lost_event_mask == 0x00) 13649f48b9dbSEugene Crosser hostevs->lost_event_mask = 0xff; 13659f48b9dbSEugene Crosser } else { 13669f48b9dbSEugene Crosser QETH_CARD_TEXT_(card, 2, "BPHe%04x", 13679f48b9dbSEugene Crosser cmd->hdr.return_code); 13689f48b9dbSEugene Crosser return; 13699f48b9dbSEugene Crosser } 13709f48b9dbSEugene Crosser } 13719f48b9dbSEugene Crosser extrasize = sizeof(struct qeth_ipacmd_addr_change_entry) * 13729f48b9dbSEugene Crosser hostevs->num_entries; 13739f48b9dbSEugene Crosser data = kzalloc(sizeof(struct qeth_bridge_host_data) + extrasize, 13749f48b9dbSEugene Crosser GFP_ATOMIC); 13759f48b9dbSEugene Crosser if (!data) { 13769f48b9dbSEugene Crosser QETH_CARD_TEXT(card, 2, "BPHalloc"); 13779f48b9dbSEugene Crosser return; 13789f48b9dbSEugene Crosser } 13799f48b9dbSEugene Crosser INIT_WORK(&data->worker, qeth_bridge_host_event_worker); 13809f48b9dbSEugene Crosser data->card = card; 13819f48b9dbSEugene Crosser memcpy(&data->hostevs, hostevs, 13829f48b9dbSEugene Crosser sizeof(struct qeth_ipacmd_addr_change) + extrasize); 1383c0a2e4d1SJulian Wiedmann queue_work(card->event_wq, &data->worker); 13849f48b9dbSEugene Crosser } 13859f48b9dbSEugene Crosser 1386b4d72c08SEugene Crosser /* SETBRIDGEPORT support; sending commands */ 1387b4d72c08SEugene Crosser 1388b4d72c08SEugene Crosser struct _qeth_sbp_cbctl { 1389b4d72c08SEugene Crosser union { 1390b4d72c08SEugene Crosser u32 supported; 1391b4d72c08SEugene Crosser struct { 1392b4d72c08SEugene Crosser enum qeth_sbp_roles *role; 1393b4d72c08SEugene Crosser enum qeth_sbp_states *state; 1394b4d72c08SEugene Crosser } qports; 1395b4d72c08SEugene Crosser } data; 1396b4d72c08SEugene Crosser }; 1397b4d72c08SEugene Crosser 1398b4d72c08SEugene Crosser static int qeth_bridgeport_makerc(struct qeth_card *card, 13991709ff8dSJulian Wiedmann struct qeth_ipa_cmd *cmd) 1400b4d72c08SEugene Crosser { 14011709ff8dSJulian Wiedmann struct qeth_ipacmd_setbridgeport *sbp = &cmd->data.sbp; 14021709ff8dSJulian Wiedmann enum qeth_ipa_sbp_cmd setcmd = sbp->hdr.command_code; 14031709ff8dSJulian Wiedmann u16 ipa_rc = cmd->hdr.return_code; 14041709ff8dSJulian Wiedmann u16 sbp_rc = sbp->hdr.return_code; 1405b4d72c08SEugene Crosser int rc; 1406b4d72c08SEugene Crosser 14071709ff8dSJulian Wiedmann if (ipa_rc == IPA_RC_SUCCESS && sbp_rc == IPA_RC_SUCCESS) 14081709ff8dSJulian Wiedmann return 0; 14091709ff8dSJulian Wiedmann 14101709ff8dSJulian Wiedmann if ((IS_IQD(card) && ipa_rc == IPA_RC_SUCCESS) || 14111709ff8dSJulian Wiedmann (!IS_IQD(card) && ipa_rc == sbp_rc)) { 14121709ff8dSJulian Wiedmann switch (sbp_rc) { 14132063a5f5SKittipon Meesompop case IPA_RC_SUCCESS: 1414b4d72c08SEugene Crosser rc = 0; 1415b4d72c08SEugene Crosser break; 14162063a5f5SKittipon Meesompop case IPA_RC_L2_UNSUPPORTED_CMD: 14172063a5f5SKittipon Meesompop case IPA_RC_UNSUPPORTED_COMMAND: 1418ffb95251SEugene Crosser rc = -EOPNOTSUPP; 1419b4d72c08SEugene Crosser break; 14202063a5f5SKittipon Meesompop case IPA_RC_SBP_OSA_NOT_CONFIGURED: 14212063a5f5SKittipon Meesompop case IPA_RC_SBP_IQD_NOT_CONFIGURED: 1422b4d72c08SEugene Crosser rc = -ENODEV; /* maybe not the best code here? */ 1423b4d72c08SEugene Crosser dev_err(&card->gdev->dev, 14249c23f4daSEugene Crosser "The device is not configured as a Bridge Port\n"); 1425b4d72c08SEugene Crosser break; 14262063a5f5SKittipon Meesompop case IPA_RC_SBP_OSA_OS_MISMATCH: 14272063a5f5SKittipon Meesompop case IPA_RC_SBP_IQD_OS_MISMATCH: 14281b05cf62SEugene Crosser rc = -EPERM; 14291b05cf62SEugene Crosser dev_err(&card->gdev->dev, 14301b05cf62SEugene Crosser "A Bridge Port is already configured by a different operating system\n"); 14311b05cf62SEugene Crosser break; 14322063a5f5SKittipon Meesompop case IPA_RC_SBP_OSA_ANO_DEV_PRIMARY: 14332063a5f5SKittipon Meesompop case IPA_RC_SBP_IQD_ANO_DEV_PRIMARY: 1434b4d72c08SEugene Crosser switch (setcmd) { 1435b4d72c08SEugene Crosser case IPA_SBP_SET_PRIMARY_BRIDGE_PORT: 1436b4d72c08SEugene Crosser rc = -EEXIST; 1437b4d72c08SEugene Crosser dev_err(&card->gdev->dev, 14389c23f4daSEugene Crosser "The LAN already has a primary Bridge Port\n"); 1439b4d72c08SEugene Crosser break; 1440b4d72c08SEugene Crosser case IPA_SBP_SET_SECONDARY_BRIDGE_PORT: 1441b4d72c08SEugene Crosser rc = -EBUSY; 1442b4d72c08SEugene Crosser dev_err(&card->gdev->dev, 14439c23f4daSEugene Crosser "The device is already a primary Bridge Port\n"); 1444b4d72c08SEugene Crosser break; 1445b4d72c08SEugene Crosser default: 1446b4d72c08SEugene Crosser rc = -EIO; 1447b4d72c08SEugene Crosser } 1448b4d72c08SEugene Crosser break; 14492063a5f5SKittipon Meesompop case IPA_RC_SBP_OSA_CURRENT_SECOND: 14502063a5f5SKittipon Meesompop case IPA_RC_SBP_IQD_CURRENT_SECOND: 1451b4d72c08SEugene Crosser rc = -EBUSY; 1452b4d72c08SEugene Crosser dev_err(&card->gdev->dev, 14539c23f4daSEugene Crosser "The device is already a secondary Bridge Port\n"); 1454b4d72c08SEugene Crosser break; 14552063a5f5SKittipon Meesompop case IPA_RC_SBP_OSA_LIMIT_SECOND: 14562063a5f5SKittipon Meesompop case IPA_RC_SBP_IQD_LIMIT_SECOND: 1457b4d72c08SEugene Crosser rc = -EEXIST; 1458b4d72c08SEugene Crosser dev_err(&card->gdev->dev, 14599c23f4daSEugene Crosser "The LAN cannot have more secondary Bridge Ports\n"); 1460b4d72c08SEugene Crosser break; 14612063a5f5SKittipon Meesompop case IPA_RC_SBP_OSA_CURRENT_PRIMARY: 14622063a5f5SKittipon Meesompop case IPA_RC_SBP_IQD_CURRENT_PRIMARY: 1463b4d72c08SEugene Crosser rc = -EBUSY; 1464b4d72c08SEugene Crosser dev_err(&card->gdev->dev, 14659c23f4daSEugene Crosser "The device is already a primary Bridge Port\n"); 1466b4d72c08SEugene Crosser break; 14672063a5f5SKittipon Meesompop case IPA_RC_SBP_OSA_NOT_AUTHD_BY_ZMAN: 14682063a5f5SKittipon Meesompop case IPA_RC_SBP_IQD_NOT_AUTHD_BY_ZMAN: 1469b4d72c08SEugene Crosser rc = -EACCES; 1470b4d72c08SEugene Crosser dev_err(&card->gdev->dev, 14719c23f4daSEugene Crosser "The device is not authorized to be a Bridge Port\n"); 1472b4d72c08SEugene Crosser break; 1473b4d72c08SEugene Crosser default: 1474b4d72c08SEugene Crosser rc = -EIO; 1475b4d72c08SEugene Crosser } 14761709ff8dSJulian Wiedmann } else { 14771709ff8dSJulian Wiedmann switch (ipa_rc) { 1478b4d72c08SEugene Crosser case IPA_RC_NOTSUPP: 1479ffb95251SEugene Crosser rc = -EOPNOTSUPP; 1480b4d72c08SEugene Crosser break; 1481b4d72c08SEugene Crosser case IPA_RC_UNSUPPORTED_COMMAND: 1482ffb95251SEugene Crosser rc = -EOPNOTSUPP; 1483b4d72c08SEugene Crosser break; 1484b4d72c08SEugene Crosser default: 1485b4d72c08SEugene Crosser rc = -EIO; 1486b4d72c08SEugene Crosser } 14871709ff8dSJulian Wiedmann } 14889c23f4daSEugene Crosser 1489b4d72c08SEugene Crosser if (rc) { 14901709ff8dSJulian Wiedmann QETH_CARD_TEXT_(card, 2, "SBPi%04x", ipa_rc); 14911709ff8dSJulian Wiedmann QETH_CARD_TEXT_(card, 2, "SBPc%04x", sbp_rc); 1492b4d72c08SEugene Crosser } 1493b4d72c08SEugene Crosser return rc; 1494b4d72c08SEugene Crosser } 1495b4d72c08SEugene Crosser 1496d65626adSJulian Wiedmann static struct qeth_cmd_buffer *qeth_sbp_build_cmd(struct qeth_card *card, 1497d65626adSJulian Wiedmann enum qeth_ipa_sbp_cmd sbp_cmd, 1498d65626adSJulian Wiedmann unsigned int cmd_length) 14999c23f4daSEugene Crosser { 1500d65626adSJulian Wiedmann enum qeth_ipa_cmds ipa_cmd = (card->info.type == QETH_CARD_TYPE_IQD) ? 15019c23f4daSEugene Crosser IPA_CMD_SETBRIDGEPORT_IQD : 15029c23f4daSEugene Crosser IPA_CMD_SETBRIDGEPORT_OSA; 1503d65626adSJulian Wiedmann struct qeth_cmd_buffer *iob; 1504d65626adSJulian Wiedmann struct qeth_ipa_cmd *cmd; 1505d65626adSJulian Wiedmann 1506d65626adSJulian Wiedmann iob = qeth_get_ipacmd_buffer(card, ipa_cmd, 0); 1507d65626adSJulian Wiedmann if (!iob) 1508d65626adSJulian Wiedmann return iob; 1509ff5caa7aSJulian Wiedmann cmd = __ipa_cmd(iob); 1510d65626adSJulian Wiedmann cmd->data.sbp.hdr.cmdlength = sizeof(struct qeth_ipacmd_sbp_hdr) + 1511d65626adSJulian Wiedmann cmd_length; 1512d65626adSJulian Wiedmann cmd->data.sbp.hdr.command_code = sbp_cmd; 1513d65626adSJulian Wiedmann cmd->data.sbp.hdr.used_total = 1; 1514d65626adSJulian Wiedmann cmd->data.sbp.hdr.seq_no = 1; 1515d65626adSJulian Wiedmann return iob; 15169c23f4daSEugene Crosser } 15179c23f4daSEugene Crosser 1518b4d72c08SEugene Crosser static int qeth_bridgeport_query_support_cb(struct qeth_card *card, 1519b4d72c08SEugene Crosser struct qeth_reply *reply, unsigned long data) 1520b4d72c08SEugene Crosser { 1521b4d72c08SEugene Crosser struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *) data; 1522b4d72c08SEugene Crosser struct _qeth_sbp_cbctl *cbctl = (struct _qeth_sbp_cbctl *)reply->param; 15231709ff8dSJulian Wiedmann int rc; 15241709ff8dSJulian Wiedmann 1525b4d72c08SEugene Crosser QETH_CARD_TEXT(card, 2, "brqsupcb"); 15261709ff8dSJulian Wiedmann rc = qeth_bridgeport_makerc(card, cmd); 15271709ff8dSJulian Wiedmann if (rc) 15281709ff8dSJulian Wiedmann return rc; 15291709ff8dSJulian Wiedmann 1530b4d72c08SEugene Crosser cbctl->data.supported = 1531b4d72c08SEugene Crosser cmd->data.sbp.data.query_cmds_supp.supported_cmds; 1532b4d72c08SEugene Crosser return 0; 1533b4d72c08SEugene Crosser } 1534b4d72c08SEugene Crosser 1535b4d72c08SEugene Crosser /** 1536b4d72c08SEugene Crosser * qeth_bridgeport_query_support() - store bitmask of supported subfunctions. 1537b4d72c08SEugene Crosser * @card: qeth_card structure pointer. 1538b4d72c08SEugene Crosser * 1539b4d72c08SEugene Crosser * Sets bitmask of supported setbridgeport subfunctions in the qeth_card 1540b4d72c08SEugene Crosser * strucutre: card->options.sbp.supported_funcs. 1541b4d72c08SEugene Crosser */ 1542c044dc21SEugene Crosser static void qeth_bridgeport_query_support(struct qeth_card *card) 1543b4d72c08SEugene Crosser { 1544b4d72c08SEugene Crosser struct qeth_cmd_buffer *iob; 1545b4d72c08SEugene Crosser struct _qeth_sbp_cbctl cbctl; 1546b4d72c08SEugene Crosser 1547b4d72c08SEugene Crosser QETH_CARD_TEXT(card, 2, "brqsuppo"); 1548d65626adSJulian Wiedmann iob = qeth_sbp_build_cmd(card, IPA_SBP_QUERY_COMMANDS_SUPPORTED, 1549d65626adSJulian Wiedmann sizeof(struct qeth_sbp_query_cmds_supp)); 15501aec42bcSThomas Richter if (!iob) 15511aec42bcSThomas Richter return; 15521709ff8dSJulian Wiedmann 1553b4d72c08SEugene Crosser if (qeth_send_ipa_cmd(card, iob, qeth_bridgeport_query_support_cb, 15541709ff8dSJulian Wiedmann &cbctl)) { 1555b4d72c08SEugene Crosser card->options.sbp.role = QETH_SBP_ROLE_NONE; 15561709ff8dSJulian Wiedmann card->options.sbp.supported_funcs = 0; 1557b4d72c08SEugene Crosser return; 1558b4d72c08SEugene Crosser } 1559b4d72c08SEugene Crosser card->options.sbp.supported_funcs = cbctl.data.supported; 1560b4d72c08SEugene Crosser } 1561b4d72c08SEugene Crosser 1562b4d72c08SEugene Crosser static int qeth_bridgeport_query_ports_cb(struct qeth_card *card, 1563b4d72c08SEugene Crosser struct qeth_reply *reply, unsigned long data) 1564b4d72c08SEugene Crosser { 1565b4d72c08SEugene Crosser struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *) data; 1566b4d72c08SEugene Crosser struct qeth_sbp_query_ports *qports = &cmd->data.sbp.data.query_ports; 1567b4d72c08SEugene Crosser struct _qeth_sbp_cbctl *cbctl = (struct _qeth_sbp_cbctl *)reply->param; 15681709ff8dSJulian Wiedmann int rc; 1569b4d72c08SEugene Crosser 1570b4d72c08SEugene Crosser QETH_CARD_TEXT(card, 2, "brqprtcb"); 15711709ff8dSJulian Wiedmann rc = qeth_bridgeport_makerc(card, cmd); 15721709ff8dSJulian Wiedmann if (rc) 15731709ff8dSJulian Wiedmann return rc; 15741709ff8dSJulian Wiedmann 1575b4d72c08SEugene Crosser if (qports->entry_length != sizeof(struct qeth_sbp_port_entry)) { 1576b4d72c08SEugene Crosser QETH_CARD_TEXT_(card, 2, "SBPs%04x", qports->entry_length); 15771709ff8dSJulian Wiedmann return -EINVAL; 1578b4d72c08SEugene Crosser } 1579b4d72c08SEugene Crosser /* first entry contains the state of the local port */ 1580b4d72c08SEugene Crosser if (qports->num_entries > 0) { 1581b4d72c08SEugene Crosser if (cbctl->data.qports.role) 1582b4d72c08SEugene Crosser *cbctl->data.qports.role = qports->entry[0].role; 1583b4d72c08SEugene Crosser if (cbctl->data.qports.state) 1584b4d72c08SEugene Crosser *cbctl->data.qports.state = qports->entry[0].state; 1585b4d72c08SEugene Crosser } 1586b4d72c08SEugene Crosser return 0; 1587b4d72c08SEugene Crosser } 1588b4d72c08SEugene Crosser 1589b4d72c08SEugene Crosser /** 1590b4d72c08SEugene Crosser * qeth_bridgeport_query_ports() - query local bridgeport status. 1591b4d72c08SEugene Crosser * @card: qeth_card structure pointer. 1592b4d72c08SEugene Crosser * @role: Role of the port: 0-none, 1-primary, 2-secondary. 1593b4d72c08SEugene Crosser * @state: State of the port: 0-inactive, 1-standby, 2-active. 1594b4d72c08SEugene Crosser * 1595b4d72c08SEugene Crosser * Returns negative errno-compatible error indication or 0 on success. 1596b4d72c08SEugene Crosser * 1597b4d72c08SEugene Crosser * 'role' and 'state' are not updated in case of hardware operation failure. 1598b4d72c08SEugene Crosser */ 1599b4d72c08SEugene Crosser int qeth_bridgeport_query_ports(struct qeth_card *card, 1600b4d72c08SEugene Crosser enum qeth_sbp_roles *role, enum qeth_sbp_states *state) 1601b4d72c08SEugene Crosser { 1602b4d72c08SEugene Crosser struct qeth_cmd_buffer *iob; 1603b4d72c08SEugene Crosser struct _qeth_sbp_cbctl cbctl = { 1604b4d72c08SEugene Crosser .data = { 1605b4d72c08SEugene Crosser .qports = { 1606b4d72c08SEugene Crosser .role = role, 1607b4d72c08SEugene Crosser .state = state, 1608b4d72c08SEugene Crosser }, 1609b4d72c08SEugene Crosser }, 1610b4d72c08SEugene Crosser }; 1611b4d72c08SEugene Crosser 1612b4d72c08SEugene Crosser QETH_CARD_TEXT(card, 2, "brqports"); 1613b4d72c08SEugene Crosser if (!(card->options.sbp.supported_funcs & IPA_SBP_QUERY_BRIDGE_PORTS)) 1614b4d72c08SEugene Crosser return -EOPNOTSUPP; 1615d65626adSJulian Wiedmann iob = qeth_sbp_build_cmd(card, IPA_SBP_QUERY_BRIDGE_PORTS, 0); 16161aec42bcSThomas Richter if (!iob) 16171aec42bcSThomas Richter return -ENOMEM; 16181709ff8dSJulian Wiedmann 16191709ff8dSJulian Wiedmann return qeth_send_ipa_cmd(card, iob, qeth_bridgeport_query_ports_cb, 16201709ff8dSJulian Wiedmann &cbctl); 1621b4d72c08SEugene Crosser } 1622b4d72c08SEugene Crosser 1623b4d72c08SEugene Crosser static int qeth_bridgeport_set_cb(struct qeth_card *card, 1624b4d72c08SEugene Crosser struct qeth_reply *reply, unsigned long data) 1625b4d72c08SEugene Crosser { 1626b4d72c08SEugene Crosser struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *)data; 16271709ff8dSJulian Wiedmann 1628b4d72c08SEugene Crosser QETH_CARD_TEXT(card, 2, "brsetrcb"); 16291709ff8dSJulian Wiedmann return qeth_bridgeport_makerc(card, cmd); 1630b4d72c08SEugene Crosser } 1631b4d72c08SEugene Crosser 1632b4d72c08SEugene Crosser /** 1633b4d72c08SEugene Crosser * qeth_bridgeport_setrole() - Assign primary role to the port. 1634b4d72c08SEugene Crosser * @card: qeth_card structure pointer. 1635b4d72c08SEugene Crosser * @role: Role to assign. 1636b4d72c08SEugene Crosser * 1637b4d72c08SEugene Crosser * Returns negative errno-compatible error indication or 0 on success. 1638b4d72c08SEugene Crosser */ 1639b4d72c08SEugene Crosser int qeth_bridgeport_setrole(struct qeth_card *card, enum qeth_sbp_roles role) 1640b4d72c08SEugene Crosser { 1641b4d72c08SEugene Crosser int cmdlength; 1642b4d72c08SEugene Crosser struct qeth_cmd_buffer *iob; 1643b4d72c08SEugene Crosser enum qeth_ipa_sbp_cmd setcmd; 1644b4d72c08SEugene Crosser 1645b4d72c08SEugene Crosser QETH_CARD_TEXT(card, 2, "brsetrol"); 1646b4d72c08SEugene Crosser switch (role) { 1647b4d72c08SEugene Crosser case QETH_SBP_ROLE_NONE: 1648b4d72c08SEugene Crosser setcmd = IPA_SBP_RESET_BRIDGE_PORT_ROLE; 1649d65626adSJulian Wiedmann cmdlength = sizeof(struct qeth_sbp_reset_role); 1650b4d72c08SEugene Crosser break; 1651b4d72c08SEugene Crosser case QETH_SBP_ROLE_PRIMARY: 1652b4d72c08SEugene Crosser setcmd = IPA_SBP_SET_PRIMARY_BRIDGE_PORT; 1653d65626adSJulian Wiedmann cmdlength = sizeof(struct qeth_sbp_set_primary); 1654b4d72c08SEugene Crosser break; 1655b4d72c08SEugene Crosser case QETH_SBP_ROLE_SECONDARY: 1656b4d72c08SEugene Crosser setcmd = IPA_SBP_SET_SECONDARY_BRIDGE_PORT; 1657d65626adSJulian Wiedmann cmdlength = sizeof(struct qeth_sbp_set_secondary); 1658b4d72c08SEugene Crosser break; 1659b4d72c08SEugene Crosser default: 1660b4d72c08SEugene Crosser return -EINVAL; 1661b4d72c08SEugene Crosser } 1662b4d72c08SEugene Crosser if (!(card->options.sbp.supported_funcs & setcmd)) 1663b4d72c08SEugene Crosser return -EOPNOTSUPP; 1664d65626adSJulian Wiedmann iob = qeth_sbp_build_cmd(card, setcmd, cmdlength); 16651aec42bcSThomas Richter if (!iob) 16661aec42bcSThomas Richter return -ENOMEM; 16671709ff8dSJulian Wiedmann 16681709ff8dSJulian Wiedmann return qeth_send_ipa_cmd(card, iob, qeth_bridgeport_set_cb, NULL); 1669b4d72c08SEugene Crosser } 1670b4d72c08SEugene Crosser 16719f48b9dbSEugene Crosser /** 16729f48b9dbSEugene Crosser * qeth_anset_makerc() - derive "traditional" error from hardware codes. 16739f48b9dbSEugene Crosser * @card: qeth_card structure pointer, for debug messages. 16749f48b9dbSEugene Crosser * 16759f48b9dbSEugene Crosser * Returns negative errno-compatible error indication or 0 on success. 16769f48b9dbSEugene Crosser */ 16779f48b9dbSEugene Crosser static int qeth_anset_makerc(struct qeth_card *card, int pnso_rc, u16 response) 16789f48b9dbSEugene Crosser { 16799f48b9dbSEugene Crosser int rc; 16809f48b9dbSEugene Crosser 16819f48b9dbSEugene Crosser if (pnso_rc == 0) 16829f48b9dbSEugene Crosser switch (response) { 16839f48b9dbSEugene Crosser case 0x0001: 16849f48b9dbSEugene Crosser rc = 0; 16859f48b9dbSEugene Crosser break; 16869f48b9dbSEugene Crosser case 0x0004: 16879f48b9dbSEugene Crosser case 0x0100: 16889f48b9dbSEugene Crosser case 0x0106: 1689ffb95251SEugene Crosser rc = -EOPNOTSUPP; 16909f48b9dbSEugene Crosser dev_err(&card->gdev->dev, 16919f48b9dbSEugene Crosser "Setting address notification failed\n"); 16929f48b9dbSEugene Crosser break; 16939f48b9dbSEugene Crosser case 0x0107: 16949f48b9dbSEugene Crosser rc = -EAGAIN; 16959f48b9dbSEugene Crosser break; 16969f48b9dbSEugene Crosser default: 16979f48b9dbSEugene Crosser rc = -EIO; 16989f48b9dbSEugene Crosser } 16999f48b9dbSEugene Crosser else 17009f48b9dbSEugene Crosser rc = -EIO; 17019f48b9dbSEugene Crosser 17029f48b9dbSEugene Crosser if (rc) { 17039f48b9dbSEugene Crosser QETH_CARD_TEXT_(card, 2, "SBPp%04x", pnso_rc); 17049f48b9dbSEugene Crosser QETH_CARD_TEXT_(card, 2, "SBPr%04x", response); 17059f48b9dbSEugene Crosser } 17069f48b9dbSEugene Crosser return rc; 17079f48b9dbSEugene Crosser } 17089f48b9dbSEugene Crosser 17099f48b9dbSEugene Crosser static void qeth_bridgeport_an_set_cb(void *priv, 17109f48b9dbSEugene Crosser enum qdio_brinfo_entry_type type, void *entry) 17119f48b9dbSEugene Crosser { 17129f48b9dbSEugene Crosser struct qeth_card *card = (struct qeth_card *)priv; 17139f48b9dbSEugene Crosser struct qdio_brinfo_entry_l2 *l2entry; 17149f48b9dbSEugene Crosser u8 code; 17159f48b9dbSEugene Crosser 17169f48b9dbSEugene Crosser if (type != l2_addr_lnid) { 17179f48b9dbSEugene Crosser WARN_ON_ONCE(1); 17189f48b9dbSEugene Crosser return; 17199f48b9dbSEugene Crosser } 17209f48b9dbSEugene Crosser 17219f48b9dbSEugene Crosser l2entry = (struct qdio_brinfo_entry_l2 *)entry; 17229f48b9dbSEugene Crosser code = IPA_ADDR_CHANGE_CODE_MACADDR; 17239f48b9dbSEugene Crosser if (l2entry->addr_lnid.lnid) 17249f48b9dbSEugene Crosser code |= IPA_ADDR_CHANGE_CODE_VLANID; 17259f48b9dbSEugene Crosser qeth_bridge_emit_host_event(card, anev_reg_unreg, code, 17269f48b9dbSEugene Crosser (struct net_if_token *)&l2entry->nit, 17279f48b9dbSEugene Crosser (struct mac_addr_lnid *)&l2entry->addr_lnid); 17289f48b9dbSEugene Crosser } 17299f48b9dbSEugene Crosser 17309f48b9dbSEugene Crosser /** 17319f48b9dbSEugene Crosser * qeth_bridgeport_an_set() - Enable or disable bridgeport address notification 17329f48b9dbSEugene Crosser * @card: qeth_card structure pointer. 17339f48b9dbSEugene Crosser * @enable: 0 - disable, non-zero - enable notifications 17349f48b9dbSEugene Crosser * 17359f48b9dbSEugene Crosser * Returns negative errno-compatible error indication or 0 on success. 17369f48b9dbSEugene Crosser * 17379f48b9dbSEugene Crosser * On enable, emits a series of address notifications udev events for all 17389f48b9dbSEugene Crosser * currently registered hosts. 17399f48b9dbSEugene Crosser */ 17409f48b9dbSEugene Crosser int qeth_bridgeport_an_set(struct qeth_card *card, int enable) 17419f48b9dbSEugene Crosser { 17429f48b9dbSEugene Crosser int rc; 17439f48b9dbSEugene Crosser u16 response; 17449f48b9dbSEugene Crosser struct ccw_device *ddev; 17459f48b9dbSEugene Crosser struct subchannel_id schid; 17469f48b9dbSEugene Crosser 17479f48b9dbSEugene Crosser if (!card) 17489f48b9dbSEugene Crosser return -EINVAL; 17499f48b9dbSEugene Crosser if (!card->options.sbp.supported_funcs) 17509f48b9dbSEugene Crosser return -EOPNOTSUPP; 17519f48b9dbSEugene Crosser ddev = CARD_DDEV(card); 17529f48b9dbSEugene Crosser ccw_device_get_schid(ddev, &schid); 17539f48b9dbSEugene Crosser 17549f48b9dbSEugene Crosser if (enable) { 17559f48b9dbSEugene Crosser qeth_bridge_emit_host_event(card, anev_reset, 0, NULL, NULL); 17569f48b9dbSEugene Crosser rc = qdio_pnso_brinfo(schid, 1, &response, 17579f48b9dbSEugene Crosser qeth_bridgeport_an_set_cb, card); 17589f48b9dbSEugene Crosser } else 17599f48b9dbSEugene Crosser rc = qdio_pnso_brinfo(schid, 0, &response, NULL, NULL); 17609f48b9dbSEugene Crosser return qeth_anset_makerc(card, rc, response); 17619f48b9dbSEugene Crosser } 17629f48b9dbSEugene Crosser 1763caa1f0b1SHans Wippel static bool qeth_bridgeport_is_in_use(struct qeth_card *card) 1764caa1f0b1SHans Wippel { 1765caa1f0b1SHans Wippel return (card->options.sbp.role || card->options.sbp.reflect_promisc || 1766caa1f0b1SHans Wippel card->options.sbp.hostnotification); 1767caa1f0b1SHans Wippel } 1768caa1f0b1SHans Wippel 1769a45b3fafSHans Wippel /* VNIC Characteristics support */ 1770a45b3fafSHans Wippel 1771a45b3fafSHans Wippel /* handle VNICC IPA command return codes; convert to error codes */ 1772742d4d40SJulian Wiedmann static int qeth_l2_vnicc_makerc(struct qeth_card *card, u16 ipa_rc) 1773a45b3fafSHans Wippel { 1774a45b3fafSHans Wippel int rc; 1775a45b3fafSHans Wippel 1776a45b3fafSHans Wippel switch (ipa_rc) { 1777a45b3fafSHans Wippel case IPA_RC_SUCCESS: 1778a45b3fafSHans Wippel return ipa_rc; 1779a45b3fafSHans Wippel case IPA_RC_L2_UNSUPPORTED_CMD: 1780a45b3fafSHans Wippel case IPA_RC_NOTSUPP: 1781a45b3fafSHans Wippel rc = -EOPNOTSUPP; 1782a45b3fafSHans Wippel break; 1783a45b3fafSHans Wippel case IPA_RC_VNICC_OOSEQ: 1784a45b3fafSHans Wippel rc = -EALREADY; 1785a45b3fafSHans Wippel break; 1786a45b3fafSHans Wippel case IPA_RC_VNICC_VNICBP: 1787a45b3fafSHans Wippel rc = -EBUSY; 1788a45b3fafSHans Wippel break; 1789a45b3fafSHans Wippel case IPA_RC_L2_ADDR_TABLE_FULL: 1790a45b3fafSHans Wippel rc = -ENOSPC; 1791a45b3fafSHans Wippel break; 1792a45b3fafSHans Wippel case IPA_RC_L2_MAC_NOT_AUTH_BY_ADP: 1793a45b3fafSHans Wippel rc = -EACCES; 1794a45b3fafSHans Wippel break; 1795a45b3fafSHans Wippel default: 1796a45b3fafSHans Wippel rc = -EIO; 1797a45b3fafSHans Wippel } 1798a45b3fafSHans Wippel 1799a45b3fafSHans Wippel QETH_CARD_TEXT_(card, 2, "err%04x", ipa_rc); 1800a45b3fafSHans Wippel return rc; 1801a45b3fafSHans Wippel } 1802a45b3fafSHans Wippel 1803a45b3fafSHans Wippel /* generic VNICC request call back control */ 1804a45b3fafSHans Wippel struct _qeth_l2_vnicc_request_cbctl { 1805a45b3fafSHans Wippel u32 sub_cmd; 1806caa1f0b1SHans Wippel struct { 1807caa1f0b1SHans Wippel u32 vnic_char; 1808349d13d5SHans Wippel u32 timeout; 1809caa1f0b1SHans Wippel } param; 1810caa1f0b1SHans Wippel struct { 1811349d13d5SHans Wippel union{ 1812caa1f0b1SHans Wippel u32 *sup_cmds; 1813349d13d5SHans Wippel u32 *timeout; 1814349d13d5SHans Wippel }; 1815caa1f0b1SHans Wippel } result; 1816a45b3fafSHans Wippel }; 1817a45b3fafSHans Wippel 1818a45b3fafSHans Wippel /* generic VNICC request call back */ 1819a45b3fafSHans Wippel static int qeth_l2_vnicc_request_cb(struct qeth_card *card, 1820a45b3fafSHans Wippel struct qeth_reply *reply, 1821a45b3fafSHans Wippel unsigned long data) 1822a45b3fafSHans Wippel { 1823caa1f0b1SHans Wippel struct _qeth_l2_vnicc_request_cbctl *cbctl = 1824caa1f0b1SHans Wippel (struct _qeth_l2_vnicc_request_cbctl *) reply->param; 1825a45b3fafSHans Wippel struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *) data; 1826a45b3fafSHans Wippel struct qeth_ipacmd_vnicc *rep = &cmd->data.vnicc; 1827a45b3fafSHans Wippel 1828a45b3fafSHans Wippel QETH_CARD_TEXT(card, 2, "vniccrcb"); 1829a45b3fafSHans Wippel if (cmd->hdr.return_code) 1830742d4d40SJulian Wiedmann return qeth_l2_vnicc_makerc(card, cmd->hdr.return_code); 1831a45b3fafSHans Wippel /* return results to caller */ 1832a45b3fafSHans Wippel card->options.vnicc.sup_chars = rep->hdr.sup; 1833a45b3fafSHans Wippel card->options.vnicc.cur_chars = rep->hdr.cur; 1834a45b3fafSHans Wippel 1835caa1f0b1SHans Wippel if (cbctl->sub_cmd == IPA_VNICC_QUERY_CMDS) 1836caa1f0b1SHans Wippel *cbctl->result.sup_cmds = rep->query_cmds.sup_cmds; 1837caa1f0b1SHans Wippel 1838349d13d5SHans Wippel if (cbctl->sub_cmd == IPA_VNICC_GET_TIMEOUT) 1839349d13d5SHans Wippel *cbctl->result.timeout = rep->getset_timeout.timeout; 1840349d13d5SHans Wippel 1841a45b3fafSHans Wippel return 0; 1842a45b3fafSHans Wippel } 1843a45b3fafSHans Wippel 1844a45b3fafSHans Wippel /* generic VNICC request */ 1845a45b3fafSHans Wippel static int qeth_l2_vnicc_request(struct qeth_card *card, 1846a45b3fafSHans Wippel struct _qeth_l2_vnicc_request_cbctl *cbctl) 1847a45b3fafSHans Wippel { 1848a45b3fafSHans Wippel struct qeth_ipacmd_vnicc *req; 1849a45b3fafSHans Wippel struct qeth_cmd_buffer *iob; 1850a45b3fafSHans Wippel struct qeth_ipa_cmd *cmd; 1851a45b3fafSHans Wippel 1852a45b3fafSHans Wippel QETH_CARD_TEXT(card, 2, "vniccreq"); 1853a45b3fafSHans Wippel 1854a45b3fafSHans Wippel /* get new buffer for request */ 1855a45b3fafSHans Wippel iob = qeth_get_ipacmd_buffer(card, IPA_CMD_VNICC, 0); 1856a45b3fafSHans Wippel if (!iob) 1857a45b3fafSHans Wippel return -ENOMEM; 1858a45b3fafSHans Wippel 1859a45b3fafSHans Wippel /* create header for request */ 1860ff5caa7aSJulian Wiedmann cmd = __ipa_cmd(iob); 1861a45b3fafSHans Wippel req = &cmd->data.vnicc; 1862a45b3fafSHans Wippel 1863a45b3fafSHans Wippel /* create sub command header for request */ 1864a45b3fafSHans Wippel req->sub_hdr.data_length = sizeof(req->sub_hdr); 1865a45b3fafSHans Wippel req->sub_hdr.sub_command = cbctl->sub_cmd; 1866a45b3fafSHans Wippel 1867a45b3fafSHans Wippel /* create sub command specific request fields */ 1868a45b3fafSHans Wippel switch (cbctl->sub_cmd) { 1869a45b3fafSHans Wippel case IPA_VNICC_QUERY_CHARS: 1870a45b3fafSHans Wippel break; 1871caa1f0b1SHans Wippel case IPA_VNICC_QUERY_CMDS: 1872caa1f0b1SHans Wippel req->sub_hdr.data_length += sizeof(req->query_cmds); 1873caa1f0b1SHans Wippel req->query_cmds.vnic_char = cbctl->param.vnic_char; 1874caa1f0b1SHans Wippel break; 1875caa1f0b1SHans Wippel case IPA_VNICC_ENABLE: 1876caa1f0b1SHans Wippel case IPA_VNICC_DISABLE: 1877caa1f0b1SHans Wippel req->sub_hdr.data_length += sizeof(req->set_char); 1878caa1f0b1SHans Wippel req->set_char.vnic_char = cbctl->param.vnic_char; 1879caa1f0b1SHans Wippel break; 1880349d13d5SHans Wippel case IPA_VNICC_SET_TIMEOUT: 1881349d13d5SHans Wippel req->getset_timeout.timeout = cbctl->param.timeout; 1882349d13d5SHans Wippel /* fallthrough */ 1883349d13d5SHans Wippel case IPA_VNICC_GET_TIMEOUT: 1884349d13d5SHans Wippel req->sub_hdr.data_length += sizeof(req->getset_timeout); 1885349d13d5SHans Wippel req->getset_timeout.vnic_char = cbctl->param.vnic_char; 1886349d13d5SHans Wippel break; 1887a45b3fafSHans Wippel default: 1888a45b3fafSHans Wippel qeth_release_buffer(iob->channel, iob); 1889a45b3fafSHans Wippel return -EOPNOTSUPP; 1890a45b3fafSHans Wippel } 1891a45b3fafSHans Wippel 1892a45b3fafSHans Wippel /* send request */ 1893742d4d40SJulian Wiedmann return qeth_send_ipa_cmd(card, iob, qeth_l2_vnicc_request_cb, cbctl); 1894a45b3fafSHans Wippel } 1895a45b3fafSHans Wippel 1896a45b3fafSHans Wippel /* VNICC query VNIC characteristics request */ 1897a45b3fafSHans Wippel static int qeth_l2_vnicc_query_chars(struct qeth_card *card) 1898a45b3fafSHans Wippel { 1899a45b3fafSHans Wippel struct _qeth_l2_vnicc_request_cbctl cbctl; 1900a45b3fafSHans Wippel 1901a45b3fafSHans Wippel /* prepare callback control */ 1902a45b3fafSHans Wippel cbctl.sub_cmd = IPA_VNICC_QUERY_CHARS; 1903a45b3fafSHans Wippel 1904a45b3fafSHans Wippel QETH_CARD_TEXT(card, 2, "vniccqch"); 1905a45b3fafSHans Wippel return qeth_l2_vnicc_request(card, &cbctl); 1906a45b3fafSHans Wippel } 1907a45b3fafSHans Wippel 1908caa1f0b1SHans Wippel /* VNICC query sub commands request */ 1909caa1f0b1SHans Wippel static int qeth_l2_vnicc_query_cmds(struct qeth_card *card, u32 vnic_char, 1910caa1f0b1SHans Wippel u32 *sup_cmds) 1911caa1f0b1SHans Wippel { 1912caa1f0b1SHans Wippel struct _qeth_l2_vnicc_request_cbctl cbctl; 1913caa1f0b1SHans Wippel 1914caa1f0b1SHans Wippel /* prepare callback control */ 1915caa1f0b1SHans Wippel cbctl.sub_cmd = IPA_VNICC_QUERY_CMDS; 1916caa1f0b1SHans Wippel cbctl.param.vnic_char = vnic_char; 1917caa1f0b1SHans Wippel cbctl.result.sup_cmds = sup_cmds; 1918caa1f0b1SHans Wippel 1919caa1f0b1SHans Wippel QETH_CARD_TEXT(card, 2, "vniccqcm"); 1920caa1f0b1SHans Wippel return qeth_l2_vnicc_request(card, &cbctl); 1921caa1f0b1SHans Wippel } 1922caa1f0b1SHans Wippel 1923caa1f0b1SHans Wippel /* VNICC enable/disable characteristic request */ 1924caa1f0b1SHans Wippel static int qeth_l2_vnicc_set_char(struct qeth_card *card, u32 vnic_char, 1925caa1f0b1SHans Wippel u32 cmd) 1926caa1f0b1SHans Wippel { 1927caa1f0b1SHans Wippel struct _qeth_l2_vnicc_request_cbctl cbctl; 1928caa1f0b1SHans Wippel 1929caa1f0b1SHans Wippel /* prepare callback control */ 1930caa1f0b1SHans Wippel cbctl.sub_cmd = cmd; 1931caa1f0b1SHans Wippel cbctl.param.vnic_char = vnic_char; 1932caa1f0b1SHans Wippel 1933caa1f0b1SHans Wippel QETH_CARD_TEXT(card, 2, "vniccedc"); 1934caa1f0b1SHans Wippel return qeth_l2_vnicc_request(card, &cbctl); 1935caa1f0b1SHans Wippel } 1936caa1f0b1SHans Wippel 1937349d13d5SHans Wippel /* VNICC get/set timeout for characteristic request */ 1938349d13d5SHans Wippel static int qeth_l2_vnicc_getset_timeout(struct qeth_card *card, u32 vnicc, 1939349d13d5SHans Wippel u32 cmd, u32 *timeout) 1940349d13d5SHans Wippel { 1941349d13d5SHans Wippel struct _qeth_l2_vnicc_request_cbctl cbctl; 1942349d13d5SHans Wippel 1943349d13d5SHans Wippel /* prepare callback control */ 1944349d13d5SHans Wippel cbctl.sub_cmd = cmd; 1945349d13d5SHans Wippel cbctl.param.vnic_char = vnicc; 1946349d13d5SHans Wippel if (cmd == IPA_VNICC_SET_TIMEOUT) 1947349d13d5SHans Wippel cbctl.param.timeout = *timeout; 1948349d13d5SHans Wippel if (cmd == IPA_VNICC_GET_TIMEOUT) 1949349d13d5SHans Wippel cbctl.result.timeout = timeout; 1950349d13d5SHans Wippel 1951349d13d5SHans Wippel QETH_CARD_TEXT(card, 2, "vniccgst"); 1952349d13d5SHans Wippel return qeth_l2_vnicc_request(card, &cbctl); 1953349d13d5SHans Wippel } 1954349d13d5SHans Wippel 1955caa1f0b1SHans Wippel /* set current VNICC flag state; called from sysfs store function */ 1956caa1f0b1SHans Wippel int qeth_l2_vnicc_set_state(struct qeth_card *card, u32 vnicc, bool state) 1957caa1f0b1SHans Wippel { 1958caa1f0b1SHans Wippel int rc = 0; 1959caa1f0b1SHans Wippel u32 cmd; 1960caa1f0b1SHans Wippel 1961caa1f0b1SHans Wippel QETH_CARD_TEXT(card, 2, "vniccsch"); 1962caa1f0b1SHans Wippel 1963caa1f0b1SHans Wippel /* do not change anything if BridgePort is enabled */ 1964caa1f0b1SHans Wippel if (qeth_bridgeport_is_in_use(card)) 1965caa1f0b1SHans Wippel return -EBUSY; 1966caa1f0b1SHans Wippel 1967caa1f0b1SHans Wippel /* check if characteristic and enable/disable are supported */ 1968caa1f0b1SHans Wippel if (!(card->options.vnicc.sup_chars & vnicc) || 1969caa1f0b1SHans Wippel !(card->options.vnicc.set_char_sup & vnicc)) 1970caa1f0b1SHans Wippel return -EOPNOTSUPP; 1971caa1f0b1SHans Wippel 1972caa1f0b1SHans Wippel /* set enable/disable command and store wanted characteristic */ 1973caa1f0b1SHans Wippel if (state) { 1974caa1f0b1SHans Wippel cmd = IPA_VNICC_ENABLE; 1975caa1f0b1SHans Wippel card->options.vnicc.wanted_chars |= vnicc; 1976caa1f0b1SHans Wippel } else { 1977caa1f0b1SHans Wippel cmd = IPA_VNICC_DISABLE; 1978caa1f0b1SHans Wippel card->options.vnicc.wanted_chars &= ~vnicc; 1979caa1f0b1SHans Wippel } 1980caa1f0b1SHans Wippel 1981caa1f0b1SHans Wippel /* do we need to do anything? */ 1982caa1f0b1SHans Wippel if (card->options.vnicc.cur_chars == card->options.vnicc.wanted_chars) 1983caa1f0b1SHans Wippel return rc; 1984caa1f0b1SHans Wippel 1985caa1f0b1SHans Wippel /* if card is not ready, simply stop here */ 1986caa1f0b1SHans Wippel if (!qeth_card_hw_is_reachable(card)) { 1987caa1f0b1SHans Wippel if (state) 1988caa1f0b1SHans Wippel card->options.vnicc.cur_chars |= vnicc; 1989caa1f0b1SHans Wippel else 1990caa1f0b1SHans Wippel card->options.vnicc.cur_chars &= ~vnicc; 1991caa1f0b1SHans Wippel return rc; 1992caa1f0b1SHans Wippel } 1993caa1f0b1SHans Wippel 1994caa1f0b1SHans Wippel rc = qeth_l2_vnicc_set_char(card, vnicc, cmd); 1995caa1f0b1SHans Wippel if (rc) 1996caa1f0b1SHans Wippel card->options.vnicc.wanted_chars = 1997caa1f0b1SHans Wippel card->options.vnicc.cur_chars; 1998349d13d5SHans Wippel else { 1999349d13d5SHans Wippel /* successful online VNICC change; handle special cases */ 2000349d13d5SHans Wippel if (state && vnicc == QETH_VNICC_RX_BCAST) 2001caa1f0b1SHans Wippel card->options.vnicc.rx_bcast_enabled = true; 2002349d13d5SHans Wippel if (!state && vnicc == QETH_VNICC_LEARNING) 2003349d13d5SHans Wippel qeth_l2_vnicc_recover_timeout(card, vnicc, 2004349d13d5SHans Wippel &card->options.vnicc.learning_timeout); 2005349d13d5SHans Wippel } 2006caa1f0b1SHans Wippel 2007caa1f0b1SHans Wippel return rc; 2008caa1f0b1SHans Wippel } 2009caa1f0b1SHans Wippel 2010caa1f0b1SHans Wippel /* get current VNICC flag state; called from sysfs show function */ 2011caa1f0b1SHans Wippel int qeth_l2_vnicc_get_state(struct qeth_card *card, u32 vnicc, bool *state) 2012caa1f0b1SHans Wippel { 2013caa1f0b1SHans Wippel int rc = 0; 2014caa1f0b1SHans Wippel 2015caa1f0b1SHans Wippel QETH_CARD_TEXT(card, 2, "vniccgch"); 2016caa1f0b1SHans Wippel 2017caa1f0b1SHans Wippel /* do not get anything if BridgePort is enabled */ 2018caa1f0b1SHans Wippel if (qeth_bridgeport_is_in_use(card)) 2019caa1f0b1SHans Wippel return -EBUSY; 2020caa1f0b1SHans Wippel 2021caa1f0b1SHans Wippel /* check if characteristic is supported */ 2022caa1f0b1SHans Wippel if (!(card->options.vnicc.sup_chars & vnicc)) 2023caa1f0b1SHans Wippel return -EOPNOTSUPP; 2024caa1f0b1SHans Wippel 2025caa1f0b1SHans Wippel /* if card is ready, query current VNICC state */ 2026caa1f0b1SHans Wippel if (qeth_card_hw_is_reachable(card)) 2027caa1f0b1SHans Wippel rc = qeth_l2_vnicc_query_chars(card); 2028caa1f0b1SHans Wippel 2029caa1f0b1SHans Wippel *state = (card->options.vnicc.cur_chars & vnicc) ? true : false; 2030caa1f0b1SHans Wippel return rc; 2031caa1f0b1SHans Wippel } 2032caa1f0b1SHans Wippel 2033349d13d5SHans Wippel /* set VNICC timeout; called from sysfs store function. Currently, only learning 2034349d13d5SHans Wippel * supports timeout 2035349d13d5SHans Wippel */ 2036349d13d5SHans Wippel int qeth_l2_vnicc_set_timeout(struct qeth_card *card, u32 timeout) 2037349d13d5SHans Wippel { 2038349d13d5SHans Wippel int rc = 0; 2039349d13d5SHans Wippel 2040349d13d5SHans Wippel QETH_CARD_TEXT(card, 2, "vniccsto"); 2041349d13d5SHans Wippel 2042349d13d5SHans Wippel /* do not change anything if BridgePort is enabled */ 2043349d13d5SHans Wippel if (qeth_bridgeport_is_in_use(card)) 2044349d13d5SHans Wippel return -EBUSY; 2045349d13d5SHans Wippel 2046349d13d5SHans Wippel /* check if characteristic and set_timeout are supported */ 2047349d13d5SHans Wippel if (!(card->options.vnicc.sup_chars & QETH_VNICC_LEARNING) || 2048349d13d5SHans Wippel !(card->options.vnicc.getset_timeout_sup & QETH_VNICC_LEARNING)) 2049349d13d5SHans Wippel return -EOPNOTSUPP; 2050349d13d5SHans Wippel 2051349d13d5SHans Wippel /* do we need to do anything? */ 2052349d13d5SHans Wippel if (card->options.vnicc.learning_timeout == timeout) 2053349d13d5SHans Wippel return rc; 2054349d13d5SHans Wippel 2055349d13d5SHans Wippel /* if card is not ready, simply store the value internally and return */ 2056349d13d5SHans Wippel if (!qeth_card_hw_is_reachable(card)) { 2057349d13d5SHans Wippel card->options.vnicc.learning_timeout = timeout; 2058349d13d5SHans Wippel return rc; 2059349d13d5SHans Wippel } 2060349d13d5SHans Wippel 2061349d13d5SHans Wippel /* send timeout value to card; if successful, store value internally */ 2062349d13d5SHans Wippel rc = qeth_l2_vnicc_getset_timeout(card, QETH_VNICC_LEARNING, 2063349d13d5SHans Wippel IPA_VNICC_SET_TIMEOUT, &timeout); 2064349d13d5SHans Wippel if (!rc) 2065349d13d5SHans Wippel card->options.vnicc.learning_timeout = timeout; 2066349d13d5SHans Wippel 2067349d13d5SHans Wippel return rc; 2068349d13d5SHans Wippel } 2069349d13d5SHans Wippel 2070349d13d5SHans Wippel /* get current VNICC timeout; called from sysfs show function. Currently, only 2071349d13d5SHans Wippel * learning supports timeout 2072349d13d5SHans Wippel */ 2073349d13d5SHans Wippel int qeth_l2_vnicc_get_timeout(struct qeth_card *card, u32 *timeout) 2074349d13d5SHans Wippel { 2075349d13d5SHans Wippel int rc = 0; 2076349d13d5SHans Wippel 2077349d13d5SHans Wippel QETH_CARD_TEXT(card, 2, "vniccgto"); 2078349d13d5SHans Wippel 2079349d13d5SHans Wippel /* do not get anything if BridgePort is enabled */ 2080349d13d5SHans Wippel if (qeth_bridgeport_is_in_use(card)) 2081349d13d5SHans Wippel return -EBUSY; 2082349d13d5SHans Wippel 2083349d13d5SHans Wippel /* check if characteristic and get_timeout are supported */ 2084349d13d5SHans Wippel if (!(card->options.vnicc.sup_chars & QETH_VNICC_LEARNING) || 2085349d13d5SHans Wippel !(card->options.vnicc.getset_timeout_sup & QETH_VNICC_LEARNING)) 2086349d13d5SHans Wippel return -EOPNOTSUPP; 2087349d13d5SHans Wippel /* if card is ready, get timeout. Otherwise, just return stored value */ 2088349d13d5SHans Wippel *timeout = card->options.vnicc.learning_timeout; 2089349d13d5SHans Wippel if (qeth_card_hw_is_reachable(card)) 2090349d13d5SHans Wippel rc = qeth_l2_vnicc_getset_timeout(card, QETH_VNICC_LEARNING, 2091349d13d5SHans Wippel IPA_VNICC_GET_TIMEOUT, 2092349d13d5SHans Wippel timeout); 2093349d13d5SHans Wippel 2094349d13d5SHans Wippel return rc; 2095349d13d5SHans Wippel } 2096349d13d5SHans Wippel 2097caa1f0b1SHans Wippel /* check if VNICC is currently enabled */ 2098caa1f0b1SHans Wippel bool qeth_l2_vnicc_is_in_use(struct qeth_card *card) 2099caa1f0b1SHans Wippel { 2100caa1f0b1SHans Wippel /* if everything is turned off, VNICC is not active */ 2101caa1f0b1SHans Wippel if (!card->options.vnicc.cur_chars) 2102caa1f0b1SHans Wippel return false; 2103caa1f0b1SHans Wippel /* default values are only OK if rx_bcast was not enabled by user 2104caa1f0b1SHans Wippel * or the card is offline. 2105caa1f0b1SHans Wippel */ 2106caa1f0b1SHans Wippel if (card->options.vnicc.cur_chars == QETH_VNICC_DEFAULT) { 2107caa1f0b1SHans Wippel if (!card->options.vnicc.rx_bcast_enabled || 2108caa1f0b1SHans Wippel !qeth_card_hw_is_reachable(card)) 2109caa1f0b1SHans Wippel return false; 2110caa1f0b1SHans Wippel } 2111caa1f0b1SHans Wippel return true; 2112caa1f0b1SHans Wippel } 2113caa1f0b1SHans Wippel 2114349d13d5SHans Wippel /* recover user timeout setting */ 2115349d13d5SHans Wippel static bool qeth_l2_vnicc_recover_timeout(struct qeth_card *card, u32 vnicc, 2116349d13d5SHans Wippel u32 *timeout) 2117349d13d5SHans Wippel { 2118349d13d5SHans Wippel if (card->options.vnicc.sup_chars & vnicc && 2119349d13d5SHans Wippel card->options.vnicc.getset_timeout_sup & vnicc && 2120349d13d5SHans Wippel !qeth_l2_vnicc_getset_timeout(card, vnicc, IPA_VNICC_SET_TIMEOUT, 2121349d13d5SHans Wippel timeout)) 2122349d13d5SHans Wippel return false; 2123349d13d5SHans Wippel *timeout = QETH_VNICC_DEFAULT_TIMEOUT; 2124349d13d5SHans Wippel return true; 2125349d13d5SHans Wippel } 2126349d13d5SHans Wippel 2127caa1f0b1SHans Wippel /* recover user characteristic setting */ 2128caa1f0b1SHans Wippel static bool qeth_l2_vnicc_recover_char(struct qeth_card *card, u32 vnicc, 2129caa1f0b1SHans Wippel bool enable) 2130caa1f0b1SHans Wippel { 2131caa1f0b1SHans Wippel u32 cmd = enable ? IPA_VNICC_ENABLE : IPA_VNICC_DISABLE; 2132caa1f0b1SHans Wippel 2133caa1f0b1SHans Wippel if (card->options.vnicc.sup_chars & vnicc && 2134caa1f0b1SHans Wippel card->options.vnicc.set_char_sup & vnicc && 2135caa1f0b1SHans Wippel !qeth_l2_vnicc_set_char(card, vnicc, cmd)) 2136caa1f0b1SHans Wippel return false; 2137caa1f0b1SHans Wippel card->options.vnicc.wanted_chars &= ~vnicc; 2138caa1f0b1SHans Wippel card->options.vnicc.wanted_chars |= QETH_VNICC_DEFAULT & vnicc; 2139caa1f0b1SHans Wippel return true; 2140caa1f0b1SHans Wippel } 2141caa1f0b1SHans Wippel 2142a45b3fafSHans Wippel /* (re-)initialize VNICC */ 2143a45b3fafSHans Wippel static void qeth_l2_vnicc_init(struct qeth_card *card) 2144a45b3fafSHans Wippel { 2145349d13d5SHans Wippel u32 *timeout = &card->options.vnicc.learning_timeout; 2146caa1f0b1SHans Wippel unsigned int chars_len, i; 2147caa1f0b1SHans Wippel unsigned long chars_tmp; 2148caa1f0b1SHans Wippel u32 sup_cmds, vnicc; 2149caa1f0b1SHans Wippel bool enable, error; 2150caa1f0b1SHans Wippel 2151a45b3fafSHans Wippel QETH_CARD_TEXT(card, 2, "vniccini"); 2152caa1f0b1SHans Wippel /* reset rx_bcast */ 2153caa1f0b1SHans Wippel card->options.vnicc.rx_bcast_enabled = 0; 2154a45b3fafSHans Wippel /* initial query and storage of VNIC characteristics */ 2155a45b3fafSHans Wippel if (qeth_l2_vnicc_query_chars(card)) { 2156349d13d5SHans Wippel if (card->options.vnicc.wanted_chars != QETH_VNICC_DEFAULT || 2157349d13d5SHans Wippel *timeout != QETH_VNICC_DEFAULT_TIMEOUT) 2158caa1f0b1SHans Wippel dev_err(&card->gdev->dev, "Configuring the VNIC characteristics failed\n"); 2159caa1f0b1SHans Wippel /* fail quietly if user didn't change the default config */ 2160a45b3fafSHans Wippel card->options.vnicc.sup_chars = 0; 2161a45b3fafSHans Wippel card->options.vnicc.cur_chars = 0; 2162caa1f0b1SHans Wippel card->options.vnicc.wanted_chars = QETH_VNICC_DEFAULT; 2163caa1f0b1SHans Wippel return; 2164a45b3fafSHans Wippel } 2165caa1f0b1SHans Wippel /* get supported commands for each supported characteristic */ 2166caa1f0b1SHans Wippel chars_tmp = card->options.vnicc.sup_chars; 2167caa1f0b1SHans Wippel chars_len = sizeof(card->options.vnicc.sup_chars) * BITS_PER_BYTE; 2168caa1f0b1SHans Wippel for_each_set_bit(i, &chars_tmp, chars_len) { 2169caa1f0b1SHans Wippel vnicc = BIT(i); 2170caa1f0b1SHans Wippel qeth_l2_vnicc_query_cmds(card, vnicc, &sup_cmds); 2171349d13d5SHans Wippel if (!(sup_cmds & IPA_VNICC_SET_TIMEOUT) || 2172349d13d5SHans Wippel !(sup_cmds & IPA_VNICC_GET_TIMEOUT)) 2173349d13d5SHans Wippel card->options.vnicc.getset_timeout_sup &= ~vnicc; 2174caa1f0b1SHans Wippel if (!(sup_cmds & IPA_VNICC_ENABLE) || 2175caa1f0b1SHans Wippel !(sup_cmds & IPA_VNICC_DISABLE)) 2176caa1f0b1SHans Wippel card->options.vnicc.set_char_sup &= ~vnicc; 2177caa1f0b1SHans Wippel } 2178caa1f0b1SHans Wippel /* enforce assumed default values and recover settings, if changed */ 2179349d13d5SHans Wippel error = qeth_l2_vnicc_recover_timeout(card, QETH_VNICC_LEARNING, 2180349d13d5SHans Wippel timeout); 2181caa1f0b1SHans Wippel chars_tmp = card->options.vnicc.wanted_chars ^ QETH_VNICC_DEFAULT; 2182caa1f0b1SHans Wippel chars_tmp |= QETH_VNICC_BRIDGE_INVISIBLE; 2183caa1f0b1SHans Wippel chars_len = sizeof(card->options.vnicc.wanted_chars) * BITS_PER_BYTE; 2184caa1f0b1SHans Wippel for_each_set_bit(i, &chars_tmp, chars_len) { 2185caa1f0b1SHans Wippel vnicc = BIT(i); 2186caa1f0b1SHans Wippel enable = card->options.vnicc.wanted_chars & vnicc; 2187caa1f0b1SHans Wippel error |= qeth_l2_vnicc_recover_char(card, vnicc, enable); 2188caa1f0b1SHans Wippel } 2189caa1f0b1SHans Wippel if (error) 2190caa1f0b1SHans Wippel dev_err(&card->gdev->dev, "Configuring the VNIC characteristics failed\n"); 2191caa1f0b1SHans Wippel } 2192caa1f0b1SHans Wippel 2193caa1f0b1SHans Wippel /* configure default values of VNIC characteristics */ 2194caa1f0b1SHans Wippel static void qeth_l2_vnicc_set_defaults(struct qeth_card *card) 2195caa1f0b1SHans Wippel { 2196caa1f0b1SHans Wippel /* characteristics values */ 2197caa1f0b1SHans Wippel card->options.vnicc.sup_chars = QETH_VNICC_ALL; 2198caa1f0b1SHans Wippel card->options.vnicc.cur_chars = QETH_VNICC_DEFAULT; 2199349d13d5SHans Wippel card->options.vnicc.learning_timeout = QETH_VNICC_DEFAULT_TIMEOUT; 2200caa1f0b1SHans Wippel /* supported commands */ 2201caa1f0b1SHans Wippel card->options.vnicc.set_char_sup = QETH_VNICC_ALL; 2202349d13d5SHans Wippel card->options.vnicc.getset_timeout_sup = QETH_VNICC_LEARNING; 2203caa1f0b1SHans Wippel /* settings wanted by users */ 2204caa1f0b1SHans Wippel card->options.vnicc.wanted_chars = QETH_VNICC_DEFAULT; 2205a45b3fafSHans Wippel } 2206a45b3fafSHans Wippel 22074a71df50SFrank Blaschka module_init(qeth_l2_init); 22084a71df50SFrank Blaschka module_exit(qeth_l2_exit); 22094a71df50SFrank Blaschka MODULE_AUTHOR("Frank Blaschka <frank.blaschka@de.ibm.com>"); 22104a71df50SFrank Blaschka MODULE_DESCRIPTION("qeth layer 2 discipline"); 22114a71df50SFrank Blaschka MODULE_LICENSE("GPL"); 2212