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> 224a71df50SFrank Blaschka 234a71df50SFrank Blaschka #include "qeth_core.h" 244a71df50SFrank Blaschka 254a71df50SFrank Blaschka static int qeth_l2_set_offline(struct ccwgroup_device *); 264a71df50SFrank Blaschka static int qeth_l2_stop(struct net_device *); 274a71df50SFrank Blaschka static int qeth_l2_send_delmac(struct qeth_card *, __u8 *); 284a71df50SFrank Blaschka static int qeth_l2_send_setdelmac(struct qeth_card *, __u8 *, 294a71df50SFrank Blaschka enum qeth_ipa_cmds, 304a71df50SFrank Blaschka int (*reply_cb) (struct qeth_card *, 314a71df50SFrank Blaschka struct qeth_reply*, 324a71df50SFrank Blaschka unsigned long)); 334a71df50SFrank Blaschka static void qeth_l2_set_multicast_list(struct net_device *); 344a71df50SFrank Blaschka static int qeth_l2_recover(void *); 354a71df50SFrank Blaschka 364a71df50SFrank Blaschka static int qeth_l2_do_ioctl(struct net_device *dev, struct ifreq *rq, int cmd) 374a71df50SFrank Blaschka { 38509e2562SHeiko Carstens struct qeth_card *card = dev->ml_priv; 394a71df50SFrank Blaschka struct mii_ioctl_data *mii_data; 404a71df50SFrank Blaschka int rc = 0; 414a71df50SFrank Blaschka 424a71df50SFrank Blaschka if (!card) 434a71df50SFrank Blaschka return -ENODEV; 444a71df50SFrank Blaschka 454a71df50SFrank Blaschka if ((card->state != CARD_STATE_UP) && 464a71df50SFrank Blaschka (card->state != CARD_STATE_SOFTSETUP)) 474a71df50SFrank Blaschka return -ENODEV; 484a71df50SFrank Blaschka 494a71df50SFrank Blaschka if (card->info.type == QETH_CARD_TYPE_OSN) 504a71df50SFrank Blaschka return -EPERM; 514a71df50SFrank Blaschka 524a71df50SFrank Blaschka switch (cmd) { 534a71df50SFrank Blaschka case SIOC_QETH_ADP_SET_SNMP_CONTROL: 544a71df50SFrank Blaschka rc = qeth_snmp_command(card, rq->ifr_ifru.ifru_data); 554a71df50SFrank Blaschka break; 564a71df50SFrank Blaschka case SIOC_QETH_GET_CARD_TYPE: 575113fec0SUrsula Braun if ((card->info.type == QETH_CARD_TYPE_OSD || 585113fec0SUrsula Braun card->info.type == QETH_CARD_TYPE_OSM || 595113fec0SUrsula Braun card->info.type == QETH_CARD_TYPE_OSX) && 604a71df50SFrank Blaschka !card->info.guestlan) 614a71df50SFrank Blaschka return 1; 624a71df50SFrank Blaschka return 0; 634a71df50SFrank Blaschka break; 644a71df50SFrank Blaschka case SIOCGMIIPHY: 654a71df50SFrank Blaschka mii_data = if_mii(rq); 664a71df50SFrank Blaschka mii_data->phy_id = 0; 674a71df50SFrank Blaschka break; 684a71df50SFrank Blaschka case SIOCGMIIREG: 694a71df50SFrank Blaschka mii_data = if_mii(rq); 704a71df50SFrank Blaschka if (mii_data->phy_id != 0) 714a71df50SFrank Blaschka rc = -EINVAL; 724a71df50SFrank Blaschka else 734a71df50SFrank Blaschka mii_data->val_out = qeth_mdio_read(dev, 744a71df50SFrank Blaschka mii_data->phy_id, mii_data->reg_num); 754a71df50SFrank Blaschka break; 76c3ab96f3SFrank Blaschka case SIOC_QETH_QUERY_OAT: 77c3ab96f3SFrank Blaschka rc = qeth_query_oat_command(card, rq->ifr_ifru.ifru_data); 78c3ab96f3SFrank Blaschka break; 794a71df50SFrank Blaschka default: 804a71df50SFrank Blaschka rc = -EOPNOTSUPP; 814a71df50SFrank Blaschka } 824a71df50SFrank Blaschka if (rc) 83847a50fdSCarsten Otte QETH_CARD_TEXT_(card, 2, "ioce%d", rc); 844a71df50SFrank Blaschka return rc; 854a71df50SFrank Blaschka } 864a71df50SFrank Blaschka 874a71df50SFrank Blaschka static int qeth_l2_verify_dev(struct net_device *dev) 884a71df50SFrank Blaschka { 894a71df50SFrank Blaschka struct qeth_card *card; 904a71df50SFrank Blaschka unsigned long flags; 914a71df50SFrank Blaschka int rc = 0; 924a71df50SFrank Blaschka 934a71df50SFrank Blaschka read_lock_irqsave(&qeth_core_card_list.rwlock, flags); 944a71df50SFrank Blaschka list_for_each_entry(card, &qeth_core_card_list.list, list) { 954a71df50SFrank Blaschka if (card->dev == dev) { 964a71df50SFrank Blaschka rc = QETH_REAL_CARD; 974a71df50SFrank Blaschka break; 984a71df50SFrank Blaschka } 994a71df50SFrank Blaschka } 1004a71df50SFrank Blaschka read_unlock_irqrestore(&qeth_core_card_list.rwlock, flags); 1014a71df50SFrank Blaschka 1024a71df50SFrank Blaschka return rc; 1034a71df50SFrank Blaschka } 1044a71df50SFrank Blaschka 1054a71df50SFrank Blaschka static struct net_device *qeth_l2_netdev_by_devno(unsigned char *read_dev_no) 1064a71df50SFrank Blaschka { 1074a71df50SFrank Blaschka struct qeth_card *card; 1084a71df50SFrank Blaschka struct net_device *ndev; 109f06f6f32SCornelia Huck __u16 temp_dev_no; 1104a71df50SFrank Blaschka unsigned long flags; 111f06f6f32SCornelia Huck struct ccw_dev_id read_devid; 1124a71df50SFrank Blaschka 1134a71df50SFrank Blaschka ndev = NULL; 1144a71df50SFrank Blaschka memcpy(&temp_dev_no, read_dev_no, 2); 1154a71df50SFrank Blaschka read_lock_irqsave(&qeth_core_card_list.rwlock, flags); 1164a71df50SFrank Blaschka list_for_each_entry(card, &qeth_core_card_list.list, list) { 117f06f6f32SCornelia Huck ccw_device_get_id(CARD_RDEV(card), &read_devid); 118f06f6f32SCornelia Huck if (read_devid.devno == temp_dev_no) { 1194a71df50SFrank Blaschka ndev = card->dev; 1204a71df50SFrank Blaschka break; 1214a71df50SFrank Blaschka } 1224a71df50SFrank Blaschka } 1234a71df50SFrank Blaschka read_unlock_irqrestore(&qeth_core_card_list.rwlock, flags); 1244a71df50SFrank Blaschka return ndev; 1254a71df50SFrank Blaschka } 1264a71df50SFrank Blaschka 1274a71df50SFrank Blaschka static int qeth_l2_send_setgroupmac_cb(struct qeth_card *card, 1284a71df50SFrank Blaschka struct qeth_reply *reply, 1294a71df50SFrank Blaschka unsigned long data) 1304a71df50SFrank Blaschka { 1314a71df50SFrank Blaschka struct qeth_ipa_cmd *cmd; 1324a71df50SFrank Blaschka __u8 *mac; 1334a71df50SFrank Blaschka 134847a50fdSCarsten Otte QETH_CARD_TEXT(card, 2, "L2Sgmacb"); 1354a71df50SFrank Blaschka cmd = (struct qeth_ipa_cmd *) data; 1364a71df50SFrank Blaschka mac = &cmd->data.setdelmac.mac[0]; 1374a71df50SFrank Blaschka /* MAC already registered, needed in couple/uncouple case */ 1380666eb06SUrsula Braun if (cmd->hdr.return_code == IPA_RC_L2_DUP_MAC) { 1397c510e4bSJohannes Berg QETH_DBF_MESSAGE(2, "Group MAC %pM already existing on %s \n", 1407c510e4bSJohannes Berg mac, QETH_CARD_IFNAME(card)); 1414a71df50SFrank Blaschka cmd->hdr.return_code = 0; 1424a71df50SFrank Blaschka } 1434a71df50SFrank Blaschka if (cmd->hdr.return_code) 1447c510e4bSJohannes Berg QETH_DBF_MESSAGE(2, "Could not set group MAC %pM on %s: %x\n", 1457c510e4bSJohannes Berg mac, QETH_CARD_IFNAME(card), cmd->hdr.return_code); 1464a71df50SFrank Blaschka return 0; 1474a71df50SFrank Blaschka } 1484a71df50SFrank Blaschka 1494a71df50SFrank Blaschka static int qeth_l2_send_setgroupmac(struct qeth_card *card, __u8 *mac) 1504a71df50SFrank Blaschka { 151847a50fdSCarsten Otte QETH_CARD_TEXT(card, 2, "L2Sgmac"); 1524a71df50SFrank Blaschka return qeth_l2_send_setdelmac(card, mac, IPA_CMD_SETGMAC, 1534a71df50SFrank Blaschka qeth_l2_send_setgroupmac_cb); 1544a71df50SFrank Blaschka } 1554a71df50SFrank Blaschka 1564a71df50SFrank Blaschka static int qeth_l2_send_delgroupmac_cb(struct qeth_card *card, 1574a71df50SFrank Blaschka struct qeth_reply *reply, 1584a71df50SFrank Blaschka unsigned long data) 1594a71df50SFrank Blaschka { 1604a71df50SFrank Blaschka struct qeth_ipa_cmd *cmd; 1614a71df50SFrank Blaschka __u8 *mac; 1624a71df50SFrank Blaschka 163847a50fdSCarsten Otte QETH_CARD_TEXT(card, 2, "L2Dgmacb"); 1644a71df50SFrank Blaschka cmd = (struct qeth_ipa_cmd *) data; 1654a71df50SFrank Blaschka mac = &cmd->data.setdelmac.mac[0]; 1664a71df50SFrank Blaschka if (cmd->hdr.return_code) 1677c510e4bSJohannes Berg QETH_DBF_MESSAGE(2, "Could not delete group MAC %pM on %s: %x\n", 1687c510e4bSJohannes Berg mac, QETH_CARD_IFNAME(card), cmd->hdr.return_code); 1694a71df50SFrank Blaschka return 0; 1704a71df50SFrank Blaschka } 1714a71df50SFrank Blaschka 1724a71df50SFrank Blaschka static int qeth_l2_send_delgroupmac(struct qeth_card *card, __u8 *mac) 1734a71df50SFrank Blaschka { 174847a50fdSCarsten Otte QETH_CARD_TEXT(card, 2, "L2Dgmac"); 1754a71df50SFrank Blaschka return qeth_l2_send_setdelmac(card, mac, IPA_CMD_DELGMAC, 1764a71df50SFrank Blaschka qeth_l2_send_delgroupmac_cb); 1774a71df50SFrank Blaschka } 1784a71df50SFrank Blaschka 1797db2266aSFrank Blaschka static void qeth_l2_add_mc(struct qeth_card *card, __u8 *mac, int vmac) 1804a71df50SFrank Blaschka { 1814a71df50SFrank Blaschka struct qeth_mc_mac *mc; 1827db2266aSFrank Blaschka int rc; 1834a71df50SFrank Blaschka 1844a71df50SFrank Blaschka mc = kmalloc(sizeof(struct qeth_mc_mac), GFP_ATOMIC); 1854a71df50SFrank Blaschka 18614cc21b6SFrank Blaschka if (!mc) 1874a71df50SFrank Blaschka return; 1884a71df50SFrank Blaschka 1894a71df50SFrank Blaschka memcpy(mc->mc_addr, mac, OSA_ADDR_LEN); 1904a71df50SFrank Blaschka mc->mc_addrlen = OSA_ADDR_LEN; 1917db2266aSFrank Blaschka mc->is_vmac = vmac; 1924a71df50SFrank Blaschka 1937db2266aSFrank Blaschka if (vmac) { 1947db2266aSFrank Blaschka rc = qeth_l2_send_setdelmac(card, mac, IPA_CMD_SETVMAC, 1957db2266aSFrank Blaschka NULL); 1967db2266aSFrank Blaschka } else { 1977db2266aSFrank Blaschka rc = qeth_l2_send_setgroupmac(card, mac); 1987db2266aSFrank Blaschka } 1997db2266aSFrank Blaschka 2007db2266aSFrank Blaschka if (!rc) 2014a71df50SFrank Blaschka list_add_tail(&mc->list, &card->mc_list); 2024a71df50SFrank Blaschka else 2034a71df50SFrank Blaschka kfree(mc); 2044a71df50SFrank Blaschka } 2054a71df50SFrank Blaschka 20670919e23SUrsula Braun static void qeth_l2_del_all_mc(struct qeth_card *card, int del) 2074a71df50SFrank Blaschka { 2084a71df50SFrank Blaschka struct qeth_mc_mac *mc, *tmp; 2094a71df50SFrank Blaschka 2104a71df50SFrank Blaschka spin_lock_bh(&card->mclock); 2114a71df50SFrank Blaschka list_for_each_entry_safe(mc, tmp, &card->mc_list, list) { 21270919e23SUrsula Braun if (del) { 2137db2266aSFrank Blaschka if (mc->is_vmac) 2147db2266aSFrank Blaschka qeth_l2_send_setdelmac(card, mc->mc_addr, 2157db2266aSFrank Blaschka IPA_CMD_DELVMAC, NULL); 2167db2266aSFrank Blaschka else 2174a71df50SFrank Blaschka qeth_l2_send_delgroupmac(card, mc->mc_addr); 21870919e23SUrsula Braun } 2194a71df50SFrank Blaschka list_del(&mc->list); 2204a71df50SFrank Blaschka kfree(mc); 2214a71df50SFrank Blaschka } 2224a71df50SFrank Blaschka spin_unlock_bh(&card->mclock); 2234a71df50SFrank Blaschka } 2244a71df50SFrank Blaschka 225ce73e10eSKlaus-Dieter Wacker static inline int qeth_l2_get_cast_type(struct qeth_card *card, 226ce73e10eSKlaus-Dieter Wacker struct sk_buff *skb) 2274a71df50SFrank Blaschka { 228ce73e10eSKlaus-Dieter Wacker if (card->info.type == QETH_CARD_TYPE_OSN) 229ce73e10eSKlaus-Dieter Wacker return RTN_UNSPEC; 230ce73e10eSKlaus-Dieter Wacker if (is_broadcast_ether_addr(skb->data)) 231ce73e10eSKlaus-Dieter Wacker return RTN_BROADCAST; 232ce73e10eSKlaus-Dieter Wacker if (is_multicast_ether_addr(skb->data)) 233ce73e10eSKlaus-Dieter Wacker return RTN_MULTICAST; 234ce73e10eSKlaus-Dieter Wacker return RTN_UNSPEC; 2354a71df50SFrank Blaschka } 2364a71df50SFrank Blaschka 2374a71df50SFrank Blaschka static void qeth_l2_fill_header(struct qeth_card *card, struct qeth_hdr *hdr, 2384a71df50SFrank Blaschka struct sk_buff *skb, int ipv, int cast_type) 2394a71df50SFrank Blaschka { 240683d718aSFrank Blaschka struct vlan_ethhdr *veth = (struct vlan_ethhdr *)skb_mac_header(skb); 2414a71df50SFrank Blaschka 2424a71df50SFrank Blaschka memset(hdr, 0, sizeof(struct qeth_hdr)); 2434a71df50SFrank Blaschka hdr->hdr.l2.id = QETH_HEADER_TYPE_LAYER2; 2444a71df50SFrank Blaschka 2454a71df50SFrank Blaschka /* set byte byte 3 to casting flags */ 2464a71df50SFrank Blaschka if (cast_type == RTN_MULTICAST) 2474a71df50SFrank Blaschka hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_MULTICAST; 2484a71df50SFrank Blaschka else if (cast_type == RTN_BROADCAST) 2494a71df50SFrank Blaschka hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_BROADCAST; 2504a71df50SFrank Blaschka else 251ce73e10eSKlaus-Dieter Wacker hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_UNICAST; 2524a71df50SFrank Blaschka 2534a71df50SFrank Blaschka hdr->hdr.l2.pkt_length = skb->len-QETH_HEADER_SIZE; 2544a71df50SFrank Blaschka /* VSWITCH relies on the VLAN 2554a71df50SFrank Blaschka * information to be present in 2564a71df50SFrank Blaschka * the QDIO header */ 2574a71df50SFrank Blaschka if (veth->h_vlan_proto == __constant_htons(ETH_P_8021Q)) { 2584a71df50SFrank Blaschka hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_VLAN; 2594a71df50SFrank Blaschka hdr->hdr.l2.vlan_id = ntohs(veth->h_vlan_TCI); 2604a71df50SFrank Blaschka } 2614a71df50SFrank Blaschka } 2624a71df50SFrank Blaschka 2634a71df50SFrank Blaschka static int qeth_l2_send_setdelvlan_cb(struct qeth_card *card, 2644a71df50SFrank Blaschka struct qeth_reply *reply, unsigned long data) 2654a71df50SFrank Blaschka { 2664a71df50SFrank Blaschka struct qeth_ipa_cmd *cmd; 2674a71df50SFrank Blaschka 268847a50fdSCarsten Otte QETH_CARD_TEXT(card, 2, "L2sdvcb"); 2694a71df50SFrank Blaschka cmd = (struct qeth_ipa_cmd *) data; 2704a71df50SFrank Blaschka if (cmd->hdr.return_code) { 27114cc21b6SFrank Blaschka QETH_DBF_MESSAGE(2, "Error in processing VLAN %i on %s: 0x%x. " 2724a71df50SFrank Blaschka "Continuing\n", cmd->data.setdelvlan.vlan_id, 2734a71df50SFrank Blaschka QETH_CARD_IFNAME(card), cmd->hdr.return_code); 274847a50fdSCarsten Otte QETH_CARD_TEXT_(card, 2, "L2VL%4x", cmd->hdr.command); 275847a50fdSCarsten Otte QETH_CARD_TEXT_(card, 2, "err%d", cmd->hdr.return_code); 2764a71df50SFrank Blaschka } 2774a71df50SFrank Blaschka return 0; 2784a71df50SFrank Blaschka } 2794a71df50SFrank Blaschka 2804a71df50SFrank Blaschka static int qeth_l2_send_setdelvlan(struct qeth_card *card, __u16 i, 2814a71df50SFrank Blaschka enum qeth_ipa_cmds ipacmd) 2824a71df50SFrank Blaschka { 2834a71df50SFrank Blaschka struct qeth_ipa_cmd *cmd; 2844a71df50SFrank Blaschka struct qeth_cmd_buffer *iob; 2854a71df50SFrank Blaschka 286847a50fdSCarsten Otte QETH_CARD_TEXT_(card, 4, "L2sdv%x", ipacmd); 2874a71df50SFrank Blaschka iob = qeth_get_ipacmd_buffer(card, ipacmd, QETH_PROT_IPV4); 2884a71df50SFrank Blaschka cmd = (struct qeth_ipa_cmd *)(iob->data+IPA_PDU_HEADER_SIZE); 2894a71df50SFrank Blaschka cmd->data.setdelvlan.vlan_id = i; 2904a71df50SFrank Blaschka return qeth_send_ipa_cmd(card, iob, 2914a71df50SFrank Blaschka qeth_l2_send_setdelvlan_cb, NULL); 2924a71df50SFrank Blaschka } 2934a71df50SFrank Blaschka 29470919e23SUrsula Braun static void qeth_l2_process_vlans(struct qeth_card *card) 2954a71df50SFrank Blaschka { 2964a71df50SFrank Blaschka struct qeth_vlan_vid *id; 297847a50fdSCarsten Otte QETH_CARD_TEXT(card, 3, "L2prcvln"); 2984a71df50SFrank Blaschka spin_lock_bh(&card->vlanlock); 2994a71df50SFrank Blaschka list_for_each_entry(id, &card->vid_list, list) { 30070919e23SUrsula Braun qeth_l2_send_setdelvlan(card, id->vid, IPA_CMD_SETVLAN); 3014a71df50SFrank Blaschka } 3024a71df50SFrank Blaschka spin_unlock_bh(&card->vlanlock); 3034a71df50SFrank Blaschka } 3044a71df50SFrank Blaschka 3058e586137SJiri Pirko static int qeth_l2_vlan_rx_add_vid(struct net_device *dev, unsigned short vid) 3064a71df50SFrank Blaschka { 307509e2562SHeiko Carstens struct qeth_card *card = dev->ml_priv; 3084a71df50SFrank Blaschka struct qeth_vlan_vid *id; 3094a71df50SFrank Blaschka 310847a50fdSCarsten Otte QETH_CARD_TEXT_(card, 4, "aid:%d", vid); 31110651db7SUrsula Braun if (!vid) 3128e586137SJiri Pirko return 0; 3135113fec0SUrsula Braun if (card->info.type == QETH_CARD_TYPE_OSM) { 314847a50fdSCarsten Otte QETH_CARD_TEXT(card, 3, "aidOSM"); 3158e586137SJiri Pirko return 0; 3165113fec0SUrsula Braun } 3178e98ac48SUrsula Braun if (qeth_wait_for_threads(card, QETH_RECOVER_THREAD)) { 318847a50fdSCarsten Otte QETH_CARD_TEXT(card, 3, "aidREC"); 3198e586137SJiri Pirko return 0; 3208e98ac48SUrsula Braun } 3214a71df50SFrank Blaschka id = kmalloc(sizeof(struct qeth_vlan_vid), GFP_ATOMIC); 3224a71df50SFrank Blaschka if (id) { 3234a71df50SFrank Blaschka id->vid = vid; 3244a71df50SFrank Blaschka qeth_l2_send_setdelvlan(card, vid, IPA_CMD_SETVLAN); 3254a71df50SFrank Blaschka spin_lock_bh(&card->vlanlock); 3264a71df50SFrank Blaschka list_add_tail(&id->list, &card->vid_list); 3274a71df50SFrank Blaschka spin_unlock_bh(&card->vlanlock); 3288e586137SJiri Pirko } else { 3298e586137SJiri Pirko return -ENOMEM; 3304a71df50SFrank Blaschka } 3318e586137SJiri Pirko return 0; 3324a71df50SFrank Blaschka } 3334a71df50SFrank Blaschka 3348e586137SJiri Pirko static int qeth_l2_vlan_rx_kill_vid(struct net_device *dev, unsigned short vid) 3354a71df50SFrank Blaschka { 3364a71df50SFrank Blaschka struct qeth_vlan_vid *id, *tmpid = NULL; 337509e2562SHeiko Carstens struct qeth_card *card = dev->ml_priv; 3384a71df50SFrank Blaschka 339847a50fdSCarsten Otte QETH_CARD_TEXT_(card, 4, "kid:%d", vid); 3405113fec0SUrsula Braun if (card->info.type == QETH_CARD_TYPE_OSM) { 341847a50fdSCarsten Otte QETH_CARD_TEXT(card, 3, "kidOSM"); 3428e586137SJiri Pirko return 0; 3435113fec0SUrsula Braun } 3448e98ac48SUrsula Braun if (qeth_wait_for_threads(card, QETH_RECOVER_THREAD)) { 345847a50fdSCarsten Otte QETH_CARD_TEXT(card, 3, "kidREC"); 3468e586137SJiri Pirko return 0; 3478e98ac48SUrsula Braun } 3484a71df50SFrank Blaschka spin_lock_bh(&card->vlanlock); 3494a71df50SFrank Blaschka list_for_each_entry(id, &card->vid_list, list) { 3504a71df50SFrank Blaschka if (id->vid == vid) { 3514a71df50SFrank Blaschka list_del(&id->list); 3524a71df50SFrank Blaschka tmpid = id; 3534a71df50SFrank Blaschka break; 3544a71df50SFrank Blaschka } 3554a71df50SFrank Blaschka } 3564a71df50SFrank Blaschka spin_unlock_bh(&card->vlanlock); 3574a71df50SFrank Blaschka if (tmpid) { 3584a71df50SFrank Blaschka qeth_l2_send_setdelvlan(card, vid, IPA_CMD_DELVLAN); 3594a71df50SFrank Blaschka kfree(tmpid); 3604a71df50SFrank Blaschka } 3614a71df50SFrank Blaschka qeth_l2_set_multicast_list(card->dev); 3628e586137SJiri Pirko return 0; 3634a71df50SFrank Blaschka } 3644a71df50SFrank Blaschka 3654a71df50SFrank Blaschka static int qeth_l2_stop_card(struct qeth_card *card, int recovery_mode) 3664a71df50SFrank Blaschka { 3674a71df50SFrank Blaschka int rc = 0; 3684a71df50SFrank Blaschka 369d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP , 2, "stopcard"); 370d11ba0c4SPeter Tiedemann QETH_DBF_HEX(SETUP, 2, &card, sizeof(void *)); 3714a71df50SFrank Blaschka 3724a71df50SFrank Blaschka qeth_set_allowed_threads(card, 0, 1); 3734a71df50SFrank Blaschka if (card->read.state == CH_STATE_UP && 3744a71df50SFrank Blaschka card->write.state == CH_STATE_UP && 3754a71df50SFrank Blaschka (card->state == CARD_STATE_UP)) { 3764a71df50SFrank Blaschka if (recovery_mode && 3774a71df50SFrank Blaschka card->info.type != QETH_CARD_TYPE_OSN) { 3784a71df50SFrank Blaschka qeth_l2_stop(card->dev); 3794a71df50SFrank Blaschka } else { 3804a71df50SFrank Blaschka rtnl_lock(); 3814a71df50SFrank Blaschka dev_close(card->dev); 3824a71df50SFrank Blaschka rtnl_unlock(); 3834a71df50SFrank Blaschka } 38470919e23SUrsula Braun card->info.mac_bits &= ~QETH_LAYER2_MAC_REGISTERED; 3854a71df50SFrank Blaschka card->state = CARD_STATE_SOFTSETUP; 3864a71df50SFrank Blaschka } 3874a71df50SFrank Blaschka if (card->state == CARD_STATE_SOFTSETUP) { 38870919e23SUrsula Braun qeth_l2_del_all_mc(card, 0); 3894a71df50SFrank Blaschka qeth_clear_ipacmd_list(card); 3904a71df50SFrank Blaschka card->state = CARD_STATE_HARDSETUP; 3914a71df50SFrank Blaschka } 3924a71df50SFrank Blaschka if (card->state == CARD_STATE_HARDSETUP) { 3934a71df50SFrank Blaschka qeth_qdio_clear_card(card, 0); 3944a71df50SFrank Blaschka qeth_clear_qdio_buffers(card); 3954a71df50SFrank Blaschka qeth_clear_working_pool_list(card); 3964a71df50SFrank Blaschka card->state = CARD_STATE_DOWN; 3974a71df50SFrank Blaschka } 3984a71df50SFrank Blaschka if (card->state == CARD_STATE_DOWN) { 3994a71df50SFrank Blaschka qeth_clear_cmd_buffers(&card->read); 4004a71df50SFrank Blaschka qeth_clear_cmd_buffers(&card->write); 4014a71df50SFrank Blaschka } 4024a71df50SFrank Blaschka return rc; 4034a71df50SFrank Blaschka } 4044a71df50SFrank Blaschka 405a1c3ed4cSFrank Blaschka static int qeth_l2_process_inbound_buffer(struct qeth_card *card, 406a1c3ed4cSFrank Blaschka int budget, int *done) 4074a71df50SFrank Blaschka { 408a1c3ed4cSFrank Blaschka int work_done = 0; 4094a71df50SFrank Blaschka struct sk_buff *skb; 4104a71df50SFrank Blaschka struct qeth_hdr *hdr; 4114a71df50SFrank Blaschka unsigned int len; 4124a71df50SFrank Blaschka 413a1c3ed4cSFrank Blaschka *done = 0; 41418af5c17SStefan Raspl WARN_ON_ONCE(!budget); 415a1c3ed4cSFrank Blaschka while (budget) { 416a1c3ed4cSFrank Blaschka skb = qeth_core_get_next_skb(card, 417b3332930SFrank Blaschka &card->qdio.in_q->bufs[card->rx.b_index], 418a1c3ed4cSFrank Blaschka &card->rx.b_element, &card->rx.e_offset, &hdr); 419a1c3ed4cSFrank Blaschka if (!skb) { 420a1c3ed4cSFrank Blaschka *done = 1; 421a1c3ed4cSFrank Blaschka break; 4224a71df50SFrank Blaschka } 423a1c3ed4cSFrank Blaschka skb->dev = card->dev; 4244a71df50SFrank Blaschka switch (hdr->hdr.l2.id) { 4254a71df50SFrank Blaschka case QETH_HEADER_TYPE_LAYER2: 4264a71df50SFrank Blaschka skb->pkt_type = PACKET_HOST; 4274a71df50SFrank Blaschka skb->protocol = eth_type_trans(skb, skb->dev); 4284a71df50SFrank Blaschka skb->ip_summed = CHECKSUM_NONE; 42912883725SUrsula Braun if (skb->protocol == htons(ETH_P_802_2)) 4304a71df50SFrank Blaschka *((__u32 *)skb->cb) = ++card->seqno.pkt_seqno; 4314a71df50SFrank Blaschka len = skb->len; 432a1c3ed4cSFrank Blaschka netif_receive_skb(skb); 4334a71df50SFrank Blaschka break; 4344a71df50SFrank Blaschka case QETH_HEADER_TYPE_OSN: 4352d488c2fSUrsula Braun if (card->info.type == QETH_CARD_TYPE_OSN) { 4364a71df50SFrank Blaschka skb_push(skb, sizeof(struct qeth_hdr)); 4374a71df50SFrank Blaschka skb_copy_to_linear_data(skb, hdr, 4384a71df50SFrank Blaschka sizeof(struct qeth_hdr)); 4394a71df50SFrank Blaschka len = skb->len; 4404a71df50SFrank Blaschka card->osn_info.data_cb(skb); 4414a71df50SFrank Blaschka break; 4422d488c2fSUrsula Braun } 4432d488c2fSUrsula Braun /* else unknown */ 4444a71df50SFrank Blaschka default: 4454a71df50SFrank Blaschka dev_kfree_skb_any(skb); 446847a50fdSCarsten Otte QETH_CARD_TEXT(card, 3, "inbunkno"); 447d11ba0c4SPeter Tiedemann QETH_DBF_HEX(CTRL, 3, hdr, QETH_DBF_CTRL_LEN); 4484a71df50SFrank Blaschka continue; 4494a71df50SFrank Blaschka } 450a1c3ed4cSFrank Blaschka work_done++; 451a1c3ed4cSFrank Blaschka budget--; 4524a71df50SFrank Blaschka card->stats.rx_packets++; 4534a71df50SFrank Blaschka card->stats.rx_bytes += len; 4544a71df50SFrank Blaschka } 455a1c3ed4cSFrank Blaschka return work_done; 456a1c3ed4cSFrank Blaschka } 457a1c3ed4cSFrank Blaschka 458a1c3ed4cSFrank Blaschka static int qeth_l2_poll(struct napi_struct *napi, int budget) 459a1c3ed4cSFrank Blaschka { 460a1c3ed4cSFrank Blaschka struct qeth_card *card = container_of(napi, struct qeth_card, napi); 461a1c3ed4cSFrank Blaschka int work_done = 0; 462a1c3ed4cSFrank Blaschka struct qeth_qdio_buffer *buffer; 463a1c3ed4cSFrank Blaschka int done; 464a1c3ed4cSFrank Blaschka int new_budget = budget; 465a1c3ed4cSFrank Blaschka 466a1c3ed4cSFrank Blaschka if (card->options.performance_stats) { 467a1c3ed4cSFrank Blaschka card->perf_stats.inbound_cnt++; 468a1c3ed4cSFrank Blaschka card->perf_stats.inbound_start_time = qeth_get_micros(); 469a1c3ed4cSFrank Blaschka } 470a1c3ed4cSFrank Blaschka 471a1c3ed4cSFrank Blaschka while (1) { 472a1c3ed4cSFrank Blaschka if (!card->rx.b_count) { 473a1c3ed4cSFrank Blaschka card->rx.qdio_err = 0; 474a1c3ed4cSFrank Blaschka card->rx.b_count = qdio_get_next_buffers( 475a1c3ed4cSFrank Blaschka card->data.ccwdev, 0, &card->rx.b_index, 476a1c3ed4cSFrank Blaschka &card->rx.qdio_err); 477a1c3ed4cSFrank Blaschka if (card->rx.b_count <= 0) { 478a1c3ed4cSFrank Blaschka card->rx.b_count = 0; 479a1c3ed4cSFrank Blaschka break; 480a1c3ed4cSFrank Blaschka } 481a1c3ed4cSFrank Blaschka card->rx.b_element = 482a1c3ed4cSFrank Blaschka &card->qdio.in_q->bufs[card->rx.b_index] 483a1c3ed4cSFrank Blaschka .buffer->element[0]; 484a1c3ed4cSFrank Blaschka card->rx.e_offset = 0; 485a1c3ed4cSFrank Blaschka } 486a1c3ed4cSFrank Blaschka 487a1c3ed4cSFrank Blaschka while (card->rx.b_count) { 488a1c3ed4cSFrank Blaschka buffer = &card->qdio.in_q->bufs[card->rx.b_index]; 489a1c3ed4cSFrank Blaschka if (!(card->rx.qdio_err && 490a1c3ed4cSFrank Blaschka qeth_check_qdio_errors(card, buffer->buffer, 491a1c3ed4cSFrank Blaschka card->rx.qdio_err, "qinerr"))) 492a1c3ed4cSFrank Blaschka work_done += qeth_l2_process_inbound_buffer( 493a1c3ed4cSFrank Blaschka card, new_budget, &done); 494a1c3ed4cSFrank Blaschka else 495a1c3ed4cSFrank Blaschka done = 1; 496a1c3ed4cSFrank Blaschka 497a1c3ed4cSFrank Blaschka if (done) { 498a1c3ed4cSFrank Blaschka if (card->options.performance_stats) 499a1c3ed4cSFrank Blaschka card->perf_stats.bufs_rec++; 500a1c3ed4cSFrank Blaschka qeth_put_buffer_pool_entry(card, 501a1c3ed4cSFrank Blaschka buffer->pool_entry); 502a1c3ed4cSFrank Blaschka qeth_queue_input_buffer(card, card->rx.b_index); 503a1c3ed4cSFrank Blaschka card->rx.b_count--; 504a1c3ed4cSFrank Blaschka if (card->rx.b_count) { 505a1c3ed4cSFrank Blaschka card->rx.b_index = 506a1c3ed4cSFrank Blaschka (card->rx.b_index + 1) % 507a1c3ed4cSFrank Blaschka QDIO_MAX_BUFFERS_PER_Q; 508a1c3ed4cSFrank Blaschka card->rx.b_element = 509a1c3ed4cSFrank Blaschka &card->qdio.in_q 510a1c3ed4cSFrank Blaschka ->bufs[card->rx.b_index] 511a1c3ed4cSFrank Blaschka .buffer->element[0]; 512a1c3ed4cSFrank Blaschka card->rx.e_offset = 0; 513a1c3ed4cSFrank Blaschka } 514a1c3ed4cSFrank Blaschka } 515a1c3ed4cSFrank Blaschka 516a1c3ed4cSFrank Blaschka if (work_done >= budget) 517a1c3ed4cSFrank Blaschka goto out; 518a1c3ed4cSFrank Blaschka else 519a1c3ed4cSFrank Blaschka new_budget = budget - work_done; 520a1c3ed4cSFrank Blaschka } 521a1c3ed4cSFrank Blaschka } 522a1c3ed4cSFrank Blaschka 523a1c3ed4cSFrank Blaschka napi_complete(napi); 524a1c3ed4cSFrank Blaschka if (qdio_start_irq(card->data.ccwdev, 0)) 525a1c3ed4cSFrank Blaschka napi_schedule(&card->napi); 526a1c3ed4cSFrank Blaschka out: 527a1c3ed4cSFrank Blaschka if (card->options.performance_stats) 528a1c3ed4cSFrank Blaschka card->perf_stats.inbound_time += qeth_get_micros() - 529a1c3ed4cSFrank Blaschka card->perf_stats.inbound_start_time; 530a1c3ed4cSFrank Blaschka return work_done; 5314a71df50SFrank Blaschka } 5324a71df50SFrank Blaschka 5334a71df50SFrank Blaschka static int qeth_l2_send_setdelmac(struct qeth_card *card, __u8 *mac, 5344a71df50SFrank Blaschka enum qeth_ipa_cmds ipacmd, 5354a71df50SFrank Blaschka int (*reply_cb) (struct qeth_card *, 5364a71df50SFrank Blaschka struct qeth_reply*, 5374a71df50SFrank Blaschka unsigned long)) 5384a71df50SFrank Blaschka { 5394a71df50SFrank Blaschka struct qeth_ipa_cmd *cmd; 5404a71df50SFrank Blaschka struct qeth_cmd_buffer *iob; 5414a71df50SFrank Blaschka 542847a50fdSCarsten Otte QETH_CARD_TEXT(card, 2, "L2sdmac"); 5434a71df50SFrank Blaschka iob = qeth_get_ipacmd_buffer(card, ipacmd, QETH_PROT_IPV4); 5444a71df50SFrank Blaschka cmd = (struct qeth_ipa_cmd *)(iob->data+IPA_PDU_HEADER_SIZE); 5454a71df50SFrank Blaschka cmd->data.setdelmac.mac_length = OSA_ADDR_LEN; 5464a71df50SFrank Blaschka memcpy(&cmd->data.setdelmac.mac, mac, OSA_ADDR_LEN); 5474a71df50SFrank Blaschka return qeth_send_ipa_cmd(card, iob, reply_cb, NULL); 5484a71df50SFrank Blaschka } 5494a71df50SFrank Blaschka 5504a71df50SFrank Blaschka static int qeth_l2_send_setmac_cb(struct qeth_card *card, 5514a71df50SFrank Blaschka struct qeth_reply *reply, 5524a71df50SFrank Blaschka unsigned long data) 5534a71df50SFrank Blaschka { 5544a71df50SFrank Blaschka struct qeth_ipa_cmd *cmd; 5554a71df50SFrank Blaschka 556847a50fdSCarsten Otte QETH_CARD_TEXT(card, 2, "L2Smaccb"); 5574a71df50SFrank Blaschka cmd = (struct qeth_ipa_cmd *) data; 5584a71df50SFrank Blaschka if (cmd->hdr.return_code) { 559847a50fdSCarsten Otte QETH_CARD_TEXT_(card, 2, "L2er%x", cmd->hdr.return_code); 5604a71df50SFrank Blaschka card->info.mac_bits &= ~QETH_LAYER2_MAC_REGISTERED; 5610666eb06SUrsula Braun switch (cmd->hdr.return_code) { 5620666eb06SUrsula Braun case IPA_RC_L2_DUP_MAC: 5630666eb06SUrsula Braun case IPA_RC_L2_DUP_LAYER3_MAC: 5640666eb06SUrsula Braun dev_warn(&card->gdev->dev, 565d998ab0bSH Hartley Sweeten "MAC address %pM already exists\n", 566221c17feSUrsula Braun cmd->data.setdelmac.mac); 5670666eb06SUrsula Braun break; 5680666eb06SUrsula Braun case IPA_RC_L2_MAC_NOT_AUTH_BY_HYP: 5690666eb06SUrsula Braun case IPA_RC_L2_MAC_NOT_AUTH_BY_ADP: 5700666eb06SUrsula Braun dev_warn(&card->gdev->dev, 571d998ab0bSH Hartley Sweeten "MAC address %pM is not authorized\n", 572221c17feSUrsula Braun cmd->data.setdelmac.mac); 5730666eb06SUrsula Braun break; 5740666eb06SUrsula Braun default: 5750666eb06SUrsula Braun break; 5760666eb06SUrsula Braun } 5774a71df50SFrank Blaschka } else { 5784a71df50SFrank Blaschka card->info.mac_bits |= QETH_LAYER2_MAC_REGISTERED; 5794a71df50SFrank Blaschka memcpy(card->dev->dev_addr, cmd->data.setdelmac.mac, 5804a71df50SFrank Blaschka OSA_ADDR_LEN); 58174eacdb9SFrank Blaschka dev_info(&card->gdev->dev, 582d998ab0bSH Hartley Sweeten "MAC address %pM successfully registered on device %s\n", 583d998ab0bSH Hartley Sweeten card->dev->dev_addr, card->dev->name); 5844a71df50SFrank Blaschka } 5854a71df50SFrank Blaschka return 0; 5864a71df50SFrank Blaschka } 5874a71df50SFrank Blaschka 5884a71df50SFrank Blaschka static int qeth_l2_send_setmac(struct qeth_card *card, __u8 *mac) 5894a71df50SFrank Blaschka { 590847a50fdSCarsten Otte QETH_CARD_TEXT(card, 2, "L2Setmac"); 5914a71df50SFrank Blaschka return qeth_l2_send_setdelmac(card, mac, IPA_CMD_SETVMAC, 5924a71df50SFrank Blaschka qeth_l2_send_setmac_cb); 5934a71df50SFrank Blaschka } 5944a71df50SFrank Blaschka 5954a71df50SFrank Blaschka static int qeth_l2_send_delmac_cb(struct qeth_card *card, 5964a71df50SFrank Blaschka struct qeth_reply *reply, 5974a71df50SFrank Blaschka unsigned long data) 5984a71df50SFrank Blaschka { 5994a71df50SFrank Blaschka struct qeth_ipa_cmd *cmd; 6004a71df50SFrank Blaschka 601847a50fdSCarsten Otte QETH_CARD_TEXT(card, 2, "L2Dmaccb"); 6024a71df50SFrank Blaschka cmd = (struct qeth_ipa_cmd *) data; 6034a71df50SFrank Blaschka if (cmd->hdr.return_code) { 604847a50fdSCarsten Otte QETH_CARD_TEXT_(card, 2, "err%d", cmd->hdr.return_code); 6054a71df50SFrank Blaschka return 0; 6064a71df50SFrank Blaschka } 6074a71df50SFrank Blaschka card->info.mac_bits &= ~QETH_LAYER2_MAC_REGISTERED; 6084a71df50SFrank Blaschka 6094a71df50SFrank Blaschka return 0; 6104a71df50SFrank Blaschka } 6114a71df50SFrank Blaschka 6124a71df50SFrank Blaschka static int qeth_l2_send_delmac(struct qeth_card *card, __u8 *mac) 6134a71df50SFrank Blaschka { 614847a50fdSCarsten Otte QETH_CARD_TEXT(card, 2, "L2Delmac"); 6154a71df50SFrank Blaschka if (!(card->info.mac_bits & QETH_LAYER2_MAC_REGISTERED)) 6164a71df50SFrank Blaschka return 0; 6174a71df50SFrank Blaschka return qeth_l2_send_setdelmac(card, mac, IPA_CMD_DELVMAC, 6184a71df50SFrank Blaschka qeth_l2_send_delmac_cb); 6194a71df50SFrank Blaschka } 6204a71df50SFrank Blaschka 6214a71df50SFrank Blaschka static int qeth_l2_request_initial_mac(struct qeth_card *card) 6224a71df50SFrank Blaschka { 6234a71df50SFrank Blaschka int rc = 0; 6244a71df50SFrank Blaschka char vendor_pre[] = {0x02, 0x00, 0x00}; 6254a71df50SFrank Blaschka 626d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "doL2init"); 627d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "doL2%s", CARD_BUS_ID(card)); 6284a71df50SFrank Blaschka 629a134884aSStefan Raspl if (qeth_is_supported(card, IPA_SETADAPTERPARMS)) { 6304a71df50SFrank Blaschka rc = qeth_query_setadapterparms(card); 6314a71df50SFrank Blaschka if (rc) { 632a134884aSStefan Raspl QETH_DBF_MESSAGE(2, "could not query adapter " 633a134884aSStefan Raspl "parameters on device %s: x%x\n", 634a134884aSStefan Raspl CARD_BUS_ID(card), rc); 635a134884aSStefan Raspl } 6364a71df50SFrank Blaschka } 6374a71df50SFrank Blaschka 6385113fec0SUrsula Braun if (card->info.type == QETH_CARD_TYPE_IQD || 6395113fec0SUrsula Braun card->info.type == QETH_CARD_TYPE_OSM || 6405113fec0SUrsula Braun card->info.type == QETH_CARD_TYPE_OSX || 6415113fec0SUrsula Braun card->info.guestlan) { 6424a71df50SFrank Blaschka rc = qeth_setadpparms_change_macaddr(card); 6434a71df50SFrank Blaschka if (rc) { 64414cc21b6SFrank Blaschka QETH_DBF_MESSAGE(2, "couldn't get MAC address on " 64514cc21b6SFrank Blaschka "device %s: x%x\n", CARD_BUS_ID(card), rc); 646d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "1err%d", rc); 6474a71df50SFrank Blaschka return rc; 6484a71df50SFrank Blaschka } 649d11ba0c4SPeter Tiedemann QETH_DBF_HEX(SETUP, 2, card->dev->dev_addr, OSA_ADDR_LEN); 6504a71df50SFrank Blaschka } else { 6511833611dSJoe Perches eth_random_addr(card->dev->dev_addr); 6524a71df50SFrank Blaschka memcpy(card->dev->dev_addr, vendor_pre, 3); 6534a71df50SFrank Blaschka } 6544a71df50SFrank Blaschka return 0; 6554a71df50SFrank Blaschka } 6564a71df50SFrank Blaschka 6574a71df50SFrank Blaschka static int qeth_l2_set_mac_address(struct net_device *dev, void *p) 6584a71df50SFrank Blaschka { 6594a71df50SFrank Blaschka struct sockaddr *addr = p; 660509e2562SHeiko Carstens struct qeth_card *card = dev->ml_priv; 6614a71df50SFrank Blaschka int rc = 0; 6624a71df50SFrank Blaschka 663847a50fdSCarsten Otte QETH_CARD_TEXT(card, 3, "setmac"); 6644a71df50SFrank Blaschka 6654a71df50SFrank Blaschka if (qeth_l2_verify_dev(dev) != QETH_REAL_CARD) { 666847a50fdSCarsten Otte QETH_CARD_TEXT(card, 3, "setmcINV"); 6674a71df50SFrank Blaschka return -EOPNOTSUPP; 6684a71df50SFrank Blaschka } 6694a71df50SFrank Blaschka 6705113fec0SUrsula Braun if (card->info.type == QETH_CARD_TYPE_OSN || 6715113fec0SUrsula Braun card->info.type == QETH_CARD_TYPE_OSM || 6725113fec0SUrsula Braun card->info.type == QETH_CARD_TYPE_OSX) { 673847a50fdSCarsten Otte QETH_CARD_TEXT(card, 3, "setmcTYP"); 6744a71df50SFrank Blaschka return -EOPNOTSUPP; 6754a71df50SFrank Blaschka } 676847a50fdSCarsten Otte QETH_CARD_HEX(card, 3, addr->sa_data, OSA_ADDR_LEN); 6778e98ac48SUrsula Braun if (qeth_wait_for_threads(card, QETH_RECOVER_THREAD)) { 678847a50fdSCarsten Otte QETH_CARD_TEXT(card, 3, "setmcREC"); 6798e98ac48SUrsula Braun return -ERESTARTSYS; 6808e98ac48SUrsula Braun } 6814a71df50SFrank Blaschka rc = qeth_l2_send_delmac(card, &card->dev->dev_addr[0]); 6827702745bSUrsula Braun if (!rc || (rc == IPA_RC_L2_MAC_NOT_FOUND)) 6834a71df50SFrank Blaschka rc = qeth_l2_send_setmac(card, addr->sa_data); 684e0a8114cSUrsula Braun return rc ? -EINVAL : 0; 6854a71df50SFrank Blaschka } 6864a71df50SFrank Blaschka 6874a71df50SFrank Blaschka static void qeth_l2_set_multicast_list(struct net_device *dev) 6884a71df50SFrank Blaschka { 689509e2562SHeiko Carstens struct qeth_card *card = dev->ml_priv; 690ccffad25SJiri Pirko struct netdev_hw_addr *ha; 6914a71df50SFrank Blaschka 6924a71df50SFrank Blaschka if (card->info.type == QETH_CARD_TYPE_OSN) 6934a71df50SFrank Blaschka return ; 6944a71df50SFrank Blaschka 695847a50fdSCarsten Otte QETH_CARD_TEXT(card, 3, "setmulti"); 6968e98ac48SUrsula Braun if (qeth_threads_running(card, QETH_RECOVER_THREAD) && 6978e98ac48SUrsula Braun (card->state != CARD_STATE_UP)) 6988e98ac48SUrsula Braun return; 69970919e23SUrsula Braun qeth_l2_del_all_mc(card, 1); 7004a71df50SFrank Blaschka spin_lock_bh(&card->mclock); 70122bedad3SJiri Pirko netdev_for_each_mc_addr(ha, dev) 70222bedad3SJiri Pirko qeth_l2_add_mc(card, ha->addr, 0); 7037db2266aSFrank Blaschka 70432e7bfc4SJiri Pirko netdev_for_each_uc_addr(ha, dev) 705ccffad25SJiri Pirko qeth_l2_add_mc(card, ha->addr, 1); 7067db2266aSFrank Blaschka 7074a71df50SFrank Blaschka spin_unlock_bh(&card->mclock); 7084a71df50SFrank Blaschka if (!qeth_adp_supported(card, IPA_SETADP_SET_PROMISC_MODE)) 7094a71df50SFrank Blaschka return; 7104a71df50SFrank Blaschka qeth_setadp_promisc_mode(card); 7114a71df50SFrank Blaschka } 7124a71df50SFrank Blaschka 7134a71df50SFrank Blaschka static int qeth_l2_hard_start_xmit(struct sk_buff *skb, struct net_device *dev) 7144a71df50SFrank Blaschka { 7154a71df50SFrank Blaschka int rc; 7164a71df50SFrank Blaschka struct qeth_hdr *hdr = NULL; 7174a71df50SFrank Blaschka int elements = 0; 718509e2562SHeiko Carstens struct qeth_card *card = dev->ml_priv; 7194a71df50SFrank Blaschka struct sk_buff *new_skb = skb; 7204a71df50SFrank Blaschka int ipv = qeth_get_ip_version(skb); 721ce73e10eSKlaus-Dieter Wacker int cast_type = qeth_l2_get_cast_type(card, skb); 7224a71df50SFrank Blaschka struct qeth_qdio_out_q *queue = card->qdio.out_qs 7234a71df50SFrank Blaschka [qeth_get_priority_queue(card, skb, ipv, cast_type)]; 7244a71df50SFrank Blaschka int tx_bytes = skb->len; 725683d718aSFrank Blaschka int data_offset = -1; 726683d718aSFrank Blaschka int elements_needed = 0; 727683d718aSFrank Blaschka int hd_len = 0; 7284a71df50SFrank Blaschka 7294a71df50SFrank Blaschka if ((card->state != CARD_STATE_UP) || !card->lan_online) { 7304a71df50SFrank Blaschka card->stats.tx_carrier_errors++; 7314a71df50SFrank Blaschka goto tx_drop; 7324a71df50SFrank Blaschka } 7334a71df50SFrank Blaschka 7344a71df50SFrank Blaschka if ((card->info.type == QETH_CARD_TYPE_OSN) && 7354a71df50SFrank Blaschka (skb->protocol == htons(ETH_P_IPV6))) 7364a71df50SFrank Blaschka goto tx_drop; 7374a71df50SFrank Blaschka 7384a71df50SFrank Blaschka if (card->options.performance_stats) { 7394a71df50SFrank Blaschka card->perf_stats.outbound_cnt++; 7404a71df50SFrank Blaschka card->perf_stats.outbound_start_time = qeth_get_micros(); 7414a71df50SFrank Blaschka } 7424a71df50SFrank Blaschka netif_stop_queue(dev); 7434a71df50SFrank Blaschka 7444a71df50SFrank Blaschka if (card->info.type == QETH_CARD_TYPE_OSN) 7454a71df50SFrank Blaschka hdr = (struct qeth_hdr *)skb->data; 7464a71df50SFrank Blaschka else { 74764ef8957SFrank Blaschka if (card->info.type == QETH_CARD_TYPE_IQD) { 748683d718aSFrank Blaschka new_skb = skb; 749683d718aSFrank Blaschka data_offset = ETH_HLEN; 750683d718aSFrank Blaschka hd_len = ETH_HLEN; 751683d718aSFrank Blaschka hdr = kmem_cache_alloc(qeth_core_header_cache, 752683d718aSFrank Blaschka GFP_ATOMIC); 753683d718aSFrank Blaschka if (!hdr) 754683d718aSFrank Blaschka goto tx_drop; 755683d718aSFrank Blaschka elements_needed++; 756683d718aSFrank Blaschka skb_reset_mac_header(new_skb); 757683d718aSFrank Blaschka qeth_l2_fill_header(card, hdr, new_skb, ipv, cast_type); 758683d718aSFrank Blaschka hdr->hdr.l2.pkt_length = new_skb->len; 759683d718aSFrank Blaschka memcpy(((char *)hdr) + sizeof(struct qeth_hdr), 760683d718aSFrank Blaschka skb_mac_header(new_skb), ETH_HLEN); 761683d718aSFrank Blaschka } else { 762f90b744eSFrank Blaschka /* create a clone with writeable headroom */ 763683d718aSFrank Blaschka new_skb = skb_realloc_headroom(skb, 764683d718aSFrank Blaschka sizeof(struct qeth_hdr)); 7654a71df50SFrank Blaschka if (!new_skb) 7664a71df50SFrank Blaschka goto tx_drop; 767f90b744eSFrank Blaschka hdr = (struct qeth_hdr *)skb_push(new_skb, 768f90b744eSFrank Blaschka sizeof(struct qeth_hdr)); 769683d718aSFrank Blaschka skb_set_mac_header(new_skb, sizeof(struct qeth_hdr)); 7704a71df50SFrank Blaschka qeth_l2_fill_header(card, hdr, new_skb, ipv, cast_type); 7714a71df50SFrank Blaschka } 772683d718aSFrank Blaschka } 7734a71df50SFrank Blaschka 774683d718aSFrank Blaschka elements = qeth_get_elements_no(card, (void *)hdr, new_skb, 775683d718aSFrank Blaschka elements_needed); 776683d718aSFrank Blaschka if (!elements) { 777683d718aSFrank Blaschka if (data_offset >= 0) 778683d718aSFrank Blaschka kmem_cache_free(qeth_core_header_cache, hdr); 7794a71df50SFrank Blaschka goto tx_drop; 7804a71df50SFrank Blaschka } 7814a71df50SFrank Blaschka 78251aa165cSFrank Blaschka if (card->info.type != QETH_CARD_TYPE_IQD) { 78351aa165cSFrank Blaschka if (qeth_hdr_chk_and_bounce(new_skb, 78451aa165cSFrank Blaschka sizeof(struct qeth_hdr_layer2))) 78551aa165cSFrank Blaschka goto tx_drop; 7864a71df50SFrank Blaschka rc = qeth_do_send_packet(card, queue, new_skb, hdr, 78764ef8957SFrank Blaschka elements); 78851aa165cSFrank Blaschka } else 7894a71df50SFrank Blaschka rc = qeth_do_send_packet_fast(card, queue, new_skb, hdr, 79064ef8957SFrank Blaschka elements, data_offset, hd_len); 7914a71df50SFrank Blaschka if (!rc) { 7924a71df50SFrank Blaschka card->stats.tx_packets++; 7934a71df50SFrank Blaschka card->stats.tx_bytes += tx_bytes; 7944a71df50SFrank Blaschka if (new_skb != skb) 7954a71df50SFrank Blaschka dev_kfree_skb_any(skb); 796ec634fe3SPatrick McHardy rc = NETDEV_TX_OK; 7974a71df50SFrank Blaschka } else { 798683d718aSFrank Blaschka if (data_offset >= 0) 799683d718aSFrank Blaschka kmem_cache_free(qeth_core_header_cache, hdr); 800683d718aSFrank Blaschka 8014a71df50SFrank Blaschka if (rc == -EBUSY) { 8024a71df50SFrank Blaschka if (new_skb != skb) 8034a71df50SFrank Blaschka dev_kfree_skb_any(new_skb); 8044a71df50SFrank Blaschka return NETDEV_TX_BUSY; 8054a71df50SFrank Blaschka } else 8064a71df50SFrank Blaschka goto tx_drop; 8074a71df50SFrank Blaschka } 8084a71df50SFrank Blaschka 8094a71df50SFrank Blaschka netif_wake_queue(dev); 8104a71df50SFrank Blaschka if (card->options.performance_stats) 8114a71df50SFrank Blaschka card->perf_stats.outbound_time += qeth_get_micros() - 8124a71df50SFrank Blaschka card->perf_stats.outbound_start_time; 8134a71df50SFrank Blaschka return rc; 8144a71df50SFrank Blaschka 8154a71df50SFrank Blaschka tx_drop: 8164a71df50SFrank Blaschka card->stats.tx_dropped++; 8174a71df50SFrank Blaschka card->stats.tx_errors++; 8184a71df50SFrank Blaschka if ((new_skb != skb) && new_skb) 8194a71df50SFrank Blaschka dev_kfree_skb_any(new_skb); 8204a71df50SFrank Blaschka dev_kfree_skb_any(skb); 821d0ec0f54SFrank Blaschka netif_wake_queue(dev); 8224a71df50SFrank Blaschka return NETDEV_TX_OK; 8234a71df50SFrank Blaschka } 8244a71df50SFrank Blaschka 82539423440SUrsula Braun static int __qeth_l2_open(struct net_device *dev) 8264a71df50SFrank Blaschka { 827509e2562SHeiko Carstens struct qeth_card *card = dev->ml_priv; 828a1c3ed4cSFrank Blaschka int rc = 0; 8294a71df50SFrank Blaschka 830847a50fdSCarsten Otte QETH_CARD_TEXT(card, 4, "qethopen"); 83139423440SUrsula Braun if (card->state == CARD_STATE_UP) 83239423440SUrsula Braun return rc; 8334a71df50SFrank Blaschka if (card->state != CARD_STATE_SOFTSETUP) 8344a71df50SFrank Blaschka return -ENODEV; 8354a71df50SFrank Blaschka 8364a71df50SFrank Blaschka if ((card->info.type != QETH_CARD_TYPE_OSN) && 8374a71df50SFrank Blaschka (!(card->info.mac_bits & QETH_LAYER2_MAC_REGISTERED))) { 838847a50fdSCarsten Otte QETH_CARD_TEXT(card, 4, "nomacadr"); 8394a71df50SFrank Blaschka return -EPERM; 8404a71df50SFrank Blaschka } 8414a71df50SFrank Blaschka card->data.state = CH_STATE_UP; 8424a71df50SFrank Blaschka card->state = CARD_STATE_UP; 8434a71df50SFrank Blaschka netif_start_queue(dev); 8444a71df50SFrank Blaschka 845a1c3ed4cSFrank Blaschka if (qdio_stop_irq(card->data.ccwdev, 0) >= 0) { 846a1c3ed4cSFrank Blaschka napi_enable(&card->napi); 847a1c3ed4cSFrank Blaschka napi_schedule(&card->napi); 848a1c3ed4cSFrank Blaschka } else 849a1c3ed4cSFrank Blaschka rc = -EIO; 850a1c3ed4cSFrank Blaschka return rc; 8514a71df50SFrank Blaschka } 8524a71df50SFrank Blaschka 85339423440SUrsula Braun static int qeth_l2_open(struct net_device *dev) 85439423440SUrsula Braun { 85539423440SUrsula Braun struct qeth_card *card = dev->ml_priv; 85639423440SUrsula Braun 85739423440SUrsula Braun QETH_CARD_TEXT(card, 5, "qethope_"); 85839423440SUrsula Braun if (qeth_wait_for_threads(card, QETH_RECOVER_THREAD)) { 85939423440SUrsula Braun QETH_CARD_TEXT(card, 3, "openREC"); 86039423440SUrsula Braun return -ERESTARTSYS; 86139423440SUrsula Braun } 86239423440SUrsula Braun return __qeth_l2_open(dev); 86339423440SUrsula Braun } 86439423440SUrsula Braun 8654a71df50SFrank Blaschka static int qeth_l2_stop(struct net_device *dev) 8664a71df50SFrank Blaschka { 867509e2562SHeiko Carstens struct qeth_card *card = dev->ml_priv; 8684a71df50SFrank Blaschka 869847a50fdSCarsten Otte QETH_CARD_TEXT(card, 4, "qethstop"); 8704a71df50SFrank Blaschka netif_tx_disable(dev); 871a1c3ed4cSFrank Blaschka if (card->state == CARD_STATE_UP) { 8724a71df50SFrank Blaschka card->state = CARD_STATE_SOFTSETUP; 873a1c3ed4cSFrank Blaschka napi_disable(&card->napi); 874a1c3ed4cSFrank Blaschka } 8754a71df50SFrank Blaschka return 0; 8764a71df50SFrank Blaschka } 8774a71df50SFrank Blaschka 8784a71df50SFrank Blaschka static int qeth_l2_probe_device(struct ccwgroup_device *gdev) 8794a71df50SFrank Blaschka { 8804a71df50SFrank Blaschka struct qeth_card *card = dev_get_drvdata(&gdev->dev); 8814a71df50SFrank Blaschka 8824a71df50SFrank Blaschka INIT_LIST_HEAD(&card->vid_list); 8834a71df50SFrank Blaschka INIT_LIST_HEAD(&card->mc_list); 8844a71df50SFrank Blaschka card->options.layer2 = 1; 8851da74b1cSFrank Blaschka card->info.hwtrap = 0; 8864a71df50SFrank Blaschka return 0; 8874a71df50SFrank Blaschka } 8884a71df50SFrank Blaschka 8894a71df50SFrank Blaschka static void qeth_l2_remove_device(struct ccwgroup_device *cgdev) 8904a71df50SFrank Blaschka { 8914a71df50SFrank Blaschka struct qeth_card *card = dev_get_drvdata(&cgdev->dev); 8924a71df50SFrank Blaschka 893f2148565SUrsula Braun qeth_set_allowed_threads(card, 0, 1); 8944a71df50SFrank Blaschka wait_event(card->wait_q, qeth_threads_running(card, 0xffffffff) == 0); 8954a71df50SFrank Blaschka 89670919e23SUrsula Braun if (cgdev->state == CCWGROUP_ONLINE) 8974a71df50SFrank Blaschka qeth_l2_set_offline(cgdev); 8984a71df50SFrank Blaschka 8994a71df50SFrank Blaschka if (card->dev) { 9004a71df50SFrank Blaschka unregister_netdev(card->dev); 9014a71df50SFrank Blaschka card->dev = NULL; 9024a71df50SFrank Blaschka } 9034a71df50SFrank Blaschka return; 9044a71df50SFrank Blaschka } 9054a71df50SFrank Blaschka 9060fc0b732SStephen Hemminger static const struct ethtool_ops qeth_l2_ethtool_ops = { 9074a71df50SFrank Blaschka .get_link = ethtool_op_get_link, 9084a71df50SFrank Blaschka .get_strings = qeth_core_get_strings, 9094a71df50SFrank Blaschka .get_ethtool_stats = qeth_core_get_ethtool_stats, 910df8b4ec8SBen Hutchings .get_sset_count = qeth_core_get_sset_count, 9114a71df50SFrank Blaschka .get_drvinfo = qeth_core_get_drvinfo, 9123f9975aaSFrank Blaschka .get_settings = qeth_core_ethtool_get_settings, 9134a71df50SFrank Blaschka }; 9144a71df50SFrank Blaschka 9150fc0b732SStephen Hemminger static const struct ethtool_ops qeth_l2_osn_ops = { 9164a71df50SFrank Blaschka .get_strings = qeth_core_get_strings, 9174a71df50SFrank Blaschka .get_ethtool_stats = qeth_core_get_ethtool_stats, 918df8b4ec8SBen Hutchings .get_sset_count = qeth_core_get_sset_count, 9194a71df50SFrank Blaschka .get_drvinfo = qeth_core_get_drvinfo, 9204a71df50SFrank Blaschka }; 9214a71df50SFrank Blaschka 9223d58cefdSFrank Blaschka static const struct net_device_ops qeth_l2_netdev_ops = { 9238403b13cSFrank Blaschka .ndo_open = qeth_l2_open, 9248403b13cSFrank Blaschka .ndo_stop = qeth_l2_stop, 9258403b13cSFrank Blaschka .ndo_get_stats = qeth_get_stats, 9268403b13cSFrank Blaschka .ndo_start_xmit = qeth_l2_hard_start_xmit, 9278403b13cSFrank Blaschka .ndo_validate_addr = eth_validate_addr, 928afc4b13dSJiri Pirko .ndo_set_rx_mode = qeth_l2_set_multicast_list, 9298403b13cSFrank Blaschka .ndo_do_ioctl = qeth_l2_do_ioctl, 9308403b13cSFrank Blaschka .ndo_set_mac_address = qeth_l2_set_mac_address, 9318403b13cSFrank Blaschka .ndo_change_mtu = qeth_change_mtu, 9328403b13cSFrank Blaschka .ndo_vlan_rx_add_vid = qeth_l2_vlan_rx_add_vid, 9338403b13cSFrank Blaschka .ndo_vlan_rx_kill_vid = qeth_l2_vlan_rx_kill_vid, 9348403b13cSFrank Blaschka .ndo_tx_timeout = qeth_tx_timeout, 9358403b13cSFrank Blaschka }; 9368403b13cSFrank Blaschka 9374a71df50SFrank Blaschka static int qeth_l2_setup_netdev(struct qeth_card *card) 9384a71df50SFrank Blaschka { 9394a71df50SFrank Blaschka switch (card->info.type) { 9404a71df50SFrank Blaschka case QETH_CARD_TYPE_IQD: 9414a71df50SFrank Blaschka card->dev = alloc_netdev(0, "hsi%d", ether_setup); 9424a71df50SFrank Blaschka break; 9434a71df50SFrank Blaschka case QETH_CARD_TYPE_OSN: 9444a71df50SFrank Blaschka card->dev = alloc_netdev(0, "osn%d", ether_setup); 9454a71df50SFrank Blaschka card->dev->flags |= IFF_NOARP; 9464a71df50SFrank Blaschka break; 9474a71df50SFrank Blaschka default: 9484a71df50SFrank Blaschka card->dev = alloc_etherdev(0); 9494a71df50SFrank Blaschka } 9504a71df50SFrank Blaschka 9514a71df50SFrank Blaschka if (!card->dev) 9524a71df50SFrank Blaschka return -ENODEV; 9534a71df50SFrank Blaschka 954509e2562SHeiko Carstens card->dev->ml_priv = card; 9554a71df50SFrank Blaschka card->dev->watchdog_timeo = QETH_TX_TIMEOUT; 9564a71df50SFrank Blaschka card->dev->mtu = card->info.initial_mtu; 9578403b13cSFrank Blaschka card->dev->netdev_ops = &qeth_l2_netdev_ops; 9584a71df50SFrank Blaschka if (card->info.type != QETH_CARD_TYPE_OSN) 9594a71df50SFrank Blaschka SET_ETHTOOL_OPS(card->dev, &qeth_l2_ethtool_ops); 9604a71df50SFrank Blaschka else 9614a71df50SFrank Blaschka SET_ETHTOOL_OPS(card->dev, &qeth_l2_osn_ops); 9624a71df50SFrank Blaschka card->dev->features |= NETIF_F_HW_VLAN_FILTER; 9634a71df50SFrank Blaschka card->info.broadcast_capable = 1; 9644a71df50SFrank Blaschka qeth_l2_request_initial_mac(card); 9654a71df50SFrank Blaschka SET_NETDEV_DEV(card->dev, &card->gdev->dev); 966a1c3ed4cSFrank Blaschka netif_napi_add(card->dev, &card->napi, qeth_l2_poll, QETH_NAPI_WEIGHT); 9674a71df50SFrank Blaschka return register_netdev(card->dev); 9684a71df50SFrank Blaschka } 9694a71df50SFrank Blaschka 9704a71df50SFrank Blaschka static int __qeth_l2_set_online(struct ccwgroup_device *gdev, int recovery_mode) 9714a71df50SFrank Blaschka { 9724a71df50SFrank Blaschka struct qeth_card *card = dev_get_drvdata(&gdev->dev); 9734a71df50SFrank Blaschka int rc = 0; 9744a71df50SFrank Blaschka enum qeth_card_states recover_flag; 9754a71df50SFrank Blaschka 9769dc48cccSUrsula Braun mutex_lock(&card->discipline_mutex); 977c4949f07SFrank Blaschka mutex_lock(&card->conf_mutex); 978d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "setonlin"); 979d11ba0c4SPeter Tiedemann QETH_DBF_HEX(SETUP, 2, &card, sizeof(void *)); 9804a71df50SFrank Blaschka 9814a71df50SFrank Blaschka recover_flag = card->state; 9824a71df50SFrank Blaschka rc = qeth_core_hardsetup_card(card); 9834a71df50SFrank Blaschka if (rc) { 984d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "2err%d", rc); 985aa909224SUrsula Braun rc = -ENODEV; 9864a71df50SFrank Blaschka goto out_remove; 9874a71df50SFrank Blaschka } 988395672e0SStefan Raspl qeth_trace_features(card); 9894a71df50SFrank Blaschka 990aa909224SUrsula Braun if (!card->dev && qeth_l2_setup_netdev(card)) { 991aa909224SUrsula Braun rc = -ENODEV; 9924a71df50SFrank Blaschka goto out_remove; 993aa909224SUrsula Braun } 9944a71df50SFrank Blaschka 9954a71df50SFrank Blaschka if (card->info.type != QETH_CARD_TYPE_OSN) 9964a71df50SFrank Blaschka qeth_l2_send_setmac(card, &card->dev->dev_addr[0]); 9974a71df50SFrank Blaschka 9981da74b1cSFrank Blaschka if (qeth_is_diagass_supported(card, QETH_DIAGS_CMD_TRAP)) { 9991da74b1cSFrank Blaschka if (card->info.hwtrap && 10001da74b1cSFrank Blaschka qeth_hw_trap(card, QETH_DIAGS_TRAP_ARM)) 10011da74b1cSFrank Blaschka card->info.hwtrap = 0; 10021da74b1cSFrank Blaschka } else 10031da74b1cSFrank Blaschka card->info.hwtrap = 0; 10041da74b1cSFrank Blaschka 10054a71df50SFrank Blaschka card->state = CARD_STATE_HARDSETUP; 1006a1c3ed4cSFrank Blaschka memset(&card->rx, 0, sizeof(struct qeth_rx)); 10074a71df50SFrank Blaschka qeth_print_status_message(card); 10084a71df50SFrank Blaschka 10094a71df50SFrank Blaschka /* softsetup */ 1010d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "softsetp"); 10114a71df50SFrank Blaschka 10124a71df50SFrank Blaschka rc = qeth_send_startlan(card); 10134a71df50SFrank Blaschka if (rc) { 1014d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "1err%d", rc); 10154a71df50SFrank Blaschka if (rc == 0xe080) { 101674eacdb9SFrank Blaschka dev_warn(&card->gdev->dev, 101774eacdb9SFrank Blaschka "The LAN is offline\n"); 10184a71df50SFrank Blaschka card->lan_online = 0; 10192b6203bbSUrsula Braun goto contin; 10204a71df50SFrank Blaschka } 1021aa909224SUrsula Braun rc = -ENODEV; 1022f2148565SUrsula Braun goto out_remove; 10234a71df50SFrank Blaschka } else 10244a71df50SFrank Blaschka card->lan_online = 1; 10254a71df50SFrank Blaschka 10262b6203bbSUrsula Braun contin: 10275113fec0SUrsula Braun if ((card->info.type == QETH_CARD_TYPE_OSD) || 10280f54761dSStefan Raspl (card->info.type == QETH_CARD_TYPE_OSX)) { 1029d64ecc22SEinar Lueck /* configure isolation level */ 10300f54761dSStefan Raspl rc = qeth_set_access_ctrl_online(card, 0); 10310f54761dSStefan Raspl if (rc) { 10320f54761dSStefan Raspl rc = -ENODEV; 10330f54761dSStefan Raspl goto out_remove; 10340f54761dSStefan Raspl } 10350f54761dSStefan Raspl } 10365113fec0SUrsula Braun 10375113fec0SUrsula Braun if (card->info.type != QETH_CARD_TYPE_OSN && 10385113fec0SUrsula Braun card->info.type != QETH_CARD_TYPE_OSM) 103970919e23SUrsula Braun qeth_l2_process_vlans(card); 10404a71df50SFrank Blaschka 10414a71df50SFrank Blaschka netif_tx_disable(card->dev); 10424a71df50SFrank Blaschka 10434a71df50SFrank Blaschka rc = qeth_init_qdio_queues(card); 10444a71df50SFrank Blaschka if (rc) { 1045d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "6err%d", rc); 1046aa909224SUrsula Braun rc = -ENODEV; 10474a71df50SFrank Blaschka goto out_remove; 10484a71df50SFrank Blaschka } 10494a71df50SFrank Blaschka card->state = CARD_STATE_SOFTSETUP; 10502b6203bbSUrsula Braun if (card->lan_online) 10514a71df50SFrank Blaschka netif_carrier_on(card->dev); 10522b6203bbSUrsula Braun else 10532b6203bbSUrsula Braun netif_carrier_off(card->dev); 10544a71df50SFrank Blaschka 10554a71df50SFrank Blaschka qeth_set_allowed_threads(card, 0xffffffff, 0); 10564a71df50SFrank Blaschka if (recover_flag == CARD_STATE_RECOVER) { 10574a71df50SFrank Blaschka if (recovery_mode && 10584a71df50SFrank Blaschka card->info.type != QETH_CARD_TYPE_OSN) { 105939423440SUrsula Braun __qeth_l2_open(card->dev); 10604a71df50SFrank Blaschka } else { 10614a71df50SFrank Blaschka rtnl_lock(); 10624a71df50SFrank Blaschka dev_open(card->dev); 10634a71df50SFrank Blaschka rtnl_unlock(); 10644a71df50SFrank Blaschka } 10654a71df50SFrank Blaschka /* this also sets saved unicast addresses */ 10664a71df50SFrank Blaschka qeth_l2_set_multicast_list(card->dev); 10674a71df50SFrank Blaschka } 10684a71df50SFrank Blaschka /* let user_space know that device is online */ 10694a71df50SFrank Blaschka kobject_uevent(&gdev->dev.kobj, KOBJ_CHANGE); 1070c4949f07SFrank Blaschka mutex_unlock(&card->conf_mutex); 10719dc48cccSUrsula Braun mutex_unlock(&card->discipline_mutex); 10724a71df50SFrank Blaschka return 0; 1073aa909224SUrsula Braun 10744a71df50SFrank Blaschka out_remove: 10754a71df50SFrank Blaschka qeth_l2_stop_card(card, 0); 10764a71df50SFrank Blaschka ccw_device_set_offline(CARD_DDEV(card)); 10774a71df50SFrank Blaschka ccw_device_set_offline(CARD_WDEV(card)); 10784a71df50SFrank Blaschka ccw_device_set_offline(CARD_RDEV(card)); 10794a71df50SFrank Blaschka if (recover_flag == CARD_STATE_RECOVER) 10804a71df50SFrank Blaschka card->state = CARD_STATE_RECOVER; 10814a71df50SFrank Blaschka else 10824a71df50SFrank Blaschka card->state = CARD_STATE_DOWN; 1083c4949f07SFrank Blaschka mutex_unlock(&card->conf_mutex); 10849dc48cccSUrsula Braun mutex_unlock(&card->discipline_mutex); 1085aa909224SUrsula Braun return rc; 10864a71df50SFrank Blaschka } 10874a71df50SFrank Blaschka 10884a71df50SFrank Blaschka static int qeth_l2_set_online(struct ccwgroup_device *gdev) 10894a71df50SFrank Blaschka { 10904a71df50SFrank Blaschka return __qeth_l2_set_online(gdev, 0); 10914a71df50SFrank Blaschka } 10924a71df50SFrank Blaschka 10934a71df50SFrank Blaschka static int __qeth_l2_set_offline(struct ccwgroup_device *cgdev, 10944a71df50SFrank Blaschka int recovery_mode) 10954a71df50SFrank Blaschka { 10964a71df50SFrank Blaschka struct qeth_card *card = dev_get_drvdata(&cgdev->dev); 10974a71df50SFrank Blaschka int rc = 0, rc2 = 0, rc3 = 0; 10984a71df50SFrank Blaschka enum qeth_card_states recover_flag; 10994a71df50SFrank Blaschka 11009dc48cccSUrsula Braun mutex_lock(&card->discipline_mutex); 1101c4949f07SFrank Blaschka mutex_lock(&card->conf_mutex); 1102d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 3, "setoffl"); 1103d11ba0c4SPeter Tiedemann QETH_DBF_HEX(SETUP, 3, &card, sizeof(void *)); 11044a71df50SFrank Blaschka 11054a71df50SFrank Blaschka if (card->dev && netif_carrier_ok(card->dev)) 11064a71df50SFrank Blaschka netif_carrier_off(card->dev); 11074a71df50SFrank Blaschka recover_flag = card->state; 11081da74b1cSFrank Blaschka if ((!recovery_mode && card->info.hwtrap) || card->info.hwtrap == 2) { 11091da74b1cSFrank Blaschka qeth_hw_trap(card, QETH_DIAGS_TRAP_DISARM); 11101da74b1cSFrank Blaschka card->info.hwtrap = 1; 11111da74b1cSFrank Blaschka } 11120f5623c9SUrsula Braun qeth_l2_stop_card(card, recovery_mode); 11134a71df50SFrank Blaschka rc = ccw_device_set_offline(CARD_DDEV(card)); 11144a71df50SFrank Blaschka rc2 = ccw_device_set_offline(CARD_WDEV(card)); 11154a71df50SFrank Blaschka rc3 = ccw_device_set_offline(CARD_RDEV(card)); 11164a71df50SFrank Blaschka if (!rc) 11174a71df50SFrank Blaschka rc = (rc2) ? rc2 : rc3; 11184a71df50SFrank Blaschka if (rc) 1119d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "1err%d", rc); 11204a71df50SFrank Blaschka if (recover_flag == CARD_STATE_UP) 11214a71df50SFrank Blaschka card->state = CARD_STATE_RECOVER; 11224a71df50SFrank Blaschka /* let user_space know that device is offline */ 11234a71df50SFrank Blaschka kobject_uevent(&cgdev->dev.kobj, KOBJ_CHANGE); 1124c4949f07SFrank Blaschka mutex_unlock(&card->conf_mutex); 11259dc48cccSUrsula Braun mutex_unlock(&card->discipline_mutex); 11264a71df50SFrank Blaschka return 0; 11274a71df50SFrank Blaschka } 11284a71df50SFrank Blaschka 11294a71df50SFrank Blaschka static int qeth_l2_set_offline(struct ccwgroup_device *cgdev) 11304a71df50SFrank Blaschka { 11314a71df50SFrank Blaschka return __qeth_l2_set_offline(cgdev, 0); 11324a71df50SFrank Blaschka } 11334a71df50SFrank Blaschka 11344a71df50SFrank Blaschka static int qeth_l2_recover(void *ptr) 11354a71df50SFrank Blaschka { 11364a71df50SFrank Blaschka struct qeth_card *card; 11374a71df50SFrank Blaschka int rc = 0; 11384a71df50SFrank Blaschka 11394a71df50SFrank Blaschka card = (struct qeth_card *) ptr; 1140847a50fdSCarsten Otte QETH_CARD_TEXT(card, 2, "recover1"); 11414a71df50SFrank Blaschka if (!qeth_do_run_thread(card, QETH_RECOVER_THREAD)) 11424a71df50SFrank Blaschka return 0; 1143847a50fdSCarsten Otte QETH_CARD_TEXT(card, 2, "recover2"); 114474eacdb9SFrank Blaschka dev_warn(&card->gdev->dev, 114574eacdb9SFrank Blaschka "A recovery process has been started for the device\n"); 114665d8013cSStefan Raspl qeth_set_recovery_task(card); 11474a71df50SFrank Blaschka __qeth_l2_set_offline(card->gdev, 1); 11484a71df50SFrank Blaschka rc = __qeth_l2_set_online(card->gdev, 1); 11494a71df50SFrank Blaschka if (!rc) 115074eacdb9SFrank Blaschka dev_info(&card->gdev->dev, 115174eacdb9SFrank Blaschka "Device successfully recovered!\n"); 115228a7e4c9SUrsula Braun else { 11530f54761dSStefan Raspl qeth_close_dev(card); 115474eacdb9SFrank Blaschka dev_warn(&card->gdev->dev, "The qeth device driver " 115574eacdb9SFrank Blaschka "failed to recover an error on the device\n"); 115628a7e4c9SUrsula Braun } 115765d8013cSStefan Raspl qeth_clear_recovery_task(card); 1158a1c3ed4cSFrank Blaschka qeth_clear_thread_start_bit(card, QETH_RECOVER_THREAD); 1159a1c3ed4cSFrank Blaschka qeth_clear_thread_running_bit(card, QETH_RECOVER_THREAD); 11604a71df50SFrank Blaschka return 0; 11614a71df50SFrank Blaschka } 11624a71df50SFrank Blaschka 11634a71df50SFrank Blaschka static int __init qeth_l2_init(void) 11644a71df50SFrank Blaschka { 116574eacdb9SFrank Blaschka pr_info("register layer 2 discipline\n"); 11664a71df50SFrank Blaschka return 0; 11674a71df50SFrank Blaschka } 11684a71df50SFrank Blaschka 11694a71df50SFrank Blaschka static void __exit qeth_l2_exit(void) 11704a71df50SFrank Blaschka { 117174eacdb9SFrank Blaschka pr_info("unregister layer 2 discipline\n"); 11724a71df50SFrank Blaschka } 11734a71df50SFrank Blaschka 11744a71df50SFrank Blaschka static void qeth_l2_shutdown(struct ccwgroup_device *gdev) 11754a71df50SFrank Blaschka { 11764a71df50SFrank Blaschka struct qeth_card *card = dev_get_drvdata(&gdev->dev); 1177f78ac2bbSUrsula Braun qeth_set_allowed_threads(card, 0, 1); 11781da74b1cSFrank Blaschka if ((gdev->state == CCWGROUP_ONLINE) && card->info.hwtrap) 11791da74b1cSFrank Blaschka qeth_hw_trap(card, QETH_DIAGS_TRAP_DISARM); 11804a71df50SFrank Blaschka qeth_qdio_clear_card(card, 0); 11814a71df50SFrank Blaschka qeth_clear_qdio_buffers(card); 11824a71df50SFrank Blaschka } 11834a71df50SFrank Blaschka 1184bbcfcdc8SFrank Blaschka static int qeth_l2_pm_suspend(struct ccwgroup_device *gdev) 1185bbcfcdc8SFrank Blaschka { 1186bbcfcdc8SFrank Blaschka struct qeth_card *card = dev_get_drvdata(&gdev->dev); 1187bbcfcdc8SFrank Blaschka 1188bbcfcdc8SFrank Blaschka if (card->dev) 1189bbcfcdc8SFrank Blaschka netif_device_detach(card->dev); 1190bbcfcdc8SFrank Blaschka qeth_set_allowed_threads(card, 0, 1); 1191bbcfcdc8SFrank Blaschka wait_event(card->wait_q, qeth_threads_running(card, 0xffffffff) == 0); 1192bbcfcdc8SFrank Blaschka if (gdev->state == CCWGROUP_OFFLINE) 1193bbcfcdc8SFrank Blaschka return 0; 1194bbcfcdc8SFrank Blaschka if (card->state == CARD_STATE_UP) { 11951da74b1cSFrank Blaschka if (card->info.hwtrap) 11961da74b1cSFrank Blaschka qeth_hw_trap(card, QETH_DIAGS_TRAP_DISARM); 1197bbcfcdc8SFrank Blaschka __qeth_l2_set_offline(card->gdev, 1); 1198bbcfcdc8SFrank Blaschka } else 1199bbcfcdc8SFrank Blaschka __qeth_l2_set_offline(card->gdev, 0); 1200bbcfcdc8SFrank Blaschka return 0; 1201bbcfcdc8SFrank Blaschka } 1202bbcfcdc8SFrank Blaschka 1203bbcfcdc8SFrank Blaschka static int qeth_l2_pm_resume(struct ccwgroup_device *gdev) 1204bbcfcdc8SFrank Blaschka { 1205bbcfcdc8SFrank Blaschka struct qeth_card *card = dev_get_drvdata(&gdev->dev); 1206bbcfcdc8SFrank Blaschka int rc = 0; 1207bbcfcdc8SFrank Blaschka 1208bbcfcdc8SFrank Blaschka if (gdev->state == CCWGROUP_OFFLINE) 1209bbcfcdc8SFrank Blaschka goto out; 1210bbcfcdc8SFrank Blaschka 1211bbcfcdc8SFrank Blaschka if (card->state == CARD_STATE_RECOVER) { 1212bbcfcdc8SFrank Blaschka rc = __qeth_l2_set_online(card->gdev, 1); 1213bbcfcdc8SFrank Blaschka if (rc) { 1214bbcfcdc8SFrank Blaschka rtnl_lock(); 1215bbcfcdc8SFrank Blaschka dev_close(card->dev); 1216bbcfcdc8SFrank Blaschka rtnl_unlock(); 1217bbcfcdc8SFrank Blaschka } 1218bbcfcdc8SFrank Blaschka } else 1219bbcfcdc8SFrank Blaschka rc = __qeth_l2_set_online(card->gdev, 0); 1220bbcfcdc8SFrank Blaschka out: 1221bbcfcdc8SFrank Blaschka qeth_set_allowed_threads(card, 0xffffffff, 0); 1222bbcfcdc8SFrank Blaschka if (card->dev) 1223bbcfcdc8SFrank Blaschka netif_device_attach(card->dev); 1224bbcfcdc8SFrank Blaschka if (rc) 1225bbcfcdc8SFrank Blaschka dev_warn(&card->gdev->dev, "The qeth device driver " 1226bbcfcdc8SFrank Blaschka "failed to recover an error on the device\n"); 1227bbcfcdc8SFrank Blaschka return rc; 1228bbcfcdc8SFrank Blaschka } 1229bbcfcdc8SFrank Blaschka 1230c041f2d4SSebastian Ott struct qeth_discipline qeth_l2_discipline = { 1231c041f2d4SSebastian Ott .start_poll = qeth_qdio_start_poll, 1232c041f2d4SSebastian Ott .input_handler = (qdio_handler_t *) qeth_qdio_input_handler, 1233c041f2d4SSebastian Ott .output_handler = (qdio_handler_t *) qeth_qdio_output_handler, 1234c041f2d4SSebastian Ott .recover = qeth_l2_recover, 1235c041f2d4SSebastian Ott .setup = qeth_l2_probe_device, 12364a71df50SFrank Blaschka .remove = qeth_l2_remove_device, 12374a71df50SFrank Blaschka .set_online = qeth_l2_set_online, 12384a71df50SFrank Blaschka .set_offline = qeth_l2_set_offline, 12394a71df50SFrank Blaschka .shutdown = qeth_l2_shutdown, 1240bbcfcdc8SFrank Blaschka .freeze = qeth_l2_pm_suspend, 1241bbcfcdc8SFrank Blaschka .thaw = qeth_l2_pm_resume, 1242bbcfcdc8SFrank Blaschka .restore = qeth_l2_pm_resume, 12434a71df50SFrank Blaschka }; 1244c041f2d4SSebastian Ott EXPORT_SYMBOL_GPL(qeth_l2_discipline); 12454a71df50SFrank Blaschka 12464a71df50SFrank Blaschka static int qeth_osn_send_control_data(struct qeth_card *card, int len, 12474a71df50SFrank Blaschka struct qeth_cmd_buffer *iob) 12484a71df50SFrank Blaschka { 12494a71df50SFrank Blaschka unsigned long flags; 12504a71df50SFrank Blaschka int rc = 0; 12514a71df50SFrank Blaschka 1252847a50fdSCarsten Otte QETH_CARD_TEXT(card, 5, "osndctrd"); 12534a71df50SFrank Blaschka 12544a71df50SFrank Blaschka wait_event(card->wait_q, 12554a71df50SFrank Blaschka atomic_cmpxchg(&card->write.irq_pending, 0, 1) == 0); 12564a71df50SFrank Blaschka qeth_prepare_control_data(card, len, iob); 1257847a50fdSCarsten Otte QETH_CARD_TEXT(card, 6, "osnoirqp"); 12584a71df50SFrank Blaschka spin_lock_irqsave(get_ccwdev_lock(card->write.ccwdev), flags); 12594a71df50SFrank Blaschka rc = ccw_device_start(card->write.ccwdev, &card->write.ccw, 12604a71df50SFrank Blaschka (addr_t) iob, 0, 0); 12614a71df50SFrank Blaschka spin_unlock_irqrestore(get_ccwdev_lock(card->write.ccwdev), flags); 12624a71df50SFrank Blaschka if (rc) { 126314cc21b6SFrank Blaschka QETH_DBF_MESSAGE(2, "qeth_osn_send_control_data: " 12644a71df50SFrank Blaschka "ccw_device_start rc = %i\n", rc); 1265847a50fdSCarsten Otte QETH_CARD_TEXT_(card, 2, " err%d", rc); 12664a71df50SFrank Blaschka qeth_release_buffer(iob->channel, iob); 12674a71df50SFrank Blaschka atomic_set(&card->write.irq_pending, 0); 12684a71df50SFrank Blaschka wake_up(&card->wait_q); 12694a71df50SFrank Blaschka } 12704a71df50SFrank Blaschka return rc; 12714a71df50SFrank Blaschka } 12724a71df50SFrank Blaschka 12734a71df50SFrank Blaschka static int qeth_osn_send_ipa_cmd(struct qeth_card *card, 12744a71df50SFrank Blaschka struct qeth_cmd_buffer *iob, int data_len) 12754a71df50SFrank Blaschka { 12764a71df50SFrank Blaschka u16 s1, s2; 12774a71df50SFrank Blaschka 1278847a50fdSCarsten Otte QETH_CARD_TEXT(card, 4, "osndipa"); 12794a71df50SFrank Blaschka 12804a71df50SFrank Blaschka qeth_prepare_ipa_cmd(card, iob, QETH_PROT_OSN2); 12814a71df50SFrank Blaschka s1 = (u16)(IPA_PDU_HEADER_SIZE + data_len); 12824a71df50SFrank Blaschka s2 = (u16)data_len; 12834a71df50SFrank Blaschka memcpy(QETH_IPA_PDU_LEN_TOTAL(iob->data), &s1, 2); 12844a71df50SFrank Blaschka memcpy(QETH_IPA_PDU_LEN_PDU1(iob->data), &s2, 2); 12854a71df50SFrank Blaschka memcpy(QETH_IPA_PDU_LEN_PDU2(iob->data), &s2, 2); 12864a71df50SFrank Blaschka memcpy(QETH_IPA_PDU_LEN_PDU3(iob->data), &s2, 2); 12874a71df50SFrank Blaschka return qeth_osn_send_control_data(card, s1, iob); 12884a71df50SFrank Blaschka } 12894a71df50SFrank Blaschka 12904a71df50SFrank Blaschka int qeth_osn_assist(struct net_device *dev, void *data, int data_len) 12914a71df50SFrank Blaschka { 12924a71df50SFrank Blaschka struct qeth_cmd_buffer *iob; 12934a71df50SFrank Blaschka struct qeth_card *card; 12944a71df50SFrank Blaschka int rc; 12954a71df50SFrank Blaschka 12964a71df50SFrank Blaschka if (!dev) 12974a71df50SFrank Blaschka return -ENODEV; 1298509e2562SHeiko Carstens card = dev->ml_priv; 12994a71df50SFrank Blaschka if (!card) 13004a71df50SFrank Blaschka return -ENODEV; 1301847a50fdSCarsten Otte QETH_CARD_TEXT(card, 2, "osnsdmc"); 13024a71df50SFrank Blaschka if ((card->state != CARD_STATE_UP) && 13034a71df50SFrank Blaschka (card->state != CARD_STATE_SOFTSETUP)) 13044a71df50SFrank Blaschka return -ENODEV; 13054a71df50SFrank Blaschka iob = qeth_wait_for_buffer(&card->write); 13064a71df50SFrank Blaschka memcpy(iob->data+IPA_PDU_HEADER_SIZE, data, data_len); 13074a71df50SFrank Blaschka rc = qeth_osn_send_ipa_cmd(card, iob, data_len); 13084a71df50SFrank Blaschka return rc; 13094a71df50SFrank Blaschka } 13104a71df50SFrank Blaschka EXPORT_SYMBOL(qeth_osn_assist); 13114a71df50SFrank Blaschka 13124a71df50SFrank Blaschka int qeth_osn_register(unsigned char *read_dev_no, struct net_device **dev, 13134a71df50SFrank Blaschka int (*assist_cb)(struct net_device *, void *), 13144a71df50SFrank Blaschka int (*data_cb)(struct sk_buff *)) 13154a71df50SFrank Blaschka { 13164a71df50SFrank Blaschka struct qeth_card *card; 13174a71df50SFrank Blaschka 13184a71df50SFrank Blaschka *dev = qeth_l2_netdev_by_devno(read_dev_no); 13194a71df50SFrank Blaschka if (*dev == NULL) 13204a71df50SFrank Blaschka return -ENODEV; 1321509e2562SHeiko Carstens card = (*dev)->ml_priv; 13224a71df50SFrank Blaschka if (!card) 13234a71df50SFrank Blaschka return -ENODEV; 1324847a50fdSCarsten Otte QETH_CARD_TEXT(card, 2, "osnreg"); 13254a71df50SFrank Blaschka if ((assist_cb == NULL) || (data_cb == NULL)) 13264a71df50SFrank Blaschka return -EINVAL; 13274a71df50SFrank Blaschka card->osn_info.assist_cb = assist_cb; 13284a71df50SFrank Blaschka card->osn_info.data_cb = data_cb; 13294a71df50SFrank Blaschka return 0; 13304a71df50SFrank Blaschka } 13314a71df50SFrank Blaschka EXPORT_SYMBOL(qeth_osn_register); 13324a71df50SFrank Blaschka 13334a71df50SFrank Blaschka void qeth_osn_deregister(struct net_device *dev) 13344a71df50SFrank Blaschka { 13354a71df50SFrank Blaschka struct qeth_card *card; 13364a71df50SFrank Blaschka 13374a71df50SFrank Blaschka if (!dev) 13384a71df50SFrank Blaschka return; 1339509e2562SHeiko Carstens card = dev->ml_priv; 13404a71df50SFrank Blaschka if (!card) 13414a71df50SFrank Blaschka return; 1342847a50fdSCarsten Otte QETH_CARD_TEXT(card, 2, "osndereg"); 13434a71df50SFrank Blaschka card->osn_info.assist_cb = NULL; 13444a71df50SFrank Blaschka card->osn_info.data_cb = NULL; 13454a71df50SFrank Blaschka return; 13464a71df50SFrank Blaschka } 13474a71df50SFrank Blaschka EXPORT_SYMBOL(qeth_osn_deregister); 13484a71df50SFrank Blaschka 13494a71df50SFrank Blaschka module_init(qeth_l2_init); 13504a71df50SFrank Blaschka module_exit(qeth_l2_exit); 13514a71df50SFrank Blaschka MODULE_AUTHOR("Frank Blaschka <frank.blaschka@de.ibm.com>"); 13524a71df50SFrank Blaschka MODULE_DESCRIPTION("qeth layer 2 discipline"); 13534a71df50SFrank Blaschka MODULE_LICENSE("GPL"); 1354