14a71df50SFrank Blaschka /* 2bbcfcdc8SFrank Blaschka * Copyright IBM Corp. 2007, 2009 34a71df50SFrank Blaschka * Author(s): Utz Bacher <utz.bacher@de.ibm.com>, 44a71df50SFrank Blaschka * Frank Pavlic <fpavlic@de.ibm.com>, 54a71df50SFrank Blaschka * Thomas Spatzier <tspat@de.ibm.com>, 64a71df50SFrank Blaschka * Frank Blaschka <frank.blaschka@de.ibm.com> 74a71df50SFrank Blaschka */ 84a71df50SFrank Blaschka 974eacdb9SFrank Blaschka #define KMSG_COMPONENT "qeth" 1074eacdb9SFrank Blaschka #define pr_fmt(fmt) KMSG_COMPONENT ": " fmt 1174eacdb9SFrank Blaschka 124a71df50SFrank Blaschka #include <linux/module.h> 134a71df50SFrank Blaschka #include <linux/moduleparam.h> 144a71df50SFrank Blaschka #include <linux/string.h> 154a71df50SFrank Blaschka #include <linux/errno.h> 164a71df50SFrank Blaschka #include <linux/kernel.h> 175a0e3ad6STejun Heo #include <linux/slab.h> 184a71df50SFrank Blaschka #include <linux/etherdevice.h> 194a71df50SFrank Blaschka #include <linux/ip.h> 20ccffad25SJiri Pirko #include <linux/list.h> 21fe5c8028SLakhvich Dmitriy #include <linux/hash.h> 22fe5c8028SLakhvich Dmitriy #include <linux/hashtable.h> 23fe5c8028SLakhvich Dmitriy #include <linux/string.h> 24ec61bd2fSJulian Wiedmann #include <asm/setup.h> 254a71df50SFrank Blaschka #include "qeth_core.h" 26b4d72c08SEugene Crosser #include "qeth_l2.h" 274a71df50SFrank Blaschka 284a71df50SFrank Blaschka static int qeth_l2_set_offline(struct ccwgroup_device *); 294a71df50SFrank Blaschka static int qeth_l2_stop(struct net_device *); 30fe5c8028SLakhvich Dmitriy static void qeth_l2_set_rx_mode(struct net_device *); 31c044dc21SEugene Crosser static void qeth_bridgeport_query_support(struct qeth_card *card); 32c044dc21SEugene Crosser static void qeth_bridge_state_change(struct qeth_card *card, 33c044dc21SEugene Crosser struct qeth_ipa_cmd *cmd); 34c044dc21SEugene Crosser static void qeth_bridge_host_event(struct qeth_card *card, 35c044dc21SEugene Crosser struct qeth_ipa_cmd *cmd); 36caa1f0b1SHans Wippel static void qeth_l2_vnicc_set_defaults(struct qeth_card *card); 37a45b3fafSHans Wippel static void qeth_l2_vnicc_init(struct qeth_card *card); 38349d13d5SHans Wippel static bool qeth_l2_vnicc_recover_timeout(struct qeth_card *card, u32 vnicc, 39349d13d5SHans Wippel u32 *timeout); 404a71df50SFrank Blaschka 414a71df50SFrank Blaschka static int qeth_l2_verify_dev(struct net_device *dev) 424a71df50SFrank Blaschka { 434a71df50SFrank Blaschka struct qeth_card *card; 444a71df50SFrank Blaschka unsigned long flags; 454a71df50SFrank Blaschka int rc = 0; 464a71df50SFrank Blaschka 474a71df50SFrank Blaschka read_lock_irqsave(&qeth_core_card_list.rwlock, flags); 484a71df50SFrank Blaschka list_for_each_entry(card, &qeth_core_card_list.list, list) { 494a71df50SFrank Blaschka if (card->dev == dev) { 504a71df50SFrank Blaschka rc = QETH_REAL_CARD; 514a71df50SFrank Blaschka break; 524a71df50SFrank Blaschka } 534a71df50SFrank Blaschka } 544a71df50SFrank Blaschka read_unlock_irqrestore(&qeth_core_card_list.rwlock, flags); 554a71df50SFrank Blaschka 564a71df50SFrank Blaschka return rc; 574a71df50SFrank Blaschka } 584a71df50SFrank Blaschka 594a71df50SFrank Blaschka static struct net_device *qeth_l2_netdev_by_devno(unsigned char *read_dev_no) 604a71df50SFrank Blaschka { 614a71df50SFrank Blaschka struct qeth_card *card; 624a71df50SFrank Blaschka struct net_device *ndev; 63f06f6f32SCornelia Huck __u16 temp_dev_no; 644a71df50SFrank Blaschka unsigned long flags; 65f06f6f32SCornelia Huck struct ccw_dev_id read_devid; 664a71df50SFrank Blaschka 674a71df50SFrank Blaschka ndev = NULL; 684a71df50SFrank Blaschka memcpy(&temp_dev_no, read_dev_no, 2); 694a71df50SFrank Blaschka read_lock_irqsave(&qeth_core_card_list.rwlock, flags); 704a71df50SFrank Blaschka list_for_each_entry(card, &qeth_core_card_list.list, list) { 71f06f6f32SCornelia Huck ccw_device_get_id(CARD_RDEV(card), &read_devid); 72f06f6f32SCornelia Huck if (read_devid.devno == temp_dev_no) { 734a71df50SFrank Blaschka ndev = card->dev; 744a71df50SFrank Blaschka break; 754a71df50SFrank Blaschka } 764a71df50SFrank Blaschka } 774a71df50SFrank Blaschka read_unlock_irqrestore(&qeth_core_card_list.rwlock, flags); 784a71df50SFrank Blaschka return ndev; 794a71df50SFrank Blaschka } 804a71df50SFrank Blaschka 812aa48671SJulian Wiedmann static int qeth_setdelmac_makerc(struct qeth_card *card, int retcode) 824a71df50SFrank Blaschka { 83efbbc1d5SEugene Crosser int rc; 844a71df50SFrank Blaschka 85efbbc1d5SEugene Crosser if (retcode) 861aec42bcSThomas Richter QETH_CARD_TEXT_(card, 2, "err%04x", retcode); 87efbbc1d5SEugene Crosser switch (retcode) { 88efbbc1d5SEugene Crosser case IPA_RC_SUCCESS: 89efbbc1d5SEugene Crosser rc = 0; 90efbbc1d5SEugene Crosser break; 91efbbc1d5SEugene Crosser case IPA_RC_L2_UNSUPPORTED_CMD: 92ffb95251SEugene Crosser rc = -EOPNOTSUPP; 93efbbc1d5SEugene Crosser break; 94efbbc1d5SEugene Crosser case IPA_RC_L2_ADDR_TABLE_FULL: 95efbbc1d5SEugene Crosser rc = -ENOSPC; 96efbbc1d5SEugene Crosser break; 97efbbc1d5SEugene Crosser case IPA_RC_L2_DUP_MAC: 98efbbc1d5SEugene Crosser case IPA_RC_L2_DUP_LAYER3_MAC: 99efbbc1d5SEugene Crosser rc = -EEXIST; 100efbbc1d5SEugene Crosser break; 101efbbc1d5SEugene Crosser case IPA_RC_L2_MAC_NOT_AUTH_BY_HYP: 102efbbc1d5SEugene Crosser case IPA_RC_L2_MAC_NOT_AUTH_BY_ADP: 103efbbc1d5SEugene Crosser rc = -EPERM; 104efbbc1d5SEugene Crosser break; 105efbbc1d5SEugene Crosser case IPA_RC_L2_MAC_NOT_FOUND: 106efbbc1d5SEugene Crosser rc = -ENOENT; 107efbbc1d5SEugene Crosser break; 1081aec42bcSThomas Richter case -ENOMEM: 1091aec42bcSThomas Richter rc = -ENOMEM; 1101aec42bcSThomas Richter break; 111efbbc1d5SEugene Crosser default: 112efbbc1d5SEugene Crosser rc = -EIO; 113efbbc1d5SEugene Crosser break; 1144a71df50SFrank Blaschka } 115efbbc1d5SEugene Crosser return rc; 1164a71df50SFrank Blaschka } 1174a71df50SFrank Blaschka 118ac988d78SJulian Wiedmann static int qeth_l2_send_setdelmac(struct qeth_card *card, __u8 *mac, 119ac988d78SJulian Wiedmann enum qeth_ipa_cmds ipacmd) 120ac988d78SJulian Wiedmann { 121ac988d78SJulian Wiedmann struct qeth_ipa_cmd *cmd; 122ac988d78SJulian Wiedmann struct qeth_cmd_buffer *iob; 123ac988d78SJulian Wiedmann 124ac988d78SJulian Wiedmann QETH_CARD_TEXT(card, 2, "L2sdmac"); 125ac988d78SJulian Wiedmann iob = qeth_get_ipacmd_buffer(card, ipacmd, QETH_PROT_IPV4); 126ac988d78SJulian Wiedmann if (!iob) 127ac988d78SJulian Wiedmann return -ENOMEM; 128ac988d78SJulian Wiedmann cmd = (struct qeth_ipa_cmd *)(iob->data+IPA_PDU_HEADER_SIZE); 129ac988d78SJulian Wiedmann cmd->data.setdelmac.mac_length = OSA_ADDR_LEN; 130ac988d78SJulian Wiedmann memcpy(&cmd->data.setdelmac.mac, mac, OSA_ADDR_LEN); 1312aa48671SJulian Wiedmann return qeth_setdelmac_makerc(card, qeth_send_ipa_cmd(card, iob, 132ac988d78SJulian Wiedmann NULL, NULL)); 133ac988d78SJulian Wiedmann } 134ac988d78SJulian Wiedmann 135ac988d78SJulian Wiedmann static int qeth_l2_send_setmac(struct qeth_card *card, __u8 *mac) 136ac988d78SJulian Wiedmann { 137ac988d78SJulian Wiedmann int rc; 138ac988d78SJulian Wiedmann 139ac988d78SJulian Wiedmann QETH_CARD_TEXT(card, 2, "L2Setmac"); 140ac988d78SJulian Wiedmann rc = qeth_l2_send_setdelmac(card, mac, IPA_CMD_SETVMAC); 141ac988d78SJulian Wiedmann if (rc == 0) { 142ac988d78SJulian Wiedmann card->info.mac_bits |= QETH_LAYER2_MAC_REGISTERED; 143ac988d78SJulian Wiedmann memcpy(card->dev->dev_addr, mac, OSA_ADDR_LEN); 144ac988d78SJulian Wiedmann dev_info(&card->gdev->dev, 145ac988d78SJulian Wiedmann "MAC address %pM successfully registered on device %s\n", 146ac988d78SJulian Wiedmann card->dev->dev_addr, card->dev->name); 147ac988d78SJulian Wiedmann } else { 148ac988d78SJulian Wiedmann card->info.mac_bits &= ~QETH_LAYER2_MAC_REGISTERED; 149ac988d78SJulian Wiedmann switch (rc) { 150ac988d78SJulian Wiedmann case -EEXIST: 151ac988d78SJulian Wiedmann dev_warn(&card->gdev->dev, 152ac988d78SJulian Wiedmann "MAC address %pM already exists\n", mac); 153ac988d78SJulian Wiedmann break; 154ac988d78SJulian Wiedmann case -EPERM: 155ac988d78SJulian Wiedmann dev_warn(&card->gdev->dev, 156ac988d78SJulian Wiedmann "MAC address %pM is not authorized\n", mac); 157ac988d78SJulian Wiedmann break; 158ac988d78SJulian Wiedmann } 159ac988d78SJulian Wiedmann } 160ac988d78SJulian Wiedmann return rc; 161ac988d78SJulian Wiedmann } 162ac988d78SJulian Wiedmann 163ac988d78SJulian Wiedmann static int qeth_l2_send_delmac(struct qeth_card *card, __u8 *mac) 164ac988d78SJulian Wiedmann { 165ac988d78SJulian Wiedmann int rc; 166ac988d78SJulian Wiedmann 167ac988d78SJulian Wiedmann QETH_CARD_TEXT(card, 2, "L2Delmac"); 168ac988d78SJulian Wiedmann if (!(card->info.mac_bits & QETH_LAYER2_MAC_REGISTERED)) 169ac988d78SJulian Wiedmann return 0; 170ac988d78SJulian Wiedmann rc = qeth_l2_send_setdelmac(card, mac, IPA_CMD_DELVMAC); 171ac988d78SJulian Wiedmann if (rc == 0) 172ac988d78SJulian Wiedmann card->info.mac_bits &= ~QETH_LAYER2_MAC_REGISTERED; 173ac988d78SJulian Wiedmann return rc; 174ac988d78SJulian Wiedmann } 175ac988d78SJulian Wiedmann 1764a71df50SFrank Blaschka static int qeth_l2_send_setgroupmac(struct qeth_card *card, __u8 *mac) 1774a71df50SFrank Blaschka { 178efbbc1d5SEugene Crosser int rc; 179efbbc1d5SEugene Crosser 180847a50fdSCarsten Otte QETH_CARD_TEXT(card, 2, "L2Sgmac"); 181754e0b8dSJulian Wiedmann rc = qeth_l2_send_setdelmac(card, mac, IPA_CMD_SETGMAC); 182efbbc1d5SEugene Crosser if (rc == -EEXIST) 183efbbc1d5SEugene Crosser QETH_DBF_MESSAGE(2, "Group MAC %pM already existing on %s\n", 184efbbc1d5SEugene Crosser mac, QETH_CARD_IFNAME(card)); 185efbbc1d5SEugene Crosser else if (rc) 186efbbc1d5SEugene Crosser QETH_DBF_MESSAGE(2, "Could not set group MAC %pM on %s: %d\n", 187efbbc1d5SEugene Crosser mac, QETH_CARD_IFNAME(card), rc); 188efbbc1d5SEugene Crosser return rc; 1894a71df50SFrank Blaschka } 1904a71df50SFrank Blaschka 1914a71df50SFrank Blaschka static int qeth_l2_send_delgroupmac(struct qeth_card *card, __u8 *mac) 1924a71df50SFrank Blaschka { 193efbbc1d5SEugene Crosser int rc; 194efbbc1d5SEugene Crosser 195847a50fdSCarsten Otte QETH_CARD_TEXT(card, 2, "L2Dgmac"); 196754e0b8dSJulian Wiedmann rc = qeth_l2_send_setdelmac(card, mac, IPA_CMD_DELGMAC); 197efbbc1d5SEugene Crosser if (rc) 198efbbc1d5SEugene Crosser QETH_DBF_MESSAGE(2, 199efbbc1d5SEugene Crosser "Could not delete group MAC %pM on %s: %d\n", 200efbbc1d5SEugene Crosser mac, QETH_CARD_IFNAME(card), rc); 201efbbc1d5SEugene Crosser return rc; 2024a71df50SFrank Blaschka } 2034a71df50SFrank Blaschka 204fe5c8028SLakhvich Dmitriy static int qeth_l2_write_mac(struct qeth_card *card, struct qeth_mac *mac) 205fe5c8028SLakhvich Dmitriy { 206fe5c8028SLakhvich Dmitriy if (mac->is_uc) { 207979d7929SJulian Wiedmann return qeth_l2_send_setdelmac(card, mac->mac_addr, 208754e0b8dSJulian Wiedmann IPA_CMD_SETVMAC); 2097db2266aSFrank Blaschka } else { 210979d7929SJulian Wiedmann return qeth_l2_send_setgroupmac(card, mac->mac_addr); 211fe5c8028SLakhvich Dmitriy } 212979d7929SJulian Wiedmann } 213979d7929SJulian Wiedmann 214979d7929SJulian Wiedmann static int qeth_l2_remove_mac(struct qeth_card *card, struct qeth_mac *mac) 215979d7929SJulian Wiedmann { 216979d7929SJulian Wiedmann if (mac->is_uc) { 217979d7929SJulian Wiedmann return qeth_l2_send_setdelmac(card, mac->mac_addr, 218979d7929SJulian Wiedmann IPA_CMD_DELVMAC); 219979d7929SJulian Wiedmann } else { 220979d7929SJulian Wiedmann return qeth_l2_send_delgroupmac(card, mac->mac_addr); 221979d7929SJulian Wiedmann } 2227db2266aSFrank Blaschka } 2237db2266aSFrank Blaschka 224c07cbf2eSJulian Wiedmann static void qeth_l2_del_all_macs(struct qeth_card *card) 2254a71df50SFrank Blaschka { 226fe5c8028SLakhvich Dmitriy struct qeth_mac *mac; 227fe5c8028SLakhvich Dmitriy struct hlist_node *tmp; 228fe5c8028SLakhvich Dmitriy int i; 2294a71df50SFrank Blaschka 2304a71df50SFrank Blaschka spin_lock_bh(&card->mclock); 231fe5c8028SLakhvich Dmitriy hash_for_each_safe(card->mac_htable, i, tmp, mac, hnode) { 232fe5c8028SLakhvich Dmitriy hash_del(&mac->hnode); 233fe5c8028SLakhvich Dmitriy kfree(mac); 2344a71df50SFrank Blaschka } 2354a71df50SFrank Blaschka spin_unlock_bh(&card->mclock); 2364a71df50SFrank Blaschka } 2374a71df50SFrank Blaschka 238cef6ff22SJulian Wiedmann static int qeth_l2_get_cast_type(struct qeth_card *card, struct sk_buff *skb) 2394a71df50SFrank Blaschka { 240ce73e10eSKlaus-Dieter Wacker if (card->info.type == QETH_CARD_TYPE_OSN) 241ce73e10eSKlaus-Dieter Wacker return RTN_UNSPEC; 242ce73e10eSKlaus-Dieter Wacker if (is_broadcast_ether_addr(skb->data)) 243ce73e10eSKlaus-Dieter Wacker return RTN_BROADCAST; 244ce73e10eSKlaus-Dieter Wacker if (is_multicast_ether_addr(skb->data)) 245ce73e10eSKlaus-Dieter Wacker return RTN_MULTICAST; 246ce73e10eSKlaus-Dieter Wacker return RTN_UNSPEC; 2474a71df50SFrank Blaschka } 2484a71df50SFrank Blaschka 249cef6ff22SJulian Wiedmann static void qeth_l2_hdr_csum(struct qeth_card *card, struct qeth_hdr *hdr, 250cef6ff22SJulian Wiedmann struct sk_buff *skb) 2514d7def2aSThomas Richter { 2524d7def2aSThomas Richter struct iphdr *iph = ip_hdr(skb); 2534d7def2aSThomas Richter 2544d7def2aSThomas Richter /* tcph->check contains already the pseudo hdr checksum 2554d7def2aSThomas Richter * so just set the header flags 2564d7def2aSThomas Richter */ 2574d7def2aSThomas Richter if (iph->protocol == IPPROTO_UDP) 2584d7def2aSThomas Richter hdr->hdr.l2.flags[1] |= QETH_HDR_EXT_UDP; 2594d7def2aSThomas Richter hdr->hdr.l2.flags[1] |= QETH_HDR_EXT_CSUM_TRANSP_REQ | 2604d7def2aSThomas Richter QETH_HDR_EXT_CSUM_HDR_REQ; 2614d7def2aSThomas Richter iph->check = 0; 2624d7def2aSThomas Richter if (card->options.performance_stats) 2634d7def2aSThomas Richter card->perf_stats.tx_csum++; 2644d7def2aSThomas Richter } 2654d7def2aSThomas Richter 266ae79fe03SJulian Wiedmann static void qeth_l2_fill_header(struct qeth_hdr *hdr, struct sk_buff *skb, 267ae79fe03SJulian Wiedmann int cast_type, unsigned int data_len) 2684a71df50SFrank Blaschka { 269683d718aSFrank Blaschka struct vlan_ethhdr *veth = (struct vlan_ethhdr *)skb_mac_header(skb); 2704a71df50SFrank Blaschka 2714a71df50SFrank Blaschka memset(hdr, 0, sizeof(struct qeth_hdr)); 2724a71df50SFrank Blaschka hdr->hdr.l2.id = QETH_HEADER_TYPE_LAYER2; 273ae79fe03SJulian Wiedmann hdr->hdr.l2.pkt_length = data_len; 2744a71df50SFrank Blaschka 2754a71df50SFrank Blaschka /* set byte byte 3 to casting flags */ 2764a71df50SFrank Blaschka if (cast_type == RTN_MULTICAST) 2774a71df50SFrank Blaschka hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_MULTICAST; 2784a71df50SFrank Blaschka else if (cast_type == RTN_BROADCAST) 2794a71df50SFrank Blaschka hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_BROADCAST; 2804a71df50SFrank Blaschka else 281ce73e10eSKlaus-Dieter Wacker hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_UNICAST; 2824a71df50SFrank Blaschka 2834a71df50SFrank Blaschka /* VSWITCH relies on the VLAN 2844a71df50SFrank Blaschka * information to be present in 2854a71df50SFrank Blaschka * the QDIO header */ 2864a71df50SFrank Blaschka if (veth->h_vlan_proto == __constant_htons(ETH_P_8021Q)) { 2874a71df50SFrank Blaschka hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_VLAN; 2884a71df50SFrank Blaschka hdr->hdr.l2.vlan_id = ntohs(veth->h_vlan_TCI); 2894a71df50SFrank Blaschka } 2904a71df50SFrank Blaschka } 2914a71df50SFrank Blaschka 2922aa48671SJulian Wiedmann static int qeth_setdelvlan_makerc(struct qeth_card *card, int retcode) 2934a71df50SFrank Blaschka { 2942aa48671SJulian Wiedmann if (retcode) 2952aa48671SJulian Wiedmann QETH_CARD_TEXT_(card, 2, "err%04x", retcode); 2962aa48671SJulian Wiedmann 2972aa48671SJulian Wiedmann switch (retcode) { 2982aa48671SJulian Wiedmann case IPA_RC_SUCCESS: 2992aa48671SJulian Wiedmann return 0; 3002aa48671SJulian Wiedmann case IPA_RC_L2_INVALID_VLAN_ID: 3012aa48671SJulian Wiedmann return -EINVAL; 3022aa48671SJulian Wiedmann case IPA_RC_L2_DUP_VLAN_ID: 3032aa48671SJulian Wiedmann return -EEXIST; 3042aa48671SJulian Wiedmann case IPA_RC_L2_VLAN_ID_NOT_FOUND: 3052aa48671SJulian Wiedmann return -ENOENT; 3062aa48671SJulian Wiedmann case IPA_RC_L2_VLAN_ID_NOT_ALLOWED: 3072aa48671SJulian Wiedmann return -EPERM; 3082aa48671SJulian Wiedmann case -ENOMEM: 3092aa48671SJulian Wiedmann return -ENOMEM; 3102aa48671SJulian Wiedmann default: 3112aa48671SJulian Wiedmann return -EIO; 3122aa48671SJulian Wiedmann } 3132aa48671SJulian Wiedmann } 3142aa48671SJulian Wiedmann 3152aa48671SJulian Wiedmann static int qeth_l2_send_setdelvlan_cb(struct qeth_card *card, 3162aa48671SJulian Wiedmann struct qeth_reply *reply, 3172aa48671SJulian Wiedmann unsigned long data) 3182aa48671SJulian Wiedmann { 3192aa48671SJulian Wiedmann struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *) data; 3204a71df50SFrank Blaschka 321847a50fdSCarsten Otte QETH_CARD_TEXT(card, 2, "L2sdvcb"); 3224a71df50SFrank Blaschka if (cmd->hdr.return_code) { 3232aa48671SJulian Wiedmann QETH_DBF_MESSAGE(2, "Error in processing VLAN %i on %s: 0x%x.\n", 3242aa48671SJulian Wiedmann cmd->data.setdelvlan.vlan_id, 3254a71df50SFrank Blaschka QETH_CARD_IFNAME(card), cmd->hdr.return_code); 326847a50fdSCarsten Otte QETH_CARD_TEXT_(card, 2, "L2VL%4x", cmd->hdr.command); 327847a50fdSCarsten Otte QETH_CARD_TEXT_(card, 2, "err%d", cmd->hdr.return_code); 3284a71df50SFrank Blaschka } 3294a71df50SFrank Blaschka return 0; 3304a71df50SFrank Blaschka } 3314a71df50SFrank Blaschka 3324a71df50SFrank Blaschka static int qeth_l2_send_setdelvlan(struct qeth_card *card, __u16 i, 3334a71df50SFrank Blaschka enum qeth_ipa_cmds ipacmd) 3344a71df50SFrank Blaschka { 3354a71df50SFrank Blaschka struct qeth_ipa_cmd *cmd; 3364a71df50SFrank Blaschka struct qeth_cmd_buffer *iob; 3374a71df50SFrank Blaschka 338847a50fdSCarsten Otte QETH_CARD_TEXT_(card, 4, "L2sdv%x", ipacmd); 3394a71df50SFrank Blaschka iob = qeth_get_ipacmd_buffer(card, ipacmd, QETH_PROT_IPV4); 3401aec42bcSThomas Richter if (!iob) 3411aec42bcSThomas Richter return -ENOMEM; 3424a71df50SFrank Blaschka cmd = (struct qeth_ipa_cmd *)(iob->data+IPA_PDU_HEADER_SIZE); 3434a71df50SFrank Blaschka cmd->data.setdelvlan.vlan_id = i; 3442aa48671SJulian Wiedmann return qeth_setdelvlan_makerc(card, qeth_send_ipa_cmd(card, iob, 3452aa48671SJulian Wiedmann qeth_l2_send_setdelvlan_cb, NULL)); 3464a71df50SFrank Blaschka } 3474a71df50SFrank Blaschka 34870919e23SUrsula Braun static void qeth_l2_process_vlans(struct qeth_card *card) 3494a71df50SFrank Blaschka { 3504a71df50SFrank Blaschka struct qeth_vlan_vid *id; 351847a50fdSCarsten Otte QETH_CARD_TEXT(card, 3, "L2prcvln"); 3524a71df50SFrank Blaschka spin_lock_bh(&card->vlanlock); 3534a71df50SFrank Blaschka list_for_each_entry(id, &card->vid_list, list) { 35470919e23SUrsula Braun qeth_l2_send_setdelvlan(card, id->vid, IPA_CMD_SETVLAN); 3554a71df50SFrank Blaschka } 3564a71df50SFrank Blaschka spin_unlock_bh(&card->vlanlock); 3574a71df50SFrank Blaschka } 3584a71df50SFrank Blaschka 35980d5c368SPatrick McHardy static int qeth_l2_vlan_rx_add_vid(struct net_device *dev, 36080d5c368SPatrick McHardy __be16 proto, u16 vid) 3614a71df50SFrank Blaschka { 362509e2562SHeiko Carstens struct qeth_card *card = dev->ml_priv; 3634a71df50SFrank Blaschka struct qeth_vlan_vid *id; 3641aec42bcSThomas Richter int rc; 3654a71df50SFrank Blaschka 366847a50fdSCarsten Otte QETH_CARD_TEXT_(card, 4, "aid:%d", vid); 36710651db7SUrsula Braun if (!vid) 3688e586137SJiri Pirko return 0; 3695113fec0SUrsula Braun if (card->info.type == QETH_CARD_TYPE_OSM) { 370847a50fdSCarsten Otte QETH_CARD_TEXT(card, 3, "aidOSM"); 3718e586137SJiri Pirko return 0; 3725113fec0SUrsula Braun } 3738e98ac48SUrsula Braun if (qeth_wait_for_threads(card, QETH_RECOVER_THREAD)) { 374847a50fdSCarsten Otte QETH_CARD_TEXT(card, 3, "aidREC"); 3758e586137SJiri Pirko return 0; 3768e98ac48SUrsula Braun } 3774a71df50SFrank Blaschka id = kmalloc(sizeof(struct qeth_vlan_vid), GFP_ATOMIC); 3784a71df50SFrank Blaschka if (id) { 3794a71df50SFrank Blaschka id->vid = vid; 3801aec42bcSThomas Richter rc = qeth_l2_send_setdelvlan(card, vid, IPA_CMD_SETVLAN); 3811aec42bcSThomas Richter if (rc) { 3821aec42bcSThomas Richter kfree(id); 3831aec42bcSThomas Richter return rc; 3841aec42bcSThomas Richter } 3854a71df50SFrank Blaschka spin_lock_bh(&card->vlanlock); 3864a71df50SFrank Blaschka list_add_tail(&id->list, &card->vid_list); 3874a71df50SFrank Blaschka spin_unlock_bh(&card->vlanlock); 3888e586137SJiri Pirko } else { 3898e586137SJiri Pirko return -ENOMEM; 3904a71df50SFrank Blaschka } 3918e586137SJiri Pirko return 0; 3924a71df50SFrank Blaschka } 3934a71df50SFrank Blaschka 39480d5c368SPatrick McHardy static int qeth_l2_vlan_rx_kill_vid(struct net_device *dev, 39580d5c368SPatrick McHardy __be16 proto, u16 vid) 3964a71df50SFrank Blaschka { 3974a71df50SFrank Blaschka struct qeth_vlan_vid *id, *tmpid = NULL; 398509e2562SHeiko Carstens struct qeth_card *card = dev->ml_priv; 3991aec42bcSThomas Richter int rc = 0; 4004a71df50SFrank Blaschka 401847a50fdSCarsten Otte QETH_CARD_TEXT_(card, 4, "kid:%d", vid); 4025113fec0SUrsula Braun if (card->info.type == QETH_CARD_TYPE_OSM) { 403847a50fdSCarsten Otte QETH_CARD_TEXT(card, 3, "kidOSM"); 4048e586137SJiri Pirko return 0; 4055113fec0SUrsula Braun } 4068e98ac48SUrsula Braun if (qeth_wait_for_threads(card, QETH_RECOVER_THREAD)) { 407847a50fdSCarsten Otte QETH_CARD_TEXT(card, 3, "kidREC"); 4088e586137SJiri Pirko return 0; 4098e98ac48SUrsula Braun } 4104a71df50SFrank Blaschka spin_lock_bh(&card->vlanlock); 4114a71df50SFrank Blaschka list_for_each_entry(id, &card->vid_list, list) { 4124a71df50SFrank Blaschka if (id->vid == vid) { 4134a71df50SFrank Blaschka list_del(&id->list); 4144a71df50SFrank Blaschka tmpid = id; 4154a71df50SFrank Blaschka break; 4164a71df50SFrank Blaschka } 4174a71df50SFrank Blaschka } 4184a71df50SFrank Blaschka spin_unlock_bh(&card->vlanlock); 4194a71df50SFrank Blaschka if (tmpid) { 4201aec42bcSThomas Richter rc = qeth_l2_send_setdelvlan(card, vid, IPA_CMD_DELVLAN); 4214a71df50SFrank Blaschka kfree(tmpid); 4224a71df50SFrank Blaschka } 423fe5c8028SLakhvich Dmitriy qeth_l2_set_rx_mode(card->dev); 4241aec42bcSThomas Richter return rc; 4254a71df50SFrank Blaschka } 4264a71df50SFrank Blaschka 427b2f4de8bSPeter Senna Tschudin static void qeth_l2_stop_card(struct qeth_card *card, int recovery_mode) 4284a71df50SFrank Blaschka { 429d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP , 2, "stopcard"); 430d11ba0c4SPeter Tiedemann QETH_DBF_HEX(SETUP, 2, &card, sizeof(void *)); 4314a71df50SFrank Blaschka 4324a71df50SFrank Blaschka qeth_set_allowed_threads(card, 0, 1); 4334a71df50SFrank Blaschka if (card->read.state == CH_STATE_UP && 4344a71df50SFrank Blaschka card->write.state == CH_STATE_UP && 4354a71df50SFrank Blaschka (card->state == CARD_STATE_UP)) { 4364a71df50SFrank Blaschka if (recovery_mode && 4374a71df50SFrank Blaschka card->info.type != QETH_CARD_TYPE_OSN) { 4384a71df50SFrank Blaschka qeth_l2_stop(card->dev); 4394a71df50SFrank Blaschka } else { 4404a71df50SFrank Blaschka rtnl_lock(); 4414a71df50SFrank Blaschka dev_close(card->dev); 4424a71df50SFrank Blaschka rtnl_unlock(); 4434a71df50SFrank Blaschka } 44470919e23SUrsula Braun card->info.mac_bits &= ~QETH_LAYER2_MAC_REGISTERED; 4454a71df50SFrank Blaschka card->state = CARD_STATE_SOFTSETUP; 4464a71df50SFrank Blaschka } 4474a71df50SFrank Blaschka if (card->state == CARD_STATE_SOFTSETUP) { 448c07cbf2eSJulian Wiedmann qeth_l2_del_all_macs(card); 4494a71df50SFrank Blaschka qeth_clear_ipacmd_list(card); 4504a71df50SFrank Blaschka card->state = CARD_STATE_HARDSETUP; 4514a71df50SFrank Blaschka } 4524a71df50SFrank Blaschka if (card->state == CARD_STATE_HARDSETUP) { 4534a71df50SFrank Blaschka qeth_qdio_clear_card(card, 0); 4544a71df50SFrank Blaschka qeth_clear_qdio_buffers(card); 4554a71df50SFrank Blaschka qeth_clear_working_pool_list(card); 4564a71df50SFrank Blaschka card->state = CARD_STATE_DOWN; 4574a71df50SFrank Blaschka } 4584a71df50SFrank Blaschka if (card->state == CARD_STATE_DOWN) { 4594a71df50SFrank Blaschka qeth_clear_cmd_buffers(&card->read); 4604a71df50SFrank Blaschka qeth_clear_cmd_buffers(&card->write); 4614a71df50SFrank Blaschka } 4624a71df50SFrank Blaschka } 4634a71df50SFrank Blaschka 464a1c3ed4cSFrank Blaschka static int qeth_l2_process_inbound_buffer(struct qeth_card *card, 465a1c3ed4cSFrank Blaschka int budget, int *done) 4664a71df50SFrank Blaschka { 467a1c3ed4cSFrank Blaschka int work_done = 0; 4684a71df50SFrank Blaschka struct sk_buff *skb; 4694a71df50SFrank Blaschka struct qeth_hdr *hdr; 4704a71df50SFrank Blaschka unsigned int len; 4714a71df50SFrank Blaschka 472a1c3ed4cSFrank Blaschka *done = 0; 47318af5c17SStefan Raspl WARN_ON_ONCE(!budget); 474a1c3ed4cSFrank Blaschka while (budget) { 475a1c3ed4cSFrank Blaschka skb = qeth_core_get_next_skb(card, 476b3332930SFrank Blaschka &card->qdio.in_q->bufs[card->rx.b_index], 477a1c3ed4cSFrank Blaschka &card->rx.b_element, &card->rx.e_offset, &hdr); 478a1c3ed4cSFrank Blaschka if (!skb) { 479a1c3ed4cSFrank Blaschka *done = 1; 480a1c3ed4cSFrank Blaschka break; 4814a71df50SFrank Blaschka } 482a1c3ed4cSFrank Blaschka skb->dev = card->dev; 4834a71df50SFrank Blaschka switch (hdr->hdr.l2.id) { 4844a71df50SFrank Blaschka case QETH_HEADER_TYPE_LAYER2: 4854a71df50SFrank Blaschka skb->pkt_type = PACKET_HOST; 4864a71df50SFrank Blaschka skb->protocol = eth_type_trans(skb, skb->dev); 4874d7def2aSThomas Richter if ((card->dev->features & NETIF_F_RXCSUM) 4884d7def2aSThomas Richter && ((hdr->hdr.l2.flags[1] & 4894d7def2aSThomas Richter (QETH_HDR_EXT_CSUM_HDR_REQ | 4904d7def2aSThomas Richter QETH_HDR_EXT_CSUM_TRANSP_REQ)) == 4914d7def2aSThomas Richter (QETH_HDR_EXT_CSUM_HDR_REQ | 4924d7def2aSThomas Richter QETH_HDR_EXT_CSUM_TRANSP_REQ))) 4934d7def2aSThomas Richter skb->ip_summed = CHECKSUM_UNNECESSARY; 4944d7def2aSThomas Richter else 4954a71df50SFrank Blaschka skb->ip_summed = CHECKSUM_NONE; 49612883725SUrsula Braun if (skb->protocol == htons(ETH_P_802_2)) 4974a71df50SFrank Blaschka *((__u32 *)skb->cb) = ++card->seqno.pkt_seqno; 4984a71df50SFrank Blaschka len = skb->len; 4999abfa8cbSThomas Richter napi_gro_receive(&card->napi, skb); 5004a71df50SFrank Blaschka break; 5014a71df50SFrank Blaschka case QETH_HEADER_TYPE_OSN: 5022d488c2fSUrsula Braun if (card->info.type == QETH_CARD_TYPE_OSN) { 5034a71df50SFrank Blaschka skb_push(skb, sizeof(struct qeth_hdr)); 5044a71df50SFrank Blaschka skb_copy_to_linear_data(skb, hdr, 5054a71df50SFrank Blaschka sizeof(struct qeth_hdr)); 5064a71df50SFrank Blaschka len = skb->len; 5074a71df50SFrank Blaschka card->osn_info.data_cb(skb); 5084a71df50SFrank Blaschka break; 5092d488c2fSUrsula Braun } 5102d488c2fSUrsula Braun /* else unknown */ 5114a71df50SFrank Blaschka default: 5124a71df50SFrank Blaschka dev_kfree_skb_any(skb); 513847a50fdSCarsten Otte QETH_CARD_TEXT(card, 3, "inbunkno"); 514d11ba0c4SPeter Tiedemann QETH_DBF_HEX(CTRL, 3, hdr, QETH_DBF_CTRL_LEN); 5154a71df50SFrank Blaschka continue; 5164a71df50SFrank Blaschka } 517a1c3ed4cSFrank Blaschka work_done++; 518a1c3ed4cSFrank Blaschka budget--; 5194a71df50SFrank Blaschka card->stats.rx_packets++; 5204a71df50SFrank Blaschka card->stats.rx_bytes += len; 5214a71df50SFrank Blaschka } 522a1c3ed4cSFrank Blaschka return work_done; 523a1c3ed4cSFrank Blaschka } 524a1c3ed4cSFrank Blaschka 5254a71df50SFrank Blaschka static int qeth_l2_request_initial_mac(struct qeth_card *card) 5264a71df50SFrank Blaschka { 5274a71df50SFrank Blaschka int rc = 0; 5284a71df50SFrank Blaschka char vendor_pre[] = {0x02, 0x00, 0x00}; 5294a71df50SFrank Blaschka 530ec61bd2fSJulian Wiedmann QETH_DBF_TEXT(SETUP, 2, "l2reqmac"); 531d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "doL2%s", CARD_BUS_ID(card)); 5324a71df50SFrank Blaschka 533ec61bd2fSJulian Wiedmann if (MACHINE_IS_VM) { 534ec61bd2fSJulian Wiedmann rc = qeth_vm_request_mac(card); 535ec61bd2fSJulian Wiedmann if (!rc) 536ec61bd2fSJulian Wiedmann goto out; 537ec61bd2fSJulian Wiedmann QETH_DBF_MESSAGE(2, "z/VM MAC Service failed on device %s: x%x\n", 538ec61bd2fSJulian Wiedmann CARD_BUS_ID(card), rc); 539ec61bd2fSJulian Wiedmann QETH_DBF_TEXT_(SETUP, 2, "err%04x", rc); 540ec61bd2fSJulian Wiedmann /* fall back to alternative mechanism: */ 541ec61bd2fSJulian Wiedmann } 542ec61bd2fSJulian Wiedmann 5435113fec0SUrsula Braun if (card->info.type == QETH_CARD_TYPE_IQD || 5445113fec0SUrsula Braun card->info.type == QETH_CARD_TYPE_OSM || 5455113fec0SUrsula Braun card->info.type == QETH_CARD_TYPE_OSX || 5465113fec0SUrsula Braun card->info.guestlan) { 5474a71df50SFrank Blaschka rc = qeth_setadpparms_change_macaddr(card); 5484a71df50SFrank Blaschka if (rc) { 54914cc21b6SFrank Blaschka QETH_DBF_MESSAGE(2, "couldn't get MAC address on " 55014cc21b6SFrank Blaschka "device %s: x%x\n", CARD_BUS_ID(card), rc); 5511aec42bcSThomas Richter QETH_DBF_TEXT_(SETUP, 2, "1err%04x", rc); 5524a71df50SFrank Blaschka return rc; 5534a71df50SFrank Blaschka } 5544a71df50SFrank Blaschka } else { 5551833611dSJoe Perches eth_random_addr(card->dev->dev_addr); 5564a71df50SFrank Blaschka memcpy(card->dev->dev_addr, vendor_pre, 3); 5574a71df50SFrank Blaschka } 558ec61bd2fSJulian Wiedmann out: 559ec61bd2fSJulian Wiedmann QETH_DBF_HEX(SETUP, 2, card->dev->dev_addr, card->dev->addr_len); 5604a71df50SFrank Blaschka return 0; 5614a71df50SFrank Blaschka } 5624a71df50SFrank Blaschka 5634a71df50SFrank Blaschka static int qeth_l2_set_mac_address(struct net_device *dev, void *p) 5644a71df50SFrank Blaschka { 5654a71df50SFrank Blaschka struct sockaddr *addr = p; 566509e2562SHeiko Carstens struct qeth_card *card = dev->ml_priv; 5674a71df50SFrank Blaschka int rc = 0; 5684a71df50SFrank Blaschka 569847a50fdSCarsten Otte QETH_CARD_TEXT(card, 3, "setmac"); 5704a71df50SFrank Blaschka 5714a71df50SFrank Blaschka if (qeth_l2_verify_dev(dev) != QETH_REAL_CARD) { 572847a50fdSCarsten Otte QETH_CARD_TEXT(card, 3, "setmcINV"); 5734a71df50SFrank Blaschka return -EOPNOTSUPP; 5744a71df50SFrank Blaschka } 5754a71df50SFrank Blaschka 5765113fec0SUrsula Braun if (card->info.type == QETH_CARD_TYPE_OSN || 5775113fec0SUrsula Braun card->info.type == QETH_CARD_TYPE_OSM || 5785113fec0SUrsula Braun card->info.type == QETH_CARD_TYPE_OSX) { 579847a50fdSCarsten Otte QETH_CARD_TEXT(card, 3, "setmcTYP"); 5804a71df50SFrank Blaschka return -EOPNOTSUPP; 5814a71df50SFrank Blaschka } 582847a50fdSCarsten Otte QETH_CARD_HEX(card, 3, addr->sa_data, OSA_ADDR_LEN); 5838e98ac48SUrsula Braun if (qeth_wait_for_threads(card, QETH_RECOVER_THREAD)) { 584847a50fdSCarsten Otte QETH_CARD_TEXT(card, 3, "setmcREC"); 5858e98ac48SUrsula Braun return -ERESTARTSYS; 5868e98ac48SUrsula Braun } 5874a71df50SFrank Blaschka rc = qeth_l2_send_delmac(card, &card->dev->dev_addr[0]); 588efbbc1d5SEugene Crosser if (!rc || (rc == -ENOENT)) 5894a71df50SFrank Blaschka rc = qeth_l2_send_setmac(card, addr->sa_data); 590e0a8114cSUrsula Braun return rc ? -EINVAL : 0; 5914a71df50SFrank Blaschka } 5924a71df50SFrank Blaschka 5930db587b0SEugene Crosser static void qeth_promisc_to_bridge(struct qeth_card *card) 5940db587b0SEugene Crosser { 5950db587b0SEugene Crosser struct net_device *dev = card->dev; 5960db587b0SEugene Crosser enum qeth_ipa_promisc_modes promisc_mode; 5970db587b0SEugene Crosser int role; 5980db587b0SEugene Crosser int rc; 5990db587b0SEugene Crosser 6000db587b0SEugene Crosser QETH_CARD_TEXT(card, 3, "pmisc2br"); 6010db587b0SEugene Crosser 6020db587b0SEugene Crosser if (!card->options.sbp.reflect_promisc) 6030db587b0SEugene Crosser return; 6040db587b0SEugene Crosser promisc_mode = (dev->flags & IFF_PROMISC) ? SET_PROMISC_MODE_ON 6050db587b0SEugene Crosser : SET_PROMISC_MODE_OFF; 6060db587b0SEugene Crosser if (promisc_mode == card->info.promisc_mode) 6070db587b0SEugene Crosser return; 6080db587b0SEugene Crosser 6090db587b0SEugene Crosser if (promisc_mode == SET_PROMISC_MODE_ON) { 6100db587b0SEugene Crosser if (card->options.sbp.reflect_promisc_primary) 6110db587b0SEugene Crosser role = QETH_SBP_ROLE_PRIMARY; 6120db587b0SEugene Crosser else 6130db587b0SEugene Crosser role = QETH_SBP_ROLE_SECONDARY; 6140db587b0SEugene Crosser } else 6150db587b0SEugene Crosser role = QETH_SBP_ROLE_NONE; 6160db587b0SEugene Crosser 6170db587b0SEugene Crosser rc = qeth_bridgeport_setrole(card, role); 6180db587b0SEugene Crosser QETH_DBF_TEXT_(SETUP, 2, "bpm%c%04x", 6190db587b0SEugene Crosser (promisc_mode == SET_PROMISC_MODE_ON) ? '+' : '-', rc); 6200db587b0SEugene Crosser if (!rc) { 6210db587b0SEugene Crosser card->options.sbp.role = role; 6220db587b0SEugene Crosser card->info.promisc_mode = promisc_mode; 6230db587b0SEugene Crosser } 624fe5c8028SLakhvich Dmitriy 625fe5c8028SLakhvich Dmitriy } 626fe5c8028SLakhvich Dmitriy /* New MAC address is added to the hash table and marked to be written on card 627fe5c8028SLakhvich Dmitriy * only if there is not in the hash table storage already 628fe5c8028SLakhvich Dmitriy * 629fe5c8028SLakhvich Dmitriy */ 630cef6ff22SJulian Wiedmann static void qeth_l2_add_mac(struct qeth_card *card, struct netdev_hw_addr *ha, 631cef6ff22SJulian Wiedmann u8 is_uc) 632fe5c8028SLakhvich Dmitriy { 633cef6ff22SJulian Wiedmann u32 mac_hash = get_unaligned((u32 *)(&ha->addr[2])); 634fe5c8028SLakhvich Dmitriy struct qeth_mac *mac; 635fe5c8028SLakhvich Dmitriy 636cef6ff22SJulian Wiedmann hash_for_each_possible(card->mac_htable, mac, hnode, mac_hash) { 637fe5c8028SLakhvich Dmitriy if (is_uc == mac->is_uc && 638fe5c8028SLakhvich Dmitriy !memcmp(ha->addr, mac->mac_addr, OSA_ADDR_LEN)) { 6395f78e29cSLakhvich Dmitriy mac->disp_flag = QETH_DISP_ADDR_DO_NOTHING; 640fe5c8028SLakhvich Dmitriy return; 641fe5c8028SLakhvich Dmitriy } 6420db587b0SEugene Crosser } 6430db587b0SEugene Crosser 644fe5c8028SLakhvich Dmitriy mac = kzalloc(sizeof(struct qeth_mac), GFP_ATOMIC); 645fe5c8028SLakhvich Dmitriy 646fe5c8028SLakhvich Dmitriy if (!mac) 647fe5c8028SLakhvich Dmitriy return; 648fe5c8028SLakhvich Dmitriy 649fe5c8028SLakhvich Dmitriy memcpy(mac->mac_addr, ha->addr, OSA_ADDR_LEN); 650fe5c8028SLakhvich Dmitriy mac->is_uc = is_uc; 6515f78e29cSLakhvich Dmitriy mac->disp_flag = QETH_DISP_ADDR_ADD; 652fe5c8028SLakhvich Dmitriy 653cef6ff22SJulian Wiedmann hash_add(card->mac_htable, &mac->hnode, mac_hash); 654fe5c8028SLakhvich Dmitriy } 655fe5c8028SLakhvich Dmitriy 656fe5c8028SLakhvich Dmitriy static void qeth_l2_set_rx_mode(struct net_device *dev) 6574a71df50SFrank Blaschka { 658509e2562SHeiko Carstens struct qeth_card *card = dev->ml_priv; 659ccffad25SJiri Pirko struct netdev_hw_addr *ha; 660fe5c8028SLakhvich Dmitriy struct qeth_mac *mac; 661fe5c8028SLakhvich Dmitriy struct hlist_node *tmp; 662fe5c8028SLakhvich Dmitriy int i; 663fe5c8028SLakhvich Dmitriy int rc; 6644a71df50SFrank Blaschka 6654a71df50SFrank Blaschka if (card->info.type == QETH_CARD_TYPE_OSN) 6664a71df50SFrank Blaschka return; 6674a71df50SFrank Blaschka 668847a50fdSCarsten Otte QETH_CARD_TEXT(card, 3, "setmulti"); 6698e98ac48SUrsula Braun if (qeth_threads_running(card, QETH_RECOVER_THREAD) && 6708e98ac48SUrsula Braun (card->state != CARD_STATE_UP)) 6718e98ac48SUrsula Braun return; 672fe5c8028SLakhvich Dmitriy 6734a71df50SFrank Blaschka spin_lock_bh(&card->mclock); 674fe5c8028SLakhvich Dmitriy 67522bedad3SJiri Pirko netdev_for_each_mc_addr(ha, dev) 676fe5c8028SLakhvich Dmitriy qeth_l2_add_mac(card, ha, 0); 6777db2266aSFrank Blaschka 67832e7bfc4SJiri Pirko netdev_for_each_uc_addr(ha, dev) 679fe5c8028SLakhvich Dmitriy qeth_l2_add_mac(card, ha, 1); 680fe5c8028SLakhvich Dmitriy 681fe5c8028SLakhvich Dmitriy hash_for_each_safe(card->mac_htable, i, tmp, mac, hnode) { 6825f78e29cSLakhvich Dmitriy if (mac->disp_flag == QETH_DISP_ADDR_DELETE) { 683979d7929SJulian Wiedmann qeth_l2_remove_mac(card, mac); 684fe5c8028SLakhvich Dmitriy hash_del(&mac->hnode); 685fe5c8028SLakhvich Dmitriy kfree(mac); 686fe5c8028SLakhvich Dmitriy 6875f78e29cSLakhvich Dmitriy } else if (mac->disp_flag == QETH_DISP_ADDR_ADD) { 688fe5c8028SLakhvich Dmitriy rc = qeth_l2_write_mac(card, mac); 689fe5c8028SLakhvich Dmitriy if (rc) { 690fe5c8028SLakhvich Dmitriy hash_del(&mac->hnode); 691fe5c8028SLakhvich Dmitriy kfree(mac); 692fe5c8028SLakhvich Dmitriy } else 6935f78e29cSLakhvich Dmitriy mac->disp_flag = QETH_DISP_ADDR_DELETE; 694fe5c8028SLakhvich Dmitriy } else 6955f78e29cSLakhvich Dmitriy mac->disp_flag = QETH_DISP_ADDR_DELETE; 696fe5c8028SLakhvich Dmitriy } 6977db2266aSFrank Blaschka 6984a71df50SFrank Blaschka spin_unlock_bh(&card->mclock); 699fe5c8028SLakhvich Dmitriy 7000db587b0SEugene Crosser if (qeth_adp_supported(card, IPA_SETADP_SET_PROMISC_MODE)) 7014a71df50SFrank Blaschka qeth_setadp_promisc_mode(card); 7020db587b0SEugene Crosser else 7030db587b0SEugene Crosser qeth_promisc_to_bridge(card); 7044a71df50SFrank Blaschka } 7054a71df50SFrank Blaschka 7067286384bSJulian Wiedmann static int qeth_l2_xmit_iqd(struct qeth_card *card, struct sk_buff *skb, 7077286384bSJulian Wiedmann struct qeth_qdio_out_q *queue, int cast_type) 7087286384bSJulian Wiedmann { 7097286384bSJulian Wiedmann unsigned int data_offset = ETH_HLEN; 7107286384bSJulian Wiedmann struct qeth_hdr *hdr; 7117286384bSJulian Wiedmann int rc; 7127286384bSJulian Wiedmann 7137286384bSJulian Wiedmann hdr = kmem_cache_alloc(qeth_core_header_cache, GFP_ATOMIC); 7147286384bSJulian Wiedmann if (!hdr) 7157286384bSJulian Wiedmann return -ENOMEM; 716ae79fe03SJulian Wiedmann qeth_l2_fill_header(hdr, skb, cast_type, skb->len); 7177286384bSJulian Wiedmann skb_copy_from_linear_data(skb, ((char *)hdr) + sizeof(*hdr), 7187286384bSJulian Wiedmann data_offset); 7197286384bSJulian Wiedmann 7207286384bSJulian Wiedmann if (!qeth_get_elements_no(card, skb, 1, data_offset)) { 7217286384bSJulian Wiedmann rc = -E2BIG; 7227286384bSJulian Wiedmann goto out; 7237286384bSJulian Wiedmann } 7247c2e9ba3SJulian Wiedmann rc = qeth_do_send_packet_fast(queue, skb, hdr, data_offset, 725f1588177SJulian Wiedmann sizeof(*hdr) + data_offset); 7267286384bSJulian Wiedmann out: 7277286384bSJulian Wiedmann if (rc) 7287286384bSJulian Wiedmann kmem_cache_free(qeth_core_header_cache, hdr); 7297286384bSJulian Wiedmann return rc; 7307286384bSJulian Wiedmann } 7317286384bSJulian Wiedmann 7327286384bSJulian Wiedmann static int qeth_l2_xmit_osa(struct qeth_card *card, struct sk_buff *skb, 7337286384bSJulian Wiedmann struct qeth_qdio_out_q *queue, int cast_type) 7347286384bSJulian Wiedmann { 7350d6f02d3SJulian Wiedmann int push_len = sizeof(struct qeth_hdr); 7367286384bSJulian Wiedmann unsigned int elements, nr_frags; 7370d6f02d3SJulian Wiedmann unsigned int hdr_elements = 0; 7380d6f02d3SJulian Wiedmann struct qeth_hdr *hdr = NULL; 7390d6f02d3SJulian Wiedmann unsigned int hd_len = 0; 7407286384bSJulian Wiedmann int rc; 7417286384bSJulian Wiedmann 7427286384bSJulian Wiedmann /* fix hardware limitation: as long as we do not have sbal 7437286384bSJulian Wiedmann * chaining we can not send long frag lists 7447286384bSJulian Wiedmann */ 7457286384bSJulian Wiedmann if (!qeth_get_elements_no(card, skb, 0, 0)) { 7467286384bSJulian Wiedmann rc = skb_linearize(skb); 7477286384bSJulian Wiedmann 7487286384bSJulian Wiedmann if (card->options.performance_stats) { 7497286384bSJulian Wiedmann if (rc) 7507286384bSJulian Wiedmann card->perf_stats.tx_linfail++; 7517286384bSJulian Wiedmann else 7527286384bSJulian Wiedmann card->perf_stats.tx_lin++; 7537286384bSJulian Wiedmann } 7547286384bSJulian Wiedmann if (rc) 7557286384bSJulian Wiedmann return rc; 7567286384bSJulian Wiedmann } 7577286384bSJulian Wiedmann nr_frags = skb_shinfo(skb)->nr_frags; 7587286384bSJulian Wiedmann 7590d6f02d3SJulian Wiedmann rc = skb_cow_head(skb, push_len); 7600d6f02d3SJulian Wiedmann if (rc) 7610d6f02d3SJulian Wiedmann return rc; 7620d6f02d3SJulian Wiedmann push_len = qeth_push_hdr(skb, &hdr, push_len); 7630d6f02d3SJulian Wiedmann if (push_len < 0) 7640d6f02d3SJulian Wiedmann return push_len; 7650d6f02d3SJulian Wiedmann if (!push_len) { 7660d6f02d3SJulian Wiedmann /* hdr was allocated from cache */ 7670d6f02d3SJulian Wiedmann hd_len = sizeof(*hdr); 7680d6f02d3SJulian Wiedmann hdr_elements = 1; 7690d6f02d3SJulian Wiedmann } 7700d6f02d3SJulian Wiedmann qeth_l2_fill_header(hdr, skb, cast_type, skb->len - push_len); 7710d6f02d3SJulian Wiedmann if (skb->ip_summed == CHECKSUM_PARTIAL) 7720d6f02d3SJulian Wiedmann qeth_l2_hdr_csum(card, hdr, skb); 7737286384bSJulian Wiedmann 7740d6f02d3SJulian Wiedmann elements = qeth_get_elements_no(card, skb, hdr_elements, 0); 7757286384bSJulian Wiedmann if (!elements) { 7767286384bSJulian Wiedmann rc = -E2BIG; 7777286384bSJulian Wiedmann goto out; 7787286384bSJulian Wiedmann } 7790d6f02d3SJulian Wiedmann elements += hdr_elements; 7800d6f02d3SJulian Wiedmann 7810d6f02d3SJulian Wiedmann /* TODO: remove the skb_orphan() once TX completion is fast enough */ 7820d6f02d3SJulian Wiedmann skb_orphan(skb); 7830d6f02d3SJulian Wiedmann rc = qeth_do_send_packet(card, queue, skb, hdr, 0, hd_len, elements); 7847286384bSJulian Wiedmann out: 7857286384bSJulian Wiedmann if (!rc) { 7867286384bSJulian Wiedmann if (card->options.performance_stats && nr_frags) { 7877286384bSJulian Wiedmann card->perf_stats.sg_skbs_sent++; 7887286384bSJulian Wiedmann /* nr_frags + skb->data */ 7897286384bSJulian Wiedmann card->perf_stats.sg_frags_sent += nr_frags + 1; 7907286384bSJulian Wiedmann } 7917286384bSJulian Wiedmann } else { 7920d6f02d3SJulian Wiedmann if (hd_len) 7930d6f02d3SJulian Wiedmann kmem_cache_free(qeth_core_header_cache, hdr); 7940d6f02d3SJulian Wiedmann if (rc == -EBUSY) 7950d6f02d3SJulian Wiedmann /* roll back to ETH header */ 7960d6f02d3SJulian Wiedmann skb_pull(skb, push_len); 7977286384bSJulian Wiedmann } 7987286384bSJulian Wiedmann return rc; 7997286384bSJulian Wiedmann } 8007286384bSJulian Wiedmann 8017286384bSJulian Wiedmann static int qeth_l2_xmit_osn(struct qeth_card *card, struct sk_buff *skb, 8027286384bSJulian Wiedmann struct qeth_qdio_out_q *queue) 8037286384bSJulian Wiedmann { 8047286384bSJulian Wiedmann unsigned int elements; 8057286384bSJulian Wiedmann struct qeth_hdr *hdr; 8067286384bSJulian Wiedmann 8077286384bSJulian Wiedmann if (skb->protocol == htons(ETH_P_IPV6)) 8087286384bSJulian Wiedmann return -EPROTONOSUPPORT; 8097286384bSJulian Wiedmann 8107286384bSJulian Wiedmann hdr = (struct qeth_hdr *)skb->data; 8117286384bSJulian Wiedmann elements = qeth_get_elements_no(card, skb, 0, 0); 8127286384bSJulian Wiedmann if (!elements) 8137286384bSJulian Wiedmann return -E2BIG; 8147286384bSJulian Wiedmann if (qeth_hdr_chk_and_bounce(skb, &hdr, sizeof(*hdr))) 8157286384bSJulian Wiedmann return -EINVAL; 8169c3bfda9SJulian Wiedmann return qeth_do_send_packet(card, queue, skb, hdr, 0, 0, elements); 8177286384bSJulian Wiedmann } 8187286384bSJulian Wiedmann 819e38db6beSJulian Wiedmann static netdev_tx_t qeth_l2_hard_start_xmit(struct sk_buff *skb, 820e38db6beSJulian Wiedmann struct net_device *dev) 8214a71df50SFrank Blaschka { 822509e2562SHeiko Carstens struct qeth_card *card = dev->ml_priv; 823ce73e10eSKlaus-Dieter Wacker int cast_type = qeth_l2_get_cast_type(card, skb); 824290b8348SStefan Raspl struct qeth_qdio_out_q *queue; 8254a71df50SFrank Blaschka int tx_bytes = skb->len; 8267286384bSJulian Wiedmann int rc; 8274a71df50SFrank Blaschka 828290b8348SStefan Raspl if (card->qdio.do_prio_queueing || (cast_type && 829290b8348SStefan Raspl card->info.is_multicast_different)) 830290b8348SStefan Raspl queue = card->qdio.out_qs[qeth_get_priority_queue(card, skb, 831290b8348SStefan Raspl qeth_get_ip_version(skb), cast_type)]; 832290b8348SStefan Raspl else 833290b8348SStefan Raspl queue = card->qdio.out_qs[card->qdio.default_out_queue]; 834290b8348SStefan Raspl 8354a71df50SFrank Blaschka if ((card->state != CARD_STATE_UP) || !card->lan_online) { 8364a71df50SFrank Blaschka card->stats.tx_carrier_errors++; 8374a71df50SFrank Blaschka goto tx_drop; 8384a71df50SFrank Blaschka } 8394a71df50SFrank Blaschka 8404a71df50SFrank Blaschka if (card->options.performance_stats) { 8414a71df50SFrank Blaschka card->perf_stats.outbound_cnt++; 8424a71df50SFrank Blaschka card->perf_stats.outbound_start_time = qeth_get_micros(); 8434a71df50SFrank Blaschka } 8444a71df50SFrank Blaschka netif_stop_queue(dev); 8454a71df50SFrank Blaschka 8467286384bSJulian Wiedmann switch (card->info.type) { 8477286384bSJulian Wiedmann case QETH_CARD_TYPE_OSN: 8487286384bSJulian Wiedmann rc = qeth_l2_xmit_osn(card, skb, queue); 8497286384bSJulian Wiedmann break; 8507286384bSJulian Wiedmann case QETH_CARD_TYPE_IQD: 8517286384bSJulian Wiedmann rc = qeth_l2_xmit_iqd(card, skb, queue, cast_type); 8527286384bSJulian Wiedmann break; 8537286384bSJulian Wiedmann default: 8547286384bSJulian Wiedmann rc = qeth_l2_xmit_osa(card, skb, queue, cast_type); 855683d718aSFrank Blaschka } 8564a71df50SFrank Blaschka 8574a71df50SFrank Blaschka if (!rc) { 8584a71df50SFrank Blaschka card->stats.tx_packets++; 8594a71df50SFrank Blaschka card->stats.tx_bytes += tx_bytes; 8604a71df50SFrank Blaschka if (card->options.performance_stats) 8614a71df50SFrank Blaschka card->perf_stats.outbound_time += qeth_get_micros() - 8624a71df50SFrank Blaschka card->perf_stats.outbound_start_time; 8637286384bSJulian Wiedmann netif_wake_queue(dev); 8647286384bSJulian Wiedmann return NETDEV_TX_OK; 8657286384bSJulian Wiedmann } else if (rc == -EBUSY) { 8667286384bSJulian Wiedmann return NETDEV_TX_BUSY; 8677286384bSJulian Wiedmann } /* else fall through */ 8684a71df50SFrank Blaschka 8694a71df50SFrank Blaschka tx_drop: 8704a71df50SFrank Blaschka card->stats.tx_dropped++; 8714a71df50SFrank Blaschka card->stats.tx_errors++; 8724a71df50SFrank Blaschka dev_kfree_skb_any(skb); 873d0ec0f54SFrank Blaschka netif_wake_queue(dev); 8744a71df50SFrank Blaschka return NETDEV_TX_OK; 8754a71df50SFrank Blaschka } 8764a71df50SFrank Blaschka 87739423440SUrsula Braun static int __qeth_l2_open(struct net_device *dev) 8784a71df50SFrank Blaschka { 879509e2562SHeiko Carstens struct qeth_card *card = dev->ml_priv; 880a1c3ed4cSFrank Blaschka int rc = 0; 8814a71df50SFrank Blaschka 882847a50fdSCarsten Otte QETH_CARD_TEXT(card, 4, "qethopen"); 88339423440SUrsula Braun if (card->state == CARD_STATE_UP) 88439423440SUrsula Braun return rc; 8854a71df50SFrank Blaschka if (card->state != CARD_STATE_SOFTSETUP) 8864a71df50SFrank Blaschka return -ENODEV; 8874a71df50SFrank Blaschka 8884a71df50SFrank Blaschka if ((card->info.type != QETH_CARD_TYPE_OSN) && 8894a71df50SFrank Blaschka (!(card->info.mac_bits & QETH_LAYER2_MAC_REGISTERED))) { 890847a50fdSCarsten Otte QETH_CARD_TEXT(card, 4, "nomacadr"); 8914a71df50SFrank Blaschka return -EPERM; 8924a71df50SFrank Blaschka } 8934a71df50SFrank Blaschka card->data.state = CH_STATE_UP; 8944a71df50SFrank Blaschka card->state = CARD_STATE_UP; 8954a71df50SFrank Blaschka netif_start_queue(dev); 8964a71df50SFrank Blaschka 897a1c3ed4cSFrank Blaschka if (qdio_stop_irq(card->data.ccwdev, 0) >= 0) { 898a1c3ed4cSFrank Blaschka napi_enable(&card->napi); 899a1c3ed4cSFrank Blaschka napi_schedule(&card->napi); 900a1c3ed4cSFrank Blaschka } else 901a1c3ed4cSFrank Blaschka rc = -EIO; 902a1c3ed4cSFrank Blaschka return rc; 9034a71df50SFrank Blaschka } 9044a71df50SFrank Blaschka 90539423440SUrsula Braun static int qeth_l2_open(struct net_device *dev) 90639423440SUrsula Braun { 90739423440SUrsula Braun struct qeth_card *card = dev->ml_priv; 90839423440SUrsula Braun 90939423440SUrsula Braun QETH_CARD_TEXT(card, 5, "qethope_"); 91039423440SUrsula Braun if (qeth_wait_for_threads(card, QETH_RECOVER_THREAD)) { 91139423440SUrsula Braun QETH_CARD_TEXT(card, 3, "openREC"); 91239423440SUrsula Braun return -ERESTARTSYS; 91339423440SUrsula Braun } 91439423440SUrsula Braun return __qeth_l2_open(dev); 91539423440SUrsula Braun } 91639423440SUrsula Braun 9174a71df50SFrank Blaschka static int qeth_l2_stop(struct net_device *dev) 9184a71df50SFrank Blaschka { 919509e2562SHeiko Carstens struct qeth_card *card = dev->ml_priv; 9204a71df50SFrank Blaschka 921847a50fdSCarsten Otte QETH_CARD_TEXT(card, 4, "qethstop"); 9224a71df50SFrank Blaschka netif_tx_disable(dev); 923a1c3ed4cSFrank Blaschka if (card->state == CARD_STATE_UP) { 9244a71df50SFrank Blaschka card->state = CARD_STATE_SOFTSETUP; 925a1c3ed4cSFrank Blaschka napi_disable(&card->napi); 926a1c3ed4cSFrank Blaschka } 9274a71df50SFrank Blaschka return 0; 9284a71df50SFrank Blaschka } 9294a71df50SFrank Blaschka 9302d2ebb3eSJulian Wiedmann static const struct device_type qeth_l2_devtype = { 9312d2ebb3eSJulian Wiedmann .name = "qeth_layer2", 9322d2ebb3eSJulian Wiedmann .groups = qeth_l2_attr_groups, 9332d2ebb3eSJulian Wiedmann }; 9342d2ebb3eSJulian Wiedmann 9354a71df50SFrank Blaschka static int qeth_l2_probe_device(struct ccwgroup_device *gdev) 9364a71df50SFrank Blaschka { 9374a71df50SFrank Blaschka struct qeth_card *card = dev_get_drvdata(&gdev->dev); 9389111e788SUrsula Braun int rc; 9394a71df50SFrank Blaschka 9402d2ebb3eSJulian Wiedmann if (gdev->dev.type == &qeth_generic_devtype) { 9419111e788SUrsula Braun rc = qeth_l2_create_device_attributes(&gdev->dev); 9429111e788SUrsula Braun if (rc) 9439111e788SUrsula Braun return rc; 9442d2ebb3eSJulian Wiedmann } 9454a71df50SFrank Blaschka INIT_LIST_HEAD(&card->vid_list); 946fe5c8028SLakhvich Dmitriy hash_init(card->mac_htable); 9474a71df50SFrank Blaschka card->options.layer2 = 1; 9481da74b1cSFrank Blaschka card->info.hwtrap = 0; 949caa1f0b1SHans Wippel qeth_l2_vnicc_set_defaults(card); 9504a71df50SFrank Blaschka return 0; 9514a71df50SFrank Blaschka } 9524a71df50SFrank Blaschka 9534a71df50SFrank Blaschka static void qeth_l2_remove_device(struct ccwgroup_device *cgdev) 9544a71df50SFrank Blaschka { 9554a71df50SFrank Blaschka struct qeth_card *card = dev_get_drvdata(&cgdev->dev); 9564a71df50SFrank Blaschka 9572d2ebb3eSJulian Wiedmann if (cgdev->dev.type == &qeth_generic_devtype) 958b4d72c08SEugene Crosser qeth_l2_remove_device_attributes(&cgdev->dev); 959f2148565SUrsula Braun qeth_set_allowed_threads(card, 0, 1); 9604a71df50SFrank Blaschka wait_event(card->wait_q, qeth_threads_running(card, 0xffffffff) == 0); 9614a71df50SFrank Blaschka 96270919e23SUrsula Braun if (cgdev->state == CCWGROUP_ONLINE) 9634a71df50SFrank Blaschka qeth_l2_set_offline(cgdev); 9644a71df50SFrank Blaschka 9654a71df50SFrank Blaschka if (card->dev) { 9667831b4ffSUrsula Braun netif_napi_del(&card->napi); 9674a71df50SFrank Blaschka unregister_netdev(card->dev); 9684a71df50SFrank Blaschka card->dev = NULL; 9694a71df50SFrank Blaschka } 9704a71df50SFrank Blaschka return; 9714a71df50SFrank Blaschka } 9724a71df50SFrank Blaschka 9730fc0b732SStephen Hemminger static const struct ethtool_ops qeth_l2_ethtool_ops = { 9744a71df50SFrank Blaschka .get_link = ethtool_op_get_link, 9754a71df50SFrank Blaschka .get_strings = qeth_core_get_strings, 9764a71df50SFrank Blaschka .get_ethtool_stats = qeth_core_get_ethtool_stats, 977df8b4ec8SBen Hutchings .get_sset_count = qeth_core_get_sset_count, 9784a71df50SFrank Blaschka .get_drvinfo = qeth_core_get_drvinfo, 979993e19c0SJulian Wiedmann .get_link_ksettings = qeth_core_ethtool_get_link_ksettings, 9804a71df50SFrank Blaschka }; 9814a71df50SFrank Blaschka 9820fc0b732SStephen Hemminger static const struct ethtool_ops qeth_l2_osn_ops = { 9834a71df50SFrank Blaschka .get_strings = qeth_core_get_strings, 9844a71df50SFrank Blaschka .get_ethtool_stats = qeth_core_get_ethtool_stats, 985df8b4ec8SBen Hutchings .get_sset_count = qeth_core_get_sset_count, 9864a71df50SFrank Blaschka .get_drvinfo = qeth_core_get_drvinfo, 9874a71df50SFrank Blaschka }; 9884a71df50SFrank Blaschka 9893d58cefdSFrank Blaschka static const struct net_device_ops qeth_l2_netdev_ops = { 9908403b13cSFrank Blaschka .ndo_open = qeth_l2_open, 9918403b13cSFrank Blaschka .ndo_stop = qeth_l2_stop, 9928403b13cSFrank Blaschka .ndo_get_stats = qeth_get_stats, 9938403b13cSFrank Blaschka .ndo_start_xmit = qeth_l2_hard_start_xmit, 9948403b13cSFrank Blaschka .ndo_validate_addr = eth_validate_addr, 995fe5c8028SLakhvich Dmitriy .ndo_set_rx_mode = qeth_l2_set_rx_mode, 996942d6984SJulian Wiedmann .ndo_do_ioctl = qeth_do_ioctl, 9978403b13cSFrank Blaschka .ndo_set_mac_address = qeth_l2_set_mac_address, 9988403b13cSFrank Blaschka .ndo_change_mtu = qeth_change_mtu, 9998403b13cSFrank Blaschka .ndo_vlan_rx_add_vid = qeth_l2_vlan_rx_add_vid, 10008403b13cSFrank Blaschka .ndo_vlan_rx_kill_vid = qeth_l2_vlan_rx_kill_vid, 10018403b13cSFrank Blaschka .ndo_tx_timeout = qeth_tx_timeout, 10028f43fb00SThomas Richter .ndo_fix_features = qeth_fix_features, 10038f43fb00SThomas Richter .ndo_set_features = qeth_set_features 10048403b13cSFrank Blaschka }; 10058403b13cSFrank Blaschka 10064a71df50SFrank Blaschka static int qeth_l2_setup_netdev(struct qeth_card *card) 10074a71df50SFrank Blaschka { 10084a71df50SFrank Blaschka switch (card->info.type) { 10094a71df50SFrank Blaschka case QETH_CARD_TYPE_IQD: 1010c835a677STom Gundersen card->dev = alloc_netdev(0, "hsi%d", NET_NAME_UNKNOWN, 1011c835a677STom Gundersen ether_setup); 10124a71df50SFrank Blaschka break; 10134a71df50SFrank Blaschka case QETH_CARD_TYPE_OSN: 1014c835a677STom Gundersen card->dev = alloc_netdev(0, "osn%d", NET_NAME_UNKNOWN, 1015c835a677STom Gundersen ether_setup); 10164a71df50SFrank Blaschka break; 10174a71df50SFrank Blaschka default: 10184a71df50SFrank Blaschka card->dev = alloc_etherdev(0); 10194a71df50SFrank Blaschka } 10204a71df50SFrank Blaschka 10214a71df50SFrank Blaschka if (!card->dev) 10224a71df50SFrank Blaschka return -ENODEV; 10234a71df50SFrank Blaschka 1024509e2562SHeiko Carstens card->dev->ml_priv = card; 10254a71df50SFrank Blaschka card->dev->watchdog_timeo = QETH_TX_TIMEOUT; 10264a71df50SFrank Blaschka card->dev->mtu = card->info.initial_mtu; 102746b3ef4cSJarod Wilson card->dev->min_mtu = 64; 102846b3ef4cSJarod Wilson card->dev->max_mtu = ETH_MAX_MTU; 10298403b13cSFrank Blaschka card->dev->netdev_ops = &qeth_l2_netdev_ops; 103025e2c341SJulian Wiedmann if (card->info.type == QETH_CARD_TYPE_OSN) { 103125e2c341SJulian Wiedmann card->dev->ethtool_ops = &qeth_l2_osn_ops; 103225e2c341SJulian Wiedmann card->dev->flags |= IFF_NOARP; 103325e2c341SJulian Wiedmann } else { 103425e2c341SJulian Wiedmann card->dev->ethtool_ops = &qeth_l2_ethtool_ops; 103525e2c341SJulian Wiedmann } 1036f646968fSPatrick McHardy card->dev->features |= NETIF_F_HW_VLAN_CTAG_FILTER; 10374d7def2aSThomas Richter if (card->info.type == QETH_CARD_TYPE_OSD && !card->info.guestlan) { 10388f43fb00SThomas Richter card->dev->hw_features = NETIF_F_SG; 10399bdc4411SHans Wippel card->dev->vlan_features = NETIF_F_SG; 10408f43fb00SThomas Richter /* OSA 3S and earlier has no RX/TX support */ 10419bdc4411SHans Wippel if (qeth_is_supported(card, IPA_OUTBOUND_CHECKSUM)) { 10428f43fb00SThomas Richter card->dev->hw_features |= NETIF_F_IP_CSUM; 10439bdc4411SHans Wippel card->dev->vlan_features |= NETIF_F_IP_CSUM; 10449bdc4411SHans Wippel } 10459bdc4411SHans Wippel if (qeth_is_supported(card, IPA_INBOUND_CHECKSUM)) { 10468f43fb00SThomas Richter card->dev->hw_features |= NETIF_F_RXCSUM; 10479bdc4411SHans Wippel card->dev->vlan_features |= NETIF_F_RXCSUM; 10489bdc4411SHans Wippel } 10494d7def2aSThomas Richter } 10500d6f02d3SJulian Wiedmann if (card->info.type != QETH_CARD_TYPE_OSN && 10510d6f02d3SJulian Wiedmann card->info.type != QETH_CARD_TYPE_IQD) { 10520d6f02d3SJulian Wiedmann card->dev->priv_flags &= ~IFF_TX_SKB_SHARING; 10530d6f02d3SJulian Wiedmann card->dev->needed_headroom = sizeof(struct qeth_hdr); 10540d6f02d3SJulian Wiedmann } 10550d6f02d3SJulian Wiedmann 10564a71df50SFrank Blaschka card->info.broadcast_capable = 1; 10574a71df50SFrank Blaschka qeth_l2_request_initial_mac(card); 1058d52aec97SEugene Crosser card->dev->gso_max_size = (QETH_MAX_BUFFER_ELEMENTS(card) - 1) * 1059d52aec97SEugene Crosser PAGE_SIZE; 10604a71df50SFrank Blaschka SET_NETDEV_DEV(card->dev, &card->gdev->dev); 1061d73ef324SJulian Wiedmann netif_napi_add(card->dev, &card->napi, qeth_poll, QETH_NAPI_WEIGHT); 1062e5ebe632SUrsula Braun netif_carrier_off(card->dev); 10634a71df50SFrank Blaschka return register_netdev(card->dev); 10644a71df50SFrank Blaschka } 10654a71df50SFrank Blaschka 10664d7def2aSThomas Richter static int qeth_l2_start_ipassists(struct qeth_card *card) 10674d7def2aSThomas Richter { 10684d7def2aSThomas Richter /* configure isolation level */ 10694d7def2aSThomas Richter if (qeth_set_access_ctrl_online(card, 0)) 10704d7def2aSThomas Richter return -ENODEV; 10714d7def2aSThomas Richter return 0; 10724d7def2aSThomas Richter } 10734d7def2aSThomas Richter 1074521c10eaSJulian Wiedmann static void qeth_l2_trace_features(struct qeth_card *card) 1075521c10eaSJulian Wiedmann { 1076a45b3fafSHans Wippel /* Set BridgePort features */ 1077a45b3fafSHans Wippel QETH_CARD_TEXT(card, 2, "featuSBP"); 1078521c10eaSJulian Wiedmann QETH_CARD_HEX(card, 2, &card->options.sbp.supported_funcs, 1079521c10eaSJulian Wiedmann sizeof(card->options.sbp.supported_funcs)); 1080a45b3fafSHans Wippel /* VNIC Characteristics features */ 1081a45b3fafSHans Wippel QETH_CARD_TEXT(card, 2, "feaVNICC"); 1082a45b3fafSHans Wippel QETH_CARD_HEX(card, 2, &card->options.vnicc.sup_chars, 1083a45b3fafSHans Wippel sizeof(card->options.vnicc.sup_chars)); 1084521c10eaSJulian Wiedmann } 1085521c10eaSJulian Wiedmann 10864a71df50SFrank Blaschka static int __qeth_l2_set_online(struct ccwgroup_device *gdev, int recovery_mode) 10874a71df50SFrank Blaschka { 10884a71df50SFrank Blaschka struct qeth_card *card = dev_get_drvdata(&gdev->dev); 10894a71df50SFrank Blaschka int rc = 0; 10904a71df50SFrank Blaschka enum qeth_card_states recover_flag; 10914a71df50SFrank Blaschka 10929dc48cccSUrsula Braun mutex_lock(&card->discipline_mutex); 1093c4949f07SFrank Blaschka mutex_lock(&card->conf_mutex); 1094d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "setonlin"); 1095d11ba0c4SPeter Tiedemann QETH_DBF_HEX(SETUP, 2, &card, sizeof(void *)); 10964a71df50SFrank Blaschka 10974a71df50SFrank Blaschka recover_flag = card->state; 10984a71df50SFrank Blaschka rc = qeth_core_hardsetup_card(card); 10994a71df50SFrank Blaschka if (rc) { 11001aec42bcSThomas Richter QETH_DBF_TEXT_(SETUP, 2, "2err%04x", rc); 1101aa909224SUrsula Braun rc = -ENODEV; 11024a71df50SFrank Blaschka goto out_remove; 11034a71df50SFrank Blaschka } 1104c044dc21SEugene Crosser qeth_bridgeport_query_support(card); 1105c044dc21SEugene Crosser if (card->options.sbp.supported_funcs) 1106c044dc21SEugene Crosser dev_info(&card->gdev->dev, 11079c23f4daSEugene Crosser "The device represents a Bridge Capable Port\n"); 11084a71df50SFrank Blaschka 1109aa909224SUrsula Braun if (!card->dev && qeth_l2_setup_netdev(card)) { 1110aa909224SUrsula Braun rc = -ENODEV; 11114a71df50SFrank Blaschka goto out_remove; 1112aa909224SUrsula Braun } 11134a71df50SFrank Blaschka 11144a71df50SFrank Blaschka if (card->info.type != QETH_CARD_TYPE_OSN) 11154a71df50SFrank Blaschka qeth_l2_send_setmac(card, &card->dev->dev_addr[0]); 11164a71df50SFrank Blaschka 11171da74b1cSFrank Blaschka if (qeth_is_diagass_supported(card, QETH_DIAGS_CMD_TRAP)) { 11181da74b1cSFrank Blaschka if (card->info.hwtrap && 11191da74b1cSFrank Blaschka qeth_hw_trap(card, QETH_DIAGS_TRAP_ARM)) 11201da74b1cSFrank Blaschka card->info.hwtrap = 0; 11211da74b1cSFrank Blaschka } else 11221da74b1cSFrank Blaschka card->info.hwtrap = 0; 11231da74b1cSFrank Blaschka 1124a45b3fafSHans Wippel /* for the rx_bcast characteristic, init VNICC after setmac */ 1125a45b3fafSHans Wippel qeth_l2_vnicc_init(card); 1126a45b3fafSHans Wippel 1127a45b3fafSHans Wippel qeth_trace_features(card); 1128a45b3fafSHans Wippel qeth_l2_trace_features(card); 1129a45b3fafSHans Wippel 1130b4d72c08SEugene Crosser qeth_l2_setup_bridgeport_attrs(card); 1131b4d72c08SEugene Crosser 11324a71df50SFrank Blaschka card->state = CARD_STATE_HARDSETUP; 1133a1c3ed4cSFrank Blaschka memset(&card->rx, 0, sizeof(struct qeth_rx)); 11344a71df50SFrank Blaschka qeth_print_status_message(card); 11354a71df50SFrank Blaschka 11364a71df50SFrank Blaschka /* softsetup */ 1137d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "softsetp"); 11384a71df50SFrank Blaschka 11395113fec0SUrsula Braun if ((card->info.type == QETH_CARD_TYPE_OSD) || 11400f54761dSStefan Raspl (card->info.type == QETH_CARD_TYPE_OSX)) { 11418f43fb00SThomas Richter rc = qeth_l2_start_ipassists(card); 11428f43fb00SThomas Richter if (rc) 11430f54761dSStefan Raspl goto out_remove; 11440f54761dSStefan Raspl } 11455113fec0SUrsula Braun 11465113fec0SUrsula Braun if (card->info.type != QETH_CARD_TYPE_OSN && 11475113fec0SUrsula Braun card->info.type != QETH_CARD_TYPE_OSM) 114870919e23SUrsula Braun qeth_l2_process_vlans(card); 11494a71df50SFrank Blaschka 11504a71df50SFrank Blaschka netif_tx_disable(card->dev); 11514a71df50SFrank Blaschka 11524a71df50SFrank Blaschka rc = qeth_init_qdio_queues(card); 11534a71df50SFrank Blaschka if (rc) { 1154d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "6err%d", rc); 1155aa909224SUrsula Braun rc = -ENODEV; 11564a71df50SFrank Blaschka goto out_remove; 11574a71df50SFrank Blaschka } 11584a71df50SFrank Blaschka card->state = CARD_STATE_SOFTSETUP; 11592b6203bbSUrsula Braun if (card->lan_online) 11604a71df50SFrank Blaschka netif_carrier_on(card->dev); 11612b6203bbSUrsula Braun else 11622b6203bbSUrsula Braun netif_carrier_off(card->dev); 11634a71df50SFrank Blaschka 11644a71df50SFrank Blaschka qeth_set_allowed_threads(card, 0xffffffff, 0); 11654a71df50SFrank Blaschka if (recover_flag == CARD_STATE_RECOVER) { 11664a71df50SFrank Blaschka if (recovery_mode && 11674a71df50SFrank Blaschka card->info.type != QETH_CARD_TYPE_OSN) { 116839423440SUrsula Braun __qeth_l2_open(card->dev); 11694a71df50SFrank Blaschka } else { 11704a71df50SFrank Blaschka rtnl_lock(); 11714a71df50SFrank Blaschka dev_open(card->dev); 11724a71df50SFrank Blaschka rtnl_unlock(); 11734a71df50SFrank Blaschka } 11744a71df50SFrank Blaschka /* this also sets saved unicast addresses */ 1175fe5c8028SLakhvich Dmitriy qeth_l2_set_rx_mode(card->dev); 1176e830baa9SHans Wippel rtnl_lock(); 1177e830baa9SHans Wippel qeth_recover_features(card->dev); 1178e830baa9SHans Wippel rtnl_unlock(); 11794a71df50SFrank Blaschka } 11804a71df50SFrank Blaschka /* let user_space know that device is online */ 11814a71df50SFrank Blaschka kobject_uevent(&gdev->dev.kobj, KOBJ_CHANGE); 1182c4949f07SFrank Blaschka mutex_unlock(&card->conf_mutex); 11839dc48cccSUrsula Braun mutex_unlock(&card->discipline_mutex); 11844a71df50SFrank Blaschka return 0; 1185aa909224SUrsula Braun 11864a71df50SFrank Blaschka out_remove: 11874a71df50SFrank Blaschka qeth_l2_stop_card(card, 0); 11884a71df50SFrank Blaschka ccw_device_set_offline(CARD_DDEV(card)); 11894a71df50SFrank Blaschka ccw_device_set_offline(CARD_WDEV(card)); 11904a71df50SFrank Blaschka ccw_device_set_offline(CARD_RDEV(card)); 119122ae2790SUrsula Braun qdio_free(CARD_DDEV(card)); 11924a71df50SFrank Blaschka if (recover_flag == CARD_STATE_RECOVER) 11934a71df50SFrank Blaschka card->state = CARD_STATE_RECOVER; 11944a71df50SFrank Blaschka else 11954a71df50SFrank Blaschka card->state = CARD_STATE_DOWN; 1196c4949f07SFrank Blaschka mutex_unlock(&card->conf_mutex); 11979dc48cccSUrsula Braun mutex_unlock(&card->discipline_mutex); 1198aa909224SUrsula Braun return rc; 11994a71df50SFrank Blaschka } 12004a71df50SFrank Blaschka 12014a71df50SFrank Blaschka static int qeth_l2_set_online(struct ccwgroup_device *gdev) 12024a71df50SFrank Blaschka { 12034a71df50SFrank Blaschka return __qeth_l2_set_online(gdev, 0); 12044a71df50SFrank Blaschka } 12054a71df50SFrank Blaschka 12064a71df50SFrank Blaschka static int __qeth_l2_set_offline(struct ccwgroup_device *cgdev, 12074a71df50SFrank Blaschka int recovery_mode) 12084a71df50SFrank Blaschka { 12094a71df50SFrank Blaschka struct qeth_card *card = dev_get_drvdata(&cgdev->dev); 12104a71df50SFrank Blaschka int rc = 0, rc2 = 0, rc3 = 0; 12114a71df50SFrank Blaschka enum qeth_card_states recover_flag; 12124a71df50SFrank Blaschka 12139dc48cccSUrsula Braun mutex_lock(&card->discipline_mutex); 1214c4949f07SFrank Blaschka mutex_lock(&card->conf_mutex); 1215d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 3, "setoffl"); 1216d11ba0c4SPeter Tiedemann QETH_DBF_HEX(SETUP, 3, &card, sizeof(void *)); 12174a71df50SFrank Blaschka 12184a71df50SFrank Blaschka if (card->dev && netif_carrier_ok(card->dev)) 12194a71df50SFrank Blaschka netif_carrier_off(card->dev); 12204a71df50SFrank Blaschka recover_flag = card->state; 12211da74b1cSFrank Blaschka if ((!recovery_mode && card->info.hwtrap) || card->info.hwtrap == 2) { 12221da74b1cSFrank Blaschka qeth_hw_trap(card, QETH_DIAGS_TRAP_DISARM); 12231da74b1cSFrank Blaschka card->info.hwtrap = 1; 12241da74b1cSFrank Blaschka } 12250f5623c9SUrsula Braun qeth_l2_stop_card(card, recovery_mode); 12264a71df50SFrank Blaschka rc = ccw_device_set_offline(CARD_DDEV(card)); 12274a71df50SFrank Blaschka rc2 = ccw_device_set_offline(CARD_WDEV(card)); 12284a71df50SFrank Blaschka rc3 = ccw_device_set_offline(CARD_RDEV(card)); 12294a71df50SFrank Blaschka if (!rc) 12304a71df50SFrank Blaschka rc = (rc2) ? rc2 : rc3; 12314a71df50SFrank Blaschka if (rc) 1232d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "1err%d", rc); 123322ae2790SUrsula Braun qdio_free(CARD_DDEV(card)); 12344a71df50SFrank Blaschka if (recover_flag == CARD_STATE_UP) 12354a71df50SFrank Blaschka card->state = CARD_STATE_RECOVER; 12364a71df50SFrank Blaschka /* let user_space know that device is offline */ 12374a71df50SFrank Blaschka kobject_uevent(&cgdev->dev.kobj, KOBJ_CHANGE); 1238c4949f07SFrank Blaschka mutex_unlock(&card->conf_mutex); 12399dc48cccSUrsula Braun mutex_unlock(&card->discipline_mutex); 12404a71df50SFrank Blaschka return 0; 12414a71df50SFrank Blaschka } 12424a71df50SFrank Blaschka 12434a71df50SFrank Blaschka static int qeth_l2_set_offline(struct ccwgroup_device *cgdev) 12444a71df50SFrank Blaschka { 12454a71df50SFrank Blaschka return __qeth_l2_set_offline(cgdev, 0); 12464a71df50SFrank Blaschka } 12474a71df50SFrank Blaschka 12484a71df50SFrank Blaschka static int qeth_l2_recover(void *ptr) 12494a71df50SFrank Blaschka { 12504a71df50SFrank Blaschka struct qeth_card *card; 12514a71df50SFrank Blaschka int rc = 0; 12524a71df50SFrank Blaschka 12534a71df50SFrank Blaschka card = (struct qeth_card *) ptr; 1254847a50fdSCarsten Otte QETH_CARD_TEXT(card, 2, "recover1"); 12554a71df50SFrank Blaschka if (!qeth_do_run_thread(card, QETH_RECOVER_THREAD)) 12564a71df50SFrank Blaschka return 0; 1257847a50fdSCarsten Otte QETH_CARD_TEXT(card, 2, "recover2"); 125874eacdb9SFrank Blaschka dev_warn(&card->gdev->dev, 125974eacdb9SFrank Blaschka "A recovery process has been started for the device\n"); 126065d8013cSStefan Raspl qeth_set_recovery_task(card); 12614a71df50SFrank Blaschka __qeth_l2_set_offline(card->gdev, 1); 12624a71df50SFrank Blaschka rc = __qeth_l2_set_online(card->gdev, 1); 12634a71df50SFrank Blaschka if (!rc) 126474eacdb9SFrank Blaschka dev_info(&card->gdev->dev, 126574eacdb9SFrank Blaschka "Device successfully recovered!\n"); 126628a7e4c9SUrsula Braun else { 12670f54761dSStefan Raspl qeth_close_dev(card); 126874eacdb9SFrank Blaschka dev_warn(&card->gdev->dev, "The qeth device driver " 126974eacdb9SFrank Blaschka "failed to recover an error on the device\n"); 127028a7e4c9SUrsula Braun } 127165d8013cSStefan Raspl qeth_clear_recovery_task(card); 1272a1c3ed4cSFrank Blaschka qeth_clear_thread_start_bit(card, QETH_RECOVER_THREAD); 1273a1c3ed4cSFrank Blaschka qeth_clear_thread_running_bit(card, QETH_RECOVER_THREAD); 12744a71df50SFrank Blaschka return 0; 12754a71df50SFrank Blaschka } 12764a71df50SFrank Blaschka 12774a71df50SFrank Blaschka static int __init qeth_l2_init(void) 12784a71df50SFrank Blaschka { 127974eacdb9SFrank Blaschka pr_info("register layer 2 discipline\n"); 12804a71df50SFrank Blaschka return 0; 12814a71df50SFrank Blaschka } 12824a71df50SFrank Blaschka 12834a71df50SFrank Blaschka static void __exit qeth_l2_exit(void) 12844a71df50SFrank Blaschka { 128574eacdb9SFrank Blaschka pr_info("unregister layer 2 discipline\n"); 12864a71df50SFrank Blaschka } 12874a71df50SFrank Blaschka 1288bbcfcdc8SFrank Blaschka static int qeth_l2_pm_suspend(struct ccwgroup_device *gdev) 1289bbcfcdc8SFrank Blaschka { 1290bbcfcdc8SFrank Blaschka struct qeth_card *card = dev_get_drvdata(&gdev->dev); 1291bbcfcdc8SFrank Blaschka 1292bbcfcdc8SFrank Blaschka if (card->dev) 1293bbcfcdc8SFrank Blaschka netif_device_detach(card->dev); 1294bbcfcdc8SFrank Blaschka qeth_set_allowed_threads(card, 0, 1); 1295bbcfcdc8SFrank Blaschka wait_event(card->wait_q, qeth_threads_running(card, 0xffffffff) == 0); 1296bbcfcdc8SFrank Blaschka if (gdev->state == CCWGROUP_OFFLINE) 1297bbcfcdc8SFrank Blaschka return 0; 1298bbcfcdc8SFrank Blaschka if (card->state == CARD_STATE_UP) { 12991da74b1cSFrank Blaschka if (card->info.hwtrap) 13001da74b1cSFrank Blaschka qeth_hw_trap(card, QETH_DIAGS_TRAP_DISARM); 1301bbcfcdc8SFrank Blaschka __qeth_l2_set_offline(card->gdev, 1); 1302bbcfcdc8SFrank Blaschka } else 1303bbcfcdc8SFrank Blaschka __qeth_l2_set_offline(card->gdev, 0); 1304bbcfcdc8SFrank Blaschka return 0; 1305bbcfcdc8SFrank Blaschka } 1306bbcfcdc8SFrank Blaschka 1307bbcfcdc8SFrank Blaschka static int qeth_l2_pm_resume(struct ccwgroup_device *gdev) 1308bbcfcdc8SFrank Blaschka { 1309bbcfcdc8SFrank Blaschka struct qeth_card *card = dev_get_drvdata(&gdev->dev); 1310bbcfcdc8SFrank Blaschka int rc = 0; 1311bbcfcdc8SFrank Blaschka 1312bbcfcdc8SFrank Blaschka if (gdev->state == CCWGROUP_OFFLINE) 1313bbcfcdc8SFrank Blaschka goto out; 1314bbcfcdc8SFrank Blaschka 1315bbcfcdc8SFrank Blaschka if (card->state == CARD_STATE_RECOVER) { 1316bbcfcdc8SFrank Blaschka rc = __qeth_l2_set_online(card->gdev, 1); 1317bbcfcdc8SFrank Blaschka if (rc) { 1318bbcfcdc8SFrank Blaschka rtnl_lock(); 1319bbcfcdc8SFrank Blaschka dev_close(card->dev); 1320bbcfcdc8SFrank Blaschka rtnl_unlock(); 1321bbcfcdc8SFrank Blaschka } 1322bbcfcdc8SFrank Blaschka } else 1323bbcfcdc8SFrank Blaschka rc = __qeth_l2_set_online(card->gdev, 0); 1324bbcfcdc8SFrank Blaschka out: 1325bbcfcdc8SFrank Blaschka qeth_set_allowed_threads(card, 0xffffffff, 0); 1326bbcfcdc8SFrank Blaschka if (card->dev) 1327bbcfcdc8SFrank Blaschka netif_device_attach(card->dev); 1328bbcfcdc8SFrank Blaschka if (rc) 1329bbcfcdc8SFrank Blaschka dev_warn(&card->gdev->dev, "The qeth device driver " 1330bbcfcdc8SFrank Blaschka "failed to recover an error on the device\n"); 1331bbcfcdc8SFrank Blaschka return rc; 1332bbcfcdc8SFrank Blaschka } 1333bbcfcdc8SFrank Blaschka 1334c044dc21SEugene Crosser /* Returns zero if the command is successfully "consumed" */ 1335c044dc21SEugene Crosser static int qeth_l2_control_event(struct qeth_card *card, 1336c044dc21SEugene Crosser struct qeth_ipa_cmd *cmd) 1337c044dc21SEugene Crosser { 1338c044dc21SEugene Crosser switch (cmd->hdr.command) { 13399c23f4daSEugene Crosser case IPA_CMD_SETBRIDGEPORT_OSA: 13409c23f4daSEugene Crosser case IPA_CMD_SETBRIDGEPORT_IQD: 1341c044dc21SEugene Crosser if (cmd->data.sbp.hdr.command_code == 1342c044dc21SEugene Crosser IPA_SBP_BRIDGE_PORT_STATE_CHANGE) { 1343c044dc21SEugene Crosser qeth_bridge_state_change(card, cmd); 1344c044dc21SEugene Crosser return 0; 1345c044dc21SEugene Crosser } else 1346c044dc21SEugene Crosser return 1; 1347c044dc21SEugene Crosser case IPA_CMD_ADDRESS_CHANGE_NOTIF: 1348c044dc21SEugene Crosser qeth_bridge_host_event(card, cmd); 1349c044dc21SEugene Crosser return 0; 1350c044dc21SEugene Crosser default: 1351c044dc21SEugene Crosser return 1; 1352c044dc21SEugene Crosser } 1353c044dc21SEugene Crosser } 1354c044dc21SEugene Crosser 1355c041f2d4SSebastian Ott struct qeth_discipline qeth_l2_discipline = { 13562d2ebb3eSJulian Wiedmann .devtype = &qeth_l2_devtype, 1357c041f2d4SSebastian Ott .start_poll = qeth_qdio_start_poll, 1358c041f2d4SSebastian Ott .input_handler = (qdio_handler_t *) qeth_qdio_input_handler, 1359c041f2d4SSebastian Ott .output_handler = (qdio_handler_t *) qeth_qdio_output_handler, 1360d73ef324SJulian Wiedmann .process_rx_buffer = qeth_l2_process_inbound_buffer, 1361c041f2d4SSebastian Ott .recover = qeth_l2_recover, 1362c041f2d4SSebastian Ott .setup = qeth_l2_probe_device, 13634a71df50SFrank Blaschka .remove = qeth_l2_remove_device, 13644a71df50SFrank Blaschka .set_online = qeth_l2_set_online, 13654a71df50SFrank Blaschka .set_offline = qeth_l2_set_offline, 1366bbcfcdc8SFrank Blaschka .freeze = qeth_l2_pm_suspend, 1367bbcfcdc8SFrank Blaschka .thaw = qeth_l2_pm_resume, 1368bbcfcdc8SFrank Blaschka .restore = qeth_l2_pm_resume, 1369942d6984SJulian Wiedmann .do_ioctl = NULL, 1370c044dc21SEugene Crosser .control_event_handler = qeth_l2_control_event, 13714a71df50SFrank Blaschka }; 1372c041f2d4SSebastian Ott EXPORT_SYMBOL_GPL(qeth_l2_discipline); 13734a71df50SFrank Blaschka 13744a71df50SFrank Blaschka static int qeth_osn_send_control_data(struct qeth_card *card, int len, 13754a71df50SFrank Blaschka struct qeth_cmd_buffer *iob) 13764a71df50SFrank Blaschka { 13774a71df50SFrank Blaschka unsigned long flags; 13784a71df50SFrank Blaschka int rc = 0; 13794a71df50SFrank Blaschka 1380847a50fdSCarsten Otte QETH_CARD_TEXT(card, 5, "osndctrd"); 13814a71df50SFrank Blaschka 13824a71df50SFrank Blaschka wait_event(card->wait_q, 13834a71df50SFrank Blaschka atomic_cmpxchg(&card->write.irq_pending, 0, 1) == 0); 13844a71df50SFrank Blaschka qeth_prepare_control_data(card, len, iob); 1385847a50fdSCarsten Otte QETH_CARD_TEXT(card, 6, "osnoirqp"); 13864a71df50SFrank Blaschka spin_lock_irqsave(get_ccwdev_lock(card->write.ccwdev), flags); 13874a71df50SFrank Blaschka rc = ccw_device_start(card->write.ccwdev, &card->write.ccw, 13884a71df50SFrank Blaschka (addr_t) iob, 0, 0); 13894a71df50SFrank Blaschka spin_unlock_irqrestore(get_ccwdev_lock(card->write.ccwdev), flags); 13904a71df50SFrank Blaschka if (rc) { 139114cc21b6SFrank Blaschka QETH_DBF_MESSAGE(2, "qeth_osn_send_control_data: " 13924a71df50SFrank Blaschka "ccw_device_start rc = %i\n", rc); 1393847a50fdSCarsten Otte QETH_CARD_TEXT_(card, 2, " err%d", rc); 13944a71df50SFrank Blaschka qeth_release_buffer(iob->channel, iob); 13954a71df50SFrank Blaschka atomic_set(&card->write.irq_pending, 0); 13964a71df50SFrank Blaschka wake_up(&card->wait_q); 13974a71df50SFrank Blaschka } 13984a71df50SFrank Blaschka return rc; 13994a71df50SFrank Blaschka } 14004a71df50SFrank Blaschka 14014a71df50SFrank Blaschka static int qeth_osn_send_ipa_cmd(struct qeth_card *card, 14024a71df50SFrank Blaschka struct qeth_cmd_buffer *iob, int data_len) 14034a71df50SFrank Blaschka { 14044a71df50SFrank Blaschka u16 s1, s2; 14054a71df50SFrank Blaschka 1406847a50fdSCarsten Otte QETH_CARD_TEXT(card, 4, "osndipa"); 14074a71df50SFrank Blaschka 14084a71df50SFrank Blaschka qeth_prepare_ipa_cmd(card, iob, QETH_PROT_OSN2); 14094a71df50SFrank Blaschka s1 = (u16)(IPA_PDU_HEADER_SIZE + data_len); 14104a71df50SFrank Blaschka s2 = (u16)data_len; 14114a71df50SFrank Blaschka memcpy(QETH_IPA_PDU_LEN_TOTAL(iob->data), &s1, 2); 14124a71df50SFrank Blaschka memcpy(QETH_IPA_PDU_LEN_PDU1(iob->data), &s2, 2); 14134a71df50SFrank Blaschka memcpy(QETH_IPA_PDU_LEN_PDU2(iob->data), &s2, 2); 14144a71df50SFrank Blaschka memcpy(QETH_IPA_PDU_LEN_PDU3(iob->data), &s2, 2); 14154a71df50SFrank Blaschka return qeth_osn_send_control_data(card, s1, iob); 14164a71df50SFrank Blaschka } 14174a71df50SFrank Blaschka 14184a71df50SFrank Blaschka int qeth_osn_assist(struct net_device *dev, void *data, int data_len) 14194a71df50SFrank Blaschka { 14204a71df50SFrank Blaschka struct qeth_cmd_buffer *iob; 14214a71df50SFrank Blaschka struct qeth_card *card; 14224a71df50SFrank Blaschka int rc; 14234a71df50SFrank Blaschka 14244a71df50SFrank Blaschka if (!dev) 14254a71df50SFrank Blaschka return -ENODEV; 1426509e2562SHeiko Carstens card = dev->ml_priv; 14274a71df50SFrank Blaschka if (!card) 14284a71df50SFrank Blaschka return -ENODEV; 1429847a50fdSCarsten Otte QETH_CARD_TEXT(card, 2, "osnsdmc"); 1430c3521254SEugene Crosser if (!qeth_card_hw_is_reachable(card)) 14314a71df50SFrank Blaschka return -ENODEV; 14324a71df50SFrank Blaschka iob = qeth_wait_for_buffer(&card->write); 14334a71df50SFrank Blaschka memcpy(iob->data+IPA_PDU_HEADER_SIZE, data, data_len); 14344a71df50SFrank Blaschka rc = qeth_osn_send_ipa_cmd(card, iob, data_len); 14354a71df50SFrank Blaschka return rc; 14364a71df50SFrank Blaschka } 14374a71df50SFrank Blaschka EXPORT_SYMBOL(qeth_osn_assist); 14384a71df50SFrank Blaschka 14394a71df50SFrank Blaschka int qeth_osn_register(unsigned char *read_dev_no, struct net_device **dev, 14404a71df50SFrank Blaschka int (*assist_cb)(struct net_device *, void *), 14414a71df50SFrank Blaschka int (*data_cb)(struct sk_buff *)) 14424a71df50SFrank Blaschka { 14434a71df50SFrank Blaschka struct qeth_card *card; 14444a71df50SFrank Blaschka 14454a71df50SFrank Blaschka *dev = qeth_l2_netdev_by_devno(read_dev_no); 14464a71df50SFrank Blaschka if (*dev == NULL) 14474a71df50SFrank Blaschka return -ENODEV; 1448509e2562SHeiko Carstens card = (*dev)->ml_priv; 14494a71df50SFrank Blaschka if (!card) 14504a71df50SFrank Blaschka return -ENODEV; 1451847a50fdSCarsten Otte QETH_CARD_TEXT(card, 2, "osnreg"); 14524a71df50SFrank Blaschka if ((assist_cb == NULL) || (data_cb == NULL)) 14534a71df50SFrank Blaschka return -EINVAL; 14544a71df50SFrank Blaschka card->osn_info.assist_cb = assist_cb; 14554a71df50SFrank Blaschka card->osn_info.data_cb = data_cb; 14564a71df50SFrank Blaschka return 0; 14574a71df50SFrank Blaschka } 14584a71df50SFrank Blaschka EXPORT_SYMBOL(qeth_osn_register); 14594a71df50SFrank Blaschka 14604a71df50SFrank Blaschka void qeth_osn_deregister(struct net_device *dev) 14614a71df50SFrank Blaschka { 14624a71df50SFrank Blaschka struct qeth_card *card; 14634a71df50SFrank Blaschka 14644a71df50SFrank Blaschka if (!dev) 14654a71df50SFrank Blaschka return; 1466509e2562SHeiko Carstens card = dev->ml_priv; 14674a71df50SFrank Blaschka if (!card) 14684a71df50SFrank Blaschka return; 1469847a50fdSCarsten Otte QETH_CARD_TEXT(card, 2, "osndereg"); 14704a71df50SFrank Blaschka card->osn_info.assist_cb = NULL; 14714a71df50SFrank Blaschka card->osn_info.data_cb = NULL; 14724a71df50SFrank Blaschka return; 14734a71df50SFrank Blaschka } 14744a71df50SFrank Blaschka EXPORT_SYMBOL(qeth_osn_deregister); 14754a71df50SFrank Blaschka 1476b4d72c08SEugene Crosser /* SETBRIDGEPORT support, async notifications */ 1477b4d72c08SEugene Crosser 14789f48b9dbSEugene Crosser enum qeth_an_event_type {anev_reg_unreg, anev_abort, anev_reset}; 14799f48b9dbSEugene Crosser 14809f48b9dbSEugene Crosser /** 14819f48b9dbSEugene Crosser * qeth_bridge_emit_host_event() - bridgeport address change notification 14829f48b9dbSEugene Crosser * @card: qeth_card structure pointer, for udev events. 14839f48b9dbSEugene Crosser * @evtype: "normal" register/unregister, or abort, or reset. For abort 14849f48b9dbSEugene Crosser * and reset token and addr_lnid are unused and may be NULL. 14859f48b9dbSEugene Crosser * @code: event bitmask: high order bit 0x80 value 1 means removal of an 14869f48b9dbSEugene Crosser * object, 0 - addition of an object. 14879f48b9dbSEugene Crosser * 0x01 - VLAN, 0x02 - MAC, 0x03 - VLAN and MAC. 14889f48b9dbSEugene Crosser * @token: "network token" structure identifying physical address of the port. 14899f48b9dbSEugene Crosser * @addr_lnid: pointer to structure with MAC address and VLAN ID. 14909f48b9dbSEugene Crosser * 14919f48b9dbSEugene Crosser * This function is called when registrations and deregistrations are 14929f48b9dbSEugene Crosser * reported by the hardware, and also when notifications are enabled - 14939f48b9dbSEugene Crosser * for all currently registered addresses. 14949f48b9dbSEugene Crosser */ 14959f48b9dbSEugene Crosser static void qeth_bridge_emit_host_event(struct qeth_card *card, 14969f48b9dbSEugene Crosser enum qeth_an_event_type evtype, 14979f48b9dbSEugene Crosser u8 code, struct net_if_token *token, struct mac_addr_lnid *addr_lnid) 14989f48b9dbSEugene Crosser { 14999f48b9dbSEugene Crosser char str[7][32]; 15009f48b9dbSEugene Crosser char *env[8]; 15019f48b9dbSEugene Crosser int i = 0; 15029f48b9dbSEugene Crosser 15039f48b9dbSEugene Crosser switch (evtype) { 15049f48b9dbSEugene Crosser case anev_reg_unreg: 15059f48b9dbSEugene Crosser snprintf(str[i], sizeof(str[i]), "BRIDGEDHOST=%s", 15069f48b9dbSEugene Crosser (code & IPA_ADDR_CHANGE_CODE_REMOVAL) 15079f48b9dbSEugene Crosser ? "deregister" : "register"); 15089f48b9dbSEugene Crosser env[i] = str[i]; i++; 15099f48b9dbSEugene Crosser if (code & IPA_ADDR_CHANGE_CODE_VLANID) { 15109f48b9dbSEugene Crosser snprintf(str[i], sizeof(str[i]), "VLAN=%d", 15119f48b9dbSEugene Crosser addr_lnid->lnid); 15129f48b9dbSEugene Crosser env[i] = str[i]; i++; 15139f48b9dbSEugene Crosser } 15149f48b9dbSEugene Crosser if (code & IPA_ADDR_CHANGE_CODE_MACADDR) { 15159846e70bSEugene Crosser snprintf(str[i], sizeof(str[i]), "MAC=%pM", 15169846e70bSEugene Crosser addr_lnid->mac); 15179f48b9dbSEugene Crosser env[i] = str[i]; i++; 15189f48b9dbSEugene Crosser } 15199f48b9dbSEugene Crosser snprintf(str[i], sizeof(str[i]), "NTOK_BUSID=%x.%x.%04x", 15209f48b9dbSEugene Crosser token->cssid, token->ssid, token->devnum); 15219f48b9dbSEugene Crosser env[i] = str[i]; i++; 15229f48b9dbSEugene Crosser snprintf(str[i], sizeof(str[i]), "NTOK_IID=%02x", token->iid); 15239f48b9dbSEugene Crosser env[i] = str[i]; i++; 15249f48b9dbSEugene Crosser snprintf(str[i], sizeof(str[i]), "NTOK_CHPID=%02x", 15259f48b9dbSEugene Crosser token->chpid); 15269f48b9dbSEugene Crosser env[i] = str[i]; i++; 15279f48b9dbSEugene Crosser snprintf(str[i], sizeof(str[i]), "NTOK_CHID=%04x", token->chid); 15289f48b9dbSEugene Crosser env[i] = str[i]; i++; 15299f48b9dbSEugene Crosser break; 15309f48b9dbSEugene Crosser case anev_abort: 15319f48b9dbSEugene Crosser snprintf(str[i], sizeof(str[i]), "BRIDGEDHOST=abort"); 15329f48b9dbSEugene Crosser env[i] = str[i]; i++; 15339f48b9dbSEugene Crosser break; 15349f48b9dbSEugene Crosser case anev_reset: 15359f48b9dbSEugene Crosser snprintf(str[i], sizeof(str[i]), "BRIDGEDHOST=reset"); 15369f48b9dbSEugene Crosser env[i] = str[i]; i++; 15379f48b9dbSEugene Crosser break; 15389f48b9dbSEugene Crosser } 15399f48b9dbSEugene Crosser env[i] = NULL; 15409f48b9dbSEugene Crosser kobject_uevent_env(&card->gdev->dev.kobj, KOBJ_CHANGE, env); 15419f48b9dbSEugene Crosser } 15429f48b9dbSEugene Crosser 1543b4d72c08SEugene Crosser struct qeth_bridge_state_data { 1544b4d72c08SEugene Crosser struct work_struct worker; 1545b4d72c08SEugene Crosser struct qeth_card *card; 1546b4d72c08SEugene Crosser struct qeth_sbp_state_change qports; 1547b4d72c08SEugene Crosser }; 1548b4d72c08SEugene Crosser 1549b4d72c08SEugene Crosser static void qeth_bridge_state_change_worker(struct work_struct *work) 1550b4d72c08SEugene Crosser { 1551b4d72c08SEugene Crosser struct qeth_bridge_state_data *data = 1552b4d72c08SEugene Crosser container_of(work, struct qeth_bridge_state_data, worker); 1553b4d72c08SEugene Crosser /* We are only interested in the first entry - local port */ 1554b4d72c08SEugene Crosser struct qeth_sbp_port_entry *entry = &data->qports.entry[0]; 1555b4d72c08SEugene Crosser char env_locrem[32]; 1556b4d72c08SEugene Crosser char env_role[32]; 1557b4d72c08SEugene Crosser char env_state[32]; 1558b4d72c08SEugene Crosser char *env[] = { 1559b4d72c08SEugene Crosser env_locrem, 1560b4d72c08SEugene Crosser env_role, 1561b4d72c08SEugene Crosser env_state, 1562b4d72c08SEugene Crosser NULL 1563b4d72c08SEugene Crosser }; 1564b4d72c08SEugene Crosser 1565b4d72c08SEugene Crosser /* Role should not change by itself, but if it did, */ 1566b4d72c08SEugene Crosser /* information from the hardware is authoritative. */ 1567b4d72c08SEugene Crosser mutex_lock(&data->card->conf_mutex); 1568b4d72c08SEugene Crosser data->card->options.sbp.role = entry->role; 1569b4d72c08SEugene Crosser mutex_unlock(&data->card->conf_mutex); 1570b4d72c08SEugene Crosser 1571b4d72c08SEugene Crosser snprintf(env_locrem, sizeof(env_locrem), "BRIDGEPORT=statechange"); 1572b4d72c08SEugene Crosser snprintf(env_role, sizeof(env_role), "ROLE=%s", 1573b4d72c08SEugene Crosser (entry->role == QETH_SBP_ROLE_NONE) ? "none" : 1574b4d72c08SEugene Crosser (entry->role == QETH_SBP_ROLE_PRIMARY) ? "primary" : 1575b4d72c08SEugene Crosser (entry->role == QETH_SBP_ROLE_SECONDARY) ? "secondary" : 1576b4d72c08SEugene Crosser "<INVALID>"); 1577b4d72c08SEugene Crosser snprintf(env_state, sizeof(env_state), "STATE=%s", 1578b4d72c08SEugene Crosser (entry->state == QETH_SBP_STATE_INACTIVE) ? "inactive" : 1579b4d72c08SEugene Crosser (entry->state == QETH_SBP_STATE_STANDBY) ? "standby" : 1580b4d72c08SEugene Crosser (entry->state == QETH_SBP_STATE_ACTIVE) ? "active" : 1581b4d72c08SEugene Crosser "<INVALID>"); 1582b4d72c08SEugene Crosser kobject_uevent_env(&data->card->gdev->dev.kobj, 1583b4d72c08SEugene Crosser KOBJ_CHANGE, env); 1584b4d72c08SEugene Crosser kfree(data); 1585b4d72c08SEugene Crosser } 1586b4d72c08SEugene Crosser 1587c044dc21SEugene Crosser static void qeth_bridge_state_change(struct qeth_card *card, 1588c044dc21SEugene Crosser struct qeth_ipa_cmd *cmd) 1589b4d72c08SEugene Crosser { 1590b4d72c08SEugene Crosser struct qeth_sbp_state_change *qports = 1591b4d72c08SEugene Crosser &cmd->data.sbp.data.state_change; 1592b4d72c08SEugene Crosser struct qeth_bridge_state_data *data; 1593b4d72c08SEugene Crosser int extrasize; 1594b4d72c08SEugene Crosser 1595b4d72c08SEugene Crosser QETH_CARD_TEXT(card, 2, "brstchng"); 1596b4d72c08SEugene Crosser if (qports->entry_length != sizeof(struct qeth_sbp_port_entry)) { 15978a593148SThomas Richter QETH_CARD_TEXT_(card, 2, "BPsz%04x", qports->entry_length); 1598b4d72c08SEugene Crosser return; 1599b4d72c08SEugene Crosser } 1600b4d72c08SEugene Crosser extrasize = sizeof(struct qeth_sbp_port_entry) * qports->num_entries; 1601b4d72c08SEugene Crosser data = kzalloc(sizeof(struct qeth_bridge_state_data) + extrasize, 1602b4d72c08SEugene Crosser GFP_ATOMIC); 1603b4d72c08SEugene Crosser if (!data) { 1604b4d72c08SEugene Crosser QETH_CARD_TEXT(card, 2, "BPSalloc"); 1605b4d72c08SEugene Crosser return; 1606b4d72c08SEugene Crosser } 1607b4d72c08SEugene Crosser INIT_WORK(&data->worker, qeth_bridge_state_change_worker); 1608b4d72c08SEugene Crosser data->card = card; 1609b4d72c08SEugene Crosser memcpy(&data->qports, qports, 1610b4d72c08SEugene Crosser sizeof(struct qeth_sbp_state_change) + extrasize); 1611b4d72c08SEugene Crosser queue_work(qeth_wq, &data->worker); 1612b4d72c08SEugene Crosser } 1613b4d72c08SEugene Crosser 16149f48b9dbSEugene Crosser struct qeth_bridge_host_data { 16159f48b9dbSEugene Crosser struct work_struct worker; 16169f48b9dbSEugene Crosser struct qeth_card *card; 16179f48b9dbSEugene Crosser struct qeth_ipacmd_addr_change hostevs; 16189f48b9dbSEugene Crosser }; 16199f48b9dbSEugene Crosser 16209f48b9dbSEugene Crosser static void qeth_bridge_host_event_worker(struct work_struct *work) 16219f48b9dbSEugene Crosser { 16229f48b9dbSEugene Crosser struct qeth_bridge_host_data *data = 16239f48b9dbSEugene Crosser container_of(work, struct qeth_bridge_host_data, worker); 16249f48b9dbSEugene Crosser int i; 16259f48b9dbSEugene Crosser 16269f48b9dbSEugene Crosser if (data->hostevs.lost_event_mask) { 16279f48b9dbSEugene Crosser dev_info(&data->card->gdev->dev, 16289c23f4daSEugene Crosser "Address notification from the Bridge Port stopped %s (%s)\n", 16299f48b9dbSEugene Crosser data->card->dev->name, 16309f48b9dbSEugene Crosser (data->hostevs.lost_event_mask == 0x01) 16319f48b9dbSEugene Crosser ? "Overflow" 16329f48b9dbSEugene Crosser : (data->hostevs.lost_event_mask == 0x02) 16339f48b9dbSEugene Crosser ? "Bridge port state change" 16349f48b9dbSEugene Crosser : "Unknown reason"); 16359f48b9dbSEugene Crosser mutex_lock(&data->card->conf_mutex); 16369f48b9dbSEugene Crosser data->card->options.sbp.hostnotification = 0; 16379f48b9dbSEugene Crosser mutex_unlock(&data->card->conf_mutex); 16389f48b9dbSEugene Crosser qeth_bridge_emit_host_event(data->card, anev_abort, 16399f48b9dbSEugene Crosser 0, NULL, NULL); 16409f48b9dbSEugene Crosser } else 16419f48b9dbSEugene Crosser for (i = 0; i < data->hostevs.num_entries; i++) { 16429f48b9dbSEugene Crosser struct qeth_ipacmd_addr_change_entry *entry = 16439f48b9dbSEugene Crosser &data->hostevs.entry[i]; 16449f48b9dbSEugene Crosser qeth_bridge_emit_host_event(data->card, 16459f48b9dbSEugene Crosser anev_reg_unreg, 16469f48b9dbSEugene Crosser entry->change_code, 16479f48b9dbSEugene Crosser &entry->token, &entry->addr_lnid); 16489f48b9dbSEugene Crosser } 16499f48b9dbSEugene Crosser kfree(data); 16509f48b9dbSEugene Crosser } 16519f48b9dbSEugene Crosser 1652c044dc21SEugene Crosser static void qeth_bridge_host_event(struct qeth_card *card, 1653c044dc21SEugene Crosser struct qeth_ipa_cmd *cmd) 16549f48b9dbSEugene Crosser { 16559f48b9dbSEugene Crosser struct qeth_ipacmd_addr_change *hostevs = 16569f48b9dbSEugene Crosser &cmd->data.addrchange; 16579f48b9dbSEugene Crosser struct qeth_bridge_host_data *data; 16589f48b9dbSEugene Crosser int extrasize; 16599f48b9dbSEugene Crosser 16609f48b9dbSEugene Crosser QETH_CARD_TEXT(card, 2, "brhostev"); 16619f48b9dbSEugene Crosser if (cmd->hdr.return_code != 0x0000) { 16629f48b9dbSEugene Crosser if (cmd->hdr.return_code == 0x0010) { 16639f48b9dbSEugene Crosser if (hostevs->lost_event_mask == 0x00) 16649f48b9dbSEugene Crosser hostevs->lost_event_mask = 0xff; 16659f48b9dbSEugene Crosser } else { 16669f48b9dbSEugene Crosser QETH_CARD_TEXT_(card, 2, "BPHe%04x", 16679f48b9dbSEugene Crosser cmd->hdr.return_code); 16689f48b9dbSEugene Crosser return; 16699f48b9dbSEugene Crosser } 16709f48b9dbSEugene Crosser } 16719f48b9dbSEugene Crosser extrasize = sizeof(struct qeth_ipacmd_addr_change_entry) * 16729f48b9dbSEugene Crosser hostevs->num_entries; 16739f48b9dbSEugene Crosser data = kzalloc(sizeof(struct qeth_bridge_host_data) + extrasize, 16749f48b9dbSEugene Crosser GFP_ATOMIC); 16759f48b9dbSEugene Crosser if (!data) { 16769f48b9dbSEugene Crosser QETH_CARD_TEXT(card, 2, "BPHalloc"); 16779f48b9dbSEugene Crosser return; 16789f48b9dbSEugene Crosser } 16799f48b9dbSEugene Crosser INIT_WORK(&data->worker, qeth_bridge_host_event_worker); 16809f48b9dbSEugene Crosser data->card = card; 16819f48b9dbSEugene Crosser memcpy(&data->hostevs, hostevs, 16829f48b9dbSEugene Crosser sizeof(struct qeth_ipacmd_addr_change) + extrasize); 16839f48b9dbSEugene Crosser queue_work(qeth_wq, &data->worker); 16849f48b9dbSEugene Crosser } 16859f48b9dbSEugene Crosser 1686b4d72c08SEugene Crosser /* SETBRIDGEPORT support; sending commands */ 1687b4d72c08SEugene Crosser 1688b4d72c08SEugene Crosser struct _qeth_sbp_cbctl { 1689b4d72c08SEugene Crosser u16 ipa_rc; 1690b4d72c08SEugene Crosser u16 cmd_rc; 1691b4d72c08SEugene Crosser union { 1692b4d72c08SEugene Crosser u32 supported; 1693b4d72c08SEugene Crosser struct { 1694b4d72c08SEugene Crosser enum qeth_sbp_roles *role; 1695b4d72c08SEugene Crosser enum qeth_sbp_states *state; 1696b4d72c08SEugene Crosser } qports; 1697b4d72c08SEugene Crosser } data; 1698b4d72c08SEugene Crosser }; 1699b4d72c08SEugene Crosser 1700b4d72c08SEugene Crosser /** 1701b4d72c08SEugene Crosser * qeth_bridgeport_makerc() - derive "traditional" error from hardware codes. 1702b4d72c08SEugene Crosser * @card: qeth_card structure pointer, for debug messages. 1703b4d72c08SEugene Crosser * @cbctl: state structure with hardware return codes. 1704b4d72c08SEugene Crosser * @setcmd: IPA command code 1705b4d72c08SEugene Crosser * 1706b4d72c08SEugene Crosser * Returns negative errno-compatible error indication or 0 on success. 1707b4d72c08SEugene Crosser */ 1708b4d72c08SEugene Crosser static int qeth_bridgeport_makerc(struct qeth_card *card, 1709b4d72c08SEugene Crosser struct _qeth_sbp_cbctl *cbctl, enum qeth_ipa_sbp_cmd setcmd) 1710b4d72c08SEugene Crosser { 1711b4d72c08SEugene Crosser int rc; 17129c23f4daSEugene Crosser int is_iqd = (card->info.type == QETH_CARD_TYPE_IQD); 1713b4d72c08SEugene Crosser 17149c23f4daSEugene Crosser if ((is_iqd && (cbctl->ipa_rc == IPA_RC_SUCCESS)) || 17159c23f4daSEugene Crosser (!is_iqd && (cbctl->ipa_rc == cbctl->cmd_rc))) 1716b4d72c08SEugene Crosser switch (cbctl->cmd_rc) { 17172063a5f5SKittipon Meesompop case IPA_RC_SUCCESS: 1718b4d72c08SEugene Crosser rc = 0; 1719b4d72c08SEugene Crosser break; 17202063a5f5SKittipon Meesompop case IPA_RC_L2_UNSUPPORTED_CMD: 17212063a5f5SKittipon Meesompop case IPA_RC_UNSUPPORTED_COMMAND: 1722ffb95251SEugene Crosser rc = -EOPNOTSUPP; 1723b4d72c08SEugene Crosser break; 17242063a5f5SKittipon Meesompop case IPA_RC_SBP_OSA_NOT_CONFIGURED: 17252063a5f5SKittipon Meesompop case IPA_RC_SBP_IQD_NOT_CONFIGURED: 1726b4d72c08SEugene Crosser rc = -ENODEV; /* maybe not the best code here? */ 1727b4d72c08SEugene Crosser dev_err(&card->gdev->dev, 17289c23f4daSEugene Crosser "The device is not configured as a Bridge Port\n"); 1729b4d72c08SEugene Crosser break; 17302063a5f5SKittipon Meesompop case IPA_RC_SBP_OSA_OS_MISMATCH: 17312063a5f5SKittipon Meesompop case IPA_RC_SBP_IQD_OS_MISMATCH: 17321b05cf62SEugene Crosser rc = -EPERM; 17331b05cf62SEugene Crosser dev_err(&card->gdev->dev, 17341b05cf62SEugene Crosser "A Bridge Port is already configured by a different operating system\n"); 17351b05cf62SEugene Crosser break; 17362063a5f5SKittipon Meesompop case IPA_RC_SBP_OSA_ANO_DEV_PRIMARY: 17372063a5f5SKittipon Meesompop case IPA_RC_SBP_IQD_ANO_DEV_PRIMARY: 1738b4d72c08SEugene Crosser switch (setcmd) { 1739b4d72c08SEugene Crosser case IPA_SBP_SET_PRIMARY_BRIDGE_PORT: 1740b4d72c08SEugene Crosser rc = -EEXIST; 1741b4d72c08SEugene Crosser dev_err(&card->gdev->dev, 17429c23f4daSEugene Crosser "The LAN already has a primary Bridge Port\n"); 1743b4d72c08SEugene Crosser break; 1744b4d72c08SEugene Crosser case IPA_SBP_SET_SECONDARY_BRIDGE_PORT: 1745b4d72c08SEugene Crosser rc = -EBUSY; 1746b4d72c08SEugene Crosser dev_err(&card->gdev->dev, 17479c23f4daSEugene Crosser "The device is already a primary Bridge Port\n"); 1748b4d72c08SEugene Crosser break; 1749b4d72c08SEugene Crosser default: 1750b4d72c08SEugene Crosser rc = -EIO; 1751b4d72c08SEugene Crosser } 1752b4d72c08SEugene Crosser break; 17532063a5f5SKittipon Meesompop case IPA_RC_SBP_OSA_CURRENT_SECOND: 17542063a5f5SKittipon Meesompop case IPA_RC_SBP_IQD_CURRENT_SECOND: 1755b4d72c08SEugene Crosser rc = -EBUSY; 1756b4d72c08SEugene Crosser dev_err(&card->gdev->dev, 17579c23f4daSEugene Crosser "The device is already a secondary Bridge Port\n"); 1758b4d72c08SEugene Crosser break; 17592063a5f5SKittipon Meesompop case IPA_RC_SBP_OSA_LIMIT_SECOND: 17602063a5f5SKittipon Meesompop case IPA_RC_SBP_IQD_LIMIT_SECOND: 1761b4d72c08SEugene Crosser rc = -EEXIST; 1762b4d72c08SEugene Crosser dev_err(&card->gdev->dev, 17639c23f4daSEugene Crosser "The LAN cannot have more secondary Bridge Ports\n"); 1764b4d72c08SEugene Crosser break; 17652063a5f5SKittipon Meesompop case IPA_RC_SBP_OSA_CURRENT_PRIMARY: 17662063a5f5SKittipon Meesompop case IPA_RC_SBP_IQD_CURRENT_PRIMARY: 1767b4d72c08SEugene Crosser rc = -EBUSY; 1768b4d72c08SEugene Crosser dev_err(&card->gdev->dev, 17699c23f4daSEugene Crosser "The device is already a primary Bridge Port\n"); 1770b4d72c08SEugene Crosser break; 17712063a5f5SKittipon Meesompop case IPA_RC_SBP_OSA_NOT_AUTHD_BY_ZMAN: 17722063a5f5SKittipon Meesompop case IPA_RC_SBP_IQD_NOT_AUTHD_BY_ZMAN: 1773b4d72c08SEugene Crosser rc = -EACCES; 1774b4d72c08SEugene Crosser dev_err(&card->gdev->dev, 17759c23f4daSEugene Crosser "The device is not authorized to be a Bridge Port\n"); 1776b4d72c08SEugene Crosser break; 1777b4d72c08SEugene Crosser default: 1778b4d72c08SEugene Crosser rc = -EIO; 1779b4d72c08SEugene Crosser } 17809c23f4daSEugene Crosser else 17819c23f4daSEugene Crosser switch (cbctl->ipa_rc) { 1782b4d72c08SEugene Crosser case IPA_RC_NOTSUPP: 1783ffb95251SEugene Crosser rc = -EOPNOTSUPP; 1784b4d72c08SEugene Crosser break; 1785b4d72c08SEugene Crosser case IPA_RC_UNSUPPORTED_COMMAND: 1786ffb95251SEugene Crosser rc = -EOPNOTSUPP; 1787b4d72c08SEugene Crosser break; 1788b4d72c08SEugene Crosser default: 1789b4d72c08SEugene Crosser rc = -EIO; 1790b4d72c08SEugene Crosser } 17919c23f4daSEugene Crosser 1792b4d72c08SEugene Crosser if (rc) { 1793b4d72c08SEugene Crosser QETH_CARD_TEXT_(card, 2, "SBPi%04x", cbctl->ipa_rc); 1794b4d72c08SEugene Crosser QETH_CARD_TEXT_(card, 2, "SBPc%04x", cbctl->cmd_rc); 1795b4d72c08SEugene Crosser } 1796b4d72c08SEugene Crosser return rc; 1797b4d72c08SEugene Crosser } 1798b4d72c08SEugene Crosser 1799d65626adSJulian Wiedmann static struct qeth_cmd_buffer *qeth_sbp_build_cmd(struct qeth_card *card, 1800d65626adSJulian Wiedmann enum qeth_ipa_sbp_cmd sbp_cmd, 1801d65626adSJulian Wiedmann unsigned int cmd_length) 18029c23f4daSEugene Crosser { 1803d65626adSJulian Wiedmann enum qeth_ipa_cmds ipa_cmd = (card->info.type == QETH_CARD_TYPE_IQD) ? 18049c23f4daSEugene Crosser IPA_CMD_SETBRIDGEPORT_IQD : 18059c23f4daSEugene Crosser IPA_CMD_SETBRIDGEPORT_OSA; 1806d65626adSJulian Wiedmann struct qeth_cmd_buffer *iob; 1807d65626adSJulian Wiedmann struct qeth_ipa_cmd *cmd; 1808d65626adSJulian Wiedmann 1809d65626adSJulian Wiedmann iob = qeth_get_ipacmd_buffer(card, ipa_cmd, 0); 1810d65626adSJulian Wiedmann if (!iob) 1811d65626adSJulian Wiedmann return iob; 1812d65626adSJulian Wiedmann cmd = (struct qeth_ipa_cmd *)(iob->data+IPA_PDU_HEADER_SIZE); 1813d65626adSJulian Wiedmann cmd->data.sbp.hdr.cmdlength = sizeof(struct qeth_ipacmd_sbp_hdr) + 1814d65626adSJulian Wiedmann cmd_length; 1815d65626adSJulian Wiedmann cmd->data.sbp.hdr.command_code = sbp_cmd; 1816d65626adSJulian Wiedmann cmd->data.sbp.hdr.used_total = 1; 1817d65626adSJulian Wiedmann cmd->data.sbp.hdr.seq_no = 1; 1818d65626adSJulian Wiedmann return iob; 18199c23f4daSEugene Crosser } 18209c23f4daSEugene Crosser 1821b4d72c08SEugene Crosser static int qeth_bridgeport_query_support_cb(struct qeth_card *card, 1822b4d72c08SEugene Crosser struct qeth_reply *reply, unsigned long data) 1823b4d72c08SEugene Crosser { 1824b4d72c08SEugene Crosser struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *) data; 1825b4d72c08SEugene Crosser struct _qeth_sbp_cbctl *cbctl = (struct _qeth_sbp_cbctl *)reply->param; 1826b4d72c08SEugene Crosser QETH_CARD_TEXT(card, 2, "brqsupcb"); 1827b4d72c08SEugene Crosser cbctl->ipa_rc = cmd->hdr.return_code; 1828b4d72c08SEugene Crosser cbctl->cmd_rc = cmd->data.sbp.hdr.return_code; 1829b4d72c08SEugene Crosser if ((cbctl->ipa_rc == 0) && (cbctl->cmd_rc == 0)) { 1830b4d72c08SEugene Crosser cbctl->data.supported = 1831b4d72c08SEugene Crosser cmd->data.sbp.data.query_cmds_supp.supported_cmds; 1832b4d72c08SEugene Crosser } else { 1833b4d72c08SEugene Crosser cbctl->data.supported = 0; 1834b4d72c08SEugene Crosser } 1835b4d72c08SEugene Crosser return 0; 1836b4d72c08SEugene Crosser } 1837b4d72c08SEugene Crosser 1838b4d72c08SEugene Crosser /** 1839b4d72c08SEugene Crosser * qeth_bridgeport_query_support() - store bitmask of supported subfunctions. 1840b4d72c08SEugene Crosser * @card: qeth_card structure pointer. 1841b4d72c08SEugene Crosser * 1842b4d72c08SEugene Crosser * Sets bitmask of supported setbridgeport subfunctions in the qeth_card 1843b4d72c08SEugene Crosser * strucutre: card->options.sbp.supported_funcs. 1844b4d72c08SEugene Crosser */ 1845c044dc21SEugene Crosser static void qeth_bridgeport_query_support(struct qeth_card *card) 1846b4d72c08SEugene Crosser { 1847b4d72c08SEugene Crosser struct qeth_cmd_buffer *iob; 1848b4d72c08SEugene Crosser struct _qeth_sbp_cbctl cbctl; 1849b4d72c08SEugene Crosser 1850b4d72c08SEugene Crosser QETH_CARD_TEXT(card, 2, "brqsuppo"); 1851d65626adSJulian Wiedmann iob = qeth_sbp_build_cmd(card, IPA_SBP_QUERY_COMMANDS_SUPPORTED, 1852d65626adSJulian Wiedmann sizeof(struct qeth_sbp_query_cmds_supp)); 18531aec42bcSThomas Richter if (!iob) 18541aec42bcSThomas Richter return; 1855b4d72c08SEugene Crosser if (qeth_send_ipa_cmd(card, iob, qeth_bridgeport_query_support_cb, 1856b4d72c08SEugene Crosser (void *)&cbctl) || 1857b4d72c08SEugene Crosser qeth_bridgeport_makerc(card, &cbctl, 1858b4d72c08SEugene Crosser IPA_SBP_QUERY_COMMANDS_SUPPORTED)) { 1859b4d72c08SEugene Crosser /* non-zero makerc signifies failure, and produce messages */ 1860b4d72c08SEugene Crosser card->options.sbp.role = QETH_SBP_ROLE_NONE; 1861b4d72c08SEugene Crosser return; 1862b4d72c08SEugene Crosser } 1863b4d72c08SEugene Crosser card->options.sbp.supported_funcs = cbctl.data.supported; 1864b4d72c08SEugene Crosser } 1865b4d72c08SEugene Crosser 1866b4d72c08SEugene Crosser static int qeth_bridgeport_query_ports_cb(struct qeth_card *card, 1867b4d72c08SEugene Crosser struct qeth_reply *reply, unsigned long data) 1868b4d72c08SEugene Crosser { 1869b4d72c08SEugene Crosser struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *) data; 1870b4d72c08SEugene Crosser struct qeth_sbp_query_ports *qports = &cmd->data.sbp.data.query_ports; 1871b4d72c08SEugene Crosser struct _qeth_sbp_cbctl *cbctl = (struct _qeth_sbp_cbctl *)reply->param; 1872b4d72c08SEugene Crosser 1873b4d72c08SEugene Crosser QETH_CARD_TEXT(card, 2, "brqprtcb"); 1874b4d72c08SEugene Crosser cbctl->ipa_rc = cmd->hdr.return_code; 1875b4d72c08SEugene Crosser cbctl->cmd_rc = cmd->data.sbp.hdr.return_code; 1876b4d72c08SEugene Crosser if ((cbctl->ipa_rc != 0) || (cbctl->cmd_rc != 0)) 1877b4d72c08SEugene Crosser return 0; 1878b4d72c08SEugene Crosser if (qports->entry_length != sizeof(struct qeth_sbp_port_entry)) { 1879b4d72c08SEugene Crosser cbctl->cmd_rc = 0xffff; 1880b4d72c08SEugene Crosser QETH_CARD_TEXT_(card, 2, "SBPs%04x", qports->entry_length); 1881b4d72c08SEugene Crosser return 0; 1882b4d72c08SEugene Crosser } 1883b4d72c08SEugene Crosser /* first entry contains the state of the local port */ 1884b4d72c08SEugene Crosser if (qports->num_entries > 0) { 1885b4d72c08SEugene Crosser if (cbctl->data.qports.role) 1886b4d72c08SEugene Crosser *cbctl->data.qports.role = qports->entry[0].role; 1887b4d72c08SEugene Crosser if (cbctl->data.qports.state) 1888b4d72c08SEugene Crosser *cbctl->data.qports.state = qports->entry[0].state; 1889b4d72c08SEugene Crosser } 1890b4d72c08SEugene Crosser return 0; 1891b4d72c08SEugene Crosser } 1892b4d72c08SEugene Crosser 1893b4d72c08SEugene Crosser /** 1894b4d72c08SEugene Crosser * qeth_bridgeport_query_ports() - query local bridgeport status. 1895b4d72c08SEugene Crosser * @card: qeth_card structure pointer. 1896b4d72c08SEugene Crosser * @role: Role of the port: 0-none, 1-primary, 2-secondary. 1897b4d72c08SEugene Crosser * @state: State of the port: 0-inactive, 1-standby, 2-active. 1898b4d72c08SEugene Crosser * 1899b4d72c08SEugene Crosser * Returns negative errno-compatible error indication or 0 on success. 1900b4d72c08SEugene Crosser * 1901b4d72c08SEugene Crosser * 'role' and 'state' are not updated in case of hardware operation failure. 1902b4d72c08SEugene Crosser */ 1903b4d72c08SEugene Crosser int qeth_bridgeport_query_ports(struct qeth_card *card, 1904b4d72c08SEugene Crosser enum qeth_sbp_roles *role, enum qeth_sbp_states *state) 1905b4d72c08SEugene Crosser { 1906b4d72c08SEugene Crosser int rc = 0; 1907b4d72c08SEugene Crosser struct qeth_cmd_buffer *iob; 1908b4d72c08SEugene Crosser struct _qeth_sbp_cbctl cbctl = { 1909b4d72c08SEugene Crosser .data = { 1910b4d72c08SEugene Crosser .qports = { 1911b4d72c08SEugene Crosser .role = role, 1912b4d72c08SEugene Crosser .state = state, 1913b4d72c08SEugene Crosser }, 1914b4d72c08SEugene Crosser }, 1915b4d72c08SEugene Crosser }; 1916b4d72c08SEugene Crosser 1917b4d72c08SEugene Crosser QETH_CARD_TEXT(card, 2, "brqports"); 1918b4d72c08SEugene Crosser if (!(card->options.sbp.supported_funcs & IPA_SBP_QUERY_BRIDGE_PORTS)) 1919b4d72c08SEugene Crosser return -EOPNOTSUPP; 1920d65626adSJulian Wiedmann iob = qeth_sbp_build_cmd(card, IPA_SBP_QUERY_BRIDGE_PORTS, 0); 19211aec42bcSThomas Richter if (!iob) 19221aec42bcSThomas Richter return -ENOMEM; 1923b4d72c08SEugene Crosser rc = qeth_send_ipa_cmd(card, iob, qeth_bridgeport_query_ports_cb, 1924b4d72c08SEugene Crosser (void *)&cbctl); 1925c88394e7SEugene Crosser if (rc < 0) 1926b4d72c08SEugene Crosser return rc; 1927c88394e7SEugene Crosser return qeth_bridgeport_makerc(card, &cbctl, IPA_SBP_QUERY_BRIDGE_PORTS); 1928b4d72c08SEugene Crosser } 1929b4d72c08SEugene Crosser EXPORT_SYMBOL_GPL(qeth_bridgeport_query_ports); 1930b4d72c08SEugene Crosser 1931b4d72c08SEugene Crosser static int qeth_bridgeport_set_cb(struct qeth_card *card, 1932b4d72c08SEugene Crosser struct qeth_reply *reply, unsigned long data) 1933b4d72c08SEugene Crosser { 1934b4d72c08SEugene Crosser struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *)data; 1935b4d72c08SEugene Crosser struct _qeth_sbp_cbctl *cbctl = (struct _qeth_sbp_cbctl *)reply->param; 1936b4d72c08SEugene Crosser QETH_CARD_TEXT(card, 2, "brsetrcb"); 1937b4d72c08SEugene Crosser cbctl->ipa_rc = cmd->hdr.return_code; 1938b4d72c08SEugene Crosser cbctl->cmd_rc = cmd->data.sbp.hdr.return_code; 1939b4d72c08SEugene Crosser return 0; 1940b4d72c08SEugene Crosser } 1941b4d72c08SEugene Crosser 1942b4d72c08SEugene Crosser /** 1943b4d72c08SEugene Crosser * qeth_bridgeport_setrole() - Assign primary role to the port. 1944b4d72c08SEugene Crosser * @card: qeth_card structure pointer. 1945b4d72c08SEugene Crosser * @role: Role to assign. 1946b4d72c08SEugene Crosser * 1947b4d72c08SEugene Crosser * Returns negative errno-compatible error indication or 0 on success. 1948b4d72c08SEugene Crosser */ 1949b4d72c08SEugene Crosser int qeth_bridgeport_setrole(struct qeth_card *card, enum qeth_sbp_roles role) 1950b4d72c08SEugene Crosser { 1951b4d72c08SEugene Crosser int rc = 0; 1952b4d72c08SEugene Crosser int cmdlength; 1953b4d72c08SEugene Crosser struct qeth_cmd_buffer *iob; 1954b4d72c08SEugene Crosser struct _qeth_sbp_cbctl cbctl; 1955b4d72c08SEugene Crosser enum qeth_ipa_sbp_cmd setcmd; 1956b4d72c08SEugene Crosser 1957b4d72c08SEugene Crosser QETH_CARD_TEXT(card, 2, "brsetrol"); 1958b4d72c08SEugene Crosser switch (role) { 1959b4d72c08SEugene Crosser case QETH_SBP_ROLE_NONE: 1960b4d72c08SEugene Crosser setcmd = IPA_SBP_RESET_BRIDGE_PORT_ROLE; 1961d65626adSJulian Wiedmann cmdlength = sizeof(struct qeth_sbp_reset_role); 1962b4d72c08SEugene Crosser break; 1963b4d72c08SEugene Crosser case QETH_SBP_ROLE_PRIMARY: 1964b4d72c08SEugene Crosser setcmd = IPA_SBP_SET_PRIMARY_BRIDGE_PORT; 1965d65626adSJulian Wiedmann cmdlength = sizeof(struct qeth_sbp_set_primary); 1966b4d72c08SEugene Crosser break; 1967b4d72c08SEugene Crosser case QETH_SBP_ROLE_SECONDARY: 1968b4d72c08SEugene Crosser setcmd = IPA_SBP_SET_SECONDARY_BRIDGE_PORT; 1969d65626adSJulian Wiedmann cmdlength = sizeof(struct qeth_sbp_set_secondary); 1970b4d72c08SEugene Crosser break; 1971b4d72c08SEugene Crosser default: 1972b4d72c08SEugene Crosser return -EINVAL; 1973b4d72c08SEugene Crosser } 1974b4d72c08SEugene Crosser if (!(card->options.sbp.supported_funcs & setcmd)) 1975b4d72c08SEugene Crosser return -EOPNOTSUPP; 1976d65626adSJulian Wiedmann iob = qeth_sbp_build_cmd(card, setcmd, cmdlength); 19771aec42bcSThomas Richter if (!iob) 19781aec42bcSThomas Richter return -ENOMEM; 1979b4d72c08SEugene Crosser rc = qeth_send_ipa_cmd(card, iob, qeth_bridgeport_set_cb, 1980b4d72c08SEugene Crosser (void *)&cbctl); 1981c88394e7SEugene Crosser if (rc < 0) 1982b4d72c08SEugene Crosser return rc; 1983c88394e7SEugene Crosser return qeth_bridgeport_makerc(card, &cbctl, setcmd); 1984b4d72c08SEugene Crosser } 1985b4d72c08SEugene Crosser 19869f48b9dbSEugene Crosser /** 19879f48b9dbSEugene Crosser * qeth_anset_makerc() - derive "traditional" error from hardware codes. 19889f48b9dbSEugene Crosser * @card: qeth_card structure pointer, for debug messages. 19899f48b9dbSEugene Crosser * 19909f48b9dbSEugene Crosser * Returns negative errno-compatible error indication or 0 on success. 19919f48b9dbSEugene Crosser */ 19929f48b9dbSEugene Crosser static int qeth_anset_makerc(struct qeth_card *card, int pnso_rc, u16 response) 19939f48b9dbSEugene Crosser { 19949f48b9dbSEugene Crosser int rc; 19959f48b9dbSEugene Crosser 19969f48b9dbSEugene Crosser if (pnso_rc == 0) 19979f48b9dbSEugene Crosser switch (response) { 19989f48b9dbSEugene Crosser case 0x0001: 19999f48b9dbSEugene Crosser rc = 0; 20009f48b9dbSEugene Crosser break; 20019f48b9dbSEugene Crosser case 0x0004: 20029f48b9dbSEugene Crosser case 0x0100: 20039f48b9dbSEugene Crosser case 0x0106: 2004ffb95251SEugene Crosser rc = -EOPNOTSUPP; 20059f48b9dbSEugene Crosser dev_err(&card->gdev->dev, 20069f48b9dbSEugene Crosser "Setting address notification failed\n"); 20079f48b9dbSEugene Crosser break; 20089f48b9dbSEugene Crosser case 0x0107: 20099f48b9dbSEugene Crosser rc = -EAGAIN; 20109f48b9dbSEugene Crosser break; 20119f48b9dbSEugene Crosser default: 20129f48b9dbSEugene Crosser rc = -EIO; 20139f48b9dbSEugene Crosser } 20149f48b9dbSEugene Crosser else 20159f48b9dbSEugene Crosser rc = -EIO; 20169f48b9dbSEugene Crosser 20179f48b9dbSEugene Crosser if (rc) { 20189f48b9dbSEugene Crosser QETH_CARD_TEXT_(card, 2, "SBPp%04x", pnso_rc); 20199f48b9dbSEugene Crosser QETH_CARD_TEXT_(card, 2, "SBPr%04x", response); 20209f48b9dbSEugene Crosser } 20219f48b9dbSEugene Crosser return rc; 20229f48b9dbSEugene Crosser } 20239f48b9dbSEugene Crosser 20249f48b9dbSEugene Crosser static void qeth_bridgeport_an_set_cb(void *priv, 20259f48b9dbSEugene Crosser enum qdio_brinfo_entry_type type, void *entry) 20269f48b9dbSEugene Crosser { 20279f48b9dbSEugene Crosser struct qeth_card *card = (struct qeth_card *)priv; 20289f48b9dbSEugene Crosser struct qdio_brinfo_entry_l2 *l2entry; 20299f48b9dbSEugene Crosser u8 code; 20309f48b9dbSEugene Crosser 20319f48b9dbSEugene Crosser if (type != l2_addr_lnid) { 20329f48b9dbSEugene Crosser WARN_ON_ONCE(1); 20339f48b9dbSEugene Crosser return; 20349f48b9dbSEugene Crosser } 20359f48b9dbSEugene Crosser 20369f48b9dbSEugene Crosser l2entry = (struct qdio_brinfo_entry_l2 *)entry; 20379f48b9dbSEugene Crosser code = IPA_ADDR_CHANGE_CODE_MACADDR; 20389f48b9dbSEugene Crosser if (l2entry->addr_lnid.lnid) 20399f48b9dbSEugene Crosser code |= IPA_ADDR_CHANGE_CODE_VLANID; 20409f48b9dbSEugene Crosser qeth_bridge_emit_host_event(card, anev_reg_unreg, code, 20419f48b9dbSEugene Crosser (struct net_if_token *)&l2entry->nit, 20429f48b9dbSEugene Crosser (struct mac_addr_lnid *)&l2entry->addr_lnid); 20439f48b9dbSEugene Crosser } 20449f48b9dbSEugene Crosser 20459f48b9dbSEugene Crosser /** 20469f48b9dbSEugene Crosser * qeth_bridgeport_an_set() - Enable or disable bridgeport address notification 20479f48b9dbSEugene Crosser * @card: qeth_card structure pointer. 20489f48b9dbSEugene Crosser * @enable: 0 - disable, non-zero - enable notifications 20499f48b9dbSEugene Crosser * 20509f48b9dbSEugene Crosser * Returns negative errno-compatible error indication or 0 on success. 20519f48b9dbSEugene Crosser * 20529f48b9dbSEugene Crosser * On enable, emits a series of address notifications udev events for all 20539f48b9dbSEugene Crosser * currently registered hosts. 20549f48b9dbSEugene Crosser */ 20559f48b9dbSEugene Crosser int qeth_bridgeport_an_set(struct qeth_card *card, int enable) 20569f48b9dbSEugene Crosser { 20579f48b9dbSEugene Crosser int rc; 20589f48b9dbSEugene Crosser u16 response; 20599f48b9dbSEugene Crosser struct ccw_device *ddev; 20609f48b9dbSEugene Crosser struct subchannel_id schid; 20619f48b9dbSEugene Crosser 20629f48b9dbSEugene Crosser if (!card) 20639f48b9dbSEugene Crosser return -EINVAL; 20649f48b9dbSEugene Crosser if (!card->options.sbp.supported_funcs) 20659f48b9dbSEugene Crosser return -EOPNOTSUPP; 20669f48b9dbSEugene Crosser ddev = CARD_DDEV(card); 20679f48b9dbSEugene Crosser ccw_device_get_schid(ddev, &schid); 20689f48b9dbSEugene Crosser 20699f48b9dbSEugene Crosser if (enable) { 20709f48b9dbSEugene Crosser qeth_bridge_emit_host_event(card, anev_reset, 0, NULL, NULL); 20719f48b9dbSEugene Crosser rc = qdio_pnso_brinfo(schid, 1, &response, 20729f48b9dbSEugene Crosser qeth_bridgeport_an_set_cb, card); 20739f48b9dbSEugene Crosser } else 20749f48b9dbSEugene Crosser rc = qdio_pnso_brinfo(schid, 0, &response, NULL, NULL); 20759f48b9dbSEugene Crosser return qeth_anset_makerc(card, rc, response); 20769f48b9dbSEugene Crosser } 20779f48b9dbSEugene Crosser EXPORT_SYMBOL_GPL(qeth_bridgeport_an_set); 20789f48b9dbSEugene Crosser 2079caa1f0b1SHans Wippel static bool qeth_bridgeport_is_in_use(struct qeth_card *card) 2080caa1f0b1SHans Wippel { 2081caa1f0b1SHans Wippel return (card->options.sbp.role || card->options.sbp.reflect_promisc || 2082caa1f0b1SHans Wippel card->options.sbp.hostnotification); 2083caa1f0b1SHans Wippel } 2084caa1f0b1SHans Wippel 2085a45b3fafSHans Wippel /* VNIC Characteristics support */ 2086a45b3fafSHans Wippel 2087a45b3fafSHans Wippel /* handle VNICC IPA command return codes; convert to error codes */ 2088a45b3fafSHans Wippel static int qeth_l2_vnicc_makerc(struct qeth_card *card, int ipa_rc) 2089a45b3fafSHans Wippel { 2090a45b3fafSHans Wippel int rc; 2091a45b3fafSHans Wippel 2092a45b3fafSHans Wippel switch (ipa_rc) { 2093a45b3fafSHans Wippel case IPA_RC_SUCCESS: 2094a45b3fafSHans Wippel return ipa_rc; 2095a45b3fafSHans Wippel case IPA_RC_L2_UNSUPPORTED_CMD: 2096a45b3fafSHans Wippel case IPA_RC_NOTSUPP: 2097a45b3fafSHans Wippel rc = -EOPNOTSUPP; 2098a45b3fafSHans Wippel break; 2099a45b3fafSHans Wippel case IPA_RC_VNICC_OOSEQ: 2100a45b3fafSHans Wippel rc = -EALREADY; 2101a45b3fafSHans Wippel break; 2102a45b3fafSHans Wippel case IPA_RC_VNICC_VNICBP: 2103a45b3fafSHans Wippel rc = -EBUSY; 2104a45b3fafSHans Wippel break; 2105a45b3fafSHans Wippel case IPA_RC_L2_ADDR_TABLE_FULL: 2106a45b3fafSHans Wippel rc = -ENOSPC; 2107a45b3fafSHans Wippel break; 2108a45b3fafSHans Wippel case IPA_RC_L2_MAC_NOT_AUTH_BY_ADP: 2109a45b3fafSHans Wippel rc = -EACCES; 2110a45b3fafSHans Wippel break; 2111a45b3fafSHans Wippel default: 2112a45b3fafSHans Wippel rc = -EIO; 2113a45b3fafSHans Wippel } 2114a45b3fafSHans Wippel 2115a45b3fafSHans Wippel QETH_CARD_TEXT_(card, 2, "err%04x", ipa_rc); 2116a45b3fafSHans Wippel return rc; 2117a45b3fafSHans Wippel } 2118a45b3fafSHans Wippel 2119a45b3fafSHans Wippel /* generic VNICC request call back control */ 2120a45b3fafSHans Wippel struct _qeth_l2_vnicc_request_cbctl { 2121a45b3fafSHans Wippel u32 sub_cmd; 2122caa1f0b1SHans Wippel struct { 2123caa1f0b1SHans Wippel u32 vnic_char; 2124349d13d5SHans Wippel u32 timeout; 2125caa1f0b1SHans Wippel } param; 2126caa1f0b1SHans Wippel struct { 2127349d13d5SHans Wippel union{ 2128caa1f0b1SHans Wippel u32 *sup_cmds; 2129349d13d5SHans Wippel u32 *timeout; 2130349d13d5SHans Wippel }; 2131caa1f0b1SHans Wippel } result; 2132a45b3fafSHans Wippel }; 2133a45b3fafSHans Wippel 2134a45b3fafSHans Wippel /* generic VNICC request call back */ 2135a45b3fafSHans Wippel static int qeth_l2_vnicc_request_cb(struct qeth_card *card, 2136a45b3fafSHans Wippel struct qeth_reply *reply, 2137a45b3fafSHans Wippel unsigned long data) 2138a45b3fafSHans Wippel { 2139caa1f0b1SHans Wippel struct _qeth_l2_vnicc_request_cbctl *cbctl = 2140caa1f0b1SHans Wippel (struct _qeth_l2_vnicc_request_cbctl *) reply->param; 2141a45b3fafSHans Wippel struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *) data; 2142a45b3fafSHans Wippel struct qeth_ipacmd_vnicc *rep = &cmd->data.vnicc; 2143a45b3fafSHans Wippel 2144a45b3fafSHans Wippel QETH_CARD_TEXT(card, 2, "vniccrcb"); 2145a45b3fafSHans Wippel if (cmd->hdr.return_code) 2146a45b3fafSHans Wippel return 0; 2147a45b3fafSHans Wippel /* return results to caller */ 2148a45b3fafSHans Wippel card->options.vnicc.sup_chars = rep->hdr.sup; 2149a45b3fafSHans Wippel card->options.vnicc.cur_chars = rep->hdr.cur; 2150a45b3fafSHans Wippel 2151caa1f0b1SHans Wippel if (cbctl->sub_cmd == IPA_VNICC_QUERY_CMDS) 2152caa1f0b1SHans Wippel *cbctl->result.sup_cmds = rep->query_cmds.sup_cmds; 2153caa1f0b1SHans Wippel 2154349d13d5SHans Wippel if (cbctl->sub_cmd == IPA_VNICC_GET_TIMEOUT) 2155349d13d5SHans Wippel *cbctl->result.timeout = rep->getset_timeout.timeout; 2156349d13d5SHans Wippel 2157a45b3fafSHans Wippel return 0; 2158a45b3fafSHans Wippel } 2159a45b3fafSHans Wippel 2160a45b3fafSHans Wippel /* generic VNICC request */ 2161a45b3fafSHans Wippel static int qeth_l2_vnicc_request(struct qeth_card *card, 2162a45b3fafSHans Wippel struct _qeth_l2_vnicc_request_cbctl *cbctl) 2163a45b3fafSHans Wippel { 2164a45b3fafSHans Wippel struct qeth_ipacmd_vnicc *req; 2165a45b3fafSHans Wippel struct qeth_cmd_buffer *iob; 2166a45b3fafSHans Wippel struct qeth_ipa_cmd *cmd; 2167a45b3fafSHans Wippel int rc; 2168a45b3fafSHans Wippel 2169a45b3fafSHans Wippel QETH_CARD_TEXT(card, 2, "vniccreq"); 2170a45b3fafSHans Wippel 2171a45b3fafSHans Wippel /* get new buffer for request */ 2172a45b3fafSHans Wippel iob = qeth_get_ipacmd_buffer(card, IPA_CMD_VNICC, 0); 2173a45b3fafSHans Wippel if (!iob) 2174a45b3fafSHans Wippel return -ENOMEM; 2175a45b3fafSHans Wippel 2176a45b3fafSHans Wippel /* create header for request */ 2177a45b3fafSHans Wippel cmd = (struct qeth_ipa_cmd *)(iob->data + IPA_PDU_HEADER_SIZE); 2178a45b3fafSHans Wippel req = &cmd->data.vnicc; 2179a45b3fafSHans Wippel 2180a45b3fafSHans Wippel /* create sub command header for request */ 2181a45b3fafSHans Wippel req->sub_hdr.data_length = sizeof(req->sub_hdr); 2182a45b3fafSHans Wippel req->sub_hdr.sub_command = cbctl->sub_cmd; 2183a45b3fafSHans Wippel 2184a45b3fafSHans Wippel /* create sub command specific request fields */ 2185a45b3fafSHans Wippel switch (cbctl->sub_cmd) { 2186a45b3fafSHans Wippel case IPA_VNICC_QUERY_CHARS: 2187a45b3fafSHans Wippel break; 2188caa1f0b1SHans Wippel case IPA_VNICC_QUERY_CMDS: 2189caa1f0b1SHans Wippel req->sub_hdr.data_length += sizeof(req->query_cmds); 2190caa1f0b1SHans Wippel req->query_cmds.vnic_char = cbctl->param.vnic_char; 2191caa1f0b1SHans Wippel break; 2192caa1f0b1SHans Wippel case IPA_VNICC_ENABLE: 2193caa1f0b1SHans Wippel case IPA_VNICC_DISABLE: 2194caa1f0b1SHans Wippel req->sub_hdr.data_length += sizeof(req->set_char); 2195caa1f0b1SHans Wippel req->set_char.vnic_char = cbctl->param.vnic_char; 2196caa1f0b1SHans Wippel break; 2197349d13d5SHans Wippel case IPA_VNICC_SET_TIMEOUT: 2198349d13d5SHans Wippel req->getset_timeout.timeout = cbctl->param.timeout; 2199349d13d5SHans Wippel /* fallthrough */ 2200349d13d5SHans Wippel case IPA_VNICC_GET_TIMEOUT: 2201349d13d5SHans Wippel req->sub_hdr.data_length += sizeof(req->getset_timeout); 2202349d13d5SHans Wippel req->getset_timeout.vnic_char = cbctl->param.vnic_char; 2203349d13d5SHans Wippel break; 2204a45b3fafSHans Wippel default: 2205a45b3fafSHans Wippel qeth_release_buffer(iob->channel, iob); 2206a45b3fafSHans Wippel return -EOPNOTSUPP; 2207a45b3fafSHans Wippel } 2208a45b3fafSHans Wippel 2209a45b3fafSHans Wippel /* send request */ 2210a45b3fafSHans Wippel rc = qeth_send_ipa_cmd(card, iob, qeth_l2_vnicc_request_cb, 2211a45b3fafSHans Wippel (void *) cbctl); 2212a45b3fafSHans Wippel 2213a45b3fafSHans Wippel return qeth_l2_vnicc_makerc(card, rc); 2214a45b3fafSHans Wippel } 2215a45b3fafSHans Wippel 2216a45b3fafSHans Wippel /* VNICC query VNIC characteristics request */ 2217a45b3fafSHans Wippel static int qeth_l2_vnicc_query_chars(struct qeth_card *card) 2218a45b3fafSHans Wippel { 2219a45b3fafSHans Wippel struct _qeth_l2_vnicc_request_cbctl cbctl; 2220a45b3fafSHans Wippel 2221a45b3fafSHans Wippel /* prepare callback control */ 2222a45b3fafSHans Wippel cbctl.sub_cmd = IPA_VNICC_QUERY_CHARS; 2223a45b3fafSHans Wippel 2224a45b3fafSHans Wippel QETH_CARD_TEXT(card, 2, "vniccqch"); 2225a45b3fafSHans Wippel return qeth_l2_vnicc_request(card, &cbctl); 2226a45b3fafSHans Wippel } 2227a45b3fafSHans Wippel 2228caa1f0b1SHans Wippel /* VNICC query sub commands request */ 2229caa1f0b1SHans Wippel static int qeth_l2_vnicc_query_cmds(struct qeth_card *card, u32 vnic_char, 2230caa1f0b1SHans Wippel u32 *sup_cmds) 2231caa1f0b1SHans Wippel { 2232caa1f0b1SHans Wippel struct _qeth_l2_vnicc_request_cbctl cbctl; 2233caa1f0b1SHans Wippel 2234caa1f0b1SHans Wippel /* prepare callback control */ 2235caa1f0b1SHans Wippel cbctl.sub_cmd = IPA_VNICC_QUERY_CMDS; 2236caa1f0b1SHans Wippel cbctl.param.vnic_char = vnic_char; 2237caa1f0b1SHans Wippel cbctl.result.sup_cmds = sup_cmds; 2238caa1f0b1SHans Wippel 2239caa1f0b1SHans Wippel QETH_CARD_TEXT(card, 2, "vniccqcm"); 2240caa1f0b1SHans Wippel return qeth_l2_vnicc_request(card, &cbctl); 2241caa1f0b1SHans Wippel } 2242caa1f0b1SHans Wippel 2243caa1f0b1SHans Wippel /* VNICC enable/disable characteristic request */ 2244caa1f0b1SHans Wippel static int qeth_l2_vnicc_set_char(struct qeth_card *card, u32 vnic_char, 2245caa1f0b1SHans Wippel u32 cmd) 2246caa1f0b1SHans Wippel { 2247caa1f0b1SHans Wippel struct _qeth_l2_vnicc_request_cbctl cbctl; 2248caa1f0b1SHans Wippel 2249caa1f0b1SHans Wippel /* prepare callback control */ 2250caa1f0b1SHans Wippel cbctl.sub_cmd = cmd; 2251caa1f0b1SHans Wippel cbctl.param.vnic_char = vnic_char; 2252caa1f0b1SHans Wippel 2253caa1f0b1SHans Wippel QETH_CARD_TEXT(card, 2, "vniccedc"); 2254caa1f0b1SHans Wippel return qeth_l2_vnicc_request(card, &cbctl); 2255caa1f0b1SHans Wippel } 2256caa1f0b1SHans Wippel 2257349d13d5SHans Wippel /* VNICC get/set timeout for characteristic request */ 2258349d13d5SHans Wippel static int qeth_l2_vnicc_getset_timeout(struct qeth_card *card, u32 vnicc, 2259349d13d5SHans Wippel u32 cmd, u32 *timeout) 2260349d13d5SHans Wippel { 2261349d13d5SHans Wippel struct _qeth_l2_vnicc_request_cbctl cbctl; 2262349d13d5SHans Wippel 2263349d13d5SHans Wippel /* prepare callback control */ 2264349d13d5SHans Wippel cbctl.sub_cmd = cmd; 2265349d13d5SHans Wippel cbctl.param.vnic_char = vnicc; 2266349d13d5SHans Wippel if (cmd == IPA_VNICC_SET_TIMEOUT) 2267349d13d5SHans Wippel cbctl.param.timeout = *timeout; 2268349d13d5SHans Wippel if (cmd == IPA_VNICC_GET_TIMEOUT) 2269349d13d5SHans Wippel cbctl.result.timeout = timeout; 2270349d13d5SHans Wippel 2271349d13d5SHans Wippel QETH_CARD_TEXT(card, 2, "vniccgst"); 2272349d13d5SHans Wippel return qeth_l2_vnicc_request(card, &cbctl); 2273349d13d5SHans Wippel } 2274349d13d5SHans Wippel 2275caa1f0b1SHans Wippel /* set current VNICC flag state; called from sysfs store function */ 2276caa1f0b1SHans Wippel int qeth_l2_vnicc_set_state(struct qeth_card *card, u32 vnicc, bool state) 2277caa1f0b1SHans Wippel { 2278caa1f0b1SHans Wippel int rc = 0; 2279caa1f0b1SHans Wippel u32 cmd; 2280caa1f0b1SHans Wippel 2281caa1f0b1SHans Wippel QETH_CARD_TEXT(card, 2, "vniccsch"); 2282caa1f0b1SHans Wippel 2283caa1f0b1SHans Wippel /* do not change anything if BridgePort is enabled */ 2284caa1f0b1SHans Wippel if (qeth_bridgeport_is_in_use(card)) 2285caa1f0b1SHans Wippel return -EBUSY; 2286caa1f0b1SHans Wippel 2287caa1f0b1SHans Wippel /* check if characteristic and enable/disable are supported */ 2288caa1f0b1SHans Wippel if (!(card->options.vnicc.sup_chars & vnicc) || 2289caa1f0b1SHans Wippel !(card->options.vnicc.set_char_sup & vnicc)) 2290caa1f0b1SHans Wippel return -EOPNOTSUPP; 2291caa1f0b1SHans Wippel 2292caa1f0b1SHans Wippel /* set enable/disable command and store wanted characteristic */ 2293caa1f0b1SHans Wippel if (state) { 2294caa1f0b1SHans Wippel cmd = IPA_VNICC_ENABLE; 2295caa1f0b1SHans Wippel card->options.vnicc.wanted_chars |= vnicc; 2296caa1f0b1SHans Wippel } else { 2297caa1f0b1SHans Wippel cmd = IPA_VNICC_DISABLE; 2298caa1f0b1SHans Wippel card->options.vnicc.wanted_chars &= ~vnicc; 2299caa1f0b1SHans Wippel } 2300caa1f0b1SHans Wippel 2301caa1f0b1SHans Wippel /* do we need to do anything? */ 2302caa1f0b1SHans Wippel if (card->options.vnicc.cur_chars == card->options.vnicc.wanted_chars) 2303caa1f0b1SHans Wippel return rc; 2304caa1f0b1SHans Wippel 2305caa1f0b1SHans Wippel /* if card is not ready, simply stop here */ 2306caa1f0b1SHans Wippel if (!qeth_card_hw_is_reachable(card)) { 2307caa1f0b1SHans Wippel if (state) 2308caa1f0b1SHans Wippel card->options.vnicc.cur_chars |= vnicc; 2309caa1f0b1SHans Wippel else 2310caa1f0b1SHans Wippel card->options.vnicc.cur_chars &= ~vnicc; 2311caa1f0b1SHans Wippel return rc; 2312caa1f0b1SHans Wippel } 2313caa1f0b1SHans Wippel 2314caa1f0b1SHans Wippel rc = qeth_l2_vnicc_set_char(card, vnicc, cmd); 2315caa1f0b1SHans Wippel if (rc) 2316caa1f0b1SHans Wippel card->options.vnicc.wanted_chars = 2317caa1f0b1SHans Wippel card->options.vnicc.cur_chars; 2318349d13d5SHans Wippel else { 2319349d13d5SHans Wippel /* successful online VNICC change; handle special cases */ 2320349d13d5SHans Wippel if (state && vnicc == QETH_VNICC_RX_BCAST) 2321caa1f0b1SHans Wippel card->options.vnicc.rx_bcast_enabled = true; 2322349d13d5SHans Wippel if (!state && vnicc == QETH_VNICC_LEARNING) 2323349d13d5SHans Wippel qeth_l2_vnicc_recover_timeout(card, vnicc, 2324349d13d5SHans Wippel &card->options.vnicc.learning_timeout); 2325349d13d5SHans Wippel } 2326caa1f0b1SHans Wippel 2327caa1f0b1SHans Wippel return rc; 2328caa1f0b1SHans Wippel } 2329caa1f0b1SHans Wippel 2330caa1f0b1SHans Wippel /* get current VNICC flag state; called from sysfs show function */ 2331caa1f0b1SHans Wippel int qeth_l2_vnicc_get_state(struct qeth_card *card, u32 vnicc, bool *state) 2332caa1f0b1SHans Wippel { 2333caa1f0b1SHans Wippel int rc = 0; 2334caa1f0b1SHans Wippel 2335caa1f0b1SHans Wippel QETH_CARD_TEXT(card, 2, "vniccgch"); 2336caa1f0b1SHans Wippel 2337caa1f0b1SHans Wippel /* do not get anything if BridgePort is enabled */ 2338caa1f0b1SHans Wippel if (qeth_bridgeport_is_in_use(card)) 2339caa1f0b1SHans Wippel return -EBUSY; 2340caa1f0b1SHans Wippel 2341caa1f0b1SHans Wippel /* check if characteristic is supported */ 2342caa1f0b1SHans Wippel if (!(card->options.vnicc.sup_chars & vnicc)) 2343caa1f0b1SHans Wippel return -EOPNOTSUPP; 2344caa1f0b1SHans Wippel 2345caa1f0b1SHans Wippel /* if card is ready, query current VNICC state */ 2346caa1f0b1SHans Wippel if (qeth_card_hw_is_reachable(card)) 2347caa1f0b1SHans Wippel rc = qeth_l2_vnicc_query_chars(card); 2348caa1f0b1SHans Wippel 2349caa1f0b1SHans Wippel *state = (card->options.vnicc.cur_chars & vnicc) ? true : false; 2350caa1f0b1SHans Wippel return rc; 2351caa1f0b1SHans Wippel } 2352caa1f0b1SHans Wippel 2353349d13d5SHans Wippel /* set VNICC timeout; called from sysfs store function. Currently, only learning 2354349d13d5SHans Wippel * supports timeout 2355349d13d5SHans Wippel */ 2356349d13d5SHans Wippel int qeth_l2_vnicc_set_timeout(struct qeth_card *card, u32 timeout) 2357349d13d5SHans Wippel { 2358349d13d5SHans Wippel int rc = 0; 2359349d13d5SHans Wippel 2360349d13d5SHans Wippel QETH_CARD_TEXT(card, 2, "vniccsto"); 2361349d13d5SHans Wippel 2362349d13d5SHans Wippel /* do not change anything if BridgePort is enabled */ 2363349d13d5SHans Wippel if (qeth_bridgeport_is_in_use(card)) 2364349d13d5SHans Wippel return -EBUSY; 2365349d13d5SHans Wippel 2366349d13d5SHans Wippel /* check if characteristic and set_timeout are supported */ 2367349d13d5SHans Wippel if (!(card->options.vnicc.sup_chars & QETH_VNICC_LEARNING) || 2368349d13d5SHans Wippel !(card->options.vnicc.getset_timeout_sup & QETH_VNICC_LEARNING)) 2369349d13d5SHans Wippel return -EOPNOTSUPP; 2370349d13d5SHans Wippel 2371349d13d5SHans Wippel /* do we need to do anything? */ 2372349d13d5SHans Wippel if (card->options.vnicc.learning_timeout == timeout) 2373349d13d5SHans Wippel return rc; 2374349d13d5SHans Wippel 2375349d13d5SHans Wippel /* if card is not ready, simply store the value internally and return */ 2376349d13d5SHans Wippel if (!qeth_card_hw_is_reachable(card)) { 2377349d13d5SHans Wippel card->options.vnicc.learning_timeout = timeout; 2378349d13d5SHans Wippel return rc; 2379349d13d5SHans Wippel } 2380349d13d5SHans Wippel 2381349d13d5SHans Wippel /* send timeout value to card; if successful, store value internally */ 2382349d13d5SHans Wippel rc = qeth_l2_vnicc_getset_timeout(card, QETH_VNICC_LEARNING, 2383349d13d5SHans Wippel IPA_VNICC_SET_TIMEOUT, &timeout); 2384349d13d5SHans Wippel if (!rc) 2385349d13d5SHans Wippel card->options.vnicc.learning_timeout = timeout; 2386349d13d5SHans Wippel 2387349d13d5SHans Wippel return rc; 2388349d13d5SHans Wippel } 2389349d13d5SHans Wippel 2390349d13d5SHans Wippel /* get current VNICC timeout; called from sysfs show function. Currently, only 2391349d13d5SHans Wippel * learning supports timeout 2392349d13d5SHans Wippel */ 2393349d13d5SHans Wippel int qeth_l2_vnicc_get_timeout(struct qeth_card *card, u32 *timeout) 2394349d13d5SHans Wippel { 2395349d13d5SHans Wippel int rc = 0; 2396349d13d5SHans Wippel 2397349d13d5SHans Wippel QETH_CARD_TEXT(card, 2, "vniccgto"); 2398349d13d5SHans Wippel 2399349d13d5SHans Wippel /* do not get anything if BridgePort is enabled */ 2400349d13d5SHans Wippel if (qeth_bridgeport_is_in_use(card)) 2401349d13d5SHans Wippel return -EBUSY; 2402349d13d5SHans Wippel 2403349d13d5SHans Wippel /* check if characteristic and get_timeout are supported */ 2404349d13d5SHans Wippel if (!(card->options.vnicc.sup_chars & QETH_VNICC_LEARNING) || 2405349d13d5SHans Wippel !(card->options.vnicc.getset_timeout_sup & QETH_VNICC_LEARNING)) 2406349d13d5SHans Wippel return -EOPNOTSUPP; 2407349d13d5SHans Wippel /* if card is ready, get timeout. Otherwise, just return stored value */ 2408349d13d5SHans Wippel *timeout = card->options.vnicc.learning_timeout; 2409349d13d5SHans Wippel if (qeth_card_hw_is_reachable(card)) 2410349d13d5SHans Wippel rc = qeth_l2_vnicc_getset_timeout(card, QETH_VNICC_LEARNING, 2411349d13d5SHans Wippel IPA_VNICC_GET_TIMEOUT, 2412349d13d5SHans Wippel timeout); 2413349d13d5SHans Wippel 2414349d13d5SHans Wippel return rc; 2415349d13d5SHans Wippel } 2416349d13d5SHans Wippel 2417caa1f0b1SHans Wippel /* check if VNICC is currently enabled */ 2418caa1f0b1SHans Wippel bool qeth_l2_vnicc_is_in_use(struct qeth_card *card) 2419caa1f0b1SHans Wippel { 2420caa1f0b1SHans Wippel /* if everything is turned off, VNICC is not active */ 2421caa1f0b1SHans Wippel if (!card->options.vnicc.cur_chars) 2422caa1f0b1SHans Wippel return false; 2423caa1f0b1SHans Wippel /* default values are only OK if rx_bcast was not enabled by user 2424caa1f0b1SHans Wippel * or the card is offline. 2425caa1f0b1SHans Wippel */ 2426caa1f0b1SHans Wippel if (card->options.vnicc.cur_chars == QETH_VNICC_DEFAULT) { 2427caa1f0b1SHans Wippel if (!card->options.vnicc.rx_bcast_enabled || 2428caa1f0b1SHans Wippel !qeth_card_hw_is_reachable(card)) 2429caa1f0b1SHans Wippel return false; 2430caa1f0b1SHans Wippel } 2431caa1f0b1SHans Wippel return true; 2432caa1f0b1SHans Wippel } 2433caa1f0b1SHans Wippel 2434349d13d5SHans Wippel /* recover user timeout setting */ 2435349d13d5SHans Wippel static bool qeth_l2_vnicc_recover_timeout(struct qeth_card *card, u32 vnicc, 2436349d13d5SHans Wippel u32 *timeout) 2437349d13d5SHans Wippel { 2438349d13d5SHans Wippel if (card->options.vnicc.sup_chars & vnicc && 2439349d13d5SHans Wippel card->options.vnicc.getset_timeout_sup & vnicc && 2440349d13d5SHans Wippel !qeth_l2_vnicc_getset_timeout(card, vnicc, IPA_VNICC_SET_TIMEOUT, 2441349d13d5SHans Wippel timeout)) 2442349d13d5SHans Wippel return false; 2443349d13d5SHans Wippel *timeout = QETH_VNICC_DEFAULT_TIMEOUT; 2444349d13d5SHans Wippel return true; 2445349d13d5SHans Wippel } 2446349d13d5SHans Wippel 2447caa1f0b1SHans Wippel /* recover user characteristic setting */ 2448caa1f0b1SHans Wippel static bool qeth_l2_vnicc_recover_char(struct qeth_card *card, u32 vnicc, 2449caa1f0b1SHans Wippel bool enable) 2450caa1f0b1SHans Wippel { 2451caa1f0b1SHans Wippel u32 cmd = enable ? IPA_VNICC_ENABLE : IPA_VNICC_DISABLE; 2452caa1f0b1SHans Wippel 2453caa1f0b1SHans Wippel if (card->options.vnicc.sup_chars & vnicc && 2454caa1f0b1SHans Wippel card->options.vnicc.set_char_sup & vnicc && 2455caa1f0b1SHans Wippel !qeth_l2_vnicc_set_char(card, vnicc, cmd)) 2456caa1f0b1SHans Wippel return false; 2457caa1f0b1SHans Wippel card->options.vnicc.wanted_chars &= ~vnicc; 2458caa1f0b1SHans Wippel card->options.vnicc.wanted_chars |= QETH_VNICC_DEFAULT & vnicc; 2459caa1f0b1SHans Wippel return true; 2460caa1f0b1SHans Wippel } 2461caa1f0b1SHans Wippel 2462a45b3fafSHans Wippel /* (re-)initialize VNICC */ 2463a45b3fafSHans Wippel static void qeth_l2_vnicc_init(struct qeth_card *card) 2464a45b3fafSHans Wippel { 2465349d13d5SHans Wippel u32 *timeout = &card->options.vnicc.learning_timeout; 2466caa1f0b1SHans Wippel unsigned int chars_len, i; 2467caa1f0b1SHans Wippel unsigned long chars_tmp; 2468caa1f0b1SHans Wippel u32 sup_cmds, vnicc; 2469caa1f0b1SHans Wippel bool enable, error; 2470caa1f0b1SHans Wippel 2471a45b3fafSHans Wippel QETH_CARD_TEXT(card, 2, "vniccini"); 2472caa1f0b1SHans Wippel /* reset rx_bcast */ 2473caa1f0b1SHans Wippel card->options.vnicc.rx_bcast_enabled = 0; 2474a45b3fafSHans Wippel /* initial query and storage of VNIC characteristics */ 2475a45b3fafSHans Wippel if (qeth_l2_vnicc_query_chars(card)) { 2476349d13d5SHans Wippel if (card->options.vnicc.wanted_chars != QETH_VNICC_DEFAULT || 2477349d13d5SHans Wippel *timeout != QETH_VNICC_DEFAULT_TIMEOUT) 2478caa1f0b1SHans Wippel dev_err(&card->gdev->dev, "Configuring the VNIC characteristics failed\n"); 2479caa1f0b1SHans Wippel /* fail quietly if user didn't change the default config */ 2480a45b3fafSHans Wippel card->options.vnicc.sup_chars = 0; 2481a45b3fafSHans Wippel card->options.vnicc.cur_chars = 0; 2482caa1f0b1SHans Wippel card->options.vnicc.wanted_chars = QETH_VNICC_DEFAULT; 2483caa1f0b1SHans Wippel return; 2484a45b3fafSHans Wippel } 2485caa1f0b1SHans Wippel /* get supported commands for each supported characteristic */ 2486caa1f0b1SHans Wippel chars_tmp = card->options.vnicc.sup_chars; 2487caa1f0b1SHans Wippel chars_len = sizeof(card->options.vnicc.sup_chars) * BITS_PER_BYTE; 2488caa1f0b1SHans Wippel for_each_set_bit(i, &chars_tmp, chars_len) { 2489caa1f0b1SHans Wippel vnicc = BIT(i); 2490caa1f0b1SHans Wippel qeth_l2_vnicc_query_cmds(card, vnicc, &sup_cmds); 2491349d13d5SHans Wippel if (!(sup_cmds & IPA_VNICC_SET_TIMEOUT) || 2492349d13d5SHans Wippel !(sup_cmds & IPA_VNICC_GET_TIMEOUT)) 2493349d13d5SHans Wippel card->options.vnicc.getset_timeout_sup &= ~vnicc; 2494caa1f0b1SHans Wippel if (!(sup_cmds & IPA_VNICC_ENABLE) || 2495caa1f0b1SHans Wippel !(sup_cmds & IPA_VNICC_DISABLE)) 2496caa1f0b1SHans Wippel card->options.vnicc.set_char_sup &= ~vnicc; 2497caa1f0b1SHans Wippel } 2498caa1f0b1SHans Wippel /* enforce assumed default values and recover settings, if changed */ 2499349d13d5SHans Wippel error = qeth_l2_vnicc_recover_timeout(card, QETH_VNICC_LEARNING, 2500349d13d5SHans Wippel timeout); 2501caa1f0b1SHans Wippel chars_tmp = card->options.vnicc.wanted_chars ^ QETH_VNICC_DEFAULT; 2502caa1f0b1SHans Wippel chars_tmp |= QETH_VNICC_BRIDGE_INVISIBLE; 2503caa1f0b1SHans Wippel chars_len = sizeof(card->options.vnicc.wanted_chars) * BITS_PER_BYTE; 2504caa1f0b1SHans Wippel for_each_set_bit(i, &chars_tmp, chars_len) { 2505caa1f0b1SHans Wippel vnicc = BIT(i); 2506caa1f0b1SHans Wippel enable = card->options.vnicc.wanted_chars & vnicc; 2507caa1f0b1SHans Wippel error |= qeth_l2_vnicc_recover_char(card, vnicc, enable); 2508caa1f0b1SHans Wippel } 2509caa1f0b1SHans Wippel if (error) 2510caa1f0b1SHans Wippel dev_err(&card->gdev->dev, "Configuring the VNIC characteristics failed\n"); 2511caa1f0b1SHans Wippel } 2512caa1f0b1SHans Wippel 2513caa1f0b1SHans Wippel /* configure default values of VNIC characteristics */ 2514caa1f0b1SHans Wippel static void qeth_l2_vnicc_set_defaults(struct qeth_card *card) 2515caa1f0b1SHans Wippel { 2516caa1f0b1SHans Wippel /* characteristics values */ 2517caa1f0b1SHans Wippel card->options.vnicc.sup_chars = QETH_VNICC_ALL; 2518caa1f0b1SHans Wippel card->options.vnicc.cur_chars = QETH_VNICC_DEFAULT; 2519349d13d5SHans Wippel card->options.vnicc.learning_timeout = QETH_VNICC_DEFAULT_TIMEOUT; 2520caa1f0b1SHans Wippel /* supported commands */ 2521caa1f0b1SHans Wippel card->options.vnicc.set_char_sup = QETH_VNICC_ALL; 2522349d13d5SHans Wippel card->options.vnicc.getset_timeout_sup = QETH_VNICC_LEARNING; 2523caa1f0b1SHans Wippel /* settings wanted by users */ 2524caa1f0b1SHans Wippel card->options.vnicc.wanted_chars = QETH_VNICC_DEFAULT; 2525a45b3fafSHans Wippel } 2526a45b3fafSHans Wippel 25274a71df50SFrank Blaschka module_init(qeth_l2_init); 25284a71df50SFrank Blaschka module_exit(qeth_l2_exit); 25294a71df50SFrank Blaschka MODULE_AUTHOR("Frank Blaschka <frank.blaschka@de.ibm.com>"); 25304a71df50SFrank Blaschka MODULE_DESCRIPTION("qeth layer 2 discipline"); 25314a71df50SFrank Blaschka MODULE_LICENSE("GPL"); 2532