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/mii.h> 204a71df50SFrank Blaschka #include <linux/ip.h> 21ccffad25SJiri Pirko #include <linux/list.h> 22fe5c8028SLakhvich Dmitriy #include <linux/hash.h> 23fe5c8028SLakhvich Dmitriy #include <linux/hashtable.h> 24fe5c8028SLakhvich Dmitriy #include <linux/string.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 *); 304a71df50SFrank Blaschka static int qeth_l2_send_delmac(struct qeth_card *, __u8 *); 314a71df50SFrank Blaschka static int qeth_l2_send_setdelmac(struct qeth_card *, __u8 *, 32efbbc1d5SEugene Crosser enum qeth_ipa_cmds); 33fe5c8028SLakhvich Dmitriy static void qeth_l2_set_rx_mode(struct net_device *); 344a71df50SFrank Blaschka static int qeth_l2_recover(void *); 35c044dc21SEugene Crosser static void qeth_bridgeport_query_support(struct qeth_card *card); 36c044dc21SEugene Crosser static void qeth_bridge_state_change(struct qeth_card *card, 37c044dc21SEugene Crosser struct qeth_ipa_cmd *cmd); 38c044dc21SEugene Crosser static void qeth_bridge_host_event(struct qeth_card *card, 39c044dc21SEugene Crosser struct qeth_ipa_cmd *cmd); 404a71df50SFrank Blaschka 414a71df50SFrank Blaschka static int qeth_l2_do_ioctl(struct net_device *dev, struct ifreq *rq, int cmd) 424a71df50SFrank Blaschka { 43509e2562SHeiko Carstens struct qeth_card *card = dev->ml_priv; 444a71df50SFrank Blaschka struct mii_ioctl_data *mii_data; 454a71df50SFrank Blaschka int rc = 0; 464a71df50SFrank Blaschka 474a71df50SFrank Blaschka if (!card) 484a71df50SFrank Blaschka return -ENODEV; 494a71df50SFrank Blaschka 50c3521254SEugene Crosser if (!qeth_card_hw_is_reachable(card)) 514a71df50SFrank Blaschka return -ENODEV; 524a71df50SFrank Blaschka 534a71df50SFrank Blaschka if (card->info.type == QETH_CARD_TYPE_OSN) 544a71df50SFrank Blaschka return -EPERM; 554a71df50SFrank Blaschka 564a71df50SFrank Blaschka switch (cmd) { 574a71df50SFrank Blaschka case SIOC_QETH_ADP_SET_SNMP_CONTROL: 584a71df50SFrank Blaschka rc = qeth_snmp_command(card, rq->ifr_ifru.ifru_data); 594a71df50SFrank Blaschka break; 604a71df50SFrank Blaschka case SIOC_QETH_GET_CARD_TYPE: 615113fec0SUrsula Braun if ((card->info.type == QETH_CARD_TYPE_OSD || 625113fec0SUrsula Braun card->info.type == QETH_CARD_TYPE_OSM || 635113fec0SUrsula Braun card->info.type == QETH_CARD_TYPE_OSX) && 644a71df50SFrank Blaschka !card->info.guestlan) 654a71df50SFrank Blaschka return 1; 664a71df50SFrank Blaschka return 0; 674a71df50SFrank Blaschka break; 684a71df50SFrank Blaschka case SIOCGMIIPHY: 694a71df50SFrank Blaschka mii_data = if_mii(rq); 704a71df50SFrank Blaschka mii_data->phy_id = 0; 714a71df50SFrank Blaschka break; 724a71df50SFrank Blaschka case SIOCGMIIREG: 734a71df50SFrank Blaschka mii_data = if_mii(rq); 744a71df50SFrank Blaschka if (mii_data->phy_id != 0) 754a71df50SFrank Blaschka rc = -EINVAL; 764a71df50SFrank Blaschka else 774a71df50SFrank Blaschka mii_data->val_out = qeth_mdio_read(dev, 784a71df50SFrank Blaschka mii_data->phy_id, mii_data->reg_num); 794a71df50SFrank Blaschka break; 80c3ab96f3SFrank Blaschka case SIOC_QETH_QUERY_OAT: 81c3ab96f3SFrank Blaschka rc = qeth_query_oat_command(card, rq->ifr_ifru.ifru_data); 82c3ab96f3SFrank Blaschka break; 834a71df50SFrank Blaschka default: 844a71df50SFrank Blaschka rc = -EOPNOTSUPP; 854a71df50SFrank Blaschka } 864a71df50SFrank Blaschka if (rc) 87847a50fdSCarsten Otte QETH_CARD_TEXT_(card, 2, "ioce%d", rc); 884a71df50SFrank Blaschka return rc; 894a71df50SFrank Blaschka } 904a71df50SFrank Blaschka 914a71df50SFrank Blaschka static int qeth_l2_verify_dev(struct net_device *dev) 924a71df50SFrank Blaschka { 934a71df50SFrank Blaschka struct qeth_card *card; 944a71df50SFrank Blaschka unsigned long flags; 954a71df50SFrank Blaschka int rc = 0; 964a71df50SFrank Blaschka 974a71df50SFrank Blaschka read_lock_irqsave(&qeth_core_card_list.rwlock, flags); 984a71df50SFrank Blaschka list_for_each_entry(card, &qeth_core_card_list.list, list) { 994a71df50SFrank Blaschka if (card->dev == dev) { 1004a71df50SFrank Blaschka rc = QETH_REAL_CARD; 1014a71df50SFrank Blaschka break; 1024a71df50SFrank Blaschka } 1034a71df50SFrank Blaschka } 1044a71df50SFrank Blaschka read_unlock_irqrestore(&qeth_core_card_list.rwlock, flags); 1054a71df50SFrank Blaschka 1064a71df50SFrank Blaschka return rc; 1074a71df50SFrank Blaschka } 1084a71df50SFrank Blaschka 1094a71df50SFrank Blaschka static struct net_device *qeth_l2_netdev_by_devno(unsigned char *read_dev_no) 1104a71df50SFrank Blaschka { 1114a71df50SFrank Blaschka struct qeth_card *card; 1124a71df50SFrank Blaschka struct net_device *ndev; 113f06f6f32SCornelia Huck __u16 temp_dev_no; 1144a71df50SFrank Blaschka unsigned long flags; 115f06f6f32SCornelia Huck struct ccw_dev_id read_devid; 1164a71df50SFrank Blaschka 1174a71df50SFrank Blaschka ndev = NULL; 1184a71df50SFrank Blaschka memcpy(&temp_dev_no, read_dev_no, 2); 1194a71df50SFrank Blaschka read_lock_irqsave(&qeth_core_card_list.rwlock, flags); 1204a71df50SFrank Blaschka list_for_each_entry(card, &qeth_core_card_list.list, list) { 121f06f6f32SCornelia Huck ccw_device_get_id(CARD_RDEV(card), &read_devid); 122f06f6f32SCornelia Huck if (read_devid.devno == temp_dev_no) { 1234a71df50SFrank Blaschka ndev = card->dev; 1244a71df50SFrank Blaschka break; 1254a71df50SFrank Blaschka } 1264a71df50SFrank Blaschka } 1274a71df50SFrank Blaschka read_unlock_irqrestore(&qeth_core_card_list.rwlock, flags); 1284a71df50SFrank Blaschka return ndev; 1294a71df50SFrank Blaschka } 1304a71df50SFrank Blaschka 131efbbc1d5SEugene Crosser static int qeth_setdel_makerc(struct qeth_card *card, int retcode) 1324a71df50SFrank Blaschka { 133efbbc1d5SEugene Crosser int rc; 1344a71df50SFrank Blaschka 135efbbc1d5SEugene Crosser if (retcode) 1361aec42bcSThomas Richter QETH_CARD_TEXT_(card, 2, "err%04x", retcode); 137efbbc1d5SEugene Crosser switch (retcode) { 138efbbc1d5SEugene Crosser case IPA_RC_SUCCESS: 139efbbc1d5SEugene Crosser rc = 0; 140efbbc1d5SEugene Crosser break; 141efbbc1d5SEugene Crosser case IPA_RC_L2_UNSUPPORTED_CMD: 142ffb95251SEugene Crosser rc = -EOPNOTSUPP; 143efbbc1d5SEugene Crosser break; 144efbbc1d5SEugene Crosser case IPA_RC_L2_ADDR_TABLE_FULL: 145efbbc1d5SEugene Crosser rc = -ENOSPC; 146efbbc1d5SEugene Crosser break; 147efbbc1d5SEugene Crosser case IPA_RC_L2_DUP_MAC: 148efbbc1d5SEugene Crosser case IPA_RC_L2_DUP_LAYER3_MAC: 149efbbc1d5SEugene Crosser rc = -EEXIST; 150efbbc1d5SEugene Crosser break; 151efbbc1d5SEugene Crosser case IPA_RC_L2_MAC_NOT_AUTH_BY_HYP: 152efbbc1d5SEugene Crosser case IPA_RC_L2_MAC_NOT_AUTH_BY_ADP: 153efbbc1d5SEugene Crosser rc = -EPERM; 154efbbc1d5SEugene Crosser break; 155efbbc1d5SEugene Crosser case IPA_RC_L2_MAC_NOT_FOUND: 156efbbc1d5SEugene Crosser rc = -ENOENT; 157efbbc1d5SEugene Crosser break; 1581aec42bcSThomas Richter case -ENOMEM: 1591aec42bcSThomas Richter rc = -ENOMEM; 1601aec42bcSThomas Richter break; 161efbbc1d5SEugene Crosser default: 162efbbc1d5SEugene Crosser rc = -EIO; 163efbbc1d5SEugene Crosser break; 1644a71df50SFrank Blaschka } 165efbbc1d5SEugene Crosser return rc; 1664a71df50SFrank Blaschka } 1674a71df50SFrank Blaschka 1684a71df50SFrank Blaschka static int qeth_l2_send_setgroupmac(struct qeth_card *card, __u8 *mac) 1694a71df50SFrank Blaschka { 170efbbc1d5SEugene Crosser int rc; 171efbbc1d5SEugene Crosser 172847a50fdSCarsten Otte QETH_CARD_TEXT(card, 2, "L2Sgmac"); 173efbbc1d5SEugene Crosser rc = qeth_setdel_makerc(card, qeth_l2_send_setdelmac(card, mac, 174efbbc1d5SEugene Crosser IPA_CMD_SETGMAC)); 175efbbc1d5SEugene Crosser if (rc == -EEXIST) 176efbbc1d5SEugene Crosser QETH_DBF_MESSAGE(2, "Group MAC %pM already existing on %s\n", 177efbbc1d5SEugene Crosser mac, QETH_CARD_IFNAME(card)); 178efbbc1d5SEugene Crosser else if (rc) 179efbbc1d5SEugene Crosser QETH_DBF_MESSAGE(2, "Could not set group MAC %pM on %s: %d\n", 180efbbc1d5SEugene Crosser mac, QETH_CARD_IFNAME(card), rc); 181efbbc1d5SEugene Crosser return rc; 1824a71df50SFrank Blaschka } 1834a71df50SFrank Blaschka 1844a71df50SFrank Blaschka static int qeth_l2_send_delgroupmac(struct qeth_card *card, __u8 *mac) 1854a71df50SFrank Blaschka { 186efbbc1d5SEugene Crosser int rc; 187efbbc1d5SEugene Crosser 188847a50fdSCarsten Otte QETH_CARD_TEXT(card, 2, "L2Dgmac"); 189efbbc1d5SEugene Crosser rc = qeth_setdel_makerc(card, qeth_l2_send_setdelmac(card, mac, 190efbbc1d5SEugene Crosser IPA_CMD_DELGMAC)); 191efbbc1d5SEugene Crosser if (rc) 192efbbc1d5SEugene Crosser QETH_DBF_MESSAGE(2, 193efbbc1d5SEugene Crosser "Could not delete group MAC %pM on %s: %d\n", 194efbbc1d5SEugene Crosser mac, QETH_CARD_IFNAME(card), rc); 195efbbc1d5SEugene Crosser return rc; 1964a71df50SFrank Blaschka } 1974a71df50SFrank Blaschka 198fe5c8028SLakhvich Dmitriy static inline u32 qeth_l2_mac_hash(const u8 *addr) 1994a71df50SFrank Blaschka { 200fe5c8028SLakhvich Dmitriy return get_unaligned((u32 *)(&addr[2])); 201fe5c8028SLakhvich Dmitriy } 202fe5c8028SLakhvich Dmitriy 203fe5c8028SLakhvich Dmitriy static int qeth_l2_write_mac(struct qeth_card *card, struct qeth_mac *mac) 204fe5c8028SLakhvich Dmitriy { 205fe5c8028SLakhvich Dmitriy 2067db2266aSFrank Blaschka int rc; 2074a71df50SFrank Blaschka 208fe5c8028SLakhvich Dmitriy if (mac->is_uc) { 209efbbc1d5SEugene Crosser rc = qeth_setdel_makerc(card, 210fe5c8028SLakhvich Dmitriy qeth_l2_send_setdelmac(card, mac->mac_addr, 211fe5c8028SLakhvich Dmitriy IPA_CMD_SETVMAC)); 2127db2266aSFrank Blaschka } else { 213efbbc1d5SEugene Crosser rc = qeth_setdel_makerc(card, 214fe5c8028SLakhvich Dmitriy qeth_l2_send_setgroupmac(card, mac->mac_addr)); 215fe5c8028SLakhvich Dmitriy } 216fe5c8028SLakhvich Dmitriy return rc; 2177db2266aSFrank Blaschka } 2187db2266aSFrank Blaschka 219fe5c8028SLakhvich Dmitriy static void qeth_l2_del_all_macs(struct qeth_card *card, int del) 2204a71df50SFrank Blaschka { 221fe5c8028SLakhvich Dmitriy struct qeth_mac *mac; 222fe5c8028SLakhvich Dmitriy struct hlist_node *tmp; 223fe5c8028SLakhvich Dmitriy int i; 2244a71df50SFrank Blaschka 2254a71df50SFrank Blaschka spin_lock_bh(&card->mclock); 226fe5c8028SLakhvich Dmitriy hash_for_each_safe(card->mac_htable, i, tmp, mac, hnode) { 22770919e23SUrsula Braun if (del) { 228fe5c8028SLakhvich Dmitriy if (mac->is_uc) 229fe5c8028SLakhvich Dmitriy qeth_l2_send_setdelmac(card, mac->mac_addr, 230efbbc1d5SEugene Crosser IPA_CMD_DELVMAC); 2317db2266aSFrank Blaschka else 232fe5c8028SLakhvich Dmitriy qeth_l2_send_delgroupmac(card, mac->mac_addr); 23370919e23SUrsula Braun } 234fe5c8028SLakhvich Dmitriy hash_del(&mac->hnode); 235fe5c8028SLakhvich Dmitriy kfree(mac); 2364a71df50SFrank Blaschka } 2374a71df50SFrank Blaschka spin_unlock_bh(&card->mclock); 2384a71df50SFrank Blaschka } 2394a71df50SFrank Blaschka 240ce73e10eSKlaus-Dieter Wacker static inline int qeth_l2_get_cast_type(struct qeth_card *card, 241ce73e10eSKlaus-Dieter Wacker struct sk_buff *skb) 2424a71df50SFrank Blaschka { 243ce73e10eSKlaus-Dieter Wacker if (card->info.type == QETH_CARD_TYPE_OSN) 244ce73e10eSKlaus-Dieter Wacker return RTN_UNSPEC; 245ce73e10eSKlaus-Dieter Wacker if (is_broadcast_ether_addr(skb->data)) 246ce73e10eSKlaus-Dieter Wacker return RTN_BROADCAST; 247ce73e10eSKlaus-Dieter Wacker if (is_multicast_ether_addr(skb->data)) 248ce73e10eSKlaus-Dieter Wacker return RTN_MULTICAST; 249ce73e10eSKlaus-Dieter Wacker return RTN_UNSPEC; 2504a71df50SFrank Blaschka } 2514a71df50SFrank Blaschka 2524d7def2aSThomas Richter static inline void qeth_l2_hdr_csum(struct qeth_card *card, 2534d7def2aSThomas Richter struct qeth_hdr *hdr, struct sk_buff *skb) 2544d7def2aSThomas Richter { 2554d7def2aSThomas Richter struct iphdr *iph = ip_hdr(skb); 2564d7def2aSThomas Richter 2574d7def2aSThomas Richter /* tcph->check contains already the pseudo hdr checksum 2584d7def2aSThomas Richter * so just set the header flags 2594d7def2aSThomas Richter */ 2604d7def2aSThomas Richter if (iph->protocol == IPPROTO_UDP) 2614d7def2aSThomas Richter hdr->hdr.l2.flags[1] |= QETH_HDR_EXT_UDP; 2624d7def2aSThomas Richter hdr->hdr.l2.flags[1] |= QETH_HDR_EXT_CSUM_TRANSP_REQ | 2634d7def2aSThomas Richter QETH_HDR_EXT_CSUM_HDR_REQ; 2644d7def2aSThomas Richter iph->check = 0; 2654d7def2aSThomas Richter if (card->options.performance_stats) 2664d7def2aSThomas Richter card->perf_stats.tx_csum++; 2674d7def2aSThomas Richter } 2684d7def2aSThomas Richter 2694a71df50SFrank Blaschka static void qeth_l2_fill_header(struct qeth_card *card, struct qeth_hdr *hdr, 27043934077SStefan Raspl struct sk_buff *skb, int cast_type) 2714a71df50SFrank Blaschka { 272683d718aSFrank Blaschka struct vlan_ethhdr *veth = (struct vlan_ethhdr *)skb_mac_header(skb); 2734a71df50SFrank Blaschka 2744a71df50SFrank Blaschka memset(hdr, 0, sizeof(struct qeth_hdr)); 2754a71df50SFrank Blaschka hdr->hdr.l2.id = QETH_HEADER_TYPE_LAYER2; 2764a71df50SFrank Blaschka 2774a71df50SFrank Blaschka /* set byte byte 3 to casting flags */ 2784a71df50SFrank Blaschka if (cast_type == RTN_MULTICAST) 2794a71df50SFrank Blaschka hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_MULTICAST; 2804a71df50SFrank Blaschka else if (cast_type == RTN_BROADCAST) 2814a71df50SFrank Blaschka hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_BROADCAST; 2824a71df50SFrank Blaschka else 283ce73e10eSKlaus-Dieter Wacker hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_UNICAST; 2844a71df50SFrank Blaschka 2854a71df50SFrank Blaschka hdr->hdr.l2.pkt_length = skb->len-QETH_HEADER_SIZE; 2864a71df50SFrank Blaschka /* VSWITCH relies on the VLAN 2874a71df50SFrank Blaschka * information to be present in 2884a71df50SFrank Blaschka * the QDIO header */ 2894a71df50SFrank Blaschka if (veth->h_vlan_proto == __constant_htons(ETH_P_8021Q)) { 2904a71df50SFrank Blaschka hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_VLAN; 2914a71df50SFrank Blaschka hdr->hdr.l2.vlan_id = ntohs(veth->h_vlan_TCI); 2924a71df50SFrank Blaschka } 2934a71df50SFrank Blaschka } 2944a71df50SFrank Blaschka 2954a71df50SFrank Blaschka static int qeth_l2_send_setdelvlan_cb(struct qeth_card *card, 2964a71df50SFrank Blaschka struct qeth_reply *reply, unsigned long data) 2974a71df50SFrank Blaschka { 2984a71df50SFrank Blaschka struct qeth_ipa_cmd *cmd; 2994a71df50SFrank Blaschka 300847a50fdSCarsten Otte QETH_CARD_TEXT(card, 2, "L2sdvcb"); 3014a71df50SFrank Blaschka cmd = (struct qeth_ipa_cmd *) data; 3024a71df50SFrank Blaschka if (cmd->hdr.return_code) { 30314cc21b6SFrank Blaschka QETH_DBF_MESSAGE(2, "Error in processing VLAN %i on %s: 0x%x. " 3044a71df50SFrank Blaschka "Continuing\n", cmd->data.setdelvlan.vlan_id, 3054a71df50SFrank Blaschka QETH_CARD_IFNAME(card), cmd->hdr.return_code); 306847a50fdSCarsten Otte QETH_CARD_TEXT_(card, 2, "L2VL%4x", cmd->hdr.command); 307847a50fdSCarsten Otte QETH_CARD_TEXT_(card, 2, "err%d", cmd->hdr.return_code); 3084a71df50SFrank Blaschka } 3094a71df50SFrank Blaschka return 0; 3104a71df50SFrank Blaschka } 3114a71df50SFrank Blaschka 3124a71df50SFrank Blaschka static int qeth_l2_send_setdelvlan(struct qeth_card *card, __u16 i, 3134a71df50SFrank Blaschka enum qeth_ipa_cmds ipacmd) 3144a71df50SFrank Blaschka { 3154a71df50SFrank Blaschka struct qeth_ipa_cmd *cmd; 3164a71df50SFrank Blaschka struct qeth_cmd_buffer *iob; 3174a71df50SFrank Blaschka 318847a50fdSCarsten Otte QETH_CARD_TEXT_(card, 4, "L2sdv%x", ipacmd); 3194a71df50SFrank Blaschka iob = qeth_get_ipacmd_buffer(card, ipacmd, QETH_PROT_IPV4); 3201aec42bcSThomas Richter if (!iob) 3211aec42bcSThomas Richter return -ENOMEM; 3224a71df50SFrank Blaschka cmd = (struct qeth_ipa_cmd *)(iob->data+IPA_PDU_HEADER_SIZE); 3234a71df50SFrank Blaschka cmd->data.setdelvlan.vlan_id = i; 3244a71df50SFrank Blaschka return qeth_send_ipa_cmd(card, iob, 3254a71df50SFrank Blaschka qeth_l2_send_setdelvlan_cb, NULL); 3264a71df50SFrank Blaschka } 3274a71df50SFrank Blaschka 32870919e23SUrsula Braun static void qeth_l2_process_vlans(struct qeth_card *card) 3294a71df50SFrank Blaschka { 3304a71df50SFrank Blaschka struct qeth_vlan_vid *id; 331847a50fdSCarsten Otte QETH_CARD_TEXT(card, 3, "L2prcvln"); 3324a71df50SFrank Blaschka spin_lock_bh(&card->vlanlock); 3334a71df50SFrank Blaschka list_for_each_entry(id, &card->vid_list, list) { 33470919e23SUrsula Braun qeth_l2_send_setdelvlan(card, id->vid, IPA_CMD_SETVLAN); 3354a71df50SFrank Blaschka } 3364a71df50SFrank Blaschka spin_unlock_bh(&card->vlanlock); 3374a71df50SFrank Blaschka } 3384a71df50SFrank Blaschka 33980d5c368SPatrick McHardy static int qeth_l2_vlan_rx_add_vid(struct net_device *dev, 34080d5c368SPatrick McHardy __be16 proto, u16 vid) 3414a71df50SFrank Blaschka { 342509e2562SHeiko Carstens struct qeth_card *card = dev->ml_priv; 3434a71df50SFrank Blaschka struct qeth_vlan_vid *id; 3441aec42bcSThomas Richter int rc; 3454a71df50SFrank Blaschka 346847a50fdSCarsten Otte QETH_CARD_TEXT_(card, 4, "aid:%d", vid); 34710651db7SUrsula Braun if (!vid) 3488e586137SJiri Pirko return 0; 3495113fec0SUrsula Braun if (card->info.type == QETH_CARD_TYPE_OSM) { 350847a50fdSCarsten Otte QETH_CARD_TEXT(card, 3, "aidOSM"); 3518e586137SJiri Pirko return 0; 3525113fec0SUrsula Braun } 3538e98ac48SUrsula Braun if (qeth_wait_for_threads(card, QETH_RECOVER_THREAD)) { 354847a50fdSCarsten Otte QETH_CARD_TEXT(card, 3, "aidREC"); 3558e586137SJiri Pirko return 0; 3568e98ac48SUrsula Braun } 3574a71df50SFrank Blaschka id = kmalloc(sizeof(struct qeth_vlan_vid), GFP_ATOMIC); 3584a71df50SFrank Blaschka if (id) { 3594a71df50SFrank Blaschka id->vid = vid; 3601aec42bcSThomas Richter rc = qeth_l2_send_setdelvlan(card, vid, IPA_CMD_SETVLAN); 3611aec42bcSThomas Richter if (rc) { 3621aec42bcSThomas Richter kfree(id); 3631aec42bcSThomas Richter return rc; 3641aec42bcSThomas Richter } 3654a71df50SFrank Blaschka spin_lock_bh(&card->vlanlock); 3664a71df50SFrank Blaschka list_add_tail(&id->list, &card->vid_list); 3674a71df50SFrank Blaschka spin_unlock_bh(&card->vlanlock); 3688e586137SJiri Pirko } else { 3698e586137SJiri Pirko return -ENOMEM; 3704a71df50SFrank Blaschka } 3718e586137SJiri Pirko return 0; 3724a71df50SFrank Blaschka } 3734a71df50SFrank Blaschka 37480d5c368SPatrick McHardy static int qeth_l2_vlan_rx_kill_vid(struct net_device *dev, 37580d5c368SPatrick McHardy __be16 proto, u16 vid) 3764a71df50SFrank Blaschka { 3774a71df50SFrank Blaschka struct qeth_vlan_vid *id, *tmpid = NULL; 378509e2562SHeiko Carstens struct qeth_card *card = dev->ml_priv; 3791aec42bcSThomas Richter int rc = 0; 3804a71df50SFrank Blaschka 381847a50fdSCarsten Otte QETH_CARD_TEXT_(card, 4, "kid:%d", vid); 3825113fec0SUrsula Braun if (card->info.type == QETH_CARD_TYPE_OSM) { 383847a50fdSCarsten Otte QETH_CARD_TEXT(card, 3, "kidOSM"); 3848e586137SJiri Pirko return 0; 3855113fec0SUrsula Braun } 3868e98ac48SUrsula Braun if (qeth_wait_for_threads(card, QETH_RECOVER_THREAD)) { 387847a50fdSCarsten Otte QETH_CARD_TEXT(card, 3, "kidREC"); 3888e586137SJiri Pirko return 0; 3898e98ac48SUrsula Braun } 3904a71df50SFrank Blaschka spin_lock_bh(&card->vlanlock); 3914a71df50SFrank Blaschka list_for_each_entry(id, &card->vid_list, list) { 3924a71df50SFrank Blaschka if (id->vid == vid) { 3934a71df50SFrank Blaschka list_del(&id->list); 3944a71df50SFrank Blaschka tmpid = id; 3954a71df50SFrank Blaschka break; 3964a71df50SFrank Blaschka } 3974a71df50SFrank Blaschka } 3984a71df50SFrank Blaschka spin_unlock_bh(&card->vlanlock); 3994a71df50SFrank Blaschka if (tmpid) { 4001aec42bcSThomas Richter rc = qeth_l2_send_setdelvlan(card, vid, IPA_CMD_DELVLAN); 4014a71df50SFrank Blaschka kfree(tmpid); 4024a71df50SFrank Blaschka } 403fe5c8028SLakhvich Dmitriy qeth_l2_set_rx_mode(card->dev); 4041aec42bcSThomas Richter return rc; 4054a71df50SFrank Blaschka } 4064a71df50SFrank Blaschka 407b2f4de8bSPeter Senna Tschudin static void qeth_l2_stop_card(struct qeth_card *card, int recovery_mode) 4084a71df50SFrank Blaschka { 409d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP , 2, "stopcard"); 410d11ba0c4SPeter Tiedemann QETH_DBF_HEX(SETUP, 2, &card, sizeof(void *)); 4114a71df50SFrank Blaschka 4124a71df50SFrank Blaschka qeth_set_allowed_threads(card, 0, 1); 4134a71df50SFrank Blaschka if (card->read.state == CH_STATE_UP && 4144a71df50SFrank Blaschka card->write.state == CH_STATE_UP && 4154a71df50SFrank Blaschka (card->state == CARD_STATE_UP)) { 4164a71df50SFrank Blaschka if (recovery_mode && 4174a71df50SFrank Blaschka card->info.type != QETH_CARD_TYPE_OSN) { 4184a71df50SFrank Blaschka qeth_l2_stop(card->dev); 4194a71df50SFrank Blaschka } else { 4204a71df50SFrank Blaschka rtnl_lock(); 4214a71df50SFrank Blaschka dev_close(card->dev); 4224a71df50SFrank Blaschka rtnl_unlock(); 4234a71df50SFrank Blaschka } 42470919e23SUrsula Braun card->info.mac_bits &= ~QETH_LAYER2_MAC_REGISTERED; 4254a71df50SFrank Blaschka card->state = CARD_STATE_SOFTSETUP; 4264a71df50SFrank Blaschka } 4274a71df50SFrank Blaschka if (card->state == CARD_STATE_SOFTSETUP) { 428fe5c8028SLakhvich Dmitriy qeth_l2_del_all_macs(card, 0); 4294a71df50SFrank Blaschka qeth_clear_ipacmd_list(card); 4304a71df50SFrank Blaschka card->state = CARD_STATE_HARDSETUP; 4314a71df50SFrank Blaschka } 4324a71df50SFrank Blaschka if (card->state == CARD_STATE_HARDSETUP) { 4334a71df50SFrank Blaschka qeth_qdio_clear_card(card, 0); 4344a71df50SFrank Blaschka qeth_clear_qdio_buffers(card); 4354a71df50SFrank Blaschka qeth_clear_working_pool_list(card); 4364a71df50SFrank Blaschka card->state = CARD_STATE_DOWN; 4374a71df50SFrank Blaschka } 4384a71df50SFrank Blaschka if (card->state == CARD_STATE_DOWN) { 4394a71df50SFrank Blaschka qeth_clear_cmd_buffers(&card->read); 4404a71df50SFrank Blaschka qeth_clear_cmd_buffers(&card->write); 4414a71df50SFrank Blaschka } 4424a71df50SFrank Blaschka } 4434a71df50SFrank Blaschka 444a1c3ed4cSFrank Blaschka static int qeth_l2_process_inbound_buffer(struct qeth_card *card, 445a1c3ed4cSFrank Blaschka int budget, int *done) 4464a71df50SFrank Blaschka { 447a1c3ed4cSFrank Blaschka int work_done = 0; 4484a71df50SFrank Blaschka struct sk_buff *skb; 4494a71df50SFrank Blaschka struct qeth_hdr *hdr; 4504a71df50SFrank Blaschka unsigned int len; 4514a71df50SFrank Blaschka 452a1c3ed4cSFrank Blaschka *done = 0; 45318af5c17SStefan Raspl WARN_ON_ONCE(!budget); 454a1c3ed4cSFrank Blaschka while (budget) { 455a1c3ed4cSFrank Blaschka skb = qeth_core_get_next_skb(card, 456b3332930SFrank Blaschka &card->qdio.in_q->bufs[card->rx.b_index], 457a1c3ed4cSFrank Blaschka &card->rx.b_element, &card->rx.e_offset, &hdr); 458a1c3ed4cSFrank Blaschka if (!skb) { 459a1c3ed4cSFrank Blaschka *done = 1; 460a1c3ed4cSFrank Blaschka break; 4614a71df50SFrank Blaschka } 462a1c3ed4cSFrank Blaschka skb->dev = card->dev; 4634a71df50SFrank Blaschka switch (hdr->hdr.l2.id) { 4644a71df50SFrank Blaschka case QETH_HEADER_TYPE_LAYER2: 4654a71df50SFrank Blaschka skb->pkt_type = PACKET_HOST; 4664a71df50SFrank Blaschka skb->protocol = eth_type_trans(skb, skb->dev); 4674d7def2aSThomas Richter if ((card->dev->features & NETIF_F_RXCSUM) 4684d7def2aSThomas Richter && ((hdr->hdr.l2.flags[1] & 4694d7def2aSThomas Richter (QETH_HDR_EXT_CSUM_HDR_REQ | 4704d7def2aSThomas Richter QETH_HDR_EXT_CSUM_TRANSP_REQ)) == 4714d7def2aSThomas Richter (QETH_HDR_EXT_CSUM_HDR_REQ | 4724d7def2aSThomas Richter QETH_HDR_EXT_CSUM_TRANSP_REQ))) 4734d7def2aSThomas Richter skb->ip_summed = CHECKSUM_UNNECESSARY; 4744d7def2aSThomas Richter else 4754a71df50SFrank Blaschka skb->ip_summed = CHECKSUM_NONE; 47612883725SUrsula Braun if (skb->protocol == htons(ETH_P_802_2)) 4774a71df50SFrank Blaschka *((__u32 *)skb->cb) = ++card->seqno.pkt_seqno; 4784a71df50SFrank Blaschka len = skb->len; 4799abfa8cbSThomas Richter napi_gro_receive(&card->napi, skb); 4804a71df50SFrank Blaschka break; 4814a71df50SFrank Blaschka case QETH_HEADER_TYPE_OSN: 4822d488c2fSUrsula Braun if (card->info.type == QETH_CARD_TYPE_OSN) { 4834a71df50SFrank Blaschka skb_push(skb, sizeof(struct qeth_hdr)); 4844a71df50SFrank Blaschka skb_copy_to_linear_data(skb, hdr, 4854a71df50SFrank Blaschka sizeof(struct qeth_hdr)); 4864a71df50SFrank Blaschka len = skb->len; 4874a71df50SFrank Blaschka card->osn_info.data_cb(skb); 4884a71df50SFrank Blaschka break; 4892d488c2fSUrsula Braun } 4902d488c2fSUrsula Braun /* else unknown */ 4914a71df50SFrank Blaschka default: 4924a71df50SFrank Blaschka dev_kfree_skb_any(skb); 493847a50fdSCarsten Otte QETH_CARD_TEXT(card, 3, "inbunkno"); 494d11ba0c4SPeter Tiedemann QETH_DBF_HEX(CTRL, 3, hdr, QETH_DBF_CTRL_LEN); 4954a71df50SFrank Blaschka continue; 4964a71df50SFrank Blaschka } 497a1c3ed4cSFrank Blaschka work_done++; 498a1c3ed4cSFrank Blaschka budget--; 4994a71df50SFrank Blaschka card->stats.rx_packets++; 5004a71df50SFrank Blaschka card->stats.rx_bytes += len; 5014a71df50SFrank Blaschka } 502a1c3ed4cSFrank Blaschka return work_done; 503a1c3ed4cSFrank Blaschka } 504a1c3ed4cSFrank Blaschka 505a1c3ed4cSFrank Blaschka static int qeth_l2_poll(struct napi_struct *napi, int budget) 506a1c3ed4cSFrank Blaschka { 507a1c3ed4cSFrank Blaschka struct qeth_card *card = container_of(napi, struct qeth_card, napi); 508a1c3ed4cSFrank Blaschka int work_done = 0; 509a1c3ed4cSFrank Blaschka struct qeth_qdio_buffer *buffer; 510a1c3ed4cSFrank Blaschka int done; 511a1c3ed4cSFrank Blaschka int new_budget = budget; 512a1c3ed4cSFrank Blaschka 513a1c3ed4cSFrank Blaschka if (card->options.performance_stats) { 514a1c3ed4cSFrank Blaschka card->perf_stats.inbound_cnt++; 515a1c3ed4cSFrank Blaschka card->perf_stats.inbound_start_time = qeth_get_micros(); 516a1c3ed4cSFrank Blaschka } 517a1c3ed4cSFrank Blaschka 518a1c3ed4cSFrank Blaschka while (1) { 519a1c3ed4cSFrank Blaschka if (!card->rx.b_count) { 520a1c3ed4cSFrank Blaschka card->rx.qdio_err = 0; 521a1c3ed4cSFrank Blaschka card->rx.b_count = qdio_get_next_buffers( 522a1c3ed4cSFrank Blaschka card->data.ccwdev, 0, &card->rx.b_index, 523a1c3ed4cSFrank Blaschka &card->rx.qdio_err); 524a1c3ed4cSFrank Blaschka if (card->rx.b_count <= 0) { 525a1c3ed4cSFrank Blaschka card->rx.b_count = 0; 526a1c3ed4cSFrank Blaschka break; 527a1c3ed4cSFrank Blaschka } 528a1c3ed4cSFrank Blaschka card->rx.b_element = 529a1c3ed4cSFrank Blaschka &card->qdio.in_q->bufs[card->rx.b_index] 530a1c3ed4cSFrank Blaschka .buffer->element[0]; 531a1c3ed4cSFrank Blaschka card->rx.e_offset = 0; 532a1c3ed4cSFrank Blaschka } 533a1c3ed4cSFrank Blaschka 534a1c3ed4cSFrank Blaschka while (card->rx.b_count) { 535a1c3ed4cSFrank Blaschka buffer = &card->qdio.in_q->bufs[card->rx.b_index]; 536a1c3ed4cSFrank Blaschka if (!(card->rx.qdio_err && 537a1c3ed4cSFrank Blaschka qeth_check_qdio_errors(card, buffer->buffer, 538a1c3ed4cSFrank Blaschka card->rx.qdio_err, "qinerr"))) 539a1c3ed4cSFrank Blaschka work_done += qeth_l2_process_inbound_buffer( 540a1c3ed4cSFrank Blaschka card, new_budget, &done); 541a1c3ed4cSFrank Blaschka else 542a1c3ed4cSFrank Blaschka done = 1; 543a1c3ed4cSFrank Blaschka 544a1c3ed4cSFrank Blaschka if (done) { 545a1c3ed4cSFrank Blaschka if (card->options.performance_stats) 546a1c3ed4cSFrank Blaschka card->perf_stats.bufs_rec++; 547a1c3ed4cSFrank Blaschka qeth_put_buffer_pool_entry(card, 548a1c3ed4cSFrank Blaschka buffer->pool_entry); 549a1c3ed4cSFrank Blaschka qeth_queue_input_buffer(card, card->rx.b_index); 550a1c3ed4cSFrank Blaschka card->rx.b_count--; 551a1c3ed4cSFrank Blaschka if (card->rx.b_count) { 552a1c3ed4cSFrank Blaschka card->rx.b_index = 553a1c3ed4cSFrank Blaschka (card->rx.b_index + 1) % 554a1c3ed4cSFrank Blaschka QDIO_MAX_BUFFERS_PER_Q; 555a1c3ed4cSFrank Blaschka card->rx.b_element = 556a1c3ed4cSFrank Blaschka &card->qdio.in_q 557a1c3ed4cSFrank Blaschka ->bufs[card->rx.b_index] 558a1c3ed4cSFrank Blaschka .buffer->element[0]; 559a1c3ed4cSFrank Blaschka card->rx.e_offset = 0; 560a1c3ed4cSFrank Blaschka } 561a1c3ed4cSFrank Blaschka } 562a1c3ed4cSFrank Blaschka 563a1c3ed4cSFrank Blaschka if (work_done >= budget) 564a1c3ed4cSFrank Blaschka goto out; 565a1c3ed4cSFrank Blaschka else 566a1c3ed4cSFrank Blaschka new_budget = budget - work_done; 567a1c3ed4cSFrank Blaschka } 568a1c3ed4cSFrank Blaschka } 569a1c3ed4cSFrank Blaschka 570a1c3ed4cSFrank Blaschka napi_complete(napi); 571a1c3ed4cSFrank Blaschka if (qdio_start_irq(card->data.ccwdev, 0)) 572a1c3ed4cSFrank Blaschka napi_schedule(&card->napi); 573a1c3ed4cSFrank Blaschka out: 574a1c3ed4cSFrank Blaschka if (card->options.performance_stats) 575a1c3ed4cSFrank Blaschka card->perf_stats.inbound_time += qeth_get_micros() - 576a1c3ed4cSFrank Blaschka card->perf_stats.inbound_start_time; 577a1c3ed4cSFrank Blaschka return work_done; 5784a71df50SFrank Blaschka } 5794a71df50SFrank Blaschka 5804a71df50SFrank Blaschka static int qeth_l2_send_setdelmac(struct qeth_card *card, __u8 *mac, 581efbbc1d5SEugene Crosser enum qeth_ipa_cmds ipacmd) 5824a71df50SFrank Blaschka { 5834a71df50SFrank Blaschka struct qeth_ipa_cmd *cmd; 5844a71df50SFrank Blaschka struct qeth_cmd_buffer *iob; 5854a71df50SFrank Blaschka 586847a50fdSCarsten Otte QETH_CARD_TEXT(card, 2, "L2sdmac"); 5874a71df50SFrank Blaschka iob = qeth_get_ipacmd_buffer(card, ipacmd, QETH_PROT_IPV4); 5881aec42bcSThomas Richter if (!iob) 5891aec42bcSThomas Richter return -ENOMEM; 5904a71df50SFrank Blaschka cmd = (struct qeth_ipa_cmd *)(iob->data+IPA_PDU_HEADER_SIZE); 5914a71df50SFrank Blaschka cmd->data.setdelmac.mac_length = OSA_ADDR_LEN; 5924a71df50SFrank Blaschka memcpy(&cmd->data.setdelmac.mac, mac, OSA_ADDR_LEN); 593efbbc1d5SEugene Crosser return qeth_send_ipa_cmd(card, iob, NULL, NULL); 5944a71df50SFrank Blaschka } 5954a71df50SFrank Blaschka 5964a71df50SFrank Blaschka static int qeth_l2_send_setmac(struct qeth_card *card, __u8 *mac) 5974a71df50SFrank Blaschka { 598efbbc1d5SEugene Crosser int rc; 599efbbc1d5SEugene Crosser 600847a50fdSCarsten Otte QETH_CARD_TEXT(card, 2, "L2Setmac"); 601efbbc1d5SEugene Crosser rc = qeth_setdel_makerc(card, qeth_l2_send_setdelmac(card, mac, 602efbbc1d5SEugene Crosser IPA_CMD_SETVMAC)); 603efbbc1d5SEugene Crosser if (rc == 0) { 604efbbc1d5SEugene Crosser card->info.mac_bits |= QETH_LAYER2_MAC_REGISTERED; 605efbbc1d5SEugene Crosser memcpy(card->dev->dev_addr, mac, OSA_ADDR_LEN); 606efbbc1d5SEugene Crosser dev_info(&card->gdev->dev, 607efbbc1d5SEugene Crosser "MAC address %pM successfully registered on device %s\n", 608efbbc1d5SEugene Crosser card->dev->dev_addr, card->dev->name); 609efbbc1d5SEugene Crosser } else { 6104a71df50SFrank Blaschka card->info.mac_bits &= ~QETH_LAYER2_MAC_REGISTERED; 611efbbc1d5SEugene Crosser switch (rc) { 612efbbc1d5SEugene Crosser case -EEXIST: 613efbbc1d5SEugene Crosser dev_warn(&card->gdev->dev, 614efbbc1d5SEugene Crosser "MAC address %pM already exists\n", mac); 615efbbc1d5SEugene Crosser break; 616efbbc1d5SEugene Crosser case -EPERM: 617efbbc1d5SEugene Crosser dev_warn(&card->gdev->dev, 618efbbc1d5SEugene Crosser "MAC address %pM is not authorized\n", mac); 619efbbc1d5SEugene Crosser break; 620efbbc1d5SEugene Crosser } 621efbbc1d5SEugene Crosser } 622efbbc1d5SEugene Crosser return rc; 6234a71df50SFrank Blaschka } 6244a71df50SFrank Blaschka 6254a71df50SFrank Blaschka static int qeth_l2_send_delmac(struct qeth_card *card, __u8 *mac) 6264a71df50SFrank Blaschka { 627efbbc1d5SEugene Crosser int rc; 628efbbc1d5SEugene Crosser 629847a50fdSCarsten Otte QETH_CARD_TEXT(card, 2, "L2Delmac"); 6304a71df50SFrank Blaschka if (!(card->info.mac_bits & QETH_LAYER2_MAC_REGISTERED)) 6314a71df50SFrank Blaschka return 0; 632efbbc1d5SEugene Crosser rc = qeth_setdel_makerc(card, qeth_l2_send_setdelmac(card, mac, 633efbbc1d5SEugene Crosser IPA_CMD_DELVMAC)); 634efbbc1d5SEugene Crosser if (rc == 0) 635efbbc1d5SEugene Crosser card->info.mac_bits &= ~QETH_LAYER2_MAC_REGISTERED; 636efbbc1d5SEugene Crosser return rc; 6374a71df50SFrank Blaschka } 6384a71df50SFrank Blaschka 6394a71df50SFrank Blaschka static int qeth_l2_request_initial_mac(struct qeth_card *card) 6404a71df50SFrank Blaschka { 6414a71df50SFrank Blaschka int rc = 0; 6424a71df50SFrank Blaschka char vendor_pre[] = {0x02, 0x00, 0x00}; 6434a71df50SFrank Blaschka 644d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "doL2init"); 645d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "doL2%s", CARD_BUS_ID(card)); 6464a71df50SFrank Blaschka 647a134884aSStefan Raspl if (qeth_is_supported(card, IPA_SETADAPTERPARMS)) { 6484a71df50SFrank Blaschka rc = qeth_query_setadapterparms(card); 6494a71df50SFrank Blaschka if (rc) { 650a134884aSStefan Raspl QETH_DBF_MESSAGE(2, "could not query adapter " 651a134884aSStefan Raspl "parameters on device %s: x%x\n", 652a134884aSStefan Raspl CARD_BUS_ID(card), rc); 653a134884aSStefan Raspl } 6544a71df50SFrank Blaschka } 6554a71df50SFrank Blaschka 6565113fec0SUrsula Braun if (card->info.type == QETH_CARD_TYPE_IQD || 6575113fec0SUrsula Braun card->info.type == QETH_CARD_TYPE_OSM || 6585113fec0SUrsula Braun card->info.type == QETH_CARD_TYPE_OSX || 6595113fec0SUrsula Braun card->info.guestlan) { 6604a71df50SFrank Blaschka rc = qeth_setadpparms_change_macaddr(card); 6614a71df50SFrank Blaschka if (rc) { 66214cc21b6SFrank Blaschka QETH_DBF_MESSAGE(2, "couldn't get MAC address on " 66314cc21b6SFrank Blaschka "device %s: x%x\n", CARD_BUS_ID(card), rc); 6641aec42bcSThomas Richter QETH_DBF_TEXT_(SETUP, 2, "1err%04x", rc); 6654a71df50SFrank Blaschka return rc; 6664a71df50SFrank Blaschka } 667d11ba0c4SPeter Tiedemann QETH_DBF_HEX(SETUP, 2, card->dev->dev_addr, OSA_ADDR_LEN); 6684a71df50SFrank Blaschka } else { 6691833611dSJoe Perches eth_random_addr(card->dev->dev_addr); 6704a71df50SFrank Blaschka memcpy(card->dev->dev_addr, vendor_pre, 3); 6714a71df50SFrank Blaschka } 6724a71df50SFrank Blaschka return 0; 6734a71df50SFrank Blaschka } 6744a71df50SFrank Blaschka 6754a71df50SFrank Blaschka static int qeth_l2_set_mac_address(struct net_device *dev, void *p) 6764a71df50SFrank Blaschka { 6774a71df50SFrank Blaschka struct sockaddr *addr = p; 678509e2562SHeiko Carstens struct qeth_card *card = dev->ml_priv; 6794a71df50SFrank Blaschka int rc = 0; 6804a71df50SFrank Blaschka 681847a50fdSCarsten Otte QETH_CARD_TEXT(card, 3, "setmac"); 6824a71df50SFrank Blaschka 6834a71df50SFrank Blaschka if (qeth_l2_verify_dev(dev) != QETH_REAL_CARD) { 684847a50fdSCarsten Otte QETH_CARD_TEXT(card, 3, "setmcINV"); 6854a71df50SFrank Blaschka return -EOPNOTSUPP; 6864a71df50SFrank Blaschka } 6874a71df50SFrank Blaschka 6885113fec0SUrsula Braun if (card->info.type == QETH_CARD_TYPE_OSN || 6895113fec0SUrsula Braun card->info.type == QETH_CARD_TYPE_OSM || 6905113fec0SUrsula Braun card->info.type == QETH_CARD_TYPE_OSX) { 691847a50fdSCarsten Otte QETH_CARD_TEXT(card, 3, "setmcTYP"); 6924a71df50SFrank Blaschka return -EOPNOTSUPP; 6934a71df50SFrank Blaschka } 694847a50fdSCarsten Otte QETH_CARD_HEX(card, 3, addr->sa_data, OSA_ADDR_LEN); 6958e98ac48SUrsula Braun if (qeth_wait_for_threads(card, QETH_RECOVER_THREAD)) { 696847a50fdSCarsten Otte QETH_CARD_TEXT(card, 3, "setmcREC"); 6978e98ac48SUrsula Braun return -ERESTARTSYS; 6988e98ac48SUrsula Braun } 6994a71df50SFrank Blaschka rc = qeth_l2_send_delmac(card, &card->dev->dev_addr[0]); 700efbbc1d5SEugene Crosser if (!rc || (rc == -ENOENT)) 7014a71df50SFrank Blaschka rc = qeth_l2_send_setmac(card, addr->sa_data); 702e0a8114cSUrsula Braun return rc ? -EINVAL : 0; 7034a71df50SFrank Blaschka } 7044a71df50SFrank Blaschka 7050db587b0SEugene Crosser static void qeth_promisc_to_bridge(struct qeth_card *card) 7060db587b0SEugene Crosser { 7070db587b0SEugene Crosser struct net_device *dev = card->dev; 7080db587b0SEugene Crosser enum qeth_ipa_promisc_modes promisc_mode; 7090db587b0SEugene Crosser int role; 7100db587b0SEugene Crosser int rc; 7110db587b0SEugene Crosser 7120db587b0SEugene Crosser QETH_CARD_TEXT(card, 3, "pmisc2br"); 7130db587b0SEugene Crosser 7140db587b0SEugene Crosser if (!card->options.sbp.reflect_promisc) 7150db587b0SEugene Crosser return; 7160db587b0SEugene Crosser promisc_mode = (dev->flags & IFF_PROMISC) ? SET_PROMISC_MODE_ON 7170db587b0SEugene Crosser : SET_PROMISC_MODE_OFF; 7180db587b0SEugene Crosser if (promisc_mode == card->info.promisc_mode) 7190db587b0SEugene Crosser return; 7200db587b0SEugene Crosser 7210db587b0SEugene Crosser if (promisc_mode == SET_PROMISC_MODE_ON) { 7220db587b0SEugene Crosser if (card->options.sbp.reflect_promisc_primary) 7230db587b0SEugene Crosser role = QETH_SBP_ROLE_PRIMARY; 7240db587b0SEugene Crosser else 7250db587b0SEugene Crosser role = QETH_SBP_ROLE_SECONDARY; 7260db587b0SEugene Crosser } else 7270db587b0SEugene Crosser role = QETH_SBP_ROLE_NONE; 7280db587b0SEugene Crosser 7290db587b0SEugene Crosser rc = qeth_bridgeport_setrole(card, role); 7300db587b0SEugene Crosser QETH_DBF_TEXT_(SETUP, 2, "bpm%c%04x", 7310db587b0SEugene Crosser (promisc_mode == SET_PROMISC_MODE_ON) ? '+' : '-', rc); 7320db587b0SEugene Crosser if (!rc) { 7330db587b0SEugene Crosser card->options.sbp.role = role; 7340db587b0SEugene Crosser card->info.promisc_mode = promisc_mode; 7350db587b0SEugene Crosser } 736fe5c8028SLakhvich Dmitriy 737fe5c8028SLakhvich Dmitriy } 738fe5c8028SLakhvich Dmitriy /* New MAC address is added to the hash table and marked to be written on card 739fe5c8028SLakhvich Dmitriy * only if there is not in the hash table storage already 740fe5c8028SLakhvich Dmitriy * 741fe5c8028SLakhvich Dmitriy */ 742fe5c8028SLakhvich Dmitriy static void 743fe5c8028SLakhvich Dmitriy qeth_l2_add_mac(struct qeth_card *card, struct netdev_hw_addr *ha, u8 is_uc) 744fe5c8028SLakhvich Dmitriy { 745fe5c8028SLakhvich Dmitriy struct qeth_mac *mac; 746fe5c8028SLakhvich Dmitriy 747fe5c8028SLakhvich Dmitriy hash_for_each_possible(card->mac_htable, mac, hnode, 748fe5c8028SLakhvich Dmitriy qeth_l2_mac_hash(ha->addr)) { 749fe5c8028SLakhvich Dmitriy if (is_uc == mac->is_uc && 750fe5c8028SLakhvich Dmitriy !memcmp(ha->addr, mac->mac_addr, OSA_ADDR_LEN)) { 7515f78e29cSLakhvich Dmitriy mac->disp_flag = QETH_DISP_ADDR_DO_NOTHING; 752fe5c8028SLakhvich Dmitriy return; 753fe5c8028SLakhvich Dmitriy } 7540db587b0SEugene Crosser } 7550db587b0SEugene Crosser 756fe5c8028SLakhvich Dmitriy mac = kzalloc(sizeof(struct qeth_mac), GFP_ATOMIC); 757fe5c8028SLakhvich Dmitriy 758fe5c8028SLakhvich Dmitriy if (!mac) 759fe5c8028SLakhvich Dmitriy return; 760fe5c8028SLakhvich Dmitriy 761fe5c8028SLakhvich Dmitriy memcpy(mac->mac_addr, ha->addr, OSA_ADDR_LEN); 762fe5c8028SLakhvich Dmitriy mac->is_uc = is_uc; 7635f78e29cSLakhvich Dmitriy mac->disp_flag = QETH_DISP_ADDR_ADD; 764fe5c8028SLakhvich Dmitriy 765fe5c8028SLakhvich Dmitriy hash_add(card->mac_htable, &mac->hnode, 766fe5c8028SLakhvich Dmitriy qeth_l2_mac_hash(mac->mac_addr)); 767fe5c8028SLakhvich Dmitriy 768fe5c8028SLakhvich Dmitriy } 769fe5c8028SLakhvich Dmitriy 770fe5c8028SLakhvich Dmitriy static void qeth_l2_set_rx_mode(struct net_device *dev) 7714a71df50SFrank Blaschka { 772509e2562SHeiko Carstens struct qeth_card *card = dev->ml_priv; 773ccffad25SJiri Pirko struct netdev_hw_addr *ha; 774fe5c8028SLakhvich Dmitriy struct qeth_mac *mac; 775fe5c8028SLakhvich Dmitriy struct hlist_node *tmp; 776fe5c8028SLakhvich Dmitriy int i; 777fe5c8028SLakhvich Dmitriy int rc; 7784a71df50SFrank Blaschka 7794a71df50SFrank Blaschka if (card->info.type == QETH_CARD_TYPE_OSN) 7804a71df50SFrank Blaschka return; 7814a71df50SFrank Blaschka 782847a50fdSCarsten Otte QETH_CARD_TEXT(card, 3, "setmulti"); 7838e98ac48SUrsula Braun if (qeth_threads_running(card, QETH_RECOVER_THREAD) && 7848e98ac48SUrsula Braun (card->state != CARD_STATE_UP)) 7858e98ac48SUrsula Braun return; 786fe5c8028SLakhvich Dmitriy 7874a71df50SFrank Blaschka spin_lock_bh(&card->mclock); 788fe5c8028SLakhvich Dmitriy 78922bedad3SJiri Pirko netdev_for_each_mc_addr(ha, dev) 790fe5c8028SLakhvich Dmitriy qeth_l2_add_mac(card, ha, 0); 7917db2266aSFrank Blaschka 79232e7bfc4SJiri Pirko netdev_for_each_uc_addr(ha, dev) 793fe5c8028SLakhvich Dmitriy qeth_l2_add_mac(card, ha, 1); 794fe5c8028SLakhvich Dmitriy 795fe5c8028SLakhvich Dmitriy hash_for_each_safe(card->mac_htable, i, tmp, mac, hnode) { 7965f78e29cSLakhvich Dmitriy if (mac->disp_flag == QETH_DISP_ADDR_DELETE) { 797fe5c8028SLakhvich Dmitriy if (!mac->is_uc) 798fe5c8028SLakhvich Dmitriy rc = qeth_l2_send_delgroupmac(card, 799fe5c8028SLakhvich Dmitriy mac->mac_addr); 800fe5c8028SLakhvich Dmitriy else { 801fe5c8028SLakhvich Dmitriy rc = qeth_l2_send_setdelmac(card, mac->mac_addr, 802fe5c8028SLakhvich Dmitriy IPA_CMD_DELVMAC); 803fe5c8028SLakhvich Dmitriy } 804fe5c8028SLakhvich Dmitriy 805fe5c8028SLakhvich Dmitriy hash_del(&mac->hnode); 806fe5c8028SLakhvich Dmitriy kfree(mac); 807fe5c8028SLakhvich Dmitriy 8085f78e29cSLakhvich Dmitriy } else if (mac->disp_flag == QETH_DISP_ADDR_ADD) { 809fe5c8028SLakhvich Dmitriy rc = qeth_l2_write_mac(card, mac); 810fe5c8028SLakhvich Dmitriy if (rc) { 811fe5c8028SLakhvich Dmitriy hash_del(&mac->hnode); 812fe5c8028SLakhvich Dmitriy kfree(mac); 813fe5c8028SLakhvich Dmitriy } else 8145f78e29cSLakhvich Dmitriy mac->disp_flag = QETH_DISP_ADDR_DELETE; 815fe5c8028SLakhvich Dmitriy } else 8165f78e29cSLakhvich Dmitriy mac->disp_flag = QETH_DISP_ADDR_DELETE; 817fe5c8028SLakhvich Dmitriy } 8187db2266aSFrank Blaschka 8194a71df50SFrank Blaschka spin_unlock_bh(&card->mclock); 820fe5c8028SLakhvich Dmitriy 8210db587b0SEugene Crosser if (qeth_adp_supported(card, IPA_SETADP_SET_PROMISC_MODE)) 8224a71df50SFrank Blaschka qeth_setadp_promisc_mode(card); 8230db587b0SEugene Crosser else 8240db587b0SEugene Crosser qeth_promisc_to_bridge(card); 8254a71df50SFrank Blaschka } 8264a71df50SFrank Blaschka 8274a71df50SFrank Blaschka static int qeth_l2_hard_start_xmit(struct sk_buff *skb, struct net_device *dev) 8284a71df50SFrank Blaschka { 8294a71df50SFrank Blaschka int rc; 8304a71df50SFrank Blaschka struct qeth_hdr *hdr = NULL; 8314a71df50SFrank Blaschka int elements = 0; 832509e2562SHeiko Carstens struct qeth_card *card = dev->ml_priv; 8334a71df50SFrank Blaschka struct sk_buff *new_skb = skb; 834ce73e10eSKlaus-Dieter Wacker int cast_type = qeth_l2_get_cast_type(card, skb); 835290b8348SStefan Raspl struct qeth_qdio_out_q *queue; 8364a71df50SFrank Blaschka int tx_bytes = skb->len; 837683d718aSFrank Blaschka int data_offset = -1; 838683d718aSFrank Blaschka int elements_needed = 0; 839683d718aSFrank Blaschka int hd_len = 0; 840d52aec97SEugene Crosser int nr_frags; 8414a71df50SFrank Blaschka 842290b8348SStefan Raspl if (card->qdio.do_prio_queueing || (cast_type && 843290b8348SStefan Raspl card->info.is_multicast_different)) 844290b8348SStefan Raspl queue = card->qdio.out_qs[qeth_get_priority_queue(card, skb, 845290b8348SStefan Raspl qeth_get_ip_version(skb), cast_type)]; 846290b8348SStefan Raspl else 847290b8348SStefan Raspl queue = card->qdio.out_qs[card->qdio.default_out_queue]; 848290b8348SStefan Raspl 8494a71df50SFrank Blaschka if ((card->state != CARD_STATE_UP) || !card->lan_online) { 8504a71df50SFrank Blaschka card->stats.tx_carrier_errors++; 8514a71df50SFrank Blaschka goto tx_drop; 8524a71df50SFrank Blaschka } 8534a71df50SFrank Blaschka 8544a71df50SFrank Blaschka if ((card->info.type == QETH_CARD_TYPE_OSN) && 8554a71df50SFrank Blaschka (skb->protocol == htons(ETH_P_IPV6))) 8564a71df50SFrank Blaschka goto tx_drop; 8574a71df50SFrank Blaschka 8584a71df50SFrank Blaschka if (card->options.performance_stats) { 8594a71df50SFrank Blaschka card->perf_stats.outbound_cnt++; 8604a71df50SFrank Blaschka card->perf_stats.outbound_start_time = qeth_get_micros(); 8614a71df50SFrank Blaschka } 8624a71df50SFrank Blaschka netif_stop_queue(dev); 8634a71df50SFrank Blaschka 864d52aec97SEugene Crosser /* fix hardware limitation: as long as we do not have sbal 865d52aec97SEugene Crosser * chaining we can not send long frag lists 866d52aec97SEugene Crosser */ 867d52aec97SEugene Crosser if ((card->info.type != QETH_CARD_TYPE_IQD) && 868d52aec97SEugene Crosser !qeth_get_elements_no(card, new_skb, 0)) { 8696059c905SEugene Crosser int lin_rc = skb_linearize(new_skb); 8706059c905SEugene Crosser 8716059c905SEugene Crosser if (card->options.performance_stats) { 8726059c905SEugene Crosser if (lin_rc) 8736059c905SEugene Crosser card->perf_stats.tx_linfail++; 8746059c905SEugene Crosser else 875d52aec97SEugene Crosser card->perf_stats.tx_lin++; 876d52aec97SEugene Crosser } 8776059c905SEugene Crosser if (lin_rc) 8786059c905SEugene Crosser goto tx_drop; 8796059c905SEugene Crosser } 880d52aec97SEugene Crosser 8814a71df50SFrank Blaschka if (card->info.type == QETH_CARD_TYPE_OSN) 8824a71df50SFrank Blaschka hdr = (struct qeth_hdr *)skb->data; 8834a71df50SFrank Blaschka else { 88464ef8957SFrank Blaschka if (card->info.type == QETH_CARD_TYPE_IQD) { 885683d718aSFrank Blaschka new_skb = skb; 886683d718aSFrank Blaschka data_offset = ETH_HLEN; 887683d718aSFrank Blaschka hd_len = ETH_HLEN; 888683d718aSFrank Blaschka hdr = kmem_cache_alloc(qeth_core_header_cache, 889683d718aSFrank Blaschka GFP_ATOMIC); 890683d718aSFrank Blaschka if (!hdr) 891683d718aSFrank Blaschka goto tx_drop; 892683d718aSFrank Blaschka elements_needed++; 893683d718aSFrank Blaschka skb_reset_mac_header(new_skb); 89443934077SStefan Raspl qeth_l2_fill_header(card, hdr, new_skb, cast_type); 895683d718aSFrank Blaschka hdr->hdr.l2.pkt_length = new_skb->len; 896683d718aSFrank Blaschka memcpy(((char *)hdr) + sizeof(struct qeth_hdr), 897683d718aSFrank Blaschka skb_mac_header(new_skb), ETH_HLEN); 898683d718aSFrank Blaschka } else { 899f90b744eSFrank Blaschka /* create a clone with writeable headroom */ 900683d718aSFrank Blaschka new_skb = skb_realloc_headroom(skb, 901683d718aSFrank Blaschka sizeof(struct qeth_hdr)); 9024a71df50SFrank Blaschka if (!new_skb) 9034a71df50SFrank Blaschka goto tx_drop; 904f90b744eSFrank Blaschka hdr = (struct qeth_hdr *)skb_push(new_skb, 905f90b744eSFrank Blaschka sizeof(struct qeth_hdr)); 906683d718aSFrank Blaschka skb_set_mac_header(new_skb, sizeof(struct qeth_hdr)); 90743934077SStefan Raspl qeth_l2_fill_header(card, hdr, new_skb, cast_type); 9084d7def2aSThomas Richter if (new_skb->ip_summed == CHECKSUM_PARTIAL) 9094d7def2aSThomas Richter qeth_l2_hdr_csum(card, hdr, new_skb); 9104a71df50SFrank Blaschka } 911683d718aSFrank Blaschka } 9124a71df50SFrank Blaschka 913065cc782SStefan Raspl elements = qeth_get_elements_no(card, new_skb, elements_needed); 914683d718aSFrank Blaschka if (!elements) { 915683d718aSFrank Blaschka if (data_offset >= 0) 916683d718aSFrank Blaschka kmem_cache_free(qeth_core_header_cache, hdr); 9174a71df50SFrank Blaschka goto tx_drop; 9184a71df50SFrank Blaschka } 9194a71df50SFrank Blaschka 92051aa165cSFrank Blaschka if (card->info.type != QETH_CARD_TYPE_IQD) { 921d4ae1f5eSStefan Raspl if (qeth_hdr_chk_and_bounce(new_skb, &hdr, 92251aa165cSFrank Blaschka sizeof(struct qeth_hdr_layer2))) 92351aa165cSFrank Blaschka goto tx_drop; 9244a71df50SFrank Blaschka rc = qeth_do_send_packet(card, queue, new_skb, hdr, 92564ef8957SFrank Blaschka elements); 92651aa165cSFrank Blaschka } else 9274a71df50SFrank Blaschka rc = qeth_do_send_packet_fast(card, queue, new_skb, hdr, 92864ef8957SFrank Blaschka elements, data_offset, hd_len); 9294a71df50SFrank Blaschka if (!rc) { 9304a71df50SFrank Blaschka card->stats.tx_packets++; 9314a71df50SFrank Blaschka card->stats.tx_bytes += tx_bytes; 932d52aec97SEugene Crosser if (card->options.performance_stats) { 933d52aec97SEugene Crosser nr_frags = skb_shinfo(new_skb)->nr_frags; 934d52aec97SEugene Crosser if (nr_frags) { 935d52aec97SEugene Crosser card->perf_stats.sg_skbs_sent++; 936d52aec97SEugene Crosser /* nr_frags + skb->data */ 937d52aec97SEugene Crosser card->perf_stats.sg_frags_sent += nr_frags + 1; 938d52aec97SEugene Crosser } 939d52aec97SEugene Crosser } 9404a71df50SFrank Blaschka if (new_skb != skb) 9414a71df50SFrank Blaschka dev_kfree_skb_any(skb); 942ec634fe3SPatrick McHardy rc = NETDEV_TX_OK; 9434a71df50SFrank Blaschka } else { 944683d718aSFrank Blaschka if (data_offset >= 0) 945683d718aSFrank Blaschka kmem_cache_free(qeth_core_header_cache, hdr); 946683d718aSFrank Blaschka 9474a71df50SFrank Blaschka if (rc == -EBUSY) { 9484a71df50SFrank Blaschka if (new_skb != skb) 9494a71df50SFrank Blaschka dev_kfree_skb_any(new_skb); 9504a71df50SFrank Blaschka return NETDEV_TX_BUSY; 9514a71df50SFrank Blaschka } else 9524a71df50SFrank Blaschka goto tx_drop; 9534a71df50SFrank Blaschka } 9544a71df50SFrank Blaschka 9554a71df50SFrank Blaschka netif_wake_queue(dev); 9564a71df50SFrank Blaschka if (card->options.performance_stats) 9574a71df50SFrank Blaschka card->perf_stats.outbound_time += qeth_get_micros() - 9584a71df50SFrank Blaschka card->perf_stats.outbound_start_time; 9594a71df50SFrank Blaschka return rc; 9604a71df50SFrank Blaschka 9614a71df50SFrank Blaschka tx_drop: 9624a71df50SFrank Blaschka card->stats.tx_dropped++; 9634a71df50SFrank Blaschka card->stats.tx_errors++; 9644a71df50SFrank Blaschka if ((new_skb != skb) && new_skb) 9654a71df50SFrank Blaschka dev_kfree_skb_any(new_skb); 9664a71df50SFrank Blaschka dev_kfree_skb_any(skb); 967d0ec0f54SFrank Blaschka netif_wake_queue(dev); 9684a71df50SFrank Blaschka return NETDEV_TX_OK; 9694a71df50SFrank Blaschka } 9704a71df50SFrank Blaschka 97139423440SUrsula Braun static int __qeth_l2_open(struct net_device *dev) 9724a71df50SFrank Blaschka { 973509e2562SHeiko Carstens struct qeth_card *card = dev->ml_priv; 974a1c3ed4cSFrank Blaschka int rc = 0; 9754a71df50SFrank Blaschka 976847a50fdSCarsten Otte QETH_CARD_TEXT(card, 4, "qethopen"); 97739423440SUrsula Braun if (card->state == CARD_STATE_UP) 97839423440SUrsula Braun return rc; 9794a71df50SFrank Blaschka if (card->state != CARD_STATE_SOFTSETUP) 9804a71df50SFrank Blaschka return -ENODEV; 9814a71df50SFrank Blaschka 9824a71df50SFrank Blaschka if ((card->info.type != QETH_CARD_TYPE_OSN) && 9834a71df50SFrank Blaschka (!(card->info.mac_bits & QETH_LAYER2_MAC_REGISTERED))) { 984847a50fdSCarsten Otte QETH_CARD_TEXT(card, 4, "nomacadr"); 9854a71df50SFrank Blaschka return -EPERM; 9864a71df50SFrank Blaschka } 9874a71df50SFrank Blaschka card->data.state = CH_STATE_UP; 9884a71df50SFrank Blaschka card->state = CARD_STATE_UP; 9894a71df50SFrank Blaschka netif_start_queue(dev); 9904a71df50SFrank Blaschka 991a1c3ed4cSFrank Blaschka if (qdio_stop_irq(card->data.ccwdev, 0) >= 0) { 992a1c3ed4cSFrank Blaschka napi_enable(&card->napi); 993a1c3ed4cSFrank Blaschka napi_schedule(&card->napi); 994a1c3ed4cSFrank Blaschka } else 995a1c3ed4cSFrank Blaschka rc = -EIO; 996a1c3ed4cSFrank Blaschka return rc; 9974a71df50SFrank Blaschka } 9984a71df50SFrank Blaschka 99939423440SUrsula Braun static int qeth_l2_open(struct net_device *dev) 100039423440SUrsula Braun { 100139423440SUrsula Braun struct qeth_card *card = dev->ml_priv; 100239423440SUrsula Braun 100339423440SUrsula Braun QETH_CARD_TEXT(card, 5, "qethope_"); 100439423440SUrsula Braun if (qeth_wait_for_threads(card, QETH_RECOVER_THREAD)) { 100539423440SUrsula Braun QETH_CARD_TEXT(card, 3, "openREC"); 100639423440SUrsula Braun return -ERESTARTSYS; 100739423440SUrsula Braun } 100839423440SUrsula Braun return __qeth_l2_open(dev); 100939423440SUrsula Braun } 101039423440SUrsula Braun 10114a71df50SFrank Blaschka static int qeth_l2_stop(struct net_device *dev) 10124a71df50SFrank Blaschka { 1013509e2562SHeiko Carstens struct qeth_card *card = dev->ml_priv; 10144a71df50SFrank Blaschka 1015847a50fdSCarsten Otte QETH_CARD_TEXT(card, 4, "qethstop"); 10164a71df50SFrank Blaschka netif_tx_disable(dev); 1017a1c3ed4cSFrank Blaschka if (card->state == CARD_STATE_UP) { 10184a71df50SFrank Blaschka card->state = CARD_STATE_SOFTSETUP; 1019a1c3ed4cSFrank Blaschka napi_disable(&card->napi); 1020a1c3ed4cSFrank Blaschka } 10214a71df50SFrank Blaschka return 0; 10224a71df50SFrank Blaschka } 10234a71df50SFrank Blaschka 10244a71df50SFrank Blaschka static int qeth_l2_probe_device(struct ccwgroup_device *gdev) 10254a71df50SFrank Blaschka { 10264a71df50SFrank Blaschka struct qeth_card *card = dev_get_drvdata(&gdev->dev); 10274a71df50SFrank Blaschka 1028b4d72c08SEugene Crosser qeth_l2_create_device_attributes(&gdev->dev); 10294a71df50SFrank Blaschka INIT_LIST_HEAD(&card->vid_list); 1030fe5c8028SLakhvich Dmitriy hash_init(card->mac_htable); 10314a71df50SFrank Blaschka card->options.layer2 = 1; 10321da74b1cSFrank Blaschka card->info.hwtrap = 0; 10334a71df50SFrank Blaschka return 0; 10344a71df50SFrank Blaschka } 10354a71df50SFrank Blaschka 10364a71df50SFrank Blaschka static void qeth_l2_remove_device(struct ccwgroup_device *cgdev) 10374a71df50SFrank Blaschka { 10384a71df50SFrank Blaschka struct qeth_card *card = dev_get_drvdata(&cgdev->dev); 10394a71df50SFrank Blaschka 1040b4d72c08SEugene Crosser qeth_l2_remove_device_attributes(&cgdev->dev); 1041f2148565SUrsula Braun qeth_set_allowed_threads(card, 0, 1); 10424a71df50SFrank Blaschka wait_event(card->wait_q, qeth_threads_running(card, 0xffffffff) == 0); 10434a71df50SFrank Blaschka 104470919e23SUrsula Braun if (cgdev->state == CCWGROUP_ONLINE) 10454a71df50SFrank Blaschka qeth_l2_set_offline(cgdev); 10464a71df50SFrank Blaschka 10474a71df50SFrank Blaschka if (card->dev) { 10487831b4ffSUrsula Braun netif_napi_del(&card->napi); 10494a71df50SFrank Blaschka unregister_netdev(card->dev); 10504a71df50SFrank Blaschka card->dev = NULL; 10514a71df50SFrank Blaschka } 10524a71df50SFrank Blaschka return; 10534a71df50SFrank Blaschka } 10544a71df50SFrank Blaschka 10550fc0b732SStephen Hemminger static const struct ethtool_ops qeth_l2_ethtool_ops = { 10564a71df50SFrank Blaschka .get_link = ethtool_op_get_link, 10574a71df50SFrank Blaschka .get_strings = qeth_core_get_strings, 10584a71df50SFrank Blaschka .get_ethtool_stats = qeth_core_get_ethtool_stats, 1059df8b4ec8SBen Hutchings .get_sset_count = qeth_core_get_sset_count, 10604a71df50SFrank Blaschka .get_drvinfo = qeth_core_get_drvinfo, 10613f9975aaSFrank Blaschka .get_settings = qeth_core_ethtool_get_settings, 10624a71df50SFrank Blaschka }; 10634a71df50SFrank Blaschka 10640fc0b732SStephen Hemminger static const struct ethtool_ops qeth_l2_osn_ops = { 10654a71df50SFrank Blaschka .get_strings = qeth_core_get_strings, 10664a71df50SFrank Blaschka .get_ethtool_stats = qeth_core_get_ethtool_stats, 1067df8b4ec8SBen Hutchings .get_sset_count = qeth_core_get_sset_count, 10684a71df50SFrank Blaschka .get_drvinfo = qeth_core_get_drvinfo, 10694a71df50SFrank Blaschka }; 10704a71df50SFrank Blaschka 10713d58cefdSFrank Blaschka static const struct net_device_ops qeth_l2_netdev_ops = { 10728403b13cSFrank Blaschka .ndo_open = qeth_l2_open, 10738403b13cSFrank Blaschka .ndo_stop = qeth_l2_stop, 10748403b13cSFrank Blaschka .ndo_get_stats = qeth_get_stats, 10758403b13cSFrank Blaschka .ndo_start_xmit = qeth_l2_hard_start_xmit, 10768403b13cSFrank Blaschka .ndo_validate_addr = eth_validate_addr, 1077fe5c8028SLakhvich Dmitriy .ndo_set_rx_mode = qeth_l2_set_rx_mode, 10788403b13cSFrank Blaschka .ndo_do_ioctl = qeth_l2_do_ioctl, 10798403b13cSFrank Blaschka .ndo_set_mac_address = qeth_l2_set_mac_address, 10808403b13cSFrank Blaschka .ndo_change_mtu = qeth_change_mtu, 10818403b13cSFrank Blaschka .ndo_vlan_rx_add_vid = qeth_l2_vlan_rx_add_vid, 10828403b13cSFrank Blaschka .ndo_vlan_rx_kill_vid = qeth_l2_vlan_rx_kill_vid, 10838403b13cSFrank Blaschka .ndo_tx_timeout = qeth_tx_timeout, 10848f43fb00SThomas Richter .ndo_fix_features = qeth_fix_features, 10858f43fb00SThomas Richter .ndo_set_features = qeth_set_features 10868403b13cSFrank Blaschka }; 10878403b13cSFrank Blaschka 10884a71df50SFrank Blaschka static int qeth_l2_setup_netdev(struct qeth_card *card) 10894a71df50SFrank Blaschka { 10904a71df50SFrank Blaschka switch (card->info.type) { 10914a71df50SFrank Blaschka case QETH_CARD_TYPE_IQD: 1092c835a677STom Gundersen card->dev = alloc_netdev(0, "hsi%d", NET_NAME_UNKNOWN, 1093c835a677STom Gundersen ether_setup); 10944a71df50SFrank Blaschka break; 10954a71df50SFrank Blaschka case QETH_CARD_TYPE_OSN: 1096c835a677STom Gundersen card->dev = alloc_netdev(0, "osn%d", NET_NAME_UNKNOWN, 1097c835a677STom Gundersen ether_setup); 10984a71df50SFrank Blaschka card->dev->flags |= IFF_NOARP; 10994a71df50SFrank Blaschka break; 11004a71df50SFrank Blaschka default: 11014a71df50SFrank Blaschka card->dev = alloc_etherdev(0); 11024a71df50SFrank Blaschka } 11034a71df50SFrank Blaschka 11044a71df50SFrank Blaschka if (!card->dev) 11054a71df50SFrank Blaschka return -ENODEV; 11064a71df50SFrank Blaschka 1107509e2562SHeiko Carstens card->dev->ml_priv = card; 11084a71df50SFrank Blaschka card->dev->watchdog_timeo = QETH_TX_TIMEOUT; 11094a71df50SFrank Blaschka card->dev->mtu = card->info.initial_mtu; 11108403b13cSFrank Blaschka card->dev->netdev_ops = &qeth_l2_netdev_ops; 11117ad24ea4SWilfried Klaebe card->dev->ethtool_ops = 11127ad24ea4SWilfried Klaebe (card->info.type != QETH_CARD_TYPE_OSN) ? 11137ad24ea4SWilfried Klaebe &qeth_l2_ethtool_ops : &qeth_l2_osn_ops; 1114f646968fSPatrick McHardy card->dev->features |= NETIF_F_HW_VLAN_CTAG_FILTER; 11154d7def2aSThomas Richter if (card->info.type == QETH_CARD_TYPE_OSD && !card->info.guestlan) { 11168f43fb00SThomas Richter card->dev->hw_features = NETIF_F_SG; 11179bdc4411SHans Wippel card->dev->vlan_features = NETIF_F_SG; 11188f43fb00SThomas Richter /* OSA 3S and earlier has no RX/TX support */ 11199bdc4411SHans Wippel if (qeth_is_supported(card, IPA_OUTBOUND_CHECKSUM)) { 11208f43fb00SThomas Richter card->dev->hw_features |= NETIF_F_IP_CSUM; 11219bdc4411SHans Wippel card->dev->vlan_features |= NETIF_F_IP_CSUM; 11229bdc4411SHans Wippel } 11239bdc4411SHans Wippel if (qeth_is_supported(card, IPA_INBOUND_CHECKSUM)) { 11248f43fb00SThomas Richter card->dev->hw_features |= NETIF_F_RXCSUM; 11259bdc4411SHans Wippel card->dev->vlan_features |= NETIF_F_RXCSUM; 11269bdc4411SHans Wippel } 11278f43fb00SThomas Richter /* Turn on SG per default */ 11288f43fb00SThomas Richter card->dev->features |= NETIF_F_SG; 11294d7def2aSThomas Richter } 11304a71df50SFrank Blaschka card->info.broadcast_capable = 1; 11314a71df50SFrank Blaschka qeth_l2_request_initial_mac(card); 1132d52aec97SEugene Crosser card->dev->gso_max_size = (QETH_MAX_BUFFER_ELEMENTS(card) - 1) * 1133d52aec97SEugene Crosser PAGE_SIZE; 1134d52aec97SEugene Crosser card->dev->gso_max_segs = (QETH_MAX_BUFFER_ELEMENTS(card) - 1); 11354a71df50SFrank Blaschka SET_NETDEV_DEV(card->dev, &card->gdev->dev); 1136a1c3ed4cSFrank Blaschka netif_napi_add(card->dev, &card->napi, qeth_l2_poll, QETH_NAPI_WEIGHT); 1137e5ebe632SUrsula Braun netif_carrier_off(card->dev); 11384a71df50SFrank Blaschka return register_netdev(card->dev); 11394a71df50SFrank Blaschka } 11404a71df50SFrank Blaschka 11414d7def2aSThomas Richter static int qeth_l2_start_ipassists(struct qeth_card *card) 11424d7def2aSThomas Richter { 11434d7def2aSThomas Richter /* configure isolation level */ 11444d7def2aSThomas Richter if (qeth_set_access_ctrl_online(card, 0)) 11454d7def2aSThomas Richter return -ENODEV; 11464d7def2aSThomas Richter return 0; 11474d7def2aSThomas Richter } 11484d7def2aSThomas Richter 11494a71df50SFrank Blaschka static int __qeth_l2_set_online(struct ccwgroup_device *gdev, int recovery_mode) 11504a71df50SFrank Blaschka { 11514a71df50SFrank Blaschka struct qeth_card *card = dev_get_drvdata(&gdev->dev); 11524a71df50SFrank Blaschka int rc = 0; 11534a71df50SFrank Blaschka enum qeth_card_states recover_flag; 11544a71df50SFrank Blaschka 11559dc48cccSUrsula Braun mutex_lock(&card->discipline_mutex); 1156c4949f07SFrank Blaschka mutex_lock(&card->conf_mutex); 1157d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "setonlin"); 1158d11ba0c4SPeter Tiedemann QETH_DBF_HEX(SETUP, 2, &card, sizeof(void *)); 11594a71df50SFrank Blaschka 11604a71df50SFrank Blaschka recover_flag = card->state; 11614a71df50SFrank Blaschka rc = qeth_core_hardsetup_card(card); 11624a71df50SFrank Blaschka if (rc) { 11631aec42bcSThomas Richter QETH_DBF_TEXT_(SETUP, 2, "2err%04x", rc); 1164aa909224SUrsula Braun rc = -ENODEV; 11654a71df50SFrank Blaschka goto out_remove; 11664a71df50SFrank Blaschka } 1167c044dc21SEugene Crosser qeth_bridgeport_query_support(card); 1168c044dc21SEugene Crosser if (card->options.sbp.supported_funcs) 1169c044dc21SEugene Crosser dev_info(&card->gdev->dev, 11709c23f4daSEugene Crosser "The device represents a Bridge Capable Port\n"); 1171395672e0SStefan Raspl qeth_trace_features(card); 11724a71df50SFrank Blaschka 1173aa909224SUrsula Braun if (!card->dev && qeth_l2_setup_netdev(card)) { 1174aa909224SUrsula Braun rc = -ENODEV; 11754a71df50SFrank Blaschka goto out_remove; 1176aa909224SUrsula Braun } 11774a71df50SFrank Blaschka 11784a71df50SFrank Blaschka if (card->info.type != QETH_CARD_TYPE_OSN) 11794a71df50SFrank Blaschka qeth_l2_send_setmac(card, &card->dev->dev_addr[0]); 11804a71df50SFrank Blaschka 11811da74b1cSFrank Blaschka if (qeth_is_diagass_supported(card, QETH_DIAGS_CMD_TRAP)) { 11821da74b1cSFrank Blaschka if (card->info.hwtrap && 11831da74b1cSFrank Blaschka qeth_hw_trap(card, QETH_DIAGS_TRAP_ARM)) 11841da74b1cSFrank Blaschka card->info.hwtrap = 0; 11851da74b1cSFrank Blaschka } else 11861da74b1cSFrank Blaschka card->info.hwtrap = 0; 11871da74b1cSFrank Blaschka 1188b4d72c08SEugene Crosser qeth_l2_setup_bridgeport_attrs(card); 1189b4d72c08SEugene Crosser 11904a71df50SFrank Blaschka card->state = CARD_STATE_HARDSETUP; 1191a1c3ed4cSFrank Blaschka memset(&card->rx, 0, sizeof(struct qeth_rx)); 11924a71df50SFrank Blaschka qeth_print_status_message(card); 11934a71df50SFrank Blaschka 11944a71df50SFrank Blaschka /* softsetup */ 1195d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "softsetp"); 11964a71df50SFrank Blaschka 11974a71df50SFrank Blaschka rc = qeth_send_startlan(card); 11984a71df50SFrank Blaschka if (rc) { 1199d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "1err%d", rc); 12004a71df50SFrank Blaschka if (rc == 0xe080) { 120174eacdb9SFrank Blaschka dev_warn(&card->gdev->dev, 120274eacdb9SFrank Blaschka "The LAN is offline\n"); 12034a71df50SFrank Blaschka card->lan_online = 0; 12042b6203bbSUrsula Braun goto contin; 12054a71df50SFrank Blaschka } 1206aa909224SUrsula Braun rc = -ENODEV; 1207f2148565SUrsula Braun goto out_remove; 12084a71df50SFrank Blaschka } else 12094a71df50SFrank Blaschka card->lan_online = 1; 12104a71df50SFrank Blaschka 12112b6203bbSUrsula Braun contin: 12125113fec0SUrsula Braun if ((card->info.type == QETH_CARD_TYPE_OSD) || 12130f54761dSStefan Raspl (card->info.type == QETH_CARD_TYPE_OSX)) { 12148f43fb00SThomas Richter rc = qeth_l2_start_ipassists(card); 12158f43fb00SThomas Richter if (rc) 12160f54761dSStefan Raspl goto out_remove; 12170f54761dSStefan Raspl } 12185113fec0SUrsula Braun 12195113fec0SUrsula Braun if (card->info.type != QETH_CARD_TYPE_OSN && 12205113fec0SUrsula Braun card->info.type != QETH_CARD_TYPE_OSM) 122170919e23SUrsula Braun qeth_l2_process_vlans(card); 12224a71df50SFrank Blaschka 12234a71df50SFrank Blaschka netif_tx_disable(card->dev); 12244a71df50SFrank Blaschka 12254a71df50SFrank Blaschka rc = qeth_init_qdio_queues(card); 12264a71df50SFrank Blaschka if (rc) { 1227d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "6err%d", rc); 1228aa909224SUrsula Braun rc = -ENODEV; 12294a71df50SFrank Blaschka goto out_remove; 12304a71df50SFrank Blaschka } 12314a71df50SFrank Blaschka card->state = CARD_STATE_SOFTSETUP; 12322b6203bbSUrsula Braun if (card->lan_online) 12334a71df50SFrank Blaschka netif_carrier_on(card->dev); 12342b6203bbSUrsula Braun else 12352b6203bbSUrsula Braun netif_carrier_off(card->dev); 12364a71df50SFrank Blaschka 12374a71df50SFrank Blaschka qeth_set_allowed_threads(card, 0xffffffff, 0); 12384a71df50SFrank Blaschka if (recover_flag == CARD_STATE_RECOVER) { 12394a71df50SFrank Blaschka if (recovery_mode && 12404a71df50SFrank Blaschka card->info.type != QETH_CARD_TYPE_OSN) { 124139423440SUrsula Braun __qeth_l2_open(card->dev); 12424a71df50SFrank Blaschka } else { 12434a71df50SFrank Blaschka rtnl_lock(); 12444a71df50SFrank Blaschka dev_open(card->dev); 12454a71df50SFrank Blaschka rtnl_unlock(); 12464a71df50SFrank Blaschka } 12474a71df50SFrank Blaschka /* this also sets saved unicast addresses */ 1248fe5c8028SLakhvich Dmitriy qeth_l2_set_rx_mode(card->dev); 1249e830baa9SHans Wippel rtnl_lock(); 1250e830baa9SHans Wippel qeth_recover_features(card->dev); 1251e830baa9SHans Wippel rtnl_unlock(); 12524a71df50SFrank Blaschka } 12534a71df50SFrank Blaschka /* let user_space know that device is online */ 12544a71df50SFrank Blaschka kobject_uevent(&gdev->dev.kobj, KOBJ_CHANGE); 1255c4949f07SFrank Blaschka mutex_unlock(&card->conf_mutex); 12569dc48cccSUrsula Braun mutex_unlock(&card->discipline_mutex); 12574a71df50SFrank Blaschka return 0; 1258aa909224SUrsula Braun 12594a71df50SFrank Blaschka out_remove: 12604a71df50SFrank Blaschka qeth_l2_stop_card(card, 0); 12614a71df50SFrank Blaschka ccw_device_set_offline(CARD_DDEV(card)); 12624a71df50SFrank Blaschka ccw_device_set_offline(CARD_WDEV(card)); 12634a71df50SFrank Blaschka ccw_device_set_offline(CARD_RDEV(card)); 126422ae2790SUrsula Braun qdio_free(CARD_DDEV(card)); 12654a71df50SFrank Blaschka if (recover_flag == CARD_STATE_RECOVER) 12664a71df50SFrank Blaschka card->state = CARD_STATE_RECOVER; 12674a71df50SFrank Blaschka else 12684a71df50SFrank Blaschka card->state = CARD_STATE_DOWN; 1269c4949f07SFrank Blaschka mutex_unlock(&card->conf_mutex); 12709dc48cccSUrsula Braun mutex_unlock(&card->discipline_mutex); 1271aa909224SUrsula Braun return rc; 12724a71df50SFrank Blaschka } 12734a71df50SFrank Blaschka 12744a71df50SFrank Blaschka static int qeth_l2_set_online(struct ccwgroup_device *gdev) 12754a71df50SFrank Blaschka { 12764a71df50SFrank Blaschka return __qeth_l2_set_online(gdev, 0); 12774a71df50SFrank Blaschka } 12784a71df50SFrank Blaschka 12794a71df50SFrank Blaschka static int __qeth_l2_set_offline(struct ccwgroup_device *cgdev, 12804a71df50SFrank Blaschka int recovery_mode) 12814a71df50SFrank Blaschka { 12824a71df50SFrank Blaschka struct qeth_card *card = dev_get_drvdata(&cgdev->dev); 12834a71df50SFrank Blaschka int rc = 0, rc2 = 0, rc3 = 0; 12844a71df50SFrank Blaschka enum qeth_card_states recover_flag; 12854a71df50SFrank Blaschka 12869dc48cccSUrsula Braun mutex_lock(&card->discipline_mutex); 1287c4949f07SFrank Blaschka mutex_lock(&card->conf_mutex); 1288d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 3, "setoffl"); 1289d11ba0c4SPeter Tiedemann QETH_DBF_HEX(SETUP, 3, &card, sizeof(void *)); 12904a71df50SFrank Blaschka 12914a71df50SFrank Blaschka if (card->dev && netif_carrier_ok(card->dev)) 12924a71df50SFrank Blaschka netif_carrier_off(card->dev); 12934a71df50SFrank Blaschka recover_flag = card->state; 12941da74b1cSFrank Blaschka if ((!recovery_mode && card->info.hwtrap) || card->info.hwtrap == 2) { 12951da74b1cSFrank Blaschka qeth_hw_trap(card, QETH_DIAGS_TRAP_DISARM); 12961da74b1cSFrank Blaschka card->info.hwtrap = 1; 12971da74b1cSFrank Blaschka } 12980f5623c9SUrsula Braun qeth_l2_stop_card(card, recovery_mode); 12994a71df50SFrank Blaschka rc = ccw_device_set_offline(CARD_DDEV(card)); 13004a71df50SFrank Blaschka rc2 = ccw_device_set_offline(CARD_WDEV(card)); 13014a71df50SFrank Blaschka rc3 = ccw_device_set_offline(CARD_RDEV(card)); 13024a71df50SFrank Blaschka if (!rc) 13034a71df50SFrank Blaschka rc = (rc2) ? rc2 : rc3; 13044a71df50SFrank Blaschka if (rc) 1305d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "1err%d", rc); 130622ae2790SUrsula Braun qdio_free(CARD_DDEV(card)); 13074a71df50SFrank Blaschka if (recover_flag == CARD_STATE_UP) 13084a71df50SFrank Blaschka card->state = CARD_STATE_RECOVER; 13094a71df50SFrank Blaschka /* let user_space know that device is offline */ 13104a71df50SFrank Blaschka kobject_uevent(&cgdev->dev.kobj, KOBJ_CHANGE); 1311c4949f07SFrank Blaschka mutex_unlock(&card->conf_mutex); 13129dc48cccSUrsula Braun mutex_unlock(&card->discipline_mutex); 13134a71df50SFrank Blaschka return 0; 13144a71df50SFrank Blaschka } 13154a71df50SFrank Blaschka 13164a71df50SFrank Blaschka static int qeth_l2_set_offline(struct ccwgroup_device *cgdev) 13174a71df50SFrank Blaschka { 13184a71df50SFrank Blaschka return __qeth_l2_set_offline(cgdev, 0); 13194a71df50SFrank Blaschka } 13204a71df50SFrank Blaschka 13214a71df50SFrank Blaschka static int qeth_l2_recover(void *ptr) 13224a71df50SFrank Blaschka { 13234a71df50SFrank Blaschka struct qeth_card *card; 13244a71df50SFrank Blaschka int rc = 0; 13254a71df50SFrank Blaschka 13264a71df50SFrank Blaschka card = (struct qeth_card *) ptr; 1327847a50fdSCarsten Otte QETH_CARD_TEXT(card, 2, "recover1"); 13284a71df50SFrank Blaschka if (!qeth_do_run_thread(card, QETH_RECOVER_THREAD)) 13294a71df50SFrank Blaschka return 0; 1330847a50fdSCarsten Otte QETH_CARD_TEXT(card, 2, "recover2"); 133174eacdb9SFrank Blaschka dev_warn(&card->gdev->dev, 133274eacdb9SFrank Blaschka "A recovery process has been started for the device\n"); 133365d8013cSStefan Raspl qeth_set_recovery_task(card); 13344a71df50SFrank Blaschka __qeth_l2_set_offline(card->gdev, 1); 13354a71df50SFrank Blaschka rc = __qeth_l2_set_online(card->gdev, 1); 13364a71df50SFrank Blaschka if (!rc) 133774eacdb9SFrank Blaschka dev_info(&card->gdev->dev, 133874eacdb9SFrank Blaschka "Device successfully recovered!\n"); 133928a7e4c9SUrsula Braun else { 13400f54761dSStefan Raspl qeth_close_dev(card); 134174eacdb9SFrank Blaschka dev_warn(&card->gdev->dev, "The qeth device driver " 134274eacdb9SFrank Blaschka "failed to recover an error on the device\n"); 134328a7e4c9SUrsula Braun } 134465d8013cSStefan Raspl qeth_clear_recovery_task(card); 1345a1c3ed4cSFrank Blaschka qeth_clear_thread_start_bit(card, QETH_RECOVER_THREAD); 1346a1c3ed4cSFrank Blaschka qeth_clear_thread_running_bit(card, QETH_RECOVER_THREAD); 13474a71df50SFrank Blaschka return 0; 13484a71df50SFrank Blaschka } 13494a71df50SFrank Blaschka 13504a71df50SFrank Blaschka static int __init qeth_l2_init(void) 13514a71df50SFrank Blaschka { 135274eacdb9SFrank Blaschka pr_info("register layer 2 discipline\n"); 13534a71df50SFrank Blaschka return 0; 13544a71df50SFrank Blaschka } 13554a71df50SFrank Blaschka 13564a71df50SFrank Blaschka static void __exit qeth_l2_exit(void) 13574a71df50SFrank Blaschka { 135874eacdb9SFrank Blaschka pr_info("unregister layer 2 discipline\n"); 13594a71df50SFrank Blaschka } 13604a71df50SFrank Blaschka 13614a71df50SFrank Blaschka static void qeth_l2_shutdown(struct ccwgroup_device *gdev) 13624a71df50SFrank Blaschka { 13634a71df50SFrank Blaschka struct qeth_card *card = dev_get_drvdata(&gdev->dev); 1364f78ac2bbSUrsula Braun qeth_set_allowed_threads(card, 0, 1); 13651da74b1cSFrank Blaschka if ((gdev->state == CCWGROUP_ONLINE) && card->info.hwtrap) 13661da74b1cSFrank Blaschka qeth_hw_trap(card, QETH_DIAGS_TRAP_DISARM); 13674a71df50SFrank Blaschka qeth_qdio_clear_card(card, 0); 13684a71df50SFrank Blaschka qeth_clear_qdio_buffers(card); 136922ae2790SUrsula Braun qdio_free(CARD_DDEV(card)); 13704a71df50SFrank Blaschka } 13714a71df50SFrank Blaschka 1372bbcfcdc8SFrank Blaschka static int qeth_l2_pm_suspend(struct ccwgroup_device *gdev) 1373bbcfcdc8SFrank Blaschka { 1374bbcfcdc8SFrank Blaschka struct qeth_card *card = dev_get_drvdata(&gdev->dev); 1375bbcfcdc8SFrank Blaschka 1376bbcfcdc8SFrank Blaschka if (card->dev) 1377bbcfcdc8SFrank Blaschka netif_device_detach(card->dev); 1378bbcfcdc8SFrank Blaschka qeth_set_allowed_threads(card, 0, 1); 1379bbcfcdc8SFrank Blaschka wait_event(card->wait_q, qeth_threads_running(card, 0xffffffff) == 0); 1380bbcfcdc8SFrank Blaschka if (gdev->state == CCWGROUP_OFFLINE) 1381bbcfcdc8SFrank Blaschka return 0; 1382bbcfcdc8SFrank Blaschka if (card->state == CARD_STATE_UP) { 13831da74b1cSFrank Blaschka if (card->info.hwtrap) 13841da74b1cSFrank Blaschka qeth_hw_trap(card, QETH_DIAGS_TRAP_DISARM); 1385bbcfcdc8SFrank Blaschka __qeth_l2_set_offline(card->gdev, 1); 1386bbcfcdc8SFrank Blaschka } else 1387bbcfcdc8SFrank Blaschka __qeth_l2_set_offline(card->gdev, 0); 1388bbcfcdc8SFrank Blaschka return 0; 1389bbcfcdc8SFrank Blaschka } 1390bbcfcdc8SFrank Blaschka 1391bbcfcdc8SFrank Blaschka static int qeth_l2_pm_resume(struct ccwgroup_device *gdev) 1392bbcfcdc8SFrank Blaschka { 1393bbcfcdc8SFrank Blaschka struct qeth_card *card = dev_get_drvdata(&gdev->dev); 1394bbcfcdc8SFrank Blaschka int rc = 0; 1395bbcfcdc8SFrank Blaschka 1396bbcfcdc8SFrank Blaschka if (gdev->state == CCWGROUP_OFFLINE) 1397bbcfcdc8SFrank Blaschka goto out; 1398bbcfcdc8SFrank Blaschka 1399bbcfcdc8SFrank Blaschka if (card->state == CARD_STATE_RECOVER) { 1400bbcfcdc8SFrank Blaschka rc = __qeth_l2_set_online(card->gdev, 1); 1401bbcfcdc8SFrank Blaschka if (rc) { 1402bbcfcdc8SFrank Blaschka rtnl_lock(); 1403bbcfcdc8SFrank Blaschka dev_close(card->dev); 1404bbcfcdc8SFrank Blaschka rtnl_unlock(); 1405bbcfcdc8SFrank Blaschka } 1406bbcfcdc8SFrank Blaschka } else 1407bbcfcdc8SFrank Blaschka rc = __qeth_l2_set_online(card->gdev, 0); 1408bbcfcdc8SFrank Blaschka out: 1409bbcfcdc8SFrank Blaschka qeth_set_allowed_threads(card, 0xffffffff, 0); 1410bbcfcdc8SFrank Blaschka if (card->dev) 1411bbcfcdc8SFrank Blaschka netif_device_attach(card->dev); 1412bbcfcdc8SFrank Blaschka if (rc) 1413bbcfcdc8SFrank Blaschka dev_warn(&card->gdev->dev, "The qeth device driver " 1414bbcfcdc8SFrank Blaschka "failed to recover an error on the device\n"); 1415bbcfcdc8SFrank Blaschka return rc; 1416bbcfcdc8SFrank Blaschka } 1417bbcfcdc8SFrank Blaschka 1418c044dc21SEugene Crosser /* Returns zero if the command is successfully "consumed" */ 1419c044dc21SEugene Crosser static int qeth_l2_control_event(struct qeth_card *card, 1420c044dc21SEugene Crosser struct qeth_ipa_cmd *cmd) 1421c044dc21SEugene Crosser { 1422c044dc21SEugene Crosser switch (cmd->hdr.command) { 14239c23f4daSEugene Crosser case IPA_CMD_SETBRIDGEPORT_OSA: 14249c23f4daSEugene Crosser case IPA_CMD_SETBRIDGEPORT_IQD: 1425c044dc21SEugene Crosser if (cmd->data.sbp.hdr.command_code == 1426c044dc21SEugene Crosser IPA_SBP_BRIDGE_PORT_STATE_CHANGE) { 1427c044dc21SEugene Crosser qeth_bridge_state_change(card, cmd); 1428c044dc21SEugene Crosser return 0; 1429c044dc21SEugene Crosser } else 1430c044dc21SEugene Crosser return 1; 1431c044dc21SEugene Crosser case IPA_CMD_ADDRESS_CHANGE_NOTIF: 1432c044dc21SEugene Crosser qeth_bridge_host_event(card, cmd); 1433c044dc21SEugene Crosser return 0; 1434c044dc21SEugene Crosser default: 1435c044dc21SEugene Crosser return 1; 1436c044dc21SEugene Crosser } 1437c044dc21SEugene Crosser } 1438c044dc21SEugene Crosser 1439c041f2d4SSebastian Ott struct qeth_discipline qeth_l2_discipline = { 1440c041f2d4SSebastian Ott .start_poll = qeth_qdio_start_poll, 1441c041f2d4SSebastian Ott .input_handler = (qdio_handler_t *) qeth_qdio_input_handler, 1442c041f2d4SSebastian Ott .output_handler = (qdio_handler_t *) qeth_qdio_output_handler, 1443c041f2d4SSebastian Ott .recover = qeth_l2_recover, 1444c041f2d4SSebastian Ott .setup = qeth_l2_probe_device, 14454a71df50SFrank Blaschka .remove = qeth_l2_remove_device, 14464a71df50SFrank Blaschka .set_online = qeth_l2_set_online, 14474a71df50SFrank Blaschka .set_offline = qeth_l2_set_offline, 14484a71df50SFrank Blaschka .shutdown = qeth_l2_shutdown, 1449bbcfcdc8SFrank Blaschka .freeze = qeth_l2_pm_suspend, 1450bbcfcdc8SFrank Blaschka .thaw = qeth_l2_pm_resume, 1451bbcfcdc8SFrank Blaschka .restore = qeth_l2_pm_resume, 1452c044dc21SEugene Crosser .control_event_handler = qeth_l2_control_event, 14534a71df50SFrank Blaschka }; 1454c041f2d4SSebastian Ott EXPORT_SYMBOL_GPL(qeth_l2_discipline); 14554a71df50SFrank Blaschka 14564a71df50SFrank Blaschka static int qeth_osn_send_control_data(struct qeth_card *card, int len, 14574a71df50SFrank Blaschka struct qeth_cmd_buffer *iob) 14584a71df50SFrank Blaschka { 14594a71df50SFrank Blaschka unsigned long flags; 14604a71df50SFrank Blaschka int rc = 0; 14614a71df50SFrank Blaschka 1462847a50fdSCarsten Otte QETH_CARD_TEXT(card, 5, "osndctrd"); 14634a71df50SFrank Blaschka 14644a71df50SFrank Blaschka wait_event(card->wait_q, 14654a71df50SFrank Blaschka atomic_cmpxchg(&card->write.irq_pending, 0, 1) == 0); 14664a71df50SFrank Blaschka qeth_prepare_control_data(card, len, iob); 1467847a50fdSCarsten Otte QETH_CARD_TEXT(card, 6, "osnoirqp"); 14684a71df50SFrank Blaschka spin_lock_irqsave(get_ccwdev_lock(card->write.ccwdev), flags); 14694a71df50SFrank Blaschka rc = ccw_device_start(card->write.ccwdev, &card->write.ccw, 14704a71df50SFrank Blaschka (addr_t) iob, 0, 0); 14714a71df50SFrank Blaschka spin_unlock_irqrestore(get_ccwdev_lock(card->write.ccwdev), flags); 14724a71df50SFrank Blaschka if (rc) { 147314cc21b6SFrank Blaschka QETH_DBF_MESSAGE(2, "qeth_osn_send_control_data: " 14744a71df50SFrank Blaschka "ccw_device_start rc = %i\n", rc); 1475847a50fdSCarsten Otte QETH_CARD_TEXT_(card, 2, " err%d", rc); 14764a71df50SFrank Blaschka qeth_release_buffer(iob->channel, iob); 14774a71df50SFrank Blaschka atomic_set(&card->write.irq_pending, 0); 14784a71df50SFrank Blaschka wake_up(&card->wait_q); 14794a71df50SFrank Blaschka } 14804a71df50SFrank Blaschka return rc; 14814a71df50SFrank Blaschka } 14824a71df50SFrank Blaschka 14834a71df50SFrank Blaschka static int qeth_osn_send_ipa_cmd(struct qeth_card *card, 14844a71df50SFrank Blaschka struct qeth_cmd_buffer *iob, int data_len) 14854a71df50SFrank Blaschka { 14864a71df50SFrank Blaschka u16 s1, s2; 14874a71df50SFrank Blaschka 1488847a50fdSCarsten Otte QETH_CARD_TEXT(card, 4, "osndipa"); 14894a71df50SFrank Blaschka 14904a71df50SFrank Blaschka qeth_prepare_ipa_cmd(card, iob, QETH_PROT_OSN2); 14914a71df50SFrank Blaschka s1 = (u16)(IPA_PDU_HEADER_SIZE + data_len); 14924a71df50SFrank Blaschka s2 = (u16)data_len; 14934a71df50SFrank Blaschka memcpy(QETH_IPA_PDU_LEN_TOTAL(iob->data), &s1, 2); 14944a71df50SFrank Blaschka memcpy(QETH_IPA_PDU_LEN_PDU1(iob->data), &s2, 2); 14954a71df50SFrank Blaschka memcpy(QETH_IPA_PDU_LEN_PDU2(iob->data), &s2, 2); 14964a71df50SFrank Blaschka memcpy(QETH_IPA_PDU_LEN_PDU3(iob->data), &s2, 2); 14974a71df50SFrank Blaschka return qeth_osn_send_control_data(card, s1, iob); 14984a71df50SFrank Blaschka } 14994a71df50SFrank Blaschka 15004a71df50SFrank Blaschka int qeth_osn_assist(struct net_device *dev, void *data, int data_len) 15014a71df50SFrank Blaschka { 15024a71df50SFrank Blaschka struct qeth_cmd_buffer *iob; 15034a71df50SFrank Blaschka struct qeth_card *card; 15044a71df50SFrank Blaschka int rc; 15054a71df50SFrank Blaschka 15064a71df50SFrank Blaschka if (!dev) 15074a71df50SFrank Blaschka return -ENODEV; 1508509e2562SHeiko Carstens card = dev->ml_priv; 15094a71df50SFrank Blaschka if (!card) 15104a71df50SFrank Blaschka return -ENODEV; 1511847a50fdSCarsten Otte QETH_CARD_TEXT(card, 2, "osnsdmc"); 1512c3521254SEugene Crosser if (!qeth_card_hw_is_reachable(card)) 15134a71df50SFrank Blaschka return -ENODEV; 15144a71df50SFrank Blaschka iob = qeth_wait_for_buffer(&card->write); 15154a71df50SFrank Blaschka memcpy(iob->data+IPA_PDU_HEADER_SIZE, data, data_len); 15164a71df50SFrank Blaschka rc = qeth_osn_send_ipa_cmd(card, iob, data_len); 15174a71df50SFrank Blaschka return rc; 15184a71df50SFrank Blaschka } 15194a71df50SFrank Blaschka EXPORT_SYMBOL(qeth_osn_assist); 15204a71df50SFrank Blaschka 15214a71df50SFrank Blaschka int qeth_osn_register(unsigned char *read_dev_no, struct net_device **dev, 15224a71df50SFrank Blaschka int (*assist_cb)(struct net_device *, void *), 15234a71df50SFrank Blaschka int (*data_cb)(struct sk_buff *)) 15244a71df50SFrank Blaschka { 15254a71df50SFrank Blaschka struct qeth_card *card; 15264a71df50SFrank Blaschka 15274a71df50SFrank Blaschka *dev = qeth_l2_netdev_by_devno(read_dev_no); 15284a71df50SFrank Blaschka if (*dev == NULL) 15294a71df50SFrank Blaschka return -ENODEV; 1530509e2562SHeiko Carstens card = (*dev)->ml_priv; 15314a71df50SFrank Blaschka if (!card) 15324a71df50SFrank Blaschka return -ENODEV; 1533847a50fdSCarsten Otte QETH_CARD_TEXT(card, 2, "osnreg"); 15344a71df50SFrank Blaschka if ((assist_cb == NULL) || (data_cb == NULL)) 15354a71df50SFrank Blaschka return -EINVAL; 15364a71df50SFrank Blaschka card->osn_info.assist_cb = assist_cb; 15374a71df50SFrank Blaschka card->osn_info.data_cb = data_cb; 15384a71df50SFrank Blaschka return 0; 15394a71df50SFrank Blaschka } 15404a71df50SFrank Blaschka EXPORT_SYMBOL(qeth_osn_register); 15414a71df50SFrank Blaschka 15424a71df50SFrank Blaschka void qeth_osn_deregister(struct net_device *dev) 15434a71df50SFrank Blaschka { 15444a71df50SFrank Blaschka struct qeth_card *card; 15454a71df50SFrank Blaschka 15464a71df50SFrank Blaschka if (!dev) 15474a71df50SFrank Blaschka return; 1548509e2562SHeiko Carstens card = dev->ml_priv; 15494a71df50SFrank Blaschka if (!card) 15504a71df50SFrank Blaschka return; 1551847a50fdSCarsten Otte QETH_CARD_TEXT(card, 2, "osndereg"); 15524a71df50SFrank Blaschka card->osn_info.assist_cb = NULL; 15534a71df50SFrank Blaschka card->osn_info.data_cb = NULL; 15544a71df50SFrank Blaschka return; 15554a71df50SFrank Blaschka } 15564a71df50SFrank Blaschka EXPORT_SYMBOL(qeth_osn_deregister); 15574a71df50SFrank Blaschka 1558b4d72c08SEugene Crosser /* SETBRIDGEPORT support, async notifications */ 1559b4d72c08SEugene Crosser 15609f48b9dbSEugene Crosser enum qeth_an_event_type {anev_reg_unreg, anev_abort, anev_reset}; 15619f48b9dbSEugene Crosser 15629f48b9dbSEugene Crosser /** 15639f48b9dbSEugene Crosser * qeth_bridge_emit_host_event() - bridgeport address change notification 15649f48b9dbSEugene Crosser * @card: qeth_card structure pointer, for udev events. 15659f48b9dbSEugene Crosser * @evtype: "normal" register/unregister, or abort, or reset. For abort 15669f48b9dbSEugene Crosser * and reset token and addr_lnid are unused and may be NULL. 15679f48b9dbSEugene Crosser * @code: event bitmask: high order bit 0x80 value 1 means removal of an 15689f48b9dbSEugene Crosser * object, 0 - addition of an object. 15699f48b9dbSEugene Crosser * 0x01 - VLAN, 0x02 - MAC, 0x03 - VLAN and MAC. 15709f48b9dbSEugene Crosser * @token: "network token" structure identifying physical address of the port. 15719f48b9dbSEugene Crosser * @addr_lnid: pointer to structure with MAC address and VLAN ID. 15729f48b9dbSEugene Crosser * 15739f48b9dbSEugene Crosser * This function is called when registrations and deregistrations are 15749f48b9dbSEugene Crosser * reported by the hardware, and also when notifications are enabled - 15759f48b9dbSEugene Crosser * for all currently registered addresses. 15769f48b9dbSEugene Crosser */ 15779f48b9dbSEugene Crosser static void qeth_bridge_emit_host_event(struct qeth_card *card, 15789f48b9dbSEugene Crosser enum qeth_an_event_type evtype, 15799f48b9dbSEugene Crosser u8 code, struct net_if_token *token, struct mac_addr_lnid *addr_lnid) 15809f48b9dbSEugene Crosser { 15819f48b9dbSEugene Crosser char str[7][32]; 15829f48b9dbSEugene Crosser char *env[8]; 15839f48b9dbSEugene Crosser int i = 0; 15849f48b9dbSEugene Crosser 15859f48b9dbSEugene Crosser switch (evtype) { 15869f48b9dbSEugene Crosser case anev_reg_unreg: 15879f48b9dbSEugene Crosser snprintf(str[i], sizeof(str[i]), "BRIDGEDHOST=%s", 15889f48b9dbSEugene Crosser (code & IPA_ADDR_CHANGE_CODE_REMOVAL) 15899f48b9dbSEugene Crosser ? "deregister" : "register"); 15909f48b9dbSEugene Crosser env[i] = str[i]; i++; 15919f48b9dbSEugene Crosser if (code & IPA_ADDR_CHANGE_CODE_VLANID) { 15929f48b9dbSEugene Crosser snprintf(str[i], sizeof(str[i]), "VLAN=%d", 15939f48b9dbSEugene Crosser addr_lnid->lnid); 15949f48b9dbSEugene Crosser env[i] = str[i]; i++; 15959f48b9dbSEugene Crosser } 15969f48b9dbSEugene Crosser if (code & IPA_ADDR_CHANGE_CODE_MACADDR) { 15979846e70bSEugene Crosser snprintf(str[i], sizeof(str[i]), "MAC=%pM", 15989846e70bSEugene Crosser addr_lnid->mac); 15999f48b9dbSEugene Crosser env[i] = str[i]; i++; 16009f48b9dbSEugene Crosser } 16019f48b9dbSEugene Crosser snprintf(str[i], sizeof(str[i]), "NTOK_BUSID=%x.%x.%04x", 16029f48b9dbSEugene Crosser token->cssid, token->ssid, token->devnum); 16039f48b9dbSEugene Crosser env[i] = str[i]; i++; 16049f48b9dbSEugene Crosser snprintf(str[i], sizeof(str[i]), "NTOK_IID=%02x", token->iid); 16059f48b9dbSEugene Crosser env[i] = str[i]; i++; 16069f48b9dbSEugene Crosser snprintf(str[i], sizeof(str[i]), "NTOK_CHPID=%02x", 16079f48b9dbSEugene Crosser token->chpid); 16089f48b9dbSEugene Crosser env[i] = str[i]; i++; 16099f48b9dbSEugene Crosser snprintf(str[i], sizeof(str[i]), "NTOK_CHID=%04x", token->chid); 16109f48b9dbSEugene Crosser env[i] = str[i]; i++; 16119f48b9dbSEugene Crosser break; 16129f48b9dbSEugene Crosser case anev_abort: 16139f48b9dbSEugene Crosser snprintf(str[i], sizeof(str[i]), "BRIDGEDHOST=abort"); 16149f48b9dbSEugene Crosser env[i] = str[i]; i++; 16159f48b9dbSEugene Crosser break; 16169f48b9dbSEugene Crosser case anev_reset: 16179f48b9dbSEugene Crosser snprintf(str[i], sizeof(str[i]), "BRIDGEDHOST=reset"); 16189f48b9dbSEugene Crosser env[i] = str[i]; i++; 16199f48b9dbSEugene Crosser break; 16209f48b9dbSEugene Crosser } 16219f48b9dbSEugene Crosser env[i] = NULL; 16229f48b9dbSEugene Crosser kobject_uevent_env(&card->gdev->dev.kobj, KOBJ_CHANGE, env); 16239f48b9dbSEugene Crosser } 16249f48b9dbSEugene Crosser 1625b4d72c08SEugene Crosser struct qeth_bridge_state_data { 1626b4d72c08SEugene Crosser struct work_struct worker; 1627b4d72c08SEugene Crosser struct qeth_card *card; 1628b4d72c08SEugene Crosser struct qeth_sbp_state_change qports; 1629b4d72c08SEugene Crosser }; 1630b4d72c08SEugene Crosser 1631b4d72c08SEugene Crosser static void qeth_bridge_state_change_worker(struct work_struct *work) 1632b4d72c08SEugene Crosser { 1633b4d72c08SEugene Crosser struct qeth_bridge_state_data *data = 1634b4d72c08SEugene Crosser container_of(work, struct qeth_bridge_state_data, worker); 1635b4d72c08SEugene Crosser /* We are only interested in the first entry - local port */ 1636b4d72c08SEugene Crosser struct qeth_sbp_port_entry *entry = &data->qports.entry[0]; 1637b4d72c08SEugene Crosser char env_locrem[32]; 1638b4d72c08SEugene Crosser char env_role[32]; 1639b4d72c08SEugene Crosser char env_state[32]; 1640b4d72c08SEugene Crosser char *env[] = { 1641b4d72c08SEugene Crosser env_locrem, 1642b4d72c08SEugene Crosser env_role, 1643b4d72c08SEugene Crosser env_state, 1644b4d72c08SEugene Crosser NULL 1645b4d72c08SEugene Crosser }; 1646b4d72c08SEugene Crosser 1647b4d72c08SEugene Crosser /* Role should not change by itself, but if it did, */ 1648b4d72c08SEugene Crosser /* information from the hardware is authoritative. */ 1649b4d72c08SEugene Crosser mutex_lock(&data->card->conf_mutex); 1650b4d72c08SEugene Crosser data->card->options.sbp.role = entry->role; 1651b4d72c08SEugene Crosser mutex_unlock(&data->card->conf_mutex); 1652b4d72c08SEugene Crosser 1653b4d72c08SEugene Crosser snprintf(env_locrem, sizeof(env_locrem), "BRIDGEPORT=statechange"); 1654b4d72c08SEugene Crosser snprintf(env_role, sizeof(env_role), "ROLE=%s", 1655b4d72c08SEugene Crosser (entry->role == QETH_SBP_ROLE_NONE) ? "none" : 1656b4d72c08SEugene Crosser (entry->role == QETH_SBP_ROLE_PRIMARY) ? "primary" : 1657b4d72c08SEugene Crosser (entry->role == QETH_SBP_ROLE_SECONDARY) ? "secondary" : 1658b4d72c08SEugene Crosser "<INVALID>"); 1659b4d72c08SEugene Crosser snprintf(env_state, sizeof(env_state), "STATE=%s", 1660b4d72c08SEugene Crosser (entry->state == QETH_SBP_STATE_INACTIVE) ? "inactive" : 1661b4d72c08SEugene Crosser (entry->state == QETH_SBP_STATE_STANDBY) ? "standby" : 1662b4d72c08SEugene Crosser (entry->state == QETH_SBP_STATE_ACTIVE) ? "active" : 1663b4d72c08SEugene Crosser "<INVALID>"); 1664b4d72c08SEugene Crosser kobject_uevent_env(&data->card->gdev->dev.kobj, 1665b4d72c08SEugene Crosser KOBJ_CHANGE, env); 1666b4d72c08SEugene Crosser kfree(data); 1667b4d72c08SEugene Crosser } 1668b4d72c08SEugene Crosser 1669c044dc21SEugene Crosser static void qeth_bridge_state_change(struct qeth_card *card, 1670c044dc21SEugene Crosser struct qeth_ipa_cmd *cmd) 1671b4d72c08SEugene Crosser { 1672b4d72c08SEugene Crosser struct qeth_sbp_state_change *qports = 1673b4d72c08SEugene Crosser &cmd->data.sbp.data.state_change; 1674b4d72c08SEugene Crosser struct qeth_bridge_state_data *data; 1675b4d72c08SEugene Crosser int extrasize; 1676b4d72c08SEugene Crosser 1677b4d72c08SEugene Crosser QETH_CARD_TEXT(card, 2, "brstchng"); 1678b4d72c08SEugene Crosser if (qports->entry_length != sizeof(struct qeth_sbp_port_entry)) { 16798a593148SThomas Richter QETH_CARD_TEXT_(card, 2, "BPsz%04x", qports->entry_length); 1680b4d72c08SEugene Crosser return; 1681b4d72c08SEugene Crosser } 1682b4d72c08SEugene Crosser extrasize = sizeof(struct qeth_sbp_port_entry) * qports->num_entries; 1683b4d72c08SEugene Crosser data = kzalloc(sizeof(struct qeth_bridge_state_data) + extrasize, 1684b4d72c08SEugene Crosser GFP_ATOMIC); 1685b4d72c08SEugene Crosser if (!data) { 1686b4d72c08SEugene Crosser QETH_CARD_TEXT(card, 2, "BPSalloc"); 1687b4d72c08SEugene Crosser return; 1688b4d72c08SEugene Crosser } 1689b4d72c08SEugene Crosser INIT_WORK(&data->worker, qeth_bridge_state_change_worker); 1690b4d72c08SEugene Crosser data->card = card; 1691b4d72c08SEugene Crosser memcpy(&data->qports, qports, 1692b4d72c08SEugene Crosser sizeof(struct qeth_sbp_state_change) + extrasize); 1693b4d72c08SEugene Crosser queue_work(qeth_wq, &data->worker); 1694b4d72c08SEugene Crosser } 1695b4d72c08SEugene Crosser 16969f48b9dbSEugene Crosser struct qeth_bridge_host_data { 16979f48b9dbSEugene Crosser struct work_struct worker; 16989f48b9dbSEugene Crosser struct qeth_card *card; 16999f48b9dbSEugene Crosser struct qeth_ipacmd_addr_change hostevs; 17009f48b9dbSEugene Crosser }; 17019f48b9dbSEugene Crosser 17029f48b9dbSEugene Crosser static void qeth_bridge_host_event_worker(struct work_struct *work) 17039f48b9dbSEugene Crosser { 17049f48b9dbSEugene Crosser struct qeth_bridge_host_data *data = 17059f48b9dbSEugene Crosser container_of(work, struct qeth_bridge_host_data, worker); 17069f48b9dbSEugene Crosser int i; 17079f48b9dbSEugene Crosser 17089f48b9dbSEugene Crosser if (data->hostevs.lost_event_mask) { 17099f48b9dbSEugene Crosser dev_info(&data->card->gdev->dev, 17109c23f4daSEugene Crosser "Address notification from the Bridge Port stopped %s (%s)\n", 17119f48b9dbSEugene Crosser data->card->dev->name, 17129f48b9dbSEugene Crosser (data->hostevs.lost_event_mask == 0x01) 17139f48b9dbSEugene Crosser ? "Overflow" 17149f48b9dbSEugene Crosser : (data->hostevs.lost_event_mask == 0x02) 17159f48b9dbSEugene Crosser ? "Bridge port state change" 17169f48b9dbSEugene Crosser : "Unknown reason"); 17179f48b9dbSEugene Crosser mutex_lock(&data->card->conf_mutex); 17189f48b9dbSEugene Crosser data->card->options.sbp.hostnotification = 0; 17199f48b9dbSEugene Crosser mutex_unlock(&data->card->conf_mutex); 17209f48b9dbSEugene Crosser qeth_bridge_emit_host_event(data->card, anev_abort, 17219f48b9dbSEugene Crosser 0, NULL, NULL); 17229f48b9dbSEugene Crosser } else 17239f48b9dbSEugene Crosser for (i = 0; i < data->hostevs.num_entries; i++) { 17249f48b9dbSEugene Crosser struct qeth_ipacmd_addr_change_entry *entry = 17259f48b9dbSEugene Crosser &data->hostevs.entry[i]; 17269f48b9dbSEugene Crosser qeth_bridge_emit_host_event(data->card, 17279f48b9dbSEugene Crosser anev_reg_unreg, 17289f48b9dbSEugene Crosser entry->change_code, 17299f48b9dbSEugene Crosser &entry->token, &entry->addr_lnid); 17309f48b9dbSEugene Crosser } 17319f48b9dbSEugene Crosser kfree(data); 17329f48b9dbSEugene Crosser } 17339f48b9dbSEugene Crosser 1734c044dc21SEugene Crosser static void qeth_bridge_host_event(struct qeth_card *card, 1735c044dc21SEugene Crosser struct qeth_ipa_cmd *cmd) 17369f48b9dbSEugene Crosser { 17379f48b9dbSEugene Crosser struct qeth_ipacmd_addr_change *hostevs = 17389f48b9dbSEugene Crosser &cmd->data.addrchange; 17399f48b9dbSEugene Crosser struct qeth_bridge_host_data *data; 17409f48b9dbSEugene Crosser int extrasize; 17419f48b9dbSEugene Crosser 17429f48b9dbSEugene Crosser QETH_CARD_TEXT(card, 2, "brhostev"); 17439f48b9dbSEugene Crosser if (cmd->hdr.return_code != 0x0000) { 17449f48b9dbSEugene Crosser if (cmd->hdr.return_code == 0x0010) { 17459f48b9dbSEugene Crosser if (hostevs->lost_event_mask == 0x00) 17469f48b9dbSEugene Crosser hostevs->lost_event_mask = 0xff; 17479f48b9dbSEugene Crosser } else { 17489f48b9dbSEugene Crosser QETH_CARD_TEXT_(card, 2, "BPHe%04x", 17499f48b9dbSEugene Crosser cmd->hdr.return_code); 17509f48b9dbSEugene Crosser return; 17519f48b9dbSEugene Crosser } 17529f48b9dbSEugene Crosser } 17539f48b9dbSEugene Crosser extrasize = sizeof(struct qeth_ipacmd_addr_change_entry) * 17549f48b9dbSEugene Crosser hostevs->num_entries; 17559f48b9dbSEugene Crosser data = kzalloc(sizeof(struct qeth_bridge_host_data) + extrasize, 17569f48b9dbSEugene Crosser GFP_ATOMIC); 17579f48b9dbSEugene Crosser if (!data) { 17589f48b9dbSEugene Crosser QETH_CARD_TEXT(card, 2, "BPHalloc"); 17599f48b9dbSEugene Crosser return; 17609f48b9dbSEugene Crosser } 17619f48b9dbSEugene Crosser INIT_WORK(&data->worker, qeth_bridge_host_event_worker); 17629f48b9dbSEugene Crosser data->card = card; 17639f48b9dbSEugene Crosser memcpy(&data->hostevs, hostevs, 17649f48b9dbSEugene Crosser sizeof(struct qeth_ipacmd_addr_change) + extrasize); 17659f48b9dbSEugene Crosser queue_work(qeth_wq, &data->worker); 17669f48b9dbSEugene Crosser } 17679f48b9dbSEugene Crosser 1768b4d72c08SEugene Crosser /* SETBRIDGEPORT support; sending commands */ 1769b4d72c08SEugene Crosser 1770b4d72c08SEugene Crosser struct _qeth_sbp_cbctl { 1771b4d72c08SEugene Crosser u16 ipa_rc; 1772b4d72c08SEugene Crosser u16 cmd_rc; 1773b4d72c08SEugene Crosser union { 1774b4d72c08SEugene Crosser u32 supported; 1775b4d72c08SEugene Crosser struct { 1776b4d72c08SEugene Crosser enum qeth_sbp_roles *role; 1777b4d72c08SEugene Crosser enum qeth_sbp_states *state; 1778b4d72c08SEugene Crosser } qports; 1779b4d72c08SEugene Crosser } data; 1780b4d72c08SEugene Crosser }; 1781b4d72c08SEugene Crosser 1782b4d72c08SEugene Crosser /** 1783b4d72c08SEugene Crosser * qeth_bridgeport_makerc() - derive "traditional" error from hardware codes. 1784b4d72c08SEugene Crosser * @card: qeth_card structure pointer, for debug messages. 1785b4d72c08SEugene Crosser * @cbctl: state structure with hardware return codes. 1786b4d72c08SEugene Crosser * @setcmd: IPA command code 1787b4d72c08SEugene Crosser * 1788b4d72c08SEugene Crosser * Returns negative errno-compatible error indication or 0 on success. 1789b4d72c08SEugene Crosser */ 1790b4d72c08SEugene Crosser static int qeth_bridgeport_makerc(struct qeth_card *card, 1791b4d72c08SEugene Crosser struct _qeth_sbp_cbctl *cbctl, enum qeth_ipa_sbp_cmd setcmd) 1792b4d72c08SEugene Crosser { 1793b4d72c08SEugene Crosser int rc; 17949c23f4daSEugene Crosser int is_iqd = (card->info.type == QETH_CARD_TYPE_IQD); 1795b4d72c08SEugene Crosser 17969c23f4daSEugene Crosser if ((is_iqd && (cbctl->ipa_rc == IPA_RC_SUCCESS)) || 17979c23f4daSEugene Crosser (!is_iqd && (cbctl->ipa_rc == cbctl->cmd_rc))) 1798b4d72c08SEugene Crosser switch (cbctl->cmd_rc) { 1799b4d72c08SEugene Crosser case 0x0000: 1800b4d72c08SEugene Crosser rc = 0; 1801b4d72c08SEugene Crosser break; 18029c23f4daSEugene Crosser case 0x2B04: 1803b4d72c08SEugene Crosser case 0x0004: 1804ffb95251SEugene Crosser rc = -EOPNOTSUPP; 1805b4d72c08SEugene Crosser break; 18069c23f4daSEugene Crosser case 0x2B0C: 1807b4d72c08SEugene Crosser case 0x000C: /* Not configured as bridge Port */ 1808b4d72c08SEugene Crosser rc = -ENODEV; /* maybe not the best code here? */ 1809b4d72c08SEugene Crosser dev_err(&card->gdev->dev, 18109c23f4daSEugene Crosser "The device is not configured as a Bridge Port\n"); 1811b4d72c08SEugene Crosser break; 18121b05cf62SEugene Crosser case 0x2B10: 18131b05cf62SEugene Crosser case 0x0010: /* OS mismatch */ 18141b05cf62SEugene Crosser rc = -EPERM; 18151b05cf62SEugene Crosser dev_err(&card->gdev->dev, 18161b05cf62SEugene Crosser "A Bridge Port is already configured by a different operating system\n"); 18171b05cf62SEugene Crosser break; 18189c23f4daSEugene Crosser case 0x2B14: 1819b4d72c08SEugene Crosser case 0x0014: /* Another device is Primary */ 1820b4d72c08SEugene Crosser switch (setcmd) { 1821b4d72c08SEugene Crosser case IPA_SBP_SET_PRIMARY_BRIDGE_PORT: 1822b4d72c08SEugene Crosser rc = -EEXIST; 1823b4d72c08SEugene Crosser dev_err(&card->gdev->dev, 18249c23f4daSEugene Crosser "The LAN already has a primary Bridge Port\n"); 1825b4d72c08SEugene Crosser break; 1826b4d72c08SEugene Crosser case IPA_SBP_SET_SECONDARY_BRIDGE_PORT: 1827b4d72c08SEugene Crosser rc = -EBUSY; 1828b4d72c08SEugene Crosser dev_err(&card->gdev->dev, 18299c23f4daSEugene Crosser "The device is already a primary Bridge Port\n"); 1830b4d72c08SEugene Crosser break; 1831b4d72c08SEugene Crosser default: 1832b4d72c08SEugene Crosser rc = -EIO; 1833b4d72c08SEugene Crosser } 1834b4d72c08SEugene Crosser break; 18359c23f4daSEugene Crosser case 0x2B18: 1836b4d72c08SEugene Crosser case 0x0018: /* This device is currently Secondary */ 1837b4d72c08SEugene Crosser rc = -EBUSY; 1838b4d72c08SEugene Crosser dev_err(&card->gdev->dev, 18399c23f4daSEugene Crosser "The device is already a secondary Bridge Port\n"); 1840b4d72c08SEugene Crosser break; 18419c23f4daSEugene Crosser case 0x2B1C: 1842b4d72c08SEugene Crosser case 0x001C: /* Limit for Secondary devices reached */ 1843b4d72c08SEugene Crosser rc = -EEXIST; 1844b4d72c08SEugene Crosser dev_err(&card->gdev->dev, 18459c23f4daSEugene Crosser "The LAN cannot have more secondary Bridge Ports\n"); 1846b4d72c08SEugene Crosser break; 18479c23f4daSEugene Crosser case 0x2B24: 1848b4d72c08SEugene Crosser case 0x0024: /* This device is currently Primary */ 1849b4d72c08SEugene Crosser rc = -EBUSY; 1850b4d72c08SEugene Crosser dev_err(&card->gdev->dev, 18519c23f4daSEugene Crosser "The device is already a primary Bridge Port\n"); 1852b4d72c08SEugene Crosser break; 18539c23f4daSEugene Crosser case 0x2B20: 1854b4d72c08SEugene Crosser case 0x0020: /* Not authorized by zManager */ 1855b4d72c08SEugene Crosser rc = -EACCES; 1856b4d72c08SEugene Crosser dev_err(&card->gdev->dev, 18579c23f4daSEugene Crosser "The device is not authorized to be a Bridge Port\n"); 1858b4d72c08SEugene Crosser break; 1859b4d72c08SEugene Crosser default: 1860b4d72c08SEugene Crosser rc = -EIO; 1861b4d72c08SEugene Crosser } 18629c23f4daSEugene Crosser else 18639c23f4daSEugene Crosser switch (cbctl->ipa_rc) { 1864b4d72c08SEugene Crosser case IPA_RC_NOTSUPP: 1865ffb95251SEugene Crosser rc = -EOPNOTSUPP; 1866b4d72c08SEugene Crosser break; 1867b4d72c08SEugene Crosser case IPA_RC_UNSUPPORTED_COMMAND: 1868ffb95251SEugene Crosser rc = -EOPNOTSUPP; 1869b4d72c08SEugene Crosser break; 1870b4d72c08SEugene Crosser default: 1871b4d72c08SEugene Crosser rc = -EIO; 1872b4d72c08SEugene Crosser } 18739c23f4daSEugene Crosser 1874b4d72c08SEugene Crosser if (rc) { 1875b4d72c08SEugene Crosser QETH_CARD_TEXT_(card, 2, "SBPi%04x", cbctl->ipa_rc); 1876b4d72c08SEugene Crosser QETH_CARD_TEXT_(card, 2, "SBPc%04x", cbctl->cmd_rc); 1877b4d72c08SEugene Crosser } 1878b4d72c08SEugene Crosser return rc; 1879b4d72c08SEugene Crosser } 1880b4d72c08SEugene Crosser 18819c23f4daSEugene Crosser static inline int ipa_cmd_sbp(struct qeth_card *card) 18829c23f4daSEugene Crosser { 18839c23f4daSEugene Crosser return (card->info.type == QETH_CARD_TYPE_IQD) ? 18849c23f4daSEugene Crosser IPA_CMD_SETBRIDGEPORT_IQD : 18859c23f4daSEugene Crosser IPA_CMD_SETBRIDGEPORT_OSA; 18869c23f4daSEugene Crosser } 18879c23f4daSEugene Crosser 1888b4d72c08SEugene Crosser static int qeth_bridgeport_query_support_cb(struct qeth_card *card, 1889b4d72c08SEugene Crosser struct qeth_reply *reply, unsigned long data) 1890b4d72c08SEugene Crosser { 1891b4d72c08SEugene Crosser struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *) data; 1892b4d72c08SEugene Crosser struct _qeth_sbp_cbctl *cbctl = (struct _qeth_sbp_cbctl *)reply->param; 1893b4d72c08SEugene Crosser QETH_CARD_TEXT(card, 2, "brqsupcb"); 1894b4d72c08SEugene Crosser cbctl->ipa_rc = cmd->hdr.return_code; 1895b4d72c08SEugene Crosser cbctl->cmd_rc = cmd->data.sbp.hdr.return_code; 1896b4d72c08SEugene Crosser if ((cbctl->ipa_rc == 0) && (cbctl->cmd_rc == 0)) { 1897b4d72c08SEugene Crosser cbctl->data.supported = 1898b4d72c08SEugene Crosser cmd->data.sbp.data.query_cmds_supp.supported_cmds; 1899b4d72c08SEugene Crosser } else { 1900b4d72c08SEugene Crosser cbctl->data.supported = 0; 1901b4d72c08SEugene Crosser } 1902b4d72c08SEugene Crosser return 0; 1903b4d72c08SEugene Crosser } 1904b4d72c08SEugene Crosser 1905b4d72c08SEugene Crosser /** 1906b4d72c08SEugene Crosser * qeth_bridgeport_query_support() - store bitmask of supported subfunctions. 1907b4d72c08SEugene Crosser * @card: qeth_card structure pointer. 1908b4d72c08SEugene Crosser * 1909b4d72c08SEugene Crosser * Sets bitmask of supported setbridgeport subfunctions in the qeth_card 1910b4d72c08SEugene Crosser * strucutre: card->options.sbp.supported_funcs. 1911b4d72c08SEugene Crosser */ 1912c044dc21SEugene Crosser static void qeth_bridgeport_query_support(struct qeth_card *card) 1913b4d72c08SEugene Crosser { 1914b4d72c08SEugene Crosser struct qeth_cmd_buffer *iob; 1915b4d72c08SEugene Crosser struct qeth_ipa_cmd *cmd; 1916b4d72c08SEugene Crosser struct _qeth_sbp_cbctl cbctl; 1917b4d72c08SEugene Crosser 1918b4d72c08SEugene Crosser QETH_CARD_TEXT(card, 2, "brqsuppo"); 19199c23f4daSEugene Crosser iob = qeth_get_ipacmd_buffer(card, ipa_cmd_sbp(card), 0); 19201aec42bcSThomas Richter if (!iob) 19211aec42bcSThomas Richter return; 1922b4d72c08SEugene Crosser cmd = (struct qeth_ipa_cmd *)(iob->data+IPA_PDU_HEADER_SIZE); 1923b4d72c08SEugene Crosser cmd->data.sbp.hdr.cmdlength = 1924b4d72c08SEugene Crosser sizeof(struct qeth_ipacmd_sbp_hdr) + 1925b4d72c08SEugene Crosser sizeof(struct qeth_sbp_query_cmds_supp); 1926b4d72c08SEugene Crosser cmd->data.sbp.hdr.command_code = 1927b4d72c08SEugene Crosser IPA_SBP_QUERY_COMMANDS_SUPPORTED; 1928b4d72c08SEugene Crosser cmd->data.sbp.hdr.used_total = 1; 1929b4d72c08SEugene Crosser cmd->data.sbp.hdr.seq_no = 1; 1930b4d72c08SEugene Crosser if (qeth_send_ipa_cmd(card, iob, qeth_bridgeport_query_support_cb, 1931b4d72c08SEugene Crosser (void *)&cbctl) || 1932b4d72c08SEugene Crosser qeth_bridgeport_makerc(card, &cbctl, 1933b4d72c08SEugene Crosser IPA_SBP_QUERY_COMMANDS_SUPPORTED)) { 1934b4d72c08SEugene Crosser /* non-zero makerc signifies failure, and produce messages */ 1935b4d72c08SEugene Crosser card->options.sbp.role = QETH_SBP_ROLE_NONE; 1936b4d72c08SEugene Crosser return; 1937b4d72c08SEugene Crosser } 1938b4d72c08SEugene Crosser card->options.sbp.supported_funcs = cbctl.data.supported; 1939b4d72c08SEugene Crosser } 1940b4d72c08SEugene Crosser 1941b4d72c08SEugene Crosser static int qeth_bridgeport_query_ports_cb(struct qeth_card *card, 1942b4d72c08SEugene Crosser struct qeth_reply *reply, unsigned long data) 1943b4d72c08SEugene Crosser { 1944b4d72c08SEugene Crosser struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *) data; 1945b4d72c08SEugene Crosser struct qeth_sbp_query_ports *qports = &cmd->data.sbp.data.query_ports; 1946b4d72c08SEugene Crosser struct _qeth_sbp_cbctl *cbctl = (struct _qeth_sbp_cbctl *)reply->param; 1947b4d72c08SEugene Crosser 1948b4d72c08SEugene Crosser QETH_CARD_TEXT(card, 2, "brqprtcb"); 1949b4d72c08SEugene Crosser cbctl->ipa_rc = cmd->hdr.return_code; 1950b4d72c08SEugene Crosser cbctl->cmd_rc = cmd->data.sbp.hdr.return_code; 1951b4d72c08SEugene Crosser if ((cbctl->ipa_rc != 0) || (cbctl->cmd_rc != 0)) 1952b4d72c08SEugene Crosser return 0; 1953b4d72c08SEugene Crosser if (qports->entry_length != sizeof(struct qeth_sbp_port_entry)) { 1954b4d72c08SEugene Crosser cbctl->cmd_rc = 0xffff; 1955b4d72c08SEugene Crosser QETH_CARD_TEXT_(card, 2, "SBPs%04x", qports->entry_length); 1956b4d72c08SEugene Crosser return 0; 1957b4d72c08SEugene Crosser } 1958b4d72c08SEugene Crosser /* first entry contains the state of the local port */ 1959b4d72c08SEugene Crosser if (qports->num_entries > 0) { 1960b4d72c08SEugene Crosser if (cbctl->data.qports.role) 1961b4d72c08SEugene Crosser *cbctl->data.qports.role = qports->entry[0].role; 1962b4d72c08SEugene Crosser if (cbctl->data.qports.state) 1963b4d72c08SEugene Crosser *cbctl->data.qports.state = qports->entry[0].state; 1964b4d72c08SEugene Crosser } 1965b4d72c08SEugene Crosser return 0; 1966b4d72c08SEugene Crosser } 1967b4d72c08SEugene Crosser 1968b4d72c08SEugene Crosser /** 1969b4d72c08SEugene Crosser * qeth_bridgeport_query_ports() - query local bridgeport status. 1970b4d72c08SEugene Crosser * @card: qeth_card structure pointer. 1971b4d72c08SEugene Crosser * @role: Role of the port: 0-none, 1-primary, 2-secondary. 1972b4d72c08SEugene Crosser * @state: State of the port: 0-inactive, 1-standby, 2-active. 1973b4d72c08SEugene Crosser * 1974b4d72c08SEugene Crosser * Returns negative errno-compatible error indication or 0 on success. 1975b4d72c08SEugene Crosser * 1976b4d72c08SEugene Crosser * 'role' and 'state' are not updated in case of hardware operation failure. 1977b4d72c08SEugene Crosser */ 1978b4d72c08SEugene Crosser int qeth_bridgeport_query_ports(struct qeth_card *card, 1979b4d72c08SEugene Crosser enum qeth_sbp_roles *role, enum qeth_sbp_states *state) 1980b4d72c08SEugene Crosser { 1981b4d72c08SEugene Crosser int rc = 0; 1982b4d72c08SEugene Crosser struct qeth_cmd_buffer *iob; 1983b4d72c08SEugene Crosser struct qeth_ipa_cmd *cmd; 1984b4d72c08SEugene Crosser struct _qeth_sbp_cbctl cbctl = { 1985b4d72c08SEugene Crosser .data = { 1986b4d72c08SEugene Crosser .qports = { 1987b4d72c08SEugene Crosser .role = role, 1988b4d72c08SEugene Crosser .state = state, 1989b4d72c08SEugene Crosser }, 1990b4d72c08SEugene Crosser }, 1991b4d72c08SEugene Crosser }; 1992b4d72c08SEugene Crosser 1993b4d72c08SEugene Crosser QETH_CARD_TEXT(card, 2, "brqports"); 1994b4d72c08SEugene Crosser if (!(card->options.sbp.supported_funcs & IPA_SBP_QUERY_BRIDGE_PORTS)) 1995b4d72c08SEugene Crosser return -EOPNOTSUPP; 19969c23f4daSEugene Crosser iob = qeth_get_ipacmd_buffer(card, ipa_cmd_sbp(card), 0); 19971aec42bcSThomas Richter if (!iob) 19981aec42bcSThomas Richter return -ENOMEM; 1999b4d72c08SEugene Crosser cmd = (struct qeth_ipa_cmd *)(iob->data+IPA_PDU_HEADER_SIZE); 2000b4d72c08SEugene Crosser cmd->data.sbp.hdr.cmdlength = 2001b4d72c08SEugene Crosser sizeof(struct qeth_ipacmd_sbp_hdr); 2002b4d72c08SEugene Crosser cmd->data.sbp.hdr.command_code = 2003b4d72c08SEugene Crosser IPA_SBP_QUERY_BRIDGE_PORTS; 2004b4d72c08SEugene Crosser cmd->data.sbp.hdr.used_total = 1; 2005b4d72c08SEugene Crosser cmd->data.sbp.hdr.seq_no = 1; 2006b4d72c08SEugene Crosser rc = qeth_send_ipa_cmd(card, iob, qeth_bridgeport_query_ports_cb, 2007b4d72c08SEugene Crosser (void *)&cbctl); 2008c88394e7SEugene Crosser if (rc < 0) 2009b4d72c08SEugene Crosser return rc; 2010c88394e7SEugene Crosser return qeth_bridgeport_makerc(card, &cbctl, IPA_SBP_QUERY_BRIDGE_PORTS); 2011b4d72c08SEugene Crosser } 2012b4d72c08SEugene Crosser EXPORT_SYMBOL_GPL(qeth_bridgeport_query_ports); 2013b4d72c08SEugene Crosser 2014b4d72c08SEugene Crosser static int qeth_bridgeport_set_cb(struct qeth_card *card, 2015b4d72c08SEugene Crosser struct qeth_reply *reply, unsigned long data) 2016b4d72c08SEugene Crosser { 2017b4d72c08SEugene Crosser struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *)data; 2018b4d72c08SEugene Crosser struct _qeth_sbp_cbctl *cbctl = (struct _qeth_sbp_cbctl *)reply->param; 2019b4d72c08SEugene Crosser QETH_CARD_TEXT(card, 2, "brsetrcb"); 2020b4d72c08SEugene Crosser cbctl->ipa_rc = cmd->hdr.return_code; 2021b4d72c08SEugene Crosser cbctl->cmd_rc = cmd->data.sbp.hdr.return_code; 2022b4d72c08SEugene Crosser return 0; 2023b4d72c08SEugene Crosser } 2024b4d72c08SEugene Crosser 2025b4d72c08SEugene Crosser /** 2026b4d72c08SEugene Crosser * qeth_bridgeport_setrole() - Assign primary role to the port. 2027b4d72c08SEugene Crosser * @card: qeth_card structure pointer. 2028b4d72c08SEugene Crosser * @role: Role to assign. 2029b4d72c08SEugene Crosser * 2030b4d72c08SEugene Crosser * Returns negative errno-compatible error indication or 0 on success. 2031b4d72c08SEugene Crosser */ 2032b4d72c08SEugene Crosser int qeth_bridgeport_setrole(struct qeth_card *card, enum qeth_sbp_roles role) 2033b4d72c08SEugene Crosser { 2034b4d72c08SEugene Crosser int rc = 0; 2035b4d72c08SEugene Crosser int cmdlength; 2036b4d72c08SEugene Crosser struct qeth_cmd_buffer *iob; 2037b4d72c08SEugene Crosser struct qeth_ipa_cmd *cmd; 2038b4d72c08SEugene Crosser struct _qeth_sbp_cbctl cbctl; 2039b4d72c08SEugene Crosser enum qeth_ipa_sbp_cmd setcmd; 2040b4d72c08SEugene Crosser 2041b4d72c08SEugene Crosser QETH_CARD_TEXT(card, 2, "brsetrol"); 2042b4d72c08SEugene Crosser switch (role) { 2043b4d72c08SEugene Crosser case QETH_SBP_ROLE_NONE: 2044b4d72c08SEugene Crosser setcmd = IPA_SBP_RESET_BRIDGE_PORT_ROLE; 2045b4d72c08SEugene Crosser cmdlength = sizeof(struct qeth_ipacmd_sbp_hdr) + 2046b4d72c08SEugene Crosser sizeof(struct qeth_sbp_reset_role); 2047b4d72c08SEugene Crosser break; 2048b4d72c08SEugene Crosser case QETH_SBP_ROLE_PRIMARY: 2049b4d72c08SEugene Crosser setcmd = IPA_SBP_SET_PRIMARY_BRIDGE_PORT; 2050b4d72c08SEugene Crosser cmdlength = sizeof(struct qeth_ipacmd_sbp_hdr) + 2051b4d72c08SEugene Crosser sizeof(struct qeth_sbp_set_primary); 2052b4d72c08SEugene Crosser break; 2053b4d72c08SEugene Crosser case QETH_SBP_ROLE_SECONDARY: 2054b4d72c08SEugene Crosser setcmd = IPA_SBP_SET_SECONDARY_BRIDGE_PORT; 2055b4d72c08SEugene Crosser cmdlength = sizeof(struct qeth_ipacmd_sbp_hdr) + 2056b4d72c08SEugene Crosser sizeof(struct qeth_sbp_set_secondary); 2057b4d72c08SEugene Crosser break; 2058b4d72c08SEugene Crosser default: 2059b4d72c08SEugene Crosser return -EINVAL; 2060b4d72c08SEugene Crosser } 2061b4d72c08SEugene Crosser if (!(card->options.sbp.supported_funcs & setcmd)) 2062b4d72c08SEugene Crosser return -EOPNOTSUPP; 20639c23f4daSEugene Crosser iob = qeth_get_ipacmd_buffer(card, ipa_cmd_sbp(card), 0); 20641aec42bcSThomas Richter if (!iob) 20651aec42bcSThomas Richter return -ENOMEM; 2066b4d72c08SEugene Crosser cmd = (struct qeth_ipa_cmd *)(iob->data+IPA_PDU_HEADER_SIZE); 2067b4d72c08SEugene Crosser cmd->data.sbp.hdr.cmdlength = cmdlength; 2068b4d72c08SEugene Crosser cmd->data.sbp.hdr.command_code = setcmd; 2069b4d72c08SEugene Crosser cmd->data.sbp.hdr.used_total = 1; 2070b4d72c08SEugene Crosser cmd->data.sbp.hdr.seq_no = 1; 2071b4d72c08SEugene Crosser rc = qeth_send_ipa_cmd(card, iob, qeth_bridgeport_set_cb, 2072b4d72c08SEugene Crosser (void *)&cbctl); 2073c88394e7SEugene Crosser if (rc < 0) 2074b4d72c08SEugene Crosser return rc; 2075c88394e7SEugene Crosser return qeth_bridgeport_makerc(card, &cbctl, setcmd); 2076b4d72c08SEugene Crosser } 2077b4d72c08SEugene Crosser 20789f48b9dbSEugene Crosser /** 20799f48b9dbSEugene Crosser * qeth_anset_makerc() - derive "traditional" error from hardware codes. 20809f48b9dbSEugene Crosser * @card: qeth_card structure pointer, for debug messages. 20819f48b9dbSEugene Crosser * 20829f48b9dbSEugene Crosser * Returns negative errno-compatible error indication or 0 on success. 20839f48b9dbSEugene Crosser */ 20849f48b9dbSEugene Crosser static int qeth_anset_makerc(struct qeth_card *card, int pnso_rc, u16 response) 20859f48b9dbSEugene Crosser { 20869f48b9dbSEugene Crosser int rc; 20879f48b9dbSEugene Crosser 20889f48b9dbSEugene Crosser if (pnso_rc == 0) 20899f48b9dbSEugene Crosser switch (response) { 20909f48b9dbSEugene Crosser case 0x0001: 20919f48b9dbSEugene Crosser rc = 0; 20929f48b9dbSEugene Crosser break; 20939f48b9dbSEugene Crosser case 0x0004: 20949f48b9dbSEugene Crosser case 0x0100: 20959f48b9dbSEugene Crosser case 0x0106: 2096ffb95251SEugene Crosser rc = -EOPNOTSUPP; 20979f48b9dbSEugene Crosser dev_err(&card->gdev->dev, 20989f48b9dbSEugene Crosser "Setting address notification failed\n"); 20999f48b9dbSEugene Crosser break; 21009f48b9dbSEugene Crosser case 0x0107: 21019f48b9dbSEugene Crosser rc = -EAGAIN; 21029f48b9dbSEugene Crosser break; 21039f48b9dbSEugene Crosser default: 21049f48b9dbSEugene Crosser rc = -EIO; 21059f48b9dbSEugene Crosser } 21069f48b9dbSEugene Crosser else 21079f48b9dbSEugene Crosser rc = -EIO; 21089f48b9dbSEugene Crosser 21099f48b9dbSEugene Crosser if (rc) { 21109f48b9dbSEugene Crosser QETH_CARD_TEXT_(card, 2, "SBPp%04x", pnso_rc); 21119f48b9dbSEugene Crosser QETH_CARD_TEXT_(card, 2, "SBPr%04x", response); 21129f48b9dbSEugene Crosser } 21139f48b9dbSEugene Crosser return rc; 21149f48b9dbSEugene Crosser } 21159f48b9dbSEugene Crosser 21169f48b9dbSEugene Crosser static void qeth_bridgeport_an_set_cb(void *priv, 21179f48b9dbSEugene Crosser enum qdio_brinfo_entry_type type, void *entry) 21189f48b9dbSEugene Crosser { 21199f48b9dbSEugene Crosser struct qeth_card *card = (struct qeth_card *)priv; 21209f48b9dbSEugene Crosser struct qdio_brinfo_entry_l2 *l2entry; 21219f48b9dbSEugene Crosser u8 code; 21229f48b9dbSEugene Crosser 21239f48b9dbSEugene Crosser if (type != l2_addr_lnid) { 21249f48b9dbSEugene Crosser WARN_ON_ONCE(1); 21259f48b9dbSEugene Crosser return; 21269f48b9dbSEugene Crosser } 21279f48b9dbSEugene Crosser 21289f48b9dbSEugene Crosser l2entry = (struct qdio_brinfo_entry_l2 *)entry; 21299f48b9dbSEugene Crosser code = IPA_ADDR_CHANGE_CODE_MACADDR; 21309f48b9dbSEugene Crosser if (l2entry->addr_lnid.lnid) 21319f48b9dbSEugene Crosser code |= IPA_ADDR_CHANGE_CODE_VLANID; 21329f48b9dbSEugene Crosser qeth_bridge_emit_host_event(card, anev_reg_unreg, code, 21339f48b9dbSEugene Crosser (struct net_if_token *)&l2entry->nit, 21349f48b9dbSEugene Crosser (struct mac_addr_lnid *)&l2entry->addr_lnid); 21359f48b9dbSEugene Crosser } 21369f48b9dbSEugene Crosser 21379f48b9dbSEugene Crosser /** 21389f48b9dbSEugene Crosser * qeth_bridgeport_an_set() - Enable or disable bridgeport address notification 21399f48b9dbSEugene Crosser * @card: qeth_card structure pointer. 21409f48b9dbSEugene Crosser * @enable: 0 - disable, non-zero - enable notifications 21419f48b9dbSEugene Crosser * 21429f48b9dbSEugene Crosser * Returns negative errno-compatible error indication or 0 on success. 21439f48b9dbSEugene Crosser * 21449f48b9dbSEugene Crosser * On enable, emits a series of address notifications udev events for all 21459f48b9dbSEugene Crosser * currently registered hosts. 21469f48b9dbSEugene Crosser */ 21479f48b9dbSEugene Crosser int qeth_bridgeport_an_set(struct qeth_card *card, int enable) 21489f48b9dbSEugene Crosser { 21499f48b9dbSEugene Crosser int rc; 21509f48b9dbSEugene Crosser u16 response; 21519f48b9dbSEugene Crosser struct ccw_device *ddev; 21529f48b9dbSEugene Crosser struct subchannel_id schid; 21539f48b9dbSEugene Crosser 21549f48b9dbSEugene Crosser if (!card) 21559f48b9dbSEugene Crosser return -EINVAL; 21569f48b9dbSEugene Crosser if (!card->options.sbp.supported_funcs) 21579f48b9dbSEugene Crosser return -EOPNOTSUPP; 21589f48b9dbSEugene Crosser ddev = CARD_DDEV(card); 21599f48b9dbSEugene Crosser ccw_device_get_schid(ddev, &schid); 21609f48b9dbSEugene Crosser 21619f48b9dbSEugene Crosser if (enable) { 21629f48b9dbSEugene Crosser qeth_bridge_emit_host_event(card, anev_reset, 0, NULL, NULL); 21639f48b9dbSEugene Crosser rc = qdio_pnso_brinfo(schid, 1, &response, 21649f48b9dbSEugene Crosser qeth_bridgeport_an_set_cb, card); 21659f48b9dbSEugene Crosser } else 21669f48b9dbSEugene Crosser rc = qdio_pnso_brinfo(schid, 0, &response, NULL, NULL); 21679f48b9dbSEugene Crosser return qeth_anset_makerc(card, rc, response); 21689f48b9dbSEugene Crosser } 21699f48b9dbSEugene Crosser EXPORT_SYMBOL_GPL(qeth_bridgeport_an_set); 21709f48b9dbSEugene Crosser 21714a71df50SFrank Blaschka module_init(qeth_l2_init); 21724a71df50SFrank Blaschka module_exit(qeth_l2_exit); 21734a71df50SFrank Blaschka MODULE_AUTHOR("Frank Blaschka <frank.blaschka@de.ibm.com>"); 21744a71df50SFrank Blaschka MODULE_DESCRIPTION("qeth layer 2 discipline"); 21754a71df50SFrank Blaschka MODULE_LICENSE("GPL"); 2176