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"); 88a59d121dSJulian Wiedmann iob = qeth_ipa_alloc_cmd(card, ipacmd, QETH_PROT_IPV4, 89a59d121dSJulian Wiedmann IPA_DATA_SIZEOF(setdelmac)); 90ac988d78SJulian Wiedmann if (!iob) 91ac988d78SJulian Wiedmann return -ENOMEM; 92ff5caa7aSJulian Wiedmann cmd = __ipa_cmd(iob); 9399f0b85dSJulian Wiedmann cmd->data.setdelmac.mac_length = ETH_ALEN; 9499f0b85dSJulian Wiedmann ether_addr_copy(cmd->data.setdelmac.mac, mac); 95742d4d40SJulian Wiedmann return qeth_send_ipa_cmd(card, iob, qeth_l2_send_setdelmac_cb, NULL); 96ac988d78SJulian Wiedmann } 97ac988d78SJulian Wiedmann 98ac988d78SJulian Wiedmann static int qeth_l2_send_setmac(struct qeth_card *card, __u8 *mac) 99ac988d78SJulian Wiedmann { 100ac988d78SJulian Wiedmann int rc; 101ac988d78SJulian Wiedmann 102ac988d78SJulian Wiedmann QETH_CARD_TEXT(card, 2, "L2Setmac"); 103ac988d78SJulian Wiedmann rc = qeth_l2_send_setdelmac(card, mac, IPA_CMD_SETVMAC); 104ac988d78SJulian Wiedmann if (rc == 0) { 105ac988d78SJulian Wiedmann dev_info(&card->gdev->dev, 106654e3d48SJulian Wiedmann "MAC address %pM successfully registered\n", mac); 107ac988d78SJulian Wiedmann } else { 108ac988d78SJulian Wiedmann switch (rc) { 109ac988d78SJulian Wiedmann case -EEXIST: 110ac988d78SJulian Wiedmann dev_warn(&card->gdev->dev, 111ac988d78SJulian Wiedmann "MAC address %pM already exists\n", mac); 112ac988d78SJulian Wiedmann break; 113ac988d78SJulian Wiedmann case -EPERM: 114ac988d78SJulian Wiedmann dev_warn(&card->gdev->dev, 115ac988d78SJulian Wiedmann "MAC address %pM is not authorized\n", mac); 116ac988d78SJulian Wiedmann break; 117ac988d78SJulian Wiedmann } 118ac988d78SJulian Wiedmann } 119ac988d78SJulian Wiedmann return rc; 120ac988d78SJulian Wiedmann } 121ac988d78SJulian Wiedmann 1228174aa8aSJulian Wiedmann static int qeth_l2_write_mac(struct qeth_card *card, u8 *mac) 1234a71df50SFrank Blaschka { 1249d0a58fbSVasily Gorbik enum qeth_ipa_cmds cmd = is_multicast_ether_addr(mac) ? 1258174aa8aSJulian Wiedmann IPA_CMD_SETGMAC : IPA_CMD_SETVMAC; 126efbbc1d5SEugene Crosser int rc; 127efbbc1d5SEugene Crosser 1288174aa8aSJulian Wiedmann QETH_CARD_TEXT(card, 2, "L2Wmac"); 1298174aa8aSJulian Wiedmann rc = qeth_l2_send_setdelmac(card, mac, cmd); 130efbbc1d5SEugene Crosser if (rc == -EEXIST) 131e19e5be8SJulian Wiedmann QETH_DBF_MESSAGE(2, "MAC already registered on device %x\n", 132e19e5be8SJulian Wiedmann CARD_DEVID(card)); 133efbbc1d5SEugene Crosser else if (rc) 134e19e5be8SJulian Wiedmann QETH_DBF_MESSAGE(2, "Failed to register MAC on device %x: %d\n", 135e19e5be8SJulian Wiedmann CARD_DEVID(card), rc); 136efbbc1d5SEugene Crosser return rc; 1374a71df50SFrank Blaschka } 1384a71df50SFrank Blaschka 1398174aa8aSJulian Wiedmann static int qeth_l2_remove_mac(struct qeth_card *card, u8 *mac) 1404a71df50SFrank Blaschka { 1419d0a58fbSVasily Gorbik enum qeth_ipa_cmds cmd = is_multicast_ether_addr(mac) ? 1428174aa8aSJulian Wiedmann IPA_CMD_DELGMAC : IPA_CMD_DELVMAC; 143efbbc1d5SEugene Crosser int rc; 144efbbc1d5SEugene Crosser 1458174aa8aSJulian Wiedmann QETH_CARD_TEXT(card, 2, "L2Rmac"); 1468174aa8aSJulian Wiedmann rc = qeth_l2_send_setdelmac(card, mac, cmd); 147efbbc1d5SEugene Crosser if (rc) 148e19e5be8SJulian Wiedmann QETH_DBF_MESSAGE(2, "Failed to delete MAC on device %u: %d\n", 149e19e5be8SJulian Wiedmann CARD_DEVID(card), rc); 150efbbc1d5SEugene Crosser return rc; 1514a71df50SFrank Blaschka } 1524a71df50SFrank Blaschka 153d0c74825SJulian Wiedmann static void qeth_l2_drain_rx_mode_cache(struct qeth_card *card) 1544a71df50SFrank Blaschka { 155fe5c8028SLakhvich Dmitriy struct qeth_mac *mac; 156fe5c8028SLakhvich Dmitriy struct hlist_node *tmp; 157fe5c8028SLakhvich Dmitriy int i; 1584a71df50SFrank Blaschka 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 } 1644a71df50SFrank Blaschka 165b0abc4f5SJulian Wiedmann static void qeth_l2_fill_header(struct qeth_qdio_out_q *queue, 166b0abc4f5SJulian Wiedmann struct qeth_hdr *hdr, struct sk_buff *skb, 167eca1d5c2SJulian Wiedmann int ipv, unsigned int data_len) 1684a71df50SFrank Blaschka { 169eca1d5c2SJulian Wiedmann int cast_type = qeth_get_ether_cast_type(skb); 1700aef8392SJulian Wiedmann struct vlan_ethhdr *veth = vlan_eth_hdr(skb); 1714a71df50SFrank Blaschka 172ae79fe03SJulian Wiedmann hdr->hdr.l2.pkt_length = data_len; 1734a71df50SFrank Blaschka 1740aef8392SJulian Wiedmann if (skb_is_gso(skb)) { 1750aef8392SJulian Wiedmann hdr->hdr.l2.id = QETH_HEADER_TYPE_L2_TSO; 1760aef8392SJulian Wiedmann } else { 1770aef8392SJulian Wiedmann hdr->hdr.l2.id = QETH_HEADER_TYPE_LAYER2; 178eeac0e20SJulian Wiedmann if (skb->ip_summed == CHECKSUM_PARTIAL) 179fc69660bSJulian Wiedmann qeth_tx_csum(skb, &hdr->hdr.l2.flags[1], ipv); 1800aef8392SJulian Wiedmann } 181fc69660bSJulian Wiedmann 1824a71df50SFrank Blaschka /* set byte byte 3 to casting flags */ 1834a71df50SFrank Blaschka if (cast_type == RTN_MULTICAST) 1844a71df50SFrank Blaschka hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_MULTICAST; 1854a71df50SFrank Blaschka else if (cast_type == RTN_BROADCAST) 1864a71df50SFrank Blaschka hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_BROADCAST; 1874a71df50SFrank Blaschka else 188ce73e10eSKlaus-Dieter Wacker hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_UNICAST; 1894a71df50SFrank Blaschka 1904a71df50SFrank Blaschka /* VSWITCH relies on the VLAN 1914a71df50SFrank Blaschka * information to be present in 1924a71df50SFrank Blaschka * the QDIO header */ 1934a71df50SFrank Blaschka if (veth->h_vlan_proto == __constant_htons(ETH_P_8021Q)) { 1944a71df50SFrank Blaschka hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_VLAN; 1954a71df50SFrank Blaschka hdr->hdr.l2.vlan_id = ntohs(veth->h_vlan_TCI); 1964a71df50SFrank Blaschka } 1974a71df50SFrank Blaschka } 1984a71df50SFrank Blaschka 199742d4d40SJulian Wiedmann static int qeth_l2_setdelvlan_makerc(struct qeth_card *card, u16 retcode) 2004a71df50SFrank Blaschka { 2012aa48671SJulian Wiedmann if (retcode) 2022aa48671SJulian Wiedmann QETH_CARD_TEXT_(card, 2, "err%04x", retcode); 2032aa48671SJulian Wiedmann 2042aa48671SJulian Wiedmann switch (retcode) { 2052aa48671SJulian Wiedmann case IPA_RC_SUCCESS: 2062aa48671SJulian Wiedmann return 0; 2072aa48671SJulian Wiedmann case IPA_RC_L2_INVALID_VLAN_ID: 2082aa48671SJulian Wiedmann return -EINVAL; 2092aa48671SJulian Wiedmann case IPA_RC_L2_DUP_VLAN_ID: 2102aa48671SJulian Wiedmann return -EEXIST; 2112aa48671SJulian Wiedmann case IPA_RC_L2_VLAN_ID_NOT_FOUND: 2122aa48671SJulian Wiedmann return -ENOENT; 2132aa48671SJulian Wiedmann case IPA_RC_L2_VLAN_ID_NOT_ALLOWED: 2142aa48671SJulian Wiedmann return -EPERM; 2152aa48671SJulian Wiedmann default: 2162aa48671SJulian Wiedmann return -EIO; 2172aa48671SJulian Wiedmann } 2182aa48671SJulian Wiedmann } 2192aa48671SJulian Wiedmann 2202aa48671SJulian Wiedmann static int qeth_l2_send_setdelvlan_cb(struct qeth_card *card, 2212aa48671SJulian Wiedmann struct qeth_reply *reply, 2222aa48671SJulian Wiedmann unsigned long data) 2232aa48671SJulian Wiedmann { 2242aa48671SJulian Wiedmann struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *) data; 2254a71df50SFrank Blaschka 226847a50fdSCarsten Otte QETH_CARD_TEXT(card, 2, "L2sdvcb"); 2274a71df50SFrank Blaschka if (cmd->hdr.return_code) { 228e19e5be8SJulian Wiedmann QETH_DBF_MESSAGE(2, "Error in processing VLAN %u on device %x: %#x.\n", 2292aa48671SJulian Wiedmann cmd->data.setdelvlan.vlan_id, 230e19e5be8SJulian Wiedmann CARD_DEVID(card), cmd->hdr.return_code); 231847a50fdSCarsten Otte QETH_CARD_TEXT_(card, 2, "L2VL%4x", cmd->hdr.command); 2324a71df50SFrank Blaschka } 233742d4d40SJulian Wiedmann return qeth_l2_setdelvlan_makerc(card, cmd->hdr.return_code); 2344a71df50SFrank Blaschka } 2354a71df50SFrank Blaschka 2364a71df50SFrank Blaschka static int qeth_l2_send_setdelvlan(struct qeth_card *card, __u16 i, 2374a71df50SFrank Blaschka enum qeth_ipa_cmds ipacmd) 2384a71df50SFrank Blaschka { 2394a71df50SFrank Blaschka struct qeth_ipa_cmd *cmd; 2404a71df50SFrank Blaschka struct qeth_cmd_buffer *iob; 2414a71df50SFrank Blaschka 242847a50fdSCarsten Otte QETH_CARD_TEXT_(card, 4, "L2sdv%x", ipacmd); 243a59d121dSJulian Wiedmann iob = qeth_ipa_alloc_cmd(card, ipacmd, QETH_PROT_IPV4, 244a59d121dSJulian Wiedmann IPA_DATA_SIZEOF(setdelvlan)); 2451aec42bcSThomas Richter if (!iob) 2461aec42bcSThomas Richter return -ENOMEM; 247ff5caa7aSJulian Wiedmann cmd = __ipa_cmd(iob); 2484a71df50SFrank Blaschka cmd->data.setdelvlan.vlan_id = i; 249742d4d40SJulian Wiedmann return qeth_send_ipa_cmd(card, iob, qeth_l2_send_setdelvlan_cb, NULL); 2504a71df50SFrank Blaschka } 2514a71df50SFrank Blaschka 25280d5c368SPatrick McHardy static int qeth_l2_vlan_rx_add_vid(struct net_device *dev, 25380d5c368SPatrick McHardy __be16 proto, u16 vid) 2544a71df50SFrank Blaschka { 255509e2562SHeiko Carstens struct qeth_card *card = dev->ml_priv; 2564a71df50SFrank Blaschka 257847a50fdSCarsten Otte QETH_CARD_TEXT_(card, 4, "aid:%d", vid); 25810651db7SUrsula Braun if (!vid) 2598e586137SJiri Pirko return 0; 260e6e771b3SJulian Wiedmann 2615fc692a7SJulian Wiedmann return qeth_l2_send_setdelvlan(card, vid, IPA_CMD_SETVLAN); 2624a71df50SFrank Blaschka } 2634a71df50SFrank Blaschka 26480d5c368SPatrick McHardy static int qeth_l2_vlan_rx_kill_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, "kid:%d", vid); 2705fc692a7SJulian Wiedmann if (!vid) 2715fc692a7SJulian Wiedmann return 0; 272e6e771b3SJulian Wiedmann 2735fc692a7SJulian Wiedmann return qeth_l2_send_setdelvlan(card, vid, IPA_CMD_DELVLAN); 2744a71df50SFrank Blaschka } 2754a71df50SFrank Blaschka 276d4560150SJulian Wiedmann static void qeth_l2_stop_card(struct qeth_card *card) 2774a71df50SFrank Blaschka { 27857a688aaSJulian Wiedmann QETH_CARD_TEXT(card, 2, "stopcard"); 2794a71df50SFrank Blaschka 2804a71df50SFrank Blaschka qeth_set_allowed_threads(card, 0, 1); 2810f7aedbdSJulian Wiedmann 282d0c74825SJulian Wiedmann cancel_work_sync(&card->rx_mode_work); 283d0c74825SJulian Wiedmann qeth_l2_drain_rx_mode_cache(card); 284d0c74825SJulian Wiedmann 2854a71df50SFrank Blaschka if (card->state == CARD_STATE_SOFTSETUP) { 2864a71df50SFrank Blaschka qeth_clear_ipacmd_list(card); 2874a71df50SFrank Blaschka card->state = CARD_STATE_HARDSETUP; 2884a71df50SFrank Blaschka } 2894a71df50SFrank Blaschka if (card->state == CARD_STATE_HARDSETUP) { 29041c47da3SJulian Wiedmann qeth_drain_output_queues(card); 2914a71df50SFrank Blaschka qeth_clear_working_pool_list(card); 2924a71df50SFrank Blaschka card->state = CARD_STATE_DOWN; 2934a71df50SFrank Blaschka } 294ad160872SJulian Wiedmann 2958b5026bcSJulian Wiedmann qeth_qdio_clear_card(card, 0); 296c0a2e4d1SJulian Wiedmann flush_workqueue(card->event_wq); 2977bd2275cSJulian Wiedmann card->info.mac_bits &= ~QETH_LAYER2_MAC_REGISTERED; 2980f399305SJulian Wiedmann card->info.promisc_mode = 0; 2994a71df50SFrank Blaschka } 3004a71df50SFrank Blaschka 301a1c3ed4cSFrank Blaschka static int qeth_l2_process_inbound_buffer(struct qeth_card *card, 302a1c3ed4cSFrank Blaschka int budget, int *done) 3034a71df50SFrank Blaschka { 304a1c3ed4cSFrank Blaschka int work_done = 0; 3054a71df50SFrank Blaschka struct sk_buff *skb; 3064a71df50SFrank Blaschka struct qeth_hdr *hdr; 3074a71df50SFrank Blaschka unsigned int len; 3084a71df50SFrank Blaschka 309a1c3ed4cSFrank Blaschka *done = 0; 31018af5c17SStefan Raspl WARN_ON_ONCE(!budget); 311a1c3ed4cSFrank Blaschka while (budget) { 312a1c3ed4cSFrank Blaschka skb = qeth_core_get_next_skb(card, 313b3332930SFrank Blaschka &card->qdio.in_q->bufs[card->rx.b_index], 314a1c3ed4cSFrank Blaschka &card->rx.b_element, &card->rx.e_offset, &hdr); 315a1c3ed4cSFrank Blaschka if (!skb) { 316a1c3ed4cSFrank Blaschka *done = 1; 317a1c3ed4cSFrank Blaschka break; 3184a71df50SFrank Blaschka } 3197d4faee7SJulian Wiedmann 3207d4faee7SJulian Wiedmann if (hdr->hdr.l2.id == QETH_HEADER_TYPE_LAYER2) { 3214a71df50SFrank Blaschka skb->protocol = eth_type_trans(skb, skb->dev); 3226195b936SJulian Wiedmann qeth_rx_csum(card, skb, hdr->hdr.l2.flags[1]); 3234a71df50SFrank Blaschka len = skb->len; 3249abfa8cbSThomas Richter napi_gro_receive(&card->napi, skb); 3257d4faee7SJulian Wiedmann } else { 3267d4faee7SJulian Wiedmann skb_push(skb, sizeof(*hdr)); 3277d4faee7SJulian Wiedmann skb_copy_to_linear_data(skb, hdr, sizeof(*hdr)); 3284a71df50SFrank Blaschka len = skb->len; 3294a71df50SFrank Blaschka card->osn_info.data_cb(skb); 3302d488c2fSUrsula Braun } 3317d4faee7SJulian Wiedmann 332a1c3ed4cSFrank Blaschka work_done++; 333a1c3ed4cSFrank Blaschka budget--; 334b0abc4f5SJulian Wiedmann QETH_CARD_STAT_INC(card, rx_packets); 335b0abc4f5SJulian Wiedmann QETH_CARD_STAT_ADD(card, rx_bytes, len); 3364a71df50SFrank Blaschka } 337a1c3ed4cSFrank Blaschka return work_done; 338a1c3ed4cSFrank Blaschka } 339a1c3ed4cSFrank Blaschka 3404a71df50SFrank Blaschka static int qeth_l2_request_initial_mac(struct qeth_card *card) 3414a71df50SFrank Blaschka { 3424a71df50SFrank Blaschka int rc = 0; 3434a71df50SFrank Blaschka 34457a688aaSJulian Wiedmann QETH_CARD_TEXT(card, 2, "l2reqmac"); 3454a71df50SFrank Blaschka 346ec61bd2fSJulian Wiedmann if (MACHINE_IS_VM) { 347ec61bd2fSJulian Wiedmann rc = qeth_vm_request_mac(card); 348ec61bd2fSJulian Wiedmann if (!rc) 349ec61bd2fSJulian Wiedmann goto out; 350e19e5be8SJulian Wiedmann QETH_DBF_MESSAGE(2, "z/VM MAC Service failed on device %x: %#x\n", 351e19e5be8SJulian Wiedmann CARD_DEVID(card), rc); 35257a688aaSJulian Wiedmann QETH_CARD_TEXT_(card, 2, "err%04x", rc); 353ec61bd2fSJulian Wiedmann /* fall back to alternative mechanism: */ 354ec61bd2fSJulian Wiedmann } 355ec61bd2fSJulian Wiedmann 356b144b99fSJulian Wiedmann if (!IS_OSN(card)) { 3574a71df50SFrank Blaschka rc = qeth_setadpparms_change_macaddr(card); 3584b7ae122SJulian Wiedmann if (!rc) 35921b1702aSJulian Wiedmann goto out; 360e19e5be8SJulian Wiedmann QETH_DBF_MESSAGE(2, "READ_MAC Assist failed on device %x: %#x\n", 361e19e5be8SJulian Wiedmann CARD_DEVID(card), rc); 36257a688aaSJulian Wiedmann QETH_CARD_TEXT_(card, 2, "1err%04x", rc); 36321b1702aSJulian Wiedmann /* fall back once more: */ 3644a71df50SFrank Blaschka } 36521b1702aSJulian Wiedmann 36621b1702aSJulian Wiedmann /* some devices don't support a custom MAC address: */ 367379ac99eSJulian Wiedmann if (IS_OSM(card) || IS_OSX(card)) 36821b1702aSJulian Wiedmann return (rc) ? rc : -EADDRNOTAVAIL; 36921b1702aSJulian Wiedmann eth_hw_addr_random(card->dev); 37021b1702aSJulian Wiedmann 371ec61bd2fSJulian Wiedmann out: 37257a688aaSJulian Wiedmann QETH_CARD_HEX(card, 2, card->dev->dev_addr, card->dev->addr_len); 3734a71df50SFrank Blaschka return 0; 3744a71df50SFrank Blaschka } 3754a71df50SFrank Blaschka 376654e3d48SJulian Wiedmann static void qeth_l2_register_dev_addr(struct qeth_card *card) 377654e3d48SJulian Wiedmann { 378654e3d48SJulian Wiedmann if (!is_valid_ether_addr(card->dev->dev_addr)) 379654e3d48SJulian Wiedmann qeth_l2_request_initial_mac(card); 380654e3d48SJulian Wiedmann 381654e3d48SJulian Wiedmann if (!IS_OSN(card) && !qeth_l2_send_setmac(card, card->dev->dev_addr)) 382654e3d48SJulian Wiedmann card->info.mac_bits |= QETH_LAYER2_MAC_REGISTERED; 383654e3d48SJulian Wiedmann } 384654e3d48SJulian Wiedmann 385e22355eaSJulian Wiedmann static int qeth_l2_validate_addr(struct net_device *dev) 386e22355eaSJulian Wiedmann { 387e22355eaSJulian Wiedmann struct qeth_card *card = dev->ml_priv; 388e22355eaSJulian Wiedmann 3898024cc9eSJulian Wiedmann if (card->info.mac_bits & QETH_LAYER2_MAC_REGISTERED) 390e22355eaSJulian Wiedmann return eth_validate_addr(dev); 391e22355eaSJulian Wiedmann 392e22355eaSJulian Wiedmann QETH_CARD_TEXT(card, 4, "nomacadr"); 393e22355eaSJulian Wiedmann return -EPERM; 394e22355eaSJulian Wiedmann } 395e22355eaSJulian Wiedmann 3964a71df50SFrank Blaschka static int qeth_l2_set_mac_address(struct net_device *dev, void *p) 3974a71df50SFrank Blaschka { 3984a71df50SFrank Blaschka struct sockaddr *addr = p; 399509e2562SHeiko Carstens struct qeth_card *card = dev->ml_priv; 400bcacfcbcSJulian Wiedmann u8 old_addr[ETH_ALEN]; 4014a71df50SFrank Blaschka int rc = 0; 4024a71df50SFrank Blaschka 403847a50fdSCarsten Otte QETH_CARD_TEXT(card, 3, "setmac"); 4044a71df50SFrank Blaschka 4058024cc9eSJulian Wiedmann if (IS_OSM(card) || IS_OSX(card)) { 406847a50fdSCarsten Otte QETH_CARD_TEXT(card, 3, "setmcTYP"); 4074a71df50SFrank Blaschka return -EOPNOTSUPP; 4084a71df50SFrank Blaschka } 40999f0b85dSJulian Wiedmann QETH_CARD_HEX(card, 3, addr->sa_data, ETH_ALEN); 410bcacfcbcSJulian Wiedmann if (!is_valid_ether_addr(addr->sa_data)) 411bcacfcbcSJulian Wiedmann return -EADDRNOTAVAIL; 412bcacfcbcSJulian Wiedmann 413bcacfcbcSJulian Wiedmann /* don't register the same address twice */ 414bcacfcbcSJulian Wiedmann if (ether_addr_equal_64bits(dev->dev_addr, addr->sa_data) && 415bcacfcbcSJulian Wiedmann (card->info.mac_bits & QETH_LAYER2_MAC_REGISTERED)) 416e6e771b3SJulian Wiedmann return 0; 417bcacfcbcSJulian Wiedmann 418bcacfcbcSJulian Wiedmann /* add the new address, switch over, drop the old */ 4194a71df50SFrank Blaschka rc = qeth_l2_send_setmac(card, addr->sa_data); 420bcacfcbcSJulian Wiedmann if (rc) 421e6e771b3SJulian Wiedmann return rc; 422bcacfcbcSJulian Wiedmann ether_addr_copy(old_addr, dev->dev_addr); 423bcacfcbcSJulian Wiedmann ether_addr_copy(dev->dev_addr, addr->sa_data); 424bcacfcbcSJulian Wiedmann 425bcacfcbcSJulian Wiedmann if (card->info.mac_bits & QETH_LAYER2_MAC_REGISTERED) 426bcacfcbcSJulian Wiedmann qeth_l2_remove_mac(card, old_addr); 427bcacfcbcSJulian Wiedmann card->info.mac_bits |= QETH_LAYER2_MAC_REGISTERED; 428e6e771b3SJulian Wiedmann return 0; 4294a71df50SFrank Blaschka } 4304a71df50SFrank Blaschka 43159b757a9SJulian Wiedmann static void qeth_l2_promisc_to_bridge(struct qeth_card *card, bool enable) 4320db587b0SEugene Crosser { 4330db587b0SEugene Crosser int role; 4340db587b0SEugene Crosser int rc; 4350db587b0SEugene Crosser 4360db587b0SEugene Crosser QETH_CARD_TEXT(card, 3, "pmisc2br"); 4370db587b0SEugene Crosser 43859b757a9SJulian Wiedmann if (enable) { 4390db587b0SEugene Crosser if (card->options.sbp.reflect_promisc_primary) 4400db587b0SEugene Crosser role = QETH_SBP_ROLE_PRIMARY; 4410db587b0SEugene Crosser else 4420db587b0SEugene Crosser role = QETH_SBP_ROLE_SECONDARY; 4430db587b0SEugene Crosser } else 4440db587b0SEugene Crosser role = QETH_SBP_ROLE_NONE; 4450db587b0SEugene Crosser 4460db587b0SEugene Crosser rc = qeth_bridgeport_setrole(card, role); 44759b757a9SJulian Wiedmann QETH_CARD_TEXT_(card, 2, "bpm%c%04x", enable ? '+' : '-', rc); 4480db587b0SEugene Crosser if (!rc) { 4490db587b0SEugene Crosser card->options.sbp.role = role; 45059b757a9SJulian Wiedmann card->info.promisc_mode = enable; 45159b757a9SJulian Wiedmann } 4520db587b0SEugene Crosser } 453fe5c8028SLakhvich Dmitriy 45459b757a9SJulian Wiedmann static void qeth_l2_set_promisc_mode(struct qeth_card *card) 45559b757a9SJulian Wiedmann { 45659b757a9SJulian Wiedmann bool enable = card->dev->flags & IFF_PROMISC; 45759b757a9SJulian Wiedmann 45859b757a9SJulian Wiedmann if (card->info.promisc_mode == enable) 45959b757a9SJulian Wiedmann return; 46059b757a9SJulian Wiedmann 461c8183f54SJulian Wiedmann if (qeth_adp_supported(card, IPA_SETADP_SET_PROMISC_MODE)) { 46259b757a9SJulian Wiedmann qeth_setadp_promisc_mode(card, enable); 463c8183f54SJulian Wiedmann } else { 464c8183f54SJulian Wiedmann mutex_lock(&card->sbp_lock); 465c8183f54SJulian Wiedmann if (card->options.sbp.reflect_promisc) 46659b757a9SJulian Wiedmann qeth_l2_promisc_to_bridge(card, enable); 467c8183f54SJulian Wiedmann mutex_unlock(&card->sbp_lock); 468c8183f54SJulian Wiedmann } 469fe5c8028SLakhvich Dmitriy } 47059b757a9SJulian Wiedmann 471fe5c8028SLakhvich Dmitriy /* New MAC address is added to the hash table and marked to be written on card 472fe5c8028SLakhvich Dmitriy * only if there is not in the hash table storage already 473fe5c8028SLakhvich Dmitriy * 474fe5c8028SLakhvich Dmitriy */ 4754641b027SJulian Wiedmann static void qeth_l2_add_mac(struct qeth_card *card, struct netdev_hw_addr *ha) 476fe5c8028SLakhvich Dmitriy { 477cef6ff22SJulian Wiedmann u32 mac_hash = get_unaligned((u32 *)(&ha->addr[2])); 478fe5c8028SLakhvich Dmitriy struct qeth_mac *mac; 479fe5c8028SLakhvich Dmitriy 480cef6ff22SJulian Wiedmann hash_for_each_possible(card->mac_htable, mac, hnode, mac_hash) { 48199f0b85dSJulian Wiedmann if (ether_addr_equal_64bits(ha->addr, mac->mac_addr)) { 4825f78e29cSLakhvich Dmitriy mac->disp_flag = QETH_DISP_ADDR_DO_NOTHING; 483fe5c8028SLakhvich Dmitriy return; 484fe5c8028SLakhvich Dmitriy } 4850db587b0SEugene Crosser } 4860db587b0SEugene Crosser 487fe5c8028SLakhvich Dmitriy mac = kzalloc(sizeof(struct qeth_mac), GFP_ATOMIC); 488fe5c8028SLakhvich Dmitriy if (!mac) 489fe5c8028SLakhvich Dmitriy return; 490fe5c8028SLakhvich Dmitriy 49199f0b85dSJulian Wiedmann ether_addr_copy(mac->mac_addr, ha->addr); 4925f78e29cSLakhvich Dmitriy mac->disp_flag = QETH_DISP_ADDR_ADD; 493fe5c8028SLakhvich Dmitriy 494cef6ff22SJulian Wiedmann hash_add(card->mac_htable, &mac->hnode, mac_hash); 495fe5c8028SLakhvich Dmitriy } 496fe5c8028SLakhvich Dmitriy 497d0c74825SJulian Wiedmann static void qeth_l2_rx_mode_work(struct work_struct *work) 4984a71df50SFrank Blaschka { 499d0c74825SJulian Wiedmann struct qeth_card *card = container_of(work, struct qeth_card, 500d0c74825SJulian Wiedmann rx_mode_work); 501d0c74825SJulian Wiedmann struct net_device *dev = card->dev; 502ccffad25SJiri Pirko struct netdev_hw_addr *ha; 503fe5c8028SLakhvich Dmitriy struct qeth_mac *mac; 504fe5c8028SLakhvich Dmitriy struct hlist_node *tmp; 505fe5c8028SLakhvich Dmitriy int i; 506fe5c8028SLakhvich Dmitriy int rc; 5074a71df50SFrank Blaschka 508847a50fdSCarsten Otte QETH_CARD_TEXT(card, 3, "setmulti"); 509fe5c8028SLakhvich Dmitriy 510d0c74825SJulian Wiedmann netif_addr_lock_bh(dev); 51122bedad3SJiri Pirko netdev_for_each_mc_addr(ha, dev) 5124641b027SJulian Wiedmann qeth_l2_add_mac(card, ha); 51332e7bfc4SJiri Pirko netdev_for_each_uc_addr(ha, dev) 5144641b027SJulian Wiedmann qeth_l2_add_mac(card, ha); 515d0c74825SJulian Wiedmann netif_addr_unlock_bh(dev); 516fe5c8028SLakhvich Dmitriy 517fe5c8028SLakhvich Dmitriy hash_for_each_safe(card->mac_htable, i, tmp, mac, hnode) { 51800c163f1SJulian Wiedmann switch (mac->disp_flag) { 51900c163f1SJulian Wiedmann case QETH_DISP_ADDR_DELETE: 5208174aa8aSJulian Wiedmann qeth_l2_remove_mac(card, mac->mac_addr); 521fe5c8028SLakhvich Dmitriy hash_del(&mac->hnode); 522fe5c8028SLakhvich Dmitriy kfree(mac); 52300c163f1SJulian Wiedmann break; 52400c163f1SJulian Wiedmann case QETH_DISP_ADDR_ADD: 5258174aa8aSJulian Wiedmann rc = qeth_l2_write_mac(card, mac->mac_addr); 526fe5c8028SLakhvich Dmitriy if (rc) { 527fe5c8028SLakhvich Dmitriy hash_del(&mac->hnode); 528fe5c8028SLakhvich Dmitriy kfree(mac); 52900c163f1SJulian Wiedmann break; 53000c163f1SJulian Wiedmann } 53100c163f1SJulian Wiedmann /* fall through */ 53200c163f1SJulian Wiedmann default: 53300c163f1SJulian Wiedmann /* for next call to set_rx_mode(): */ 5345f78e29cSLakhvich Dmitriy mac->disp_flag = QETH_DISP_ADDR_DELETE; 53500c163f1SJulian Wiedmann } 536fe5c8028SLakhvich Dmitriy } 5377db2266aSFrank Blaschka 53859b757a9SJulian Wiedmann qeth_l2_set_promisc_mode(card); 5394a71df50SFrank Blaschka } 5404a71df50SFrank Blaschka 5417286384bSJulian Wiedmann static int qeth_l2_xmit_osn(struct qeth_card *card, struct sk_buff *skb, 5427286384bSJulian Wiedmann struct qeth_qdio_out_q *queue) 5437286384bSJulian Wiedmann { 54469d7ce80SJulian Wiedmann struct qeth_hdr *hdr = (struct qeth_hdr *)skb->data; 54569d7ce80SJulian Wiedmann addr_t end = (addr_t)(skb->data + sizeof(*hdr)); 54669d7ce80SJulian Wiedmann addr_t start = (addr_t)skb->data; 54769d7ce80SJulian Wiedmann unsigned int elements = 0; 54869d7ce80SJulian Wiedmann unsigned int hd_len = 0; 54969d7ce80SJulian Wiedmann int rc; 5507286384bSJulian Wiedmann 5517286384bSJulian Wiedmann if (skb->protocol == htons(ETH_P_IPV6)) 5527286384bSJulian Wiedmann return -EPROTONOSUPPORT; 5537286384bSJulian Wiedmann 55469d7ce80SJulian Wiedmann if (qeth_get_elements_for_range(start, end) > 1) { 55569d7ce80SJulian Wiedmann /* Misaligned HW header, move it to its own buffer element. */ 55669d7ce80SJulian Wiedmann hdr = kmem_cache_alloc(qeth_core_header_cache, GFP_ATOMIC); 55769d7ce80SJulian Wiedmann if (!hdr) 55869d7ce80SJulian Wiedmann return -ENOMEM; 55969d7ce80SJulian Wiedmann hd_len = sizeof(*hdr); 56069d7ce80SJulian Wiedmann skb_copy_from_linear_data(skb, (char *)hdr, hd_len); 56169d7ce80SJulian Wiedmann elements++; 56269d7ce80SJulian Wiedmann } 56369d7ce80SJulian Wiedmann 56469d7ce80SJulian Wiedmann elements += qeth_count_elements(skb, hd_len); 5654e26c5feSJulian Wiedmann if (elements > queue->max_elements) { 56669d7ce80SJulian Wiedmann rc = -E2BIG; 56769d7ce80SJulian Wiedmann goto out; 56869d7ce80SJulian Wiedmann } 56969d7ce80SJulian Wiedmann 57069d7ce80SJulian Wiedmann rc = qeth_do_send_packet(card, queue, skb, hdr, hd_len, hd_len, 57169d7ce80SJulian Wiedmann elements); 57269d7ce80SJulian Wiedmann out: 57369d7ce80SJulian Wiedmann if (rc && hd_len) 57469d7ce80SJulian Wiedmann kmem_cache_free(qeth_core_header_cache, hdr); 57569d7ce80SJulian Wiedmann return rc; 5767286384bSJulian Wiedmann } 5777286384bSJulian Wiedmann 578e38db6beSJulian Wiedmann static netdev_tx_t qeth_l2_hard_start_xmit(struct sk_buff *skb, 579e38db6beSJulian Wiedmann struct net_device *dev) 5804a71df50SFrank Blaschka { 581509e2562SHeiko Carstens struct qeth_card *card = dev->ml_priv; 5823a18d754SJulian Wiedmann u16 txq = skb_get_queue_mapping(skb); 583290b8348SStefan Raspl struct qeth_qdio_out_q *queue; 5847286384bSJulian Wiedmann int rc; 5854a71df50SFrank Blaschka 586eeac0e20SJulian Wiedmann if (!skb_is_gso(skb)) 587eeac0e20SJulian Wiedmann qdisc_skb_cb(skb)->pkt_len = skb->len; 5883a18d754SJulian Wiedmann if (IS_IQD(card)) 58954a50941SJulian Wiedmann txq = qeth_iqd_translate_txq(dev, txq); 59073dc2dafSJulian Wiedmann queue = card->qdio.out_qs[txq]; 591b0abc4f5SJulian Wiedmann 5925f89eca5SJulian Wiedmann if (IS_OSN(card)) 5937286384bSJulian Wiedmann rc = qeth_l2_xmit_osn(card, skb, queue); 5945f89eca5SJulian Wiedmann else 59573dc2dafSJulian Wiedmann rc = qeth_xmit(card, skb, queue, qeth_get_ip_version(skb), 59658aa2491SJulian Wiedmann qeth_l2_fill_header); 5974a71df50SFrank Blaschka 598eeac0e20SJulian Wiedmann if (!rc) 5997286384bSJulian Wiedmann return NETDEV_TX_OK; 6004a71df50SFrank Blaschka 601b0abc4f5SJulian Wiedmann QETH_TXQ_STAT_INC(queue, tx_dropped); 602104b4859SJulian Wiedmann kfree_skb(skb); 6034a71df50SFrank Blaschka return NETDEV_TX_OK; 6044a71df50SFrank Blaschka } 6054a71df50SFrank Blaschka 6063a18d754SJulian Wiedmann static u16 qeth_l2_select_queue(struct net_device *dev, struct sk_buff *skb, 6073a18d754SJulian Wiedmann struct net_device *sb_dev) 6083a18d754SJulian Wiedmann { 60973dc2dafSJulian Wiedmann struct qeth_card *card = dev->ml_priv; 61073dc2dafSJulian Wiedmann 61173dc2dafSJulian Wiedmann if (IS_IQD(card)) 61273dc2dafSJulian Wiedmann return qeth_iqd_select_queue(dev, skb, 61358aa2491SJulian Wiedmann qeth_get_ether_cast_type(skb), 6143a18d754SJulian Wiedmann sb_dev); 61573dc2dafSJulian Wiedmann return qeth_get_priority_queue(card, skb); 6163a18d754SJulian Wiedmann } 6173a18d754SJulian Wiedmann 6182d2ebb3eSJulian Wiedmann static const struct device_type qeth_l2_devtype = { 6192d2ebb3eSJulian Wiedmann .name = "qeth_layer2", 6202d2ebb3eSJulian Wiedmann .groups = qeth_l2_attr_groups, 6212d2ebb3eSJulian Wiedmann }; 6222d2ebb3eSJulian Wiedmann 6234a71df50SFrank Blaschka static int qeth_l2_probe_device(struct ccwgroup_device *gdev) 6244a71df50SFrank Blaschka { 6254a71df50SFrank Blaschka struct qeth_card *card = dev_get_drvdata(&gdev->dev); 6269111e788SUrsula Braun int rc; 6274a71df50SFrank Blaschka 62812b409ddSJulian Wiedmann qeth_l2_vnicc_set_defaults(card); 629c8183f54SJulian Wiedmann mutex_init(&card->sbp_lock); 63012b409ddSJulian Wiedmann 6312d2ebb3eSJulian Wiedmann if (gdev->dev.type == &qeth_generic_devtype) { 6329111e788SUrsula Braun rc = qeth_l2_create_device_attributes(&gdev->dev); 6339111e788SUrsula Braun if (rc) 6349111e788SUrsula Braun return rc; 6352d2ebb3eSJulian Wiedmann } 6365fc692a7SJulian Wiedmann 637fe5c8028SLakhvich Dmitriy hash_init(card->mac_htable); 638d0c74825SJulian Wiedmann INIT_WORK(&card->rx_mode_work, qeth_l2_rx_mode_work); 6394a71df50SFrank Blaschka return 0; 6404a71df50SFrank Blaschka } 6414a71df50SFrank Blaschka 6424a71df50SFrank Blaschka static void qeth_l2_remove_device(struct ccwgroup_device *cgdev) 6434a71df50SFrank Blaschka { 6444a71df50SFrank Blaschka struct qeth_card *card = dev_get_drvdata(&cgdev->dev); 6454a71df50SFrank Blaschka 6462d2ebb3eSJulian Wiedmann if (cgdev->dev.type == &qeth_generic_devtype) 647b4d72c08SEugene Crosser qeth_l2_remove_device_attributes(&cgdev->dev); 648f2148565SUrsula Braun qeth_set_allowed_threads(card, 0, 1); 6494a71df50SFrank Blaschka wait_event(card->wait_q, qeth_threads_running(card, 0xffffffff) == 0); 6504a71df50SFrank Blaschka 65170919e23SUrsula Braun if (cgdev->state == CCWGROUP_ONLINE) 6524a71df50SFrank Blaschka qeth_l2_set_offline(cgdev); 653c2780c1aSJulian Wiedmann 654c2780c1aSJulian Wiedmann cancel_work_sync(&card->close_dev_work); 65530356d08SJulian Wiedmann if (qeth_netdev_is_registered(card->dev)) 6564a71df50SFrank Blaschka unregister_netdev(card->dev); 6574a71df50SFrank Blaschka } 6584a71df50SFrank Blaschka 659d0c74825SJulian Wiedmann static void qeth_l2_set_rx_mode(struct net_device *dev) 660d0c74825SJulian Wiedmann { 661d0c74825SJulian Wiedmann struct qeth_card *card = dev->ml_priv; 662d0c74825SJulian Wiedmann 663d0c74825SJulian Wiedmann schedule_work(&card->rx_mode_work); 664d0c74825SJulian Wiedmann } 665d0c74825SJulian Wiedmann 6663d58cefdSFrank Blaschka static const struct net_device_ops qeth_l2_netdev_ops = { 667e22355eaSJulian Wiedmann .ndo_open = qeth_open, 668e22355eaSJulian Wiedmann .ndo_stop = qeth_stop, 669b0abc4f5SJulian Wiedmann .ndo_get_stats64 = qeth_get_stats64, 6708403b13cSFrank Blaschka .ndo_start_xmit = qeth_l2_hard_start_xmit, 6716d69b1f1SJulian Wiedmann .ndo_features_check = qeth_features_check, 6723a18d754SJulian Wiedmann .ndo_select_queue = qeth_l2_select_queue, 673e22355eaSJulian Wiedmann .ndo_validate_addr = qeth_l2_validate_addr, 674fe5c8028SLakhvich Dmitriy .ndo_set_rx_mode = qeth_l2_set_rx_mode, 675942d6984SJulian Wiedmann .ndo_do_ioctl = qeth_do_ioctl, 6768403b13cSFrank Blaschka .ndo_set_mac_address = qeth_l2_set_mac_address, 6778403b13cSFrank Blaschka .ndo_vlan_rx_add_vid = qeth_l2_vlan_rx_add_vid, 6788403b13cSFrank Blaschka .ndo_vlan_rx_kill_vid = qeth_l2_vlan_rx_kill_vid, 6798403b13cSFrank Blaschka .ndo_tx_timeout = qeth_tx_timeout, 6808f43fb00SThomas Richter .ndo_fix_features = qeth_fix_features, 6818f43fb00SThomas Richter .ndo_set_features = qeth_set_features 6828403b13cSFrank Blaschka }; 6838403b13cSFrank Blaschka 6848024cc9eSJulian Wiedmann static const struct net_device_ops qeth_osn_netdev_ops = { 6858024cc9eSJulian Wiedmann .ndo_open = qeth_open, 6868024cc9eSJulian Wiedmann .ndo_stop = qeth_stop, 6878024cc9eSJulian Wiedmann .ndo_get_stats64 = qeth_get_stats64, 6888024cc9eSJulian Wiedmann .ndo_start_xmit = qeth_l2_hard_start_xmit, 6898024cc9eSJulian Wiedmann .ndo_validate_addr = eth_validate_addr, 6908024cc9eSJulian Wiedmann .ndo_tx_timeout = qeth_tx_timeout, 6918024cc9eSJulian Wiedmann }; 6928024cc9eSJulian Wiedmann 6939fae5c3bSJulian Wiedmann static int qeth_l2_setup_netdev(struct qeth_card *card, bool carrier_ok) 6944a71df50SFrank Blaschka { 695d3d1b205SJulian Wiedmann int rc; 6964a71df50SFrank Blaschka 6978024cc9eSJulian Wiedmann if (IS_OSN(card)) { 6988024cc9eSJulian Wiedmann card->dev->netdev_ops = &qeth_osn_netdev_ops; 69925e2c341SJulian Wiedmann card->dev->flags |= IFF_NOARP; 7008024cc9eSJulian Wiedmann goto add_napi; 7018024cc9eSJulian Wiedmann } 7028024cc9eSJulian Wiedmann 7035f89eca5SJulian Wiedmann card->dev->needed_headroom = sizeof(struct qeth_hdr); 7048024cc9eSJulian Wiedmann card->dev->netdev_ops = &qeth_l2_netdev_ops; 7058024cc9eSJulian Wiedmann card->dev->priv_flags |= IFF_UNICAST_FLT; 7069400c53fSJulian Wiedmann 7075fc692a7SJulian Wiedmann if (IS_OSM(card)) { 7089400c53fSJulian Wiedmann card->dev->features |= NETIF_F_VLAN_CHALLENGED; 7095fc692a7SJulian Wiedmann } else { 7105fc692a7SJulian Wiedmann if (!IS_VM_NIC(card)) 7115fc692a7SJulian Wiedmann card->dev->hw_features |= NETIF_F_HW_VLAN_CTAG_FILTER; 712f646968fSPatrick McHardy card->dev->features |= NETIF_F_HW_VLAN_CTAG_FILTER; 7135fc692a7SJulian Wiedmann } 7140f342945SJulian Wiedmann 715379ac99eSJulian Wiedmann if (IS_OSD(card) && !IS_VM_NIC(card)) { 7166d69b1f1SJulian Wiedmann card->dev->features |= NETIF_F_SG; 7178f43fb00SThomas Richter /* OSA 3S and earlier has no RX/TX support */ 7189bdc4411SHans Wippel if (qeth_is_supported(card, IPA_OUTBOUND_CHECKSUM)) { 7198f43fb00SThomas Richter card->dev->hw_features |= NETIF_F_IP_CSUM; 7209bdc4411SHans Wippel card->dev->vlan_features |= NETIF_F_IP_CSUM; 7219bdc4411SHans Wippel } 7224d7def2aSThomas Richter } 723571f9dd8SKittipon Meesompop if (qeth_is_supported6(card, IPA_OUTBOUND_CHECKSUM_V6)) { 724571f9dd8SKittipon Meesompop card->dev->hw_features |= NETIF_F_IPV6_CSUM; 725571f9dd8SKittipon Meesompop card->dev->vlan_features |= NETIF_F_IPV6_CSUM; 726571f9dd8SKittipon Meesompop } 727d7e6ed97SKittipon Meesompop if (qeth_is_supported(card, IPA_INBOUND_CHECKSUM) || 728d7e6ed97SKittipon Meesompop qeth_is_supported6(card, IPA_INBOUND_CHECKSUM_V6)) { 729d7e6ed97SKittipon Meesompop card->dev->hw_features |= NETIF_F_RXCSUM; 730d7e6ed97SKittipon Meesompop card->dev->vlan_features |= NETIF_F_RXCSUM; 731d7e6ed97SKittipon Meesompop } 7320aef8392SJulian Wiedmann if (qeth_is_supported(card, IPA_OUTBOUND_TSO)) { 7330aef8392SJulian Wiedmann card->dev->hw_features |= NETIF_F_TSO; 7340aef8392SJulian Wiedmann card->dev->vlan_features |= NETIF_F_TSO; 7350aef8392SJulian Wiedmann } 7360aef8392SJulian Wiedmann if (qeth_is_supported6(card, IPA_OUTBOUND_TSO)) { 7370aef8392SJulian Wiedmann card->dev->hw_features |= NETIF_F_TSO6; 7380aef8392SJulian Wiedmann card->dev->vlan_features |= NETIF_F_TSO6; 7390aef8392SJulian Wiedmann } 7400aef8392SJulian Wiedmann 7410aef8392SJulian Wiedmann if (card->dev->hw_features & (NETIF_F_TSO | NETIF_F_TSO6)) { 7420aef8392SJulian Wiedmann card->dev->needed_headroom = sizeof(struct qeth_hdr_tso); 7430aef8392SJulian Wiedmann netif_set_gso_max_size(card->dev, 7440aef8392SJulian Wiedmann PAGE_SIZE * (QDIO_MAX_ELEMENTS_PER_BUFFER - 1)); 7450aef8392SJulian Wiedmann } 7460d6f02d3SJulian Wiedmann 7478024cc9eSJulian Wiedmann add_napi: 748d73ef324SJulian Wiedmann netif_napi_add(card->dev, &card->napi, qeth_poll, QETH_NAPI_WEIGHT); 749d3d1b205SJulian Wiedmann rc = register_netdev(card->dev); 7509fae5c3bSJulian Wiedmann if (!rc && carrier_ok) 7519fae5c3bSJulian Wiedmann netif_carrier_on(card->dev); 7529fae5c3bSJulian Wiedmann 753d3d1b205SJulian Wiedmann if (rc) 754d3d1b205SJulian Wiedmann card->dev->netdev_ops = NULL; 755d3d1b205SJulian Wiedmann return rc; 7564a71df50SFrank Blaschka } 7574a71df50SFrank Blaschka 758521c10eaSJulian Wiedmann static void qeth_l2_trace_features(struct qeth_card *card) 759521c10eaSJulian Wiedmann { 760a45b3fafSHans Wippel /* Set BridgePort features */ 761a45b3fafSHans Wippel QETH_CARD_TEXT(card, 2, "featuSBP"); 762521c10eaSJulian Wiedmann QETH_CARD_HEX(card, 2, &card->options.sbp.supported_funcs, 763521c10eaSJulian Wiedmann sizeof(card->options.sbp.supported_funcs)); 764a45b3fafSHans Wippel /* VNIC Characteristics features */ 765a45b3fafSHans Wippel QETH_CARD_TEXT(card, 2, "feaVNICC"); 766a45b3fafSHans Wippel QETH_CARD_HEX(card, 2, &card->options.vnicc.sup_chars, 767a45b3fafSHans Wippel sizeof(card->options.vnicc.sup_chars)); 768521c10eaSJulian Wiedmann } 769521c10eaSJulian Wiedmann 770d4560150SJulian Wiedmann static int qeth_l2_set_online(struct ccwgroup_device *gdev) 7714a71df50SFrank Blaschka { 7724a71df50SFrank Blaschka struct qeth_card *card = dev_get_drvdata(&gdev->dev); 773fa3d2e60SJulian Wiedmann struct net_device *dev = card->dev; 7744a71df50SFrank Blaschka int rc = 0; 7759fae5c3bSJulian Wiedmann bool carrier_ok; 7764a71df50SFrank Blaschka 7779dc48cccSUrsula Braun mutex_lock(&card->discipline_mutex); 778c4949f07SFrank Blaschka mutex_lock(&card->conf_mutex); 77957a688aaSJulian Wiedmann QETH_CARD_TEXT(card, 2, "setonlin"); 7804a71df50SFrank Blaschka 7819fae5c3bSJulian Wiedmann rc = qeth_core_hardsetup_card(card, &carrier_ok); 7824a71df50SFrank Blaschka if (rc) { 78357a688aaSJulian Wiedmann QETH_CARD_TEXT_(card, 2, "2err%04x", rc); 784aa909224SUrsula Braun rc = -ENODEV; 7854a71df50SFrank Blaschka goto out_remove; 7864a71df50SFrank Blaschka } 787654e3d48SJulian Wiedmann 788c8183f54SJulian Wiedmann mutex_lock(&card->sbp_lock); 789d7ef489fSJulian Wiedmann qeth_bridgeport_query_support(card); 790d7ef489fSJulian Wiedmann if (card->options.sbp.supported_funcs) 791d7ef489fSJulian Wiedmann dev_info(&card->gdev->dev, 792d7ef489fSJulian Wiedmann "The device represents a Bridge Capable Port\n"); 793c8183f54SJulian Wiedmann mutex_unlock(&card->sbp_lock); 794d7ef489fSJulian Wiedmann 795d7ef489fSJulian Wiedmann qeth_l2_register_dev_addr(card); 796d7ef489fSJulian Wiedmann 797a45b3fafSHans Wippel /* for the rx_bcast characteristic, init VNICC after setmac */ 798a45b3fafSHans Wippel qeth_l2_vnicc_init(card); 799a45b3fafSHans Wippel 800a45b3fafSHans Wippel qeth_trace_features(card); 801a45b3fafSHans Wippel qeth_l2_trace_features(card); 802a45b3fafSHans Wippel 803b4d72c08SEugene Crosser qeth_l2_setup_bridgeport_attrs(card); 804b4d72c08SEugene Crosser 8054a71df50SFrank Blaschka card->state = CARD_STATE_HARDSETUP; 8064a71df50SFrank Blaschka qeth_print_status_message(card); 8074a71df50SFrank Blaschka 8084a71df50SFrank Blaschka /* softsetup */ 80957a688aaSJulian Wiedmann QETH_CARD_TEXT(card, 2, "softsetp"); 8104a71df50SFrank Blaschka 8114a71df50SFrank Blaschka rc = qeth_init_qdio_queues(card); 8124a71df50SFrank Blaschka if (rc) { 81357a688aaSJulian Wiedmann QETH_CARD_TEXT_(card, 2, "6err%d", rc); 814aa909224SUrsula Braun rc = -ENODEV; 8154a71df50SFrank Blaschka goto out_remove; 8164a71df50SFrank Blaschka } 8174a71df50SFrank Blaschka card->state = CARD_STATE_SOFTSETUP; 8184a71df50SFrank Blaschka 8194a71df50SFrank Blaschka qeth_set_allowed_threads(card, 0xffffffff, 0); 820d025da9eSJulian Wiedmann 821fa3d2e60SJulian Wiedmann if (!qeth_netdev_is_registered(dev)) { 822fa3d2e60SJulian Wiedmann rc = qeth_l2_setup_netdev(card, carrier_ok); 823fa3d2e60SJulian Wiedmann if (rc) 824fa3d2e60SJulian Wiedmann goto out_remove; 8254a71df50SFrank Blaschka } else { 8264a71df50SFrank Blaschka rtnl_lock(); 827fa3d2e60SJulian Wiedmann if (carrier_ok) 828fa3d2e60SJulian Wiedmann netif_carrier_on(dev); 829fa3d2e60SJulian Wiedmann else 830fa3d2e60SJulian Wiedmann netif_carrier_off(dev); 831fa3d2e60SJulian Wiedmann 832e6e771b3SJulian Wiedmann netif_device_attach(dev); 833fa3d2e60SJulian Wiedmann qeth_enable_hw_features(dev); 834fa3d2e60SJulian Wiedmann 835d7d543f2SJulian Wiedmann if (card->info.open_when_online) { 836d7d543f2SJulian Wiedmann card->info.open_when_online = 0; 837fa3d2e60SJulian Wiedmann dev_open(dev, NULL); 838fa3d2e60SJulian Wiedmann } 839fa3d2e60SJulian Wiedmann rtnl_unlock(); 8404a71df50SFrank Blaschka } 8414a71df50SFrank Blaschka /* let user_space know that device is online */ 8424a71df50SFrank Blaschka kobject_uevent(&gdev->dev.kobj, KOBJ_CHANGE); 843c4949f07SFrank Blaschka mutex_unlock(&card->conf_mutex); 8449dc48cccSUrsula Braun mutex_unlock(&card->discipline_mutex); 8454a71df50SFrank Blaschka return 0; 846aa909224SUrsula Braun 8474a71df50SFrank Blaschka out_remove: 848d4560150SJulian Wiedmann qeth_l2_stop_card(card); 849f9e50b02SJulian Wiedmann qeth_stop_channel(&card->data); 850f9e50b02SJulian Wiedmann qeth_stop_channel(&card->write); 851f9e50b02SJulian Wiedmann qeth_stop_channel(&card->read); 85222ae2790SUrsula Braun qdio_free(CARD_DDEV(card)); 853d7d543f2SJulian Wiedmann 854c4949f07SFrank Blaschka mutex_unlock(&card->conf_mutex); 8559dc48cccSUrsula Braun mutex_unlock(&card->discipline_mutex); 856aa909224SUrsula Braun return rc; 8574a71df50SFrank Blaschka } 8584a71df50SFrank Blaschka 8594a71df50SFrank Blaschka static int __qeth_l2_set_offline(struct ccwgroup_device *cgdev, 8604a71df50SFrank Blaschka int recovery_mode) 8614a71df50SFrank Blaschka { 8624a71df50SFrank Blaschka struct qeth_card *card = dev_get_drvdata(&cgdev->dev); 8634a71df50SFrank Blaschka int rc = 0, rc2 = 0, rc3 = 0; 8644a71df50SFrank Blaschka 8659dc48cccSUrsula Braun mutex_lock(&card->discipline_mutex); 866c4949f07SFrank Blaschka mutex_lock(&card->conf_mutex); 86757a688aaSJulian Wiedmann QETH_CARD_TEXT(card, 3, "setoffl"); 8684a71df50SFrank Blaschka 869d7ef489fSJulian Wiedmann if ((!recovery_mode && card->info.hwtrap) || card->info.hwtrap == 2) { 870d7ef489fSJulian Wiedmann qeth_hw_trap(card, QETH_DIAGS_TRAP_DISARM); 871d7ef489fSJulian Wiedmann card->info.hwtrap = 1; 872d7ef489fSJulian Wiedmann } 873d7ef489fSJulian Wiedmann 874e6e771b3SJulian Wiedmann rtnl_lock(); 875d7d543f2SJulian Wiedmann card->info.open_when_online = card->dev->flags & IFF_UP; 876d4560150SJulian Wiedmann dev_close(card->dev); 877e6e771b3SJulian Wiedmann netif_device_detach(card->dev); 8784a71df50SFrank Blaschka netif_carrier_off(card->dev); 879e6e771b3SJulian Wiedmann rtnl_unlock(); 880e6e771b3SJulian Wiedmann 881d4560150SJulian Wiedmann qeth_l2_stop_card(card); 882f9e50b02SJulian Wiedmann rc = qeth_stop_channel(&card->data); 883f9e50b02SJulian Wiedmann rc2 = qeth_stop_channel(&card->write); 884f9e50b02SJulian Wiedmann rc3 = qeth_stop_channel(&card->read); 8854a71df50SFrank Blaschka if (!rc) 8864a71df50SFrank Blaschka rc = (rc2) ? rc2 : rc3; 8874a71df50SFrank Blaschka if (rc) 88857a688aaSJulian Wiedmann QETH_CARD_TEXT_(card, 2, "1err%d", rc); 88922ae2790SUrsula Braun qdio_free(CARD_DDEV(card)); 890d7d543f2SJulian Wiedmann 8914a71df50SFrank Blaschka /* let user_space know that device is offline */ 8924a71df50SFrank Blaschka kobject_uevent(&cgdev->dev.kobj, KOBJ_CHANGE); 893c4949f07SFrank Blaschka mutex_unlock(&card->conf_mutex); 8949dc48cccSUrsula Braun mutex_unlock(&card->discipline_mutex); 8954a71df50SFrank Blaschka return 0; 8964a71df50SFrank Blaschka } 8974a71df50SFrank Blaschka 8984a71df50SFrank Blaschka static int qeth_l2_set_offline(struct ccwgroup_device *cgdev) 8994a71df50SFrank Blaschka { 9004a71df50SFrank Blaschka return __qeth_l2_set_offline(cgdev, 0); 9014a71df50SFrank Blaschka } 9024a71df50SFrank Blaschka 9034a71df50SFrank Blaschka static int qeth_l2_recover(void *ptr) 9044a71df50SFrank Blaschka { 9054a71df50SFrank Blaschka struct qeth_card *card; 9064a71df50SFrank Blaschka int rc = 0; 9074a71df50SFrank Blaschka 9084a71df50SFrank Blaschka card = (struct qeth_card *) ptr; 909847a50fdSCarsten Otte QETH_CARD_TEXT(card, 2, "recover1"); 9104a71df50SFrank Blaschka if (!qeth_do_run_thread(card, QETH_RECOVER_THREAD)) 9114a71df50SFrank Blaschka return 0; 912847a50fdSCarsten Otte QETH_CARD_TEXT(card, 2, "recover2"); 91374eacdb9SFrank Blaschka dev_warn(&card->gdev->dev, 91474eacdb9SFrank Blaschka "A recovery process has been started for the device\n"); 9154a71df50SFrank Blaschka __qeth_l2_set_offline(card->gdev, 1); 916d4560150SJulian Wiedmann rc = qeth_l2_set_online(card->gdev); 9174a71df50SFrank Blaschka if (!rc) 91874eacdb9SFrank Blaschka dev_info(&card->gdev->dev, 91974eacdb9SFrank Blaschka "Device successfully recovered!\n"); 92028a7e4c9SUrsula Braun else { 921bf42d40bSJulian Wiedmann ccwgroup_set_offline(card->gdev); 92274eacdb9SFrank Blaschka dev_warn(&card->gdev->dev, "The qeth device driver " 92374eacdb9SFrank Blaschka "failed to recover an error on the device\n"); 92428a7e4c9SUrsula Braun } 925a1c3ed4cSFrank Blaschka qeth_clear_thread_start_bit(card, QETH_RECOVER_THREAD); 926a1c3ed4cSFrank Blaschka qeth_clear_thread_running_bit(card, QETH_RECOVER_THREAD); 9274a71df50SFrank Blaschka return 0; 9284a71df50SFrank Blaschka } 9294a71df50SFrank Blaschka 9304a71df50SFrank Blaschka static int __init qeth_l2_init(void) 9314a71df50SFrank Blaschka { 93274eacdb9SFrank Blaschka pr_info("register layer 2 discipline\n"); 9334a71df50SFrank Blaschka return 0; 9344a71df50SFrank Blaschka } 9354a71df50SFrank Blaschka 9364a71df50SFrank Blaschka static void __exit qeth_l2_exit(void) 9374a71df50SFrank Blaschka { 93874eacdb9SFrank Blaschka pr_info("unregister layer 2 discipline\n"); 9394a71df50SFrank Blaschka } 9404a71df50SFrank Blaschka 941c044dc21SEugene Crosser /* Returns zero if the command is successfully "consumed" */ 942c044dc21SEugene Crosser static int qeth_l2_control_event(struct qeth_card *card, 943c044dc21SEugene Crosser struct qeth_ipa_cmd *cmd) 944c044dc21SEugene Crosser { 945c044dc21SEugene Crosser switch (cmd->hdr.command) { 9469c23f4daSEugene Crosser case IPA_CMD_SETBRIDGEPORT_OSA: 9479c23f4daSEugene Crosser case IPA_CMD_SETBRIDGEPORT_IQD: 948c044dc21SEugene Crosser if (cmd->data.sbp.hdr.command_code == 949c044dc21SEugene Crosser IPA_SBP_BRIDGE_PORT_STATE_CHANGE) { 950c044dc21SEugene Crosser qeth_bridge_state_change(card, cmd); 951c044dc21SEugene Crosser return 0; 952c044dc21SEugene Crosser } else 953c044dc21SEugene Crosser return 1; 954c044dc21SEugene Crosser case IPA_CMD_ADDRESS_CHANGE_NOTIF: 955c044dc21SEugene Crosser qeth_bridge_host_event(card, cmd); 956c044dc21SEugene Crosser return 0; 957c044dc21SEugene Crosser default: 958c044dc21SEugene Crosser return 1; 959c044dc21SEugene Crosser } 960c044dc21SEugene Crosser } 961c044dc21SEugene Crosser 962c041f2d4SSebastian Ott struct qeth_discipline qeth_l2_discipline = { 9632d2ebb3eSJulian Wiedmann .devtype = &qeth_l2_devtype, 964d73ef324SJulian Wiedmann .process_rx_buffer = qeth_l2_process_inbound_buffer, 965c041f2d4SSebastian Ott .recover = qeth_l2_recover, 966c041f2d4SSebastian Ott .setup = qeth_l2_probe_device, 9674a71df50SFrank Blaschka .remove = qeth_l2_remove_device, 9684a71df50SFrank Blaschka .set_online = qeth_l2_set_online, 9694a71df50SFrank Blaschka .set_offline = qeth_l2_set_offline, 970942d6984SJulian Wiedmann .do_ioctl = NULL, 971c044dc21SEugene Crosser .control_event_handler = qeth_l2_control_event, 9724a71df50SFrank Blaschka }; 973c041f2d4SSebastian Ott EXPORT_SYMBOL_GPL(qeth_l2_discipline); 9744a71df50SFrank Blaschka 9750ce37ec2SJulian Wiedmann static void qeth_osn_assist_cb(struct qeth_card *card, 97612fc286fSJulian Wiedmann struct qeth_cmd_buffer *iob, 97712fc286fSJulian Wiedmann unsigned int data_length) 9784a71df50SFrank Blaschka { 979308946b0SJulian Wiedmann qeth_notify_cmd(iob, 0); 980c3b2218dSJulian Wiedmann qeth_put_cmd(iob); 9814a71df50SFrank Blaschka } 9824a71df50SFrank Blaschka 9834a71df50SFrank Blaschka int qeth_osn_assist(struct net_device *dev, void *data, int data_len) 9844a71df50SFrank Blaschka { 9854a71df50SFrank Blaschka struct qeth_cmd_buffer *iob; 9864a71df50SFrank Blaschka struct qeth_card *card; 9874a71df50SFrank Blaschka 988a59d121dSJulian Wiedmann if (data_len < 0) 989a59d121dSJulian Wiedmann return -EINVAL; 9904a71df50SFrank Blaschka if (!dev) 9914a71df50SFrank Blaschka return -ENODEV; 992509e2562SHeiko Carstens card = dev->ml_priv; 9934a71df50SFrank Blaschka if (!card) 9944a71df50SFrank Blaschka return -ENODEV; 995847a50fdSCarsten Otte QETH_CARD_TEXT(card, 2, "osnsdmc"); 996c3521254SEugene Crosser if (!qeth_card_hw_is_reachable(card)) 9974a71df50SFrank Blaschka return -ENODEV; 998a59d121dSJulian Wiedmann 999a59d121dSJulian Wiedmann iob = qeth_alloc_cmd(&card->write, IPA_PDU_HEADER_SIZE + data_len, 1, 1000a59d121dSJulian Wiedmann QETH_IPA_TIMEOUT); 10011273a800SJulian Wiedmann if (!iob) 10021273a800SJulian Wiedmann return -ENOMEM; 10031273a800SJulian Wiedmann 1004c2153277SJulian Wiedmann qeth_prepare_ipa_cmd(card, iob, (u16) data_len); 1005ff5caa7aSJulian Wiedmann memcpy(__ipa_cmd(iob), data, data_len); 10060ce37ec2SJulian Wiedmann iob->callback = qeth_osn_assist_cb; 10070ce37ec2SJulian Wiedmann return qeth_send_ipa_cmd(card, iob, NULL, NULL); 10084a71df50SFrank Blaschka } 10094a71df50SFrank Blaschka EXPORT_SYMBOL(qeth_osn_assist); 10104a71df50SFrank Blaschka 10114a71df50SFrank Blaschka int qeth_osn_register(unsigned char *read_dev_no, struct net_device **dev, 10124a71df50SFrank Blaschka int (*assist_cb)(struct net_device *, void *), 10134a71df50SFrank Blaschka int (*data_cb)(struct sk_buff *)) 10144a71df50SFrank Blaschka { 10154a71df50SFrank Blaschka struct qeth_card *card; 1016d7d18da1SJulian Wiedmann char bus_id[16]; 1017d7d18da1SJulian Wiedmann u16 devno; 10184a71df50SFrank Blaschka 1019d7d18da1SJulian Wiedmann memcpy(&devno, read_dev_no, 2); 1020d7d18da1SJulian Wiedmann sprintf(bus_id, "0.0.%04x", devno); 1021d7d18da1SJulian Wiedmann card = qeth_get_card_by_busid(bus_id); 1022d7d18da1SJulian Wiedmann if (!card || !IS_OSN(card)) 10234a71df50SFrank Blaschka return -ENODEV; 1024d7d18da1SJulian Wiedmann *dev = card->dev; 1025d7d18da1SJulian Wiedmann 1026847a50fdSCarsten Otte QETH_CARD_TEXT(card, 2, "osnreg"); 10274a71df50SFrank Blaschka if ((assist_cb == NULL) || (data_cb == NULL)) 10284a71df50SFrank Blaschka return -EINVAL; 10294a71df50SFrank Blaschka card->osn_info.assist_cb = assist_cb; 10304a71df50SFrank Blaschka card->osn_info.data_cb = data_cb; 10314a71df50SFrank Blaschka return 0; 10324a71df50SFrank Blaschka } 10334a71df50SFrank Blaschka EXPORT_SYMBOL(qeth_osn_register); 10344a71df50SFrank Blaschka 10354a71df50SFrank Blaschka void qeth_osn_deregister(struct net_device *dev) 10364a71df50SFrank Blaschka { 10374a71df50SFrank Blaschka struct qeth_card *card; 10384a71df50SFrank Blaschka 10394a71df50SFrank Blaschka if (!dev) 10404a71df50SFrank Blaschka return; 1041509e2562SHeiko Carstens card = dev->ml_priv; 10424a71df50SFrank Blaschka if (!card) 10434a71df50SFrank Blaschka return; 1044847a50fdSCarsten Otte QETH_CARD_TEXT(card, 2, "osndereg"); 10454a71df50SFrank Blaschka card->osn_info.assist_cb = NULL; 10464a71df50SFrank Blaschka card->osn_info.data_cb = NULL; 10474a71df50SFrank Blaschka return; 10484a71df50SFrank Blaschka } 10494a71df50SFrank Blaschka EXPORT_SYMBOL(qeth_osn_deregister); 10504a71df50SFrank Blaschka 1051b4d72c08SEugene Crosser /* SETBRIDGEPORT support, async notifications */ 1052b4d72c08SEugene Crosser 10539f48b9dbSEugene Crosser enum qeth_an_event_type {anev_reg_unreg, anev_abort, anev_reset}; 10549f48b9dbSEugene Crosser 10559f48b9dbSEugene Crosser /** 10569f48b9dbSEugene Crosser * qeth_bridge_emit_host_event() - bridgeport address change notification 10579f48b9dbSEugene Crosser * @card: qeth_card structure pointer, for udev events. 10589f48b9dbSEugene Crosser * @evtype: "normal" register/unregister, or abort, or reset. For abort 10599f48b9dbSEugene Crosser * and reset token and addr_lnid are unused and may be NULL. 10609f48b9dbSEugene Crosser * @code: event bitmask: high order bit 0x80 value 1 means removal of an 10619f48b9dbSEugene Crosser * object, 0 - addition of an object. 10629f48b9dbSEugene Crosser * 0x01 - VLAN, 0x02 - MAC, 0x03 - VLAN and MAC. 10639f48b9dbSEugene Crosser * @token: "network token" structure identifying physical address of the port. 10649f48b9dbSEugene Crosser * @addr_lnid: pointer to structure with MAC address and VLAN ID. 10659f48b9dbSEugene Crosser * 10669f48b9dbSEugene Crosser * This function is called when registrations and deregistrations are 10679f48b9dbSEugene Crosser * reported by the hardware, and also when notifications are enabled - 10689f48b9dbSEugene Crosser * for all currently registered addresses. 10699f48b9dbSEugene Crosser */ 10709f48b9dbSEugene Crosser static void qeth_bridge_emit_host_event(struct qeth_card *card, 10719f48b9dbSEugene Crosser enum qeth_an_event_type evtype, 10729f48b9dbSEugene Crosser u8 code, struct net_if_token *token, struct mac_addr_lnid *addr_lnid) 10739f48b9dbSEugene Crosser { 10749f48b9dbSEugene Crosser char str[7][32]; 10759f48b9dbSEugene Crosser char *env[8]; 10769f48b9dbSEugene Crosser int i = 0; 10779f48b9dbSEugene Crosser 10789f48b9dbSEugene Crosser switch (evtype) { 10799f48b9dbSEugene Crosser case anev_reg_unreg: 10809f48b9dbSEugene Crosser snprintf(str[i], sizeof(str[i]), "BRIDGEDHOST=%s", 10819f48b9dbSEugene Crosser (code & IPA_ADDR_CHANGE_CODE_REMOVAL) 10829f48b9dbSEugene Crosser ? "deregister" : "register"); 10839f48b9dbSEugene Crosser env[i] = str[i]; i++; 10849f48b9dbSEugene Crosser if (code & IPA_ADDR_CHANGE_CODE_VLANID) { 10859f48b9dbSEugene Crosser snprintf(str[i], sizeof(str[i]), "VLAN=%d", 10869f48b9dbSEugene Crosser addr_lnid->lnid); 10879f48b9dbSEugene Crosser env[i] = str[i]; i++; 10889f48b9dbSEugene Crosser } 10899f48b9dbSEugene Crosser if (code & IPA_ADDR_CHANGE_CODE_MACADDR) { 10909846e70bSEugene Crosser snprintf(str[i], sizeof(str[i]), "MAC=%pM", 10919846e70bSEugene Crosser addr_lnid->mac); 10929f48b9dbSEugene Crosser env[i] = str[i]; i++; 10939f48b9dbSEugene Crosser } 10949f48b9dbSEugene Crosser snprintf(str[i], sizeof(str[i]), "NTOK_BUSID=%x.%x.%04x", 10959f48b9dbSEugene Crosser token->cssid, token->ssid, token->devnum); 10969f48b9dbSEugene Crosser env[i] = str[i]; i++; 10979f48b9dbSEugene Crosser snprintf(str[i], sizeof(str[i]), "NTOK_IID=%02x", token->iid); 10989f48b9dbSEugene Crosser env[i] = str[i]; i++; 10999f48b9dbSEugene Crosser snprintf(str[i], sizeof(str[i]), "NTOK_CHPID=%02x", 11009f48b9dbSEugene Crosser token->chpid); 11019f48b9dbSEugene Crosser env[i] = str[i]; i++; 11029f48b9dbSEugene Crosser snprintf(str[i], sizeof(str[i]), "NTOK_CHID=%04x", token->chid); 11039f48b9dbSEugene Crosser env[i] = str[i]; i++; 11049f48b9dbSEugene Crosser break; 11059f48b9dbSEugene Crosser case anev_abort: 11069f48b9dbSEugene Crosser snprintf(str[i], sizeof(str[i]), "BRIDGEDHOST=abort"); 11079f48b9dbSEugene Crosser env[i] = str[i]; i++; 11089f48b9dbSEugene Crosser break; 11099f48b9dbSEugene Crosser case anev_reset: 11109f48b9dbSEugene Crosser snprintf(str[i], sizeof(str[i]), "BRIDGEDHOST=reset"); 11119f48b9dbSEugene Crosser env[i] = str[i]; i++; 11129f48b9dbSEugene Crosser break; 11139f48b9dbSEugene Crosser } 11149f48b9dbSEugene Crosser env[i] = NULL; 11159f48b9dbSEugene Crosser kobject_uevent_env(&card->gdev->dev.kobj, KOBJ_CHANGE, env); 11169f48b9dbSEugene Crosser } 11179f48b9dbSEugene Crosser 1118b4d72c08SEugene Crosser struct qeth_bridge_state_data { 1119b4d72c08SEugene Crosser struct work_struct worker; 1120b4d72c08SEugene Crosser struct qeth_card *card; 1121b4d72c08SEugene Crosser struct qeth_sbp_state_change qports; 1122b4d72c08SEugene Crosser }; 1123b4d72c08SEugene Crosser 1124b4d72c08SEugene Crosser static void qeth_bridge_state_change_worker(struct work_struct *work) 1125b4d72c08SEugene Crosser { 1126b4d72c08SEugene Crosser struct qeth_bridge_state_data *data = 1127b4d72c08SEugene Crosser container_of(work, struct qeth_bridge_state_data, worker); 1128b4d72c08SEugene Crosser /* We are only interested in the first entry - local port */ 1129b4d72c08SEugene Crosser struct qeth_sbp_port_entry *entry = &data->qports.entry[0]; 1130b4d72c08SEugene Crosser char env_locrem[32]; 1131b4d72c08SEugene Crosser char env_role[32]; 1132b4d72c08SEugene Crosser char env_state[32]; 1133b4d72c08SEugene Crosser char *env[] = { 1134b4d72c08SEugene Crosser env_locrem, 1135b4d72c08SEugene Crosser env_role, 1136b4d72c08SEugene Crosser env_state, 1137b4d72c08SEugene Crosser NULL 1138b4d72c08SEugene Crosser }; 1139b4d72c08SEugene Crosser 1140b4d72c08SEugene Crosser /* Role should not change by itself, but if it did, */ 1141b4d72c08SEugene Crosser /* information from the hardware is authoritative. */ 1142c8183f54SJulian Wiedmann mutex_lock(&data->card->sbp_lock); 1143b4d72c08SEugene Crosser data->card->options.sbp.role = entry->role; 1144c8183f54SJulian Wiedmann mutex_unlock(&data->card->sbp_lock); 1145b4d72c08SEugene Crosser 1146b4d72c08SEugene Crosser snprintf(env_locrem, sizeof(env_locrem), "BRIDGEPORT=statechange"); 1147b4d72c08SEugene Crosser snprintf(env_role, sizeof(env_role), "ROLE=%s", 1148b4d72c08SEugene Crosser (entry->role == QETH_SBP_ROLE_NONE) ? "none" : 1149b4d72c08SEugene Crosser (entry->role == QETH_SBP_ROLE_PRIMARY) ? "primary" : 1150b4d72c08SEugene Crosser (entry->role == QETH_SBP_ROLE_SECONDARY) ? "secondary" : 1151b4d72c08SEugene Crosser "<INVALID>"); 1152b4d72c08SEugene Crosser snprintf(env_state, sizeof(env_state), "STATE=%s", 1153b4d72c08SEugene Crosser (entry->state == QETH_SBP_STATE_INACTIVE) ? "inactive" : 1154b4d72c08SEugene Crosser (entry->state == QETH_SBP_STATE_STANDBY) ? "standby" : 1155b4d72c08SEugene Crosser (entry->state == QETH_SBP_STATE_ACTIVE) ? "active" : 1156b4d72c08SEugene Crosser "<INVALID>"); 1157b4d72c08SEugene Crosser kobject_uevent_env(&data->card->gdev->dev.kobj, 1158b4d72c08SEugene Crosser KOBJ_CHANGE, env); 1159b4d72c08SEugene Crosser kfree(data); 1160b4d72c08SEugene Crosser } 1161b4d72c08SEugene Crosser 1162c044dc21SEugene Crosser static void qeth_bridge_state_change(struct qeth_card *card, 1163c044dc21SEugene Crosser struct qeth_ipa_cmd *cmd) 1164b4d72c08SEugene Crosser { 1165b4d72c08SEugene Crosser struct qeth_sbp_state_change *qports = 1166b4d72c08SEugene Crosser &cmd->data.sbp.data.state_change; 1167b4d72c08SEugene Crosser struct qeth_bridge_state_data *data; 1168b4d72c08SEugene Crosser int extrasize; 1169b4d72c08SEugene Crosser 1170b4d72c08SEugene Crosser QETH_CARD_TEXT(card, 2, "brstchng"); 1171b4d72c08SEugene Crosser if (qports->entry_length != sizeof(struct qeth_sbp_port_entry)) { 11728a593148SThomas Richter QETH_CARD_TEXT_(card, 2, "BPsz%04x", qports->entry_length); 1173b4d72c08SEugene Crosser return; 1174b4d72c08SEugene Crosser } 1175b4d72c08SEugene Crosser extrasize = sizeof(struct qeth_sbp_port_entry) * qports->num_entries; 1176b4d72c08SEugene Crosser data = kzalloc(sizeof(struct qeth_bridge_state_data) + extrasize, 1177b4d72c08SEugene Crosser GFP_ATOMIC); 1178b4d72c08SEugene Crosser if (!data) { 1179b4d72c08SEugene Crosser QETH_CARD_TEXT(card, 2, "BPSalloc"); 1180b4d72c08SEugene Crosser return; 1181b4d72c08SEugene Crosser } 1182b4d72c08SEugene Crosser INIT_WORK(&data->worker, qeth_bridge_state_change_worker); 1183b4d72c08SEugene Crosser data->card = card; 1184b4d72c08SEugene Crosser memcpy(&data->qports, qports, 1185b4d72c08SEugene Crosser sizeof(struct qeth_sbp_state_change) + extrasize); 1186c0a2e4d1SJulian Wiedmann queue_work(card->event_wq, &data->worker); 1187b4d72c08SEugene Crosser } 1188b4d72c08SEugene Crosser 11899f48b9dbSEugene Crosser struct qeth_bridge_host_data { 11909f48b9dbSEugene Crosser struct work_struct worker; 11919f48b9dbSEugene Crosser struct qeth_card *card; 11929f48b9dbSEugene Crosser struct qeth_ipacmd_addr_change hostevs; 11939f48b9dbSEugene Crosser }; 11949f48b9dbSEugene Crosser 11959f48b9dbSEugene Crosser static void qeth_bridge_host_event_worker(struct work_struct *work) 11969f48b9dbSEugene Crosser { 11979f48b9dbSEugene Crosser struct qeth_bridge_host_data *data = 11989f48b9dbSEugene Crosser container_of(work, struct qeth_bridge_host_data, worker); 11999f48b9dbSEugene Crosser int i; 12009f48b9dbSEugene Crosser 12019f48b9dbSEugene Crosser if (data->hostevs.lost_event_mask) { 12029f48b9dbSEugene Crosser dev_info(&data->card->gdev->dev, 12039c23f4daSEugene Crosser "Address notification from the Bridge Port stopped %s (%s)\n", 12049f48b9dbSEugene Crosser data->card->dev->name, 12059f48b9dbSEugene Crosser (data->hostevs.lost_event_mask == 0x01) 12069f48b9dbSEugene Crosser ? "Overflow" 12079f48b9dbSEugene Crosser : (data->hostevs.lost_event_mask == 0x02) 12089f48b9dbSEugene Crosser ? "Bridge port state change" 12099f48b9dbSEugene Crosser : "Unknown reason"); 1210c8183f54SJulian Wiedmann mutex_lock(&data->card->sbp_lock); 12119f48b9dbSEugene Crosser data->card->options.sbp.hostnotification = 0; 1212c8183f54SJulian Wiedmann mutex_unlock(&data->card->sbp_lock); 12139f48b9dbSEugene Crosser qeth_bridge_emit_host_event(data->card, anev_abort, 12149f48b9dbSEugene Crosser 0, NULL, NULL); 12159f48b9dbSEugene Crosser } else 12169f48b9dbSEugene Crosser for (i = 0; i < data->hostevs.num_entries; i++) { 12179f48b9dbSEugene Crosser struct qeth_ipacmd_addr_change_entry *entry = 12189f48b9dbSEugene Crosser &data->hostevs.entry[i]; 12199f48b9dbSEugene Crosser qeth_bridge_emit_host_event(data->card, 12209f48b9dbSEugene Crosser anev_reg_unreg, 12219f48b9dbSEugene Crosser entry->change_code, 12229f48b9dbSEugene Crosser &entry->token, &entry->addr_lnid); 12239f48b9dbSEugene Crosser } 12249f48b9dbSEugene Crosser kfree(data); 12259f48b9dbSEugene Crosser } 12269f48b9dbSEugene Crosser 1227c044dc21SEugene Crosser static void qeth_bridge_host_event(struct qeth_card *card, 1228c044dc21SEugene Crosser struct qeth_ipa_cmd *cmd) 12299f48b9dbSEugene Crosser { 12309f48b9dbSEugene Crosser struct qeth_ipacmd_addr_change *hostevs = 12319f48b9dbSEugene Crosser &cmd->data.addrchange; 12329f48b9dbSEugene Crosser struct qeth_bridge_host_data *data; 12339f48b9dbSEugene Crosser int extrasize; 12349f48b9dbSEugene Crosser 12359f48b9dbSEugene Crosser QETH_CARD_TEXT(card, 2, "brhostev"); 12369f48b9dbSEugene Crosser if (cmd->hdr.return_code != 0x0000) { 12379f48b9dbSEugene Crosser if (cmd->hdr.return_code == 0x0010) { 12389f48b9dbSEugene Crosser if (hostevs->lost_event_mask == 0x00) 12399f48b9dbSEugene Crosser hostevs->lost_event_mask = 0xff; 12409f48b9dbSEugene Crosser } else { 12419f48b9dbSEugene Crosser QETH_CARD_TEXT_(card, 2, "BPHe%04x", 12429f48b9dbSEugene Crosser cmd->hdr.return_code); 12439f48b9dbSEugene Crosser return; 12449f48b9dbSEugene Crosser } 12459f48b9dbSEugene Crosser } 12469f48b9dbSEugene Crosser extrasize = sizeof(struct qeth_ipacmd_addr_change_entry) * 12479f48b9dbSEugene Crosser hostevs->num_entries; 12489f48b9dbSEugene Crosser data = kzalloc(sizeof(struct qeth_bridge_host_data) + extrasize, 12499f48b9dbSEugene Crosser GFP_ATOMIC); 12509f48b9dbSEugene Crosser if (!data) { 12519f48b9dbSEugene Crosser QETH_CARD_TEXT(card, 2, "BPHalloc"); 12529f48b9dbSEugene Crosser return; 12539f48b9dbSEugene Crosser } 12549f48b9dbSEugene Crosser INIT_WORK(&data->worker, qeth_bridge_host_event_worker); 12559f48b9dbSEugene Crosser data->card = card; 12569f48b9dbSEugene Crosser memcpy(&data->hostevs, hostevs, 12579f48b9dbSEugene Crosser sizeof(struct qeth_ipacmd_addr_change) + extrasize); 1258c0a2e4d1SJulian Wiedmann queue_work(card->event_wq, &data->worker); 12599f48b9dbSEugene Crosser } 12609f48b9dbSEugene Crosser 1261b4d72c08SEugene Crosser /* SETBRIDGEPORT support; sending commands */ 1262b4d72c08SEugene Crosser 1263b4d72c08SEugene Crosser struct _qeth_sbp_cbctl { 1264b4d72c08SEugene Crosser union { 1265b4d72c08SEugene Crosser u32 supported; 1266b4d72c08SEugene Crosser struct { 1267b4d72c08SEugene Crosser enum qeth_sbp_roles *role; 1268b4d72c08SEugene Crosser enum qeth_sbp_states *state; 1269b4d72c08SEugene Crosser } qports; 1270b4d72c08SEugene Crosser } data; 1271b4d72c08SEugene Crosser }; 1272b4d72c08SEugene Crosser 1273b4d72c08SEugene Crosser static int qeth_bridgeport_makerc(struct qeth_card *card, 12741709ff8dSJulian Wiedmann struct qeth_ipa_cmd *cmd) 1275b4d72c08SEugene Crosser { 12761709ff8dSJulian Wiedmann struct qeth_ipacmd_setbridgeport *sbp = &cmd->data.sbp; 12771709ff8dSJulian Wiedmann enum qeth_ipa_sbp_cmd setcmd = sbp->hdr.command_code; 12781709ff8dSJulian Wiedmann u16 ipa_rc = cmd->hdr.return_code; 12791709ff8dSJulian Wiedmann u16 sbp_rc = sbp->hdr.return_code; 1280b4d72c08SEugene Crosser int rc; 1281b4d72c08SEugene Crosser 12821709ff8dSJulian Wiedmann if (ipa_rc == IPA_RC_SUCCESS && sbp_rc == IPA_RC_SUCCESS) 12831709ff8dSJulian Wiedmann return 0; 12841709ff8dSJulian Wiedmann 12851709ff8dSJulian Wiedmann if ((IS_IQD(card) && ipa_rc == IPA_RC_SUCCESS) || 12861709ff8dSJulian Wiedmann (!IS_IQD(card) && ipa_rc == sbp_rc)) { 12871709ff8dSJulian Wiedmann switch (sbp_rc) { 12882063a5f5SKittipon Meesompop case IPA_RC_SUCCESS: 1289b4d72c08SEugene Crosser rc = 0; 1290b4d72c08SEugene Crosser break; 12912063a5f5SKittipon Meesompop case IPA_RC_L2_UNSUPPORTED_CMD: 12922063a5f5SKittipon Meesompop case IPA_RC_UNSUPPORTED_COMMAND: 1293ffb95251SEugene Crosser rc = -EOPNOTSUPP; 1294b4d72c08SEugene Crosser break; 12952063a5f5SKittipon Meesompop case IPA_RC_SBP_OSA_NOT_CONFIGURED: 12962063a5f5SKittipon Meesompop case IPA_RC_SBP_IQD_NOT_CONFIGURED: 1297b4d72c08SEugene Crosser rc = -ENODEV; /* maybe not the best code here? */ 1298b4d72c08SEugene Crosser dev_err(&card->gdev->dev, 12999c23f4daSEugene Crosser "The device is not configured as a Bridge Port\n"); 1300b4d72c08SEugene Crosser break; 13012063a5f5SKittipon Meesompop case IPA_RC_SBP_OSA_OS_MISMATCH: 13022063a5f5SKittipon Meesompop case IPA_RC_SBP_IQD_OS_MISMATCH: 13031b05cf62SEugene Crosser rc = -EPERM; 13041b05cf62SEugene Crosser dev_err(&card->gdev->dev, 13051b05cf62SEugene Crosser "A Bridge Port is already configured by a different operating system\n"); 13061b05cf62SEugene Crosser break; 13072063a5f5SKittipon Meesompop case IPA_RC_SBP_OSA_ANO_DEV_PRIMARY: 13082063a5f5SKittipon Meesompop case IPA_RC_SBP_IQD_ANO_DEV_PRIMARY: 1309b4d72c08SEugene Crosser switch (setcmd) { 1310b4d72c08SEugene Crosser case IPA_SBP_SET_PRIMARY_BRIDGE_PORT: 1311b4d72c08SEugene Crosser rc = -EEXIST; 1312b4d72c08SEugene Crosser dev_err(&card->gdev->dev, 13139c23f4daSEugene Crosser "The LAN already has a primary Bridge Port\n"); 1314b4d72c08SEugene Crosser break; 1315b4d72c08SEugene Crosser case IPA_SBP_SET_SECONDARY_BRIDGE_PORT: 1316b4d72c08SEugene Crosser rc = -EBUSY; 1317b4d72c08SEugene Crosser dev_err(&card->gdev->dev, 13189c23f4daSEugene Crosser "The device is already a primary Bridge Port\n"); 1319b4d72c08SEugene Crosser break; 1320b4d72c08SEugene Crosser default: 1321b4d72c08SEugene Crosser rc = -EIO; 1322b4d72c08SEugene Crosser } 1323b4d72c08SEugene Crosser break; 13242063a5f5SKittipon Meesompop case IPA_RC_SBP_OSA_CURRENT_SECOND: 13252063a5f5SKittipon Meesompop case IPA_RC_SBP_IQD_CURRENT_SECOND: 1326b4d72c08SEugene Crosser rc = -EBUSY; 1327b4d72c08SEugene Crosser dev_err(&card->gdev->dev, 13289c23f4daSEugene Crosser "The device is already a secondary Bridge Port\n"); 1329b4d72c08SEugene Crosser break; 13302063a5f5SKittipon Meesompop case IPA_RC_SBP_OSA_LIMIT_SECOND: 13312063a5f5SKittipon Meesompop case IPA_RC_SBP_IQD_LIMIT_SECOND: 1332b4d72c08SEugene Crosser rc = -EEXIST; 1333b4d72c08SEugene Crosser dev_err(&card->gdev->dev, 13349c23f4daSEugene Crosser "The LAN cannot have more secondary Bridge Ports\n"); 1335b4d72c08SEugene Crosser break; 13362063a5f5SKittipon Meesompop case IPA_RC_SBP_OSA_CURRENT_PRIMARY: 13372063a5f5SKittipon Meesompop case IPA_RC_SBP_IQD_CURRENT_PRIMARY: 1338b4d72c08SEugene Crosser rc = -EBUSY; 1339b4d72c08SEugene Crosser dev_err(&card->gdev->dev, 13409c23f4daSEugene Crosser "The device is already a primary Bridge Port\n"); 1341b4d72c08SEugene Crosser break; 13422063a5f5SKittipon Meesompop case IPA_RC_SBP_OSA_NOT_AUTHD_BY_ZMAN: 13432063a5f5SKittipon Meesompop case IPA_RC_SBP_IQD_NOT_AUTHD_BY_ZMAN: 1344b4d72c08SEugene Crosser rc = -EACCES; 1345b4d72c08SEugene Crosser dev_err(&card->gdev->dev, 13469c23f4daSEugene Crosser "The device is not authorized to be a Bridge Port\n"); 1347b4d72c08SEugene Crosser break; 1348b4d72c08SEugene Crosser default: 1349b4d72c08SEugene Crosser rc = -EIO; 1350b4d72c08SEugene Crosser } 13511709ff8dSJulian Wiedmann } else { 13521709ff8dSJulian Wiedmann switch (ipa_rc) { 1353b4d72c08SEugene Crosser case IPA_RC_NOTSUPP: 1354ffb95251SEugene Crosser rc = -EOPNOTSUPP; 1355b4d72c08SEugene Crosser break; 1356b4d72c08SEugene Crosser case IPA_RC_UNSUPPORTED_COMMAND: 1357ffb95251SEugene Crosser rc = -EOPNOTSUPP; 1358b4d72c08SEugene Crosser break; 1359b4d72c08SEugene Crosser default: 1360b4d72c08SEugene Crosser rc = -EIO; 1361b4d72c08SEugene Crosser } 13621709ff8dSJulian Wiedmann } 13639c23f4daSEugene Crosser 1364b4d72c08SEugene Crosser if (rc) { 13651709ff8dSJulian Wiedmann QETH_CARD_TEXT_(card, 2, "SBPi%04x", ipa_rc); 13661709ff8dSJulian Wiedmann QETH_CARD_TEXT_(card, 2, "SBPc%04x", sbp_rc); 1367b4d72c08SEugene Crosser } 1368b4d72c08SEugene Crosser return rc; 1369b4d72c08SEugene Crosser } 1370b4d72c08SEugene Crosser 1371d65626adSJulian Wiedmann static struct qeth_cmd_buffer *qeth_sbp_build_cmd(struct qeth_card *card, 1372d65626adSJulian Wiedmann enum qeth_ipa_sbp_cmd sbp_cmd, 1373b9150461SJulian Wiedmann unsigned int data_length) 13749c23f4daSEugene Crosser { 1375379ac99eSJulian Wiedmann enum qeth_ipa_cmds ipa_cmd = IS_IQD(card) ? IPA_CMD_SETBRIDGEPORT_IQD : 13769c23f4daSEugene Crosser IPA_CMD_SETBRIDGEPORT_OSA; 1377b9150461SJulian Wiedmann struct qeth_ipacmd_sbp_hdr *hdr; 1378d65626adSJulian Wiedmann struct qeth_cmd_buffer *iob; 1379d65626adSJulian Wiedmann 1380b9150461SJulian Wiedmann iob = qeth_ipa_alloc_cmd(card, ipa_cmd, QETH_PROT_NONE, 1381b9150461SJulian Wiedmann data_length + 1382b9150461SJulian Wiedmann offsetof(struct qeth_ipacmd_setbridgeport, 1383b9150461SJulian Wiedmann data)); 1384d65626adSJulian Wiedmann if (!iob) 1385d65626adSJulian Wiedmann return iob; 1386b9150461SJulian Wiedmann 1387b9150461SJulian Wiedmann hdr = &__ipa_cmd(iob)->data.sbp.hdr; 1388b9150461SJulian Wiedmann hdr->cmdlength = sizeof(*hdr) + data_length; 1389b9150461SJulian Wiedmann hdr->command_code = sbp_cmd; 1390b9150461SJulian Wiedmann hdr->used_total = 1; 1391b9150461SJulian Wiedmann hdr->seq_no = 1; 1392d65626adSJulian Wiedmann return iob; 13939c23f4daSEugene Crosser } 13949c23f4daSEugene Crosser 1395b4d72c08SEugene Crosser static int qeth_bridgeport_query_support_cb(struct qeth_card *card, 1396b4d72c08SEugene Crosser struct qeth_reply *reply, unsigned long data) 1397b4d72c08SEugene Crosser { 1398b4d72c08SEugene Crosser struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *) data; 1399b4d72c08SEugene Crosser struct _qeth_sbp_cbctl *cbctl = (struct _qeth_sbp_cbctl *)reply->param; 14001709ff8dSJulian Wiedmann int rc; 14011709ff8dSJulian Wiedmann 1402b4d72c08SEugene Crosser QETH_CARD_TEXT(card, 2, "brqsupcb"); 14031709ff8dSJulian Wiedmann rc = qeth_bridgeport_makerc(card, cmd); 14041709ff8dSJulian Wiedmann if (rc) 14051709ff8dSJulian Wiedmann return rc; 14061709ff8dSJulian Wiedmann 1407b4d72c08SEugene Crosser cbctl->data.supported = 1408b4d72c08SEugene Crosser cmd->data.sbp.data.query_cmds_supp.supported_cmds; 1409b4d72c08SEugene Crosser return 0; 1410b4d72c08SEugene Crosser } 1411b4d72c08SEugene Crosser 1412b4d72c08SEugene Crosser /** 1413b4d72c08SEugene Crosser * qeth_bridgeport_query_support() - store bitmask of supported subfunctions. 1414b4d72c08SEugene Crosser * @card: qeth_card structure pointer. 1415b4d72c08SEugene Crosser * 1416b4d72c08SEugene Crosser * Sets bitmask of supported setbridgeport subfunctions in the qeth_card 1417b4d72c08SEugene Crosser * strucutre: card->options.sbp.supported_funcs. 1418b4d72c08SEugene Crosser */ 1419c044dc21SEugene Crosser static void qeth_bridgeport_query_support(struct qeth_card *card) 1420b4d72c08SEugene Crosser { 1421b4d72c08SEugene Crosser struct qeth_cmd_buffer *iob; 1422b4d72c08SEugene Crosser struct _qeth_sbp_cbctl cbctl; 1423b4d72c08SEugene Crosser 1424b4d72c08SEugene Crosser QETH_CARD_TEXT(card, 2, "brqsuppo"); 1425d65626adSJulian Wiedmann iob = qeth_sbp_build_cmd(card, IPA_SBP_QUERY_COMMANDS_SUPPORTED, 1426b9150461SJulian Wiedmann SBP_DATA_SIZEOF(query_cmds_supp)); 14271aec42bcSThomas Richter if (!iob) 14281aec42bcSThomas Richter return; 14291709ff8dSJulian Wiedmann 1430b4d72c08SEugene Crosser if (qeth_send_ipa_cmd(card, iob, qeth_bridgeport_query_support_cb, 14311709ff8dSJulian Wiedmann &cbctl)) { 1432b4d72c08SEugene Crosser card->options.sbp.role = QETH_SBP_ROLE_NONE; 14331709ff8dSJulian Wiedmann card->options.sbp.supported_funcs = 0; 1434b4d72c08SEugene Crosser return; 1435b4d72c08SEugene Crosser } 1436b4d72c08SEugene Crosser card->options.sbp.supported_funcs = cbctl.data.supported; 1437b4d72c08SEugene Crosser } 1438b4d72c08SEugene Crosser 1439b4d72c08SEugene Crosser static int qeth_bridgeport_query_ports_cb(struct qeth_card *card, 1440b4d72c08SEugene Crosser struct qeth_reply *reply, unsigned long data) 1441b4d72c08SEugene Crosser { 1442b4d72c08SEugene Crosser struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *) data; 1443b4d72c08SEugene Crosser struct qeth_sbp_query_ports *qports = &cmd->data.sbp.data.query_ports; 1444b4d72c08SEugene Crosser struct _qeth_sbp_cbctl *cbctl = (struct _qeth_sbp_cbctl *)reply->param; 14451709ff8dSJulian Wiedmann int rc; 1446b4d72c08SEugene Crosser 1447b4d72c08SEugene Crosser QETH_CARD_TEXT(card, 2, "brqprtcb"); 14481709ff8dSJulian Wiedmann rc = qeth_bridgeport_makerc(card, cmd); 14491709ff8dSJulian Wiedmann if (rc) 14501709ff8dSJulian Wiedmann return rc; 14511709ff8dSJulian Wiedmann 1452b4d72c08SEugene Crosser if (qports->entry_length != sizeof(struct qeth_sbp_port_entry)) { 1453b4d72c08SEugene Crosser QETH_CARD_TEXT_(card, 2, "SBPs%04x", qports->entry_length); 14541709ff8dSJulian Wiedmann return -EINVAL; 1455b4d72c08SEugene Crosser } 1456b4d72c08SEugene Crosser /* first entry contains the state of the local port */ 1457b4d72c08SEugene Crosser if (qports->num_entries > 0) { 1458b4d72c08SEugene Crosser if (cbctl->data.qports.role) 1459b4d72c08SEugene Crosser *cbctl->data.qports.role = qports->entry[0].role; 1460b4d72c08SEugene Crosser if (cbctl->data.qports.state) 1461b4d72c08SEugene Crosser *cbctl->data.qports.state = qports->entry[0].state; 1462b4d72c08SEugene Crosser } 1463b4d72c08SEugene Crosser return 0; 1464b4d72c08SEugene Crosser } 1465b4d72c08SEugene Crosser 1466b4d72c08SEugene Crosser /** 1467b4d72c08SEugene Crosser * qeth_bridgeport_query_ports() - query local bridgeport status. 1468b4d72c08SEugene Crosser * @card: qeth_card structure pointer. 1469b4d72c08SEugene Crosser * @role: Role of the port: 0-none, 1-primary, 2-secondary. 1470b4d72c08SEugene Crosser * @state: State of the port: 0-inactive, 1-standby, 2-active. 1471b4d72c08SEugene Crosser * 1472b4d72c08SEugene Crosser * Returns negative errno-compatible error indication or 0 on success. 1473b4d72c08SEugene Crosser * 1474b4d72c08SEugene Crosser * 'role' and 'state' are not updated in case of hardware operation failure. 1475b4d72c08SEugene Crosser */ 1476b4d72c08SEugene Crosser int qeth_bridgeport_query_ports(struct qeth_card *card, 1477b4d72c08SEugene Crosser enum qeth_sbp_roles *role, enum qeth_sbp_states *state) 1478b4d72c08SEugene Crosser { 1479b4d72c08SEugene Crosser struct qeth_cmd_buffer *iob; 1480b4d72c08SEugene Crosser struct _qeth_sbp_cbctl cbctl = { 1481b4d72c08SEugene Crosser .data = { 1482b4d72c08SEugene Crosser .qports = { 1483b4d72c08SEugene Crosser .role = role, 1484b4d72c08SEugene Crosser .state = state, 1485b4d72c08SEugene Crosser }, 1486b4d72c08SEugene Crosser }, 1487b4d72c08SEugene Crosser }; 1488b4d72c08SEugene Crosser 1489b4d72c08SEugene Crosser QETH_CARD_TEXT(card, 2, "brqports"); 1490b4d72c08SEugene Crosser if (!(card->options.sbp.supported_funcs & IPA_SBP_QUERY_BRIDGE_PORTS)) 1491b4d72c08SEugene Crosser return -EOPNOTSUPP; 1492d65626adSJulian Wiedmann iob = qeth_sbp_build_cmd(card, IPA_SBP_QUERY_BRIDGE_PORTS, 0); 14931aec42bcSThomas Richter if (!iob) 14941aec42bcSThomas Richter return -ENOMEM; 14951709ff8dSJulian Wiedmann 14961709ff8dSJulian Wiedmann return qeth_send_ipa_cmd(card, iob, qeth_bridgeport_query_ports_cb, 14971709ff8dSJulian Wiedmann &cbctl); 1498b4d72c08SEugene Crosser } 1499b4d72c08SEugene Crosser 1500b4d72c08SEugene Crosser static int qeth_bridgeport_set_cb(struct qeth_card *card, 1501b4d72c08SEugene Crosser struct qeth_reply *reply, unsigned long data) 1502b4d72c08SEugene Crosser { 1503b4d72c08SEugene Crosser struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *)data; 15041709ff8dSJulian Wiedmann 1505b4d72c08SEugene Crosser QETH_CARD_TEXT(card, 2, "brsetrcb"); 15061709ff8dSJulian Wiedmann return qeth_bridgeport_makerc(card, cmd); 1507b4d72c08SEugene Crosser } 1508b4d72c08SEugene Crosser 1509b4d72c08SEugene Crosser /** 1510b4d72c08SEugene Crosser * qeth_bridgeport_setrole() - Assign primary role to the port. 1511b4d72c08SEugene Crosser * @card: qeth_card structure pointer. 1512b4d72c08SEugene Crosser * @role: Role to assign. 1513b4d72c08SEugene Crosser * 1514b4d72c08SEugene Crosser * Returns negative errno-compatible error indication or 0 on success. 1515b4d72c08SEugene Crosser */ 1516b4d72c08SEugene Crosser int qeth_bridgeport_setrole(struct qeth_card *card, enum qeth_sbp_roles role) 1517b4d72c08SEugene Crosser { 1518b4d72c08SEugene Crosser struct qeth_cmd_buffer *iob; 1519b4d72c08SEugene Crosser enum qeth_ipa_sbp_cmd setcmd; 1520b9150461SJulian Wiedmann unsigned int cmdlength = 0; 1521b4d72c08SEugene Crosser 1522b4d72c08SEugene Crosser QETH_CARD_TEXT(card, 2, "brsetrol"); 1523b4d72c08SEugene Crosser switch (role) { 1524b4d72c08SEugene Crosser case QETH_SBP_ROLE_NONE: 1525b4d72c08SEugene Crosser setcmd = IPA_SBP_RESET_BRIDGE_PORT_ROLE; 1526b4d72c08SEugene Crosser break; 1527b4d72c08SEugene Crosser case QETH_SBP_ROLE_PRIMARY: 1528b4d72c08SEugene Crosser setcmd = IPA_SBP_SET_PRIMARY_BRIDGE_PORT; 1529b9150461SJulian Wiedmann cmdlength = SBP_DATA_SIZEOF(set_primary); 1530b4d72c08SEugene Crosser break; 1531b4d72c08SEugene Crosser case QETH_SBP_ROLE_SECONDARY: 1532b4d72c08SEugene Crosser setcmd = IPA_SBP_SET_SECONDARY_BRIDGE_PORT; 1533b4d72c08SEugene Crosser break; 1534b4d72c08SEugene Crosser default: 1535b4d72c08SEugene Crosser return -EINVAL; 1536b4d72c08SEugene Crosser } 1537b4d72c08SEugene Crosser if (!(card->options.sbp.supported_funcs & setcmd)) 1538b4d72c08SEugene Crosser return -EOPNOTSUPP; 1539d65626adSJulian Wiedmann iob = qeth_sbp_build_cmd(card, setcmd, cmdlength); 15401aec42bcSThomas Richter if (!iob) 15411aec42bcSThomas Richter return -ENOMEM; 15421709ff8dSJulian Wiedmann 15431709ff8dSJulian Wiedmann return qeth_send_ipa_cmd(card, iob, qeth_bridgeport_set_cb, NULL); 1544b4d72c08SEugene Crosser } 1545b4d72c08SEugene Crosser 15469f48b9dbSEugene Crosser /** 15479f48b9dbSEugene Crosser * qeth_anset_makerc() - derive "traditional" error from hardware codes. 15489f48b9dbSEugene Crosser * @card: qeth_card structure pointer, for debug messages. 15499f48b9dbSEugene Crosser * 15509f48b9dbSEugene Crosser * Returns negative errno-compatible error indication or 0 on success. 15519f48b9dbSEugene Crosser */ 15529f48b9dbSEugene Crosser static int qeth_anset_makerc(struct qeth_card *card, int pnso_rc, u16 response) 15539f48b9dbSEugene Crosser { 15549f48b9dbSEugene Crosser int rc; 15559f48b9dbSEugene Crosser 15569f48b9dbSEugene Crosser if (pnso_rc == 0) 15579f48b9dbSEugene Crosser switch (response) { 15589f48b9dbSEugene Crosser case 0x0001: 15599f48b9dbSEugene Crosser rc = 0; 15609f48b9dbSEugene Crosser break; 15619f48b9dbSEugene Crosser case 0x0004: 15629f48b9dbSEugene Crosser case 0x0100: 15639f48b9dbSEugene Crosser case 0x0106: 1564ffb95251SEugene Crosser rc = -EOPNOTSUPP; 15659f48b9dbSEugene Crosser dev_err(&card->gdev->dev, 15669f48b9dbSEugene Crosser "Setting address notification failed\n"); 15679f48b9dbSEugene Crosser break; 15689f48b9dbSEugene Crosser case 0x0107: 15699f48b9dbSEugene Crosser rc = -EAGAIN; 15709f48b9dbSEugene Crosser break; 15719f48b9dbSEugene Crosser default: 15729f48b9dbSEugene Crosser rc = -EIO; 15739f48b9dbSEugene Crosser } 15749f48b9dbSEugene Crosser else 15759f48b9dbSEugene Crosser rc = -EIO; 15769f48b9dbSEugene Crosser 15779f48b9dbSEugene Crosser if (rc) { 15789f48b9dbSEugene Crosser QETH_CARD_TEXT_(card, 2, "SBPp%04x", pnso_rc); 15799f48b9dbSEugene Crosser QETH_CARD_TEXT_(card, 2, "SBPr%04x", response); 15809f48b9dbSEugene Crosser } 15819f48b9dbSEugene Crosser return rc; 15829f48b9dbSEugene Crosser } 15839f48b9dbSEugene Crosser 15849f48b9dbSEugene Crosser static void qeth_bridgeport_an_set_cb(void *priv, 15859f48b9dbSEugene Crosser enum qdio_brinfo_entry_type type, void *entry) 15869f48b9dbSEugene Crosser { 15879f48b9dbSEugene Crosser struct qeth_card *card = (struct qeth_card *)priv; 15889f48b9dbSEugene Crosser struct qdio_brinfo_entry_l2 *l2entry; 15899f48b9dbSEugene Crosser u8 code; 15909f48b9dbSEugene Crosser 15919f48b9dbSEugene Crosser if (type != l2_addr_lnid) { 15929f48b9dbSEugene Crosser WARN_ON_ONCE(1); 15939f48b9dbSEugene Crosser return; 15949f48b9dbSEugene Crosser } 15959f48b9dbSEugene Crosser 15969f48b9dbSEugene Crosser l2entry = (struct qdio_brinfo_entry_l2 *)entry; 15979f48b9dbSEugene Crosser code = IPA_ADDR_CHANGE_CODE_MACADDR; 159833572619SAlexandra Winter if (l2entry->addr_lnid.lnid < VLAN_N_VID) 15999f48b9dbSEugene Crosser code |= IPA_ADDR_CHANGE_CODE_VLANID; 16009f48b9dbSEugene Crosser qeth_bridge_emit_host_event(card, anev_reg_unreg, code, 16019f48b9dbSEugene Crosser (struct net_if_token *)&l2entry->nit, 16029f48b9dbSEugene Crosser (struct mac_addr_lnid *)&l2entry->addr_lnid); 16039f48b9dbSEugene Crosser } 16049f48b9dbSEugene Crosser 16059f48b9dbSEugene Crosser /** 16069f48b9dbSEugene Crosser * qeth_bridgeport_an_set() - Enable or disable bridgeport address notification 16079f48b9dbSEugene Crosser * @card: qeth_card structure pointer. 16089f48b9dbSEugene Crosser * @enable: 0 - disable, non-zero - enable notifications 16099f48b9dbSEugene Crosser * 16109f48b9dbSEugene Crosser * Returns negative errno-compatible error indication or 0 on success. 16119f48b9dbSEugene Crosser * 16129f48b9dbSEugene Crosser * On enable, emits a series of address notifications udev events for all 16139f48b9dbSEugene Crosser * currently registered hosts. 16149f48b9dbSEugene Crosser */ 16159f48b9dbSEugene Crosser int qeth_bridgeport_an_set(struct qeth_card *card, int enable) 16169f48b9dbSEugene Crosser { 16179f48b9dbSEugene Crosser int rc; 16189f48b9dbSEugene Crosser u16 response; 16199f48b9dbSEugene Crosser struct ccw_device *ddev; 16209f48b9dbSEugene Crosser struct subchannel_id schid; 16219f48b9dbSEugene Crosser 16229f48b9dbSEugene Crosser if (!card) 16239f48b9dbSEugene Crosser return -EINVAL; 16249f48b9dbSEugene Crosser if (!card->options.sbp.supported_funcs) 16259f48b9dbSEugene Crosser return -EOPNOTSUPP; 16269f48b9dbSEugene Crosser ddev = CARD_DDEV(card); 16279f48b9dbSEugene Crosser ccw_device_get_schid(ddev, &schid); 16289f48b9dbSEugene Crosser 16299f48b9dbSEugene Crosser if (enable) { 16309f48b9dbSEugene Crosser qeth_bridge_emit_host_event(card, anev_reset, 0, NULL, NULL); 16319f48b9dbSEugene Crosser rc = qdio_pnso_brinfo(schid, 1, &response, 16329f48b9dbSEugene Crosser qeth_bridgeport_an_set_cb, card); 16339f48b9dbSEugene Crosser } else 16349f48b9dbSEugene Crosser rc = qdio_pnso_brinfo(schid, 0, &response, NULL, NULL); 16359f48b9dbSEugene Crosser return qeth_anset_makerc(card, rc, response); 16369f48b9dbSEugene Crosser } 16379f48b9dbSEugene Crosser 1638caa1f0b1SHans Wippel static bool qeth_bridgeport_is_in_use(struct qeth_card *card) 1639caa1f0b1SHans Wippel { 1640caa1f0b1SHans Wippel return (card->options.sbp.role || card->options.sbp.reflect_promisc || 1641caa1f0b1SHans Wippel card->options.sbp.hostnotification); 1642caa1f0b1SHans Wippel } 1643caa1f0b1SHans Wippel 1644a45b3fafSHans Wippel /* VNIC Characteristics support */ 1645a45b3fafSHans Wippel 1646a45b3fafSHans Wippel /* handle VNICC IPA command return codes; convert to error codes */ 1647742d4d40SJulian Wiedmann static int qeth_l2_vnicc_makerc(struct qeth_card *card, u16 ipa_rc) 1648a45b3fafSHans Wippel { 1649a45b3fafSHans Wippel int rc; 1650a45b3fafSHans Wippel 1651a45b3fafSHans Wippel switch (ipa_rc) { 1652a45b3fafSHans Wippel case IPA_RC_SUCCESS: 1653a45b3fafSHans Wippel return ipa_rc; 1654a45b3fafSHans Wippel case IPA_RC_L2_UNSUPPORTED_CMD: 1655a45b3fafSHans Wippel case IPA_RC_NOTSUPP: 1656a45b3fafSHans Wippel rc = -EOPNOTSUPP; 1657a45b3fafSHans Wippel break; 1658a45b3fafSHans Wippel case IPA_RC_VNICC_OOSEQ: 1659a45b3fafSHans Wippel rc = -EALREADY; 1660a45b3fafSHans Wippel break; 1661a45b3fafSHans Wippel case IPA_RC_VNICC_VNICBP: 1662a45b3fafSHans Wippel rc = -EBUSY; 1663a45b3fafSHans Wippel break; 1664a45b3fafSHans Wippel case IPA_RC_L2_ADDR_TABLE_FULL: 1665a45b3fafSHans Wippel rc = -ENOSPC; 1666a45b3fafSHans Wippel break; 1667a45b3fafSHans Wippel case IPA_RC_L2_MAC_NOT_AUTH_BY_ADP: 1668a45b3fafSHans Wippel rc = -EACCES; 1669a45b3fafSHans Wippel break; 1670a45b3fafSHans Wippel default: 1671a45b3fafSHans Wippel rc = -EIO; 1672a45b3fafSHans Wippel } 1673a45b3fafSHans Wippel 1674a45b3fafSHans Wippel QETH_CARD_TEXT_(card, 2, "err%04x", ipa_rc); 1675a45b3fafSHans Wippel return rc; 1676a45b3fafSHans Wippel } 1677a45b3fafSHans Wippel 1678a45b3fafSHans Wippel /* generic VNICC request call back control */ 1679a45b3fafSHans Wippel struct _qeth_l2_vnicc_request_cbctl { 1680caa1f0b1SHans Wippel struct { 1681349d13d5SHans Wippel union{ 1682caa1f0b1SHans Wippel u32 *sup_cmds; 1683349d13d5SHans Wippel u32 *timeout; 1684349d13d5SHans Wippel }; 1685caa1f0b1SHans Wippel } result; 1686a45b3fafSHans Wippel }; 1687a45b3fafSHans Wippel 1688a45b3fafSHans Wippel /* generic VNICC request call back */ 1689a45b3fafSHans Wippel static int qeth_l2_vnicc_request_cb(struct qeth_card *card, 1690a45b3fafSHans Wippel struct qeth_reply *reply, 1691a45b3fafSHans Wippel unsigned long data) 1692a45b3fafSHans Wippel { 1693caa1f0b1SHans Wippel struct _qeth_l2_vnicc_request_cbctl *cbctl = 1694caa1f0b1SHans Wippel (struct _qeth_l2_vnicc_request_cbctl *) reply->param; 1695a45b3fafSHans Wippel struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *) data; 1696a45b3fafSHans Wippel struct qeth_ipacmd_vnicc *rep = &cmd->data.vnicc; 16972744d811SJulian Wiedmann u32 sub_cmd = cmd->data.vnicc.hdr.sub_command; 1698a45b3fafSHans Wippel 1699a45b3fafSHans Wippel QETH_CARD_TEXT(card, 2, "vniccrcb"); 1700a45b3fafSHans Wippel if (cmd->hdr.return_code) 1701742d4d40SJulian Wiedmann return qeth_l2_vnicc_makerc(card, cmd->hdr.return_code); 1702a45b3fafSHans Wippel /* return results to caller */ 17032cfb4810SJulian Wiedmann card->options.vnicc.sup_chars = rep->vnicc_cmds.supported; 17042cfb4810SJulian Wiedmann card->options.vnicc.cur_chars = rep->vnicc_cmds.enabled; 1705a45b3fafSHans Wippel 17062744d811SJulian Wiedmann if (sub_cmd == IPA_VNICC_QUERY_CMDS) 17072cfb4810SJulian Wiedmann *cbctl->result.sup_cmds = rep->data.query_cmds.sup_cmds; 17082744d811SJulian Wiedmann else if (sub_cmd == IPA_VNICC_GET_TIMEOUT) 17092cfb4810SJulian Wiedmann *cbctl->result.timeout = rep->data.getset_timeout.timeout; 1710349d13d5SHans Wippel 1711a45b3fafSHans Wippel return 0; 1712a45b3fafSHans Wippel } 1713a45b3fafSHans Wippel 17142cfb4810SJulian Wiedmann static struct qeth_cmd_buffer *qeth_l2_vnicc_build_cmd(struct qeth_card *card, 17152cfb4810SJulian Wiedmann u32 vnicc_cmd, 17162cfb4810SJulian Wiedmann unsigned int data_length) 1717a45b3fafSHans Wippel { 17182cfb4810SJulian Wiedmann struct qeth_ipacmd_vnicc_hdr *hdr; 1719a45b3fafSHans Wippel struct qeth_cmd_buffer *iob; 1720a45b3fafSHans Wippel 17212cfb4810SJulian Wiedmann iob = qeth_ipa_alloc_cmd(card, IPA_CMD_VNICC, QETH_PROT_NONE, 17222cfb4810SJulian Wiedmann data_length + 17232cfb4810SJulian Wiedmann offsetof(struct qeth_ipacmd_vnicc, data)); 1724a45b3fafSHans Wippel if (!iob) 17252cfb4810SJulian Wiedmann return NULL; 1726a45b3fafSHans Wippel 17272cfb4810SJulian Wiedmann hdr = &__ipa_cmd(iob)->data.vnicc.hdr; 17282cfb4810SJulian Wiedmann hdr->data_length = sizeof(*hdr) + data_length; 17292cfb4810SJulian Wiedmann hdr->sub_command = vnicc_cmd; 17302cfb4810SJulian Wiedmann return iob; 1731a45b3fafSHans Wippel } 1732a45b3fafSHans Wippel 1733a45b3fafSHans Wippel /* VNICC query VNIC characteristics request */ 1734a45b3fafSHans Wippel static int qeth_l2_vnicc_query_chars(struct qeth_card *card) 1735a45b3fafSHans Wippel { 17362cfb4810SJulian Wiedmann struct qeth_cmd_buffer *iob; 17372cfb4810SJulian Wiedmann 17382cfb4810SJulian Wiedmann QETH_CARD_TEXT(card, 2, "vniccqch"); 17392cfb4810SJulian Wiedmann iob = qeth_l2_vnicc_build_cmd(card, IPA_VNICC_QUERY_CHARS, 0); 17402cfb4810SJulian Wiedmann if (!iob) 17412cfb4810SJulian Wiedmann return -ENOMEM; 1742a45b3fafSHans Wippel 17432744d811SJulian Wiedmann return qeth_send_ipa_cmd(card, iob, qeth_l2_vnicc_request_cb, NULL); 1744a45b3fafSHans Wippel } 1745a45b3fafSHans Wippel 1746caa1f0b1SHans Wippel /* VNICC query sub commands request */ 1747caa1f0b1SHans Wippel static int qeth_l2_vnicc_query_cmds(struct qeth_card *card, u32 vnic_char, 1748caa1f0b1SHans Wippel u32 *sup_cmds) 1749caa1f0b1SHans Wippel { 1750caa1f0b1SHans Wippel struct _qeth_l2_vnicc_request_cbctl cbctl; 17512cfb4810SJulian Wiedmann struct qeth_cmd_buffer *iob; 17522cfb4810SJulian Wiedmann 17532cfb4810SJulian Wiedmann QETH_CARD_TEXT(card, 2, "vniccqcm"); 17542cfb4810SJulian Wiedmann iob = qeth_l2_vnicc_build_cmd(card, IPA_VNICC_QUERY_CMDS, 17552cfb4810SJulian Wiedmann VNICC_DATA_SIZEOF(query_cmds)); 17562cfb4810SJulian Wiedmann if (!iob) 17572cfb4810SJulian Wiedmann return -ENOMEM; 17582cfb4810SJulian Wiedmann 17592cfb4810SJulian Wiedmann __ipa_cmd(iob)->data.vnicc.data.query_cmds.vnic_char = vnic_char; 1760caa1f0b1SHans Wippel 1761caa1f0b1SHans Wippel /* prepare callback control */ 1762caa1f0b1SHans Wippel cbctl.result.sup_cmds = sup_cmds; 1763caa1f0b1SHans Wippel 17642cfb4810SJulian Wiedmann return qeth_send_ipa_cmd(card, iob, qeth_l2_vnicc_request_cb, &cbctl); 1765caa1f0b1SHans Wippel } 1766caa1f0b1SHans Wippel 1767caa1f0b1SHans Wippel /* VNICC enable/disable characteristic request */ 1768caa1f0b1SHans Wippel static int qeth_l2_vnicc_set_char(struct qeth_card *card, u32 vnic_char, 1769caa1f0b1SHans Wippel u32 cmd) 1770caa1f0b1SHans Wippel { 17712cfb4810SJulian Wiedmann struct qeth_cmd_buffer *iob; 17722cfb4810SJulian Wiedmann 17732cfb4810SJulian Wiedmann QETH_CARD_TEXT(card, 2, "vniccedc"); 17742cfb4810SJulian Wiedmann iob = qeth_l2_vnicc_build_cmd(card, cmd, VNICC_DATA_SIZEOF(set_char)); 17752cfb4810SJulian Wiedmann if (!iob) 17762cfb4810SJulian Wiedmann return -ENOMEM; 17772cfb4810SJulian Wiedmann 17782cfb4810SJulian Wiedmann __ipa_cmd(iob)->data.vnicc.data.set_char.vnic_char = vnic_char; 1779caa1f0b1SHans Wippel 17802744d811SJulian Wiedmann return qeth_send_ipa_cmd(card, iob, qeth_l2_vnicc_request_cb, NULL); 1781caa1f0b1SHans Wippel } 1782caa1f0b1SHans Wippel 1783349d13d5SHans Wippel /* VNICC get/set timeout for characteristic request */ 1784349d13d5SHans Wippel static int qeth_l2_vnicc_getset_timeout(struct qeth_card *card, u32 vnicc, 1785349d13d5SHans Wippel u32 cmd, u32 *timeout) 1786349d13d5SHans Wippel { 17872cfb4810SJulian Wiedmann struct qeth_vnicc_getset_timeout *getset_timeout; 1788349d13d5SHans Wippel struct _qeth_l2_vnicc_request_cbctl cbctl; 17892cfb4810SJulian Wiedmann struct qeth_cmd_buffer *iob; 17902cfb4810SJulian Wiedmann 17912cfb4810SJulian Wiedmann QETH_CARD_TEXT(card, 2, "vniccgst"); 17922cfb4810SJulian Wiedmann iob = qeth_l2_vnicc_build_cmd(card, cmd, 17932cfb4810SJulian Wiedmann VNICC_DATA_SIZEOF(getset_timeout)); 17942cfb4810SJulian Wiedmann if (!iob) 17952cfb4810SJulian Wiedmann return -ENOMEM; 17962cfb4810SJulian Wiedmann 17972cfb4810SJulian Wiedmann getset_timeout = &__ipa_cmd(iob)->data.vnicc.data.getset_timeout; 17982cfb4810SJulian Wiedmann getset_timeout->vnic_char = vnicc; 17992cfb4810SJulian Wiedmann 18002cfb4810SJulian Wiedmann if (cmd == IPA_VNICC_SET_TIMEOUT) 18012cfb4810SJulian Wiedmann getset_timeout->timeout = *timeout; 1802349d13d5SHans Wippel 1803349d13d5SHans Wippel /* prepare callback control */ 1804349d13d5SHans Wippel if (cmd == IPA_VNICC_GET_TIMEOUT) 1805349d13d5SHans Wippel cbctl.result.timeout = timeout; 1806349d13d5SHans Wippel 18072cfb4810SJulian Wiedmann return qeth_send_ipa_cmd(card, iob, qeth_l2_vnicc_request_cb, &cbctl); 1808349d13d5SHans Wippel } 1809349d13d5SHans Wippel 1810caa1f0b1SHans Wippel /* set current VNICC flag state; called from sysfs store function */ 1811caa1f0b1SHans Wippel int qeth_l2_vnicc_set_state(struct qeth_card *card, u32 vnicc, bool state) 1812caa1f0b1SHans Wippel { 1813caa1f0b1SHans Wippel int rc = 0; 1814caa1f0b1SHans Wippel u32 cmd; 1815caa1f0b1SHans Wippel 1816caa1f0b1SHans Wippel QETH_CARD_TEXT(card, 2, "vniccsch"); 1817caa1f0b1SHans Wippel 1818caa1f0b1SHans Wippel /* do not change anything if BridgePort is enabled */ 1819caa1f0b1SHans Wippel if (qeth_bridgeport_is_in_use(card)) 1820caa1f0b1SHans Wippel return -EBUSY; 1821caa1f0b1SHans Wippel 1822caa1f0b1SHans Wippel /* check if characteristic and enable/disable are supported */ 1823caa1f0b1SHans Wippel if (!(card->options.vnicc.sup_chars & vnicc) || 1824caa1f0b1SHans Wippel !(card->options.vnicc.set_char_sup & vnicc)) 1825caa1f0b1SHans Wippel return -EOPNOTSUPP; 1826caa1f0b1SHans Wippel 1827caa1f0b1SHans Wippel /* set enable/disable command and store wanted characteristic */ 1828caa1f0b1SHans Wippel if (state) { 1829caa1f0b1SHans Wippel cmd = IPA_VNICC_ENABLE; 1830caa1f0b1SHans Wippel card->options.vnicc.wanted_chars |= vnicc; 1831caa1f0b1SHans Wippel } else { 1832caa1f0b1SHans Wippel cmd = IPA_VNICC_DISABLE; 1833caa1f0b1SHans Wippel card->options.vnicc.wanted_chars &= ~vnicc; 1834caa1f0b1SHans Wippel } 1835caa1f0b1SHans Wippel 1836caa1f0b1SHans Wippel /* do we need to do anything? */ 1837caa1f0b1SHans Wippel if (card->options.vnicc.cur_chars == card->options.vnicc.wanted_chars) 1838caa1f0b1SHans Wippel return rc; 1839caa1f0b1SHans Wippel 1840caa1f0b1SHans Wippel /* if card is not ready, simply stop here */ 1841caa1f0b1SHans Wippel if (!qeth_card_hw_is_reachable(card)) { 1842caa1f0b1SHans Wippel if (state) 1843caa1f0b1SHans Wippel card->options.vnicc.cur_chars |= vnicc; 1844caa1f0b1SHans Wippel else 1845caa1f0b1SHans Wippel card->options.vnicc.cur_chars &= ~vnicc; 1846caa1f0b1SHans Wippel return rc; 1847caa1f0b1SHans Wippel } 1848caa1f0b1SHans Wippel 1849caa1f0b1SHans Wippel rc = qeth_l2_vnicc_set_char(card, vnicc, cmd); 1850caa1f0b1SHans Wippel if (rc) 1851caa1f0b1SHans Wippel card->options.vnicc.wanted_chars = 1852caa1f0b1SHans Wippel card->options.vnicc.cur_chars; 1853349d13d5SHans Wippel else { 1854349d13d5SHans Wippel /* successful online VNICC change; handle special cases */ 1855349d13d5SHans Wippel if (state && vnicc == QETH_VNICC_RX_BCAST) 1856caa1f0b1SHans Wippel card->options.vnicc.rx_bcast_enabled = true; 1857349d13d5SHans Wippel if (!state && vnicc == QETH_VNICC_LEARNING) 1858349d13d5SHans Wippel qeth_l2_vnicc_recover_timeout(card, vnicc, 1859349d13d5SHans Wippel &card->options.vnicc.learning_timeout); 1860349d13d5SHans Wippel } 1861caa1f0b1SHans Wippel 1862caa1f0b1SHans Wippel return rc; 1863caa1f0b1SHans Wippel } 1864caa1f0b1SHans Wippel 1865caa1f0b1SHans Wippel /* get current VNICC flag state; called from sysfs show function */ 1866caa1f0b1SHans Wippel int qeth_l2_vnicc_get_state(struct qeth_card *card, u32 vnicc, bool *state) 1867caa1f0b1SHans Wippel { 1868caa1f0b1SHans Wippel int rc = 0; 1869caa1f0b1SHans Wippel 1870caa1f0b1SHans Wippel QETH_CARD_TEXT(card, 2, "vniccgch"); 1871caa1f0b1SHans Wippel 1872caa1f0b1SHans Wippel /* do not get anything if BridgePort is enabled */ 1873caa1f0b1SHans Wippel if (qeth_bridgeport_is_in_use(card)) 1874caa1f0b1SHans Wippel return -EBUSY; 1875caa1f0b1SHans Wippel 1876caa1f0b1SHans Wippel /* check if characteristic is supported */ 1877caa1f0b1SHans Wippel if (!(card->options.vnicc.sup_chars & vnicc)) 1878caa1f0b1SHans Wippel return -EOPNOTSUPP; 1879caa1f0b1SHans Wippel 1880caa1f0b1SHans Wippel /* if card is ready, query current VNICC state */ 1881caa1f0b1SHans Wippel if (qeth_card_hw_is_reachable(card)) 1882caa1f0b1SHans Wippel rc = qeth_l2_vnicc_query_chars(card); 1883caa1f0b1SHans Wippel 1884caa1f0b1SHans Wippel *state = (card->options.vnicc.cur_chars & vnicc) ? true : false; 1885caa1f0b1SHans Wippel return rc; 1886caa1f0b1SHans Wippel } 1887caa1f0b1SHans Wippel 1888349d13d5SHans Wippel /* set VNICC timeout; called from sysfs store function. Currently, only learning 1889349d13d5SHans Wippel * supports timeout 1890349d13d5SHans Wippel */ 1891349d13d5SHans Wippel int qeth_l2_vnicc_set_timeout(struct qeth_card *card, u32 timeout) 1892349d13d5SHans Wippel { 1893349d13d5SHans Wippel int rc = 0; 1894349d13d5SHans Wippel 1895349d13d5SHans Wippel QETH_CARD_TEXT(card, 2, "vniccsto"); 1896349d13d5SHans Wippel 1897349d13d5SHans Wippel /* do not change anything if BridgePort is enabled */ 1898349d13d5SHans Wippel if (qeth_bridgeport_is_in_use(card)) 1899349d13d5SHans Wippel return -EBUSY; 1900349d13d5SHans Wippel 1901349d13d5SHans Wippel /* check if characteristic and set_timeout are supported */ 1902349d13d5SHans Wippel if (!(card->options.vnicc.sup_chars & QETH_VNICC_LEARNING) || 1903349d13d5SHans Wippel !(card->options.vnicc.getset_timeout_sup & QETH_VNICC_LEARNING)) 1904349d13d5SHans Wippel return -EOPNOTSUPP; 1905349d13d5SHans Wippel 1906349d13d5SHans Wippel /* do we need to do anything? */ 1907349d13d5SHans Wippel if (card->options.vnicc.learning_timeout == timeout) 1908349d13d5SHans Wippel return rc; 1909349d13d5SHans Wippel 1910349d13d5SHans Wippel /* if card is not ready, simply store the value internally and return */ 1911349d13d5SHans Wippel if (!qeth_card_hw_is_reachable(card)) { 1912349d13d5SHans Wippel card->options.vnicc.learning_timeout = timeout; 1913349d13d5SHans Wippel return rc; 1914349d13d5SHans Wippel } 1915349d13d5SHans Wippel 1916349d13d5SHans Wippel /* send timeout value to card; if successful, store value internally */ 1917349d13d5SHans Wippel rc = qeth_l2_vnicc_getset_timeout(card, QETH_VNICC_LEARNING, 1918349d13d5SHans Wippel IPA_VNICC_SET_TIMEOUT, &timeout); 1919349d13d5SHans Wippel if (!rc) 1920349d13d5SHans Wippel card->options.vnicc.learning_timeout = timeout; 1921349d13d5SHans Wippel 1922349d13d5SHans Wippel return rc; 1923349d13d5SHans Wippel } 1924349d13d5SHans Wippel 1925349d13d5SHans Wippel /* get current VNICC timeout; called from sysfs show function. Currently, only 1926349d13d5SHans Wippel * learning supports timeout 1927349d13d5SHans Wippel */ 1928349d13d5SHans Wippel int qeth_l2_vnicc_get_timeout(struct qeth_card *card, u32 *timeout) 1929349d13d5SHans Wippel { 1930349d13d5SHans Wippel int rc = 0; 1931349d13d5SHans Wippel 1932349d13d5SHans Wippel QETH_CARD_TEXT(card, 2, "vniccgto"); 1933349d13d5SHans Wippel 1934349d13d5SHans Wippel /* do not get anything if BridgePort is enabled */ 1935349d13d5SHans Wippel if (qeth_bridgeport_is_in_use(card)) 1936349d13d5SHans Wippel return -EBUSY; 1937349d13d5SHans Wippel 1938349d13d5SHans Wippel /* check if characteristic and get_timeout are supported */ 1939349d13d5SHans Wippel if (!(card->options.vnicc.sup_chars & QETH_VNICC_LEARNING) || 1940349d13d5SHans Wippel !(card->options.vnicc.getset_timeout_sup & QETH_VNICC_LEARNING)) 1941349d13d5SHans Wippel return -EOPNOTSUPP; 1942349d13d5SHans Wippel /* if card is ready, get timeout. Otherwise, just return stored value */ 1943349d13d5SHans Wippel *timeout = card->options.vnicc.learning_timeout; 1944349d13d5SHans Wippel if (qeth_card_hw_is_reachable(card)) 1945349d13d5SHans Wippel rc = qeth_l2_vnicc_getset_timeout(card, QETH_VNICC_LEARNING, 1946349d13d5SHans Wippel IPA_VNICC_GET_TIMEOUT, 1947349d13d5SHans Wippel timeout); 1948349d13d5SHans Wippel 1949349d13d5SHans Wippel return rc; 1950349d13d5SHans Wippel } 1951349d13d5SHans Wippel 1952caa1f0b1SHans Wippel /* check if VNICC is currently enabled */ 1953caa1f0b1SHans Wippel bool qeth_l2_vnicc_is_in_use(struct qeth_card *card) 1954caa1f0b1SHans Wippel { 1955caa1f0b1SHans Wippel /* if everything is turned off, VNICC is not active */ 1956caa1f0b1SHans Wippel if (!card->options.vnicc.cur_chars) 1957caa1f0b1SHans Wippel return false; 1958caa1f0b1SHans Wippel /* default values are only OK if rx_bcast was not enabled by user 1959caa1f0b1SHans Wippel * or the card is offline. 1960caa1f0b1SHans Wippel */ 1961caa1f0b1SHans Wippel if (card->options.vnicc.cur_chars == QETH_VNICC_DEFAULT) { 1962caa1f0b1SHans Wippel if (!card->options.vnicc.rx_bcast_enabled || 1963caa1f0b1SHans Wippel !qeth_card_hw_is_reachable(card)) 1964caa1f0b1SHans Wippel return false; 1965caa1f0b1SHans Wippel } 1966caa1f0b1SHans Wippel return true; 1967caa1f0b1SHans Wippel } 1968caa1f0b1SHans Wippel 1969349d13d5SHans Wippel /* recover user timeout setting */ 1970349d13d5SHans Wippel static bool qeth_l2_vnicc_recover_timeout(struct qeth_card *card, u32 vnicc, 1971349d13d5SHans Wippel u32 *timeout) 1972349d13d5SHans Wippel { 1973349d13d5SHans Wippel if (card->options.vnicc.sup_chars & vnicc && 1974349d13d5SHans Wippel card->options.vnicc.getset_timeout_sup & vnicc && 1975349d13d5SHans Wippel !qeth_l2_vnicc_getset_timeout(card, vnicc, IPA_VNICC_SET_TIMEOUT, 1976349d13d5SHans Wippel timeout)) 1977349d13d5SHans Wippel return false; 1978349d13d5SHans Wippel *timeout = QETH_VNICC_DEFAULT_TIMEOUT; 1979349d13d5SHans Wippel return true; 1980349d13d5SHans Wippel } 1981349d13d5SHans Wippel 1982caa1f0b1SHans Wippel /* recover user characteristic setting */ 1983caa1f0b1SHans Wippel static bool qeth_l2_vnicc_recover_char(struct qeth_card *card, u32 vnicc, 1984caa1f0b1SHans Wippel bool enable) 1985caa1f0b1SHans Wippel { 1986caa1f0b1SHans Wippel u32 cmd = enable ? IPA_VNICC_ENABLE : IPA_VNICC_DISABLE; 1987caa1f0b1SHans Wippel 1988caa1f0b1SHans Wippel if (card->options.vnicc.sup_chars & vnicc && 1989caa1f0b1SHans Wippel card->options.vnicc.set_char_sup & vnicc && 1990caa1f0b1SHans Wippel !qeth_l2_vnicc_set_char(card, vnicc, cmd)) 1991caa1f0b1SHans Wippel return false; 1992caa1f0b1SHans Wippel card->options.vnicc.wanted_chars &= ~vnicc; 1993caa1f0b1SHans Wippel card->options.vnicc.wanted_chars |= QETH_VNICC_DEFAULT & vnicc; 1994caa1f0b1SHans Wippel return true; 1995caa1f0b1SHans Wippel } 1996caa1f0b1SHans Wippel 1997a45b3fafSHans Wippel /* (re-)initialize VNICC */ 1998a45b3fafSHans Wippel static void qeth_l2_vnicc_init(struct qeth_card *card) 1999a45b3fafSHans Wippel { 2000349d13d5SHans Wippel u32 *timeout = &card->options.vnicc.learning_timeout; 2001b528965bSAlexandra Winter bool enable, error = false; 2002caa1f0b1SHans Wippel unsigned int chars_len, i; 2003caa1f0b1SHans Wippel unsigned long chars_tmp; 2004caa1f0b1SHans Wippel u32 sup_cmds, vnicc; 2005caa1f0b1SHans Wippel 2006a45b3fafSHans Wippel QETH_CARD_TEXT(card, 2, "vniccini"); 2007caa1f0b1SHans Wippel /* reset rx_bcast */ 2008caa1f0b1SHans Wippel card->options.vnicc.rx_bcast_enabled = 0; 2009a45b3fafSHans Wippel /* initial query and storage of VNIC characteristics */ 2010a45b3fafSHans Wippel if (qeth_l2_vnicc_query_chars(card)) { 2011349d13d5SHans Wippel if (card->options.vnicc.wanted_chars != QETH_VNICC_DEFAULT || 2012349d13d5SHans Wippel *timeout != QETH_VNICC_DEFAULT_TIMEOUT) 2013caa1f0b1SHans Wippel dev_err(&card->gdev->dev, "Configuring the VNIC characteristics failed\n"); 2014caa1f0b1SHans Wippel /* fail quietly if user didn't change the default config */ 2015a45b3fafSHans Wippel card->options.vnicc.sup_chars = 0; 2016a45b3fafSHans Wippel card->options.vnicc.cur_chars = 0; 2017caa1f0b1SHans Wippel card->options.vnicc.wanted_chars = QETH_VNICC_DEFAULT; 2018caa1f0b1SHans Wippel return; 2019a45b3fafSHans Wippel } 2020caa1f0b1SHans Wippel /* get supported commands for each supported characteristic */ 2021caa1f0b1SHans Wippel chars_tmp = card->options.vnicc.sup_chars; 2022caa1f0b1SHans Wippel chars_len = sizeof(card->options.vnicc.sup_chars) * BITS_PER_BYTE; 2023caa1f0b1SHans Wippel for_each_set_bit(i, &chars_tmp, chars_len) { 2024caa1f0b1SHans Wippel vnicc = BIT(i); 2025b528965bSAlexandra Winter if (qeth_l2_vnicc_query_cmds(card, vnicc, &sup_cmds)) { 2026b528965bSAlexandra Winter sup_cmds = 0; 2027b528965bSAlexandra Winter error = true; 2028b528965bSAlexandra Winter } 2029be40a86cSAlexandra Winter if ((sup_cmds & IPA_VNICC_SET_TIMEOUT) && 2030be40a86cSAlexandra Winter (sup_cmds & IPA_VNICC_GET_TIMEOUT)) 2031be40a86cSAlexandra Winter card->options.vnicc.getset_timeout_sup |= vnicc; 2032be40a86cSAlexandra Winter else 2033349d13d5SHans Wippel card->options.vnicc.getset_timeout_sup &= ~vnicc; 2034be40a86cSAlexandra Winter if ((sup_cmds & IPA_VNICC_ENABLE) && 2035be40a86cSAlexandra Winter (sup_cmds & IPA_VNICC_DISABLE)) 2036be40a86cSAlexandra Winter card->options.vnicc.set_char_sup |= vnicc; 2037be40a86cSAlexandra Winter else 2038caa1f0b1SHans Wippel card->options.vnicc.set_char_sup &= ~vnicc; 2039caa1f0b1SHans Wippel } 2040caa1f0b1SHans Wippel /* enforce assumed default values and recover settings, if changed */ 2041b528965bSAlexandra Winter error |= qeth_l2_vnicc_recover_timeout(card, QETH_VNICC_LEARNING, 2042349d13d5SHans Wippel timeout); 2043caa1f0b1SHans Wippel chars_tmp = card->options.vnicc.wanted_chars ^ QETH_VNICC_DEFAULT; 2044caa1f0b1SHans Wippel chars_tmp |= QETH_VNICC_BRIDGE_INVISIBLE; 2045caa1f0b1SHans Wippel chars_len = sizeof(card->options.vnicc.wanted_chars) * BITS_PER_BYTE; 2046caa1f0b1SHans Wippel for_each_set_bit(i, &chars_tmp, chars_len) { 2047caa1f0b1SHans Wippel vnicc = BIT(i); 2048caa1f0b1SHans Wippel enable = card->options.vnicc.wanted_chars & vnicc; 2049caa1f0b1SHans Wippel error |= qeth_l2_vnicc_recover_char(card, vnicc, enable); 2050caa1f0b1SHans Wippel } 2051caa1f0b1SHans Wippel if (error) 2052caa1f0b1SHans Wippel dev_err(&card->gdev->dev, "Configuring the VNIC characteristics failed\n"); 2053caa1f0b1SHans Wippel } 2054caa1f0b1SHans Wippel 2055caa1f0b1SHans Wippel /* configure default values of VNIC characteristics */ 2056caa1f0b1SHans Wippel static void qeth_l2_vnicc_set_defaults(struct qeth_card *card) 2057caa1f0b1SHans Wippel { 2058caa1f0b1SHans Wippel /* characteristics values */ 2059caa1f0b1SHans Wippel card->options.vnicc.sup_chars = QETH_VNICC_ALL; 2060caa1f0b1SHans Wippel card->options.vnicc.cur_chars = QETH_VNICC_DEFAULT; 2061349d13d5SHans Wippel card->options.vnicc.learning_timeout = QETH_VNICC_DEFAULT_TIMEOUT; 2062caa1f0b1SHans Wippel /* supported commands */ 2063caa1f0b1SHans Wippel card->options.vnicc.set_char_sup = QETH_VNICC_ALL; 2064349d13d5SHans Wippel card->options.vnicc.getset_timeout_sup = QETH_VNICC_LEARNING; 2065caa1f0b1SHans Wippel /* settings wanted by users */ 2066caa1f0b1SHans Wippel card->options.vnicc.wanted_chars = QETH_VNICC_DEFAULT; 2067a45b3fafSHans Wippel } 2068a45b3fafSHans Wippel 20694a71df50SFrank Blaschka module_init(qeth_l2_init); 20704a71df50SFrank Blaschka module_exit(qeth_l2_exit); 20714a71df50SFrank Blaschka MODULE_AUTHOR("Frank Blaschka <frank.blaschka@de.ibm.com>"); 20724a71df50SFrank Blaschka MODULE_DESCRIPTION("qeth layer 2 discipline"); 20734a71df50SFrank Blaschka MODULE_LICENSE("GPL"); 2074