14a71df50SFrank Blaschka /* 24a71df50SFrank Blaschka * drivers/s390/net/qeth_l2_main.c 34a71df50SFrank Blaschka * 44a71df50SFrank Blaschka * Copyright IBM Corp. 2007 54a71df50SFrank Blaschka * Author(s): Utz Bacher <utz.bacher@de.ibm.com>, 64a71df50SFrank Blaschka * Frank Pavlic <fpavlic@de.ibm.com>, 74a71df50SFrank Blaschka * Thomas Spatzier <tspat@de.ibm.com>, 84a71df50SFrank Blaschka * Frank Blaschka <frank.blaschka@de.ibm.com> 94a71df50SFrank Blaschka */ 104a71df50SFrank Blaschka 1174eacdb9SFrank Blaschka #define KMSG_COMPONENT "qeth" 1274eacdb9SFrank Blaschka #define pr_fmt(fmt) KMSG_COMPONENT ": " fmt 1374eacdb9SFrank Blaschka 144a71df50SFrank Blaschka #include <linux/module.h> 154a71df50SFrank Blaschka #include <linux/moduleparam.h> 164a71df50SFrank Blaschka #include <linux/string.h> 174a71df50SFrank Blaschka #include <linux/errno.h> 184a71df50SFrank Blaschka #include <linux/kernel.h> 194a71df50SFrank Blaschka #include <linux/etherdevice.h> 204a71df50SFrank Blaschka #include <linux/mii.h> 214a71df50SFrank Blaschka #include <linux/ip.h> 224a71df50SFrank Blaschka 234a71df50SFrank Blaschka #include <asm/s390_rdev.h> 244a71df50SFrank Blaschka 254a71df50SFrank Blaschka #include "qeth_core.h" 264a71df50SFrank Blaschka #include "qeth_core_offl.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 *, 324a71df50SFrank Blaschka enum qeth_ipa_cmds, 334a71df50SFrank Blaschka int (*reply_cb) (struct qeth_card *, 344a71df50SFrank Blaschka struct qeth_reply*, 354a71df50SFrank Blaschka unsigned long)); 364a71df50SFrank Blaschka static void qeth_l2_set_multicast_list(struct net_device *); 374a71df50SFrank Blaschka static int qeth_l2_recover(void *); 384a71df50SFrank Blaschka 394a71df50SFrank Blaschka static int qeth_l2_do_ioctl(struct net_device *dev, struct ifreq *rq, int cmd) 404a71df50SFrank Blaschka { 41509e2562SHeiko Carstens struct qeth_card *card = dev->ml_priv; 424a71df50SFrank Blaschka struct mii_ioctl_data *mii_data; 434a71df50SFrank Blaschka int rc = 0; 444a71df50SFrank Blaschka 454a71df50SFrank Blaschka if (!card) 464a71df50SFrank Blaschka return -ENODEV; 474a71df50SFrank Blaschka 484a71df50SFrank Blaschka if ((card->state != CARD_STATE_UP) && 494a71df50SFrank Blaschka (card->state != CARD_STATE_SOFTSETUP)) 504a71df50SFrank Blaschka return -ENODEV; 514a71df50SFrank Blaschka 524a71df50SFrank Blaschka if (card->info.type == QETH_CARD_TYPE_OSN) 534a71df50SFrank Blaschka return -EPERM; 544a71df50SFrank Blaschka 554a71df50SFrank Blaschka switch (cmd) { 564a71df50SFrank Blaschka case SIOC_QETH_ADP_SET_SNMP_CONTROL: 574a71df50SFrank Blaschka rc = qeth_snmp_command(card, rq->ifr_ifru.ifru_data); 584a71df50SFrank Blaschka break; 594a71df50SFrank Blaschka case SIOC_QETH_GET_CARD_TYPE: 604a71df50SFrank Blaschka if ((card->info.type == QETH_CARD_TYPE_OSAE) && 614a71df50SFrank Blaschka !card->info.guestlan) 624a71df50SFrank Blaschka return 1; 634a71df50SFrank Blaschka return 0; 644a71df50SFrank Blaschka break; 654a71df50SFrank Blaschka case SIOCGMIIPHY: 664a71df50SFrank Blaschka mii_data = if_mii(rq); 674a71df50SFrank Blaschka mii_data->phy_id = 0; 684a71df50SFrank Blaschka break; 694a71df50SFrank Blaschka case SIOCGMIIREG: 704a71df50SFrank Blaschka mii_data = if_mii(rq); 714a71df50SFrank Blaschka if (mii_data->phy_id != 0) 724a71df50SFrank Blaschka rc = -EINVAL; 734a71df50SFrank Blaschka else 744a71df50SFrank Blaschka mii_data->val_out = qeth_mdio_read(dev, 754a71df50SFrank Blaschka mii_data->phy_id, mii_data->reg_num); 764a71df50SFrank Blaschka break; 774a71df50SFrank Blaschka default: 784a71df50SFrank Blaschka rc = -EOPNOTSUPP; 794a71df50SFrank Blaschka } 804a71df50SFrank Blaschka if (rc) 81d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(TRACE, 2, "ioce%d", rc); 824a71df50SFrank Blaschka return rc; 834a71df50SFrank Blaschka } 844a71df50SFrank Blaschka 854a71df50SFrank Blaschka static int qeth_l2_verify_dev(struct net_device *dev) 864a71df50SFrank Blaschka { 874a71df50SFrank Blaschka struct qeth_card *card; 884a71df50SFrank Blaschka unsigned long flags; 894a71df50SFrank Blaschka int rc = 0; 904a71df50SFrank Blaschka 914a71df50SFrank Blaschka read_lock_irqsave(&qeth_core_card_list.rwlock, flags); 924a71df50SFrank Blaschka list_for_each_entry(card, &qeth_core_card_list.list, list) { 934a71df50SFrank Blaschka if (card->dev == dev) { 944a71df50SFrank Blaschka rc = QETH_REAL_CARD; 954a71df50SFrank Blaschka break; 964a71df50SFrank Blaschka } 974a71df50SFrank Blaschka } 984a71df50SFrank Blaschka read_unlock_irqrestore(&qeth_core_card_list.rwlock, flags); 994a71df50SFrank Blaschka 1004a71df50SFrank Blaschka return rc; 1014a71df50SFrank Blaschka } 1024a71df50SFrank Blaschka 1034a71df50SFrank Blaschka static struct net_device *qeth_l2_netdev_by_devno(unsigned char *read_dev_no) 1044a71df50SFrank Blaschka { 1054a71df50SFrank Blaschka struct qeth_card *card; 1064a71df50SFrank Blaschka struct net_device *ndev; 107f06f6f32SCornelia Huck __u16 temp_dev_no; 1084a71df50SFrank Blaschka unsigned long flags; 109f06f6f32SCornelia Huck struct ccw_dev_id read_devid; 1104a71df50SFrank Blaschka 1114a71df50SFrank Blaschka ndev = NULL; 1124a71df50SFrank Blaschka memcpy(&temp_dev_no, read_dev_no, 2); 1134a71df50SFrank Blaschka read_lock_irqsave(&qeth_core_card_list.rwlock, flags); 1144a71df50SFrank Blaschka list_for_each_entry(card, &qeth_core_card_list.list, list) { 115f06f6f32SCornelia Huck ccw_device_get_id(CARD_RDEV(card), &read_devid); 116f06f6f32SCornelia Huck if (read_devid.devno == temp_dev_no) { 1174a71df50SFrank Blaschka ndev = card->dev; 1184a71df50SFrank Blaschka break; 1194a71df50SFrank Blaschka } 1204a71df50SFrank Blaschka } 1214a71df50SFrank Blaschka read_unlock_irqrestore(&qeth_core_card_list.rwlock, flags); 1224a71df50SFrank Blaschka return ndev; 1234a71df50SFrank Blaschka } 1244a71df50SFrank Blaschka 1254a71df50SFrank Blaschka static int qeth_l2_send_setgroupmac_cb(struct qeth_card *card, 1264a71df50SFrank Blaschka struct qeth_reply *reply, 1274a71df50SFrank Blaschka unsigned long data) 1284a71df50SFrank Blaschka { 1294a71df50SFrank Blaschka struct qeth_ipa_cmd *cmd; 1304a71df50SFrank Blaschka __u8 *mac; 1314a71df50SFrank Blaschka 132d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 2, "L2Sgmacb"); 1334a71df50SFrank Blaschka cmd = (struct qeth_ipa_cmd *) data; 1344a71df50SFrank Blaschka mac = &cmd->data.setdelmac.mac[0]; 1354a71df50SFrank Blaschka /* MAC already registered, needed in couple/uncouple case */ 1364a71df50SFrank Blaschka if (cmd->hdr.return_code == 0x2005) { 1377c510e4bSJohannes Berg QETH_DBF_MESSAGE(2, "Group MAC %pM already existing on %s \n", 1387c510e4bSJohannes Berg mac, QETH_CARD_IFNAME(card)); 1394a71df50SFrank Blaschka cmd->hdr.return_code = 0; 1404a71df50SFrank Blaschka } 1414a71df50SFrank Blaschka if (cmd->hdr.return_code) 1427c510e4bSJohannes Berg QETH_DBF_MESSAGE(2, "Could not set group MAC %pM on %s: %x\n", 1437c510e4bSJohannes Berg mac, QETH_CARD_IFNAME(card), cmd->hdr.return_code); 1444a71df50SFrank Blaschka return 0; 1454a71df50SFrank Blaschka } 1464a71df50SFrank Blaschka 1474a71df50SFrank Blaschka static int qeth_l2_send_setgroupmac(struct qeth_card *card, __u8 *mac) 1484a71df50SFrank Blaschka { 149d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 2, "L2Sgmac"); 1504a71df50SFrank Blaschka return qeth_l2_send_setdelmac(card, mac, IPA_CMD_SETGMAC, 1514a71df50SFrank Blaschka qeth_l2_send_setgroupmac_cb); 1524a71df50SFrank Blaschka } 1534a71df50SFrank Blaschka 1544a71df50SFrank Blaschka static int qeth_l2_send_delgroupmac_cb(struct qeth_card *card, 1554a71df50SFrank Blaschka struct qeth_reply *reply, 1564a71df50SFrank Blaschka unsigned long data) 1574a71df50SFrank Blaschka { 1584a71df50SFrank Blaschka struct qeth_ipa_cmd *cmd; 1594a71df50SFrank Blaschka __u8 *mac; 1604a71df50SFrank Blaschka 161d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 2, "L2Dgmacb"); 1624a71df50SFrank Blaschka cmd = (struct qeth_ipa_cmd *) data; 1634a71df50SFrank Blaschka mac = &cmd->data.setdelmac.mac[0]; 1644a71df50SFrank Blaschka if (cmd->hdr.return_code) 1657c510e4bSJohannes Berg QETH_DBF_MESSAGE(2, "Could not delete group MAC %pM on %s: %x\n", 1667c510e4bSJohannes Berg mac, QETH_CARD_IFNAME(card), cmd->hdr.return_code); 1674a71df50SFrank Blaschka return 0; 1684a71df50SFrank Blaschka } 1694a71df50SFrank Blaschka 1704a71df50SFrank Blaschka static int qeth_l2_send_delgroupmac(struct qeth_card *card, __u8 *mac) 1714a71df50SFrank Blaschka { 172d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 2, "L2Dgmac"); 1734a71df50SFrank Blaschka return qeth_l2_send_setdelmac(card, mac, IPA_CMD_DELGMAC, 1744a71df50SFrank Blaschka qeth_l2_send_delgroupmac_cb); 1754a71df50SFrank Blaschka } 1764a71df50SFrank Blaschka 1777db2266aSFrank Blaschka static void qeth_l2_add_mc(struct qeth_card *card, __u8 *mac, int vmac) 1784a71df50SFrank Blaschka { 1794a71df50SFrank Blaschka struct qeth_mc_mac *mc; 1807db2266aSFrank Blaschka int rc; 1814a71df50SFrank Blaschka 1824a71df50SFrank Blaschka mc = kmalloc(sizeof(struct qeth_mc_mac), GFP_ATOMIC); 1834a71df50SFrank Blaschka 18414cc21b6SFrank Blaschka if (!mc) 1854a71df50SFrank Blaschka return; 1864a71df50SFrank Blaschka 1874a71df50SFrank Blaschka memcpy(mc->mc_addr, mac, OSA_ADDR_LEN); 1884a71df50SFrank Blaschka mc->mc_addrlen = OSA_ADDR_LEN; 1897db2266aSFrank Blaschka mc->is_vmac = vmac; 1904a71df50SFrank Blaschka 1917db2266aSFrank Blaschka if (vmac) { 1927db2266aSFrank Blaschka rc = qeth_l2_send_setdelmac(card, mac, IPA_CMD_SETVMAC, 1937db2266aSFrank Blaschka NULL); 1947db2266aSFrank Blaschka } else { 1957db2266aSFrank Blaschka rc = qeth_l2_send_setgroupmac(card, mac); 1967db2266aSFrank Blaschka } 1977db2266aSFrank Blaschka 1987db2266aSFrank Blaschka if (!rc) 1994a71df50SFrank Blaschka list_add_tail(&mc->list, &card->mc_list); 2004a71df50SFrank Blaschka else 2014a71df50SFrank Blaschka kfree(mc); 2024a71df50SFrank Blaschka } 2034a71df50SFrank Blaschka 2044a71df50SFrank Blaschka static void qeth_l2_del_all_mc(struct qeth_card *card) 2054a71df50SFrank Blaschka { 2064a71df50SFrank Blaschka struct qeth_mc_mac *mc, *tmp; 2074a71df50SFrank Blaschka 2084a71df50SFrank Blaschka spin_lock_bh(&card->mclock); 2094a71df50SFrank Blaschka list_for_each_entry_safe(mc, tmp, &card->mc_list, list) { 2107db2266aSFrank Blaschka if (mc->is_vmac) 2117db2266aSFrank Blaschka qeth_l2_send_setdelmac(card, mc->mc_addr, 2127db2266aSFrank Blaschka IPA_CMD_DELVMAC, NULL); 2137db2266aSFrank Blaschka else 2144a71df50SFrank Blaschka qeth_l2_send_delgroupmac(card, mc->mc_addr); 2154a71df50SFrank Blaschka list_del(&mc->list); 2164a71df50SFrank Blaschka kfree(mc); 2174a71df50SFrank Blaschka } 2184a71df50SFrank Blaschka spin_unlock_bh(&card->mclock); 2194a71df50SFrank Blaschka } 2204a71df50SFrank Blaschka 2214a71df50SFrank Blaschka static void qeth_l2_get_packet_type(struct qeth_card *card, 2224a71df50SFrank Blaschka struct qeth_hdr *hdr, struct sk_buff *skb) 2234a71df50SFrank Blaschka { 2244a71df50SFrank Blaschka __u16 hdr_mac; 2254a71df50SFrank Blaschka 2264a71df50SFrank Blaschka if (!memcmp(skb->data + QETH_HEADER_SIZE, 2274a71df50SFrank Blaschka skb->dev->broadcast, 6)) { 2284a71df50SFrank Blaschka /* broadcast? */ 2294a71df50SFrank Blaschka hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_BROADCAST; 2304a71df50SFrank Blaschka return; 2314a71df50SFrank Blaschka } 2324a71df50SFrank Blaschka hdr_mac = *((__u16 *)skb->data); 2334a71df50SFrank Blaschka /* tr multicast? */ 2344a71df50SFrank Blaschka switch (card->info.link_type) { 2354a71df50SFrank Blaschka case QETH_LINK_TYPE_HSTR: 2364a71df50SFrank Blaschka case QETH_LINK_TYPE_LANE_TR: 2374a71df50SFrank Blaschka if ((hdr_mac == QETH_TR_MAC_NC) || 2384a71df50SFrank Blaschka (hdr_mac == QETH_TR_MAC_C)) 2394a71df50SFrank Blaschka hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_MULTICAST; 2404a71df50SFrank Blaschka else 2414a71df50SFrank Blaschka hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_UNICAST; 2424a71df50SFrank Blaschka break; 2434a71df50SFrank Blaschka /* eth or so multicast? */ 2444a71df50SFrank Blaschka default: 2454a71df50SFrank Blaschka if ((hdr_mac == QETH_ETH_MAC_V4) || 2464a71df50SFrank Blaschka (hdr_mac == QETH_ETH_MAC_V6)) 2474a71df50SFrank Blaschka hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_MULTICAST; 2484a71df50SFrank Blaschka else 2494a71df50SFrank Blaschka hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_UNICAST; 2504a71df50SFrank Blaschka } 2514a71df50SFrank Blaschka } 2524a71df50SFrank Blaschka 2534a71df50SFrank Blaschka static void qeth_l2_fill_header(struct qeth_card *card, struct qeth_hdr *hdr, 2544a71df50SFrank Blaschka struct sk_buff *skb, int ipv, int cast_type) 2554a71df50SFrank Blaschka { 256683d718aSFrank Blaschka struct vlan_ethhdr *veth = (struct vlan_ethhdr *)skb_mac_header(skb); 2574a71df50SFrank Blaschka 2584a71df50SFrank Blaschka memset(hdr, 0, sizeof(struct qeth_hdr)); 2594a71df50SFrank Blaschka hdr->hdr.l2.id = QETH_HEADER_TYPE_LAYER2; 2604a71df50SFrank Blaschka 2614a71df50SFrank Blaschka /* set byte byte 3 to casting flags */ 2624a71df50SFrank Blaschka if (cast_type == RTN_MULTICAST) 2634a71df50SFrank Blaschka hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_MULTICAST; 2644a71df50SFrank Blaschka else if (cast_type == RTN_BROADCAST) 2654a71df50SFrank Blaschka hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_BROADCAST; 2664a71df50SFrank Blaschka else 2674a71df50SFrank Blaschka qeth_l2_get_packet_type(card, hdr, skb); 2684a71df50SFrank Blaschka 2694a71df50SFrank Blaschka hdr->hdr.l2.pkt_length = skb->len-QETH_HEADER_SIZE; 2704a71df50SFrank Blaschka /* VSWITCH relies on the VLAN 2714a71df50SFrank Blaschka * information to be present in 2724a71df50SFrank Blaschka * the QDIO header */ 2734a71df50SFrank Blaschka if (veth->h_vlan_proto == __constant_htons(ETH_P_8021Q)) { 2744a71df50SFrank Blaschka hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_VLAN; 2754a71df50SFrank Blaschka hdr->hdr.l2.vlan_id = ntohs(veth->h_vlan_TCI); 2764a71df50SFrank Blaschka } 2774a71df50SFrank Blaschka } 2784a71df50SFrank Blaschka 2794a71df50SFrank Blaschka static int qeth_l2_send_setdelvlan_cb(struct qeth_card *card, 2804a71df50SFrank Blaschka struct qeth_reply *reply, unsigned long data) 2814a71df50SFrank Blaschka { 2824a71df50SFrank Blaschka struct qeth_ipa_cmd *cmd; 2834a71df50SFrank Blaschka 284d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 2, "L2sdvcb"); 2854a71df50SFrank Blaschka cmd = (struct qeth_ipa_cmd *) data; 2864a71df50SFrank Blaschka if (cmd->hdr.return_code) { 28714cc21b6SFrank Blaschka QETH_DBF_MESSAGE(2, "Error in processing VLAN %i on %s: 0x%x. " 2884a71df50SFrank Blaschka "Continuing\n", cmd->data.setdelvlan.vlan_id, 2894a71df50SFrank Blaschka QETH_CARD_IFNAME(card), cmd->hdr.return_code); 290d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(TRACE, 2, "L2VL%4x", cmd->hdr.command); 291d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(TRACE, 2, "L2%s", CARD_BUS_ID(card)); 292d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(TRACE, 2, "err%d", cmd->hdr.return_code); 2934a71df50SFrank Blaschka } 2944a71df50SFrank Blaschka return 0; 2954a71df50SFrank Blaschka } 2964a71df50SFrank Blaschka 2974a71df50SFrank Blaschka static int qeth_l2_send_setdelvlan(struct qeth_card *card, __u16 i, 2984a71df50SFrank Blaschka enum qeth_ipa_cmds ipacmd) 2994a71df50SFrank Blaschka { 3004a71df50SFrank Blaschka struct qeth_ipa_cmd *cmd; 3014a71df50SFrank Blaschka struct qeth_cmd_buffer *iob; 3024a71df50SFrank Blaschka 303d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(TRACE, 4, "L2sdv%x", ipacmd); 3044a71df50SFrank Blaschka iob = qeth_get_ipacmd_buffer(card, ipacmd, QETH_PROT_IPV4); 3054a71df50SFrank Blaschka cmd = (struct qeth_ipa_cmd *)(iob->data+IPA_PDU_HEADER_SIZE); 3064a71df50SFrank Blaschka cmd->data.setdelvlan.vlan_id = i; 3074a71df50SFrank Blaschka return qeth_send_ipa_cmd(card, iob, 3084a71df50SFrank Blaschka qeth_l2_send_setdelvlan_cb, NULL); 3094a71df50SFrank Blaschka } 3104a71df50SFrank Blaschka 3114a71df50SFrank Blaschka static void qeth_l2_process_vlans(struct qeth_card *card, int clear) 3124a71df50SFrank Blaschka { 3134a71df50SFrank Blaschka struct qeth_vlan_vid *id; 314d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 3, "L2prcvln"); 3154a71df50SFrank Blaschka spin_lock_bh(&card->vlanlock); 3164a71df50SFrank Blaschka list_for_each_entry(id, &card->vid_list, list) { 3174a71df50SFrank Blaschka if (clear) 3184a71df50SFrank Blaschka qeth_l2_send_setdelvlan(card, id->vid, 3194a71df50SFrank Blaschka IPA_CMD_DELVLAN); 3204a71df50SFrank Blaschka else 3214a71df50SFrank Blaschka qeth_l2_send_setdelvlan(card, id->vid, 3224a71df50SFrank Blaschka IPA_CMD_SETVLAN); 3234a71df50SFrank Blaschka } 3244a71df50SFrank Blaschka spin_unlock_bh(&card->vlanlock); 3254a71df50SFrank Blaschka } 3264a71df50SFrank Blaschka 3274a71df50SFrank Blaschka static void qeth_l2_vlan_rx_add_vid(struct net_device *dev, unsigned short vid) 3284a71df50SFrank Blaschka { 329509e2562SHeiko Carstens struct qeth_card *card = dev->ml_priv; 3304a71df50SFrank Blaschka struct qeth_vlan_vid *id; 3314a71df50SFrank Blaschka 332d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(TRACE, 4, "aid:%d", vid); 3334a71df50SFrank Blaschka id = kmalloc(sizeof(struct qeth_vlan_vid), GFP_ATOMIC); 3344a71df50SFrank Blaschka if (id) { 3354a71df50SFrank Blaschka id->vid = vid; 3364a71df50SFrank Blaschka qeth_l2_send_setdelvlan(card, vid, IPA_CMD_SETVLAN); 3374a71df50SFrank Blaschka spin_lock_bh(&card->vlanlock); 3384a71df50SFrank Blaschka list_add_tail(&id->list, &card->vid_list); 3394a71df50SFrank Blaschka spin_unlock_bh(&card->vlanlock); 3404a71df50SFrank Blaschka } 3414a71df50SFrank Blaschka } 3424a71df50SFrank Blaschka 3434a71df50SFrank Blaschka static void qeth_l2_vlan_rx_kill_vid(struct net_device *dev, unsigned short vid) 3444a71df50SFrank Blaschka { 3454a71df50SFrank Blaschka struct qeth_vlan_vid *id, *tmpid = NULL; 346509e2562SHeiko Carstens struct qeth_card *card = dev->ml_priv; 3474a71df50SFrank Blaschka 348d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(TRACE, 4, "kid:%d", vid); 3494a71df50SFrank Blaschka spin_lock_bh(&card->vlanlock); 3504a71df50SFrank Blaschka list_for_each_entry(id, &card->vid_list, list) { 3514a71df50SFrank Blaschka if (id->vid == vid) { 3524a71df50SFrank Blaschka list_del(&id->list); 3534a71df50SFrank Blaschka tmpid = id; 3544a71df50SFrank Blaschka break; 3554a71df50SFrank Blaschka } 3564a71df50SFrank Blaschka } 3574a71df50SFrank Blaschka spin_unlock_bh(&card->vlanlock); 3584a71df50SFrank Blaschka if (tmpid) { 3594a71df50SFrank Blaschka qeth_l2_send_setdelvlan(card, vid, IPA_CMD_DELVLAN); 3604a71df50SFrank Blaschka kfree(tmpid); 3614a71df50SFrank Blaschka } 3624a71df50SFrank Blaschka qeth_l2_set_multicast_list(card->dev); 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 } 3844a71df50SFrank Blaschka if (!card->use_hard_stop) { 3854a71df50SFrank Blaschka __u8 *mac = &card->dev->dev_addr[0]; 3864a71df50SFrank Blaschka rc = qeth_l2_send_delmac(card, mac); 387d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "Lerr%d", rc); 3884a71df50SFrank Blaschka } 3894a71df50SFrank Blaschka card->state = CARD_STATE_SOFTSETUP; 3904a71df50SFrank Blaschka } 3914a71df50SFrank Blaschka if (card->state == CARD_STATE_SOFTSETUP) { 3924a71df50SFrank Blaschka qeth_l2_process_vlans(card, 1); 39328a7e4c9SUrsula Braun if (!card->use_hard_stop) 3944a71df50SFrank Blaschka qeth_l2_del_all_mc(card); 3954a71df50SFrank Blaschka qeth_clear_ipacmd_list(card); 3964a71df50SFrank Blaschka card->state = CARD_STATE_HARDSETUP; 3974a71df50SFrank Blaschka } 3984a71df50SFrank Blaschka if (card->state == CARD_STATE_HARDSETUP) { 3994a71df50SFrank Blaschka qeth_qdio_clear_card(card, 0); 4004a71df50SFrank Blaschka qeth_clear_qdio_buffers(card); 4014a71df50SFrank Blaschka qeth_clear_working_pool_list(card); 4024a71df50SFrank Blaschka card->state = CARD_STATE_DOWN; 4034a71df50SFrank Blaschka } 4044a71df50SFrank Blaschka if (card->state == CARD_STATE_DOWN) { 4054a71df50SFrank Blaschka qeth_clear_cmd_buffers(&card->read); 4064a71df50SFrank Blaschka qeth_clear_cmd_buffers(&card->write); 4074a71df50SFrank Blaschka } 4084a71df50SFrank Blaschka card->use_hard_stop = 0; 4094a71df50SFrank Blaschka return rc; 4104a71df50SFrank Blaschka } 4114a71df50SFrank Blaschka 4124a71df50SFrank Blaschka static void qeth_l2_process_inbound_buffer(struct qeth_card *card, 4134a71df50SFrank Blaschka struct qeth_qdio_buffer *buf, int index) 4144a71df50SFrank Blaschka { 4154a71df50SFrank Blaschka struct qdio_buffer_element *element; 4164a71df50SFrank Blaschka struct sk_buff *skb; 4174a71df50SFrank Blaschka struct qeth_hdr *hdr; 4184a71df50SFrank Blaschka int offset; 4194a71df50SFrank Blaschka unsigned int len; 4204a71df50SFrank Blaschka 4214a71df50SFrank Blaschka /* get first element of current buffer */ 4224a71df50SFrank Blaschka element = (struct qdio_buffer_element *)&buf->buffer->element[0]; 4234a71df50SFrank Blaschka offset = 0; 4244a71df50SFrank Blaschka if (card->options.performance_stats) 4254a71df50SFrank Blaschka card->perf_stats.bufs_rec++; 4264a71df50SFrank Blaschka while ((skb = qeth_core_get_next_skb(card, buf->buffer, &element, 4274a71df50SFrank Blaschka &offset, &hdr))) { 4284a71df50SFrank Blaschka skb->dev = card->dev; 4294a71df50SFrank Blaschka /* is device UP ? */ 4304a71df50SFrank Blaschka if (!(card->dev->flags & IFF_UP)) { 4314a71df50SFrank Blaschka dev_kfree_skb_any(skb); 4324a71df50SFrank Blaschka continue; 4334a71df50SFrank Blaschka } 4344a71df50SFrank Blaschka 4354a71df50SFrank Blaschka switch (hdr->hdr.l2.id) { 4364a71df50SFrank Blaschka case QETH_HEADER_TYPE_LAYER2: 4374a71df50SFrank Blaschka skb->pkt_type = PACKET_HOST; 4384a71df50SFrank Blaschka skb->protocol = eth_type_trans(skb, skb->dev); 4394a71df50SFrank Blaschka if (card->options.checksum_type == NO_CHECKSUMMING) 4404a71df50SFrank Blaschka skb->ip_summed = CHECKSUM_UNNECESSARY; 4414a71df50SFrank Blaschka else 4424a71df50SFrank Blaschka skb->ip_summed = CHECKSUM_NONE; 44312883725SUrsula Braun if (skb->protocol == htons(ETH_P_802_2)) 4444a71df50SFrank Blaschka *((__u32 *)skb->cb) = ++card->seqno.pkt_seqno; 4454a71df50SFrank Blaschka len = skb->len; 4464a71df50SFrank Blaschka netif_rx(skb); 4474a71df50SFrank Blaschka break; 4484a71df50SFrank Blaschka case QETH_HEADER_TYPE_OSN: 4492d488c2fSUrsula Braun if (card->info.type == QETH_CARD_TYPE_OSN) { 4504a71df50SFrank Blaschka skb_push(skb, sizeof(struct qeth_hdr)); 4514a71df50SFrank Blaschka skb_copy_to_linear_data(skb, hdr, 4524a71df50SFrank Blaschka sizeof(struct qeth_hdr)); 4534a71df50SFrank Blaschka len = skb->len; 4544a71df50SFrank Blaschka card->osn_info.data_cb(skb); 4554a71df50SFrank Blaschka break; 4562d488c2fSUrsula Braun } 4572d488c2fSUrsula Braun /* else unknown */ 4584a71df50SFrank Blaschka default: 4594a71df50SFrank Blaschka dev_kfree_skb_any(skb); 460d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 3, "inbunkno"); 461d11ba0c4SPeter Tiedemann QETH_DBF_HEX(CTRL, 3, hdr, QETH_DBF_CTRL_LEN); 4624a71df50SFrank Blaschka continue; 4634a71df50SFrank Blaschka } 4644a71df50SFrank Blaschka card->dev->last_rx = jiffies; 4654a71df50SFrank Blaschka card->stats.rx_packets++; 4664a71df50SFrank Blaschka card->stats.rx_bytes += len; 4674a71df50SFrank Blaschka } 4684a71df50SFrank Blaschka } 4694a71df50SFrank Blaschka 4704a71df50SFrank Blaschka static int qeth_l2_send_setdelmac(struct qeth_card *card, __u8 *mac, 4714a71df50SFrank Blaschka enum qeth_ipa_cmds ipacmd, 4724a71df50SFrank Blaschka int (*reply_cb) (struct qeth_card *, 4734a71df50SFrank Blaschka struct qeth_reply*, 4744a71df50SFrank Blaschka unsigned long)) 4754a71df50SFrank Blaschka { 4764a71df50SFrank Blaschka struct qeth_ipa_cmd *cmd; 4774a71df50SFrank Blaschka struct qeth_cmd_buffer *iob; 4784a71df50SFrank Blaschka 479d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 2, "L2sdmac"); 4804a71df50SFrank Blaschka iob = qeth_get_ipacmd_buffer(card, ipacmd, QETH_PROT_IPV4); 4814a71df50SFrank Blaschka cmd = (struct qeth_ipa_cmd *)(iob->data+IPA_PDU_HEADER_SIZE); 4824a71df50SFrank Blaschka cmd->data.setdelmac.mac_length = OSA_ADDR_LEN; 4834a71df50SFrank Blaschka memcpy(&cmd->data.setdelmac.mac, mac, OSA_ADDR_LEN); 4844a71df50SFrank Blaschka return qeth_send_ipa_cmd(card, iob, reply_cb, NULL); 4854a71df50SFrank Blaschka } 4864a71df50SFrank Blaschka 4874a71df50SFrank Blaschka static int qeth_l2_send_setmac_cb(struct qeth_card *card, 4884a71df50SFrank Blaschka struct qeth_reply *reply, 4894a71df50SFrank Blaschka unsigned long data) 4904a71df50SFrank Blaschka { 4914a71df50SFrank Blaschka struct qeth_ipa_cmd *cmd; 4924a71df50SFrank Blaschka 493d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 2, "L2Smaccb"); 4944a71df50SFrank Blaschka cmd = (struct qeth_ipa_cmd *) data; 4954a71df50SFrank Blaschka if (cmd->hdr.return_code) { 496d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(TRACE, 2, "L2er%x", cmd->hdr.return_code); 4974a71df50SFrank Blaschka card->info.mac_bits &= ~QETH_LAYER2_MAC_REGISTERED; 4984a71df50SFrank Blaschka cmd->hdr.return_code = -EIO; 4994a71df50SFrank Blaschka } else { 5004a71df50SFrank Blaschka card->info.mac_bits |= QETH_LAYER2_MAC_REGISTERED; 5014a71df50SFrank Blaschka memcpy(card->dev->dev_addr, cmd->data.setdelmac.mac, 5024a71df50SFrank Blaschka OSA_ADDR_LEN); 50374eacdb9SFrank Blaschka dev_info(&card->gdev->dev, 50474eacdb9SFrank Blaschka "MAC address %2.2x:%2.2x:%2.2x:%2.2x:%2.2x:%2.2x " 5054a71df50SFrank Blaschka "successfully registered on device %s\n", 5064a71df50SFrank Blaschka card->dev->dev_addr[0], card->dev->dev_addr[1], 5074a71df50SFrank Blaschka card->dev->dev_addr[2], card->dev->dev_addr[3], 5084a71df50SFrank Blaschka card->dev->dev_addr[4], card->dev->dev_addr[5], 5094a71df50SFrank Blaschka card->dev->name); 5104a71df50SFrank Blaschka } 5114a71df50SFrank Blaschka return 0; 5124a71df50SFrank Blaschka } 5134a71df50SFrank Blaschka 5144a71df50SFrank Blaschka static int qeth_l2_send_setmac(struct qeth_card *card, __u8 *mac) 5154a71df50SFrank Blaschka { 516d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 2, "L2Setmac"); 5174a71df50SFrank Blaschka return qeth_l2_send_setdelmac(card, mac, IPA_CMD_SETVMAC, 5184a71df50SFrank Blaschka qeth_l2_send_setmac_cb); 5194a71df50SFrank Blaschka } 5204a71df50SFrank Blaschka 5214a71df50SFrank Blaschka static int qeth_l2_send_delmac_cb(struct qeth_card *card, 5224a71df50SFrank Blaschka struct qeth_reply *reply, 5234a71df50SFrank Blaschka unsigned long data) 5244a71df50SFrank Blaschka { 5254a71df50SFrank Blaschka struct qeth_ipa_cmd *cmd; 5264a71df50SFrank Blaschka 527d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 2, "L2Dmaccb"); 5284a71df50SFrank Blaschka cmd = (struct qeth_ipa_cmd *) data; 5294a71df50SFrank Blaschka if (cmd->hdr.return_code) { 530d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(TRACE, 2, "err%d", cmd->hdr.return_code); 5314a71df50SFrank Blaschka cmd->hdr.return_code = -EIO; 5324a71df50SFrank Blaschka return 0; 5334a71df50SFrank Blaschka } 5344a71df50SFrank Blaschka card->info.mac_bits &= ~QETH_LAYER2_MAC_REGISTERED; 5354a71df50SFrank Blaschka 5364a71df50SFrank Blaschka return 0; 5374a71df50SFrank Blaschka } 5384a71df50SFrank Blaschka 5394a71df50SFrank Blaschka static int qeth_l2_send_delmac(struct qeth_card *card, __u8 *mac) 5404a71df50SFrank Blaschka { 541d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 2, "L2Delmac"); 5424a71df50SFrank Blaschka if (!(card->info.mac_bits & QETH_LAYER2_MAC_REGISTERED)) 5434a71df50SFrank Blaschka return 0; 5444a71df50SFrank Blaschka return qeth_l2_send_setdelmac(card, mac, IPA_CMD_DELVMAC, 5454a71df50SFrank Blaschka qeth_l2_send_delmac_cb); 5464a71df50SFrank Blaschka } 5474a71df50SFrank Blaschka 5484a71df50SFrank Blaschka static int qeth_l2_request_initial_mac(struct qeth_card *card) 5494a71df50SFrank Blaschka { 5504a71df50SFrank Blaschka int rc = 0; 5514a71df50SFrank Blaschka char vendor_pre[] = {0x02, 0x00, 0x00}; 5524a71df50SFrank Blaschka 553d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "doL2init"); 554d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "doL2%s", CARD_BUS_ID(card)); 5554a71df50SFrank Blaschka 5564a71df50SFrank Blaschka rc = qeth_query_setadapterparms(card); 5574a71df50SFrank Blaschka if (rc) { 55814cc21b6SFrank Blaschka QETH_DBF_MESSAGE(2, "could not query adapter parameters on " 55914cc21b6SFrank Blaschka "device %s: x%x\n", CARD_BUS_ID(card), rc); 5604a71df50SFrank Blaschka } 5614a71df50SFrank Blaschka 562f1d58672SUrsula Braun if ((card->info.type == QETH_CARD_TYPE_IQD) || 563f1d58672SUrsula Braun (card->info.guestlan)) { 5644a71df50SFrank Blaschka rc = qeth_setadpparms_change_macaddr(card); 5654a71df50SFrank Blaschka if (rc) { 56614cc21b6SFrank Blaschka QETH_DBF_MESSAGE(2, "couldn't get MAC address on " 56714cc21b6SFrank Blaschka "device %s: x%x\n", CARD_BUS_ID(card), rc); 568d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "1err%d", rc); 5694a71df50SFrank Blaschka return rc; 5704a71df50SFrank Blaschka } 571d11ba0c4SPeter Tiedemann QETH_DBF_HEX(SETUP, 2, card->dev->dev_addr, OSA_ADDR_LEN); 5724a71df50SFrank Blaschka } else { 5734a71df50SFrank Blaschka random_ether_addr(card->dev->dev_addr); 5744a71df50SFrank Blaschka memcpy(card->dev->dev_addr, vendor_pre, 3); 5754a71df50SFrank Blaschka } 5764a71df50SFrank Blaschka return 0; 5774a71df50SFrank Blaschka } 5784a71df50SFrank Blaschka 5794a71df50SFrank Blaschka static int qeth_l2_set_mac_address(struct net_device *dev, void *p) 5804a71df50SFrank Blaschka { 5814a71df50SFrank Blaschka struct sockaddr *addr = p; 582509e2562SHeiko Carstens struct qeth_card *card = dev->ml_priv; 5834a71df50SFrank Blaschka int rc = 0; 5844a71df50SFrank Blaschka 585d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 3, "setmac"); 5864a71df50SFrank Blaschka 5874a71df50SFrank Blaschka if (qeth_l2_verify_dev(dev) != QETH_REAL_CARD) { 588d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 3, "setmcINV"); 5894a71df50SFrank Blaschka return -EOPNOTSUPP; 5904a71df50SFrank Blaschka } 5914a71df50SFrank Blaschka 5924a71df50SFrank Blaschka if (card->info.type == QETH_CARD_TYPE_OSN) { 593d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 3, "setmcOSN"); 5944a71df50SFrank Blaschka return -EOPNOTSUPP; 5954a71df50SFrank Blaschka } 596d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(TRACE, 3, "%s", CARD_BUS_ID(card)); 597d11ba0c4SPeter Tiedemann QETH_DBF_HEX(TRACE, 3, addr->sa_data, OSA_ADDR_LEN); 5984a71df50SFrank Blaschka rc = qeth_l2_send_delmac(card, &card->dev->dev_addr[0]); 5994a71df50SFrank Blaschka if (!rc) 6004a71df50SFrank Blaschka rc = qeth_l2_send_setmac(card, addr->sa_data); 6014a71df50SFrank Blaschka return rc; 6024a71df50SFrank Blaschka } 6034a71df50SFrank Blaschka 6044a71df50SFrank Blaschka static void qeth_l2_set_multicast_list(struct net_device *dev) 6054a71df50SFrank Blaschka { 606509e2562SHeiko Carstens struct qeth_card *card = dev->ml_priv; 6077db2266aSFrank Blaschka struct dev_addr_list *dm; 6084a71df50SFrank Blaschka 6094a71df50SFrank Blaschka if (card->info.type == QETH_CARD_TYPE_OSN) 6104a71df50SFrank Blaschka return ; 6114a71df50SFrank Blaschka 612d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 3, "setmulti"); 6134a71df50SFrank Blaschka qeth_l2_del_all_mc(card); 6144a71df50SFrank Blaschka spin_lock_bh(&card->mclock); 6154a71df50SFrank Blaschka for (dm = dev->mc_list; dm; dm = dm->next) 6167db2266aSFrank Blaschka qeth_l2_add_mc(card, dm->da_addr, 0); 6177db2266aSFrank Blaschka 6187db2266aSFrank Blaschka for (dm = dev->uc_list; dm; dm = dm->next) 6197db2266aSFrank Blaschka qeth_l2_add_mc(card, dm->da_addr, 1); 6207db2266aSFrank Blaschka 6214a71df50SFrank Blaschka spin_unlock_bh(&card->mclock); 6224a71df50SFrank Blaschka if (!qeth_adp_supported(card, IPA_SETADP_SET_PROMISC_MODE)) 6234a71df50SFrank Blaschka return; 6244a71df50SFrank Blaschka qeth_setadp_promisc_mode(card); 6254a71df50SFrank Blaschka } 6264a71df50SFrank Blaschka 6274a71df50SFrank Blaschka static int qeth_l2_hard_start_xmit(struct sk_buff *skb, struct net_device *dev) 6284a71df50SFrank Blaschka { 6294a71df50SFrank Blaschka int rc; 6304a71df50SFrank Blaschka struct qeth_hdr *hdr = NULL; 6314a71df50SFrank Blaschka int elements = 0; 632509e2562SHeiko Carstens struct qeth_card *card = dev->ml_priv; 6334a71df50SFrank Blaschka struct sk_buff *new_skb = skb; 6344a71df50SFrank Blaschka int ipv = qeth_get_ip_version(skb); 6354a71df50SFrank Blaschka int cast_type = qeth_get_cast_type(card, skb); 6364a71df50SFrank Blaschka struct qeth_qdio_out_q *queue = card->qdio.out_qs 6374a71df50SFrank Blaschka [qeth_get_priority_queue(card, skb, ipv, cast_type)]; 6384a71df50SFrank Blaschka int tx_bytes = skb->len; 6394a71df50SFrank Blaschka enum qeth_large_send_types large_send = QETH_LARGE_SEND_NO; 6404a71df50SFrank Blaschka struct qeth_eddp_context *ctx = NULL; 641683d718aSFrank Blaschka int data_offset = -1; 642683d718aSFrank Blaschka int elements_needed = 0; 643683d718aSFrank Blaschka int hd_len = 0; 6444a71df50SFrank Blaschka 6454a71df50SFrank Blaschka if ((card->state != CARD_STATE_UP) || !card->lan_online) { 6464a71df50SFrank Blaschka card->stats.tx_carrier_errors++; 6474a71df50SFrank Blaschka goto tx_drop; 6484a71df50SFrank Blaschka } 6494a71df50SFrank Blaschka 6504a71df50SFrank Blaschka if ((card->info.type == QETH_CARD_TYPE_OSN) && 6514a71df50SFrank Blaschka (skb->protocol == htons(ETH_P_IPV6))) 6524a71df50SFrank Blaschka goto tx_drop; 6534a71df50SFrank Blaschka 6544a71df50SFrank Blaschka if (card->options.performance_stats) { 6554a71df50SFrank Blaschka card->perf_stats.outbound_cnt++; 6564a71df50SFrank Blaschka card->perf_stats.outbound_start_time = qeth_get_micros(); 6574a71df50SFrank Blaschka } 6584a71df50SFrank Blaschka netif_stop_queue(dev); 6594a71df50SFrank Blaschka 6604a71df50SFrank Blaschka if (skb_is_gso(skb)) 6614a71df50SFrank Blaschka large_send = QETH_LARGE_SEND_EDDP; 6624a71df50SFrank Blaschka 6634a71df50SFrank Blaschka if (card->info.type == QETH_CARD_TYPE_OSN) 6644a71df50SFrank Blaschka hdr = (struct qeth_hdr *)skb->data; 6654a71df50SFrank Blaschka else { 666683d718aSFrank Blaschka if ((card->info.type == QETH_CARD_TYPE_IQD) && (!large_send) && 667683d718aSFrank Blaschka (skb_shinfo(skb)->nr_frags == 0)) { 668683d718aSFrank Blaschka new_skb = skb; 669683d718aSFrank Blaschka data_offset = ETH_HLEN; 670683d718aSFrank Blaschka hd_len = ETH_HLEN; 671683d718aSFrank Blaschka hdr = kmem_cache_alloc(qeth_core_header_cache, 672683d718aSFrank Blaschka GFP_ATOMIC); 673683d718aSFrank Blaschka if (!hdr) 674683d718aSFrank Blaschka goto tx_drop; 675683d718aSFrank Blaschka elements_needed++; 676683d718aSFrank Blaschka skb_reset_mac_header(new_skb); 677683d718aSFrank Blaschka qeth_l2_fill_header(card, hdr, new_skb, ipv, cast_type); 678683d718aSFrank Blaschka hdr->hdr.l2.pkt_length = new_skb->len; 679683d718aSFrank Blaschka memcpy(((char *)hdr) + sizeof(struct qeth_hdr), 680683d718aSFrank Blaschka skb_mac_header(new_skb), ETH_HLEN); 681683d718aSFrank Blaschka } else { 682f90b744eSFrank Blaschka /* create a clone with writeable headroom */ 683683d718aSFrank Blaschka new_skb = skb_realloc_headroom(skb, 684683d718aSFrank Blaschka sizeof(struct qeth_hdr)); 6854a71df50SFrank Blaschka if (!new_skb) 6864a71df50SFrank Blaschka goto tx_drop; 687f90b744eSFrank Blaschka hdr = (struct qeth_hdr *)skb_push(new_skb, 688f90b744eSFrank Blaschka sizeof(struct qeth_hdr)); 689683d718aSFrank Blaschka skb_set_mac_header(new_skb, sizeof(struct qeth_hdr)); 6904a71df50SFrank Blaschka qeth_l2_fill_header(card, hdr, new_skb, ipv, cast_type); 6914a71df50SFrank Blaschka } 692683d718aSFrank Blaschka } 6934a71df50SFrank Blaschka 6944a71df50SFrank Blaschka if (large_send == QETH_LARGE_SEND_EDDP) { 6954a71df50SFrank Blaschka ctx = qeth_eddp_create_context(card, new_skb, hdr, 6964a71df50SFrank Blaschka skb->sk->sk_protocol); 6974a71df50SFrank Blaschka if (ctx == NULL) { 69814cc21b6SFrank Blaschka QETH_DBF_MESSAGE(2, "could not create eddp context\n"); 6994a71df50SFrank Blaschka goto tx_drop; 7004a71df50SFrank Blaschka } 7014a71df50SFrank Blaschka } else { 702683d718aSFrank Blaschka elements = qeth_get_elements_no(card, (void *)hdr, new_skb, 703683d718aSFrank Blaschka elements_needed); 704683d718aSFrank Blaschka if (!elements) { 705683d718aSFrank Blaschka if (data_offset >= 0) 706683d718aSFrank Blaschka kmem_cache_free(qeth_core_header_cache, hdr); 7074a71df50SFrank Blaschka goto tx_drop; 7084a71df50SFrank Blaschka } 709683d718aSFrank Blaschka } 7104a71df50SFrank Blaschka 7114a71df50SFrank Blaschka if ((large_send == QETH_LARGE_SEND_NO) && 7124a71df50SFrank Blaschka (skb->ip_summed == CHECKSUM_PARTIAL)) 7134a71df50SFrank Blaschka qeth_tx_csum(new_skb); 7144a71df50SFrank Blaschka 7154a71df50SFrank Blaschka if (card->info.type != QETH_CARD_TYPE_IQD) 7164a71df50SFrank Blaschka rc = qeth_do_send_packet(card, queue, new_skb, hdr, 7174a71df50SFrank Blaschka elements, ctx); 7184a71df50SFrank Blaschka else 7194a71df50SFrank Blaschka rc = qeth_do_send_packet_fast(card, queue, new_skb, hdr, 720683d718aSFrank Blaschka elements, ctx, data_offset, hd_len); 7214a71df50SFrank Blaschka if (!rc) { 7224a71df50SFrank Blaschka card->stats.tx_packets++; 7234a71df50SFrank Blaschka card->stats.tx_bytes += tx_bytes; 7244a71df50SFrank Blaschka if (new_skb != skb) 7254a71df50SFrank Blaschka dev_kfree_skb_any(skb); 7264a71df50SFrank Blaschka if (card->options.performance_stats) { 7274a71df50SFrank Blaschka if (large_send != QETH_LARGE_SEND_NO) { 7284a71df50SFrank Blaschka card->perf_stats.large_send_bytes += tx_bytes; 7294a71df50SFrank Blaschka card->perf_stats.large_send_cnt++; 7304a71df50SFrank Blaschka } 7314a71df50SFrank Blaschka if (skb_shinfo(new_skb)->nr_frags > 0) { 7324a71df50SFrank Blaschka card->perf_stats.sg_skbs_sent++; 7334a71df50SFrank Blaschka /* nr_frags + skb->data */ 7344a71df50SFrank Blaschka card->perf_stats.sg_frags_sent += 7354a71df50SFrank Blaschka skb_shinfo(new_skb)->nr_frags + 1; 7364a71df50SFrank Blaschka } 7374a71df50SFrank Blaschka } 7384a71df50SFrank Blaschka 7394a71df50SFrank Blaschka if (ctx != NULL) { 7404a71df50SFrank Blaschka qeth_eddp_put_context(ctx); 7414a71df50SFrank Blaschka dev_kfree_skb_any(new_skb); 7424a71df50SFrank Blaschka } 7434a71df50SFrank Blaschka } else { 7444a71df50SFrank Blaschka if (ctx != NULL) 7454a71df50SFrank Blaschka qeth_eddp_put_context(ctx); 7464a71df50SFrank Blaschka 747683d718aSFrank Blaschka if (data_offset >= 0) 748683d718aSFrank Blaschka kmem_cache_free(qeth_core_header_cache, hdr); 749683d718aSFrank Blaschka 7504a71df50SFrank Blaschka if (rc == -EBUSY) { 7514a71df50SFrank Blaschka if (new_skb != skb) 7524a71df50SFrank Blaschka dev_kfree_skb_any(new_skb); 7534a71df50SFrank Blaschka return NETDEV_TX_BUSY; 7544a71df50SFrank Blaschka } else 7554a71df50SFrank Blaschka goto tx_drop; 7564a71df50SFrank Blaschka } 7574a71df50SFrank Blaschka 7584a71df50SFrank Blaschka netif_wake_queue(dev); 7594a71df50SFrank Blaschka if (card->options.performance_stats) 7604a71df50SFrank Blaschka card->perf_stats.outbound_time += qeth_get_micros() - 7614a71df50SFrank Blaschka card->perf_stats.outbound_start_time; 7624a71df50SFrank Blaschka return rc; 7634a71df50SFrank Blaschka 7644a71df50SFrank Blaschka tx_drop: 7654a71df50SFrank Blaschka card->stats.tx_dropped++; 7664a71df50SFrank Blaschka card->stats.tx_errors++; 7674a71df50SFrank Blaschka if ((new_skb != skb) && new_skb) 7684a71df50SFrank Blaschka dev_kfree_skb_any(new_skb); 7694a71df50SFrank Blaschka dev_kfree_skb_any(skb); 770d0ec0f54SFrank Blaschka netif_wake_queue(dev); 7714a71df50SFrank Blaschka return NETDEV_TX_OK; 7724a71df50SFrank Blaschka } 7734a71df50SFrank Blaschka 7744a71df50SFrank Blaschka static void qeth_l2_qdio_input_handler(struct ccw_device *ccwdev, 775779e6e1cSJan Glauber unsigned int qdio_err, unsigned int queue, 7764a71df50SFrank Blaschka int first_element, int count, unsigned long card_ptr) 7774a71df50SFrank Blaschka { 7784a71df50SFrank Blaschka struct net_device *net_dev; 7794a71df50SFrank Blaschka struct qeth_card *card; 7804a71df50SFrank Blaschka struct qeth_qdio_buffer *buffer; 7814a71df50SFrank Blaschka int index; 7824a71df50SFrank Blaschka int i; 7834a71df50SFrank Blaschka 7844a71df50SFrank Blaschka card = (struct qeth_card *) card_ptr; 7854a71df50SFrank Blaschka net_dev = card->dev; 7864a71df50SFrank Blaschka if (card->options.performance_stats) { 7874a71df50SFrank Blaschka card->perf_stats.inbound_cnt++; 7884a71df50SFrank Blaschka card->perf_stats.inbound_start_time = qeth_get_micros(); 7894a71df50SFrank Blaschka } 790779e6e1cSJan Glauber if (qdio_err & QDIO_ERROR_ACTIVATE_CHECK_CONDITION) { 791d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 1, "qdinchk"); 792d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(TRACE, 1, "%s", CARD_BUS_ID(card)); 793d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(TRACE, 1, "%04X%04X", first_element, 7944a71df50SFrank Blaschka count); 795779e6e1cSJan Glauber QETH_DBF_TEXT_(TRACE, 1, "%04X", queue); 7964a71df50SFrank Blaschka qeth_schedule_recovery(card); 7974a71df50SFrank Blaschka return; 7984a71df50SFrank Blaschka } 7994a71df50SFrank Blaschka for (i = first_element; i < (first_element + count); ++i) { 8004a71df50SFrank Blaschka index = i % QDIO_MAX_BUFFERS_PER_Q; 8014a71df50SFrank Blaschka buffer = &card->qdio.in_q->bufs[index]; 802779e6e1cSJan Glauber if (!(qdio_err && 803779e6e1cSJan Glauber qeth_check_qdio_errors(buffer->buffer, qdio_err, "qinerr"))) 8044a71df50SFrank Blaschka qeth_l2_process_inbound_buffer(card, buffer, index); 8054a71df50SFrank Blaschka /* clear buffer and give back to hardware */ 8064a71df50SFrank Blaschka qeth_put_buffer_pool_entry(card, buffer->pool_entry); 8074a71df50SFrank Blaschka qeth_queue_input_buffer(card, index); 8084a71df50SFrank Blaschka } 8094a71df50SFrank Blaschka if (card->options.performance_stats) 8104a71df50SFrank Blaschka card->perf_stats.inbound_time += qeth_get_micros() - 8114a71df50SFrank Blaschka card->perf_stats.inbound_start_time; 8124a71df50SFrank Blaschka } 8134a71df50SFrank Blaschka 8144a71df50SFrank Blaschka static int qeth_l2_open(struct net_device *dev) 8154a71df50SFrank Blaschka { 816509e2562SHeiko Carstens struct qeth_card *card = dev->ml_priv; 8174a71df50SFrank Blaschka 818d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 4, "qethopen"); 8194a71df50SFrank Blaschka if (card->state != CARD_STATE_SOFTSETUP) 8204a71df50SFrank Blaschka return -ENODEV; 8214a71df50SFrank Blaschka 8224a71df50SFrank Blaschka if ((card->info.type != QETH_CARD_TYPE_OSN) && 8234a71df50SFrank Blaschka (!(card->info.mac_bits & QETH_LAYER2_MAC_REGISTERED))) { 824d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 4, "nomacadr"); 8254a71df50SFrank Blaschka return -EPERM; 8264a71df50SFrank Blaschka } 8274a71df50SFrank Blaschka card->data.state = CH_STATE_UP; 8284a71df50SFrank Blaschka card->state = CARD_STATE_UP; 8294a71df50SFrank Blaschka netif_start_queue(dev); 8304a71df50SFrank Blaschka 8314a71df50SFrank Blaschka if (!card->lan_online && netif_carrier_ok(dev)) 8324a71df50SFrank Blaschka netif_carrier_off(dev); 8334a71df50SFrank Blaschka return 0; 8344a71df50SFrank Blaschka } 8354a71df50SFrank Blaschka 8364a71df50SFrank Blaschka 8374a71df50SFrank Blaschka static int qeth_l2_stop(struct net_device *dev) 8384a71df50SFrank Blaschka { 839509e2562SHeiko Carstens struct qeth_card *card = dev->ml_priv; 8404a71df50SFrank Blaschka 841d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 4, "qethstop"); 8424a71df50SFrank Blaschka netif_tx_disable(dev); 8434a71df50SFrank Blaschka if (card->state == CARD_STATE_UP) 8444a71df50SFrank Blaschka card->state = CARD_STATE_SOFTSETUP; 8454a71df50SFrank Blaschka return 0; 8464a71df50SFrank Blaschka } 8474a71df50SFrank Blaschka 8484a71df50SFrank Blaschka static int qeth_l2_probe_device(struct ccwgroup_device *gdev) 8494a71df50SFrank Blaschka { 8504a71df50SFrank Blaschka struct qeth_card *card = dev_get_drvdata(&gdev->dev); 8514a71df50SFrank Blaschka 8524a71df50SFrank Blaschka INIT_LIST_HEAD(&card->vid_list); 8534a71df50SFrank Blaschka INIT_LIST_HEAD(&card->mc_list); 8544a71df50SFrank Blaschka card->options.layer2 = 1; 8554a71df50SFrank Blaschka card->discipline.input_handler = (qdio_handler_t *) 8564a71df50SFrank Blaschka qeth_l2_qdio_input_handler; 8574a71df50SFrank Blaschka card->discipline.output_handler = (qdio_handler_t *) 8584a71df50SFrank Blaschka qeth_qdio_output_handler; 8594a71df50SFrank Blaschka card->discipline.recover = qeth_l2_recover; 8604a71df50SFrank Blaschka return 0; 8614a71df50SFrank Blaschka } 8624a71df50SFrank Blaschka 8634a71df50SFrank Blaschka static void qeth_l2_remove_device(struct ccwgroup_device *cgdev) 8644a71df50SFrank Blaschka { 8654a71df50SFrank Blaschka struct qeth_card *card = dev_get_drvdata(&cgdev->dev); 8664a71df50SFrank Blaschka 8674a71df50SFrank Blaschka wait_event(card->wait_q, qeth_threads_running(card, 0xffffffff) == 0); 8684a71df50SFrank Blaschka 8694a71df50SFrank Blaschka if (cgdev->state == CCWGROUP_ONLINE) { 8704a71df50SFrank Blaschka card->use_hard_stop = 1; 8714a71df50SFrank Blaschka qeth_l2_set_offline(cgdev); 8724a71df50SFrank Blaschka } 8734a71df50SFrank Blaschka 8744a71df50SFrank Blaschka if (card->dev) { 8754a71df50SFrank Blaschka unregister_netdev(card->dev); 8764a71df50SFrank Blaschka card->dev = NULL; 8774a71df50SFrank Blaschka } 8784a71df50SFrank Blaschka 8794a71df50SFrank Blaschka qeth_l2_del_all_mc(card); 8804a71df50SFrank Blaschka return; 8814a71df50SFrank Blaschka } 8824a71df50SFrank Blaschka 883efe3df6fSFrank Blaschka static int qeth_l2_ethtool_set_tso(struct net_device *dev, u32 data) 884efe3df6fSFrank Blaschka { 885509e2562SHeiko Carstens struct qeth_card *card = dev->ml_priv; 886efe3df6fSFrank Blaschka 887efe3df6fSFrank Blaschka if (data) { 888efe3df6fSFrank Blaschka if (card->options.large_send == QETH_LARGE_SEND_NO) { 889efe3df6fSFrank Blaschka card->options.large_send = QETH_LARGE_SEND_EDDP; 890efe3df6fSFrank Blaschka dev->features |= NETIF_F_TSO; 891efe3df6fSFrank Blaschka } 892efe3df6fSFrank Blaschka } else { 893efe3df6fSFrank Blaschka dev->features &= ~NETIF_F_TSO; 894efe3df6fSFrank Blaschka card->options.large_send = QETH_LARGE_SEND_NO; 895efe3df6fSFrank Blaschka } 896efe3df6fSFrank Blaschka return 0; 897efe3df6fSFrank Blaschka } 898efe3df6fSFrank Blaschka 8994a71df50SFrank Blaschka static struct ethtool_ops qeth_l2_ethtool_ops = { 9004a71df50SFrank Blaschka .get_link = ethtool_op_get_link, 9014a71df50SFrank Blaschka .get_tx_csum = ethtool_op_get_tx_csum, 9024a71df50SFrank Blaschka .set_tx_csum = ethtool_op_set_tx_hw_csum, 9034a71df50SFrank Blaschka .get_sg = ethtool_op_get_sg, 9044a71df50SFrank Blaschka .set_sg = ethtool_op_set_sg, 9054a71df50SFrank Blaschka .get_tso = ethtool_op_get_tso, 906efe3df6fSFrank Blaschka .set_tso = qeth_l2_ethtool_set_tso, 9074a71df50SFrank Blaschka .get_strings = qeth_core_get_strings, 9084a71df50SFrank Blaschka .get_ethtool_stats = qeth_core_get_ethtool_stats, 9094a71df50SFrank Blaschka .get_stats_count = qeth_core_get_stats_count, 9104a71df50SFrank Blaschka .get_drvinfo = qeth_core_get_drvinfo, 9113f9975aaSFrank Blaschka .get_settings = qeth_core_ethtool_get_settings, 9124a71df50SFrank Blaschka }; 9134a71df50SFrank Blaschka 9144a71df50SFrank Blaschka static struct ethtool_ops qeth_l2_osn_ops = { 9154a71df50SFrank Blaschka .get_strings = qeth_core_get_strings, 9164a71df50SFrank Blaschka .get_ethtool_stats = qeth_core_get_ethtool_stats, 9174a71df50SFrank Blaschka .get_stats_count = qeth_core_get_stats_count, 9184a71df50SFrank Blaschka .get_drvinfo = qeth_core_get_drvinfo, 9194a71df50SFrank Blaschka }; 9204a71df50SFrank Blaschka 9214a71df50SFrank Blaschka static int qeth_l2_setup_netdev(struct qeth_card *card) 9224a71df50SFrank Blaschka { 9234a71df50SFrank Blaschka switch (card->info.type) { 9244a71df50SFrank Blaschka case QETH_CARD_TYPE_OSAE: 9254a71df50SFrank Blaschka card->dev = alloc_etherdev(0); 9264a71df50SFrank Blaschka break; 9274a71df50SFrank Blaschka case QETH_CARD_TYPE_IQD: 9284a71df50SFrank Blaschka card->dev = alloc_netdev(0, "hsi%d", ether_setup); 9294a71df50SFrank Blaschka break; 9304a71df50SFrank Blaschka case QETH_CARD_TYPE_OSN: 9314a71df50SFrank Blaschka card->dev = alloc_netdev(0, "osn%d", ether_setup); 9324a71df50SFrank Blaschka card->dev->flags |= IFF_NOARP; 9334a71df50SFrank Blaschka break; 9344a71df50SFrank Blaschka default: 9354a71df50SFrank Blaschka card->dev = alloc_etherdev(0); 9364a71df50SFrank Blaschka } 9374a71df50SFrank Blaschka 9384a71df50SFrank Blaschka if (!card->dev) 9394a71df50SFrank Blaschka return -ENODEV; 9404a71df50SFrank Blaschka 941509e2562SHeiko Carstens card->dev->ml_priv = card; 9424a71df50SFrank Blaschka card->dev->tx_timeout = &qeth_tx_timeout; 9434a71df50SFrank Blaschka card->dev->watchdog_timeo = QETH_TX_TIMEOUT; 9444a71df50SFrank Blaschka card->dev->open = qeth_l2_open; 9454a71df50SFrank Blaschka card->dev->stop = qeth_l2_stop; 9464a71df50SFrank Blaschka card->dev->hard_start_xmit = qeth_l2_hard_start_xmit; 9474a71df50SFrank Blaschka card->dev->do_ioctl = qeth_l2_do_ioctl; 9484a71df50SFrank Blaschka card->dev->get_stats = qeth_get_stats; 9494a71df50SFrank Blaschka card->dev->change_mtu = qeth_change_mtu; 9504a71df50SFrank Blaschka card->dev->set_multicast_list = qeth_l2_set_multicast_list; 9514a71df50SFrank Blaschka card->dev->vlan_rx_kill_vid = qeth_l2_vlan_rx_kill_vid; 9524a71df50SFrank Blaschka card->dev->vlan_rx_add_vid = qeth_l2_vlan_rx_add_vid; 9534a71df50SFrank Blaschka card->dev->set_mac_address = qeth_l2_set_mac_address; 9544a71df50SFrank Blaschka card->dev->mtu = card->info.initial_mtu; 9554a71df50SFrank Blaschka if (card->info.type != QETH_CARD_TYPE_OSN) 9564a71df50SFrank Blaschka SET_ETHTOOL_OPS(card->dev, &qeth_l2_ethtool_ops); 9574a71df50SFrank Blaschka else 9584a71df50SFrank Blaschka SET_ETHTOOL_OPS(card->dev, &qeth_l2_osn_ops); 9594a71df50SFrank Blaschka card->dev->features |= NETIF_F_HW_VLAN_FILTER; 9604a71df50SFrank Blaschka card->info.broadcast_capable = 1; 9614a71df50SFrank Blaschka qeth_l2_request_initial_mac(card); 9624a71df50SFrank Blaschka SET_NETDEV_DEV(card->dev, &card->gdev->dev); 9634a71df50SFrank Blaschka return register_netdev(card->dev); 9644a71df50SFrank Blaschka } 9654a71df50SFrank Blaschka 9664a71df50SFrank Blaschka static int __qeth_l2_set_online(struct ccwgroup_device *gdev, int recovery_mode) 9674a71df50SFrank Blaschka { 9684a71df50SFrank Blaschka struct qeth_card *card = dev_get_drvdata(&gdev->dev); 9694a71df50SFrank Blaschka int rc = 0; 9704a71df50SFrank Blaschka enum qeth_card_states recover_flag; 9714a71df50SFrank Blaschka 9724a71df50SFrank Blaschka BUG_ON(!card); 973d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 2, "setonlin"); 974d11ba0c4SPeter Tiedemann QETH_DBF_HEX(SETUP, 2, &card, sizeof(void *)); 9754a71df50SFrank Blaschka 9764a71df50SFrank Blaschka qeth_set_allowed_threads(card, QETH_RECOVER_THREAD, 1); 9774a71df50SFrank Blaschka recover_flag = card->state; 9784a71df50SFrank Blaschka rc = ccw_device_set_online(CARD_RDEV(card)); 9794a71df50SFrank Blaschka if (rc) { 980d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "1err%d", rc); 9814a71df50SFrank Blaschka return -EIO; 9824a71df50SFrank Blaschka } 9834a71df50SFrank Blaschka rc = ccw_device_set_online(CARD_WDEV(card)); 9844a71df50SFrank Blaschka if (rc) { 985d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "1err%d", rc); 9864a71df50SFrank Blaschka return -EIO; 9874a71df50SFrank Blaschka } 9884a71df50SFrank Blaschka rc = ccw_device_set_online(CARD_DDEV(card)); 9894a71df50SFrank Blaschka if (rc) { 990d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "1err%d", rc); 9914a71df50SFrank Blaschka return -EIO; 9924a71df50SFrank Blaschka } 9934a71df50SFrank Blaschka 9944a71df50SFrank Blaschka rc = qeth_core_hardsetup_card(card); 9954a71df50SFrank Blaschka if (rc) { 996d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "2err%d", rc); 9974a71df50SFrank Blaschka goto out_remove; 9984a71df50SFrank Blaschka } 9994a71df50SFrank Blaschka 10004a71df50SFrank Blaschka if (!card->dev && qeth_l2_setup_netdev(card)) 10014a71df50SFrank Blaschka goto out_remove; 10024a71df50SFrank Blaschka 10034a71df50SFrank Blaschka if (card->info.type != QETH_CARD_TYPE_OSN) 10044a71df50SFrank Blaschka qeth_l2_send_setmac(card, &card->dev->dev_addr[0]); 10054a71df50SFrank Blaschka 10064a71df50SFrank Blaschka card->state = CARD_STATE_HARDSETUP; 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; 10194a71df50SFrank Blaschka } 10204a71df50SFrank Blaschka return rc; 10214a71df50SFrank Blaschka } else 10224a71df50SFrank Blaschka card->lan_online = 1; 10234a71df50SFrank Blaschka 10244a71df50SFrank Blaschka if (card->info.type != QETH_CARD_TYPE_OSN) { 10254a71df50SFrank Blaschka qeth_set_large_send(card, card->options.large_send); 10264a71df50SFrank Blaschka qeth_l2_process_vlans(card, 0); 10274a71df50SFrank Blaschka } 10284a71df50SFrank Blaschka 10294a71df50SFrank Blaschka netif_tx_disable(card->dev); 10304a71df50SFrank Blaschka 10314a71df50SFrank Blaschka rc = qeth_init_qdio_queues(card); 10324a71df50SFrank Blaschka if (rc) { 1033d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "6err%d", rc); 10344a71df50SFrank Blaschka goto out_remove; 10354a71df50SFrank Blaschka } 10364a71df50SFrank Blaschka card->state = CARD_STATE_SOFTSETUP; 10374a71df50SFrank Blaschka netif_carrier_on(card->dev); 10384a71df50SFrank Blaschka 10394a71df50SFrank Blaschka qeth_set_allowed_threads(card, 0xffffffff, 0); 10404a71df50SFrank Blaschka if (recover_flag == CARD_STATE_RECOVER) { 10414a71df50SFrank Blaschka if (recovery_mode && 10424a71df50SFrank Blaschka card->info.type != QETH_CARD_TYPE_OSN) { 10434a71df50SFrank Blaschka qeth_l2_open(card->dev); 10444a71df50SFrank Blaschka } else { 10454a71df50SFrank Blaschka rtnl_lock(); 10464a71df50SFrank Blaschka dev_open(card->dev); 10474a71df50SFrank Blaschka rtnl_unlock(); 10484a71df50SFrank Blaschka } 10494a71df50SFrank Blaschka /* this also sets saved unicast addresses */ 10504a71df50SFrank Blaschka qeth_l2_set_multicast_list(card->dev); 10514a71df50SFrank Blaschka } 10524a71df50SFrank Blaschka /* let user_space know that device is online */ 10534a71df50SFrank Blaschka kobject_uevent(&gdev->dev.kobj, KOBJ_CHANGE); 10544a71df50SFrank Blaschka return 0; 10554a71df50SFrank Blaschka out_remove: 10564a71df50SFrank Blaschka card->use_hard_stop = 1; 10574a71df50SFrank Blaschka qeth_l2_stop_card(card, 0); 10584a71df50SFrank Blaschka ccw_device_set_offline(CARD_DDEV(card)); 10594a71df50SFrank Blaschka ccw_device_set_offline(CARD_WDEV(card)); 10604a71df50SFrank Blaschka ccw_device_set_offline(CARD_RDEV(card)); 10614a71df50SFrank Blaschka if (recover_flag == CARD_STATE_RECOVER) 10624a71df50SFrank Blaschka card->state = CARD_STATE_RECOVER; 10634a71df50SFrank Blaschka else 10644a71df50SFrank Blaschka card->state = CARD_STATE_DOWN; 10654a71df50SFrank Blaschka return -ENODEV; 10664a71df50SFrank Blaschka } 10674a71df50SFrank Blaschka 10684a71df50SFrank Blaschka static int qeth_l2_set_online(struct ccwgroup_device *gdev) 10694a71df50SFrank Blaschka { 10704a71df50SFrank Blaschka return __qeth_l2_set_online(gdev, 0); 10714a71df50SFrank Blaschka } 10724a71df50SFrank Blaschka 10734a71df50SFrank Blaschka static int __qeth_l2_set_offline(struct ccwgroup_device *cgdev, 10744a71df50SFrank Blaschka int recovery_mode) 10754a71df50SFrank Blaschka { 10764a71df50SFrank Blaschka struct qeth_card *card = dev_get_drvdata(&cgdev->dev); 10774a71df50SFrank Blaschka int rc = 0, rc2 = 0, rc3 = 0; 10784a71df50SFrank Blaschka enum qeth_card_states recover_flag; 10794a71df50SFrank Blaschka 1080d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(SETUP, 3, "setoffl"); 1081d11ba0c4SPeter Tiedemann QETH_DBF_HEX(SETUP, 3, &card, sizeof(void *)); 10824a71df50SFrank Blaschka 10834a71df50SFrank Blaschka if (card->dev && netif_carrier_ok(card->dev)) 10844a71df50SFrank Blaschka netif_carrier_off(card->dev); 10854a71df50SFrank Blaschka recover_flag = card->state; 10860f5623c9SUrsula Braun qeth_l2_stop_card(card, recovery_mode); 10874a71df50SFrank Blaschka rc = ccw_device_set_offline(CARD_DDEV(card)); 10884a71df50SFrank Blaschka rc2 = ccw_device_set_offline(CARD_WDEV(card)); 10894a71df50SFrank Blaschka rc3 = ccw_device_set_offline(CARD_RDEV(card)); 10904a71df50SFrank Blaschka if (!rc) 10914a71df50SFrank Blaschka rc = (rc2) ? rc2 : rc3; 10924a71df50SFrank Blaschka if (rc) 1093d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(SETUP, 2, "1err%d", rc); 10944a71df50SFrank Blaschka if (recover_flag == CARD_STATE_UP) 10954a71df50SFrank Blaschka card->state = CARD_STATE_RECOVER; 10964a71df50SFrank Blaschka /* let user_space know that device is offline */ 10974a71df50SFrank Blaschka kobject_uevent(&cgdev->dev.kobj, KOBJ_CHANGE); 10984a71df50SFrank Blaschka return 0; 10994a71df50SFrank Blaschka } 11004a71df50SFrank Blaschka 11014a71df50SFrank Blaschka static int qeth_l2_set_offline(struct ccwgroup_device *cgdev) 11024a71df50SFrank Blaschka { 11034a71df50SFrank Blaschka return __qeth_l2_set_offline(cgdev, 0); 11044a71df50SFrank Blaschka } 11054a71df50SFrank Blaschka 11064a71df50SFrank Blaschka static int qeth_l2_recover(void *ptr) 11074a71df50SFrank Blaschka { 11084a71df50SFrank Blaschka struct qeth_card *card; 11094a71df50SFrank Blaschka int rc = 0; 11104a71df50SFrank Blaschka 11114a71df50SFrank Blaschka card = (struct qeth_card *) ptr; 1112d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 2, "recover1"); 1113d11ba0c4SPeter Tiedemann QETH_DBF_HEX(TRACE, 2, &card, sizeof(void *)); 11144a71df50SFrank Blaschka if (!qeth_do_run_thread(card, QETH_RECOVER_THREAD)) 11154a71df50SFrank Blaschka return 0; 1116d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 2, "recover2"); 111774eacdb9SFrank Blaschka dev_warn(&card->gdev->dev, 111874eacdb9SFrank Blaschka "A recovery process has been started for the device\n"); 11194a71df50SFrank Blaschka card->use_hard_stop = 1; 11204a71df50SFrank Blaschka __qeth_l2_set_offline(card->gdev, 1); 11214a71df50SFrank Blaschka rc = __qeth_l2_set_online(card->gdev, 1); 11224a71df50SFrank Blaschka /* don't run another scheduled recovery */ 11234a71df50SFrank Blaschka qeth_clear_thread_start_bit(card, QETH_RECOVER_THREAD); 11244a71df50SFrank Blaschka qeth_clear_thread_running_bit(card, QETH_RECOVER_THREAD); 11254a71df50SFrank Blaschka if (!rc) 112674eacdb9SFrank Blaschka dev_info(&card->gdev->dev, 112774eacdb9SFrank Blaschka "Device successfully recovered!\n"); 112828a7e4c9SUrsula Braun else { 1129fc9c2460SUrsula Braun if (card->dev) { 113028a7e4c9SUrsula Braun rtnl_lock(); 113128a7e4c9SUrsula Braun dev_close(card->dev); 113228a7e4c9SUrsula Braun rtnl_unlock(); 1133fc9c2460SUrsula Braun } 113474eacdb9SFrank Blaschka dev_warn(&card->gdev->dev, "The qeth device driver " 113574eacdb9SFrank Blaschka "failed to recover an error on the device\n"); 113628a7e4c9SUrsula Braun } 11374a71df50SFrank Blaschka return 0; 11384a71df50SFrank Blaschka } 11394a71df50SFrank Blaschka 11404a71df50SFrank Blaschka static int __init qeth_l2_init(void) 11414a71df50SFrank Blaschka { 114274eacdb9SFrank Blaschka pr_info("register layer 2 discipline\n"); 11434a71df50SFrank Blaschka return 0; 11444a71df50SFrank Blaschka } 11454a71df50SFrank Blaschka 11464a71df50SFrank Blaschka static void __exit qeth_l2_exit(void) 11474a71df50SFrank Blaschka { 114874eacdb9SFrank Blaschka pr_info("unregister layer 2 discipline\n"); 11494a71df50SFrank Blaschka } 11504a71df50SFrank Blaschka 11514a71df50SFrank Blaschka static void qeth_l2_shutdown(struct ccwgroup_device *gdev) 11524a71df50SFrank Blaschka { 11534a71df50SFrank Blaschka struct qeth_card *card = dev_get_drvdata(&gdev->dev); 11544a71df50SFrank Blaschka qeth_qdio_clear_card(card, 0); 11554a71df50SFrank Blaschka qeth_clear_qdio_buffers(card); 11564a71df50SFrank Blaschka } 11574a71df50SFrank Blaschka 11584a71df50SFrank Blaschka struct ccwgroup_driver qeth_l2_ccwgroup_driver = { 11594a71df50SFrank Blaschka .probe = qeth_l2_probe_device, 11604a71df50SFrank Blaschka .remove = qeth_l2_remove_device, 11614a71df50SFrank Blaschka .set_online = qeth_l2_set_online, 11624a71df50SFrank Blaschka .set_offline = qeth_l2_set_offline, 11634a71df50SFrank Blaschka .shutdown = qeth_l2_shutdown, 11644a71df50SFrank Blaschka }; 11654a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_l2_ccwgroup_driver); 11664a71df50SFrank Blaschka 11674a71df50SFrank Blaschka static int qeth_osn_send_control_data(struct qeth_card *card, int len, 11684a71df50SFrank Blaschka struct qeth_cmd_buffer *iob) 11694a71df50SFrank Blaschka { 11704a71df50SFrank Blaschka unsigned long flags; 11714a71df50SFrank Blaschka int rc = 0; 11724a71df50SFrank Blaschka 1173d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 5, "osndctrd"); 11744a71df50SFrank Blaschka 11754a71df50SFrank Blaschka wait_event(card->wait_q, 11764a71df50SFrank Blaschka atomic_cmpxchg(&card->write.irq_pending, 0, 1) == 0); 11774a71df50SFrank Blaschka qeth_prepare_control_data(card, len, iob); 1178d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 6, "osnoirqp"); 11794a71df50SFrank Blaschka spin_lock_irqsave(get_ccwdev_lock(card->write.ccwdev), flags); 11804a71df50SFrank Blaschka rc = ccw_device_start(card->write.ccwdev, &card->write.ccw, 11814a71df50SFrank Blaschka (addr_t) iob, 0, 0); 11824a71df50SFrank Blaschka spin_unlock_irqrestore(get_ccwdev_lock(card->write.ccwdev), flags); 11834a71df50SFrank Blaschka if (rc) { 118414cc21b6SFrank Blaschka QETH_DBF_MESSAGE(2, "qeth_osn_send_control_data: " 11854a71df50SFrank Blaschka "ccw_device_start rc = %i\n", rc); 1186d11ba0c4SPeter Tiedemann QETH_DBF_TEXT_(TRACE, 2, " err%d", rc); 11874a71df50SFrank Blaschka qeth_release_buffer(iob->channel, iob); 11884a71df50SFrank Blaschka atomic_set(&card->write.irq_pending, 0); 11894a71df50SFrank Blaschka wake_up(&card->wait_q); 11904a71df50SFrank Blaschka } 11914a71df50SFrank Blaschka return rc; 11924a71df50SFrank Blaschka } 11934a71df50SFrank Blaschka 11944a71df50SFrank Blaschka static int qeth_osn_send_ipa_cmd(struct qeth_card *card, 11954a71df50SFrank Blaschka struct qeth_cmd_buffer *iob, int data_len) 11964a71df50SFrank Blaschka { 11974a71df50SFrank Blaschka u16 s1, s2; 11984a71df50SFrank Blaschka 1199d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 4, "osndipa"); 12004a71df50SFrank Blaschka 12014a71df50SFrank Blaschka qeth_prepare_ipa_cmd(card, iob, QETH_PROT_OSN2); 12024a71df50SFrank Blaschka s1 = (u16)(IPA_PDU_HEADER_SIZE + data_len); 12034a71df50SFrank Blaschka s2 = (u16)data_len; 12044a71df50SFrank Blaschka memcpy(QETH_IPA_PDU_LEN_TOTAL(iob->data), &s1, 2); 12054a71df50SFrank Blaschka memcpy(QETH_IPA_PDU_LEN_PDU1(iob->data), &s2, 2); 12064a71df50SFrank Blaschka memcpy(QETH_IPA_PDU_LEN_PDU2(iob->data), &s2, 2); 12074a71df50SFrank Blaschka memcpy(QETH_IPA_PDU_LEN_PDU3(iob->data), &s2, 2); 12084a71df50SFrank Blaschka return qeth_osn_send_control_data(card, s1, iob); 12094a71df50SFrank Blaschka } 12104a71df50SFrank Blaschka 12114a71df50SFrank Blaschka int qeth_osn_assist(struct net_device *dev, void *data, int data_len) 12124a71df50SFrank Blaschka { 12134a71df50SFrank Blaschka struct qeth_cmd_buffer *iob; 12144a71df50SFrank Blaschka struct qeth_card *card; 12154a71df50SFrank Blaschka int rc; 12164a71df50SFrank Blaschka 1217d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 2, "osnsdmc"); 12184a71df50SFrank Blaschka if (!dev) 12194a71df50SFrank Blaschka return -ENODEV; 1220509e2562SHeiko Carstens card = dev->ml_priv; 12214a71df50SFrank Blaschka if (!card) 12224a71df50SFrank Blaschka return -ENODEV; 12234a71df50SFrank Blaschka if ((card->state != CARD_STATE_UP) && 12244a71df50SFrank Blaschka (card->state != CARD_STATE_SOFTSETUP)) 12254a71df50SFrank Blaschka return -ENODEV; 12264a71df50SFrank Blaschka iob = qeth_wait_for_buffer(&card->write); 12274a71df50SFrank Blaschka memcpy(iob->data+IPA_PDU_HEADER_SIZE, data, data_len); 12284a71df50SFrank Blaschka rc = qeth_osn_send_ipa_cmd(card, iob, data_len); 12294a71df50SFrank Blaschka return rc; 12304a71df50SFrank Blaschka } 12314a71df50SFrank Blaschka EXPORT_SYMBOL(qeth_osn_assist); 12324a71df50SFrank Blaschka 12334a71df50SFrank Blaschka int qeth_osn_register(unsigned char *read_dev_no, struct net_device **dev, 12344a71df50SFrank Blaschka int (*assist_cb)(struct net_device *, void *), 12354a71df50SFrank Blaschka int (*data_cb)(struct sk_buff *)) 12364a71df50SFrank Blaschka { 12374a71df50SFrank Blaschka struct qeth_card *card; 12384a71df50SFrank Blaschka 1239d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 2, "osnreg"); 12404a71df50SFrank Blaschka *dev = qeth_l2_netdev_by_devno(read_dev_no); 12414a71df50SFrank Blaschka if (*dev == NULL) 12424a71df50SFrank Blaschka return -ENODEV; 1243509e2562SHeiko Carstens card = (*dev)->ml_priv; 12444a71df50SFrank Blaschka if (!card) 12454a71df50SFrank Blaschka return -ENODEV; 12464a71df50SFrank Blaschka if ((assist_cb == NULL) || (data_cb == NULL)) 12474a71df50SFrank Blaschka return -EINVAL; 12484a71df50SFrank Blaschka card->osn_info.assist_cb = assist_cb; 12494a71df50SFrank Blaschka card->osn_info.data_cb = data_cb; 12504a71df50SFrank Blaschka return 0; 12514a71df50SFrank Blaschka } 12524a71df50SFrank Blaschka EXPORT_SYMBOL(qeth_osn_register); 12534a71df50SFrank Blaschka 12544a71df50SFrank Blaschka void qeth_osn_deregister(struct net_device *dev) 12554a71df50SFrank Blaschka { 12564a71df50SFrank Blaschka struct qeth_card *card; 12574a71df50SFrank Blaschka 1258d11ba0c4SPeter Tiedemann QETH_DBF_TEXT(TRACE, 2, "osndereg"); 12594a71df50SFrank Blaschka if (!dev) 12604a71df50SFrank Blaschka return; 1261509e2562SHeiko Carstens card = dev->ml_priv; 12624a71df50SFrank Blaschka if (!card) 12634a71df50SFrank Blaschka return; 12644a71df50SFrank Blaschka card->osn_info.assist_cb = NULL; 12654a71df50SFrank Blaschka card->osn_info.data_cb = NULL; 12664a71df50SFrank Blaschka return; 12674a71df50SFrank Blaschka } 12684a71df50SFrank Blaschka EXPORT_SYMBOL(qeth_osn_deregister); 12694a71df50SFrank Blaschka 12704a71df50SFrank Blaschka module_init(qeth_l2_init); 12714a71df50SFrank Blaschka module_exit(qeth_l2_exit); 12724a71df50SFrank Blaschka MODULE_AUTHOR("Frank Blaschka <frank.blaschka@de.ibm.com>"); 12734a71df50SFrank Blaschka MODULE_DESCRIPTION("qeth layer 2 discipline"); 12744a71df50SFrank Blaschka MODULE_LICENSE("GPL"); 1275