xref: /openbmc/linux/drivers/s390/net/qeth_l2_main.c (revision 8b030a57)
1 // SPDX-License-Identifier: GPL-2.0
2 /*
3  *    Copyright IBM Corp. 2007, 2009
4  *    Author(s): Utz Bacher <utz.bacher@de.ibm.com>,
5  *		 Frank Pavlic <fpavlic@de.ibm.com>,
6  *		 Thomas Spatzier <tspat@de.ibm.com>,
7  *		 Frank Blaschka <frank.blaschka@de.ibm.com>
8  */
9 
10 #define KMSG_COMPONENT "qeth"
11 #define pr_fmt(fmt) KMSG_COMPONENT ": " fmt
12 
13 #include <linux/module.h>
14 #include <linux/moduleparam.h>
15 #include <linux/string.h>
16 #include <linux/errno.h>
17 #include <linux/kernel.h>
18 #include <linux/slab.h>
19 #include <linux/etherdevice.h>
20 #include <linux/list.h>
21 #include <linux/hash.h>
22 #include <linux/hashtable.h>
23 #include <asm/setup.h>
24 #include "qeth_core.h"
25 #include "qeth_l2.h"
26 
27 static int qeth_l2_set_offline(struct ccwgroup_device *);
28 static int qeth_l2_stop(struct net_device *);
29 static void qeth_bridgeport_query_support(struct qeth_card *card);
30 static void qeth_bridge_state_change(struct qeth_card *card,
31 					struct qeth_ipa_cmd *cmd);
32 static void qeth_bridge_host_event(struct qeth_card *card,
33 					struct qeth_ipa_cmd *cmd);
34 static void qeth_l2_vnicc_set_defaults(struct qeth_card *card);
35 static void qeth_l2_vnicc_init(struct qeth_card *card);
36 static bool qeth_l2_vnicc_recover_timeout(struct qeth_card *card, u32 vnicc,
37 					  u32 *timeout);
38 
39 static int qeth_setdelmac_makerc(struct qeth_card *card, int retcode)
40 {
41 	int rc;
42 
43 	if (retcode)
44 		QETH_CARD_TEXT_(card, 2, "err%04x", retcode);
45 	switch (retcode) {
46 	case IPA_RC_SUCCESS:
47 		rc = 0;
48 		break;
49 	case IPA_RC_L2_UNSUPPORTED_CMD:
50 		rc = -EOPNOTSUPP;
51 		break;
52 	case IPA_RC_L2_ADDR_TABLE_FULL:
53 		rc = -ENOSPC;
54 		break;
55 	case IPA_RC_L2_DUP_MAC:
56 	case IPA_RC_L2_DUP_LAYER3_MAC:
57 		rc = -EEXIST;
58 		break;
59 	case IPA_RC_L2_MAC_NOT_AUTH_BY_HYP:
60 	case IPA_RC_L2_MAC_NOT_AUTH_BY_ADP:
61 		rc = -EPERM;
62 		break;
63 	case IPA_RC_L2_MAC_NOT_FOUND:
64 		rc = -ENOENT;
65 		break;
66 	case -ENOMEM:
67 		rc = -ENOMEM;
68 		break;
69 	default:
70 		rc = -EIO;
71 		break;
72 	}
73 	return rc;
74 }
75 
76 static int qeth_l2_send_setdelmac(struct qeth_card *card, __u8 *mac,
77 			   enum qeth_ipa_cmds ipacmd)
78 {
79 	struct qeth_ipa_cmd *cmd;
80 	struct qeth_cmd_buffer *iob;
81 
82 	QETH_CARD_TEXT(card, 2, "L2sdmac");
83 	iob = qeth_get_ipacmd_buffer(card, ipacmd, QETH_PROT_IPV4);
84 	if (!iob)
85 		return -ENOMEM;
86 	cmd = __ipa_cmd(iob);
87 	cmd->data.setdelmac.mac_length = ETH_ALEN;
88 	ether_addr_copy(cmd->data.setdelmac.mac, mac);
89 	return qeth_setdelmac_makerc(card, qeth_send_ipa_cmd(card, iob,
90 					   NULL, NULL));
91 }
92 
93 static int qeth_l2_send_setmac(struct qeth_card *card, __u8 *mac)
94 {
95 	int rc;
96 
97 	QETH_CARD_TEXT(card, 2, "L2Setmac");
98 	rc = qeth_l2_send_setdelmac(card, mac, IPA_CMD_SETVMAC);
99 	if (rc == 0) {
100 		dev_info(&card->gdev->dev,
101 			 "MAC address %pM successfully registered on device %s\n",
102 			 mac, card->dev->name);
103 	} else {
104 		switch (rc) {
105 		case -EEXIST:
106 			dev_warn(&card->gdev->dev,
107 				"MAC address %pM already exists\n", mac);
108 			break;
109 		case -EPERM:
110 			dev_warn(&card->gdev->dev,
111 				"MAC address %pM is not authorized\n", mac);
112 			break;
113 		}
114 	}
115 	return rc;
116 }
117 
118 static int qeth_l2_write_mac(struct qeth_card *card, u8 *mac)
119 {
120 	enum qeth_ipa_cmds cmd = is_multicast_ether_addr(mac) ?
121 					IPA_CMD_SETGMAC : IPA_CMD_SETVMAC;
122 	int rc;
123 
124 	QETH_CARD_TEXT(card, 2, "L2Wmac");
125 	rc = qeth_l2_send_setdelmac(card, mac, cmd);
126 	if (rc == -EEXIST)
127 		QETH_DBF_MESSAGE(2, "MAC already registered on device %x\n",
128 				 CARD_DEVID(card));
129 	else if (rc)
130 		QETH_DBF_MESSAGE(2, "Failed to register MAC on device %x: %d\n",
131 				 CARD_DEVID(card), rc);
132 	return rc;
133 }
134 
135 static int qeth_l2_remove_mac(struct qeth_card *card, u8 *mac)
136 {
137 	enum qeth_ipa_cmds cmd = is_multicast_ether_addr(mac) ?
138 					IPA_CMD_DELGMAC : IPA_CMD_DELVMAC;
139 	int rc;
140 
141 	QETH_CARD_TEXT(card, 2, "L2Rmac");
142 	rc = qeth_l2_send_setdelmac(card, mac, cmd);
143 	if (rc)
144 		QETH_DBF_MESSAGE(2, "Failed to delete MAC on device %u: %d\n",
145 				 CARD_DEVID(card), rc);
146 	return rc;
147 }
148 
149 static void qeth_l2_del_all_macs(struct qeth_card *card)
150 {
151 	struct qeth_mac *mac;
152 	struct hlist_node *tmp;
153 	int i;
154 
155 	spin_lock_bh(&card->mclock);
156 	hash_for_each_safe(card->mac_htable, i, tmp, mac, hnode) {
157 		hash_del(&mac->hnode);
158 		kfree(mac);
159 	}
160 	spin_unlock_bh(&card->mclock);
161 }
162 
163 static int qeth_l2_get_cast_type(struct qeth_card *card, struct sk_buff *skb)
164 {
165 	if (card->info.type == QETH_CARD_TYPE_OSN)
166 		return RTN_UNICAST;
167 	if (is_broadcast_ether_addr(skb->data))
168 		return RTN_BROADCAST;
169 	if (is_multicast_ether_addr(skb->data))
170 		return RTN_MULTICAST;
171 	return RTN_UNICAST;
172 }
173 
174 static void qeth_l2_fill_header(struct qeth_card *card, struct qeth_hdr *hdr,
175 				struct sk_buff *skb, int ipv, int cast_type,
176 				unsigned int data_len)
177 {
178 	struct vlan_ethhdr *veth = vlan_eth_hdr(skb);
179 
180 	hdr->hdr.l2.pkt_length = data_len;
181 
182 	if (skb_is_gso(skb)) {
183 		hdr->hdr.l2.id = QETH_HEADER_TYPE_L2_TSO;
184 	} else {
185 		hdr->hdr.l2.id = QETH_HEADER_TYPE_LAYER2;
186 		if (skb->ip_summed == CHECKSUM_PARTIAL) {
187 			qeth_tx_csum(skb, &hdr->hdr.l2.flags[1], ipv);
188 			if (card->options.performance_stats)
189 				card->perf_stats.tx_csum++;
190 		}
191 	}
192 
193 	/* set byte byte 3 to casting flags */
194 	if (cast_type == RTN_MULTICAST)
195 		hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_MULTICAST;
196 	else if (cast_type == RTN_BROADCAST)
197 		hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_BROADCAST;
198 	else
199 		hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_UNICAST;
200 
201 	/* VSWITCH relies on the VLAN
202 	 * information to be present in
203 	 * the QDIO header */
204 	if (veth->h_vlan_proto == __constant_htons(ETH_P_8021Q)) {
205 		hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_VLAN;
206 		hdr->hdr.l2.vlan_id = ntohs(veth->h_vlan_TCI);
207 	}
208 }
209 
210 static int qeth_setdelvlan_makerc(struct qeth_card *card, int retcode)
211 {
212 	if (retcode)
213 		QETH_CARD_TEXT_(card, 2, "err%04x", retcode);
214 
215 	switch (retcode) {
216 	case IPA_RC_SUCCESS:
217 		return 0;
218 	case IPA_RC_L2_INVALID_VLAN_ID:
219 		return -EINVAL;
220 	case IPA_RC_L2_DUP_VLAN_ID:
221 		return -EEXIST;
222 	case IPA_RC_L2_VLAN_ID_NOT_FOUND:
223 		return -ENOENT;
224 	case IPA_RC_L2_VLAN_ID_NOT_ALLOWED:
225 		return -EPERM;
226 	case -ENOMEM:
227 		return -ENOMEM;
228 	default:
229 		return -EIO;
230 	}
231 }
232 
233 static int qeth_l2_send_setdelvlan_cb(struct qeth_card *card,
234 				      struct qeth_reply *reply,
235 				      unsigned long data)
236 {
237 	struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *) data;
238 
239 	QETH_CARD_TEXT(card, 2, "L2sdvcb");
240 	if (cmd->hdr.return_code) {
241 		QETH_DBF_MESSAGE(2, "Error in processing VLAN %u on device %x: %#x.\n",
242 				 cmd->data.setdelvlan.vlan_id,
243 				 CARD_DEVID(card), cmd->hdr.return_code);
244 		QETH_CARD_TEXT_(card, 2, "L2VL%4x", cmd->hdr.command);
245 		QETH_CARD_TEXT_(card, 2, "err%d", cmd->hdr.return_code);
246 	}
247 	return 0;
248 }
249 
250 static int qeth_l2_send_setdelvlan(struct qeth_card *card, __u16 i,
251 				   enum qeth_ipa_cmds ipacmd)
252 {
253 	struct qeth_ipa_cmd *cmd;
254 	struct qeth_cmd_buffer *iob;
255 
256 	QETH_CARD_TEXT_(card, 4, "L2sdv%x", ipacmd);
257 	iob = qeth_get_ipacmd_buffer(card, ipacmd, QETH_PROT_IPV4);
258 	if (!iob)
259 		return -ENOMEM;
260 	cmd = __ipa_cmd(iob);
261 	cmd->data.setdelvlan.vlan_id = i;
262 	return qeth_setdelvlan_makerc(card, qeth_send_ipa_cmd(card, iob,
263 					    qeth_l2_send_setdelvlan_cb, NULL));
264 }
265 
266 static void qeth_l2_process_vlans(struct qeth_card *card)
267 {
268 	struct qeth_vlan_vid *id;
269 
270 	QETH_CARD_TEXT(card, 3, "L2prcvln");
271 	mutex_lock(&card->vid_list_mutex);
272 	list_for_each_entry(id, &card->vid_list, list) {
273 		qeth_l2_send_setdelvlan(card, id->vid, IPA_CMD_SETVLAN);
274 	}
275 	mutex_unlock(&card->vid_list_mutex);
276 }
277 
278 static int qeth_l2_vlan_rx_add_vid(struct net_device *dev,
279 				   __be16 proto, u16 vid)
280 {
281 	struct qeth_card *card = dev->ml_priv;
282 	struct qeth_vlan_vid *id;
283 	int rc;
284 
285 	QETH_CARD_TEXT_(card, 4, "aid:%d", vid);
286 	if (!vid)
287 		return 0;
288 	if (qeth_wait_for_threads(card, QETH_RECOVER_THREAD)) {
289 		QETH_CARD_TEXT(card, 3, "aidREC");
290 		return 0;
291 	}
292 	id = kmalloc(sizeof(*id), GFP_KERNEL);
293 	if (id) {
294 		id->vid = vid;
295 		rc = qeth_l2_send_setdelvlan(card, vid, IPA_CMD_SETVLAN);
296 		if (rc) {
297 			kfree(id);
298 			return rc;
299 		}
300 		mutex_lock(&card->vid_list_mutex);
301 		list_add_tail(&id->list, &card->vid_list);
302 		mutex_unlock(&card->vid_list_mutex);
303 	} else {
304 		return -ENOMEM;
305 	}
306 	return 0;
307 }
308 
309 static int qeth_l2_vlan_rx_kill_vid(struct net_device *dev,
310 				    __be16 proto, u16 vid)
311 {
312 	struct qeth_vlan_vid *id, *tmpid = NULL;
313 	struct qeth_card *card = dev->ml_priv;
314 	int rc = 0;
315 
316 	QETH_CARD_TEXT_(card, 4, "kid:%d", vid);
317 	if (qeth_wait_for_threads(card, QETH_RECOVER_THREAD)) {
318 		QETH_CARD_TEXT(card, 3, "kidREC");
319 		return 0;
320 	}
321 	mutex_lock(&card->vid_list_mutex);
322 	list_for_each_entry(id, &card->vid_list, list) {
323 		if (id->vid == vid) {
324 			list_del(&id->list);
325 			tmpid = id;
326 			break;
327 		}
328 	}
329 	mutex_unlock(&card->vid_list_mutex);
330 	if (tmpid) {
331 		rc = qeth_l2_send_setdelvlan(card, vid, IPA_CMD_DELVLAN);
332 		kfree(tmpid);
333 	}
334 	return rc;
335 }
336 
337 static void qeth_l2_stop_card(struct qeth_card *card, int recovery_mode)
338 {
339 	QETH_DBF_TEXT(SETUP , 2, "stopcard");
340 	QETH_DBF_HEX(SETUP, 2, &card, sizeof(void *));
341 
342 	qeth_set_allowed_threads(card, 0, 1);
343 	if (card->read.state == CH_STATE_UP &&
344 	    card->write.state == CH_STATE_UP &&
345 	    (card->state == CARD_STATE_UP)) {
346 		if (recovery_mode &&
347 		    card->info.type != QETH_CARD_TYPE_OSN) {
348 			qeth_l2_stop(card->dev);
349 		} else {
350 			rtnl_lock();
351 			dev_close(card->dev);
352 			rtnl_unlock();
353 		}
354 		card->info.mac_bits &= ~QETH_LAYER2_MAC_REGISTERED;
355 		card->state = CARD_STATE_SOFTSETUP;
356 	}
357 	if (card->state == CARD_STATE_SOFTSETUP) {
358 		qeth_l2_del_all_macs(card);
359 		qeth_clear_ipacmd_list(card);
360 		card->state = CARD_STATE_HARDSETUP;
361 	}
362 	if (card->state == CARD_STATE_HARDSETUP) {
363 		qeth_qdio_clear_card(card, 0);
364 		qeth_clear_qdio_buffers(card);
365 		qeth_clear_working_pool_list(card);
366 		card->state = CARD_STATE_DOWN;
367 	}
368 	if (card->state == CARD_STATE_DOWN) {
369 		qeth_clear_cmd_buffers(&card->read);
370 		qeth_clear_cmd_buffers(&card->write);
371 	}
372 
373 	flush_workqueue(card->event_wq);
374 }
375 
376 static int qeth_l2_process_inbound_buffer(struct qeth_card *card,
377 				int budget, int *done)
378 {
379 	int work_done = 0;
380 	struct sk_buff *skb;
381 	struct qeth_hdr *hdr;
382 	unsigned int len;
383 
384 	*done = 0;
385 	WARN_ON_ONCE(!budget);
386 	while (budget) {
387 		skb = qeth_core_get_next_skb(card,
388 			&card->qdio.in_q->bufs[card->rx.b_index],
389 			&card->rx.b_element, &card->rx.e_offset, &hdr);
390 		if (!skb) {
391 			*done = 1;
392 			break;
393 		}
394 		switch (hdr->hdr.l2.id) {
395 		case QETH_HEADER_TYPE_LAYER2:
396 			skb->protocol = eth_type_trans(skb, skb->dev);
397 			qeth_rx_csum(card, skb, hdr->hdr.l2.flags[1]);
398 			if (skb->protocol == htons(ETH_P_802_2))
399 				*((__u32 *)skb->cb) = ++card->seqno.pkt_seqno;
400 			len = skb->len;
401 			napi_gro_receive(&card->napi, skb);
402 			break;
403 		case QETH_HEADER_TYPE_OSN:
404 			if (card->info.type == QETH_CARD_TYPE_OSN) {
405 				skb_push(skb, sizeof(struct qeth_hdr));
406 				skb_copy_to_linear_data(skb, hdr,
407 						sizeof(struct qeth_hdr));
408 				len = skb->len;
409 				card->osn_info.data_cb(skb);
410 				break;
411 			}
412 			/* else unknown */
413 		default:
414 			dev_kfree_skb_any(skb);
415 			QETH_CARD_TEXT(card, 3, "inbunkno");
416 			QETH_DBF_HEX(CTRL, 3, hdr, sizeof(*hdr));
417 			continue;
418 		}
419 		work_done++;
420 		budget--;
421 		card->stats.rx_packets++;
422 		card->stats.rx_bytes += len;
423 	}
424 	return work_done;
425 }
426 
427 static int qeth_l2_request_initial_mac(struct qeth_card *card)
428 {
429 	int rc = 0;
430 
431 	QETH_DBF_TEXT(SETUP, 2, "l2reqmac");
432 	QETH_DBF_TEXT_(SETUP, 2, "doL2%s", CARD_BUS_ID(card));
433 
434 	if (MACHINE_IS_VM) {
435 		rc = qeth_vm_request_mac(card);
436 		if (!rc)
437 			goto out;
438 		QETH_DBF_MESSAGE(2, "z/VM MAC Service failed on device %x: %#x\n",
439 				 CARD_DEVID(card), rc);
440 		QETH_DBF_TEXT_(SETUP, 2, "err%04x", rc);
441 		/* fall back to alternative mechanism: */
442 	}
443 
444 	if (!IS_OSN(card)) {
445 		rc = qeth_setadpparms_change_macaddr(card);
446 		if (!rc && is_valid_ether_addr(card->dev->dev_addr))
447 			goto out;
448 		QETH_DBF_MESSAGE(2, "READ_MAC Assist failed on device %x: %#x\n",
449 				 CARD_DEVID(card), rc);
450 		QETH_DBF_TEXT_(SETUP, 2, "1err%04x", rc);
451 		/* fall back once more: */
452 	}
453 
454 	/* some devices don't support a custom MAC address: */
455 	if (card->info.type == QETH_CARD_TYPE_OSM ||
456 	    card->info.type == QETH_CARD_TYPE_OSX)
457 		return (rc) ? rc : -EADDRNOTAVAIL;
458 	eth_hw_addr_random(card->dev);
459 
460 out:
461 	QETH_DBF_HEX(SETUP, 2, card->dev->dev_addr, card->dev->addr_len);
462 	return 0;
463 }
464 
465 static int qeth_l2_set_mac_address(struct net_device *dev, void *p)
466 {
467 	struct sockaddr *addr = p;
468 	struct qeth_card *card = dev->ml_priv;
469 	u8 old_addr[ETH_ALEN];
470 	int rc = 0;
471 
472 	QETH_CARD_TEXT(card, 3, "setmac");
473 
474 	if (card->info.type == QETH_CARD_TYPE_OSN ||
475 	    card->info.type == QETH_CARD_TYPE_OSM ||
476 	    card->info.type == QETH_CARD_TYPE_OSX) {
477 		QETH_CARD_TEXT(card, 3, "setmcTYP");
478 		return -EOPNOTSUPP;
479 	}
480 	QETH_CARD_HEX(card, 3, addr->sa_data, ETH_ALEN);
481 	if (!is_valid_ether_addr(addr->sa_data))
482 		return -EADDRNOTAVAIL;
483 
484 	if (qeth_wait_for_threads(card, QETH_RECOVER_THREAD)) {
485 		QETH_CARD_TEXT(card, 3, "setmcREC");
486 		return -ERESTARTSYS;
487 	}
488 
489 	/* avoid racing against concurrent state change: */
490 	if (!mutex_trylock(&card->conf_mutex))
491 		return -EAGAIN;
492 
493 	if (!qeth_card_hw_is_reachable(card)) {
494 		ether_addr_copy(dev->dev_addr, addr->sa_data);
495 		goto out_unlock;
496 	}
497 
498 	/* don't register the same address twice */
499 	if (ether_addr_equal_64bits(dev->dev_addr, addr->sa_data) &&
500 	    (card->info.mac_bits & QETH_LAYER2_MAC_REGISTERED))
501 		goto out_unlock;
502 
503 	/* add the new address, switch over, drop the old */
504 	rc = qeth_l2_send_setmac(card, addr->sa_data);
505 	if (rc)
506 		goto out_unlock;
507 	ether_addr_copy(old_addr, dev->dev_addr);
508 	ether_addr_copy(dev->dev_addr, addr->sa_data);
509 
510 	if (card->info.mac_bits & QETH_LAYER2_MAC_REGISTERED)
511 		qeth_l2_remove_mac(card, old_addr);
512 	card->info.mac_bits |= QETH_LAYER2_MAC_REGISTERED;
513 
514 out_unlock:
515 	mutex_unlock(&card->conf_mutex);
516 	return rc;
517 }
518 
519 static void qeth_promisc_to_bridge(struct qeth_card *card)
520 {
521 	struct net_device *dev = card->dev;
522 	enum qeth_ipa_promisc_modes promisc_mode;
523 	int role;
524 	int rc;
525 
526 	QETH_CARD_TEXT(card, 3, "pmisc2br");
527 
528 	if (!card->options.sbp.reflect_promisc)
529 		return;
530 	promisc_mode = (dev->flags & IFF_PROMISC) ? SET_PROMISC_MODE_ON
531 						: SET_PROMISC_MODE_OFF;
532 	if (promisc_mode == card->info.promisc_mode)
533 		return;
534 
535 	if (promisc_mode == SET_PROMISC_MODE_ON) {
536 		if (card->options.sbp.reflect_promisc_primary)
537 			role = QETH_SBP_ROLE_PRIMARY;
538 		else
539 			role = QETH_SBP_ROLE_SECONDARY;
540 	} else
541 		role = QETH_SBP_ROLE_NONE;
542 
543 	rc = qeth_bridgeport_setrole(card, role);
544 	QETH_DBF_TEXT_(SETUP, 2, "bpm%c%04x",
545 			(promisc_mode == SET_PROMISC_MODE_ON) ? '+' : '-', rc);
546 	if (!rc) {
547 		card->options.sbp.role = role;
548 		card->info.promisc_mode = promisc_mode;
549 	}
550 
551 }
552 /* New MAC address is added to the hash table and marked to be written on card
553  * only if there is not in the hash table storage already
554  *
555 */
556 static void qeth_l2_add_mac(struct qeth_card *card, struct netdev_hw_addr *ha)
557 {
558 	u32 mac_hash = get_unaligned((u32 *)(&ha->addr[2]));
559 	struct qeth_mac *mac;
560 
561 	hash_for_each_possible(card->mac_htable, mac, hnode, mac_hash) {
562 		if (ether_addr_equal_64bits(ha->addr, mac->mac_addr)) {
563 			mac->disp_flag = QETH_DISP_ADDR_DO_NOTHING;
564 			return;
565 		}
566 	}
567 
568 	mac = kzalloc(sizeof(struct qeth_mac), GFP_ATOMIC);
569 	if (!mac)
570 		return;
571 
572 	ether_addr_copy(mac->mac_addr, ha->addr);
573 	mac->disp_flag = QETH_DISP_ADDR_ADD;
574 
575 	hash_add(card->mac_htable, &mac->hnode, mac_hash);
576 }
577 
578 static void qeth_l2_set_rx_mode(struct net_device *dev)
579 {
580 	struct qeth_card *card = dev->ml_priv;
581 	struct netdev_hw_addr *ha;
582 	struct qeth_mac *mac;
583 	struct hlist_node *tmp;
584 	int i;
585 	int rc;
586 
587 	if (card->info.type == QETH_CARD_TYPE_OSN)
588 		return;
589 
590 	QETH_CARD_TEXT(card, 3, "setmulti");
591 	if (qeth_threads_running(card, QETH_RECOVER_THREAD) &&
592 	    (card->state != CARD_STATE_UP))
593 		return;
594 
595 	spin_lock_bh(&card->mclock);
596 
597 	netdev_for_each_mc_addr(ha, dev)
598 		qeth_l2_add_mac(card, ha);
599 	netdev_for_each_uc_addr(ha, dev)
600 		qeth_l2_add_mac(card, ha);
601 
602 	hash_for_each_safe(card->mac_htable, i, tmp, mac, hnode) {
603 		switch (mac->disp_flag) {
604 		case QETH_DISP_ADDR_DELETE:
605 			qeth_l2_remove_mac(card, mac->mac_addr);
606 			hash_del(&mac->hnode);
607 			kfree(mac);
608 			break;
609 		case QETH_DISP_ADDR_ADD:
610 			rc = qeth_l2_write_mac(card, mac->mac_addr);
611 			if (rc) {
612 				hash_del(&mac->hnode);
613 				kfree(mac);
614 				break;
615 			}
616 			/* fall through */
617 		default:
618 			/* for next call to set_rx_mode(): */
619 			mac->disp_flag = QETH_DISP_ADDR_DELETE;
620 		}
621 	}
622 
623 	spin_unlock_bh(&card->mclock);
624 
625 	if (qeth_adp_supported(card, IPA_SETADP_SET_PROMISC_MODE))
626 		qeth_setadp_promisc_mode(card);
627 	else
628 		qeth_promisc_to_bridge(card);
629 }
630 
631 static int qeth_l2_xmit_osn(struct qeth_card *card, struct sk_buff *skb,
632 			    struct qeth_qdio_out_q *queue)
633 {
634 	struct qeth_hdr *hdr = (struct qeth_hdr *)skb->data;
635 	addr_t end = (addr_t)(skb->data + sizeof(*hdr));
636 	addr_t start = (addr_t)skb->data;
637 	unsigned int elements = 0;
638 	unsigned int hd_len = 0;
639 	int rc;
640 
641 	if (skb->protocol == htons(ETH_P_IPV6))
642 		return -EPROTONOSUPPORT;
643 
644 	if (qeth_get_elements_for_range(start, end) > 1) {
645 		/* Misaligned HW header, move it to its own buffer element. */
646 		hdr = kmem_cache_alloc(qeth_core_header_cache, GFP_ATOMIC);
647 		if (!hdr)
648 			return -ENOMEM;
649 		hd_len = sizeof(*hdr);
650 		skb_copy_from_linear_data(skb, (char *)hdr, hd_len);
651 		elements++;
652 	}
653 
654 	elements += qeth_count_elements(skb, hd_len);
655 	if (elements > QETH_MAX_BUFFER_ELEMENTS(card)) {
656 		rc = -E2BIG;
657 		goto out;
658 	}
659 
660 	rc = qeth_do_send_packet(card, queue, skb, hdr, hd_len, hd_len,
661 				 elements);
662 out:
663 	if (rc && hd_len)
664 		kmem_cache_free(qeth_core_header_cache, hdr);
665 	return rc;
666 }
667 
668 static netdev_tx_t qeth_l2_hard_start_xmit(struct sk_buff *skb,
669 					   struct net_device *dev)
670 {
671 	struct qeth_card *card = dev->ml_priv;
672 	int cast_type = qeth_l2_get_cast_type(card, skb);
673 	int ipv = qeth_get_ip_version(skb);
674 	struct qeth_qdio_out_q *queue;
675 	int tx_bytes = skb->len;
676 	int rc;
677 
678 	if (card->state != CARD_STATE_UP) {
679 		card->stats.tx_carrier_errors++;
680 		goto tx_drop;
681 	}
682 
683 	queue = qeth_get_tx_queue(card, skb, ipv, cast_type);
684 
685 	if (card->options.performance_stats) {
686 		card->perf_stats.outbound_cnt++;
687 		card->perf_stats.outbound_start_time = qeth_get_micros();
688 	}
689 	netif_stop_queue(dev);
690 
691 	if (IS_OSN(card))
692 		rc = qeth_l2_xmit_osn(card, skb, queue);
693 	else
694 		rc = qeth_xmit(card, skb, queue, ipv, cast_type,
695 			       qeth_l2_fill_header);
696 
697 	if (!rc) {
698 		card->stats.tx_packets++;
699 		card->stats.tx_bytes += tx_bytes;
700 		if (card->options.performance_stats)
701 			card->perf_stats.outbound_time += qeth_get_micros() -
702 				card->perf_stats.outbound_start_time;
703 		netif_wake_queue(dev);
704 		return NETDEV_TX_OK;
705 	} else if (rc == -EBUSY) {
706 		return NETDEV_TX_BUSY;
707 	} /* else fall through */
708 
709 tx_drop:
710 	card->stats.tx_dropped++;
711 	card->stats.tx_errors++;
712 	dev_kfree_skb_any(skb);
713 	netif_wake_queue(dev);
714 	return NETDEV_TX_OK;
715 }
716 
717 static int __qeth_l2_open(struct net_device *dev)
718 {
719 	struct qeth_card *card = dev->ml_priv;
720 	int rc = 0;
721 
722 	QETH_CARD_TEXT(card, 4, "qethopen");
723 	if (card->state == CARD_STATE_UP)
724 		return rc;
725 	if (card->state != CARD_STATE_SOFTSETUP)
726 		return -ENODEV;
727 
728 	if ((card->info.type != QETH_CARD_TYPE_OSN) &&
729 	     (!(card->info.mac_bits & QETH_LAYER2_MAC_REGISTERED))) {
730 		QETH_CARD_TEXT(card, 4, "nomacadr");
731 		return -EPERM;
732 	}
733 	card->data.state = CH_STATE_UP;
734 	card->state = CARD_STATE_UP;
735 	netif_start_queue(dev);
736 
737 	if (qdio_stop_irq(card->data.ccwdev, 0) >= 0) {
738 		napi_enable(&card->napi);
739 		local_bh_disable();
740 		napi_schedule(&card->napi);
741 		/* kick-start the NAPI softirq: */
742 		local_bh_enable();
743 	} else
744 		rc = -EIO;
745 	return rc;
746 }
747 
748 static int qeth_l2_open(struct net_device *dev)
749 {
750 	struct qeth_card *card = dev->ml_priv;
751 
752 	QETH_CARD_TEXT(card, 5, "qethope_");
753 	if (qeth_wait_for_threads(card, QETH_RECOVER_THREAD)) {
754 		QETH_CARD_TEXT(card, 3, "openREC");
755 		return -ERESTARTSYS;
756 	}
757 	return __qeth_l2_open(dev);
758 }
759 
760 static int qeth_l2_stop(struct net_device *dev)
761 {
762 	struct qeth_card *card = dev->ml_priv;
763 
764 	QETH_CARD_TEXT(card, 4, "qethstop");
765 	netif_tx_disable(dev);
766 	if (card->state == CARD_STATE_UP) {
767 		card->state = CARD_STATE_SOFTSETUP;
768 		napi_disable(&card->napi);
769 	}
770 	return 0;
771 }
772 
773 static const struct device_type qeth_l2_devtype = {
774 	.name = "qeth_layer2",
775 	.groups = qeth_l2_attr_groups,
776 };
777 
778 static int qeth_l2_probe_device(struct ccwgroup_device *gdev)
779 {
780 	struct qeth_card *card = dev_get_drvdata(&gdev->dev);
781 	int rc;
782 
783 	if (gdev->dev.type == &qeth_generic_devtype) {
784 		rc = qeth_l2_create_device_attributes(&gdev->dev);
785 		if (rc)
786 			return rc;
787 	}
788 	INIT_LIST_HEAD(&card->vid_list);
789 	hash_init(card->mac_htable);
790 	card->info.hwtrap = 0;
791 	qeth_l2_vnicc_set_defaults(card);
792 	return 0;
793 }
794 
795 static void qeth_l2_remove_device(struct ccwgroup_device *cgdev)
796 {
797 	struct qeth_card *card = dev_get_drvdata(&cgdev->dev);
798 
799 	if (cgdev->dev.type == &qeth_generic_devtype)
800 		qeth_l2_remove_device_attributes(&cgdev->dev);
801 	qeth_set_allowed_threads(card, 0, 1);
802 	wait_event(card->wait_q, qeth_threads_running(card, 0xffffffff) == 0);
803 
804 	if (cgdev->state == CCWGROUP_ONLINE)
805 		qeth_l2_set_offline(cgdev);
806 
807 	cancel_work_sync(&card->close_dev_work);
808 	if (qeth_netdev_is_registered(card->dev))
809 		unregister_netdev(card->dev);
810 }
811 
812 static const struct ethtool_ops qeth_l2_ethtool_ops = {
813 	.get_link = ethtool_op_get_link,
814 	.get_strings = qeth_core_get_strings,
815 	.get_ethtool_stats = qeth_core_get_ethtool_stats,
816 	.get_sset_count = qeth_core_get_sset_count,
817 	.get_drvinfo = qeth_core_get_drvinfo,
818 	.get_link_ksettings = qeth_core_ethtool_get_link_ksettings,
819 };
820 
821 static const struct ethtool_ops qeth_l2_osn_ops = {
822 	.get_strings = qeth_core_get_strings,
823 	.get_ethtool_stats = qeth_core_get_ethtool_stats,
824 	.get_sset_count = qeth_core_get_sset_count,
825 	.get_drvinfo = qeth_core_get_drvinfo,
826 };
827 
828 static const struct net_device_ops qeth_l2_netdev_ops = {
829 	.ndo_open		= qeth_l2_open,
830 	.ndo_stop		= qeth_l2_stop,
831 	.ndo_get_stats		= qeth_get_stats,
832 	.ndo_start_xmit		= qeth_l2_hard_start_xmit,
833 	.ndo_features_check	= qeth_features_check,
834 	.ndo_validate_addr	= eth_validate_addr,
835 	.ndo_set_rx_mode	= qeth_l2_set_rx_mode,
836 	.ndo_do_ioctl		= qeth_do_ioctl,
837 	.ndo_set_mac_address    = qeth_l2_set_mac_address,
838 	.ndo_vlan_rx_add_vid	= qeth_l2_vlan_rx_add_vid,
839 	.ndo_vlan_rx_kill_vid   = qeth_l2_vlan_rx_kill_vid,
840 	.ndo_tx_timeout	   	= qeth_tx_timeout,
841 	.ndo_fix_features	= qeth_fix_features,
842 	.ndo_set_features	= qeth_set_features
843 };
844 
845 static int qeth_l2_setup_netdev(struct qeth_card *card, bool carrier_ok)
846 {
847 	int rc;
848 
849 	if (qeth_netdev_is_registered(card->dev))
850 		return 0;
851 
852 	card->dev->priv_flags |= IFF_UNICAST_FLT;
853 	card->dev->netdev_ops = &qeth_l2_netdev_ops;
854 	if (card->info.type == QETH_CARD_TYPE_OSN) {
855 		card->dev->ethtool_ops = &qeth_l2_osn_ops;
856 		card->dev->flags |= IFF_NOARP;
857 	} else {
858 		card->dev->ethtool_ops = &qeth_l2_ethtool_ops;
859 		card->dev->needed_headroom = sizeof(struct qeth_hdr);
860 	}
861 
862 	if (card->info.type == QETH_CARD_TYPE_OSM)
863 		card->dev->features |= NETIF_F_VLAN_CHALLENGED;
864 	else
865 		card->dev->features |= NETIF_F_HW_VLAN_CTAG_FILTER;
866 
867 	if (card->info.type == QETH_CARD_TYPE_OSD && !card->info.guestlan) {
868 		card->dev->features |= NETIF_F_SG;
869 		/* OSA 3S and earlier has no RX/TX support */
870 		if (qeth_is_supported(card, IPA_OUTBOUND_CHECKSUM)) {
871 			card->dev->hw_features |= NETIF_F_IP_CSUM;
872 			card->dev->vlan_features |= NETIF_F_IP_CSUM;
873 		}
874 	}
875 	if (qeth_is_supported6(card, IPA_OUTBOUND_CHECKSUM_V6)) {
876 		card->dev->hw_features |= NETIF_F_IPV6_CSUM;
877 		card->dev->vlan_features |= NETIF_F_IPV6_CSUM;
878 	}
879 	if (qeth_is_supported(card, IPA_INBOUND_CHECKSUM) ||
880 	    qeth_is_supported6(card, IPA_INBOUND_CHECKSUM_V6)) {
881 		card->dev->hw_features |= NETIF_F_RXCSUM;
882 		card->dev->vlan_features |= NETIF_F_RXCSUM;
883 	}
884 	if (qeth_is_supported(card, IPA_OUTBOUND_TSO)) {
885 		card->dev->hw_features |= NETIF_F_TSO;
886 		card->dev->vlan_features |= NETIF_F_TSO;
887 	}
888 	if (qeth_is_supported6(card, IPA_OUTBOUND_TSO)) {
889 		card->dev->hw_features |= NETIF_F_TSO6;
890 		card->dev->vlan_features |= NETIF_F_TSO6;
891 	}
892 
893 	if (card->dev->hw_features & (NETIF_F_TSO | NETIF_F_TSO6)) {
894 		card->dev->needed_headroom = sizeof(struct qeth_hdr_tso);
895 		netif_set_gso_max_size(card->dev,
896 				       PAGE_SIZE * (QDIO_MAX_ELEMENTS_PER_BUFFER - 1));
897 	}
898 
899 	if (!is_valid_ether_addr(card->dev->dev_addr))
900 		qeth_l2_request_initial_mac(card);
901 	netif_napi_add(card->dev, &card->napi, qeth_poll, QETH_NAPI_WEIGHT);
902 	rc = register_netdev(card->dev);
903 	if (!rc && carrier_ok)
904 		netif_carrier_on(card->dev);
905 
906 	if (rc)
907 		card->dev->netdev_ops = NULL;
908 	return rc;
909 }
910 
911 static int qeth_l2_start_ipassists(struct qeth_card *card)
912 {
913 	/* configure isolation level */
914 	if (qeth_set_access_ctrl_online(card, 0))
915 		return -ENODEV;
916 	return 0;
917 }
918 
919 static void qeth_l2_trace_features(struct qeth_card *card)
920 {
921 	/* Set BridgePort features */
922 	QETH_CARD_TEXT(card, 2, "featuSBP");
923 	QETH_CARD_HEX(card, 2, &card->options.sbp.supported_funcs,
924 		      sizeof(card->options.sbp.supported_funcs));
925 	/* VNIC Characteristics features */
926 	QETH_CARD_TEXT(card, 2, "feaVNICC");
927 	QETH_CARD_HEX(card, 2, &card->options.vnicc.sup_chars,
928 		      sizeof(card->options.vnicc.sup_chars));
929 }
930 
931 static int __qeth_l2_set_online(struct ccwgroup_device *gdev, int recovery_mode)
932 {
933 	struct qeth_card *card = dev_get_drvdata(&gdev->dev);
934 	int rc = 0;
935 	enum qeth_card_states recover_flag;
936 	bool carrier_ok;
937 
938 	mutex_lock(&card->discipline_mutex);
939 	mutex_lock(&card->conf_mutex);
940 	QETH_DBF_TEXT(SETUP, 2, "setonlin");
941 	QETH_DBF_HEX(SETUP, 2, &card, sizeof(void *));
942 
943 	recover_flag = card->state;
944 	rc = qeth_core_hardsetup_card(card, &carrier_ok);
945 	if (rc) {
946 		QETH_DBF_TEXT_(SETUP, 2, "2err%04x", rc);
947 		rc = -ENODEV;
948 		goto out_remove;
949 	}
950 	qeth_bridgeport_query_support(card);
951 	if (card->options.sbp.supported_funcs)
952 		dev_info(&card->gdev->dev,
953 		"The device represents a Bridge Capable Port\n");
954 
955 	rc = qeth_l2_setup_netdev(card, carrier_ok);
956 	if (rc)
957 		goto out_remove;
958 
959 	if (card->info.type != QETH_CARD_TYPE_OSN &&
960 	    !qeth_l2_send_setmac(card, card->dev->dev_addr))
961 		card->info.mac_bits |= QETH_LAYER2_MAC_REGISTERED;
962 
963 	if (qeth_is_diagass_supported(card, QETH_DIAGS_CMD_TRAP)) {
964 		if (card->info.hwtrap &&
965 		    qeth_hw_trap(card, QETH_DIAGS_TRAP_ARM))
966 			card->info.hwtrap = 0;
967 	} else
968 		card->info.hwtrap = 0;
969 
970 	/* for the rx_bcast characteristic, init VNICC after setmac */
971 	qeth_l2_vnicc_init(card);
972 
973 	qeth_trace_features(card);
974 	qeth_l2_trace_features(card);
975 
976 	qeth_l2_setup_bridgeport_attrs(card);
977 
978 	card->state = CARD_STATE_HARDSETUP;
979 	qeth_print_status_message(card);
980 
981 	/* softsetup */
982 	QETH_DBF_TEXT(SETUP, 2, "softsetp");
983 
984 	if ((card->info.type == QETH_CARD_TYPE_OSD) ||
985 	    (card->info.type == QETH_CARD_TYPE_OSX)) {
986 		rc = qeth_l2_start_ipassists(card);
987 		if (rc)
988 			goto out_remove;
989 	}
990 
991 	if (card->info.type != QETH_CARD_TYPE_OSN)
992 		qeth_l2_process_vlans(card);
993 
994 	netif_tx_disable(card->dev);
995 
996 	rc = qeth_init_qdio_queues(card);
997 	if (rc) {
998 		QETH_DBF_TEXT_(SETUP, 2, "6err%d", rc);
999 		rc = -ENODEV;
1000 		goto out_remove;
1001 	}
1002 	card->state = CARD_STATE_SOFTSETUP;
1003 
1004 	qeth_set_allowed_threads(card, 0xffffffff, 0);
1005 
1006 	qeth_enable_hw_features(card->dev);
1007 	if (recover_flag == CARD_STATE_RECOVER) {
1008 		if (recovery_mode &&
1009 		    card->info.type != QETH_CARD_TYPE_OSN) {
1010 			__qeth_l2_open(card->dev);
1011 			qeth_l2_set_rx_mode(card->dev);
1012 		} else {
1013 			rtnl_lock();
1014 			dev_open(card->dev, NULL);
1015 			rtnl_unlock();
1016 		}
1017 	}
1018 	/* let user_space know that device is online */
1019 	kobject_uevent(&gdev->dev.kobj, KOBJ_CHANGE);
1020 	mutex_unlock(&card->conf_mutex);
1021 	mutex_unlock(&card->discipline_mutex);
1022 	return 0;
1023 
1024 out_remove:
1025 	qeth_l2_stop_card(card, 0);
1026 	ccw_device_set_offline(CARD_DDEV(card));
1027 	ccw_device_set_offline(CARD_WDEV(card));
1028 	ccw_device_set_offline(CARD_RDEV(card));
1029 	qdio_free(CARD_DDEV(card));
1030 	if (recover_flag == CARD_STATE_RECOVER)
1031 		card->state = CARD_STATE_RECOVER;
1032 	else
1033 		card->state = CARD_STATE_DOWN;
1034 	mutex_unlock(&card->conf_mutex);
1035 	mutex_unlock(&card->discipline_mutex);
1036 	return rc;
1037 }
1038 
1039 static int qeth_l2_set_online(struct ccwgroup_device *gdev)
1040 {
1041 	return __qeth_l2_set_online(gdev, 0);
1042 }
1043 
1044 static int __qeth_l2_set_offline(struct ccwgroup_device *cgdev,
1045 					int recovery_mode)
1046 {
1047 	struct qeth_card *card = dev_get_drvdata(&cgdev->dev);
1048 	int rc = 0, rc2 = 0, rc3 = 0;
1049 	enum qeth_card_states recover_flag;
1050 
1051 	mutex_lock(&card->discipline_mutex);
1052 	mutex_lock(&card->conf_mutex);
1053 	QETH_DBF_TEXT(SETUP, 3, "setoffl");
1054 	QETH_DBF_HEX(SETUP, 3, &card, sizeof(void *));
1055 
1056 	netif_carrier_off(card->dev);
1057 	recover_flag = card->state;
1058 	if ((!recovery_mode && card->info.hwtrap) || card->info.hwtrap == 2) {
1059 		qeth_hw_trap(card, QETH_DIAGS_TRAP_DISARM);
1060 		card->info.hwtrap = 1;
1061 	}
1062 	qeth_l2_stop_card(card, recovery_mode);
1063 	rc  = ccw_device_set_offline(CARD_DDEV(card));
1064 	rc2 = ccw_device_set_offline(CARD_WDEV(card));
1065 	rc3 = ccw_device_set_offline(CARD_RDEV(card));
1066 	if (!rc)
1067 		rc = (rc2) ? rc2 : rc3;
1068 	if (rc)
1069 		QETH_DBF_TEXT_(SETUP, 2, "1err%d", rc);
1070 	qdio_free(CARD_DDEV(card));
1071 	if (recover_flag == CARD_STATE_UP)
1072 		card->state = CARD_STATE_RECOVER;
1073 	/* let user_space know that device is offline */
1074 	kobject_uevent(&cgdev->dev.kobj, KOBJ_CHANGE);
1075 	mutex_unlock(&card->conf_mutex);
1076 	mutex_unlock(&card->discipline_mutex);
1077 	return 0;
1078 }
1079 
1080 static int qeth_l2_set_offline(struct ccwgroup_device *cgdev)
1081 {
1082 	return __qeth_l2_set_offline(cgdev, 0);
1083 }
1084 
1085 static int qeth_l2_recover(void *ptr)
1086 {
1087 	struct qeth_card *card;
1088 	int rc = 0;
1089 
1090 	card = (struct qeth_card *) ptr;
1091 	QETH_CARD_TEXT(card, 2, "recover1");
1092 	if (!qeth_do_run_thread(card, QETH_RECOVER_THREAD))
1093 		return 0;
1094 	QETH_CARD_TEXT(card, 2, "recover2");
1095 	dev_warn(&card->gdev->dev,
1096 		"A recovery process has been started for the device\n");
1097 	qeth_set_recovery_task(card);
1098 	__qeth_l2_set_offline(card->gdev, 1);
1099 	rc = __qeth_l2_set_online(card->gdev, 1);
1100 	if (!rc)
1101 		dev_info(&card->gdev->dev,
1102 			"Device successfully recovered!\n");
1103 	else {
1104 		qeth_close_dev(card);
1105 		dev_warn(&card->gdev->dev, "The qeth device driver "
1106 				"failed to recover an error on the device\n");
1107 	}
1108 	qeth_clear_recovery_task(card);
1109 	qeth_clear_thread_start_bit(card, QETH_RECOVER_THREAD);
1110 	qeth_clear_thread_running_bit(card, QETH_RECOVER_THREAD);
1111 	return 0;
1112 }
1113 
1114 static int __init qeth_l2_init(void)
1115 {
1116 	pr_info("register layer 2 discipline\n");
1117 	return 0;
1118 }
1119 
1120 static void __exit qeth_l2_exit(void)
1121 {
1122 	pr_info("unregister layer 2 discipline\n");
1123 }
1124 
1125 static int qeth_l2_pm_suspend(struct ccwgroup_device *gdev)
1126 {
1127 	struct qeth_card *card = dev_get_drvdata(&gdev->dev);
1128 
1129 	netif_device_detach(card->dev);
1130 	qeth_set_allowed_threads(card, 0, 1);
1131 	wait_event(card->wait_q, qeth_threads_running(card, 0xffffffff) == 0);
1132 	if (gdev->state == CCWGROUP_OFFLINE)
1133 		return 0;
1134 	if (card->state == CARD_STATE_UP) {
1135 		if (card->info.hwtrap)
1136 			qeth_hw_trap(card, QETH_DIAGS_TRAP_DISARM);
1137 		__qeth_l2_set_offline(card->gdev, 1);
1138 	} else
1139 		__qeth_l2_set_offline(card->gdev, 0);
1140 	return 0;
1141 }
1142 
1143 static int qeth_l2_pm_resume(struct ccwgroup_device *gdev)
1144 {
1145 	struct qeth_card *card = dev_get_drvdata(&gdev->dev);
1146 	int rc = 0;
1147 
1148 	if (card->state == CARD_STATE_RECOVER) {
1149 		rc = __qeth_l2_set_online(card->gdev, 1);
1150 		if (rc) {
1151 			rtnl_lock();
1152 			dev_close(card->dev);
1153 			rtnl_unlock();
1154 		}
1155 	} else
1156 		rc = __qeth_l2_set_online(card->gdev, 0);
1157 
1158 	qeth_set_allowed_threads(card, 0xffffffff, 0);
1159 	netif_device_attach(card->dev);
1160 	if (rc)
1161 		dev_warn(&card->gdev->dev, "The qeth device driver "
1162 			"failed to recover an error on the device\n");
1163 	return rc;
1164 }
1165 
1166 /* Returns zero if the command is successfully "consumed" */
1167 static int qeth_l2_control_event(struct qeth_card *card,
1168 					struct qeth_ipa_cmd *cmd)
1169 {
1170 	switch (cmd->hdr.command) {
1171 	case IPA_CMD_SETBRIDGEPORT_OSA:
1172 	case IPA_CMD_SETBRIDGEPORT_IQD:
1173 		if (cmd->data.sbp.hdr.command_code ==
1174 				IPA_SBP_BRIDGE_PORT_STATE_CHANGE) {
1175 			qeth_bridge_state_change(card, cmd);
1176 			return 0;
1177 		} else
1178 			return 1;
1179 	case IPA_CMD_ADDRESS_CHANGE_NOTIF:
1180 		qeth_bridge_host_event(card, cmd);
1181 		return 0;
1182 	default:
1183 		return 1;
1184 	}
1185 }
1186 
1187 struct qeth_discipline qeth_l2_discipline = {
1188 	.devtype = &qeth_l2_devtype,
1189 	.process_rx_buffer = qeth_l2_process_inbound_buffer,
1190 	.recover = qeth_l2_recover,
1191 	.setup = qeth_l2_probe_device,
1192 	.remove = qeth_l2_remove_device,
1193 	.set_online = qeth_l2_set_online,
1194 	.set_offline = qeth_l2_set_offline,
1195 	.freeze = qeth_l2_pm_suspend,
1196 	.thaw = qeth_l2_pm_resume,
1197 	.restore = qeth_l2_pm_resume,
1198 	.do_ioctl = NULL,
1199 	.control_event_handler = qeth_l2_control_event,
1200 };
1201 EXPORT_SYMBOL_GPL(qeth_l2_discipline);
1202 
1203 static int qeth_osn_send_control_data(struct qeth_card *card, int len,
1204 			   struct qeth_cmd_buffer *iob)
1205 {
1206 	struct qeth_channel *channel = iob->channel;
1207 	int rc = 0;
1208 
1209 	QETH_CARD_TEXT(card, 5, "osndctrd");
1210 
1211 	wait_event(card->wait_q,
1212 		   atomic_cmpxchg(&channel->irq_pending, 0, 1) == 0);
1213 	qeth_prepare_control_data(card, len, iob);
1214 	QETH_CARD_TEXT(card, 6, "osnoirqp");
1215 	spin_lock_irq(get_ccwdev_lock(channel->ccwdev));
1216 	rc = ccw_device_start_timeout(channel->ccwdev, channel->ccw,
1217 				      (addr_t) iob, 0, 0, QETH_IPA_TIMEOUT);
1218 	spin_unlock_irq(get_ccwdev_lock(channel->ccwdev));
1219 	if (rc) {
1220 		QETH_DBF_MESSAGE(2, "qeth_osn_send_control_data: "
1221 			   "ccw_device_start rc = %i\n", rc);
1222 		QETH_CARD_TEXT_(card, 2, " err%d", rc);
1223 		qeth_release_buffer(channel, iob);
1224 		atomic_set(&channel->irq_pending, 0);
1225 		wake_up(&card->wait_q);
1226 	}
1227 	return rc;
1228 }
1229 
1230 static int qeth_osn_send_ipa_cmd(struct qeth_card *card,
1231 			struct qeth_cmd_buffer *iob, int data_len)
1232 {
1233 	u16 s1, s2;
1234 
1235 	QETH_CARD_TEXT(card, 4, "osndipa");
1236 
1237 	qeth_prepare_ipa_cmd(card, iob);
1238 	s1 = (u16)(IPA_PDU_HEADER_SIZE + data_len);
1239 	s2 = (u16)data_len;
1240 	memcpy(QETH_IPA_PDU_LEN_TOTAL(iob->data), &s1, 2);
1241 	memcpy(QETH_IPA_PDU_LEN_PDU1(iob->data), &s2, 2);
1242 	memcpy(QETH_IPA_PDU_LEN_PDU2(iob->data), &s2, 2);
1243 	memcpy(QETH_IPA_PDU_LEN_PDU3(iob->data), &s2, 2);
1244 	return qeth_osn_send_control_data(card, s1, iob);
1245 }
1246 
1247 int qeth_osn_assist(struct net_device *dev, void *data, int data_len)
1248 {
1249 	struct qeth_cmd_buffer *iob;
1250 	struct qeth_card *card;
1251 
1252 	if (!dev)
1253 		return -ENODEV;
1254 	card = dev->ml_priv;
1255 	if (!card)
1256 		return -ENODEV;
1257 	QETH_CARD_TEXT(card, 2, "osnsdmc");
1258 	if (!qeth_card_hw_is_reachable(card))
1259 		return -ENODEV;
1260 	iob = qeth_wait_for_buffer(&card->write);
1261 	memcpy(__ipa_cmd(iob), data, data_len);
1262 	return qeth_osn_send_ipa_cmd(card, iob, data_len);
1263 }
1264 EXPORT_SYMBOL(qeth_osn_assist);
1265 
1266 int qeth_osn_register(unsigned char *read_dev_no, struct net_device **dev,
1267 		  int (*assist_cb)(struct net_device *, void *),
1268 		  int (*data_cb)(struct sk_buff *))
1269 {
1270 	struct qeth_card *card;
1271 	char bus_id[16];
1272 	u16 devno;
1273 
1274 	memcpy(&devno, read_dev_no, 2);
1275 	sprintf(bus_id, "0.0.%04x", devno);
1276 	card = qeth_get_card_by_busid(bus_id);
1277 	if (!card || !IS_OSN(card))
1278 		return -ENODEV;
1279 	*dev = card->dev;
1280 
1281 	QETH_CARD_TEXT(card, 2, "osnreg");
1282 	if ((assist_cb == NULL) || (data_cb == NULL))
1283 		return -EINVAL;
1284 	card->osn_info.assist_cb = assist_cb;
1285 	card->osn_info.data_cb = data_cb;
1286 	return 0;
1287 }
1288 EXPORT_SYMBOL(qeth_osn_register);
1289 
1290 void qeth_osn_deregister(struct net_device *dev)
1291 {
1292 	struct qeth_card *card;
1293 
1294 	if (!dev)
1295 		return;
1296 	card = dev->ml_priv;
1297 	if (!card)
1298 		return;
1299 	QETH_CARD_TEXT(card, 2, "osndereg");
1300 	card->osn_info.assist_cb = NULL;
1301 	card->osn_info.data_cb = NULL;
1302 	return;
1303 }
1304 EXPORT_SYMBOL(qeth_osn_deregister);
1305 
1306 /* SETBRIDGEPORT support, async notifications */
1307 
1308 enum qeth_an_event_type {anev_reg_unreg, anev_abort, anev_reset};
1309 
1310 /**
1311  * qeth_bridge_emit_host_event() - bridgeport address change notification
1312  * @card:  qeth_card structure pointer, for udev events.
1313  * @evtype:  "normal" register/unregister, or abort, or reset. For abort
1314  *	      and reset token and addr_lnid are unused and may be NULL.
1315  * @code:  event bitmask: high order bit 0x80 value 1 means removal of an
1316  *			  object, 0 - addition of an object.
1317  *			  0x01 - VLAN, 0x02 - MAC, 0x03 - VLAN and MAC.
1318  * @token: "network token" structure identifying physical address of the port.
1319  * @addr_lnid: pointer to structure with MAC address and VLAN ID.
1320  *
1321  * This function is called when registrations and deregistrations are
1322  * reported by the hardware, and also when notifications are enabled -
1323  * for all currently registered addresses.
1324  */
1325 static void qeth_bridge_emit_host_event(struct qeth_card *card,
1326 	enum qeth_an_event_type evtype,
1327 	u8 code, struct net_if_token *token, struct mac_addr_lnid *addr_lnid)
1328 {
1329 	char str[7][32];
1330 	char *env[8];
1331 	int i = 0;
1332 
1333 	switch (evtype) {
1334 	case anev_reg_unreg:
1335 		snprintf(str[i], sizeof(str[i]), "BRIDGEDHOST=%s",
1336 				(code & IPA_ADDR_CHANGE_CODE_REMOVAL)
1337 				? "deregister" : "register");
1338 		env[i] = str[i]; i++;
1339 		if (code & IPA_ADDR_CHANGE_CODE_VLANID) {
1340 			snprintf(str[i], sizeof(str[i]), "VLAN=%d",
1341 				addr_lnid->lnid);
1342 			env[i] = str[i]; i++;
1343 		}
1344 		if (code & IPA_ADDR_CHANGE_CODE_MACADDR) {
1345 			snprintf(str[i], sizeof(str[i]), "MAC=%pM",
1346 				addr_lnid->mac);
1347 			env[i] = str[i]; i++;
1348 		}
1349 		snprintf(str[i], sizeof(str[i]), "NTOK_BUSID=%x.%x.%04x",
1350 			token->cssid, token->ssid, token->devnum);
1351 		env[i] = str[i]; i++;
1352 		snprintf(str[i], sizeof(str[i]), "NTOK_IID=%02x", token->iid);
1353 		env[i] = str[i]; i++;
1354 		snprintf(str[i], sizeof(str[i]), "NTOK_CHPID=%02x",
1355 				token->chpid);
1356 		env[i] = str[i]; i++;
1357 		snprintf(str[i], sizeof(str[i]), "NTOK_CHID=%04x", token->chid);
1358 		env[i] = str[i]; i++;
1359 		break;
1360 	case anev_abort:
1361 		snprintf(str[i], sizeof(str[i]), "BRIDGEDHOST=abort");
1362 		env[i] = str[i]; i++;
1363 		break;
1364 	case anev_reset:
1365 		snprintf(str[i], sizeof(str[i]), "BRIDGEDHOST=reset");
1366 		env[i] = str[i]; i++;
1367 		break;
1368 	}
1369 	env[i] = NULL;
1370 	kobject_uevent_env(&card->gdev->dev.kobj, KOBJ_CHANGE, env);
1371 }
1372 
1373 struct qeth_bridge_state_data {
1374 	struct work_struct worker;
1375 	struct qeth_card *card;
1376 	struct qeth_sbp_state_change qports;
1377 };
1378 
1379 static void qeth_bridge_state_change_worker(struct work_struct *work)
1380 {
1381 	struct qeth_bridge_state_data *data =
1382 		container_of(work, struct qeth_bridge_state_data, worker);
1383 	/* We are only interested in the first entry - local port */
1384 	struct qeth_sbp_port_entry *entry = &data->qports.entry[0];
1385 	char env_locrem[32];
1386 	char env_role[32];
1387 	char env_state[32];
1388 	char *env[] = {
1389 		env_locrem,
1390 		env_role,
1391 		env_state,
1392 		NULL
1393 	};
1394 
1395 	/* Role should not change by itself, but if it did, */
1396 	/* information from the hardware is authoritative.  */
1397 	mutex_lock(&data->card->conf_mutex);
1398 	data->card->options.sbp.role = entry->role;
1399 	mutex_unlock(&data->card->conf_mutex);
1400 
1401 	snprintf(env_locrem, sizeof(env_locrem), "BRIDGEPORT=statechange");
1402 	snprintf(env_role, sizeof(env_role), "ROLE=%s",
1403 		(entry->role == QETH_SBP_ROLE_NONE) ? "none" :
1404 		(entry->role == QETH_SBP_ROLE_PRIMARY) ? "primary" :
1405 		(entry->role == QETH_SBP_ROLE_SECONDARY) ? "secondary" :
1406 		"<INVALID>");
1407 	snprintf(env_state, sizeof(env_state), "STATE=%s",
1408 		(entry->state == QETH_SBP_STATE_INACTIVE) ? "inactive" :
1409 		(entry->state == QETH_SBP_STATE_STANDBY) ? "standby" :
1410 		(entry->state == QETH_SBP_STATE_ACTIVE) ? "active" :
1411 		"<INVALID>");
1412 	kobject_uevent_env(&data->card->gdev->dev.kobj,
1413 				KOBJ_CHANGE, env);
1414 	kfree(data);
1415 }
1416 
1417 static void qeth_bridge_state_change(struct qeth_card *card,
1418 					struct qeth_ipa_cmd *cmd)
1419 {
1420 	struct qeth_sbp_state_change *qports =
1421 		 &cmd->data.sbp.data.state_change;
1422 	struct qeth_bridge_state_data *data;
1423 	int extrasize;
1424 
1425 	QETH_CARD_TEXT(card, 2, "brstchng");
1426 	if (qports->entry_length != sizeof(struct qeth_sbp_port_entry)) {
1427 		QETH_CARD_TEXT_(card, 2, "BPsz%04x", qports->entry_length);
1428 		return;
1429 	}
1430 	extrasize = sizeof(struct qeth_sbp_port_entry) * qports->num_entries;
1431 	data = kzalloc(sizeof(struct qeth_bridge_state_data) + extrasize,
1432 		GFP_ATOMIC);
1433 	if (!data) {
1434 		QETH_CARD_TEXT(card, 2, "BPSalloc");
1435 		return;
1436 	}
1437 	INIT_WORK(&data->worker, qeth_bridge_state_change_worker);
1438 	data->card = card;
1439 	memcpy(&data->qports, qports,
1440 			sizeof(struct qeth_sbp_state_change) + extrasize);
1441 	queue_work(card->event_wq, &data->worker);
1442 }
1443 
1444 struct qeth_bridge_host_data {
1445 	struct work_struct worker;
1446 	struct qeth_card *card;
1447 	struct qeth_ipacmd_addr_change hostevs;
1448 };
1449 
1450 static void qeth_bridge_host_event_worker(struct work_struct *work)
1451 {
1452 	struct qeth_bridge_host_data *data =
1453 		container_of(work, struct qeth_bridge_host_data, worker);
1454 	int i;
1455 
1456 	if (data->hostevs.lost_event_mask) {
1457 		dev_info(&data->card->gdev->dev,
1458 "Address notification from the Bridge Port stopped %s (%s)\n",
1459 			data->card->dev->name,
1460 			(data->hostevs.lost_event_mask == 0x01)
1461 			? "Overflow"
1462 			: (data->hostevs.lost_event_mask == 0x02)
1463 			? "Bridge port state change"
1464 			: "Unknown reason");
1465 		mutex_lock(&data->card->conf_mutex);
1466 		data->card->options.sbp.hostnotification = 0;
1467 		mutex_unlock(&data->card->conf_mutex);
1468 		qeth_bridge_emit_host_event(data->card, anev_abort,
1469 			0, NULL, NULL);
1470 	} else
1471 		for (i = 0; i < data->hostevs.num_entries; i++) {
1472 			struct qeth_ipacmd_addr_change_entry *entry =
1473 					&data->hostevs.entry[i];
1474 			qeth_bridge_emit_host_event(data->card,
1475 					anev_reg_unreg,
1476 					entry->change_code,
1477 					&entry->token, &entry->addr_lnid);
1478 		}
1479 	kfree(data);
1480 }
1481 
1482 static void qeth_bridge_host_event(struct qeth_card *card,
1483 					struct qeth_ipa_cmd *cmd)
1484 {
1485 	struct qeth_ipacmd_addr_change *hostevs =
1486 		 &cmd->data.addrchange;
1487 	struct qeth_bridge_host_data *data;
1488 	int extrasize;
1489 
1490 	QETH_CARD_TEXT(card, 2, "brhostev");
1491 	if (cmd->hdr.return_code != 0x0000) {
1492 		if (cmd->hdr.return_code == 0x0010) {
1493 			if (hostevs->lost_event_mask == 0x00)
1494 				hostevs->lost_event_mask = 0xff;
1495 		} else {
1496 			QETH_CARD_TEXT_(card, 2, "BPHe%04x",
1497 				cmd->hdr.return_code);
1498 			return;
1499 		}
1500 	}
1501 	extrasize = sizeof(struct qeth_ipacmd_addr_change_entry) *
1502 						hostevs->num_entries;
1503 	data = kzalloc(sizeof(struct qeth_bridge_host_data) + extrasize,
1504 		GFP_ATOMIC);
1505 	if (!data) {
1506 		QETH_CARD_TEXT(card, 2, "BPHalloc");
1507 		return;
1508 	}
1509 	INIT_WORK(&data->worker, qeth_bridge_host_event_worker);
1510 	data->card = card;
1511 	memcpy(&data->hostevs, hostevs,
1512 			sizeof(struct qeth_ipacmd_addr_change) + extrasize);
1513 	queue_work(card->event_wq, &data->worker);
1514 }
1515 
1516 /* SETBRIDGEPORT support; sending commands */
1517 
1518 struct _qeth_sbp_cbctl {
1519 	u16 ipa_rc;
1520 	u16 cmd_rc;
1521 	union {
1522 		u32 supported;
1523 		struct {
1524 			enum qeth_sbp_roles *role;
1525 			enum qeth_sbp_states *state;
1526 		} qports;
1527 	} data;
1528 };
1529 
1530 /**
1531  * qeth_bridgeport_makerc() - derive "traditional" error from hardware codes.
1532  * @card:		      qeth_card structure pointer, for debug messages.
1533  * @cbctl:		      state structure with hardware return codes.
1534  * @setcmd:		      IPA command code
1535  *
1536  * Returns negative errno-compatible error indication or 0 on success.
1537  */
1538 static int qeth_bridgeport_makerc(struct qeth_card *card,
1539 	struct _qeth_sbp_cbctl *cbctl, enum qeth_ipa_sbp_cmd setcmd)
1540 {
1541 	int rc;
1542 	int is_iqd = (card->info.type == QETH_CARD_TYPE_IQD);
1543 
1544 	if ((is_iqd && (cbctl->ipa_rc == IPA_RC_SUCCESS)) ||
1545 	    (!is_iqd && (cbctl->ipa_rc == cbctl->cmd_rc)))
1546 		switch (cbctl->cmd_rc) {
1547 		case IPA_RC_SUCCESS:
1548 			rc = 0;
1549 			break;
1550 		case IPA_RC_L2_UNSUPPORTED_CMD:
1551 		case IPA_RC_UNSUPPORTED_COMMAND:
1552 			rc = -EOPNOTSUPP;
1553 			break;
1554 		case IPA_RC_SBP_OSA_NOT_CONFIGURED:
1555 		case IPA_RC_SBP_IQD_NOT_CONFIGURED:
1556 			rc = -ENODEV; /* maybe not the best code here? */
1557 			dev_err(&card->gdev->dev,
1558 	"The device is not configured as a Bridge Port\n");
1559 			break;
1560 		case IPA_RC_SBP_OSA_OS_MISMATCH:
1561 		case IPA_RC_SBP_IQD_OS_MISMATCH:
1562 			rc = -EPERM;
1563 			dev_err(&card->gdev->dev,
1564 	"A Bridge Port is already configured by a different operating system\n");
1565 			break;
1566 		case IPA_RC_SBP_OSA_ANO_DEV_PRIMARY:
1567 		case IPA_RC_SBP_IQD_ANO_DEV_PRIMARY:
1568 			switch (setcmd) {
1569 			case IPA_SBP_SET_PRIMARY_BRIDGE_PORT:
1570 				rc = -EEXIST;
1571 				dev_err(&card->gdev->dev,
1572 	"The LAN already has a primary Bridge Port\n");
1573 				break;
1574 			case IPA_SBP_SET_SECONDARY_BRIDGE_PORT:
1575 				rc = -EBUSY;
1576 				dev_err(&card->gdev->dev,
1577 	"The device is already a primary Bridge Port\n");
1578 				break;
1579 			default:
1580 				rc = -EIO;
1581 			}
1582 			break;
1583 		case IPA_RC_SBP_OSA_CURRENT_SECOND:
1584 		case IPA_RC_SBP_IQD_CURRENT_SECOND:
1585 			rc = -EBUSY;
1586 			dev_err(&card->gdev->dev,
1587 	"The device is already a secondary Bridge Port\n");
1588 			break;
1589 		case IPA_RC_SBP_OSA_LIMIT_SECOND:
1590 		case IPA_RC_SBP_IQD_LIMIT_SECOND:
1591 			rc = -EEXIST;
1592 			dev_err(&card->gdev->dev,
1593 	"The LAN cannot have more secondary Bridge Ports\n");
1594 			break;
1595 		case IPA_RC_SBP_OSA_CURRENT_PRIMARY:
1596 		case IPA_RC_SBP_IQD_CURRENT_PRIMARY:
1597 			rc = -EBUSY;
1598 			dev_err(&card->gdev->dev,
1599 	"The device is already a primary Bridge Port\n");
1600 			break;
1601 		case IPA_RC_SBP_OSA_NOT_AUTHD_BY_ZMAN:
1602 		case IPA_RC_SBP_IQD_NOT_AUTHD_BY_ZMAN:
1603 			rc = -EACCES;
1604 			dev_err(&card->gdev->dev,
1605 	"The device is not authorized to be a Bridge Port\n");
1606 			break;
1607 		default:
1608 			rc = -EIO;
1609 		}
1610 	else
1611 		switch (cbctl->ipa_rc) {
1612 		case IPA_RC_NOTSUPP:
1613 			rc = -EOPNOTSUPP;
1614 			break;
1615 		case IPA_RC_UNSUPPORTED_COMMAND:
1616 			rc = -EOPNOTSUPP;
1617 			break;
1618 		default:
1619 			rc = -EIO;
1620 		}
1621 
1622 	if (rc) {
1623 		QETH_CARD_TEXT_(card, 2, "SBPi%04x", cbctl->ipa_rc);
1624 		QETH_CARD_TEXT_(card, 2, "SBPc%04x", cbctl->cmd_rc);
1625 	}
1626 	return rc;
1627 }
1628 
1629 static struct qeth_cmd_buffer *qeth_sbp_build_cmd(struct qeth_card *card,
1630 						  enum qeth_ipa_sbp_cmd sbp_cmd,
1631 						  unsigned int cmd_length)
1632 {
1633 	enum qeth_ipa_cmds ipa_cmd = (card->info.type == QETH_CARD_TYPE_IQD) ?
1634 					IPA_CMD_SETBRIDGEPORT_IQD :
1635 					IPA_CMD_SETBRIDGEPORT_OSA;
1636 	struct qeth_cmd_buffer *iob;
1637 	struct qeth_ipa_cmd *cmd;
1638 
1639 	iob = qeth_get_ipacmd_buffer(card, ipa_cmd, 0);
1640 	if (!iob)
1641 		return iob;
1642 	cmd = __ipa_cmd(iob);
1643 	cmd->data.sbp.hdr.cmdlength = sizeof(struct qeth_ipacmd_sbp_hdr) +
1644 				      cmd_length;
1645 	cmd->data.sbp.hdr.command_code = sbp_cmd;
1646 	cmd->data.sbp.hdr.used_total = 1;
1647 	cmd->data.sbp.hdr.seq_no = 1;
1648 	return iob;
1649 }
1650 
1651 static int qeth_bridgeport_query_support_cb(struct qeth_card *card,
1652 	struct qeth_reply *reply, unsigned long data)
1653 {
1654 	struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *) data;
1655 	struct _qeth_sbp_cbctl *cbctl = (struct _qeth_sbp_cbctl *)reply->param;
1656 	QETH_CARD_TEXT(card, 2, "brqsupcb");
1657 	cbctl->ipa_rc = cmd->hdr.return_code;
1658 	cbctl->cmd_rc = cmd->data.sbp.hdr.return_code;
1659 	if ((cbctl->ipa_rc == 0) && (cbctl->cmd_rc == 0)) {
1660 		cbctl->data.supported =
1661 			cmd->data.sbp.data.query_cmds_supp.supported_cmds;
1662 	} else {
1663 		cbctl->data.supported = 0;
1664 	}
1665 	return 0;
1666 }
1667 
1668 /**
1669  * qeth_bridgeport_query_support() - store bitmask of supported subfunctions.
1670  * @card:			     qeth_card structure pointer.
1671  *
1672  * Sets bitmask of supported setbridgeport subfunctions in the qeth_card
1673  * strucutre: card->options.sbp.supported_funcs.
1674  */
1675 static void qeth_bridgeport_query_support(struct qeth_card *card)
1676 {
1677 	struct qeth_cmd_buffer *iob;
1678 	struct _qeth_sbp_cbctl cbctl;
1679 
1680 	QETH_CARD_TEXT(card, 2, "brqsuppo");
1681 	iob = qeth_sbp_build_cmd(card, IPA_SBP_QUERY_COMMANDS_SUPPORTED,
1682 				 sizeof(struct qeth_sbp_query_cmds_supp));
1683 	if (!iob)
1684 		return;
1685 	if (qeth_send_ipa_cmd(card, iob, qeth_bridgeport_query_support_cb,
1686 							(void *)&cbctl) ||
1687 	    qeth_bridgeport_makerc(card, &cbctl,
1688 					IPA_SBP_QUERY_COMMANDS_SUPPORTED)) {
1689 		/* non-zero makerc signifies failure, and produce messages */
1690 		card->options.sbp.role = QETH_SBP_ROLE_NONE;
1691 		return;
1692 	}
1693 	card->options.sbp.supported_funcs = cbctl.data.supported;
1694 }
1695 
1696 static int qeth_bridgeport_query_ports_cb(struct qeth_card *card,
1697 	struct qeth_reply *reply, unsigned long data)
1698 {
1699 	struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *) data;
1700 	struct qeth_sbp_query_ports *qports = &cmd->data.sbp.data.query_ports;
1701 	struct _qeth_sbp_cbctl *cbctl = (struct _qeth_sbp_cbctl *)reply->param;
1702 
1703 	QETH_CARD_TEXT(card, 2, "brqprtcb");
1704 	cbctl->ipa_rc = cmd->hdr.return_code;
1705 	cbctl->cmd_rc = cmd->data.sbp.hdr.return_code;
1706 	if ((cbctl->ipa_rc != 0) || (cbctl->cmd_rc != 0))
1707 		return 0;
1708 	if (qports->entry_length != sizeof(struct qeth_sbp_port_entry)) {
1709 		cbctl->cmd_rc = 0xffff;
1710 		QETH_CARD_TEXT_(card, 2, "SBPs%04x", qports->entry_length);
1711 		return 0;
1712 	}
1713 	/* first entry contains the state of the local port */
1714 	if (qports->num_entries > 0) {
1715 		if (cbctl->data.qports.role)
1716 			*cbctl->data.qports.role = qports->entry[0].role;
1717 		if (cbctl->data.qports.state)
1718 			*cbctl->data.qports.state = qports->entry[0].state;
1719 	}
1720 	return 0;
1721 }
1722 
1723 /**
1724  * qeth_bridgeport_query_ports() - query local bridgeport status.
1725  * @card:			   qeth_card structure pointer.
1726  * @role:   Role of the port: 0-none, 1-primary, 2-secondary.
1727  * @state:  State of the port: 0-inactive, 1-standby, 2-active.
1728  *
1729  * Returns negative errno-compatible error indication or 0 on success.
1730  *
1731  * 'role' and 'state' are not updated in case of hardware operation failure.
1732  */
1733 int qeth_bridgeport_query_ports(struct qeth_card *card,
1734 	enum qeth_sbp_roles *role, enum qeth_sbp_states *state)
1735 {
1736 	int rc = 0;
1737 	struct qeth_cmd_buffer *iob;
1738 	struct _qeth_sbp_cbctl cbctl = {
1739 		.data = {
1740 			.qports = {
1741 				.role = role,
1742 				.state = state,
1743 			},
1744 		},
1745 	};
1746 
1747 	QETH_CARD_TEXT(card, 2, "brqports");
1748 	if (!(card->options.sbp.supported_funcs & IPA_SBP_QUERY_BRIDGE_PORTS))
1749 		return -EOPNOTSUPP;
1750 	iob = qeth_sbp_build_cmd(card, IPA_SBP_QUERY_BRIDGE_PORTS, 0);
1751 	if (!iob)
1752 		return -ENOMEM;
1753 	rc = qeth_send_ipa_cmd(card, iob, qeth_bridgeport_query_ports_cb,
1754 				(void *)&cbctl);
1755 	if (rc < 0)
1756 		return rc;
1757 	return qeth_bridgeport_makerc(card, &cbctl, IPA_SBP_QUERY_BRIDGE_PORTS);
1758 }
1759 
1760 static int qeth_bridgeport_set_cb(struct qeth_card *card,
1761 	struct qeth_reply *reply, unsigned long data)
1762 {
1763 	struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *)data;
1764 	struct _qeth_sbp_cbctl *cbctl = (struct _qeth_sbp_cbctl *)reply->param;
1765 	QETH_CARD_TEXT(card, 2, "brsetrcb");
1766 	cbctl->ipa_rc = cmd->hdr.return_code;
1767 	cbctl->cmd_rc = cmd->data.sbp.hdr.return_code;
1768 	return 0;
1769 }
1770 
1771 /**
1772  * qeth_bridgeport_setrole() - Assign primary role to the port.
1773  * @card:		       qeth_card structure pointer.
1774  * @role:		       Role to assign.
1775  *
1776  * Returns negative errno-compatible error indication or 0 on success.
1777  */
1778 int qeth_bridgeport_setrole(struct qeth_card *card, enum qeth_sbp_roles role)
1779 {
1780 	int rc = 0;
1781 	int cmdlength;
1782 	struct qeth_cmd_buffer *iob;
1783 	struct _qeth_sbp_cbctl cbctl;
1784 	enum qeth_ipa_sbp_cmd setcmd;
1785 
1786 	QETH_CARD_TEXT(card, 2, "brsetrol");
1787 	switch (role) {
1788 	case QETH_SBP_ROLE_NONE:
1789 		setcmd = IPA_SBP_RESET_BRIDGE_PORT_ROLE;
1790 		cmdlength = sizeof(struct qeth_sbp_reset_role);
1791 		break;
1792 	case QETH_SBP_ROLE_PRIMARY:
1793 		setcmd = IPA_SBP_SET_PRIMARY_BRIDGE_PORT;
1794 		cmdlength = sizeof(struct qeth_sbp_set_primary);
1795 		break;
1796 	case QETH_SBP_ROLE_SECONDARY:
1797 		setcmd = IPA_SBP_SET_SECONDARY_BRIDGE_PORT;
1798 		cmdlength = sizeof(struct qeth_sbp_set_secondary);
1799 		break;
1800 	default:
1801 		return -EINVAL;
1802 	}
1803 	if (!(card->options.sbp.supported_funcs & setcmd))
1804 		return -EOPNOTSUPP;
1805 	iob = qeth_sbp_build_cmd(card, setcmd, cmdlength);
1806 	if (!iob)
1807 		return -ENOMEM;
1808 	rc = qeth_send_ipa_cmd(card, iob, qeth_bridgeport_set_cb,
1809 				(void *)&cbctl);
1810 	if (rc < 0)
1811 		return rc;
1812 	return qeth_bridgeport_makerc(card, &cbctl, setcmd);
1813 }
1814 
1815 /**
1816  * qeth_anset_makerc() - derive "traditional" error from hardware codes.
1817  * @card:		      qeth_card structure pointer, for debug messages.
1818  *
1819  * Returns negative errno-compatible error indication or 0 on success.
1820  */
1821 static int qeth_anset_makerc(struct qeth_card *card, int pnso_rc, u16 response)
1822 {
1823 	int rc;
1824 
1825 	if (pnso_rc == 0)
1826 		switch (response) {
1827 		case 0x0001:
1828 			rc = 0;
1829 			break;
1830 		case 0x0004:
1831 		case 0x0100:
1832 		case 0x0106:
1833 			rc = -EOPNOTSUPP;
1834 			dev_err(&card->gdev->dev,
1835 				"Setting address notification failed\n");
1836 			break;
1837 		case 0x0107:
1838 			rc = -EAGAIN;
1839 			break;
1840 		default:
1841 			rc = -EIO;
1842 		}
1843 	else
1844 		rc = -EIO;
1845 
1846 	if (rc) {
1847 		QETH_CARD_TEXT_(card, 2, "SBPp%04x", pnso_rc);
1848 		QETH_CARD_TEXT_(card, 2, "SBPr%04x", response);
1849 	}
1850 	return rc;
1851 }
1852 
1853 static void qeth_bridgeport_an_set_cb(void *priv,
1854 		enum qdio_brinfo_entry_type type, void *entry)
1855 {
1856 	struct qeth_card *card = (struct qeth_card *)priv;
1857 	struct qdio_brinfo_entry_l2 *l2entry;
1858 	u8 code;
1859 
1860 	if (type != l2_addr_lnid) {
1861 		WARN_ON_ONCE(1);
1862 		return;
1863 	}
1864 
1865 	l2entry = (struct qdio_brinfo_entry_l2 *)entry;
1866 	code = IPA_ADDR_CHANGE_CODE_MACADDR;
1867 	if (l2entry->addr_lnid.lnid)
1868 		code |= IPA_ADDR_CHANGE_CODE_VLANID;
1869 	qeth_bridge_emit_host_event(card, anev_reg_unreg, code,
1870 		(struct net_if_token *)&l2entry->nit,
1871 		(struct mac_addr_lnid *)&l2entry->addr_lnid);
1872 }
1873 
1874 /**
1875  * qeth_bridgeport_an_set() - Enable or disable bridgeport address notification
1876  * @card:		      qeth_card structure pointer.
1877  * @enable:		      0 - disable, non-zero - enable notifications
1878  *
1879  * Returns negative errno-compatible error indication or 0 on success.
1880  *
1881  * On enable, emits a series of address notifications udev events for all
1882  * currently registered hosts.
1883  */
1884 int qeth_bridgeport_an_set(struct qeth_card *card, int enable)
1885 {
1886 	int rc;
1887 	u16 response;
1888 	struct ccw_device *ddev;
1889 	struct subchannel_id schid;
1890 
1891 	if (!card)
1892 		return -EINVAL;
1893 	if (!card->options.sbp.supported_funcs)
1894 		return -EOPNOTSUPP;
1895 	ddev = CARD_DDEV(card);
1896 	ccw_device_get_schid(ddev, &schid);
1897 
1898 	if (enable) {
1899 		qeth_bridge_emit_host_event(card, anev_reset, 0, NULL, NULL);
1900 		rc = qdio_pnso_brinfo(schid, 1, &response,
1901 			qeth_bridgeport_an_set_cb, card);
1902 	} else
1903 		rc = qdio_pnso_brinfo(schid, 0, &response, NULL, NULL);
1904 	return qeth_anset_makerc(card, rc, response);
1905 }
1906 
1907 static bool qeth_bridgeport_is_in_use(struct qeth_card *card)
1908 {
1909 	return (card->options.sbp.role || card->options.sbp.reflect_promisc ||
1910 		card->options.sbp.hostnotification);
1911 }
1912 
1913 /* VNIC Characteristics support */
1914 
1915 /* handle VNICC IPA command return codes; convert to error codes */
1916 static int qeth_l2_vnicc_makerc(struct qeth_card *card, int ipa_rc)
1917 {
1918 	int rc;
1919 
1920 	switch (ipa_rc) {
1921 	case IPA_RC_SUCCESS:
1922 		return ipa_rc;
1923 	case IPA_RC_L2_UNSUPPORTED_CMD:
1924 	case IPA_RC_NOTSUPP:
1925 		rc = -EOPNOTSUPP;
1926 		break;
1927 	case IPA_RC_VNICC_OOSEQ:
1928 		rc = -EALREADY;
1929 		break;
1930 	case IPA_RC_VNICC_VNICBP:
1931 		rc = -EBUSY;
1932 		break;
1933 	case IPA_RC_L2_ADDR_TABLE_FULL:
1934 		rc = -ENOSPC;
1935 		break;
1936 	case IPA_RC_L2_MAC_NOT_AUTH_BY_ADP:
1937 		rc = -EACCES;
1938 		break;
1939 	default:
1940 		rc = -EIO;
1941 	}
1942 
1943 	QETH_CARD_TEXT_(card, 2, "err%04x", ipa_rc);
1944 	return rc;
1945 }
1946 
1947 /* generic VNICC request call back control */
1948 struct _qeth_l2_vnicc_request_cbctl {
1949 	u32 sub_cmd;
1950 	struct {
1951 		u32 vnic_char;
1952 		u32 timeout;
1953 	} param;
1954 	struct {
1955 		union{
1956 			u32 *sup_cmds;
1957 			u32 *timeout;
1958 		};
1959 	} result;
1960 };
1961 
1962 /* generic VNICC request call back */
1963 static int qeth_l2_vnicc_request_cb(struct qeth_card *card,
1964 				    struct qeth_reply *reply,
1965 				    unsigned long data)
1966 {
1967 	struct _qeth_l2_vnicc_request_cbctl *cbctl =
1968 		(struct _qeth_l2_vnicc_request_cbctl *) reply->param;
1969 	struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *) data;
1970 	struct qeth_ipacmd_vnicc *rep = &cmd->data.vnicc;
1971 
1972 	QETH_CARD_TEXT(card, 2, "vniccrcb");
1973 	if (cmd->hdr.return_code)
1974 		return 0;
1975 	/* return results to caller */
1976 	card->options.vnicc.sup_chars = rep->hdr.sup;
1977 	card->options.vnicc.cur_chars = rep->hdr.cur;
1978 
1979 	if (cbctl->sub_cmd == IPA_VNICC_QUERY_CMDS)
1980 		*cbctl->result.sup_cmds = rep->query_cmds.sup_cmds;
1981 
1982 	if (cbctl->sub_cmd == IPA_VNICC_GET_TIMEOUT)
1983 		*cbctl->result.timeout = rep->getset_timeout.timeout;
1984 
1985 	return 0;
1986 }
1987 
1988 /* generic VNICC request */
1989 static int qeth_l2_vnicc_request(struct qeth_card *card,
1990 				 struct _qeth_l2_vnicc_request_cbctl *cbctl)
1991 {
1992 	struct qeth_ipacmd_vnicc *req;
1993 	struct qeth_cmd_buffer *iob;
1994 	struct qeth_ipa_cmd *cmd;
1995 	int rc;
1996 
1997 	QETH_CARD_TEXT(card, 2, "vniccreq");
1998 
1999 	/* get new buffer for request */
2000 	iob = qeth_get_ipacmd_buffer(card, IPA_CMD_VNICC, 0);
2001 	if (!iob)
2002 		return -ENOMEM;
2003 
2004 	/* create header for request */
2005 	cmd = __ipa_cmd(iob);
2006 	req = &cmd->data.vnicc;
2007 
2008 	/* create sub command header for request */
2009 	req->sub_hdr.data_length = sizeof(req->sub_hdr);
2010 	req->sub_hdr.sub_command = cbctl->sub_cmd;
2011 
2012 	/* create sub command specific request fields */
2013 	switch (cbctl->sub_cmd) {
2014 	case IPA_VNICC_QUERY_CHARS:
2015 		break;
2016 	case IPA_VNICC_QUERY_CMDS:
2017 		req->sub_hdr.data_length += sizeof(req->query_cmds);
2018 		req->query_cmds.vnic_char = cbctl->param.vnic_char;
2019 		break;
2020 	case IPA_VNICC_ENABLE:
2021 	case IPA_VNICC_DISABLE:
2022 		req->sub_hdr.data_length += sizeof(req->set_char);
2023 		req->set_char.vnic_char = cbctl->param.vnic_char;
2024 		break;
2025 	case IPA_VNICC_SET_TIMEOUT:
2026 		req->getset_timeout.timeout = cbctl->param.timeout;
2027 		/* fallthrough */
2028 	case IPA_VNICC_GET_TIMEOUT:
2029 		req->sub_hdr.data_length += sizeof(req->getset_timeout);
2030 		req->getset_timeout.vnic_char = cbctl->param.vnic_char;
2031 		break;
2032 	default:
2033 		qeth_release_buffer(iob->channel, iob);
2034 		return -EOPNOTSUPP;
2035 	}
2036 
2037 	/* send request */
2038 	rc = qeth_send_ipa_cmd(card, iob, qeth_l2_vnicc_request_cb,
2039 			       (void *) cbctl);
2040 
2041 	return qeth_l2_vnicc_makerc(card, rc);
2042 }
2043 
2044 /* VNICC query VNIC characteristics request */
2045 static int qeth_l2_vnicc_query_chars(struct qeth_card *card)
2046 {
2047 	struct _qeth_l2_vnicc_request_cbctl cbctl;
2048 
2049 	/* prepare callback control */
2050 	cbctl.sub_cmd = IPA_VNICC_QUERY_CHARS;
2051 
2052 	QETH_CARD_TEXT(card, 2, "vniccqch");
2053 	return qeth_l2_vnicc_request(card, &cbctl);
2054 }
2055 
2056 /* VNICC query sub commands request */
2057 static int qeth_l2_vnicc_query_cmds(struct qeth_card *card, u32 vnic_char,
2058 				    u32 *sup_cmds)
2059 {
2060 	struct _qeth_l2_vnicc_request_cbctl cbctl;
2061 
2062 	/* prepare callback control */
2063 	cbctl.sub_cmd = IPA_VNICC_QUERY_CMDS;
2064 	cbctl.param.vnic_char = vnic_char;
2065 	cbctl.result.sup_cmds = sup_cmds;
2066 
2067 	QETH_CARD_TEXT(card, 2, "vniccqcm");
2068 	return qeth_l2_vnicc_request(card, &cbctl);
2069 }
2070 
2071 /* VNICC enable/disable characteristic request */
2072 static int qeth_l2_vnicc_set_char(struct qeth_card *card, u32 vnic_char,
2073 				      u32 cmd)
2074 {
2075 	struct _qeth_l2_vnicc_request_cbctl cbctl;
2076 
2077 	/* prepare callback control */
2078 	cbctl.sub_cmd = cmd;
2079 	cbctl.param.vnic_char = vnic_char;
2080 
2081 	QETH_CARD_TEXT(card, 2, "vniccedc");
2082 	return qeth_l2_vnicc_request(card, &cbctl);
2083 }
2084 
2085 /* VNICC get/set timeout for characteristic request */
2086 static int qeth_l2_vnicc_getset_timeout(struct qeth_card *card, u32 vnicc,
2087 					u32 cmd, u32 *timeout)
2088 {
2089 	struct _qeth_l2_vnicc_request_cbctl cbctl;
2090 
2091 	/* prepare callback control */
2092 	cbctl.sub_cmd = cmd;
2093 	cbctl.param.vnic_char = vnicc;
2094 	if (cmd == IPA_VNICC_SET_TIMEOUT)
2095 		cbctl.param.timeout = *timeout;
2096 	if (cmd == IPA_VNICC_GET_TIMEOUT)
2097 		cbctl.result.timeout = timeout;
2098 
2099 	QETH_CARD_TEXT(card, 2, "vniccgst");
2100 	return qeth_l2_vnicc_request(card, &cbctl);
2101 }
2102 
2103 /* set current VNICC flag state; called from sysfs store function */
2104 int qeth_l2_vnicc_set_state(struct qeth_card *card, u32 vnicc, bool state)
2105 {
2106 	int rc = 0;
2107 	u32 cmd;
2108 
2109 	QETH_CARD_TEXT(card, 2, "vniccsch");
2110 
2111 	/* do not change anything if BridgePort is enabled */
2112 	if (qeth_bridgeport_is_in_use(card))
2113 		return -EBUSY;
2114 
2115 	/* check if characteristic and enable/disable are supported */
2116 	if (!(card->options.vnicc.sup_chars & vnicc) ||
2117 	    !(card->options.vnicc.set_char_sup & vnicc))
2118 		return -EOPNOTSUPP;
2119 
2120 	/* set enable/disable command and store wanted characteristic */
2121 	if (state) {
2122 		cmd = IPA_VNICC_ENABLE;
2123 		card->options.vnicc.wanted_chars |= vnicc;
2124 	} else {
2125 		cmd = IPA_VNICC_DISABLE;
2126 		card->options.vnicc.wanted_chars &= ~vnicc;
2127 	}
2128 
2129 	/* do we need to do anything? */
2130 	if (card->options.vnicc.cur_chars == card->options.vnicc.wanted_chars)
2131 		return rc;
2132 
2133 	/* if card is not ready, simply stop here */
2134 	if (!qeth_card_hw_is_reachable(card)) {
2135 		if (state)
2136 			card->options.vnicc.cur_chars |= vnicc;
2137 		else
2138 			card->options.vnicc.cur_chars &= ~vnicc;
2139 		return rc;
2140 	}
2141 
2142 	rc = qeth_l2_vnicc_set_char(card, vnicc, cmd);
2143 	if (rc)
2144 		card->options.vnicc.wanted_chars =
2145 			card->options.vnicc.cur_chars;
2146 	else {
2147 		/* successful online VNICC change; handle special cases */
2148 		if (state && vnicc == QETH_VNICC_RX_BCAST)
2149 			card->options.vnicc.rx_bcast_enabled = true;
2150 		if (!state && vnicc == QETH_VNICC_LEARNING)
2151 			qeth_l2_vnicc_recover_timeout(card, vnicc,
2152 					&card->options.vnicc.learning_timeout);
2153 	}
2154 
2155 	return rc;
2156 }
2157 
2158 /* get current VNICC flag state; called from sysfs show function */
2159 int qeth_l2_vnicc_get_state(struct qeth_card *card, u32 vnicc, bool *state)
2160 {
2161 	int rc = 0;
2162 
2163 	QETH_CARD_TEXT(card, 2, "vniccgch");
2164 
2165 	/* do not get anything if BridgePort is enabled */
2166 	if (qeth_bridgeport_is_in_use(card))
2167 		return -EBUSY;
2168 
2169 	/* check if characteristic is supported */
2170 	if (!(card->options.vnicc.sup_chars & vnicc))
2171 		return -EOPNOTSUPP;
2172 
2173 	/* if card is ready, query current VNICC state */
2174 	if (qeth_card_hw_is_reachable(card))
2175 		rc = qeth_l2_vnicc_query_chars(card);
2176 
2177 	*state = (card->options.vnicc.cur_chars & vnicc) ? true : false;
2178 	return rc;
2179 }
2180 
2181 /* set VNICC timeout; called from sysfs store function. Currently, only learning
2182  * supports timeout
2183  */
2184 int qeth_l2_vnicc_set_timeout(struct qeth_card *card, u32 timeout)
2185 {
2186 	int rc = 0;
2187 
2188 	QETH_CARD_TEXT(card, 2, "vniccsto");
2189 
2190 	/* do not change anything if BridgePort is enabled */
2191 	if (qeth_bridgeport_is_in_use(card))
2192 		return -EBUSY;
2193 
2194 	/* check if characteristic and set_timeout are supported */
2195 	if (!(card->options.vnicc.sup_chars & QETH_VNICC_LEARNING) ||
2196 	    !(card->options.vnicc.getset_timeout_sup & QETH_VNICC_LEARNING))
2197 		return -EOPNOTSUPP;
2198 
2199 	/* do we need to do anything? */
2200 	if (card->options.vnicc.learning_timeout == timeout)
2201 		return rc;
2202 
2203 	/* if card is not ready, simply store the value internally and return */
2204 	if (!qeth_card_hw_is_reachable(card)) {
2205 		card->options.vnicc.learning_timeout = timeout;
2206 		return rc;
2207 	}
2208 
2209 	/* send timeout value to card; if successful, store value internally */
2210 	rc = qeth_l2_vnicc_getset_timeout(card, QETH_VNICC_LEARNING,
2211 					  IPA_VNICC_SET_TIMEOUT, &timeout);
2212 	if (!rc)
2213 		card->options.vnicc.learning_timeout = timeout;
2214 
2215 	return rc;
2216 }
2217 
2218 /* get current VNICC timeout; called from sysfs show function. Currently, only
2219  * learning supports timeout
2220  */
2221 int qeth_l2_vnicc_get_timeout(struct qeth_card *card, u32 *timeout)
2222 {
2223 	int rc = 0;
2224 
2225 	QETH_CARD_TEXT(card, 2, "vniccgto");
2226 
2227 	/* do not get anything if BridgePort is enabled */
2228 	if (qeth_bridgeport_is_in_use(card))
2229 		return -EBUSY;
2230 
2231 	/* check if characteristic and get_timeout are supported */
2232 	if (!(card->options.vnicc.sup_chars & QETH_VNICC_LEARNING) ||
2233 	    !(card->options.vnicc.getset_timeout_sup & QETH_VNICC_LEARNING))
2234 		return -EOPNOTSUPP;
2235 	/* if card is ready, get timeout. Otherwise, just return stored value */
2236 	*timeout = card->options.vnicc.learning_timeout;
2237 	if (qeth_card_hw_is_reachable(card))
2238 		rc = qeth_l2_vnicc_getset_timeout(card, QETH_VNICC_LEARNING,
2239 						  IPA_VNICC_GET_TIMEOUT,
2240 						  timeout);
2241 
2242 	return rc;
2243 }
2244 
2245 /* check if VNICC is currently enabled */
2246 bool qeth_l2_vnicc_is_in_use(struct qeth_card *card)
2247 {
2248 	/* if everything is turned off, VNICC is not active */
2249 	if (!card->options.vnicc.cur_chars)
2250 		return false;
2251 	/* default values are only OK if rx_bcast was not enabled by user
2252 	 * or the card is offline.
2253 	 */
2254 	if (card->options.vnicc.cur_chars == QETH_VNICC_DEFAULT) {
2255 		if (!card->options.vnicc.rx_bcast_enabled ||
2256 		    !qeth_card_hw_is_reachable(card))
2257 			return false;
2258 	}
2259 	return true;
2260 }
2261 
2262 /* recover user timeout setting */
2263 static bool qeth_l2_vnicc_recover_timeout(struct qeth_card *card, u32 vnicc,
2264 					  u32 *timeout)
2265 {
2266 	if (card->options.vnicc.sup_chars & vnicc &&
2267 	    card->options.vnicc.getset_timeout_sup & vnicc &&
2268 	    !qeth_l2_vnicc_getset_timeout(card, vnicc, IPA_VNICC_SET_TIMEOUT,
2269 					  timeout))
2270 		return false;
2271 	*timeout = QETH_VNICC_DEFAULT_TIMEOUT;
2272 	return true;
2273 }
2274 
2275 /* recover user characteristic setting */
2276 static bool qeth_l2_vnicc_recover_char(struct qeth_card *card, u32 vnicc,
2277 				       bool enable)
2278 {
2279 	u32 cmd = enable ? IPA_VNICC_ENABLE : IPA_VNICC_DISABLE;
2280 
2281 	if (card->options.vnicc.sup_chars & vnicc &&
2282 	    card->options.vnicc.set_char_sup & vnicc &&
2283 	    !qeth_l2_vnicc_set_char(card, vnicc, cmd))
2284 		return false;
2285 	card->options.vnicc.wanted_chars &= ~vnicc;
2286 	card->options.vnicc.wanted_chars |= QETH_VNICC_DEFAULT & vnicc;
2287 	return true;
2288 }
2289 
2290 /* (re-)initialize VNICC */
2291 static void qeth_l2_vnicc_init(struct qeth_card *card)
2292 {
2293 	u32 *timeout = &card->options.vnicc.learning_timeout;
2294 	unsigned int chars_len, i;
2295 	unsigned long chars_tmp;
2296 	u32 sup_cmds, vnicc;
2297 	bool enable, error;
2298 
2299 	QETH_CARD_TEXT(card, 2, "vniccini");
2300 	/* reset rx_bcast */
2301 	card->options.vnicc.rx_bcast_enabled = 0;
2302 	/* initial query and storage of VNIC characteristics */
2303 	if (qeth_l2_vnicc_query_chars(card)) {
2304 		if (card->options.vnicc.wanted_chars != QETH_VNICC_DEFAULT ||
2305 		    *timeout != QETH_VNICC_DEFAULT_TIMEOUT)
2306 			dev_err(&card->gdev->dev, "Configuring the VNIC characteristics failed\n");
2307 		/* fail quietly if user didn't change the default config */
2308 		card->options.vnicc.sup_chars = 0;
2309 		card->options.vnicc.cur_chars = 0;
2310 		card->options.vnicc.wanted_chars = QETH_VNICC_DEFAULT;
2311 		return;
2312 	}
2313 	/* get supported commands for each supported characteristic */
2314 	chars_tmp = card->options.vnicc.sup_chars;
2315 	chars_len = sizeof(card->options.vnicc.sup_chars) * BITS_PER_BYTE;
2316 	for_each_set_bit(i, &chars_tmp, chars_len) {
2317 		vnicc = BIT(i);
2318 		qeth_l2_vnicc_query_cmds(card, vnicc, &sup_cmds);
2319 		if (!(sup_cmds & IPA_VNICC_SET_TIMEOUT) ||
2320 		    !(sup_cmds & IPA_VNICC_GET_TIMEOUT))
2321 			card->options.vnicc.getset_timeout_sup &= ~vnicc;
2322 		if (!(sup_cmds & IPA_VNICC_ENABLE) ||
2323 		    !(sup_cmds & IPA_VNICC_DISABLE))
2324 			card->options.vnicc.set_char_sup &= ~vnicc;
2325 	}
2326 	/* enforce assumed default values and recover settings, if changed  */
2327 	error = qeth_l2_vnicc_recover_timeout(card, QETH_VNICC_LEARNING,
2328 					      timeout);
2329 	chars_tmp = card->options.vnicc.wanted_chars ^ QETH_VNICC_DEFAULT;
2330 	chars_tmp |= QETH_VNICC_BRIDGE_INVISIBLE;
2331 	chars_len = sizeof(card->options.vnicc.wanted_chars) * BITS_PER_BYTE;
2332 	for_each_set_bit(i, &chars_tmp, chars_len) {
2333 		vnicc = BIT(i);
2334 		enable = card->options.vnicc.wanted_chars & vnicc;
2335 		error |= qeth_l2_vnicc_recover_char(card, vnicc, enable);
2336 	}
2337 	if (error)
2338 		dev_err(&card->gdev->dev, "Configuring the VNIC characteristics failed\n");
2339 }
2340 
2341 /* configure default values of VNIC characteristics */
2342 static void qeth_l2_vnicc_set_defaults(struct qeth_card *card)
2343 {
2344 	/* characteristics values */
2345 	card->options.vnicc.sup_chars = QETH_VNICC_ALL;
2346 	card->options.vnicc.cur_chars = QETH_VNICC_DEFAULT;
2347 	card->options.vnicc.learning_timeout = QETH_VNICC_DEFAULT_TIMEOUT;
2348 	/* supported commands */
2349 	card->options.vnicc.set_char_sup = QETH_VNICC_ALL;
2350 	card->options.vnicc.getset_timeout_sup = QETH_VNICC_LEARNING;
2351 	/* settings wanted by users */
2352 	card->options.vnicc.wanted_chars = QETH_VNICC_DEFAULT;
2353 }
2354 
2355 module_init(qeth_l2_init);
2356 module_exit(qeth_l2_exit);
2357 MODULE_AUTHOR("Frank Blaschka <frank.blaschka@de.ibm.com>");
2358 MODULE_DESCRIPTION("qeth layer 2 discipline");
2359 MODULE_LICENSE("GPL");
2360