qeth_l2_main.c revision 2b6203bb7d85e6a2ca2088b8684f30be70246ddf
14a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka/*
24a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka *  drivers/s390/net/qeth_l2_main.c
34a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka *
4bbcfcdc8324e75532c4d2592a545a91fcb45f229Frank Blaschka *    Copyright IBM Corp. 2007, 2009
54a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka *    Author(s): Utz Bacher <utz.bacher@de.ibm.com>,
64a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka *		 Frank Pavlic <fpavlic@de.ibm.com>,
74a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka *		 Thomas Spatzier <tspat@de.ibm.com>,
84a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka *		 Frank Blaschka <frank.blaschka@de.ibm.com>
94a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka */
104a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
1174eacdb9c2bf9fc6e8c6785013b5dd0e551a9dfaFrank Blaschka#define KMSG_COMPONENT "qeth"
1274eacdb9c2bf9fc6e8c6785013b5dd0e551a9dfaFrank Blaschka#define pr_fmt(fmt) KMSG_COMPONENT ": " fmt
1374eacdb9c2bf9fc6e8c6785013b5dd0e551a9dfaFrank Blaschka
144a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka#include <linux/module.h>
154a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka#include <linux/moduleparam.h>
164a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka#include <linux/string.h>
174a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka#include <linux/errno.h>
184a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka#include <linux/kernel.h>
195a0e3ad6af8660be21ca98a971cd00f331318c05Tejun Heo#include <linux/slab.h>
204a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka#include <linux/etherdevice.h>
214a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka#include <linux/mii.h>
224a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka#include <linux/ip.h>
23ccffad25b5136958d4769ed6de5e87992dd9c65cJiri Pirko#include <linux/list.h>
244a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
254a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka#include "qeth_core.h"
264a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
274a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschkastatic int qeth_l2_set_offline(struct ccwgroup_device *);
284a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschkastatic int qeth_l2_stop(struct net_device *);
294a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschkastatic int qeth_l2_send_delmac(struct qeth_card *, __u8 *);
304a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschkastatic int qeth_l2_send_setdelmac(struct qeth_card *, __u8 *,
314a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka			   enum qeth_ipa_cmds,
324a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka			   int (*reply_cb) (struct qeth_card *,
334a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka					    struct qeth_reply*,
344a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka					    unsigned long));
354a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschkastatic void qeth_l2_set_multicast_list(struct net_device *);
364a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschkastatic int qeth_l2_recover(void *);
374a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
384a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschkastatic int qeth_l2_do_ioctl(struct net_device *dev, struct ifreq *rq, int cmd)
394a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka{
40509e2562adfd63964aa30c1ddd9ddf4e57949351Heiko Carstens	struct qeth_card *card = dev->ml_priv;
414a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	struct mii_ioctl_data *mii_data;
424a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	int rc = 0;
434a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
444a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	if (!card)
454a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		return -ENODEV;
464a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
474a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	if ((card->state != CARD_STATE_UP) &&
484a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		(card->state != CARD_STATE_SOFTSETUP))
494a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		return -ENODEV;
504a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
514a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	if (card->info.type == QETH_CARD_TYPE_OSN)
524a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		return -EPERM;
534a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
544a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	switch (cmd) {
554a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	case SIOC_QETH_ADP_SET_SNMP_CONTROL:
564a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		rc = qeth_snmp_command(card, rq->ifr_ifru.ifru_data);
574a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		break;
584a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	case SIOC_QETH_GET_CARD_TYPE:
595113fec0984276836cb6f0677f7cb53586ec3451Ursula Braun		if ((card->info.type == QETH_CARD_TYPE_OSD ||
605113fec0984276836cb6f0677f7cb53586ec3451Ursula Braun		     card->info.type == QETH_CARD_TYPE_OSM ||
615113fec0984276836cb6f0677f7cb53586ec3451Ursula Braun		     card->info.type == QETH_CARD_TYPE_OSX) &&
624a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		    !card->info.guestlan)
634a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka			return 1;
644a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		return 0;
654a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		break;
664a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	case SIOCGMIIPHY:
674a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		mii_data = if_mii(rq);
684a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		mii_data->phy_id = 0;
694a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		break;
704a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	case SIOCGMIIREG:
714a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		mii_data = if_mii(rq);
724a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		if (mii_data->phy_id != 0)
734a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka			rc = -EINVAL;
744a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		else
754a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka			mii_data->val_out = qeth_mdio_read(dev,
764a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka				mii_data->phy_id, mii_data->reg_num);
774a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		break;
784a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	default:
794a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		rc = -EOPNOTSUPP;
804a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	}
814a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	if (rc)
82847a50fd9f3d6a1ee8c8bf646aa8c9a61ea51550Carsten Otte		QETH_CARD_TEXT_(card, 2, "ioce%d", rc);
834a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	return rc;
844a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka}
854a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
864a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschkastatic int qeth_l2_verify_dev(struct net_device *dev)
874a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka{
884a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	struct qeth_card *card;
894a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	unsigned long flags;
904a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	int rc = 0;
914a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
924a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	read_lock_irqsave(&qeth_core_card_list.rwlock, flags);
934a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	list_for_each_entry(card, &qeth_core_card_list.list, list) {
944a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		if (card->dev == dev) {
954a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka			rc = QETH_REAL_CARD;
964a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka			break;
974a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		}
984a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	}
994a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	read_unlock_irqrestore(&qeth_core_card_list.rwlock, flags);
1004a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
1014a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	return rc;
1024a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka}
1034a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
1044a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschkastatic struct net_device *qeth_l2_netdev_by_devno(unsigned char *read_dev_no)
1054a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka{
1064a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	struct qeth_card *card;
1074a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	struct net_device *ndev;
108f06f6f3224afdd7e58207d1f5950f4666c5f095fCornelia Huck	__u16 temp_dev_no;
1094a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	unsigned long flags;
110f06f6f3224afdd7e58207d1f5950f4666c5f095fCornelia Huck	struct ccw_dev_id read_devid;
1114a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
1124a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	ndev = NULL;
1134a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	memcpy(&temp_dev_no, read_dev_no, 2);
1144a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	read_lock_irqsave(&qeth_core_card_list.rwlock, flags);
1154a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	list_for_each_entry(card, &qeth_core_card_list.list, list) {
116f06f6f3224afdd7e58207d1f5950f4666c5f095fCornelia Huck		ccw_device_get_id(CARD_RDEV(card), &read_devid);
117f06f6f3224afdd7e58207d1f5950f4666c5f095fCornelia Huck		if (read_devid.devno == temp_dev_no) {
1184a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka			ndev = card->dev;
1194a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka			break;
1204a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		}
1214a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	}
1224a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	read_unlock_irqrestore(&qeth_core_card_list.rwlock, flags);
1234a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	return ndev;
1244a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka}
1254a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
1264a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschkastatic int qeth_l2_send_setgroupmac_cb(struct qeth_card *card,
1274a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka				struct qeth_reply *reply,
1284a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka				unsigned long data)
1294a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka{
1304a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	struct qeth_ipa_cmd *cmd;
1314a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	__u8 *mac;
1324a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
133847a50fd9f3d6a1ee8c8bf646aa8c9a61ea51550Carsten Otte	QETH_CARD_TEXT(card, 2, "L2Sgmacb");
1344a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	cmd = (struct qeth_ipa_cmd *) data;
1354a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	mac = &cmd->data.setdelmac.mac[0];
1364a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	/* MAC already registered, needed in couple/uncouple case */
1370666eb06ab12b1f876719ff5b7d39cf3c609dec3Ursula Braun	if (cmd->hdr.return_code ==  IPA_RC_L2_DUP_MAC) {
1387c510e4b730a92cecf94ada45c989d8be0200d47Johannes Berg		QETH_DBF_MESSAGE(2, "Group MAC %pM already existing on %s \n",
1397c510e4b730a92cecf94ada45c989d8be0200d47Johannes Berg			  mac, QETH_CARD_IFNAME(card));
1404a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		cmd->hdr.return_code = 0;
1414a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	}
1424a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	if (cmd->hdr.return_code)
1437c510e4b730a92cecf94ada45c989d8be0200d47Johannes Berg		QETH_DBF_MESSAGE(2, "Could not set group MAC %pM on %s: %x\n",
1447c510e4b730a92cecf94ada45c989d8be0200d47Johannes Berg			  mac, QETH_CARD_IFNAME(card), cmd->hdr.return_code);
1454a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	return 0;
1464a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka}
1474a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
1484a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschkastatic int qeth_l2_send_setgroupmac(struct qeth_card *card, __u8 *mac)
1494a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka{
150847a50fd9f3d6a1ee8c8bf646aa8c9a61ea51550Carsten Otte	QETH_CARD_TEXT(card, 2, "L2Sgmac");
1514a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	return qeth_l2_send_setdelmac(card, mac, IPA_CMD_SETGMAC,
1524a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka					  qeth_l2_send_setgroupmac_cb);
1534a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka}
1544a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
1554a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschkastatic int qeth_l2_send_delgroupmac_cb(struct qeth_card *card,
1564a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka				struct qeth_reply *reply,
1574a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka				unsigned long data)
1584a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka{
1594a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	struct qeth_ipa_cmd *cmd;
1604a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	__u8 *mac;
1614a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
162847a50fd9f3d6a1ee8c8bf646aa8c9a61ea51550Carsten Otte	QETH_CARD_TEXT(card, 2, "L2Dgmacb");
1634a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	cmd = (struct qeth_ipa_cmd *) data;
1644a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	mac = &cmd->data.setdelmac.mac[0];
1654a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	if (cmd->hdr.return_code)
1667c510e4b730a92cecf94ada45c989d8be0200d47Johannes Berg		QETH_DBF_MESSAGE(2, "Could not delete group MAC %pM on %s: %x\n",
1677c510e4b730a92cecf94ada45c989d8be0200d47Johannes Berg			  mac, QETH_CARD_IFNAME(card), cmd->hdr.return_code);
1684a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	return 0;
1694a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka}
1704a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
1714a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschkastatic int qeth_l2_send_delgroupmac(struct qeth_card *card, __u8 *mac)
1724a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka{
173847a50fd9f3d6a1ee8c8bf646aa8c9a61ea51550Carsten Otte	QETH_CARD_TEXT(card, 2, "L2Dgmac");
1744a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	return qeth_l2_send_setdelmac(card, mac, IPA_CMD_DELGMAC,
1754a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka					  qeth_l2_send_delgroupmac_cb);
1764a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka}
1774a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
1787db2266a374d66f5ac85334c922cb37d76939cc5Frank Blaschkastatic void qeth_l2_add_mc(struct qeth_card *card, __u8 *mac, int vmac)
1794a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka{
1804a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	struct qeth_mc_mac *mc;
1817db2266a374d66f5ac85334c922cb37d76939cc5Frank Blaschka	int rc;
1824a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
1834a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	mc = kmalloc(sizeof(struct qeth_mc_mac), GFP_ATOMIC);
1844a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
18514cc21b6770972e5d1487dbf3a2caaf63cae909aFrank Blaschka	if (!mc)
1864a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		return;
1874a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
1884a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	memcpy(mc->mc_addr, mac, OSA_ADDR_LEN);
1894a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	mc->mc_addrlen = OSA_ADDR_LEN;
1907db2266a374d66f5ac85334c922cb37d76939cc5Frank Blaschka	mc->is_vmac = vmac;
1917db2266a374d66f5ac85334c922cb37d76939cc5Frank Blaschka
1927db2266a374d66f5ac85334c922cb37d76939cc5Frank Blaschka	if (vmac) {
1937db2266a374d66f5ac85334c922cb37d76939cc5Frank Blaschka		rc = qeth_l2_send_setdelmac(card, mac, IPA_CMD_SETVMAC,
1947db2266a374d66f5ac85334c922cb37d76939cc5Frank Blaschka					NULL);
1957db2266a374d66f5ac85334c922cb37d76939cc5Frank Blaschka	} else {
1967db2266a374d66f5ac85334c922cb37d76939cc5Frank Blaschka		rc = qeth_l2_send_setgroupmac(card, mac);
1977db2266a374d66f5ac85334c922cb37d76939cc5Frank Blaschka	}
1984a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
1997db2266a374d66f5ac85334c922cb37d76939cc5Frank Blaschka	if (!rc)
2004a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		list_add_tail(&mc->list, &card->mc_list);
2014a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	else
2024a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		kfree(mc);
2034a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka}
2044a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
20570919e23ac35c9c244dfd73f97312894cae7d65fUrsula Braunstatic void qeth_l2_del_all_mc(struct qeth_card *card)
2064a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka{
2074a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	struct qeth_mc_mac *mc, *tmp;
2084a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
2094a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	spin_lock_bh(&card->mclock);
2104a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	list_for_each_entry_safe(mc, tmp, &card->mc_list, list) {
21170919e23ac35c9c244dfd73f97312894cae7d65fUrsula Braun		if (mc->is_vmac)
21270919e23ac35c9c244dfd73f97312894cae7d65fUrsula Braun			qeth_l2_send_setdelmac(card, mc->mc_addr,
21370919e23ac35c9c244dfd73f97312894cae7d65fUrsula Braun					IPA_CMD_DELVMAC, NULL);
2147db2266a374d66f5ac85334c922cb37d76939cc5Frank Blaschka		else
21570919e23ac35c9c244dfd73f97312894cae7d65fUrsula Braun			qeth_l2_send_delgroupmac(card, mc->mc_addr);
21670919e23ac35c9c244dfd73f97312894cae7d65fUrsula Braun		list_del(&mc->list);
21770919e23ac35c9c244dfd73f97312894cae7d65fUrsula Braun		kfree(mc);
2184a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	}
2194a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	spin_unlock_bh(&card->mclock);
2204a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka}
2214a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
2224a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschkastatic inline int qeth_l2_get_cast_type(struct qeth_card *card,
2234a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka			struct sk_buff *skb)
224ce73e10ee0cb6cde1c5075a2803da0f0eb5b2324Klaus-Dieter Wacker{
225ce73e10ee0cb6cde1c5075a2803da0f0eb5b2324Klaus-Dieter Wacker	if (card->info.type == QETH_CARD_TYPE_OSN)
2264a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		return RTN_UNSPEC;
227ce73e10ee0cb6cde1c5075a2803da0f0eb5b2324Klaus-Dieter Wacker	if (is_broadcast_ether_addr(skb->data))
228ce73e10ee0cb6cde1c5075a2803da0f0eb5b2324Klaus-Dieter Wacker		return RTN_BROADCAST;
229ce73e10ee0cb6cde1c5075a2803da0f0eb5b2324Klaus-Dieter Wacker	if (is_multicast_ether_addr(skb->data))
230ce73e10ee0cb6cde1c5075a2803da0f0eb5b2324Klaus-Dieter Wacker		return RTN_MULTICAST;
231ce73e10ee0cb6cde1c5075a2803da0f0eb5b2324Klaus-Dieter Wacker	return RTN_UNSPEC;
232ce73e10ee0cb6cde1c5075a2803da0f0eb5b2324Klaus-Dieter Wacker}
233ce73e10ee0cb6cde1c5075a2803da0f0eb5b2324Klaus-Dieter Wacker
2344a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschkastatic void qeth_l2_fill_header(struct qeth_card *card, struct qeth_hdr *hdr,
2354a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka			struct sk_buff *skb, int ipv, int cast_type)
2364a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka{
2374a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	struct vlan_ethhdr *veth = (struct vlan_ethhdr *)skb_mac_header(skb);
2384a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
239683d718a893575a88c551ad71ea2c382eedbf67eFrank Blaschka	memset(hdr, 0, sizeof(struct qeth_hdr));
2404a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	hdr->hdr.l2.id = QETH_HEADER_TYPE_LAYER2;
2414a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
2424a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	/* set byte byte 3 to casting flags */
2434a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	if (cast_type == RTN_MULTICAST)
2444a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_MULTICAST;
2454a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	else if (cast_type == RTN_BROADCAST)
2464a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_BROADCAST;
2474a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	else
2484a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_UNICAST;
2494a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
250ce73e10ee0cb6cde1c5075a2803da0f0eb5b2324Klaus-Dieter Wacker	hdr->hdr.l2.pkt_length = skb->len-QETH_HEADER_SIZE;
2514a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	/* VSWITCH relies on the VLAN
2524a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	 * information to be present in
2534a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	 * the QDIO header */
2544a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	if (veth->h_vlan_proto == __constant_htons(ETH_P_8021Q)) {
2554a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_VLAN;
2564a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		hdr->hdr.l2.vlan_id = ntohs(veth->h_vlan_TCI);
2574a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	}
2584a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka}
2594a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
2604a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschkastatic int qeth_l2_send_setdelvlan_cb(struct qeth_card *card,
2614a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka			struct qeth_reply *reply, unsigned long data)
2624a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka{
2634a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	struct qeth_ipa_cmd *cmd;
2644a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
2654a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	QETH_CARD_TEXT(card, 2, "L2sdvcb");
2664a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	cmd = (struct qeth_ipa_cmd *) data;
267847a50fd9f3d6a1ee8c8bf646aa8c9a61ea51550Carsten Otte	if (cmd->hdr.return_code) {
2684a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		QETH_DBF_MESSAGE(2, "Error in processing VLAN %i on %s: 0x%x. "
2694a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka			  "Continuing\n", cmd->data.setdelvlan.vlan_id,
27014cc21b6770972e5d1487dbf3a2caaf63cae909aFrank Blaschka			  QETH_CARD_IFNAME(card), cmd->hdr.return_code);
2714a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		QETH_CARD_TEXT_(card, 2, "L2VL%4x", cmd->hdr.command);
2724a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		QETH_CARD_TEXT_(card, 2, "err%d", cmd->hdr.return_code);
273847a50fd9f3d6a1ee8c8bf646aa8c9a61ea51550Carsten Otte	}
274847a50fd9f3d6a1ee8c8bf646aa8c9a61ea51550Carsten Otte	return 0;
2754a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka}
2764a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
2774a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschkastatic int qeth_l2_send_setdelvlan(struct qeth_card *card, __u16 i,
2784a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka				enum qeth_ipa_cmds ipacmd)
2794a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka{
2804a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	struct qeth_ipa_cmd *cmd;
2814a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	struct qeth_cmd_buffer *iob;
2824a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
2834a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	QETH_CARD_TEXT_(card, 4, "L2sdv%x", ipacmd);
2844a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	iob = qeth_get_ipacmd_buffer(card, ipacmd, QETH_PROT_IPV4);
285847a50fd9f3d6a1ee8c8bf646aa8c9a61ea51550Carsten Otte	cmd = (struct qeth_ipa_cmd *)(iob->data+IPA_PDU_HEADER_SIZE);
2864a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	cmd->data.setdelvlan.vlan_id = i;
2874a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	return qeth_send_ipa_cmd(card, iob,
2884a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka				 qeth_l2_send_setdelvlan_cb, NULL);
2894a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka}
2904a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
2914a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschkastatic void qeth_l2_process_vlans(struct qeth_card *card, int clear)
2924a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka{
29370919e23ac35c9c244dfd73f97312894cae7d65fUrsula Braun	struct qeth_vlan_vid *id;
2944a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	QETH_CARD_TEXT(card, 3, "L2prcvln");
2954a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	spin_lock_bh(&card->vlanlock);
296847a50fd9f3d6a1ee8c8bf646aa8c9a61ea51550Carsten Otte	list_for_each_entry(id, &card->vid_list, list) {
2974a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		if (clear)
2984a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka			qeth_l2_send_setdelvlan(card, id->vid,
29970919e23ac35c9c244dfd73f97312894cae7d65fUrsula Braun				IPA_CMD_DELVLAN);
3004a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		else
3014a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka			qeth_l2_send_setdelvlan(card, id->vid,
3024a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka				IPA_CMD_SETVLAN);
3034a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	}
3044a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	spin_unlock_bh(&card->vlanlock);
3054a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka}
306509e2562adfd63964aa30c1ddd9ddf4e57949351Heiko Carstens
3074a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschkastatic void qeth_l2_vlan_rx_add_vid(struct net_device *dev, unsigned short vid)
3084a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka{
309847a50fd9f3d6a1ee8c8bf646aa8c9a61ea51550Carsten Otte	struct qeth_card *card = dev->ml_priv;
31010651db75a94c54a34bbf85fbee334d1114da3fbUrsula Braun	struct qeth_vlan_vid *id;
31110651db75a94c54a34bbf85fbee334d1114da3fbUrsula Braun
3125113fec0984276836cb6f0677f7cb53586ec3451Ursula Braun	QETH_CARD_TEXT_(card, 4, "aid:%d", vid);
313847a50fd9f3d6a1ee8c8bf646aa8c9a61ea51550Carsten Otte	if (!vid)
3145113fec0984276836cb6f0677f7cb53586ec3451Ursula Braun		return;
3155113fec0984276836cb6f0677f7cb53586ec3451Ursula Braun	if (card->info.type == QETH_CARD_TYPE_OSM) {
3168e98ac48d06068470f1b954e599cf7b706cfcebaUrsula Braun		QETH_CARD_TEXT(card, 3, "aidOSM");
317847a50fd9f3d6a1ee8c8bf646aa8c9a61ea51550Carsten Otte		return;
3188e98ac48d06068470f1b954e599cf7b706cfcebaUrsula Braun	}
3198e98ac48d06068470f1b954e599cf7b706cfcebaUrsula Braun	if (qeth_wait_for_threads(card, QETH_RECOVER_THREAD)) {
3204a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		QETH_CARD_TEXT(card, 3, "aidREC");
3214a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		return;
3224a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	}
3234a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	id = kmalloc(sizeof(struct qeth_vlan_vid), GFP_ATOMIC);
3244a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	if (id) {
3254a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		id->vid = vid;
3264a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		qeth_l2_send_setdelvlan(card, vid, IPA_CMD_SETVLAN);
3274a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		spin_lock_bh(&card->vlanlock);
3284a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		list_add_tail(&id->list, &card->vid_list);
3294a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		spin_unlock_bh(&card->vlanlock);
3304a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	}
3314a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka}
3324a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
333509e2562adfd63964aa30c1ddd9ddf4e57949351Heiko Carstensstatic void qeth_l2_vlan_rx_kill_vid(struct net_device *dev, unsigned short vid)
3344a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka{
335847a50fd9f3d6a1ee8c8bf646aa8c9a61ea51550Carsten Otte	struct qeth_vlan_vid *id, *tmpid = NULL;
3365113fec0984276836cb6f0677f7cb53586ec3451Ursula Braun	struct qeth_card *card = dev->ml_priv;
337847a50fd9f3d6a1ee8c8bf646aa8c9a61ea51550Carsten Otte
3385113fec0984276836cb6f0677f7cb53586ec3451Ursula Braun	QETH_CARD_TEXT_(card, 4, "kid:%d", vid);
3395113fec0984276836cb6f0677f7cb53586ec3451Ursula Braun	if (card->info.type == QETH_CARD_TYPE_OSM) {
3408e98ac48d06068470f1b954e599cf7b706cfcebaUrsula Braun		QETH_CARD_TEXT(card, 3, "kidOSM");
341847a50fd9f3d6a1ee8c8bf646aa8c9a61ea51550Carsten Otte		return;
3428e98ac48d06068470f1b954e599cf7b706cfcebaUrsula Braun	}
3438e98ac48d06068470f1b954e599cf7b706cfcebaUrsula Braun	if (qeth_wait_for_threads(card, QETH_RECOVER_THREAD)) {
3444a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		QETH_CARD_TEXT(card, 3, "kidREC");
3454a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		return;
3464a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	}
3474a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	spin_lock_bh(&card->vlanlock);
3484a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	list_for_each_entry(id, &card->vid_list, list) {
3494a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		if (id->vid == vid) {
3504a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka			list_del(&id->list);
3514a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka			tmpid = id;
3524a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka			break;
3534a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		}
3544a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	}
3554a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	spin_unlock_bh(&card->vlanlock);
3564a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	if (tmpid) {
3574a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		qeth_l2_send_setdelvlan(card, vid, IPA_CMD_DELVLAN);
3584a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		kfree(tmpid);
3594a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	}
3604a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	qeth_l2_set_multicast_list(card->dev);
3614a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka}
3624a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
3634a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschkastatic int qeth_l2_stop_card(struct qeth_card *card, int recovery_mode)
364d11ba0c40fa8a21511822efee3be8389f94f0431Peter Tiedemann{
365d11ba0c40fa8a21511822efee3be8389f94f0431Peter Tiedemann	int rc = 0;
3664a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
3674a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	QETH_DBF_TEXT(SETUP , 2, "stopcard");
3684a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	QETH_DBF_HEX(SETUP, 2, &card, sizeof(void *));
3694a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
3704a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	qeth_set_allowed_threads(card, 0, 1);
3714a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	if (card->read.state == CH_STATE_UP &&
3724a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	    card->write.state == CH_STATE_UP &&
3734a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	    (card->state == CARD_STATE_UP)) {
3744a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		if (recovery_mode &&
3754a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		    card->info.type != QETH_CARD_TYPE_OSN) {
3764a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka			qeth_l2_stop(card->dev);
3774a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		} else {
3784a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka			rtnl_lock();
37970919e23ac35c9c244dfd73f97312894cae7d65fUrsula Braun			dev_close(card->dev);
3804a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka			rtnl_unlock();
3814a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		}
3824a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		if (!card->use_hard_stop ||
38370919e23ac35c9c244dfd73f97312894cae7d65fUrsula Braun			recovery_mode) {
3844a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka			__u8 *mac = &card->dev->dev_addr[0];
3854a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka			rc = qeth_l2_send_delmac(card, mac);
3864a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka			QETH_DBF_TEXT_(SETUP, 2, "Lerr%d", rc);
3874a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		}
3884a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		card->state = CARD_STATE_SOFTSETUP;
3894a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	}
3904a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	if (card->state == CARD_STATE_SOFTSETUP) {
3914a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		qeth_l2_process_vlans(card, 1);
3924a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		if (!card->use_hard_stop ||
3934a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka			recovery_mode)
3944a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka			qeth_l2_del_all_mc(card);
3954a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		qeth_clear_ipacmd_list(card);
3964a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		card->state = CARD_STATE_HARDSETUP;
3974a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	}
3984a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	if (card->state == CARD_STATE_HARDSETUP) {
3994a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		qeth_qdio_clear_card(card, 0);
400a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka		qeth_clear_qdio_buffers(card);
401a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka		qeth_clear_working_pool_list(card);
4024a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		card->state = CARD_STATE_DOWN;
403a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka	}
4044a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	if (card->state == CARD_STATE_DOWN) {
4054a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		qeth_clear_cmd_buffers(&card->read);
4064a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		qeth_clear_cmd_buffers(&card->write);
4074a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	}
408a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka	card->use_hard_stop = 0;
409a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka	return rc;
410a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka}
411a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka
412b333293058aa2d401737c7246bce58f8ba00906dFrank Blaschkastatic int qeth_l2_process_inbound_buffer(struct qeth_card *card,
413a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka				int budget, int *done)
414a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka{
415a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka	int work_done = 0;
416a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka	struct sk_buff *skb;
4174a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	struct qeth_hdr *hdr;
418a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka	unsigned int len;
4194a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
4204a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	*done = 0;
4214a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	BUG_ON(!budget);
4224a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	while (budget) {
423c5e631a8d4e305a68465b7334efe9875be8b7033Frank Blaschka		skb = qeth_core_get_next_skb(card,
424128837259912087101cd336226abc7ee3e8555b5Ursula Braun			card->qdio.in_q->bufs[card->rx.b_index].buffer,
425128837259912087101cd336226abc7ee3e8555b5Ursula Braun			&card->rx.b_element, &card->rx.e_offset, &hdr);
4264a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		if (!skb) {
427a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka			*done = 1;
4284a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka			break;
4294a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		}
4302d488c2f514a6c5248a0773c78345626abdc1818Ursula Braun		skb->dev = card->dev;
4312d488c2f514a6c5248a0773c78345626abdc1818Ursula Braun		switch (hdr->hdr.l2.id) {
4322d488c2f514a6c5248a0773c78345626abdc1818Ursula Braun		case QETH_HEADER_TYPE_LAYER2:
4334a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka			skb->pkt_type = PACKET_HOST;
4342d488c2f514a6c5248a0773c78345626abdc1818Ursula Braun			skb->protocol = eth_type_trans(skb, skb->dev);
4352d488c2f514a6c5248a0773c78345626abdc1818Ursula Braun			if (card->options.checksum_type == NO_CHECKSUMMING)
4362d488c2f514a6c5248a0773c78345626abdc1818Ursula Braun				skb->ip_summed = CHECKSUM_UNNECESSARY;
4372d488c2f514a6c5248a0773c78345626abdc1818Ursula Braun			else
4382d488c2f514a6c5248a0773c78345626abdc1818Ursula Braun				skb->ip_summed = CHECKSUM_NONE;
4394a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka			if (skb->protocol == htons(ETH_P_802_2))
4404a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka				*((__u32 *)skb->cb) = ++card->seqno.pkt_seqno;
441847a50fd9f3d6a1ee8c8bf646aa8c9a61ea51550Carsten Otte			len = skb->len;
442d11ba0c40fa8a21511822efee3be8389f94f0431Peter Tiedemann			netif_receive_skb(skb);
4434a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka			break;
4444a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		case QETH_HEADER_TYPE_OSN:
445a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka			if (card->info.type == QETH_CARD_TYPE_OSN) {
446a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka				skb_push(skb, sizeof(struct qeth_hdr));
4474a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka				skb_copy_to_linear_data(skb, hdr,
4484a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka						sizeof(struct qeth_hdr));
4494a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka				len = skb->len;
450a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka				card->osn_info.data_cb(skb);
451a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka				break;
452a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka			}
453a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka			/* else unknown */
454a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka		default:
455a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka			dev_kfree_skb_any(skb);
456a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka			QETH_CARD_TEXT(card, 3, "inbunkno");
457a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka			QETH_DBF_HEX(CTRL, 3, hdr, QETH_DBF_CTRL_LEN);
458a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka			continue;
459a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka		}
460a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka		work_done++;
461a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka		budget--;
462a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka		card->stats.rx_packets++;
463a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka		card->stats.rx_bytes += len;
464a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka	}
465a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka	return work_done;
466a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka}
467a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka
468a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschkastatic int qeth_l2_poll(struct napi_struct *napi, int budget)
469a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka{
470a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka	struct qeth_card *card = container_of(napi, struct qeth_card, napi);
471a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka	int work_done = 0;
472a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka	struct qeth_qdio_buffer *buffer;
473a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka	int done;
474a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka	int new_budget = budget;
475a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka
476a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka	if (card->options.performance_stats) {
477a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka		card->perf_stats.inbound_cnt++;
478a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka		card->perf_stats.inbound_start_time = qeth_get_micros();
479a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka	}
480a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka
481a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka	while (1) {
482a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka		if (!card->rx.b_count) {
483a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka			card->rx.qdio_err = 0;
484a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka			card->rx.b_count = qdio_get_next_buffers(
485a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka				card->data.ccwdev, 0, &card->rx.b_index,
486a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka				&card->rx.qdio_err);
487a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka			if (card->rx.b_count <= 0) {
488a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka				card->rx.b_count = 0;
489a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka				break;
490a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka			}
491a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka			card->rx.b_element =
492a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka				&card->qdio.in_q->bufs[card->rx.b_index]
493a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka				.buffer->element[0];
494a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka			card->rx.e_offset = 0;
495a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka		}
496a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka
497a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka		while (card->rx.b_count) {
498a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka			buffer = &card->qdio.in_q->bufs[card->rx.b_index];
499a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka			if (!(card->rx.qdio_err &&
500a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka			    qeth_check_qdio_errors(card, buffer->buffer,
501a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka			    card->rx.qdio_err, "qinerr")))
502a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka				work_done += qeth_l2_process_inbound_buffer(
503a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka					card, new_budget, &done);
504a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka			else
505a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka				done = 1;
506a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka
507a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka			if (done) {
508a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka				if (card->options.performance_stats)
509a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka					card->perf_stats.bufs_rec++;
510a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka				qeth_put_buffer_pool_entry(card,
511a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka					buffer->pool_entry);
512a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka				qeth_queue_input_buffer(card, card->rx.b_index);
513a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka				card->rx.b_count--;
514a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka				if (card->rx.b_count) {
515a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka					card->rx.b_index =
516a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka						(card->rx.b_index + 1) %
517a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka						QDIO_MAX_BUFFERS_PER_Q;
518a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka					card->rx.b_element =
519a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka						&card->qdio.in_q
520a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka						->bufs[card->rx.b_index]
521a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka						.buffer->element[0];
522a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka					card->rx.e_offset = 0;
523a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka				}
524a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka			}
525a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka
5264a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka			if (work_done >= budget)
5274a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka				goto out;
5284a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka			else
5294a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka				new_budget = budget - work_done;
5304a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		}
5314a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	}
5324a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
5334a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	napi_complete(napi);
5344a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	if (qdio_start_irq(card->data.ccwdev, 0))
5354a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		napi_schedule(&card->napi);
5364a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschkaout:
537847a50fd9f3d6a1ee8c8bf646aa8c9a61ea51550Carsten Otte	if (card->options.performance_stats)
5384a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		card->perf_stats.inbound_time += qeth_get_micros() -
5394a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka			card->perf_stats.inbound_start_time;
5404a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	return work_done;
5414a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka}
5424a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
5434a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschkastatic int qeth_l2_send_setdelmac(struct qeth_card *card, __u8 *mac,
5444a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka			   enum qeth_ipa_cmds ipacmd,
5454a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka			   int (*reply_cb) (struct qeth_card *,
5464a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka					    struct qeth_reply*,
5474a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka					    unsigned long))
5484a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka{
5494a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	struct qeth_ipa_cmd *cmd;
5504a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	struct qeth_cmd_buffer *iob;
551847a50fd9f3d6a1ee8c8bf646aa8c9a61ea51550Carsten Otte
5524a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	QETH_CARD_TEXT(card, 2, "L2sdmac");
5534a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	iob = qeth_get_ipacmd_buffer(card, ipacmd, QETH_PROT_IPV4);
554847a50fd9f3d6a1ee8c8bf646aa8c9a61ea51550Carsten Otte	cmd = (struct qeth_ipa_cmd *)(iob->data+IPA_PDU_HEADER_SIZE);
5554a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	cmd->data.setdelmac.mac_length = OSA_ADDR_LEN;
5560666eb06ab12b1f876719ff5b7d39cf3c609dec3Ursula Braun	memcpy(&cmd->data.setdelmac.mac, mac, OSA_ADDR_LEN);
5570666eb06ab12b1f876719ff5b7d39cf3c609dec3Ursula Braun	return qeth_send_ipa_cmd(card, iob, reply_cb, NULL);
5580666eb06ab12b1f876719ff5b7d39cf3c609dec3Ursula Braun}
5590666eb06ab12b1f876719ff5b7d39cf3c609dec3Ursula Braun
560d998ab0bd737fad9c8e3c88eb6f52c43e90fda9aH Hartley Sweetenstatic int qeth_l2_send_setmac_cb(struct qeth_card *card,
561221c17fe87033aa154df68679b437c83d835c284Ursula Braun			   struct qeth_reply *reply,
5620666eb06ab12b1f876719ff5b7d39cf3c609dec3Ursula Braun			   unsigned long data)
5630666eb06ab12b1f876719ff5b7d39cf3c609dec3Ursula Braun{
5640666eb06ab12b1f876719ff5b7d39cf3c609dec3Ursula Braun	struct qeth_ipa_cmd *cmd;
5650666eb06ab12b1f876719ff5b7d39cf3c609dec3Ursula Braun
566d998ab0bd737fad9c8e3c88eb6f52c43e90fda9aH Hartley Sweeten	QETH_CARD_TEXT(card, 2, "L2Smaccb");
567221c17fe87033aa154df68679b437c83d835c284Ursula Braun	cmd = (struct qeth_ipa_cmd *) data;
5680666eb06ab12b1f876719ff5b7d39cf3c609dec3Ursula Braun	if (cmd->hdr.return_code) {
5690666eb06ab12b1f876719ff5b7d39cf3c609dec3Ursula Braun		QETH_CARD_TEXT_(card, 2, "L2er%x", cmd->hdr.return_code);
5700666eb06ab12b1f876719ff5b7d39cf3c609dec3Ursula Braun		card->info.mac_bits &= ~QETH_LAYER2_MAC_REGISTERED;
5710666eb06ab12b1f876719ff5b7d39cf3c609dec3Ursula Braun		switch (cmd->hdr.return_code) {
5724a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		case IPA_RC_L2_DUP_MAC:
5734a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		case IPA_RC_L2_DUP_LAYER3_MAC:
5744a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka			dev_warn(&card->gdev->dev,
5754a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka				"MAC address %pM already exists\n",
5764a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka				card->dev->dev_addr);
57774eacdb9c2bf9fc6e8c6785013b5dd0e551a9dfaFrank Blaschka			break;
578d998ab0bd737fad9c8e3c88eb6f52c43e90fda9aH Hartley Sweeten		case IPA_RC_L2_MAC_NOT_AUTH_BY_HYP:
579d998ab0bd737fad9c8e3c88eb6f52c43e90fda9aH Hartley Sweeten		case IPA_RC_L2_MAC_NOT_AUTH_BY_ADP:
5804a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka			dev_warn(&card->gdev->dev,
5814a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka				"MAC address %pM is not authorized\n",
5824a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka				card->dev->dev_addr);
5834a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka			break;
5844a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		default:
5854a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka			break;
586847a50fd9f3d6a1ee8c8bf646aa8c9a61ea51550Carsten Otte		}
5874a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		cmd->hdr.return_code = -EIO;
5884a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	} else {
5894a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		card->info.mac_bits |= QETH_LAYER2_MAC_REGISTERED;
5904a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		memcpy(card->dev->dev_addr, cmd->data.setdelmac.mac,
5914a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		       OSA_ADDR_LEN);
5924a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		dev_info(&card->gdev->dev,
5934a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka			"MAC address %pM successfully registered on device %s\n",
5944a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka			card->dev->dev_addr, card->dev->name);
5954a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	}
5964a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	return 0;
597847a50fd9f3d6a1ee8c8bf646aa8c9a61ea51550Carsten Otte}
5984a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
5994a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschkastatic int qeth_l2_send_setmac(struct qeth_card *card, __u8 *mac)
600847a50fd9f3d6a1ee8c8bf646aa8c9a61ea51550Carsten Otte{
6014a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	QETH_CARD_TEXT(card, 2, "L2Setmac");
6024a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	return qeth_l2_send_setdelmac(card, mac, IPA_CMD_SETVMAC,
6034a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka					  qeth_l2_send_setmac_cb);
6044a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka}
6054a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
6064a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschkastatic int qeth_l2_send_delmac_cb(struct qeth_card *card,
6074a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka			   struct qeth_reply *reply,
6084a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka			   unsigned long data)
6094a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka{
6104a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	struct qeth_ipa_cmd *cmd;
611847a50fd9f3d6a1ee8c8bf646aa8c9a61ea51550Carsten Otte
6124a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	QETH_CARD_TEXT(card, 2, "L2Dmaccb");
6134a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	cmd = (struct qeth_ipa_cmd *) data;
6144a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	if (cmd->hdr.return_code) {
6154a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		QETH_CARD_TEXT_(card, 2, "err%d", cmd->hdr.return_code);
6164a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		cmd->hdr.return_code = -EIO;
6174a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		return 0;
6184a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	}
6194a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	card->info.mac_bits &= ~QETH_LAYER2_MAC_REGISTERED;
6204a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
6214a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	return 0;
6224a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka}
623d11ba0c40fa8a21511822efee3be8389f94f0431Peter Tiedemann
624d11ba0c40fa8a21511822efee3be8389f94f0431Peter Tiedemannstatic int qeth_l2_send_delmac(struct qeth_card *card, __u8 *mac)
6254a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka{
6264a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	QETH_CARD_TEXT(card, 2, "L2Delmac");
6274a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	if (!(card->info.mac_bits & QETH_LAYER2_MAC_REGISTERED))
62814cc21b6770972e5d1487dbf3a2caaf63cae909aFrank Blaschka		return 0;
62914cc21b6770972e5d1487dbf3a2caaf63cae909aFrank Blaschka	return qeth_l2_send_setdelmac(card, mac, IPA_CMD_DELVMAC,
6304a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka					  qeth_l2_send_delmac_cb);
6314a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka}
6325113fec0984276836cb6f0677f7cb53586ec3451Ursula Braun
6335113fec0984276836cb6f0677f7cb53586ec3451Ursula Braunstatic int qeth_l2_request_initial_mac(struct qeth_card *card)
6345113fec0984276836cb6f0677f7cb53586ec3451Ursula Braun{
6355113fec0984276836cb6f0677f7cb53586ec3451Ursula Braun	int rc = 0;
6364a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	char vendor_pre[] = {0x02, 0x00, 0x00};
6374a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
63814cc21b6770972e5d1487dbf3a2caaf63cae909aFrank Blaschka	QETH_DBF_TEXT(SETUP, 2, "doL2init");
63914cc21b6770972e5d1487dbf3a2caaf63cae909aFrank Blaschka	QETH_DBF_TEXT_(SETUP, 2, "doL2%s", CARD_BUS_ID(card));
640d11ba0c40fa8a21511822efee3be8389f94f0431Peter Tiedemann
6414a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	rc = qeth_query_setadapterparms(card);
6424a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	if (rc) {
643d11ba0c40fa8a21511822efee3be8389f94f0431Peter Tiedemann		QETH_DBF_MESSAGE(2, "could not query adapter parameters on "
6444a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka			"device %s: x%x\n", CARD_BUS_ID(card), rc);
6454a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	}
6464a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
6474a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	if (card->info.type == QETH_CARD_TYPE_IQD ||
6484a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	    card->info.type == QETH_CARD_TYPE_OSM ||
6494a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	    card->info.type == QETH_CARD_TYPE_OSX ||
6504a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	    card->info.guestlan) {
6514a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		rc = qeth_setadpparms_change_macaddr(card);
6524a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		if (rc) {
6534a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka			QETH_DBF_MESSAGE(2, "couldn't get MAC address on "
654509e2562adfd63964aa30c1ddd9ddf4e57949351Heiko Carstens				"device %s: x%x\n", CARD_BUS_ID(card), rc);
6554a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka			QETH_DBF_TEXT_(SETUP, 2, "1err%d", rc);
6564a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka			return rc;
657847a50fd9f3d6a1ee8c8bf646aa8c9a61ea51550Carsten Otte		}
6584a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		QETH_DBF_HEX(SETUP, 2, card->dev->dev_addr, OSA_ADDR_LEN);
6594a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	} else {
660847a50fd9f3d6a1ee8c8bf646aa8c9a61ea51550Carsten Otte		random_ether_addr(card->dev->dev_addr);
6614a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		memcpy(card->dev->dev_addr, vendor_pre, 3);
6624a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	}
6634a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	return 0;
6645113fec0984276836cb6f0677f7cb53586ec3451Ursula Braun}
6655113fec0984276836cb6f0677f7cb53586ec3451Ursula Braun
6665113fec0984276836cb6f0677f7cb53586ec3451Ursula Braunstatic int qeth_l2_set_mac_address(struct net_device *dev, void *p)
667847a50fd9f3d6a1ee8c8bf646aa8c9a61ea51550Carsten Otte{
6684a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	struct sockaddr *addr = p;
6694a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	struct qeth_card *card = dev->ml_priv;
670847a50fd9f3d6a1ee8c8bf646aa8c9a61ea51550Carsten Otte	int rc = 0;
6718e98ac48d06068470f1b954e599cf7b706cfcebaUrsula Braun
672847a50fd9f3d6a1ee8c8bf646aa8c9a61ea51550Carsten Otte	QETH_CARD_TEXT(card, 3, "setmac");
6738e98ac48d06068470f1b954e599cf7b706cfcebaUrsula Braun
6748e98ac48d06068470f1b954e599cf7b706cfcebaUrsula Braun	if (qeth_l2_verify_dev(dev) != QETH_REAL_CARD) {
6754a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		QETH_CARD_TEXT(card, 3, "setmcINV");
6764a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		return -EOPNOTSUPP;
6774a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	}
6784a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
6794a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	if (card->info.type == QETH_CARD_TYPE_OSN ||
6804a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	    card->info.type == QETH_CARD_TYPE_OSM ||
6814a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	    card->info.type == QETH_CARD_TYPE_OSX) {
6824a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		QETH_CARD_TEXT(card, 3, "setmcTYP");
683509e2562adfd63964aa30c1ddd9ddf4e57949351Heiko Carstens		return -EOPNOTSUPP;
684ccffad25b5136958d4769ed6de5e87992dd9c65cJiri Pirko	}
6854a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	QETH_CARD_HEX(card, 3, addr->sa_data, OSA_ADDR_LEN);
6864a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	if (qeth_wait_for_threads(card, QETH_RECOVER_THREAD)) {
6874a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		QETH_CARD_TEXT(card, 3, "setmcREC");
6884a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		return -ERESTARTSYS;
689847a50fd9f3d6a1ee8c8bf646aa8c9a61ea51550Carsten Otte	}
6908e98ac48d06068470f1b954e599cf7b706cfcebaUrsula Braun	rc = qeth_l2_send_delmac(card, &card->dev->dev_addr[0]);
6918e98ac48d06068470f1b954e599cf7b706cfcebaUrsula Braun	if (!rc)
6928e98ac48d06068470f1b954e599cf7b706cfcebaUrsula Braun		rc = qeth_l2_send_setmac(card, addr->sa_data);
69370919e23ac35c9c244dfd73f97312894cae7d65fUrsula Braun	return rc;
6944a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka}
69522bedad3ce112d5ca1eaf043d4990fa2ed698c87Jiri Pirko
69622bedad3ce112d5ca1eaf043d4990fa2ed698c87Jiri Pirkostatic void qeth_l2_set_multicast_list(struct net_device *dev)
6977db2266a374d66f5ac85334c922cb37d76939cc5Frank Blaschka{
69832e7bfc41110bc8f29ec0f293c3bcee6645fef34Jiri Pirko	struct qeth_card *card = dev->ml_priv;
699ccffad25b5136958d4769ed6de5e87992dd9c65cJiri Pirko	struct netdev_hw_addr *ha;
7007db2266a374d66f5ac85334c922cb37d76939cc5Frank Blaschka
7014a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	if (card->info.type == QETH_CARD_TYPE_OSN)
7024a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		return ;
7034a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
7044a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	QETH_CARD_TEXT(card, 3, "setmulti");
7054a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	if (qeth_threads_running(card, QETH_RECOVER_THREAD) &&
7064a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	    (card->state != CARD_STATE_UP))
7074a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		return;
7084a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	qeth_l2_del_all_mc(card);
7094a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	spin_lock_bh(&card->mclock);
7104a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	netdev_for_each_mc_addr(ha, dev)
7114a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		qeth_l2_add_mc(card, ha->addr, 0);
712509e2562adfd63964aa30c1ddd9ddf4e57949351Heiko Carstens
7134a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	netdev_for_each_uc_addr(ha, dev)
7144a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		qeth_l2_add_mc(card, ha->addr, 1);
715ce73e10ee0cb6cde1c5075a2803da0f0eb5b2324Klaus-Dieter Wacker
7164a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	spin_unlock_bh(&card->mclock);
7174a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	if (!qeth_adp_supported(card, IPA_SETADP_SET_PROMISC_MODE))
7184a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		return;
719683d718a893575a88c551ad71ea2c382eedbf67eFrank Blaschka	qeth_setadp_promisc_mode(card);
720683d718a893575a88c551ad71ea2c382eedbf67eFrank Blaschka}
721683d718a893575a88c551ad71ea2c382eedbf67eFrank Blaschka
7224a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschkastatic int qeth_l2_hard_start_xmit(struct sk_buff *skb, struct net_device *dev)
7234a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka{
7244a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	int rc;
7254a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	struct qeth_hdr *hdr = NULL;
7264a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	int elements = 0;
7274a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	struct qeth_card *card = dev->ml_priv;
7284a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	struct sk_buff *new_skb = skb;
7294a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	int ipv = qeth_get_ip_version(skb);
7304a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	int cast_type = qeth_l2_get_cast_type(card, skb);
7314a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	struct qeth_qdio_out_q *queue = card->qdio.out_qs
7324a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		[qeth_get_priority_queue(card, skb, ipv, cast_type)];
7334a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	int tx_bytes = skb->len;
7344a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	int data_offset = -1;
7354a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	int elements_needed = 0;
7364a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	int hd_len = 0;
7374a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
7384a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	if ((card->state != CARD_STATE_UP) || !card->lan_online) {
7394a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		card->stats.tx_carrier_errors++;
7404a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		goto tx_drop;
74164ef8957986f6a04f61e7c95fa6ffeb3a86a6661Frank Blaschka	}
742683d718a893575a88c551ad71ea2c382eedbf67eFrank Blaschka
743683d718a893575a88c551ad71ea2c382eedbf67eFrank Blaschka	if ((card->info.type == QETH_CARD_TYPE_OSN) &&
744683d718a893575a88c551ad71ea2c382eedbf67eFrank Blaschka	    (skb->protocol == htons(ETH_P_IPV6)))
745683d718a893575a88c551ad71ea2c382eedbf67eFrank Blaschka		goto tx_drop;
746683d718a893575a88c551ad71ea2c382eedbf67eFrank Blaschka
747683d718a893575a88c551ad71ea2c382eedbf67eFrank Blaschka	if (card->options.performance_stats) {
748683d718a893575a88c551ad71ea2c382eedbf67eFrank Blaschka		card->perf_stats.outbound_cnt++;
749683d718a893575a88c551ad71ea2c382eedbf67eFrank Blaschka		card->perf_stats.outbound_start_time = qeth_get_micros();
750683d718a893575a88c551ad71ea2c382eedbf67eFrank Blaschka	}
751683d718a893575a88c551ad71ea2c382eedbf67eFrank Blaschka	netif_stop_queue(dev);
752683d718a893575a88c551ad71ea2c382eedbf67eFrank Blaschka
753683d718a893575a88c551ad71ea2c382eedbf67eFrank Blaschka	if (card->info.type == QETH_CARD_TYPE_OSN)
754683d718a893575a88c551ad71ea2c382eedbf67eFrank Blaschka		hdr = (struct qeth_hdr *)skb->data;
755683d718a893575a88c551ad71ea2c382eedbf67eFrank Blaschka	else {
756683d718a893575a88c551ad71ea2c382eedbf67eFrank Blaschka		if (card->info.type == QETH_CARD_TYPE_IQD) {
757683d718a893575a88c551ad71ea2c382eedbf67eFrank Blaschka			new_skb = skb;
758683d718a893575a88c551ad71ea2c382eedbf67eFrank Blaschka			data_offset = ETH_HLEN;
759683d718a893575a88c551ad71ea2c382eedbf67eFrank Blaschka			hd_len = ETH_HLEN;
760683d718a893575a88c551ad71ea2c382eedbf67eFrank Blaschka			hdr = kmem_cache_alloc(qeth_core_header_cache,
761683d718a893575a88c551ad71ea2c382eedbf67eFrank Blaschka						GFP_ATOMIC);
762f90b744eb8ead0af7a7aa2f78ff861dff4863f2cFrank Blaschka			if (!hdr)
763683d718a893575a88c551ad71ea2c382eedbf67eFrank Blaschka				goto tx_drop;
764683d718a893575a88c551ad71ea2c382eedbf67eFrank Blaschka			elements_needed++;
765683d718a893575a88c551ad71ea2c382eedbf67eFrank Blaschka			skb_reset_mac_header(new_skb);
7664a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka			qeth_l2_fill_header(card, hdr, new_skb, ipv, cast_type);
7674a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka			hdr->hdr.l2.pkt_length = new_skb->len;
76864ef8957986f6a04f61e7c95fa6ffeb3a86a6661Frank Blaschka			memcpy(((char *)hdr) + sizeof(struct qeth_hdr),
769683d718a893575a88c551ad71ea2c382eedbf67eFrank Blaschka				skb_mac_header(new_skb), ETH_HLEN);
77064ef8957986f6a04f61e7c95fa6ffeb3a86a6661Frank Blaschka		} else {
77164ef8957986f6a04f61e7c95fa6ffeb3a86a6661Frank Blaschka			/* create a clone with writeable headroom */
77264ef8957986f6a04f61e7c95fa6ffeb3a86a6661Frank Blaschka			new_skb = skb_realloc_headroom(skb,
77364ef8957986f6a04f61e7c95fa6ffeb3a86a6661Frank Blaschka						sizeof(struct qeth_hdr));
774f61a0d0538ca62547a127fd270d9f3c6e713027fFrank Blaschka			if (!new_skb)
7754a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka				goto tx_drop;
77651aa165c9f27bbfff498e4d56f3eadf17d74c476Frank Blaschka			hdr = (struct qeth_hdr *)skb_push(new_skb,
77751aa165c9f27bbfff498e4d56f3eadf17d74c476Frank Blaschka						sizeof(struct qeth_hdr));
77851aa165c9f27bbfff498e4d56f3eadf17d74c476Frank Blaschka			skb_set_mac_header(new_skb, sizeof(struct qeth_hdr));
77951aa165c9f27bbfff498e4d56f3eadf17d74c476Frank Blaschka			qeth_l2_fill_header(card, hdr, new_skb, ipv, cast_type);
7804a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		}
78164ef8957986f6a04f61e7c95fa6ffeb3a86a6661Frank Blaschka	}
78251aa165c9f27bbfff498e4d56f3eadf17d74c476Frank Blaschka
7834a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	elements = qeth_get_elements_no(card, (void *)hdr, new_skb,
78464ef8957986f6a04f61e7c95fa6ffeb3a86a6661Frank Blaschka						elements_needed);
7854a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	if (!elements) {
7864a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		if (data_offset >= 0)
7874a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka			kmem_cache_free(qeth_core_header_cache, hdr);
7884a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		goto tx_drop;
7894a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	}
790ec634fe328182a1a098585bfc7b69e5042bdb08dPatrick McHardy
7914a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	if (card->info.type != QETH_CARD_TYPE_IQD) {
792683d718a893575a88c551ad71ea2c382eedbf67eFrank Blaschka		if (qeth_hdr_chk_and_bounce(new_skb,
793683d718a893575a88c551ad71ea2c382eedbf67eFrank Blaschka		    sizeof(struct qeth_hdr_layer2)))
794683d718a893575a88c551ad71ea2c382eedbf67eFrank Blaschka			goto tx_drop;
7954a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		rc = qeth_do_send_packet(card, queue, new_skb, hdr,
7964a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka					 elements);
7974a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	} else
7984a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		rc = qeth_do_send_packet_fast(card, queue, new_skb, hdr,
7994a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka					elements, data_offset, hd_len);
8004a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	if (!rc) {
8014a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		card->stats.tx_packets++;
8024a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		card->stats.tx_bytes += tx_bytes;
8034a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		if (new_skb != skb)
8044a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka			dev_kfree_skb_any(skb);
8054a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		rc = NETDEV_TX_OK;
8064a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	} else {
8074a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		if (data_offset >= 0)
8084a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka			kmem_cache_free(qeth_core_header_cache, hdr);
8094a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
8104a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		if (rc == -EBUSY) {
8114a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka			if (new_skb != skb)
8124a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka				dev_kfree_skb_any(new_skb);
8134a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka			return NETDEV_TX_BUSY;
8144a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		} else
815d0ec0f549705b7ecfb787f02512606b08fe5b291Frank Blaschka			goto tx_drop;
8164a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	}
8174a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
8184a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	netif_wake_queue(dev);
819394234406c7a8a6b947d230b115c918c0a1def68Ursula Braun	if (card->options.performance_stats)
8204a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		card->perf_stats.outbound_time += qeth_get_micros() -
821509e2562adfd63964aa30c1ddd9ddf4e57949351Heiko Carstens			card->perf_stats.outbound_start_time;
822a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka	return rc;
8234a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
824847a50fd9f3d6a1ee8c8bf646aa8c9a61ea51550Carsten Ottetx_drop:
825394234406c7a8a6b947d230b115c918c0a1def68Ursula Braun	card->stats.tx_dropped++;
826394234406c7a8a6b947d230b115c918c0a1def68Ursula Braun	card->stats.tx_errors++;
8274a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	if ((new_skb != skb) && new_skb)
8284a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		dev_kfree_skb_any(new_skb);
8294a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	dev_kfree_skb_any(skb);
8304a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	netif_wake_queue(dev);
8314a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	return NETDEV_TX_OK;
832847a50fd9f3d6a1ee8c8bf646aa8c9a61ea51550Carsten Otte}
8334a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
8344a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschkastatic int qeth_l2_open(struct net_device *dev)
8354a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka{
8364a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	struct qeth_card *card = dev->ml_priv;
8374a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	int rc = 0;
8384a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
839a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka	QETH_CARD_TEXT(card, 4, "qethopen");
840a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka	if (card->state != CARD_STATE_SOFTSETUP)
841a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka		return -ENODEV;
842a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka
843a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka	if ((card->info.type != QETH_CARD_TYPE_OSN) &&
844a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka	     (!(card->info.mac_bits & QETH_LAYER2_MAC_REGISTERED))) {
8454a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		QETH_CARD_TEXT(card, 4, "nomacadr");
8464a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		return -EPERM;
847394234406c7a8a6b947d230b115c918c0a1def68Ursula Braun	}
848394234406c7a8a6b947d230b115c918c0a1def68Ursula Braun	card->data.state = CH_STATE_UP;
849394234406c7a8a6b947d230b115c918c0a1def68Ursula Braun	card->state = CARD_STATE_UP;
850394234406c7a8a6b947d230b115c918c0a1def68Ursula Braun	netif_start_queue(dev);
851394234406c7a8a6b947d230b115c918c0a1def68Ursula Braun
852394234406c7a8a6b947d230b115c918c0a1def68Ursula Braun	if (qdio_stop_irq(card->data.ccwdev, 0) >= 0) {
853394234406c7a8a6b947d230b115c918c0a1def68Ursula Braun		napi_enable(&card->napi);
854394234406c7a8a6b947d230b115c918c0a1def68Ursula Braun		napi_schedule(&card->napi);
855394234406c7a8a6b947d230b115c918c0a1def68Ursula Braun	} else
856394234406c7a8a6b947d230b115c918c0a1def68Ursula Braun		rc = -EIO;
857394234406c7a8a6b947d230b115c918c0a1def68Ursula Braun	return rc;
858394234406c7a8a6b947d230b115c918c0a1def68Ursula Braun}
8594a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
8604a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschkastatic int qeth_l2_stop(struct net_device *dev)
861509e2562adfd63964aa30c1ddd9ddf4e57949351Heiko Carstens{
8624a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	struct qeth_card *card = dev->ml_priv;
863847a50fd9f3d6a1ee8c8bf646aa8c9a61ea51550Carsten Otte
8644a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	QETH_CARD_TEXT(card, 4, "qethstop");
865a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka	netif_tx_disable(dev);
8664a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	if (card->state == CARD_STATE_UP) {
867a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka		card->state = CARD_STATE_SOFTSETUP;
868a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka		napi_disable(&card->napi);
8694a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	}
8704a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	return 0;
8714a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka}
8724a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
8734a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschkastatic int qeth_l2_probe_device(struct ccwgroup_device *gdev)
8744a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka{
8754a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	struct qeth_card *card = dev_get_drvdata(&gdev->dev);
8764a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
8774a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	INIT_LIST_HEAD(&card->vid_list);
8784a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	INIT_LIST_HEAD(&card->mc_list);
8791da74b1c10062eff5f67accb3bcb27fa329a55d6Frank Blaschka	card->options.layer2 = 1;
880a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka	card->discipline.start_poll = qeth_qdio_start_poll;
8814a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	card->discipline.input_handler = (qdio_handler_t *)
882a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka		qeth_qdio_input_handler;
8834a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	card->discipline.output_handler = (qdio_handler_t *)
8844a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		qeth_qdio_output_handler;
8854a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	card->discipline.recover = qeth_l2_recover;
8864a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	return 0;
8874a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka}
8884a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
8894a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschkastatic void qeth_l2_remove_device(struct ccwgroup_device *cgdev)
8904a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka{
8914a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	struct qeth_card *card = dev_get_drvdata(&cgdev->dev);
8924a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
893f214856540f6d704e817bf6b26a6bca9e697ee72Ursula Braun	qeth_set_allowed_threads(card, 0, 1);
8944a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	wait_event(card->wait_q, qeth_threads_running(card, 0xffffffff) == 0);
8954a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
89670919e23ac35c9c244dfd73f97312894cae7d65fUrsula Braun	if (cgdev->state == CCWGROUP_ONLINE) {
8974a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		card->use_hard_stop = 1;
8984a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		qeth_l2_set_offline(cgdev);
8994a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	}
9004a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
9014a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	if (card->dev) {
9024a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		unregister_netdev(card->dev);
9034a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		card->dev = NULL;
9044a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	}
9054a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	return;
9060fc0b732eaa38beb93a6fb62f77c7bd9622c76ecStephen Hemminger}
9074a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
9084a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschkastatic const struct ethtool_ops qeth_l2_ethtool_ops = {
9094a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	.get_link = ethtool_op_get_link,
910df8b4ec8b15a5db84706548149add3131c3af8baBen Hutchings	.get_strings = qeth_core_get_strings,
9114a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	.get_ethtool_stats = qeth_core_get_ethtool_stats,
9123f9975aa4d5b3c614eef8785ec63da13fbd55b51Frank Blaschka	.get_sset_count = qeth_core_get_sset_count,
9134a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	.get_drvinfo = qeth_core_get_drvinfo,
9144a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	.get_settings = qeth_core_ethtool_get_settings,
9150fc0b732eaa38beb93a6fb62f77c7bd9622c76ecStephen Hemminger};
9164a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
9174a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschkastatic const struct ethtool_ops qeth_l2_osn_ops = {
918df8b4ec8b15a5db84706548149add3131c3af8baBen Hutchings	.get_strings = qeth_core_get_strings,
9194a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	.get_ethtool_stats = qeth_core_get_ethtool_stats,
9204a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	.get_sset_count = qeth_core_get_sset_count,
9214a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	.get_drvinfo = qeth_core_get_drvinfo,
9223d58cefd823e47209ffcac9cada0a618771da1a4Frank Blaschka};
9238403b13c7627df7104e450cbc845627bf25c8cd6Frank Blaschka
9248403b13c7627df7104e450cbc845627bf25c8cd6Frank Blaschkastatic const struct net_device_ops qeth_l2_netdev_ops = {
9258403b13c7627df7104e450cbc845627bf25c8cd6Frank Blaschka	.ndo_open		= qeth_l2_open,
9268403b13c7627df7104e450cbc845627bf25c8cd6Frank Blaschka	.ndo_stop		= qeth_l2_stop,
9278403b13c7627df7104e450cbc845627bf25c8cd6Frank Blaschka	.ndo_get_stats		= qeth_get_stats,
9288403b13c7627df7104e450cbc845627bf25c8cd6Frank Blaschka	.ndo_start_xmit		= qeth_l2_hard_start_xmit,
9298403b13c7627df7104e450cbc845627bf25c8cd6Frank Blaschka	.ndo_validate_addr	= eth_validate_addr,
9308403b13c7627df7104e450cbc845627bf25c8cd6Frank Blaschka	.ndo_set_multicast_list = qeth_l2_set_multicast_list,
9318403b13c7627df7104e450cbc845627bf25c8cd6Frank Blaschka	.ndo_do_ioctl	   	= qeth_l2_do_ioctl,
9328403b13c7627df7104e450cbc845627bf25c8cd6Frank Blaschka	.ndo_set_mac_address    = qeth_l2_set_mac_address,
9338403b13c7627df7104e450cbc845627bf25c8cd6Frank Blaschka	.ndo_change_mtu	   	= qeth_change_mtu,
9348403b13c7627df7104e450cbc845627bf25c8cd6Frank Blaschka	.ndo_vlan_rx_add_vid	= qeth_l2_vlan_rx_add_vid,
9358403b13c7627df7104e450cbc845627bf25c8cd6Frank Blaschka	.ndo_vlan_rx_kill_vid   = qeth_l2_vlan_rx_kill_vid,
9368403b13c7627df7104e450cbc845627bf25c8cd6Frank Blaschka	.ndo_tx_timeout	   	= qeth_tx_timeout,
9374a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka};
9384a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
9394a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschkastatic int qeth_l2_setup_netdev(struct qeth_card *card)
9404a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka{
9414a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	switch (card->info.type) {
9424a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	case QETH_CARD_TYPE_IQD:
9434a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		card->dev = alloc_netdev(0, "hsi%d", ether_setup);
9444a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		break;
9454a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	case QETH_CARD_TYPE_OSN:
9464a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		card->dev = alloc_netdev(0, "osn%d", ether_setup);
9474a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		card->dev->flags |= IFF_NOARP;
9484a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		break;
9494a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	default:
9504a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		card->dev = alloc_etherdev(0);
9514a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	}
9524a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
9534a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	if (!card->dev)
954509e2562adfd63964aa30c1ddd9ddf4e57949351Heiko Carstens		return -ENODEV;
9554a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
9564a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	card->dev->ml_priv = card;
9578403b13c7627df7104e450cbc845627bf25c8cd6Frank Blaschka	card->dev->watchdog_timeo = QETH_TX_TIMEOUT;
9584a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	card->dev->mtu = card->info.initial_mtu;
9594a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	card->dev->netdev_ops = &qeth_l2_netdev_ops;
9604a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	if (card->info.type != QETH_CARD_TYPE_OSN)
9614a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		SET_ETHTOOL_OPS(card->dev, &qeth_l2_ethtool_ops);
9624a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	else
9634a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		SET_ETHTOOL_OPS(card->dev, &qeth_l2_osn_ops);
9644a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	card->dev->features |= NETIF_F_HW_VLAN_FILTER;
9654a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	card->info.broadcast_capable = 1;
966a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka	qeth_l2_request_initial_mac(card);
9674a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	SET_NETDEV_DEV(card->dev, &card->gdev->dev);
9684a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	netif_napi_add(card->dev, &card->napi, qeth_l2_poll, QETH_NAPI_WEIGHT);
9694a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	return register_netdev(card->dev);
9704a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka}
9714a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
9724a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschkastatic int __qeth_l2_set_online(struct ccwgroup_device *gdev, int recovery_mode)
9734a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka{
9744a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	struct qeth_card *card = dev_get_drvdata(&gdev->dev);
9754a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	int rc = 0;
9764a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	enum qeth_card_states recover_flag;
9779dc48ccc68b9dfc01c2beee2d4317fb3df3fdce9Ursula Braun
978c4949f074332a64baeb2ead6ab9319ca37642f96Frank Blaschka	BUG_ON(!card);
979d11ba0c40fa8a21511822efee3be8389f94f0431Peter Tiedemann	mutex_lock(&card->discipline_mutex);
980d11ba0c40fa8a21511822efee3be8389f94f0431Peter Tiedemann	mutex_lock(&card->conf_mutex);
9814a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	QETH_DBF_TEXT(SETUP, 2, "setonlin");
9824a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	QETH_DBF_HEX(SETUP, 2, &card, sizeof(void *));
9834a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
9844a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	recover_flag = card->state;
985d11ba0c40fa8a21511822efee3be8389f94f0431Peter Tiedemann	rc = qeth_core_hardsetup_card(card);
986aa90922479513db0d080239324d0d04701418ba5Ursula Braun	if (rc) {
9874a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		QETH_DBF_TEXT_(SETUP, 2, "2err%d", rc);
9884a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		rc = -ENODEV;
9894a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		goto out_remove;
990aa90922479513db0d080239324d0d04701418ba5Ursula Braun	}
991aa90922479513db0d080239324d0d04701418ba5Ursula Braun
9924a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	if (!card->dev && qeth_l2_setup_netdev(card)) {
993aa90922479513db0d080239324d0d04701418ba5Ursula Braun		rc = -ENODEV;
9944a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		goto out_remove;
9954a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	}
9964a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
9974a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	if (card->info.type != QETH_CARD_TYPE_OSN)
9981da74b1c10062eff5f67accb3bcb27fa329a55d6Frank Blaschka		qeth_l2_send_setmac(card, &card->dev->dev_addr[0]);
9991da74b1c10062eff5f67accb3bcb27fa329a55d6Frank Blaschka
10001da74b1c10062eff5f67accb3bcb27fa329a55d6Frank Blaschka	card->state = CARD_STATE_HARDSETUP;
10011da74b1c10062eff5f67accb3bcb27fa329a55d6Frank Blaschka	memset(&card->rx, 0, sizeof(struct qeth_rx));
10021da74b1c10062eff5f67accb3bcb27fa329a55d6Frank Blaschka	qeth_print_status_message(card);
10031da74b1c10062eff5f67accb3bcb27fa329a55d6Frank Blaschka
10041da74b1c10062eff5f67accb3bcb27fa329a55d6Frank Blaschka	/* softsetup */
10054a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	QETH_DBF_TEXT(SETUP, 2, "softsetp");
1006a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka
10074a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	rc = qeth_send_startlan(card);
10084a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	if (rc) {
10094a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		QETH_DBF_TEXT_(SETUP, 2, "1err%d", rc);
1010d11ba0c40fa8a21511822efee3be8389f94f0431Peter Tiedemann		if (rc == 0xe080) {
10114a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka			dev_warn(&card->gdev->dev,
10124a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka				"The LAN is offline\n");
10134a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka			card->lan_online = 0;
1014d11ba0c40fa8a21511822efee3be8389f94f0431Peter Tiedemann			goto contin;
10154a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		}
101674eacdb9c2bf9fc6e8c6785013b5dd0e551a9dfaFrank Blaschka		rc = -ENODEV;
101774eacdb9c2bf9fc6e8c6785013b5dd0e551a9dfaFrank Blaschka		goto out_remove;
10184a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	} else
10192b6203bb7d85e6a2ca2088b8684f30be70246ddfUrsula Braun		card->lan_online = 1;
10204a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
1021aa90922479513db0d080239324d0d04701418ba5Ursula Brauncontin:
1022f214856540f6d704e817bf6b26a6bca9e697ee72Ursula Braun	if ((card->info.type == QETH_CARD_TYPE_OSD) ||
10234a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	    (card->info.type == QETH_CARD_TYPE_OSX))
10244a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		/* configure isolation level */
10254a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		qeth_set_access_ctrl_online(card);
10262b6203bb7d85e6a2ca2088b8684f30be70246ddfUrsula Braun
10275113fec0984276836cb6f0677f7cb53586ec3451Ursula Braun	if (card->info.type != QETH_CARD_TYPE_OSN &&
10285113fec0984276836cb6f0677f7cb53586ec3451Ursula Braun	    card->info.type != QETH_CARD_TYPE_OSM)
1029d64ecc22d0a4b175d97cb2b1e297a9c5e3bdb26dEinar Lueck		qeth_l2_process_vlans(card, 0);
1030d64ecc22d0a4b175d97cb2b1e297a9c5e3bdb26dEinar Lueck
10315113fec0984276836cb6f0677f7cb53586ec3451Ursula Braun	netif_tx_disable(card->dev);
10325113fec0984276836cb6f0677f7cb53586ec3451Ursula Braun
10335113fec0984276836cb6f0677f7cb53586ec3451Ursula Braun	rc = qeth_init_qdio_queues(card);
103470919e23ac35c9c244dfd73f97312894cae7d65fUrsula Braun	if (rc) {
10354a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		QETH_DBF_TEXT_(SETUP, 2, "6err%d", rc);
10364a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		rc = -ENODEV;
10374a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		goto out_remove;
10384a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	}
10394a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	card->state = CARD_STATE_SOFTSETUP;
1040d11ba0c40fa8a21511822efee3be8389f94f0431Peter Tiedemann	if (card->lan_online)
1041aa90922479513db0d080239324d0d04701418ba5Ursula Braun		netif_carrier_on(card->dev);
10424a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	else
10434a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		netif_carrier_off(card->dev);
10444a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
10452b6203bb7d85e6a2ca2088b8684f30be70246ddfUrsula Braun	qeth_set_allowed_threads(card, 0xffffffff, 0);
10462b6203bb7d85e6a2ca2088b8684f30be70246ddfUrsula Braun	if (recover_flag == CARD_STATE_RECOVER) {
10472b6203bb7d85e6a2ca2088b8684f30be70246ddfUrsula Braun		if (recovery_mode &&
10482b6203bb7d85e6a2ca2088b8684f30be70246ddfUrsula Braun		    card->info.type != QETH_CARD_TYPE_OSN) {
10494a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka			qeth_l2_open(card->dev);
10504a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		} else {
10514a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka			rtnl_lock();
10524a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka			dev_open(card->dev);
10534a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka			rtnl_unlock();
1054394234406c7a8a6b947d230b115c918c0a1def68Ursula Braun		}
10554a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		/* this also sets saved unicast addresses */
10564a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		qeth_l2_set_multicast_list(card->dev);
10574a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	}
10584a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	/* let user_space know that device is online */
10594a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	kobject_uevent(&gdev->dev.kobj, KOBJ_CHANGE);
10604a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	mutex_unlock(&card->conf_mutex);
10614a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	mutex_unlock(&card->discipline_mutex);
10624a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	return 0;
10634a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
10644a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschkaout_remove:
1065c4949f074332a64baeb2ead6ab9319ca37642f96Frank Blaschka	card->use_hard_stop = 1;
10669dc48ccc68b9dfc01c2beee2d4317fb3df3fdce9Ursula Braun	qeth_l2_stop_card(card, 0);
10674a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	ccw_device_set_offline(CARD_DDEV(card));
1068aa90922479513db0d080239324d0d04701418ba5Ursula Braun	ccw_device_set_offline(CARD_WDEV(card));
10694a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	ccw_device_set_offline(CARD_RDEV(card));
10704a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	if (recover_flag == CARD_STATE_RECOVER)
10714a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		card->state = CARD_STATE_RECOVER;
10724a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	else
10734a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		card->state = CARD_STATE_DOWN;
10744a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	mutex_unlock(&card->conf_mutex);
10754a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	mutex_unlock(&card->discipline_mutex);
10764a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	return rc;
10774a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka}
1078c4949f074332a64baeb2ead6ab9319ca37642f96Frank Blaschka
10799dc48ccc68b9dfc01c2beee2d4317fb3df3fdce9Ursula Braunstatic int qeth_l2_set_online(struct ccwgroup_device *gdev)
1080aa90922479513db0d080239324d0d04701418ba5Ursula Braun{
10814a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	return __qeth_l2_set_online(gdev, 0);
10824a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka}
10834a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
10844a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschkastatic int __qeth_l2_set_offline(struct ccwgroup_device *cgdev,
10854a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka					int recovery_mode)
10864a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka{
10874a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	struct qeth_card *card = dev_get_drvdata(&cgdev->dev);
10884a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	int rc = 0, rc2 = 0, rc3 = 0;
10894a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	enum qeth_card_states recover_flag;
10904a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
10914a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	mutex_lock(&card->discipline_mutex);
10924a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	mutex_lock(&card->conf_mutex);
10934a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	QETH_DBF_TEXT(SETUP, 3, "setoffl");
10944a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	QETH_DBF_HEX(SETUP, 3, &card, sizeof(void *));
10959dc48ccc68b9dfc01c2beee2d4317fb3df3fdce9Ursula Braun
1096c4949f074332a64baeb2ead6ab9319ca37642f96Frank Blaschka	if (card->dev && netif_carrier_ok(card->dev))
1097d11ba0c40fa8a21511822efee3be8389f94f0431Peter Tiedemann		netif_carrier_off(card->dev);
1098d11ba0c40fa8a21511822efee3be8389f94f0431Peter Tiedemann	recover_flag = card->state;
10994a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	qeth_l2_stop_card(card, recovery_mode);
11004a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	rc  = ccw_device_set_offline(CARD_DDEV(card));
11014a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	rc2 = ccw_device_set_offline(CARD_WDEV(card));
11024a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	rc3 = ccw_device_set_offline(CARD_RDEV(card));
11031da74b1c10062eff5f67accb3bcb27fa329a55d6Frank Blaschka	if (!rc)
11041da74b1c10062eff5f67accb3bcb27fa329a55d6Frank Blaschka		rc = (rc2) ? rc2 : rc3;
11051da74b1c10062eff5f67accb3bcb27fa329a55d6Frank Blaschka	if (rc)
11061da74b1c10062eff5f67accb3bcb27fa329a55d6Frank Blaschka		QETH_DBF_TEXT_(SETUP, 2, "1err%d", rc);
11070f5623c9ebfc6576c5682ab3b335c57812f6c87eUrsula Braun	if (recover_flag == CARD_STATE_UP)
11084a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		card->state = CARD_STATE_RECOVER;
11094a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	/* let user_space know that device is offline */
11104a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	kobject_uevent(&cgdev->dev.kobj, KOBJ_CHANGE);
11114a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	mutex_unlock(&card->conf_mutex);
11124a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	mutex_unlock(&card->discipline_mutex);
11134a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	return 0;
1114d11ba0c40fa8a21511822efee3be8389f94f0431Peter Tiedemann}
11154a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
11164a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschkastatic int qeth_l2_set_offline(struct ccwgroup_device *cgdev)
11174a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka{
11184a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	return __qeth_l2_set_offline(cgdev, 0);
1119c4949f074332a64baeb2ead6ab9319ca37642f96Frank Blaschka}
11209dc48ccc68b9dfc01c2beee2d4317fb3df3fdce9Ursula Braun
11214a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschkastatic int qeth_l2_recover(void *ptr)
11224a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka{
11234a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	struct qeth_card *card;
11244a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	int rc = 0;
11254a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
11264a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	card = (struct qeth_card *) ptr;
11274a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	QETH_CARD_TEXT(card, 2, "recover1");
11284a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	if (!qeth_do_run_thread(card, QETH_RECOVER_THREAD))
11294a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		return 0;
11304a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	QETH_CARD_TEXT(card, 2, "recover2");
11314a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	dev_warn(&card->gdev->dev,
11324a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		"A recovery process has been started for the device\n");
11334a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	card->use_hard_stop = 1;
11344a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	__qeth_l2_set_offline(card->gdev, 1);
1135847a50fd9f3d6a1ee8c8bf646aa8c9a61ea51550Carsten Otte	rc = __qeth_l2_set_online(card->gdev, 1);
11364a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	if (!rc)
11374a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		dev_info(&card->gdev->dev,
1138847a50fd9f3d6a1ee8c8bf646aa8c9a61ea51550Carsten Otte			"Device successfully recovered!\n");
113974eacdb9c2bf9fc6e8c6785013b5dd0e551a9dfaFrank Blaschka	else {
114074eacdb9c2bf9fc6e8c6785013b5dd0e551a9dfaFrank Blaschka		rtnl_lock();
11414a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		dev_close(card->dev);
11424a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		rtnl_unlock();
11434a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		dev_warn(&card->gdev->dev, "The qeth device driver "
114474eacdb9c2bf9fc6e8c6785013b5dd0e551a9dfaFrank Blaschka			"failed to recover an error on the device\n");
114574eacdb9c2bf9fc6e8c6785013b5dd0e551a9dfaFrank Blaschka	}
114628a7e4c906bd86419eb8572b3b1343e619cd1470Ursula Braun	qeth_clear_thread_start_bit(card, QETH_RECOVER_THREAD);
1147869da90b9ae39f0d5b9b5aa3a84502684a6aa1f4Ursula Braun	qeth_clear_thread_running_bit(card, QETH_RECOVER_THREAD);
1148869da90b9ae39f0d5b9b5aa3a84502684a6aa1f4Ursula Braun	return 0;
1149869da90b9ae39f0d5b9b5aa3a84502684a6aa1f4Ursula Braun}
115074eacdb9c2bf9fc6e8c6785013b5dd0e551a9dfaFrank Blaschka
115174eacdb9c2bf9fc6e8c6785013b5dd0e551a9dfaFrank Blaschkastatic int __init qeth_l2_init(void)
115228a7e4c906bd86419eb8572b3b1343e619cd1470Ursula Braun{
1153a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka	pr_info("register layer 2 discipline\n");
1154a1c3ed4c9ca01dded8d511a1d1daf271fbae8d89Frank Blaschka	return 0;
11554a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka}
11564a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
11574a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschkastatic void __exit qeth_l2_exit(void)
11584a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka{
11594a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	pr_info("unregister layer 2 discipline\n");
116074eacdb9c2bf9fc6e8c6785013b5dd0e551a9dfaFrank Blaschka}
11614a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
11624a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschkastatic void qeth_l2_shutdown(struct ccwgroup_device *gdev)
11634a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka{
11644a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	struct qeth_card *card = dev_get_drvdata(&gdev->dev);
11654a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	qeth_qdio_clear_card(card, 0);
116674eacdb9c2bf9fc6e8c6785013b5dd0e551a9dfaFrank Blaschka	qeth_clear_qdio_buffers(card);
11674a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka}
11684a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
11694a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschkastatic int qeth_l2_pm_suspend(struct ccwgroup_device *gdev)
11704a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka{
11714a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	struct qeth_card *card = dev_get_drvdata(&gdev->dev);
11721da74b1c10062eff5f67accb3bcb27fa329a55d6Frank Blaschka
11731da74b1c10062eff5f67accb3bcb27fa329a55d6Frank Blaschka	if (card->dev)
11744a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		netif_device_detach(card->dev);
11754a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	qeth_set_allowed_threads(card, 0, 1);
11764a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	wait_event(card->wait_q, qeth_threads_running(card, 0xffffffff) == 0);
11774a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	if (gdev->state == CCWGROUP_OFFLINE)
1178bbcfcdc8324e75532c4d2592a545a91fcb45f229Frank Blaschka		return 0;
1179bbcfcdc8324e75532c4d2592a545a91fcb45f229Frank Blaschka	if (card->state == CARD_STATE_UP) {
1180bbcfcdc8324e75532c4d2592a545a91fcb45f229Frank Blaschka		card->use_hard_stop = 1;
1181bbcfcdc8324e75532c4d2592a545a91fcb45f229Frank Blaschka		__qeth_l2_set_offline(card->gdev, 1);
1182bbcfcdc8324e75532c4d2592a545a91fcb45f229Frank Blaschka	} else
1183bbcfcdc8324e75532c4d2592a545a91fcb45f229Frank Blaschka		__qeth_l2_set_offline(card->gdev, 0);
1184bbcfcdc8324e75532c4d2592a545a91fcb45f229Frank Blaschka	return 0;
1185bbcfcdc8324e75532c4d2592a545a91fcb45f229Frank Blaschka}
1186bbcfcdc8324e75532c4d2592a545a91fcb45f229Frank Blaschka
1187bbcfcdc8324e75532c4d2592a545a91fcb45f229Frank Blaschkastatic int qeth_l2_pm_resume(struct ccwgroup_device *gdev)
1188bbcfcdc8324e75532c4d2592a545a91fcb45f229Frank Blaschka{
11891da74b1c10062eff5f67accb3bcb27fa329a55d6Frank Blaschka	struct qeth_card *card = dev_get_drvdata(&gdev->dev);
11901da74b1c10062eff5f67accb3bcb27fa329a55d6Frank Blaschka	int rc = 0;
1191bbcfcdc8324e75532c4d2592a545a91fcb45f229Frank Blaschka
1192bbcfcdc8324e75532c4d2592a545a91fcb45f229Frank Blaschka	if (gdev->state == CCWGROUP_OFFLINE)
1193bbcfcdc8324e75532c4d2592a545a91fcb45f229Frank Blaschka		goto out;
1194bbcfcdc8324e75532c4d2592a545a91fcb45f229Frank Blaschka
1195bbcfcdc8324e75532c4d2592a545a91fcb45f229Frank Blaschka	if (card->state == CARD_STATE_RECOVER) {
1196bbcfcdc8324e75532c4d2592a545a91fcb45f229Frank Blaschka		rc = __qeth_l2_set_online(card->gdev, 1);
1197bbcfcdc8324e75532c4d2592a545a91fcb45f229Frank Blaschka		if (rc) {
1198bbcfcdc8324e75532c4d2592a545a91fcb45f229Frank Blaschka			rtnl_lock();
1199bbcfcdc8324e75532c4d2592a545a91fcb45f229Frank Blaschka			dev_close(card->dev);
1200bbcfcdc8324e75532c4d2592a545a91fcb45f229Frank Blaschka			rtnl_unlock();
1201bbcfcdc8324e75532c4d2592a545a91fcb45f229Frank Blaschka		}
1202bbcfcdc8324e75532c4d2592a545a91fcb45f229Frank Blaschka	} else
1203bbcfcdc8324e75532c4d2592a545a91fcb45f229Frank Blaschka		rc = __qeth_l2_set_online(card->gdev, 0);
1204bbcfcdc8324e75532c4d2592a545a91fcb45f229Frank Blaschkaout:
1205bbcfcdc8324e75532c4d2592a545a91fcb45f229Frank Blaschka	qeth_set_allowed_threads(card, 0xffffffff, 0);
1206bbcfcdc8324e75532c4d2592a545a91fcb45f229Frank Blaschka	if (card->dev)
1207bbcfcdc8324e75532c4d2592a545a91fcb45f229Frank Blaschka		netif_device_attach(card->dev);
1208869da90b9ae39f0d5b9b5aa3a84502684a6aa1f4Ursula Braun	if (rc)
1209869da90b9ae39f0d5b9b5aa3a84502684a6aa1f4Ursula Braun		dev_warn(&card->gdev->dev, "The qeth device driver "
1210869da90b9ae39f0d5b9b5aa3a84502684a6aa1f4Ursula Braun			"failed to recover an error on the device\n");
1211bbcfcdc8324e75532c4d2592a545a91fcb45f229Frank Blaschka	return rc;
1212bbcfcdc8324e75532c4d2592a545a91fcb45f229Frank Blaschka}
1213bbcfcdc8324e75532c4d2592a545a91fcb45f229Frank Blaschka
1214bbcfcdc8324e75532c4d2592a545a91fcb45f229Frank Blaschkastruct ccwgroup_driver qeth_l2_ccwgroup_driver = {
1215bbcfcdc8324e75532c4d2592a545a91fcb45f229Frank Blaschka	.probe = qeth_l2_probe_device,
1216bbcfcdc8324e75532c4d2592a545a91fcb45f229Frank Blaschka	.remove = qeth_l2_remove_device,
1217bbcfcdc8324e75532c4d2592a545a91fcb45f229Frank Blaschka	.set_online = qeth_l2_set_online,
1218bbcfcdc8324e75532c4d2592a545a91fcb45f229Frank Blaschka	.set_offline = qeth_l2_set_offline,
1219bbcfcdc8324e75532c4d2592a545a91fcb45f229Frank Blaschka	.shutdown = qeth_l2_shutdown,
1220bbcfcdc8324e75532c4d2592a545a91fcb45f229Frank Blaschka	.freeze = qeth_l2_pm_suspend,
1221bbcfcdc8324e75532c4d2592a545a91fcb45f229Frank Blaschka	.thaw = qeth_l2_pm_resume,
1222bbcfcdc8324e75532c4d2592a545a91fcb45f229Frank Blaschka	.restore = qeth_l2_pm_resume,
1223bbcfcdc8324e75532c4d2592a545a91fcb45f229Frank Blaschka};
12244a71df50047f0db65ea09b1be155852e81a45ebaFrank BlaschkaEXPORT_SYMBOL_GPL(qeth_l2_ccwgroup_driver);
12254a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
12264a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschkastatic int qeth_osn_send_control_data(struct qeth_card *card, int len,
12274a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka			   struct qeth_cmd_buffer *iob)
12284a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka{
12294a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	unsigned long flags;
1230bbcfcdc8324e75532c4d2592a545a91fcb45f229Frank Blaschka	int rc = 0;
1231bbcfcdc8324e75532c4d2592a545a91fcb45f229Frank Blaschka
1232bbcfcdc8324e75532c4d2592a545a91fcb45f229Frank Blaschka	QETH_CARD_TEXT(card, 5, "osndctrd");
12334a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
12344a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	wait_event(card->wait_q,
12354a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		   atomic_cmpxchg(&card->write.irq_pending, 0, 1) == 0);
12364a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	qeth_prepare_control_data(card, len, iob);
12374a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	QETH_CARD_TEXT(card, 6, "osnoirqp");
12384a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	spin_lock_irqsave(get_ccwdev_lock(card->write.ccwdev), flags);
12394a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	rc = ccw_device_start(card->write.ccwdev, &card->write.ccw,
12404a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka			      (addr_t) iob, 0, 0);
12414a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	spin_unlock_irqrestore(get_ccwdev_lock(card->write.ccwdev), flags);
1242847a50fd9f3d6a1ee8c8bf646aa8c9a61ea51550Carsten Otte	if (rc) {
12434a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		QETH_DBF_MESSAGE(2, "qeth_osn_send_control_data: "
12444a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka			   "ccw_device_start rc = %i\n", rc);
12454a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		QETH_CARD_TEXT_(card, 2, " err%d", rc);
12464a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		qeth_release_buffer(iob->channel, iob);
1247847a50fd9f3d6a1ee8c8bf646aa8c9a61ea51550Carsten Otte		atomic_set(&card->write.irq_pending, 0);
12484a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		wake_up(&card->wait_q);
12494a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	}
12504a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	return rc;
12514a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka}
12524a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
125314cc21b6770972e5d1487dbf3a2caaf63cae909aFrank Blaschkastatic int qeth_osn_send_ipa_cmd(struct qeth_card *card,
12544a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka			struct qeth_cmd_buffer *iob, int data_len)
1255847a50fd9f3d6a1ee8c8bf646aa8c9a61ea51550Carsten Otte{
12564a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	u16 s1, s2;
12574a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
12584a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	QETH_CARD_TEXT(card, 4, "osndipa");
12594a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
12604a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	qeth_prepare_ipa_cmd(card, iob, QETH_PROT_OSN2);
12614a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	s1 = (u16)(IPA_PDU_HEADER_SIZE + data_len);
12624a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	s2 = (u16)data_len;
12634a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	memcpy(QETH_IPA_PDU_LEN_TOTAL(iob->data), &s1, 2);
12644a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	memcpy(QETH_IPA_PDU_LEN_PDU1(iob->data), &s2, 2);
12654a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	memcpy(QETH_IPA_PDU_LEN_PDU2(iob->data), &s2, 2);
12664a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	memcpy(QETH_IPA_PDU_LEN_PDU3(iob->data), &s2, 2);
12674a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	return qeth_osn_send_control_data(card, s1, iob);
1268847a50fd9f3d6a1ee8c8bf646aa8c9a61ea51550Carsten Otte}
12694a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
12704a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschkaint qeth_osn_assist(struct net_device *dev, void *data, int data_len)
12714a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka{
12724a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	struct qeth_cmd_buffer *iob;
12734a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	struct qeth_card *card;
12744a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	int rc;
12754a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
12764a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	if (!dev)
12774a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		return -ENODEV;
12784a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	card = dev->ml_priv;
12794a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	if (!card)
12804a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		return -ENODEV;
12814a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	QETH_CARD_TEXT(card, 2, "osnsdmc");
12824a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	if ((card->state != CARD_STATE_UP) &&
12834a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	    (card->state != CARD_STATE_SOFTSETUP))
12844a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		return -ENODEV;
12854a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	iob = qeth_wait_for_buffer(&card->write);
12864a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	memcpy(iob->data+IPA_PDU_HEADER_SIZE, data, data_len);
12874a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	rc = qeth_osn_send_ipa_cmd(card, iob, data_len);
1288509e2562adfd63964aa30c1ddd9ddf4e57949351Heiko Carstens	return rc;
12894a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka}
12904a71df50047f0db65ea09b1be155852e81a45ebaFrank BlaschkaEXPORT_SYMBOL(qeth_osn_assist);
1291847a50fd9f3d6a1ee8c8bf646aa8c9a61ea51550Carsten Otte
12924a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschkaint qeth_osn_register(unsigned char *read_dev_no, struct net_device **dev,
12934a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		  int (*assist_cb)(struct net_device *, void *),
12944a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		  int (*data_cb)(struct sk_buff *))
12954a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka{
12964a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	struct qeth_card *card;
12974a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
12984a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	*dev = qeth_l2_netdev_by_devno(read_dev_no);
12994a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	if (*dev == NULL)
13004a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		return -ENODEV;
13014a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	card = (*dev)->ml_priv;
13024a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	if (!card)
13034a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		return -ENODEV;
13044a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	QETH_CARD_TEXT(card, 2, "osnreg");
13054a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	if ((assist_cb == NULL) || (data_cb == NULL))
13064a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		return -EINVAL;
13074a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	card->osn_info.assist_cb = assist_cb;
13084a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	card->osn_info.data_cb = data_cb;
13094a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	return 0;
13104a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka}
1311509e2562adfd63964aa30c1ddd9ddf4e57949351Heiko CarstensEXPORT_SYMBOL(qeth_osn_register);
13124a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
13134a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschkavoid qeth_osn_deregister(struct net_device *dev)
1314847a50fd9f3d6a1ee8c8bf646aa8c9a61ea51550Carsten Otte{
13154a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	struct qeth_card *card;
13164a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
13174a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	if (!dev)
13184a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		return;
13194a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	card = dev->ml_priv;
13204a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	if (!card)
13214a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka		return;
13224a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	QETH_CARD_TEXT(card, 2, "osndereg");
13234a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	card->osn_info.assist_cb = NULL;
13244a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	card->osn_info.data_cb = NULL;
13254a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka	return;
13264a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka}
13274a71df50047f0db65ea09b1be155852e81a45ebaFrank BlaschkaEXPORT_SYMBOL(qeth_osn_deregister);
13284a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka
1329509e2562adfd63964aa30c1ddd9ddf4e57949351Heiko Carstensmodule_init(qeth_l2_init);
13304a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschkamodule_exit(qeth_l2_exit);
13314a71df50047f0db65ea09b1be155852e81a45ebaFrank BlaschkaMODULE_AUTHOR("Frank Blaschka <frank.blaschka@de.ibm.com>");
1332847a50fd9f3d6a1ee8c8bf646aa8c9a61ea51550Carsten OtteMODULE_DESCRIPTION("qeth layer 2 discipline");
13334a71df50047f0db65ea09b1be155852e81a45ebaFrank BlaschkaMODULE_LICENSE("GPL");
13344a71df50047f0db65ea09b1be155852e81a45ebaFrank Blaschka