xref: /openbmc/linux/drivers/s390/net/qeth_l2_main.c (revision 221c17fe)
14a71df50SFrank Blaschka /*
24a71df50SFrank Blaschka  *  drivers/s390/net/qeth_l2_main.c
34a71df50SFrank Blaschka  *
4bbcfcdc8SFrank Blaschka  *    Copyright IBM Corp. 2007, 2009
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>
195a0e3ad6STejun Heo #include <linux/slab.h>
204a71df50SFrank Blaschka #include <linux/etherdevice.h>
214a71df50SFrank Blaschka #include <linux/mii.h>
224a71df50SFrank Blaschka #include <linux/ip.h>
23ccffad25SJiri Pirko #include <linux/list.h>
244a71df50SFrank Blaschka 
254a71df50SFrank Blaschka #include "qeth_core.h"
264a71df50SFrank Blaschka 
274a71df50SFrank Blaschka static int qeth_l2_set_offline(struct ccwgroup_device *);
284a71df50SFrank Blaschka static int qeth_l2_stop(struct net_device *);
294a71df50SFrank Blaschka static int qeth_l2_send_delmac(struct qeth_card *, __u8 *);
304a71df50SFrank Blaschka static int qeth_l2_send_setdelmac(struct qeth_card *, __u8 *,
314a71df50SFrank Blaschka 			   enum qeth_ipa_cmds,
324a71df50SFrank Blaschka 			   int (*reply_cb) (struct qeth_card *,
334a71df50SFrank Blaschka 					    struct qeth_reply*,
344a71df50SFrank Blaschka 					    unsigned long));
354a71df50SFrank Blaschka static void qeth_l2_set_multicast_list(struct net_device *);
364a71df50SFrank Blaschka static int qeth_l2_recover(void *);
374a71df50SFrank Blaschka 
384a71df50SFrank Blaschka static int qeth_l2_do_ioctl(struct net_device *dev, struct ifreq *rq, int cmd)
394a71df50SFrank Blaschka {
40509e2562SHeiko Carstens 	struct qeth_card *card = dev->ml_priv;
414a71df50SFrank Blaschka 	struct mii_ioctl_data *mii_data;
424a71df50SFrank Blaschka 	int rc = 0;
434a71df50SFrank Blaschka 
444a71df50SFrank Blaschka 	if (!card)
454a71df50SFrank Blaschka 		return -ENODEV;
464a71df50SFrank Blaschka 
474a71df50SFrank Blaschka 	if ((card->state != CARD_STATE_UP) &&
484a71df50SFrank Blaschka 		(card->state != CARD_STATE_SOFTSETUP))
494a71df50SFrank Blaschka 		return -ENODEV;
504a71df50SFrank Blaschka 
514a71df50SFrank Blaschka 	if (card->info.type == QETH_CARD_TYPE_OSN)
524a71df50SFrank Blaschka 		return -EPERM;
534a71df50SFrank Blaschka 
544a71df50SFrank Blaschka 	switch (cmd) {
554a71df50SFrank Blaschka 	case SIOC_QETH_ADP_SET_SNMP_CONTROL:
564a71df50SFrank Blaschka 		rc = qeth_snmp_command(card, rq->ifr_ifru.ifru_data);
574a71df50SFrank Blaschka 		break;
584a71df50SFrank Blaschka 	case SIOC_QETH_GET_CARD_TYPE:
595113fec0SUrsula Braun 		if ((card->info.type == QETH_CARD_TYPE_OSD ||
605113fec0SUrsula Braun 		     card->info.type == QETH_CARD_TYPE_OSM ||
615113fec0SUrsula Braun 		     card->info.type == QETH_CARD_TYPE_OSX) &&
624a71df50SFrank Blaschka 		    !card->info.guestlan)
634a71df50SFrank Blaschka 			return 1;
644a71df50SFrank Blaschka 		return 0;
654a71df50SFrank Blaschka 		break;
664a71df50SFrank Blaschka 	case SIOCGMIIPHY:
674a71df50SFrank Blaschka 		mii_data = if_mii(rq);
684a71df50SFrank Blaschka 		mii_data->phy_id = 0;
694a71df50SFrank Blaschka 		break;
704a71df50SFrank Blaschka 	case SIOCGMIIREG:
714a71df50SFrank Blaschka 		mii_data = if_mii(rq);
724a71df50SFrank Blaschka 		if (mii_data->phy_id != 0)
734a71df50SFrank Blaschka 			rc = -EINVAL;
744a71df50SFrank Blaschka 		else
754a71df50SFrank Blaschka 			mii_data->val_out = qeth_mdio_read(dev,
764a71df50SFrank Blaschka 				mii_data->phy_id, mii_data->reg_num);
774a71df50SFrank Blaschka 		break;
784a71df50SFrank Blaschka 	default:
794a71df50SFrank Blaschka 		rc = -EOPNOTSUPP;
804a71df50SFrank Blaschka 	}
814a71df50SFrank Blaschka 	if (rc)
82847a50fdSCarsten Otte 		QETH_CARD_TEXT_(card, 2, "ioce%d", rc);
834a71df50SFrank Blaschka 	return rc;
844a71df50SFrank Blaschka }
854a71df50SFrank Blaschka 
864a71df50SFrank Blaschka static int qeth_l2_verify_dev(struct net_device *dev)
874a71df50SFrank Blaschka {
884a71df50SFrank Blaschka 	struct qeth_card *card;
894a71df50SFrank Blaschka 	unsigned long flags;
904a71df50SFrank Blaschka 	int rc = 0;
914a71df50SFrank Blaschka 
924a71df50SFrank Blaschka 	read_lock_irqsave(&qeth_core_card_list.rwlock, flags);
934a71df50SFrank Blaschka 	list_for_each_entry(card, &qeth_core_card_list.list, list) {
944a71df50SFrank Blaschka 		if (card->dev == dev) {
954a71df50SFrank Blaschka 			rc = QETH_REAL_CARD;
964a71df50SFrank Blaschka 			break;
974a71df50SFrank Blaschka 		}
984a71df50SFrank Blaschka 	}
994a71df50SFrank Blaschka 	read_unlock_irqrestore(&qeth_core_card_list.rwlock, flags);
1004a71df50SFrank Blaschka 
1014a71df50SFrank Blaschka 	return rc;
1024a71df50SFrank Blaschka }
1034a71df50SFrank Blaschka 
1044a71df50SFrank Blaschka static struct net_device *qeth_l2_netdev_by_devno(unsigned char *read_dev_no)
1054a71df50SFrank Blaschka {
1064a71df50SFrank Blaschka 	struct qeth_card *card;
1074a71df50SFrank Blaschka 	struct net_device *ndev;
108f06f6f32SCornelia Huck 	__u16 temp_dev_no;
1094a71df50SFrank Blaschka 	unsigned long flags;
110f06f6f32SCornelia Huck 	struct ccw_dev_id read_devid;
1114a71df50SFrank Blaschka 
1124a71df50SFrank Blaschka 	ndev = NULL;
1134a71df50SFrank Blaschka 	memcpy(&temp_dev_no, read_dev_no, 2);
1144a71df50SFrank Blaschka 	read_lock_irqsave(&qeth_core_card_list.rwlock, flags);
1154a71df50SFrank Blaschka 	list_for_each_entry(card, &qeth_core_card_list.list, list) {
116f06f6f32SCornelia Huck 		ccw_device_get_id(CARD_RDEV(card), &read_devid);
117f06f6f32SCornelia Huck 		if (read_devid.devno == temp_dev_no) {
1184a71df50SFrank Blaschka 			ndev = card->dev;
1194a71df50SFrank Blaschka 			break;
1204a71df50SFrank Blaschka 		}
1214a71df50SFrank Blaschka 	}
1224a71df50SFrank Blaschka 	read_unlock_irqrestore(&qeth_core_card_list.rwlock, flags);
1234a71df50SFrank Blaschka 	return ndev;
1244a71df50SFrank Blaschka }
1254a71df50SFrank Blaschka 
1264a71df50SFrank Blaschka static int qeth_l2_send_setgroupmac_cb(struct qeth_card *card,
1274a71df50SFrank Blaschka 				struct qeth_reply *reply,
1284a71df50SFrank Blaschka 				unsigned long data)
1294a71df50SFrank Blaschka {
1304a71df50SFrank Blaschka 	struct qeth_ipa_cmd *cmd;
1314a71df50SFrank Blaschka 	__u8 *mac;
1324a71df50SFrank Blaschka 
133847a50fdSCarsten Otte 	QETH_CARD_TEXT(card, 2, "L2Sgmacb");
1344a71df50SFrank Blaschka 	cmd = (struct qeth_ipa_cmd *) data;
1354a71df50SFrank Blaschka 	mac = &cmd->data.setdelmac.mac[0];
1364a71df50SFrank Blaschka 	/* MAC already registered, needed in couple/uncouple case */
1370666eb06SUrsula Braun 	if (cmd->hdr.return_code ==  IPA_RC_L2_DUP_MAC) {
1387c510e4bSJohannes Berg 		QETH_DBF_MESSAGE(2, "Group MAC %pM already existing on %s \n",
1397c510e4bSJohannes Berg 			  mac, QETH_CARD_IFNAME(card));
1404a71df50SFrank Blaschka 		cmd->hdr.return_code = 0;
1414a71df50SFrank Blaschka 	}
1424a71df50SFrank Blaschka 	if (cmd->hdr.return_code)
1437c510e4bSJohannes Berg 		QETH_DBF_MESSAGE(2, "Could not set group MAC %pM on %s: %x\n",
1447c510e4bSJohannes Berg 			  mac, QETH_CARD_IFNAME(card), cmd->hdr.return_code);
1454a71df50SFrank Blaschka 	return 0;
1464a71df50SFrank Blaschka }
1474a71df50SFrank Blaschka 
1484a71df50SFrank Blaschka static int qeth_l2_send_setgroupmac(struct qeth_card *card, __u8 *mac)
1494a71df50SFrank Blaschka {
150847a50fdSCarsten Otte 	QETH_CARD_TEXT(card, 2, "L2Sgmac");
1514a71df50SFrank Blaschka 	return qeth_l2_send_setdelmac(card, mac, IPA_CMD_SETGMAC,
1524a71df50SFrank Blaschka 					  qeth_l2_send_setgroupmac_cb);
1534a71df50SFrank Blaschka }
1544a71df50SFrank Blaschka 
1554a71df50SFrank Blaschka static int qeth_l2_send_delgroupmac_cb(struct qeth_card *card,
1564a71df50SFrank Blaschka 				struct qeth_reply *reply,
1574a71df50SFrank Blaschka 				unsigned long data)
1584a71df50SFrank Blaschka {
1594a71df50SFrank Blaschka 	struct qeth_ipa_cmd *cmd;
1604a71df50SFrank Blaschka 	__u8 *mac;
1614a71df50SFrank Blaschka 
162847a50fdSCarsten Otte 	QETH_CARD_TEXT(card, 2, "L2Dgmacb");
1634a71df50SFrank Blaschka 	cmd = (struct qeth_ipa_cmd *) data;
1644a71df50SFrank Blaschka 	mac = &cmd->data.setdelmac.mac[0];
1654a71df50SFrank Blaschka 	if (cmd->hdr.return_code)
1667c510e4bSJohannes Berg 		QETH_DBF_MESSAGE(2, "Could not delete group MAC %pM on %s: %x\n",
1677c510e4bSJohannes Berg 			  mac, QETH_CARD_IFNAME(card), cmd->hdr.return_code);
1684a71df50SFrank Blaschka 	return 0;
1694a71df50SFrank Blaschka }
1704a71df50SFrank Blaschka 
1714a71df50SFrank Blaschka static int qeth_l2_send_delgroupmac(struct qeth_card *card, __u8 *mac)
1724a71df50SFrank Blaschka {
173847a50fdSCarsten Otte 	QETH_CARD_TEXT(card, 2, "L2Dgmac");
1744a71df50SFrank Blaschka 	return qeth_l2_send_setdelmac(card, mac, IPA_CMD_DELGMAC,
1754a71df50SFrank Blaschka 					  qeth_l2_send_delgroupmac_cb);
1764a71df50SFrank Blaschka }
1774a71df50SFrank Blaschka 
1787db2266aSFrank Blaschka static void qeth_l2_add_mc(struct qeth_card *card, __u8 *mac, int vmac)
1794a71df50SFrank Blaschka {
1804a71df50SFrank Blaschka 	struct qeth_mc_mac *mc;
1817db2266aSFrank Blaschka 	int rc;
1824a71df50SFrank Blaschka 
1834a71df50SFrank Blaschka 	mc = kmalloc(sizeof(struct qeth_mc_mac), GFP_ATOMIC);
1844a71df50SFrank Blaschka 
18514cc21b6SFrank Blaschka 	if (!mc)
1864a71df50SFrank Blaschka 		return;
1874a71df50SFrank Blaschka 
1884a71df50SFrank Blaschka 	memcpy(mc->mc_addr, mac, OSA_ADDR_LEN);
1894a71df50SFrank Blaschka 	mc->mc_addrlen = OSA_ADDR_LEN;
1907db2266aSFrank Blaschka 	mc->is_vmac = vmac;
1914a71df50SFrank Blaschka 
1927db2266aSFrank Blaschka 	if (vmac) {
1937db2266aSFrank Blaschka 		rc = qeth_l2_send_setdelmac(card, mac, IPA_CMD_SETVMAC,
1947db2266aSFrank Blaschka 					NULL);
1957db2266aSFrank Blaschka 	} else {
1967db2266aSFrank Blaschka 		rc = qeth_l2_send_setgroupmac(card, mac);
1977db2266aSFrank Blaschka 	}
1987db2266aSFrank Blaschka 
1997db2266aSFrank Blaschka 	if (!rc)
2004a71df50SFrank Blaschka 		list_add_tail(&mc->list, &card->mc_list);
2014a71df50SFrank Blaschka 	else
2024a71df50SFrank Blaschka 		kfree(mc);
2034a71df50SFrank Blaschka }
2044a71df50SFrank Blaschka 
2054a71df50SFrank Blaschka static void qeth_l2_del_all_mc(struct qeth_card *card)
2064a71df50SFrank Blaschka {
2074a71df50SFrank Blaschka 	struct qeth_mc_mac *mc, *tmp;
2084a71df50SFrank Blaschka 
2094a71df50SFrank Blaschka 	spin_lock_bh(&card->mclock);
2104a71df50SFrank Blaschka 	list_for_each_entry_safe(mc, tmp, &card->mc_list, list) {
2117db2266aSFrank Blaschka 		if (mc->is_vmac)
2127db2266aSFrank Blaschka 			qeth_l2_send_setdelmac(card, mc->mc_addr,
2137db2266aSFrank Blaschka 					IPA_CMD_DELVMAC, NULL);
2147db2266aSFrank Blaschka 		else
2154a71df50SFrank Blaschka 			qeth_l2_send_delgroupmac(card, mc->mc_addr);
2164a71df50SFrank Blaschka 		list_del(&mc->list);
2174a71df50SFrank Blaschka 		kfree(mc);
2184a71df50SFrank Blaschka 	}
2194a71df50SFrank Blaschka 	spin_unlock_bh(&card->mclock);
2204a71df50SFrank Blaschka }
2214a71df50SFrank Blaschka 
222ce73e10eSKlaus-Dieter Wacker static inline int qeth_l2_get_cast_type(struct qeth_card *card,
223ce73e10eSKlaus-Dieter Wacker 			struct sk_buff *skb)
2244a71df50SFrank Blaschka {
225ce73e10eSKlaus-Dieter Wacker 	if (card->info.type == QETH_CARD_TYPE_OSN)
226ce73e10eSKlaus-Dieter Wacker 		return RTN_UNSPEC;
227ce73e10eSKlaus-Dieter Wacker 	if (is_broadcast_ether_addr(skb->data))
228ce73e10eSKlaus-Dieter Wacker 		return RTN_BROADCAST;
229ce73e10eSKlaus-Dieter Wacker 	if (is_multicast_ether_addr(skb->data))
230ce73e10eSKlaus-Dieter Wacker 		return RTN_MULTICAST;
231ce73e10eSKlaus-Dieter Wacker 	return RTN_UNSPEC;
2324a71df50SFrank Blaschka }
2334a71df50SFrank Blaschka 
2344a71df50SFrank Blaschka static void qeth_l2_fill_header(struct qeth_card *card, struct qeth_hdr *hdr,
2354a71df50SFrank Blaschka 			struct sk_buff *skb, int ipv, int cast_type)
2364a71df50SFrank Blaschka {
237683d718aSFrank Blaschka 	struct vlan_ethhdr *veth = (struct vlan_ethhdr *)skb_mac_header(skb);
2384a71df50SFrank Blaschka 
2394a71df50SFrank Blaschka 	memset(hdr, 0, sizeof(struct qeth_hdr));
2404a71df50SFrank Blaschka 	hdr->hdr.l2.id = QETH_HEADER_TYPE_LAYER2;
2414a71df50SFrank Blaschka 
2424a71df50SFrank Blaschka 	/* set byte byte 3 to casting flags */
2434a71df50SFrank Blaschka 	if (cast_type == RTN_MULTICAST)
2444a71df50SFrank Blaschka 		hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_MULTICAST;
2454a71df50SFrank Blaschka 	else if (cast_type == RTN_BROADCAST)
2464a71df50SFrank Blaschka 		hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_BROADCAST;
2474a71df50SFrank Blaschka 	else
248ce73e10eSKlaus-Dieter Wacker 		hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_UNICAST;
2494a71df50SFrank Blaschka 
2504a71df50SFrank Blaschka 	hdr->hdr.l2.pkt_length = skb->len-QETH_HEADER_SIZE;
2514a71df50SFrank Blaschka 	/* VSWITCH relies on the VLAN
2524a71df50SFrank Blaschka 	 * information to be present in
2534a71df50SFrank Blaschka 	 * the QDIO header */
2544a71df50SFrank Blaschka 	if (veth->h_vlan_proto == __constant_htons(ETH_P_8021Q)) {
2554a71df50SFrank Blaschka 		hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_VLAN;
2564a71df50SFrank Blaschka 		hdr->hdr.l2.vlan_id = ntohs(veth->h_vlan_TCI);
2574a71df50SFrank Blaschka 	}
2584a71df50SFrank Blaschka }
2594a71df50SFrank Blaschka 
2604a71df50SFrank Blaschka static int qeth_l2_send_setdelvlan_cb(struct qeth_card *card,
2614a71df50SFrank Blaschka 			struct qeth_reply *reply, unsigned long data)
2624a71df50SFrank Blaschka {
2634a71df50SFrank Blaschka 	struct qeth_ipa_cmd *cmd;
2644a71df50SFrank Blaschka 
265847a50fdSCarsten Otte 	QETH_CARD_TEXT(card, 2, "L2sdvcb");
2664a71df50SFrank Blaschka 	cmd = (struct qeth_ipa_cmd *) data;
2674a71df50SFrank Blaschka 	if (cmd->hdr.return_code) {
26814cc21b6SFrank Blaschka 		QETH_DBF_MESSAGE(2, "Error in processing VLAN %i on %s: 0x%x. "
2694a71df50SFrank Blaschka 			  "Continuing\n", cmd->data.setdelvlan.vlan_id,
2704a71df50SFrank Blaschka 			  QETH_CARD_IFNAME(card), cmd->hdr.return_code);
271847a50fdSCarsten Otte 		QETH_CARD_TEXT_(card, 2, "L2VL%4x", cmd->hdr.command);
272847a50fdSCarsten Otte 		QETH_CARD_TEXT_(card, 2, "err%d", cmd->hdr.return_code);
2734a71df50SFrank Blaschka 	}
2744a71df50SFrank Blaschka 	return 0;
2754a71df50SFrank Blaschka }
2764a71df50SFrank Blaschka 
2774a71df50SFrank Blaschka static int qeth_l2_send_setdelvlan(struct qeth_card *card, __u16 i,
2784a71df50SFrank Blaschka 				enum qeth_ipa_cmds ipacmd)
2794a71df50SFrank Blaschka {
2804a71df50SFrank Blaschka 	struct qeth_ipa_cmd *cmd;
2814a71df50SFrank Blaschka 	struct qeth_cmd_buffer *iob;
2824a71df50SFrank Blaschka 
283847a50fdSCarsten Otte 	QETH_CARD_TEXT_(card, 4, "L2sdv%x", ipacmd);
2844a71df50SFrank Blaschka 	iob = qeth_get_ipacmd_buffer(card, ipacmd, QETH_PROT_IPV4);
2854a71df50SFrank Blaschka 	cmd = (struct qeth_ipa_cmd *)(iob->data+IPA_PDU_HEADER_SIZE);
2864a71df50SFrank Blaschka 	cmd->data.setdelvlan.vlan_id = i;
2874a71df50SFrank Blaschka 	return qeth_send_ipa_cmd(card, iob,
2884a71df50SFrank Blaschka 				 qeth_l2_send_setdelvlan_cb, NULL);
2894a71df50SFrank Blaschka }
2904a71df50SFrank Blaschka 
2914a71df50SFrank Blaschka static void qeth_l2_process_vlans(struct qeth_card *card, int clear)
2924a71df50SFrank Blaschka {
2934a71df50SFrank Blaschka 	struct qeth_vlan_vid *id;
294847a50fdSCarsten Otte 	QETH_CARD_TEXT(card, 3, "L2prcvln");
2954a71df50SFrank Blaschka 	spin_lock_bh(&card->vlanlock);
2964a71df50SFrank Blaschka 	list_for_each_entry(id, &card->vid_list, list) {
2974a71df50SFrank Blaschka 		if (clear)
2984a71df50SFrank Blaschka 			qeth_l2_send_setdelvlan(card, id->vid,
2994a71df50SFrank Blaschka 				IPA_CMD_DELVLAN);
3004a71df50SFrank Blaschka 		else
3014a71df50SFrank Blaschka 			qeth_l2_send_setdelvlan(card, id->vid,
3024a71df50SFrank Blaschka 				IPA_CMD_SETVLAN);
3034a71df50SFrank Blaschka 	}
3044a71df50SFrank Blaschka 	spin_unlock_bh(&card->vlanlock);
3054a71df50SFrank Blaschka }
3064a71df50SFrank Blaschka 
3074a71df50SFrank Blaschka static void qeth_l2_vlan_rx_add_vid(struct net_device *dev, unsigned short vid)
3084a71df50SFrank Blaschka {
309509e2562SHeiko Carstens 	struct qeth_card *card = dev->ml_priv;
3104a71df50SFrank Blaschka 	struct qeth_vlan_vid *id;
3114a71df50SFrank Blaschka 
312847a50fdSCarsten Otte 	QETH_CARD_TEXT_(card, 4, "aid:%d", vid);
31310651db7SUrsula Braun 	if (!vid)
31410651db7SUrsula Braun 		return;
3155113fec0SUrsula Braun 	if (card->info.type == QETH_CARD_TYPE_OSM) {
316847a50fdSCarsten Otte 		QETH_CARD_TEXT(card, 3, "aidOSM");
3175113fec0SUrsula Braun 		return;
3185113fec0SUrsula Braun 	}
3198e98ac48SUrsula Braun 	if (qeth_wait_for_threads(card, QETH_RECOVER_THREAD)) {
320847a50fdSCarsten Otte 		QETH_CARD_TEXT(card, 3, "aidREC");
3218e98ac48SUrsula Braun 		return;
3228e98ac48SUrsula Braun 	}
3234a71df50SFrank Blaschka 	id = kmalloc(sizeof(struct qeth_vlan_vid), GFP_ATOMIC);
3244a71df50SFrank Blaschka 	if (id) {
3254a71df50SFrank Blaschka 		id->vid = vid;
3264a71df50SFrank Blaschka 		qeth_l2_send_setdelvlan(card, vid, IPA_CMD_SETVLAN);
3274a71df50SFrank Blaschka 		spin_lock_bh(&card->vlanlock);
3284a71df50SFrank Blaschka 		list_add_tail(&id->list, &card->vid_list);
3294a71df50SFrank Blaschka 		spin_unlock_bh(&card->vlanlock);
3304a71df50SFrank Blaschka 	}
3314a71df50SFrank Blaschka }
3324a71df50SFrank Blaschka 
3334a71df50SFrank Blaschka static void qeth_l2_vlan_rx_kill_vid(struct net_device *dev, unsigned short vid)
3344a71df50SFrank Blaschka {
3354a71df50SFrank Blaschka 	struct qeth_vlan_vid *id, *tmpid = NULL;
336509e2562SHeiko Carstens 	struct qeth_card *card = dev->ml_priv;
3374a71df50SFrank Blaschka 
338847a50fdSCarsten Otte 	QETH_CARD_TEXT_(card, 4, "kid:%d", vid);
3395113fec0SUrsula Braun 	if (card->info.type == QETH_CARD_TYPE_OSM) {
340847a50fdSCarsten Otte 		QETH_CARD_TEXT(card, 3, "kidOSM");
3415113fec0SUrsula Braun 		return;
3425113fec0SUrsula Braun 	}
3438e98ac48SUrsula Braun 	if (qeth_wait_for_threads(card, QETH_RECOVER_THREAD)) {
344847a50fdSCarsten Otte 		QETH_CARD_TEXT(card, 3, "kidREC");
3458e98ac48SUrsula Braun 		return;
3468e98ac48SUrsula Braun 	}
3474a71df50SFrank Blaschka 	spin_lock_bh(&card->vlanlock);
3484a71df50SFrank Blaschka 	list_for_each_entry(id, &card->vid_list, list) {
3494a71df50SFrank Blaschka 		if (id->vid == vid) {
3504a71df50SFrank Blaschka 			list_del(&id->list);
3514a71df50SFrank Blaschka 			tmpid = id;
3524a71df50SFrank Blaschka 			break;
3534a71df50SFrank Blaschka 		}
3544a71df50SFrank Blaschka 	}
3554a71df50SFrank Blaschka 	spin_unlock_bh(&card->vlanlock);
3564a71df50SFrank Blaschka 	if (tmpid) {
3574a71df50SFrank Blaschka 		qeth_l2_send_setdelvlan(card, vid, IPA_CMD_DELVLAN);
3584a71df50SFrank Blaschka 		kfree(tmpid);
3594a71df50SFrank Blaschka 	}
3604a71df50SFrank Blaschka 	qeth_l2_set_multicast_list(card->dev);
3614a71df50SFrank Blaschka }
3624a71df50SFrank Blaschka 
3634a71df50SFrank Blaschka static int qeth_l2_stop_card(struct qeth_card *card, int recovery_mode)
3644a71df50SFrank Blaschka {
3654a71df50SFrank Blaschka 	int rc = 0;
3664a71df50SFrank Blaschka 
367d11ba0c4SPeter Tiedemann 	QETH_DBF_TEXT(SETUP , 2, "stopcard");
368d11ba0c4SPeter Tiedemann 	QETH_DBF_HEX(SETUP, 2, &card, sizeof(void *));
3694a71df50SFrank Blaschka 
3704a71df50SFrank Blaschka 	qeth_set_allowed_threads(card, 0, 1);
3714a71df50SFrank Blaschka 	if (card->read.state == CH_STATE_UP &&
3724a71df50SFrank Blaschka 	    card->write.state == CH_STATE_UP &&
3734a71df50SFrank Blaschka 	    (card->state == CARD_STATE_UP)) {
3744a71df50SFrank Blaschka 		if (recovery_mode &&
3754a71df50SFrank Blaschka 		    card->info.type != QETH_CARD_TYPE_OSN) {
3764a71df50SFrank Blaschka 			qeth_l2_stop(card->dev);
3774a71df50SFrank Blaschka 		} else {
3784a71df50SFrank Blaschka 			rtnl_lock();
3794a71df50SFrank Blaschka 			dev_close(card->dev);
3804a71df50SFrank Blaschka 			rtnl_unlock();
3814a71df50SFrank Blaschka 		}
382932e1583SKlaus-Dieter Wacker 		if (!card->use_hard_stop ||
383932e1583SKlaus-Dieter Wacker 			recovery_mode) {
3844a71df50SFrank Blaschka 			__u8 *mac = &card->dev->dev_addr[0];
3854a71df50SFrank Blaschka 			rc = qeth_l2_send_delmac(card, mac);
386d11ba0c4SPeter Tiedemann 			QETH_DBF_TEXT_(SETUP, 2, "Lerr%d", rc);
3874a71df50SFrank Blaschka 		}
3884a71df50SFrank Blaschka 		card->state = CARD_STATE_SOFTSETUP;
3894a71df50SFrank Blaschka 	}
3904a71df50SFrank Blaschka 	if (card->state == CARD_STATE_SOFTSETUP) {
3914a71df50SFrank Blaschka 		qeth_l2_process_vlans(card, 1);
392932e1583SKlaus-Dieter Wacker 		if (!card->use_hard_stop ||
393932e1583SKlaus-Dieter Wacker 			recovery_mode)
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 
412a1c3ed4cSFrank Blaschka static int qeth_l2_process_inbound_buffer(struct qeth_card *card,
413a1c3ed4cSFrank Blaschka 				int budget, int *done)
4144a71df50SFrank Blaschka {
415a1c3ed4cSFrank Blaschka 	int work_done = 0;
4164a71df50SFrank Blaschka 	struct sk_buff *skb;
4174a71df50SFrank Blaschka 	struct qeth_hdr *hdr;
4184a71df50SFrank Blaschka 	unsigned int len;
4194a71df50SFrank Blaschka 
420a1c3ed4cSFrank Blaschka 	*done = 0;
421a1c3ed4cSFrank Blaschka 	BUG_ON(!budget);
422a1c3ed4cSFrank Blaschka 	while (budget) {
423a1c3ed4cSFrank Blaschka 		skb = qeth_core_get_next_skb(card,
424a1c3ed4cSFrank Blaschka 			card->qdio.in_q->bufs[card->rx.b_index].buffer,
425a1c3ed4cSFrank Blaschka 			&card->rx.b_element, &card->rx.e_offset, &hdr);
426a1c3ed4cSFrank Blaschka 		if (!skb) {
427a1c3ed4cSFrank Blaschka 			*done = 1;
428a1c3ed4cSFrank Blaschka 			break;
4294a71df50SFrank Blaschka 		}
430a1c3ed4cSFrank Blaschka 		skb->dev = card->dev;
4314a71df50SFrank Blaschka 		switch (hdr->hdr.l2.id) {
4324a71df50SFrank Blaschka 		case QETH_HEADER_TYPE_LAYER2:
4334a71df50SFrank Blaschka 			skb->pkt_type = PACKET_HOST;
4344a71df50SFrank Blaschka 			skb->protocol = eth_type_trans(skb, skb->dev);
4354a71df50SFrank Blaschka 			if (card->options.checksum_type == NO_CHECKSUMMING)
4364a71df50SFrank Blaschka 				skb->ip_summed = CHECKSUM_UNNECESSARY;
4374a71df50SFrank Blaschka 			else
4384a71df50SFrank Blaschka 				skb->ip_summed = CHECKSUM_NONE;
43912883725SUrsula Braun 			if (skb->protocol == htons(ETH_P_802_2))
4404a71df50SFrank Blaschka 				*((__u32 *)skb->cb) = ++card->seqno.pkt_seqno;
4414a71df50SFrank Blaschka 			len = skb->len;
442a1c3ed4cSFrank Blaschka 			netif_receive_skb(skb);
4434a71df50SFrank Blaschka 			break;
4444a71df50SFrank Blaschka 		case QETH_HEADER_TYPE_OSN:
4452d488c2fSUrsula Braun 			if (card->info.type == QETH_CARD_TYPE_OSN) {
4464a71df50SFrank Blaschka 				skb_push(skb, sizeof(struct qeth_hdr));
4474a71df50SFrank Blaschka 				skb_copy_to_linear_data(skb, hdr,
4484a71df50SFrank Blaschka 						sizeof(struct qeth_hdr));
4494a71df50SFrank Blaschka 				len = skb->len;
4504a71df50SFrank Blaschka 				card->osn_info.data_cb(skb);
4514a71df50SFrank Blaschka 				break;
4522d488c2fSUrsula Braun 			}
4532d488c2fSUrsula Braun 			/* else unknown */
4544a71df50SFrank Blaschka 		default:
4554a71df50SFrank Blaschka 			dev_kfree_skb_any(skb);
456847a50fdSCarsten Otte 			QETH_CARD_TEXT(card, 3, "inbunkno");
457d11ba0c4SPeter Tiedemann 			QETH_DBF_HEX(CTRL, 3, hdr, QETH_DBF_CTRL_LEN);
4584a71df50SFrank Blaschka 			continue;
4594a71df50SFrank Blaschka 		}
460a1c3ed4cSFrank Blaschka 		work_done++;
461a1c3ed4cSFrank Blaschka 		budget--;
4624a71df50SFrank Blaschka 		card->stats.rx_packets++;
4634a71df50SFrank Blaschka 		card->stats.rx_bytes += len;
4644a71df50SFrank Blaschka 	}
465a1c3ed4cSFrank Blaschka 	return work_done;
466a1c3ed4cSFrank Blaschka }
467a1c3ed4cSFrank Blaschka 
468a1c3ed4cSFrank Blaschka static int qeth_l2_poll(struct napi_struct *napi, int budget)
469a1c3ed4cSFrank Blaschka {
470a1c3ed4cSFrank Blaschka 	struct qeth_card *card = container_of(napi, struct qeth_card, napi);
471a1c3ed4cSFrank Blaschka 	int work_done = 0;
472a1c3ed4cSFrank Blaschka 	struct qeth_qdio_buffer *buffer;
473a1c3ed4cSFrank Blaschka 	int done;
474a1c3ed4cSFrank Blaschka 	int new_budget = budget;
475a1c3ed4cSFrank Blaschka 
476a1c3ed4cSFrank Blaschka 	if (card->options.performance_stats) {
477a1c3ed4cSFrank Blaschka 		card->perf_stats.inbound_cnt++;
478a1c3ed4cSFrank Blaschka 		card->perf_stats.inbound_start_time = qeth_get_micros();
479a1c3ed4cSFrank Blaschka 	}
480a1c3ed4cSFrank Blaschka 
481a1c3ed4cSFrank Blaschka 	while (1) {
482a1c3ed4cSFrank Blaschka 		if (!card->rx.b_count) {
483a1c3ed4cSFrank Blaschka 			card->rx.qdio_err = 0;
484a1c3ed4cSFrank Blaschka 			card->rx.b_count = qdio_get_next_buffers(
485a1c3ed4cSFrank Blaschka 				card->data.ccwdev, 0, &card->rx.b_index,
486a1c3ed4cSFrank Blaschka 				&card->rx.qdio_err);
487a1c3ed4cSFrank Blaschka 			if (card->rx.b_count <= 0) {
488a1c3ed4cSFrank Blaschka 				card->rx.b_count = 0;
489a1c3ed4cSFrank Blaschka 				break;
490a1c3ed4cSFrank Blaschka 			}
491a1c3ed4cSFrank Blaschka 			card->rx.b_element =
492a1c3ed4cSFrank Blaschka 				&card->qdio.in_q->bufs[card->rx.b_index]
493a1c3ed4cSFrank Blaschka 				.buffer->element[0];
494a1c3ed4cSFrank Blaschka 			card->rx.e_offset = 0;
495a1c3ed4cSFrank Blaschka 		}
496a1c3ed4cSFrank Blaschka 
497a1c3ed4cSFrank Blaschka 		while (card->rx.b_count) {
498a1c3ed4cSFrank Blaschka 			buffer = &card->qdio.in_q->bufs[card->rx.b_index];
499a1c3ed4cSFrank Blaschka 			if (!(card->rx.qdio_err &&
500a1c3ed4cSFrank Blaschka 			    qeth_check_qdio_errors(card, buffer->buffer,
501a1c3ed4cSFrank Blaschka 			    card->rx.qdio_err, "qinerr")))
502a1c3ed4cSFrank Blaschka 				work_done += qeth_l2_process_inbound_buffer(
503a1c3ed4cSFrank Blaschka 					card, new_budget, &done);
504a1c3ed4cSFrank Blaschka 			else
505a1c3ed4cSFrank Blaschka 				done = 1;
506a1c3ed4cSFrank Blaschka 
507a1c3ed4cSFrank Blaschka 			if (done) {
508a1c3ed4cSFrank Blaschka 				if (card->options.performance_stats)
509a1c3ed4cSFrank Blaschka 					card->perf_stats.bufs_rec++;
510a1c3ed4cSFrank Blaschka 				qeth_put_buffer_pool_entry(card,
511a1c3ed4cSFrank Blaschka 					buffer->pool_entry);
512a1c3ed4cSFrank Blaschka 				qeth_queue_input_buffer(card, card->rx.b_index);
513a1c3ed4cSFrank Blaschka 				card->rx.b_count--;
514a1c3ed4cSFrank Blaschka 				if (card->rx.b_count) {
515a1c3ed4cSFrank Blaschka 					card->rx.b_index =
516a1c3ed4cSFrank Blaschka 						(card->rx.b_index + 1) %
517a1c3ed4cSFrank Blaschka 						QDIO_MAX_BUFFERS_PER_Q;
518a1c3ed4cSFrank Blaschka 					card->rx.b_element =
519a1c3ed4cSFrank Blaschka 						&card->qdio.in_q
520a1c3ed4cSFrank Blaschka 						->bufs[card->rx.b_index]
521a1c3ed4cSFrank Blaschka 						.buffer->element[0];
522a1c3ed4cSFrank Blaschka 					card->rx.e_offset = 0;
523a1c3ed4cSFrank Blaschka 				}
524a1c3ed4cSFrank Blaschka 			}
525a1c3ed4cSFrank Blaschka 
526a1c3ed4cSFrank Blaschka 			if (work_done >= budget)
527a1c3ed4cSFrank Blaschka 				goto out;
528a1c3ed4cSFrank Blaschka 			else
529a1c3ed4cSFrank Blaschka 				new_budget = budget - work_done;
530a1c3ed4cSFrank Blaschka 		}
531a1c3ed4cSFrank Blaschka 	}
532a1c3ed4cSFrank Blaschka 
533a1c3ed4cSFrank Blaschka 	napi_complete(napi);
534a1c3ed4cSFrank Blaschka 	if (qdio_start_irq(card->data.ccwdev, 0))
535a1c3ed4cSFrank Blaschka 		napi_schedule(&card->napi);
536a1c3ed4cSFrank Blaschka out:
537a1c3ed4cSFrank Blaschka 	if (card->options.performance_stats)
538a1c3ed4cSFrank Blaschka 		card->perf_stats.inbound_time += qeth_get_micros() -
539a1c3ed4cSFrank Blaschka 			card->perf_stats.inbound_start_time;
540a1c3ed4cSFrank Blaschka 	return work_done;
5414a71df50SFrank Blaschka }
5424a71df50SFrank Blaschka 
5434a71df50SFrank Blaschka static int qeth_l2_send_setdelmac(struct qeth_card *card, __u8 *mac,
5444a71df50SFrank Blaschka 			   enum qeth_ipa_cmds ipacmd,
5454a71df50SFrank Blaschka 			   int (*reply_cb) (struct qeth_card *,
5464a71df50SFrank Blaschka 					    struct qeth_reply*,
5474a71df50SFrank Blaschka 					    unsigned long))
5484a71df50SFrank Blaschka {
5494a71df50SFrank Blaschka 	struct qeth_ipa_cmd *cmd;
5504a71df50SFrank Blaschka 	struct qeth_cmd_buffer *iob;
5514a71df50SFrank Blaschka 
552847a50fdSCarsten Otte 	QETH_CARD_TEXT(card, 2, "L2sdmac");
5534a71df50SFrank Blaschka 	iob = qeth_get_ipacmd_buffer(card, ipacmd, QETH_PROT_IPV4);
5544a71df50SFrank Blaschka 	cmd = (struct qeth_ipa_cmd *)(iob->data+IPA_PDU_HEADER_SIZE);
5554a71df50SFrank Blaschka 	cmd->data.setdelmac.mac_length = OSA_ADDR_LEN;
5564a71df50SFrank Blaschka 	memcpy(&cmd->data.setdelmac.mac, mac, OSA_ADDR_LEN);
5574a71df50SFrank Blaschka 	return qeth_send_ipa_cmd(card, iob, reply_cb, NULL);
5584a71df50SFrank Blaschka }
5594a71df50SFrank Blaschka 
5604a71df50SFrank Blaschka static int qeth_l2_send_setmac_cb(struct qeth_card *card,
5614a71df50SFrank Blaschka 			   struct qeth_reply *reply,
5624a71df50SFrank Blaschka 			   unsigned long data)
5634a71df50SFrank Blaschka {
5644a71df50SFrank Blaschka 	struct qeth_ipa_cmd *cmd;
5654a71df50SFrank Blaschka 
566847a50fdSCarsten Otte 	QETH_CARD_TEXT(card, 2, "L2Smaccb");
5674a71df50SFrank Blaschka 	cmd = (struct qeth_ipa_cmd *) data;
5684a71df50SFrank Blaschka 	if (cmd->hdr.return_code) {
569847a50fdSCarsten Otte 		QETH_CARD_TEXT_(card, 2, "L2er%x", cmd->hdr.return_code);
5704a71df50SFrank Blaschka 		card->info.mac_bits &= ~QETH_LAYER2_MAC_REGISTERED;
5710666eb06SUrsula Braun 		switch (cmd->hdr.return_code) {
5720666eb06SUrsula Braun 		case IPA_RC_L2_DUP_MAC:
5730666eb06SUrsula Braun 		case IPA_RC_L2_DUP_LAYER3_MAC:
5740666eb06SUrsula Braun 			dev_warn(&card->gdev->dev,
575d998ab0bSH Hartley Sweeten 				"MAC address %pM already exists\n",
576221c17feSUrsula Braun 				cmd->data.setdelmac.mac);
5770666eb06SUrsula Braun 			break;
5780666eb06SUrsula Braun 		case IPA_RC_L2_MAC_NOT_AUTH_BY_HYP:
5790666eb06SUrsula Braun 		case IPA_RC_L2_MAC_NOT_AUTH_BY_ADP:
5800666eb06SUrsula Braun 			dev_warn(&card->gdev->dev,
581d998ab0bSH Hartley Sweeten 				"MAC address %pM is not authorized\n",
582221c17feSUrsula Braun 				cmd->data.setdelmac.mac);
5830666eb06SUrsula Braun 			break;
5840666eb06SUrsula Braun 		default:
5850666eb06SUrsula Braun 			break;
5860666eb06SUrsula Braun 		}
5874a71df50SFrank Blaschka 		cmd->hdr.return_code = -EIO;
5884a71df50SFrank Blaschka 	} else {
5894a71df50SFrank Blaschka 		card->info.mac_bits |= QETH_LAYER2_MAC_REGISTERED;
5904a71df50SFrank Blaschka 		memcpy(card->dev->dev_addr, cmd->data.setdelmac.mac,
5914a71df50SFrank Blaschka 		       OSA_ADDR_LEN);
59274eacdb9SFrank Blaschka 		dev_info(&card->gdev->dev,
593d998ab0bSH Hartley Sweeten 			"MAC address %pM successfully registered on device %s\n",
594d998ab0bSH Hartley Sweeten 			card->dev->dev_addr, card->dev->name);
5954a71df50SFrank Blaschka 	}
5964a71df50SFrank Blaschka 	return 0;
5974a71df50SFrank Blaschka }
5984a71df50SFrank Blaschka 
5994a71df50SFrank Blaschka static int qeth_l2_send_setmac(struct qeth_card *card, __u8 *mac)
6004a71df50SFrank Blaschka {
601847a50fdSCarsten Otte 	QETH_CARD_TEXT(card, 2, "L2Setmac");
6024a71df50SFrank Blaschka 	return qeth_l2_send_setdelmac(card, mac, IPA_CMD_SETVMAC,
6034a71df50SFrank Blaschka 					  qeth_l2_send_setmac_cb);
6044a71df50SFrank Blaschka }
6054a71df50SFrank Blaschka 
6064a71df50SFrank Blaschka static int qeth_l2_send_delmac_cb(struct qeth_card *card,
6074a71df50SFrank Blaschka 			   struct qeth_reply *reply,
6084a71df50SFrank Blaschka 			   unsigned long data)
6094a71df50SFrank Blaschka {
6104a71df50SFrank Blaschka 	struct qeth_ipa_cmd *cmd;
6114a71df50SFrank Blaschka 
612847a50fdSCarsten Otte 	QETH_CARD_TEXT(card, 2, "L2Dmaccb");
6134a71df50SFrank Blaschka 	cmd = (struct qeth_ipa_cmd *) data;
6144a71df50SFrank Blaschka 	if (cmd->hdr.return_code) {
615847a50fdSCarsten Otte 		QETH_CARD_TEXT_(card, 2, "err%d", cmd->hdr.return_code);
6164a71df50SFrank Blaschka 		cmd->hdr.return_code = -EIO;
6174a71df50SFrank Blaschka 		return 0;
6184a71df50SFrank Blaschka 	}
6194a71df50SFrank Blaschka 	card->info.mac_bits &= ~QETH_LAYER2_MAC_REGISTERED;
6204a71df50SFrank Blaschka 
6214a71df50SFrank Blaschka 	return 0;
6224a71df50SFrank Blaschka }
6234a71df50SFrank Blaschka 
6244a71df50SFrank Blaschka static int qeth_l2_send_delmac(struct qeth_card *card, __u8 *mac)
6254a71df50SFrank Blaschka {
626847a50fdSCarsten Otte 	QETH_CARD_TEXT(card, 2, "L2Delmac");
6274a71df50SFrank Blaschka 	if (!(card->info.mac_bits & QETH_LAYER2_MAC_REGISTERED))
6284a71df50SFrank Blaschka 		return 0;
6294a71df50SFrank Blaschka 	return qeth_l2_send_setdelmac(card, mac, IPA_CMD_DELVMAC,
6304a71df50SFrank Blaschka 					  qeth_l2_send_delmac_cb);
6314a71df50SFrank Blaschka }
6324a71df50SFrank Blaschka 
6334a71df50SFrank Blaschka static int qeth_l2_request_initial_mac(struct qeth_card *card)
6344a71df50SFrank Blaschka {
6354a71df50SFrank Blaschka 	int rc = 0;
6364a71df50SFrank Blaschka 	char vendor_pre[] = {0x02, 0x00, 0x00};
6374a71df50SFrank Blaschka 
638d11ba0c4SPeter Tiedemann 	QETH_DBF_TEXT(SETUP, 2, "doL2init");
639d11ba0c4SPeter Tiedemann 	QETH_DBF_TEXT_(SETUP, 2, "doL2%s", CARD_BUS_ID(card));
6404a71df50SFrank Blaschka 
6414a71df50SFrank Blaschka 	rc = qeth_query_setadapterparms(card);
6424a71df50SFrank Blaschka 	if (rc) {
64314cc21b6SFrank Blaschka 		QETH_DBF_MESSAGE(2, "could not query adapter parameters on "
64414cc21b6SFrank Blaschka 			"device %s: x%x\n", CARD_BUS_ID(card), rc);
6454a71df50SFrank Blaschka 	}
6464a71df50SFrank Blaschka 
6475113fec0SUrsula Braun 	if (card->info.type == QETH_CARD_TYPE_IQD ||
6485113fec0SUrsula Braun 	    card->info.type == QETH_CARD_TYPE_OSM ||
6495113fec0SUrsula Braun 	    card->info.type == QETH_CARD_TYPE_OSX ||
6505113fec0SUrsula Braun 	    card->info.guestlan) {
6514a71df50SFrank Blaschka 		rc = qeth_setadpparms_change_macaddr(card);
6524a71df50SFrank Blaschka 		if (rc) {
65314cc21b6SFrank Blaschka 			QETH_DBF_MESSAGE(2, "couldn't get MAC address on "
65414cc21b6SFrank Blaschka 				"device %s: x%x\n", CARD_BUS_ID(card), rc);
655d11ba0c4SPeter Tiedemann 			QETH_DBF_TEXT_(SETUP, 2, "1err%d", rc);
6564a71df50SFrank Blaschka 			return rc;
6574a71df50SFrank Blaschka 		}
658d11ba0c4SPeter Tiedemann 		QETH_DBF_HEX(SETUP, 2, card->dev->dev_addr, OSA_ADDR_LEN);
6594a71df50SFrank Blaschka 	} else {
6604a71df50SFrank Blaschka 		random_ether_addr(card->dev->dev_addr);
6614a71df50SFrank Blaschka 		memcpy(card->dev->dev_addr, vendor_pre, 3);
6624a71df50SFrank Blaschka 	}
6634a71df50SFrank Blaschka 	return 0;
6644a71df50SFrank Blaschka }
6654a71df50SFrank Blaschka 
6664a71df50SFrank Blaschka static int qeth_l2_set_mac_address(struct net_device *dev, void *p)
6674a71df50SFrank Blaschka {
6684a71df50SFrank Blaschka 	struct sockaddr *addr = p;
669509e2562SHeiko Carstens 	struct qeth_card *card = dev->ml_priv;
6704a71df50SFrank Blaschka 	int rc = 0;
6714a71df50SFrank Blaschka 
672847a50fdSCarsten Otte 	QETH_CARD_TEXT(card, 3, "setmac");
6734a71df50SFrank Blaschka 
6744a71df50SFrank Blaschka 	if (qeth_l2_verify_dev(dev) != QETH_REAL_CARD) {
675847a50fdSCarsten Otte 		QETH_CARD_TEXT(card, 3, "setmcINV");
6764a71df50SFrank Blaschka 		return -EOPNOTSUPP;
6774a71df50SFrank Blaschka 	}
6784a71df50SFrank Blaschka 
6795113fec0SUrsula Braun 	if (card->info.type == QETH_CARD_TYPE_OSN ||
6805113fec0SUrsula Braun 	    card->info.type == QETH_CARD_TYPE_OSM ||
6815113fec0SUrsula Braun 	    card->info.type == QETH_CARD_TYPE_OSX) {
682847a50fdSCarsten Otte 		QETH_CARD_TEXT(card, 3, "setmcTYP");
6834a71df50SFrank Blaschka 		return -EOPNOTSUPP;
6844a71df50SFrank Blaschka 	}
685847a50fdSCarsten Otte 	QETH_CARD_HEX(card, 3, addr->sa_data, OSA_ADDR_LEN);
6868e98ac48SUrsula Braun 	if (qeth_wait_for_threads(card, QETH_RECOVER_THREAD)) {
687847a50fdSCarsten Otte 		QETH_CARD_TEXT(card, 3, "setmcREC");
6888e98ac48SUrsula Braun 		return -ERESTARTSYS;
6898e98ac48SUrsula Braun 	}
6904a71df50SFrank Blaschka 	rc = qeth_l2_send_delmac(card, &card->dev->dev_addr[0]);
6914a71df50SFrank Blaschka 	if (!rc)
6924a71df50SFrank Blaschka 		rc = qeth_l2_send_setmac(card, addr->sa_data);
6934a71df50SFrank Blaschka 	return rc;
6944a71df50SFrank Blaschka }
6954a71df50SFrank Blaschka 
6964a71df50SFrank Blaschka static void qeth_l2_set_multicast_list(struct net_device *dev)
6974a71df50SFrank Blaschka {
698509e2562SHeiko Carstens 	struct qeth_card *card = dev->ml_priv;
699ccffad25SJiri Pirko 	struct netdev_hw_addr *ha;
7004a71df50SFrank Blaschka 
7014a71df50SFrank Blaschka 	if (card->info.type == QETH_CARD_TYPE_OSN)
7024a71df50SFrank Blaschka 		return ;
7034a71df50SFrank Blaschka 
704847a50fdSCarsten Otte 	QETH_CARD_TEXT(card, 3, "setmulti");
7058e98ac48SUrsula Braun 	if (qeth_threads_running(card, QETH_RECOVER_THREAD) &&
7068e98ac48SUrsula Braun 	    (card->state != CARD_STATE_UP))
7078e98ac48SUrsula Braun 		return;
7084a71df50SFrank Blaschka 	qeth_l2_del_all_mc(card);
7094a71df50SFrank Blaschka 	spin_lock_bh(&card->mclock);
71022bedad3SJiri Pirko 	netdev_for_each_mc_addr(ha, dev)
71122bedad3SJiri Pirko 		qeth_l2_add_mc(card, ha->addr, 0);
7127db2266aSFrank Blaschka 
71332e7bfc4SJiri Pirko 	netdev_for_each_uc_addr(ha, dev)
714ccffad25SJiri Pirko 		qeth_l2_add_mc(card, ha->addr, 1);
7157db2266aSFrank Blaschka 
7164a71df50SFrank Blaschka 	spin_unlock_bh(&card->mclock);
7174a71df50SFrank Blaschka 	if (!qeth_adp_supported(card, IPA_SETADP_SET_PROMISC_MODE))
7184a71df50SFrank Blaschka 		return;
7194a71df50SFrank Blaschka 	qeth_setadp_promisc_mode(card);
7204a71df50SFrank Blaschka }
7214a71df50SFrank Blaschka 
7224a71df50SFrank Blaschka static int qeth_l2_hard_start_xmit(struct sk_buff *skb, struct net_device *dev)
7234a71df50SFrank Blaschka {
7244a71df50SFrank Blaschka 	int rc;
7254a71df50SFrank Blaschka 	struct qeth_hdr *hdr = NULL;
7264a71df50SFrank Blaschka 	int elements = 0;
727509e2562SHeiko Carstens 	struct qeth_card *card = dev->ml_priv;
7284a71df50SFrank Blaschka 	struct sk_buff *new_skb = skb;
7294a71df50SFrank Blaschka 	int ipv = qeth_get_ip_version(skb);
730ce73e10eSKlaus-Dieter Wacker 	int cast_type = qeth_l2_get_cast_type(card, skb);
7314a71df50SFrank Blaschka 	struct qeth_qdio_out_q *queue = card->qdio.out_qs
7324a71df50SFrank Blaschka 		[qeth_get_priority_queue(card, skb, ipv, cast_type)];
7334a71df50SFrank Blaschka 	int tx_bytes = skb->len;
734683d718aSFrank Blaschka 	int data_offset = -1;
735683d718aSFrank Blaschka 	int elements_needed = 0;
736683d718aSFrank Blaschka 	int hd_len = 0;
7374a71df50SFrank Blaschka 
7384a71df50SFrank Blaschka 	if ((card->state != CARD_STATE_UP) || !card->lan_online) {
7394a71df50SFrank Blaschka 		card->stats.tx_carrier_errors++;
7404a71df50SFrank Blaschka 		goto tx_drop;
7414a71df50SFrank Blaschka 	}
7424a71df50SFrank Blaschka 
7434a71df50SFrank Blaschka 	if ((card->info.type == QETH_CARD_TYPE_OSN) &&
7444a71df50SFrank Blaschka 	    (skb->protocol == htons(ETH_P_IPV6)))
7454a71df50SFrank Blaschka 		goto tx_drop;
7464a71df50SFrank Blaschka 
7474a71df50SFrank Blaschka 	if (card->options.performance_stats) {
7484a71df50SFrank Blaschka 		card->perf_stats.outbound_cnt++;
7494a71df50SFrank Blaschka 		card->perf_stats.outbound_start_time = qeth_get_micros();
7504a71df50SFrank Blaschka 	}
7514a71df50SFrank Blaschka 	netif_stop_queue(dev);
7524a71df50SFrank Blaschka 
7534a71df50SFrank Blaschka 	if (card->info.type == QETH_CARD_TYPE_OSN)
7544a71df50SFrank Blaschka 		hdr = (struct qeth_hdr *)skb->data;
7554a71df50SFrank Blaschka 	else {
75664ef8957SFrank Blaschka 		if (card->info.type == QETH_CARD_TYPE_IQD) {
757683d718aSFrank Blaschka 			new_skb = skb;
758683d718aSFrank Blaschka 			data_offset = ETH_HLEN;
759683d718aSFrank Blaschka 			hd_len = ETH_HLEN;
760683d718aSFrank Blaschka 			hdr = kmem_cache_alloc(qeth_core_header_cache,
761683d718aSFrank Blaschka 						GFP_ATOMIC);
762683d718aSFrank Blaschka 			if (!hdr)
763683d718aSFrank Blaschka 				goto tx_drop;
764683d718aSFrank Blaschka 			elements_needed++;
765683d718aSFrank Blaschka 			skb_reset_mac_header(new_skb);
766683d718aSFrank Blaschka 			qeth_l2_fill_header(card, hdr, new_skb, ipv, cast_type);
767683d718aSFrank Blaschka 			hdr->hdr.l2.pkt_length = new_skb->len;
768683d718aSFrank Blaschka 			memcpy(((char *)hdr) + sizeof(struct qeth_hdr),
769683d718aSFrank Blaschka 				skb_mac_header(new_skb), ETH_HLEN);
770683d718aSFrank Blaschka 		} else {
771f90b744eSFrank Blaschka 			/* create a clone with writeable headroom */
772683d718aSFrank Blaschka 			new_skb = skb_realloc_headroom(skb,
773683d718aSFrank Blaschka 						sizeof(struct qeth_hdr));
7744a71df50SFrank Blaschka 			if (!new_skb)
7754a71df50SFrank Blaschka 				goto tx_drop;
776f90b744eSFrank Blaschka 			hdr = (struct qeth_hdr *)skb_push(new_skb,
777f90b744eSFrank Blaschka 						sizeof(struct qeth_hdr));
778683d718aSFrank Blaschka 			skb_set_mac_header(new_skb, sizeof(struct qeth_hdr));
7794a71df50SFrank Blaschka 			qeth_l2_fill_header(card, hdr, new_skb, ipv, cast_type);
7804a71df50SFrank Blaschka 		}
781683d718aSFrank Blaschka 	}
7824a71df50SFrank Blaschka 
783683d718aSFrank Blaschka 	elements = qeth_get_elements_no(card, (void *)hdr, new_skb,
784683d718aSFrank Blaschka 						elements_needed);
785683d718aSFrank Blaschka 	if (!elements) {
786683d718aSFrank Blaschka 		if (data_offset >= 0)
787683d718aSFrank Blaschka 			kmem_cache_free(qeth_core_header_cache, hdr);
7884a71df50SFrank Blaschka 		goto tx_drop;
7894a71df50SFrank Blaschka 	}
7904a71df50SFrank Blaschka 
79151aa165cSFrank Blaschka 	if (card->info.type != QETH_CARD_TYPE_IQD) {
79251aa165cSFrank Blaschka 		if (qeth_hdr_chk_and_bounce(new_skb,
79351aa165cSFrank Blaschka 		    sizeof(struct qeth_hdr_layer2)))
79451aa165cSFrank Blaschka 			goto tx_drop;
7954a71df50SFrank Blaschka 		rc = qeth_do_send_packet(card, queue, new_skb, hdr,
79664ef8957SFrank Blaschka 					 elements);
79751aa165cSFrank Blaschka 	} else
7984a71df50SFrank Blaschka 		rc = qeth_do_send_packet_fast(card, queue, new_skb, hdr,
79964ef8957SFrank Blaschka 					elements, data_offset, hd_len);
8004a71df50SFrank Blaschka 	if (!rc) {
8014a71df50SFrank Blaschka 		card->stats.tx_packets++;
8024a71df50SFrank Blaschka 		card->stats.tx_bytes += tx_bytes;
8034a71df50SFrank Blaschka 		if (new_skb != skb)
8044a71df50SFrank Blaschka 			dev_kfree_skb_any(skb);
805ec634fe3SPatrick McHardy 		rc = NETDEV_TX_OK;
8064a71df50SFrank Blaschka 	} else {
807683d718aSFrank Blaschka 		if (data_offset >= 0)
808683d718aSFrank Blaschka 			kmem_cache_free(qeth_core_header_cache, hdr);
809683d718aSFrank Blaschka 
8104a71df50SFrank Blaschka 		if (rc == -EBUSY) {
8114a71df50SFrank Blaschka 			if (new_skb != skb)
8124a71df50SFrank Blaschka 				dev_kfree_skb_any(new_skb);
8134a71df50SFrank Blaschka 			return NETDEV_TX_BUSY;
8144a71df50SFrank Blaschka 		} else
8154a71df50SFrank Blaschka 			goto tx_drop;
8164a71df50SFrank Blaschka 	}
8174a71df50SFrank Blaschka 
8184a71df50SFrank Blaschka 	netif_wake_queue(dev);
8194a71df50SFrank Blaschka 	if (card->options.performance_stats)
8204a71df50SFrank Blaschka 		card->perf_stats.outbound_time += qeth_get_micros() -
8214a71df50SFrank Blaschka 			card->perf_stats.outbound_start_time;
8224a71df50SFrank Blaschka 	return rc;
8234a71df50SFrank Blaschka 
8244a71df50SFrank Blaschka tx_drop:
8254a71df50SFrank Blaschka 	card->stats.tx_dropped++;
8264a71df50SFrank Blaschka 	card->stats.tx_errors++;
8274a71df50SFrank Blaschka 	if ((new_skb != skb) && new_skb)
8284a71df50SFrank Blaschka 		dev_kfree_skb_any(new_skb);
8294a71df50SFrank Blaschka 	dev_kfree_skb_any(skb);
830d0ec0f54SFrank Blaschka 	netif_wake_queue(dev);
8314a71df50SFrank Blaschka 	return NETDEV_TX_OK;
8324a71df50SFrank Blaschka }
8334a71df50SFrank Blaschka 
83439423440SUrsula Braun static int __qeth_l2_open(struct net_device *dev)
8354a71df50SFrank Blaschka {
836509e2562SHeiko Carstens 	struct qeth_card *card = dev->ml_priv;
837a1c3ed4cSFrank Blaschka 	int rc = 0;
8384a71df50SFrank Blaschka 
839847a50fdSCarsten Otte 	QETH_CARD_TEXT(card, 4, "qethopen");
84039423440SUrsula Braun 	if (card->state == CARD_STATE_UP)
84139423440SUrsula Braun 		return rc;
8424a71df50SFrank Blaschka 	if (card->state != CARD_STATE_SOFTSETUP)
8434a71df50SFrank Blaschka 		return -ENODEV;
8444a71df50SFrank Blaschka 
8454a71df50SFrank Blaschka 	if ((card->info.type != QETH_CARD_TYPE_OSN) &&
8464a71df50SFrank Blaschka 	     (!(card->info.mac_bits & QETH_LAYER2_MAC_REGISTERED))) {
847847a50fdSCarsten Otte 		QETH_CARD_TEXT(card, 4, "nomacadr");
8484a71df50SFrank Blaschka 		return -EPERM;
8494a71df50SFrank Blaschka 	}
8504a71df50SFrank Blaschka 	card->data.state = CH_STATE_UP;
8514a71df50SFrank Blaschka 	card->state = CARD_STATE_UP;
8524a71df50SFrank Blaschka 	netif_start_queue(dev);
8534a71df50SFrank Blaschka 
854a1c3ed4cSFrank Blaschka 	if (qdio_stop_irq(card->data.ccwdev, 0) >= 0) {
855a1c3ed4cSFrank Blaschka 		napi_enable(&card->napi);
856a1c3ed4cSFrank Blaschka 		napi_schedule(&card->napi);
857a1c3ed4cSFrank Blaschka 	} else
858a1c3ed4cSFrank Blaschka 		rc = -EIO;
859a1c3ed4cSFrank Blaschka 	return rc;
8604a71df50SFrank Blaschka }
8614a71df50SFrank Blaschka 
86239423440SUrsula Braun static int qeth_l2_open(struct net_device *dev)
86339423440SUrsula Braun {
86439423440SUrsula Braun 	struct qeth_card *card = dev->ml_priv;
86539423440SUrsula Braun 
86639423440SUrsula Braun 	QETH_CARD_TEXT(card, 5, "qethope_");
86739423440SUrsula Braun 	if (qeth_wait_for_threads(card, QETH_RECOVER_THREAD)) {
86839423440SUrsula Braun 		QETH_CARD_TEXT(card, 3, "openREC");
86939423440SUrsula Braun 		return -ERESTARTSYS;
87039423440SUrsula Braun 	}
87139423440SUrsula Braun 	return __qeth_l2_open(dev);
87239423440SUrsula Braun }
87339423440SUrsula Braun 
8744a71df50SFrank Blaschka static int qeth_l2_stop(struct net_device *dev)
8754a71df50SFrank Blaschka {
876509e2562SHeiko Carstens 	struct qeth_card *card = dev->ml_priv;
8774a71df50SFrank Blaschka 
878847a50fdSCarsten Otte 	QETH_CARD_TEXT(card, 4, "qethstop");
8794a71df50SFrank Blaschka 	netif_tx_disable(dev);
880a1c3ed4cSFrank Blaschka 	if (card->state == CARD_STATE_UP) {
8814a71df50SFrank Blaschka 		card->state = CARD_STATE_SOFTSETUP;
882a1c3ed4cSFrank Blaschka 		napi_disable(&card->napi);
883a1c3ed4cSFrank Blaschka 	}
8844a71df50SFrank Blaschka 	return 0;
8854a71df50SFrank Blaschka }
8864a71df50SFrank Blaschka 
8874a71df50SFrank Blaschka static int qeth_l2_probe_device(struct ccwgroup_device *gdev)
8884a71df50SFrank Blaschka {
8894a71df50SFrank Blaschka 	struct qeth_card *card = dev_get_drvdata(&gdev->dev);
8904a71df50SFrank Blaschka 
8914a71df50SFrank Blaschka 	INIT_LIST_HEAD(&card->vid_list);
8924a71df50SFrank Blaschka 	INIT_LIST_HEAD(&card->mc_list);
8934a71df50SFrank Blaschka 	card->options.layer2 = 1;
894a1c3ed4cSFrank Blaschka 	card->discipline.start_poll = qeth_qdio_start_poll;
8954a71df50SFrank Blaschka 	card->discipline.input_handler = (qdio_handler_t *)
896a1c3ed4cSFrank Blaschka 		qeth_qdio_input_handler;
8974a71df50SFrank Blaschka 	card->discipline.output_handler = (qdio_handler_t *)
8984a71df50SFrank Blaschka 		qeth_qdio_output_handler;
8994a71df50SFrank Blaschka 	card->discipline.recover = qeth_l2_recover;
9004a71df50SFrank Blaschka 	return 0;
9014a71df50SFrank Blaschka }
9024a71df50SFrank Blaschka 
9034a71df50SFrank Blaschka static void qeth_l2_remove_device(struct ccwgroup_device *cgdev)
9044a71df50SFrank Blaschka {
9054a71df50SFrank Blaschka 	struct qeth_card *card = dev_get_drvdata(&cgdev->dev);
9064a71df50SFrank Blaschka 
907f2148565SUrsula Braun 	qeth_set_allowed_threads(card, 0, 1);
9084a71df50SFrank Blaschka 	wait_event(card->wait_q, qeth_threads_running(card, 0xffffffff) == 0);
9094a71df50SFrank Blaschka 
9104a71df50SFrank Blaschka 	if (cgdev->state == CCWGROUP_ONLINE) {
9114a71df50SFrank Blaschka 		card->use_hard_stop = 1;
9124a71df50SFrank Blaschka 		qeth_l2_set_offline(cgdev);
9134a71df50SFrank Blaschka 	}
9144a71df50SFrank Blaschka 
9154a71df50SFrank Blaschka 	if (card->dev) {
9164a71df50SFrank Blaschka 		unregister_netdev(card->dev);
9174a71df50SFrank Blaschka 		card->dev = NULL;
9184a71df50SFrank Blaschka 	}
9194a71df50SFrank Blaschka 	return;
9204a71df50SFrank Blaschka }
9214a71df50SFrank Blaschka 
9220fc0b732SStephen Hemminger static const struct ethtool_ops qeth_l2_ethtool_ops = {
9234a71df50SFrank Blaschka 	.get_link = ethtool_op_get_link,
9244a71df50SFrank Blaschka 	.get_strings = qeth_core_get_strings,
9254a71df50SFrank Blaschka 	.get_ethtool_stats = qeth_core_get_ethtool_stats,
926df8b4ec8SBen Hutchings 	.get_sset_count = qeth_core_get_sset_count,
9274a71df50SFrank Blaschka 	.get_drvinfo = qeth_core_get_drvinfo,
9283f9975aaSFrank Blaschka 	.get_settings = qeth_core_ethtool_get_settings,
9294a71df50SFrank Blaschka };
9304a71df50SFrank Blaschka 
9310fc0b732SStephen Hemminger static const struct ethtool_ops qeth_l2_osn_ops = {
9324a71df50SFrank Blaschka 	.get_strings = qeth_core_get_strings,
9334a71df50SFrank Blaschka 	.get_ethtool_stats = qeth_core_get_ethtool_stats,
934df8b4ec8SBen Hutchings 	.get_sset_count = qeth_core_get_sset_count,
9354a71df50SFrank Blaschka 	.get_drvinfo = qeth_core_get_drvinfo,
9364a71df50SFrank Blaschka };
9374a71df50SFrank Blaschka 
9383d58cefdSFrank Blaschka static const struct net_device_ops qeth_l2_netdev_ops = {
9398403b13cSFrank Blaschka 	.ndo_open		= qeth_l2_open,
9408403b13cSFrank Blaschka 	.ndo_stop		= qeth_l2_stop,
9418403b13cSFrank Blaschka 	.ndo_get_stats		= qeth_get_stats,
9428403b13cSFrank Blaschka 	.ndo_start_xmit		= qeth_l2_hard_start_xmit,
9438403b13cSFrank Blaschka 	.ndo_validate_addr	= eth_validate_addr,
9448403b13cSFrank Blaschka 	.ndo_set_multicast_list = qeth_l2_set_multicast_list,
9458403b13cSFrank Blaschka 	.ndo_do_ioctl	   	= qeth_l2_do_ioctl,
9468403b13cSFrank Blaschka 	.ndo_set_mac_address    = qeth_l2_set_mac_address,
9478403b13cSFrank Blaschka 	.ndo_change_mtu	   	= qeth_change_mtu,
9488403b13cSFrank Blaschka 	.ndo_vlan_rx_add_vid	= qeth_l2_vlan_rx_add_vid,
9498403b13cSFrank Blaschka 	.ndo_vlan_rx_kill_vid   = qeth_l2_vlan_rx_kill_vid,
9508403b13cSFrank Blaschka 	.ndo_tx_timeout	   	= qeth_tx_timeout,
9518403b13cSFrank Blaschka };
9528403b13cSFrank Blaschka 
9534a71df50SFrank Blaschka static int qeth_l2_setup_netdev(struct qeth_card *card)
9544a71df50SFrank Blaschka {
9554a71df50SFrank Blaschka 	switch (card->info.type) {
9564a71df50SFrank Blaschka 	case QETH_CARD_TYPE_IQD:
9574a71df50SFrank Blaschka 		card->dev = alloc_netdev(0, "hsi%d", ether_setup);
9584a71df50SFrank Blaschka 		break;
9594a71df50SFrank Blaschka 	case QETH_CARD_TYPE_OSN:
9604a71df50SFrank Blaschka 		card->dev = alloc_netdev(0, "osn%d", ether_setup);
9614a71df50SFrank Blaschka 		card->dev->flags |= IFF_NOARP;
9624a71df50SFrank Blaschka 		break;
9634a71df50SFrank Blaschka 	default:
9644a71df50SFrank Blaschka 		card->dev = alloc_etherdev(0);
9654a71df50SFrank Blaschka 	}
9664a71df50SFrank Blaschka 
9674a71df50SFrank Blaschka 	if (!card->dev)
9684a71df50SFrank Blaschka 		return -ENODEV;
9694a71df50SFrank Blaschka 
970509e2562SHeiko Carstens 	card->dev->ml_priv = card;
9714a71df50SFrank Blaschka 	card->dev->watchdog_timeo = QETH_TX_TIMEOUT;
9724a71df50SFrank Blaschka 	card->dev->mtu = card->info.initial_mtu;
9738403b13cSFrank Blaschka 	card->dev->netdev_ops = &qeth_l2_netdev_ops;
9744a71df50SFrank Blaschka 	if (card->info.type != QETH_CARD_TYPE_OSN)
9754a71df50SFrank Blaschka 		SET_ETHTOOL_OPS(card->dev, &qeth_l2_ethtool_ops);
9764a71df50SFrank Blaschka 	else
9774a71df50SFrank Blaschka 		SET_ETHTOOL_OPS(card->dev, &qeth_l2_osn_ops);
9784a71df50SFrank Blaschka 	card->dev->features |= NETIF_F_HW_VLAN_FILTER;
9794a71df50SFrank Blaschka 	card->info.broadcast_capable = 1;
9804a71df50SFrank Blaschka 	qeth_l2_request_initial_mac(card);
9814a71df50SFrank Blaschka 	SET_NETDEV_DEV(card->dev, &card->gdev->dev);
982a1c3ed4cSFrank Blaschka 	netif_napi_add(card->dev, &card->napi, qeth_l2_poll, QETH_NAPI_WEIGHT);
9834a71df50SFrank Blaschka 	return register_netdev(card->dev);
9844a71df50SFrank Blaschka }
9854a71df50SFrank Blaschka 
9864a71df50SFrank Blaschka static int __qeth_l2_set_online(struct ccwgroup_device *gdev, int recovery_mode)
9874a71df50SFrank Blaschka {
9884a71df50SFrank Blaschka 	struct qeth_card *card = dev_get_drvdata(&gdev->dev);
9894a71df50SFrank Blaschka 	int rc = 0;
9904a71df50SFrank Blaschka 	enum qeth_card_states recover_flag;
9914a71df50SFrank Blaschka 
9924a71df50SFrank Blaschka 	BUG_ON(!card);
9939dc48cccSUrsula Braun 	mutex_lock(&card->discipline_mutex);
994c4949f07SFrank Blaschka 	mutex_lock(&card->conf_mutex);
995d11ba0c4SPeter Tiedemann 	QETH_DBF_TEXT(SETUP, 2, "setonlin");
996d11ba0c4SPeter Tiedemann 	QETH_DBF_HEX(SETUP, 2, &card, sizeof(void *));
9974a71df50SFrank Blaschka 
9984a71df50SFrank Blaschka 	recover_flag = card->state;
9994a71df50SFrank Blaschka 	rc = qeth_core_hardsetup_card(card);
10004a71df50SFrank Blaschka 	if (rc) {
1001d11ba0c4SPeter Tiedemann 		QETH_DBF_TEXT_(SETUP, 2, "2err%d", rc);
1002aa909224SUrsula Braun 		rc = -ENODEV;
10034a71df50SFrank Blaschka 		goto out_remove;
10044a71df50SFrank Blaschka 	}
10054a71df50SFrank Blaschka 
1006aa909224SUrsula Braun 	if (!card->dev && qeth_l2_setup_netdev(card)) {
1007aa909224SUrsula Braun 		rc = -ENODEV;
10084a71df50SFrank Blaschka 		goto out_remove;
1009aa909224SUrsula Braun 	}
10104a71df50SFrank Blaschka 
10114a71df50SFrank Blaschka 	if (card->info.type != QETH_CARD_TYPE_OSN)
10124a71df50SFrank Blaschka 		qeth_l2_send_setmac(card, &card->dev->dev_addr[0]);
10134a71df50SFrank Blaschka 
10144a71df50SFrank Blaschka 	card->state = CARD_STATE_HARDSETUP;
1015a1c3ed4cSFrank Blaschka 	memset(&card->rx, 0, sizeof(struct qeth_rx));
10164a71df50SFrank Blaschka 	qeth_print_status_message(card);
10174a71df50SFrank Blaschka 
10184a71df50SFrank Blaschka 	/* softsetup */
1019d11ba0c4SPeter Tiedemann 	QETH_DBF_TEXT(SETUP, 2, "softsetp");
10204a71df50SFrank Blaschka 
10214a71df50SFrank Blaschka 	rc = qeth_send_startlan(card);
10224a71df50SFrank Blaschka 	if (rc) {
1023d11ba0c4SPeter Tiedemann 		QETH_DBF_TEXT_(SETUP, 2, "1err%d", rc);
10244a71df50SFrank Blaschka 		if (rc == 0xe080) {
102574eacdb9SFrank Blaschka 			dev_warn(&card->gdev->dev,
102674eacdb9SFrank Blaschka 				"The LAN is offline\n");
10274a71df50SFrank Blaschka 			card->lan_online = 0;
10282b6203bbSUrsula Braun 			goto contin;
10294a71df50SFrank Blaschka 		}
1030aa909224SUrsula Braun 		rc = -ENODEV;
1031f2148565SUrsula Braun 		goto out_remove;
10324a71df50SFrank Blaschka 	} else
10334a71df50SFrank Blaschka 		card->lan_online = 1;
10344a71df50SFrank Blaschka 
10352b6203bbSUrsula Braun contin:
10365113fec0SUrsula Braun 	if ((card->info.type == QETH_CARD_TYPE_OSD) ||
10375113fec0SUrsula Braun 	    (card->info.type == QETH_CARD_TYPE_OSX))
1038d64ecc22SEinar Lueck 		/* configure isolation level */
1039d64ecc22SEinar Lueck 		qeth_set_access_ctrl_online(card);
10405113fec0SUrsula Braun 
10415113fec0SUrsula Braun 	if (card->info.type != QETH_CARD_TYPE_OSN &&
10425113fec0SUrsula Braun 	    card->info.type != QETH_CARD_TYPE_OSM)
10434a71df50SFrank Blaschka 		qeth_l2_process_vlans(card, 0);
10444a71df50SFrank Blaschka 
10454a71df50SFrank Blaschka 	netif_tx_disable(card->dev);
10464a71df50SFrank Blaschka 
10474a71df50SFrank Blaschka 	rc = qeth_init_qdio_queues(card);
10484a71df50SFrank Blaschka 	if (rc) {
1049d11ba0c4SPeter Tiedemann 		QETH_DBF_TEXT_(SETUP, 2, "6err%d", rc);
1050aa909224SUrsula Braun 		rc = -ENODEV;
10514a71df50SFrank Blaschka 		goto out_remove;
10524a71df50SFrank Blaschka 	}
10534a71df50SFrank Blaschka 	card->state = CARD_STATE_SOFTSETUP;
10542b6203bbSUrsula Braun 	if (card->lan_online)
10554a71df50SFrank Blaschka 		netif_carrier_on(card->dev);
10562b6203bbSUrsula Braun 	else
10572b6203bbSUrsula Braun 		netif_carrier_off(card->dev);
10584a71df50SFrank Blaschka 
10594a71df50SFrank Blaschka 	qeth_set_allowed_threads(card, 0xffffffff, 0);
10604a71df50SFrank Blaschka 	if (recover_flag == CARD_STATE_RECOVER) {
10614a71df50SFrank Blaschka 		if (recovery_mode &&
10624a71df50SFrank Blaschka 		    card->info.type != QETH_CARD_TYPE_OSN) {
106339423440SUrsula Braun 			__qeth_l2_open(card->dev);
10644a71df50SFrank Blaschka 		} else {
10654a71df50SFrank Blaschka 			rtnl_lock();
10664a71df50SFrank Blaschka 			dev_open(card->dev);
10674a71df50SFrank Blaschka 			rtnl_unlock();
10684a71df50SFrank Blaschka 		}
10694a71df50SFrank Blaschka 		/* this also sets saved unicast addresses */
10704a71df50SFrank Blaschka 		qeth_l2_set_multicast_list(card->dev);
10714a71df50SFrank Blaschka 	}
10724a71df50SFrank Blaschka 	/* let user_space know that device is online */
10734a71df50SFrank Blaschka 	kobject_uevent(&gdev->dev.kobj, KOBJ_CHANGE);
1074c4949f07SFrank Blaschka 	mutex_unlock(&card->conf_mutex);
10759dc48cccSUrsula Braun 	mutex_unlock(&card->discipline_mutex);
10764a71df50SFrank Blaschka 	return 0;
1077aa909224SUrsula Braun 
10784a71df50SFrank Blaschka out_remove:
10794a71df50SFrank Blaschka 	card->use_hard_stop = 1;
10804a71df50SFrank Blaschka 	qeth_l2_stop_card(card, 0);
10814a71df50SFrank Blaschka 	ccw_device_set_offline(CARD_DDEV(card));
10824a71df50SFrank Blaschka 	ccw_device_set_offline(CARD_WDEV(card));
10834a71df50SFrank Blaschka 	ccw_device_set_offline(CARD_RDEV(card));
10844a71df50SFrank Blaschka 	if (recover_flag == CARD_STATE_RECOVER)
10854a71df50SFrank Blaschka 		card->state = CARD_STATE_RECOVER;
10864a71df50SFrank Blaschka 	else
10874a71df50SFrank Blaschka 		card->state = CARD_STATE_DOWN;
1088c4949f07SFrank Blaschka 	mutex_unlock(&card->conf_mutex);
10899dc48cccSUrsula Braun 	mutex_unlock(&card->discipline_mutex);
1090aa909224SUrsula Braun 	return rc;
10914a71df50SFrank Blaschka }
10924a71df50SFrank Blaschka 
10934a71df50SFrank Blaschka static int qeth_l2_set_online(struct ccwgroup_device *gdev)
10944a71df50SFrank Blaschka {
10954a71df50SFrank Blaschka 	return __qeth_l2_set_online(gdev, 0);
10964a71df50SFrank Blaschka }
10974a71df50SFrank Blaschka 
10984a71df50SFrank Blaschka static int __qeth_l2_set_offline(struct ccwgroup_device *cgdev,
10994a71df50SFrank Blaschka 					int recovery_mode)
11004a71df50SFrank Blaschka {
11014a71df50SFrank Blaschka 	struct qeth_card *card = dev_get_drvdata(&cgdev->dev);
11024a71df50SFrank Blaschka 	int rc = 0, rc2 = 0, rc3 = 0;
11034a71df50SFrank Blaschka 	enum qeth_card_states recover_flag;
11044a71df50SFrank Blaschka 
11059dc48cccSUrsula Braun 	mutex_lock(&card->discipline_mutex);
1106c4949f07SFrank Blaschka 	mutex_lock(&card->conf_mutex);
1107d11ba0c4SPeter Tiedemann 	QETH_DBF_TEXT(SETUP, 3, "setoffl");
1108d11ba0c4SPeter Tiedemann 	QETH_DBF_HEX(SETUP, 3, &card, sizeof(void *));
11094a71df50SFrank Blaschka 
11104a71df50SFrank Blaschka 	if (card->dev && netif_carrier_ok(card->dev))
11114a71df50SFrank Blaschka 		netif_carrier_off(card->dev);
11124a71df50SFrank Blaschka 	recover_flag = card->state;
11130f5623c9SUrsula Braun 	qeth_l2_stop_card(card, recovery_mode);
11144a71df50SFrank Blaschka 	rc  = ccw_device_set_offline(CARD_DDEV(card));
11154a71df50SFrank Blaschka 	rc2 = ccw_device_set_offline(CARD_WDEV(card));
11164a71df50SFrank Blaschka 	rc3 = ccw_device_set_offline(CARD_RDEV(card));
11174a71df50SFrank Blaschka 	if (!rc)
11184a71df50SFrank Blaschka 		rc = (rc2) ? rc2 : rc3;
11194a71df50SFrank Blaschka 	if (rc)
1120d11ba0c4SPeter Tiedemann 		QETH_DBF_TEXT_(SETUP, 2, "1err%d", rc);
11214a71df50SFrank Blaschka 	if (recover_flag == CARD_STATE_UP)
11224a71df50SFrank Blaschka 		card->state = CARD_STATE_RECOVER;
11234a71df50SFrank Blaschka 	/* let user_space know that device is offline */
11244a71df50SFrank Blaschka 	kobject_uevent(&cgdev->dev.kobj, KOBJ_CHANGE);
1125c4949f07SFrank Blaschka 	mutex_unlock(&card->conf_mutex);
11269dc48cccSUrsula Braun 	mutex_unlock(&card->discipline_mutex);
11274a71df50SFrank Blaschka 	return 0;
11284a71df50SFrank Blaschka }
11294a71df50SFrank Blaschka 
11304a71df50SFrank Blaschka static int qeth_l2_set_offline(struct ccwgroup_device *cgdev)
11314a71df50SFrank Blaschka {
11324a71df50SFrank Blaschka 	return __qeth_l2_set_offline(cgdev, 0);
11334a71df50SFrank Blaschka }
11344a71df50SFrank Blaschka 
11354a71df50SFrank Blaschka static int qeth_l2_recover(void *ptr)
11364a71df50SFrank Blaschka {
11374a71df50SFrank Blaschka 	struct qeth_card *card;
11384a71df50SFrank Blaschka 	int rc = 0;
11394a71df50SFrank Blaschka 
11404a71df50SFrank Blaschka 	card = (struct qeth_card *) ptr;
1141847a50fdSCarsten Otte 	QETH_CARD_TEXT(card, 2, "recover1");
11424a71df50SFrank Blaschka 	if (!qeth_do_run_thread(card, QETH_RECOVER_THREAD))
11434a71df50SFrank Blaschka 		return 0;
1144847a50fdSCarsten Otte 	QETH_CARD_TEXT(card, 2, "recover2");
114574eacdb9SFrank Blaschka 	dev_warn(&card->gdev->dev,
114674eacdb9SFrank Blaschka 		"A recovery process has been started for the device\n");
11474a71df50SFrank Blaschka 	card->use_hard_stop = 1;
11484a71df50SFrank Blaschka 	__qeth_l2_set_offline(card->gdev, 1);
11494a71df50SFrank Blaschka 	rc = __qeth_l2_set_online(card->gdev, 1);
11504a71df50SFrank Blaschka 	if (!rc)
115174eacdb9SFrank Blaschka 		dev_info(&card->gdev->dev,
115274eacdb9SFrank Blaschka 			"Device successfully recovered!\n");
115328a7e4c9SUrsula Braun 	else {
115428a7e4c9SUrsula Braun 		rtnl_lock();
115528a7e4c9SUrsula Braun 		dev_close(card->dev);
115628a7e4c9SUrsula Braun 		rtnl_unlock();
115774eacdb9SFrank Blaschka 		dev_warn(&card->gdev->dev, "The qeth device driver "
115874eacdb9SFrank Blaschka 			"failed to recover an error on the device\n");
115928a7e4c9SUrsula Braun 	}
1160a1c3ed4cSFrank Blaschka 	qeth_clear_thread_start_bit(card, QETH_RECOVER_THREAD);
1161a1c3ed4cSFrank Blaschka 	qeth_clear_thread_running_bit(card, QETH_RECOVER_THREAD);
11624a71df50SFrank Blaschka 	return 0;
11634a71df50SFrank Blaschka }
11644a71df50SFrank Blaschka 
11654a71df50SFrank Blaschka static int __init qeth_l2_init(void)
11664a71df50SFrank Blaschka {
116774eacdb9SFrank Blaschka 	pr_info("register layer 2 discipline\n");
11684a71df50SFrank Blaschka 	return 0;
11694a71df50SFrank Blaschka }
11704a71df50SFrank Blaschka 
11714a71df50SFrank Blaschka static void __exit qeth_l2_exit(void)
11724a71df50SFrank Blaschka {
117374eacdb9SFrank Blaschka 	pr_info("unregister layer 2 discipline\n");
11744a71df50SFrank Blaschka }
11754a71df50SFrank Blaschka 
11764a71df50SFrank Blaschka static void qeth_l2_shutdown(struct ccwgroup_device *gdev)
11774a71df50SFrank Blaschka {
11784a71df50SFrank Blaschka 	struct qeth_card *card = dev_get_drvdata(&gdev->dev);
11794a71df50SFrank Blaschka 	qeth_qdio_clear_card(card, 0);
11804a71df50SFrank Blaschka 	qeth_clear_qdio_buffers(card);
11814a71df50SFrank Blaschka }
11824a71df50SFrank Blaschka 
1183bbcfcdc8SFrank Blaschka static int qeth_l2_pm_suspend(struct ccwgroup_device *gdev)
1184bbcfcdc8SFrank Blaschka {
1185bbcfcdc8SFrank Blaschka 	struct qeth_card *card = dev_get_drvdata(&gdev->dev);
1186bbcfcdc8SFrank Blaschka 
1187bbcfcdc8SFrank Blaschka 	if (card->dev)
1188bbcfcdc8SFrank Blaschka 		netif_device_detach(card->dev);
1189bbcfcdc8SFrank Blaschka 	qeth_set_allowed_threads(card, 0, 1);
1190bbcfcdc8SFrank Blaschka 	wait_event(card->wait_q, qeth_threads_running(card, 0xffffffff) == 0);
1191bbcfcdc8SFrank Blaschka 	if (gdev->state == CCWGROUP_OFFLINE)
1192bbcfcdc8SFrank Blaschka 		return 0;
1193bbcfcdc8SFrank Blaschka 	if (card->state == CARD_STATE_UP) {
1194bbcfcdc8SFrank Blaschka 		card->use_hard_stop = 1;
1195bbcfcdc8SFrank Blaschka 		__qeth_l2_set_offline(card->gdev, 1);
1196bbcfcdc8SFrank Blaschka 	} else
1197bbcfcdc8SFrank Blaschka 		__qeth_l2_set_offline(card->gdev, 0);
1198bbcfcdc8SFrank Blaschka 	return 0;
1199bbcfcdc8SFrank Blaschka }
1200bbcfcdc8SFrank Blaschka 
1201bbcfcdc8SFrank Blaschka static int qeth_l2_pm_resume(struct ccwgroup_device *gdev)
1202bbcfcdc8SFrank Blaschka {
1203bbcfcdc8SFrank Blaschka 	struct qeth_card *card = dev_get_drvdata(&gdev->dev);
1204bbcfcdc8SFrank Blaschka 	int rc = 0;
1205bbcfcdc8SFrank Blaschka 
1206bbcfcdc8SFrank Blaschka 	if (gdev->state == CCWGROUP_OFFLINE)
1207bbcfcdc8SFrank Blaschka 		goto out;
1208bbcfcdc8SFrank Blaschka 
1209bbcfcdc8SFrank Blaschka 	if (card->state == CARD_STATE_RECOVER) {
1210bbcfcdc8SFrank Blaschka 		rc = __qeth_l2_set_online(card->gdev, 1);
1211bbcfcdc8SFrank Blaschka 		if (rc) {
1212bbcfcdc8SFrank Blaschka 			rtnl_lock();
1213bbcfcdc8SFrank Blaschka 			dev_close(card->dev);
1214bbcfcdc8SFrank Blaschka 			rtnl_unlock();
1215bbcfcdc8SFrank Blaschka 		}
1216bbcfcdc8SFrank Blaschka 	} else
1217bbcfcdc8SFrank Blaschka 		rc = __qeth_l2_set_online(card->gdev, 0);
1218bbcfcdc8SFrank Blaschka out:
1219bbcfcdc8SFrank Blaschka 	qeth_set_allowed_threads(card, 0xffffffff, 0);
1220bbcfcdc8SFrank Blaschka 	if (card->dev)
1221bbcfcdc8SFrank Blaschka 		netif_device_attach(card->dev);
1222bbcfcdc8SFrank Blaschka 	if (rc)
1223bbcfcdc8SFrank Blaschka 		dev_warn(&card->gdev->dev, "The qeth device driver "
1224bbcfcdc8SFrank Blaschka 			"failed to recover an error on the device\n");
1225bbcfcdc8SFrank Blaschka 	return rc;
1226bbcfcdc8SFrank Blaschka }
1227bbcfcdc8SFrank Blaschka 
12284a71df50SFrank Blaschka struct ccwgroup_driver qeth_l2_ccwgroup_driver = {
12294a71df50SFrank Blaschka 	.probe = qeth_l2_probe_device,
12304a71df50SFrank Blaschka 	.remove = qeth_l2_remove_device,
12314a71df50SFrank Blaschka 	.set_online = qeth_l2_set_online,
12324a71df50SFrank Blaschka 	.set_offline = qeth_l2_set_offline,
12334a71df50SFrank Blaschka 	.shutdown = qeth_l2_shutdown,
1234bbcfcdc8SFrank Blaschka 	.freeze = qeth_l2_pm_suspend,
1235bbcfcdc8SFrank Blaschka 	.thaw = qeth_l2_pm_resume,
1236bbcfcdc8SFrank Blaschka 	.restore = qeth_l2_pm_resume,
12374a71df50SFrank Blaschka };
12384a71df50SFrank Blaschka EXPORT_SYMBOL_GPL(qeth_l2_ccwgroup_driver);
12394a71df50SFrank Blaschka 
12404a71df50SFrank Blaschka static int qeth_osn_send_control_data(struct qeth_card *card, int len,
12414a71df50SFrank Blaschka 			   struct qeth_cmd_buffer *iob)
12424a71df50SFrank Blaschka {
12434a71df50SFrank Blaschka 	unsigned long flags;
12444a71df50SFrank Blaschka 	int rc = 0;
12454a71df50SFrank Blaschka 
1246847a50fdSCarsten Otte 	QETH_CARD_TEXT(card, 5, "osndctrd");
12474a71df50SFrank Blaschka 
12484a71df50SFrank Blaschka 	wait_event(card->wait_q,
12494a71df50SFrank Blaschka 		   atomic_cmpxchg(&card->write.irq_pending, 0, 1) == 0);
12504a71df50SFrank Blaschka 	qeth_prepare_control_data(card, len, iob);
1251847a50fdSCarsten Otte 	QETH_CARD_TEXT(card, 6, "osnoirqp");
12524a71df50SFrank Blaschka 	spin_lock_irqsave(get_ccwdev_lock(card->write.ccwdev), flags);
12534a71df50SFrank Blaschka 	rc = ccw_device_start(card->write.ccwdev, &card->write.ccw,
12544a71df50SFrank Blaschka 			      (addr_t) iob, 0, 0);
12554a71df50SFrank Blaschka 	spin_unlock_irqrestore(get_ccwdev_lock(card->write.ccwdev), flags);
12564a71df50SFrank Blaschka 	if (rc) {
125714cc21b6SFrank Blaschka 		QETH_DBF_MESSAGE(2, "qeth_osn_send_control_data: "
12584a71df50SFrank Blaschka 			   "ccw_device_start rc = %i\n", rc);
1259847a50fdSCarsten Otte 		QETH_CARD_TEXT_(card, 2, " err%d", rc);
12604a71df50SFrank Blaschka 		qeth_release_buffer(iob->channel, iob);
12614a71df50SFrank Blaschka 		atomic_set(&card->write.irq_pending, 0);
12624a71df50SFrank Blaschka 		wake_up(&card->wait_q);
12634a71df50SFrank Blaschka 	}
12644a71df50SFrank Blaschka 	return rc;
12654a71df50SFrank Blaschka }
12664a71df50SFrank Blaschka 
12674a71df50SFrank Blaschka static int qeth_osn_send_ipa_cmd(struct qeth_card *card,
12684a71df50SFrank Blaschka 			struct qeth_cmd_buffer *iob, int data_len)
12694a71df50SFrank Blaschka {
12704a71df50SFrank Blaschka 	u16 s1, s2;
12714a71df50SFrank Blaschka 
1272847a50fdSCarsten Otte 	QETH_CARD_TEXT(card, 4, "osndipa");
12734a71df50SFrank Blaschka 
12744a71df50SFrank Blaschka 	qeth_prepare_ipa_cmd(card, iob, QETH_PROT_OSN2);
12754a71df50SFrank Blaschka 	s1 = (u16)(IPA_PDU_HEADER_SIZE + data_len);
12764a71df50SFrank Blaschka 	s2 = (u16)data_len;
12774a71df50SFrank Blaschka 	memcpy(QETH_IPA_PDU_LEN_TOTAL(iob->data), &s1, 2);
12784a71df50SFrank Blaschka 	memcpy(QETH_IPA_PDU_LEN_PDU1(iob->data), &s2, 2);
12794a71df50SFrank Blaschka 	memcpy(QETH_IPA_PDU_LEN_PDU2(iob->data), &s2, 2);
12804a71df50SFrank Blaschka 	memcpy(QETH_IPA_PDU_LEN_PDU3(iob->data), &s2, 2);
12814a71df50SFrank Blaschka 	return qeth_osn_send_control_data(card, s1, iob);
12824a71df50SFrank Blaschka }
12834a71df50SFrank Blaschka 
12844a71df50SFrank Blaschka int qeth_osn_assist(struct net_device *dev, void *data, int data_len)
12854a71df50SFrank Blaschka {
12864a71df50SFrank Blaschka 	struct qeth_cmd_buffer *iob;
12874a71df50SFrank Blaschka 	struct qeth_card *card;
12884a71df50SFrank Blaschka 	int rc;
12894a71df50SFrank Blaschka 
12904a71df50SFrank Blaschka 	if (!dev)
12914a71df50SFrank Blaschka 		return -ENODEV;
1292509e2562SHeiko Carstens 	card = dev->ml_priv;
12934a71df50SFrank Blaschka 	if (!card)
12944a71df50SFrank Blaschka 		return -ENODEV;
1295847a50fdSCarsten Otte 	QETH_CARD_TEXT(card, 2, "osnsdmc");
12964a71df50SFrank Blaschka 	if ((card->state != CARD_STATE_UP) &&
12974a71df50SFrank Blaschka 	    (card->state != CARD_STATE_SOFTSETUP))
12984a71df50SFrank Blaschka 		return -ENODEV;
12994a71df50SFrank Blaschka 	iob = qeth_wait_for_buffer(&card->write);
13004a71df50SFrank Blaschka 	memcpy(iob->data+IPA_PDU_HEADER_SIZE, data, data_len);
13014a71df50SFrank Blaschka 	rc = qeth_osn_send_ipa_cmd(card, iob, data_len);
13024a71df50SFrank Blaschka 	return rc;
13034a71df50SFrank Blaschka }
13044a71df50SFrank Blaschka EXPORT_SYMBOL(qeth_osn_assist);
13054a71df50SFrank Blaschka 
13064a71df50SFrank Blaschka int qeth_osn_register(unsigned char *read_dev_no, struct net_device **dev,
13074a71df50SFrank Blaschka 		  int (*assist_cb)(struct net_device *, void *),
13084a71df50SFrank Blaschka 		  int (*data_cb)(struct sk_buff *))
13094a71df50SFrank Blaschka {
13104a71df50SFrank Blaschka 	struct qeth_card *card;
13114a71df50SFrank Blaschka 
13124a71df50SFrank Blaschka 	*dev = qeth_l2_netdev_by_devno(read_dev_no);
13134a71df50SFrank Blaschka 	if (*dev == NULL)
13144a71df50SFrank Blaschka 		return -ENODEV;
1315509e2562SHeiko Carstens 	card = (*dev)->ml_priv;
13164a71df50SFrank Blaschka 	if (!card)
13174a71df50SFrank Blaschka 		return -ENODEV;
1318847a50fdSCarsten Otte 	QETH_CARD_TEXT(card, 2, "osnreg");
13194a71df50SFrank Blaschka 	if ((assist_cb == NULL) || (data_cb == NULL))
13204a71df50SFrank Blaschka 		return -EINVAL;
13214a71df50SFrank Blaschka 	card->osn_info.assist_cb = assist_cb;
13224a71df50SFrank Blaschka 	card->osn_info.data_cb = data_cb;
13234a71df50SFrank Blaschka 	return 0;
13244a71df50SFrank Blaschka }
13254a71df50SFrank Blaschka EXPORT_SYMBOL(qeth_osn_register);
13264a71df50SFrank Blaschka 
13274a71df50SFrank Blaschka void qeth_osn_deregister(struct net_device *dev)
13284a71df50SFrank Blaschka {
13294a71df50SFrank Blaschka 	struct qeth_card *card;
13304a71df50SFrank Blaschka 
13314a71df50SFrank Blaschka 	if (!dev)
13324a71df50SFrank Blaschka 		return;
1333509e2562SHeiko Carstens 	card = dev->ml_priv;
13344a71df50SFrank Blaschka 	if (!card)
13354a71df50SFrank Blaschka 		return;
1336847a50fdSCarsten Otte 	QETH_CARD_TEXT(card, 2, "osndereg");
13374a71df50SFrank Blaschka 	card->osn_info.assist_cb = NULL;
13384a71df50SFrank Blaschka 	card->osn_info.data_cb = NULL;
13394a71df50SFrank Blaschka 	return;
13404a71df50SFrank Blaschka }
13414a71df50SFrank Blaschka EXPORT_SYMBOL(qeth_osn_deregister);
13424a71df50SFrank Blaschka 
13434a71df50SFrank Blaschka module_init(qeth_l2_init);
13444a71df50SFrank Blaschka module_exit(qeth_l2_exit);
13454a71df50SFrank Blaschka MODULE_AUTHOR("Frank Blaschka <frank.blaschka@de.ibm.com>");
13464a71df50SFrank Blaschka MODULE_DESCRIPTION("qeth layer 2 discipline");
13474a71df50SFrank Blaschka MODULE_LICENSE("GPL");
1348