?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
treewide: remove redundant IS_ERR() before error code check
[linux/fpc-iii.git] / drivers / s390 / net / qeth_l2_main.c
blob692bd26234018f2a260fa16d3085616390a6fab9
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 void qeth_bridgeport_query_support(struct qeth_card *card);
28 static void qeth_bridge_state_change(struct qeth_card *card,
29 struct qeth_ipa_cmd *cmd);
30 static void qeth_bridge_host_event(struct qeth_card *card,
31 struct qeth_ipa_cmd *cmd);
32 static void qeth_l2_vnicc_set_defaults(struct qeth_card *card);
33 static void qeth_l2_vnicc_init(struct qeth_card *card);
34 static bool qeth_l2_vnicc_recover_timeout(struct qeth_card *card, u32 vnicc,
35 u32 *timeout);
36
37 static int qeth_l2_setdelmac_makerc(struct qeth_card *card, u16 retcode)
38 {
39 int rc;
40
41 if (retcode)
42 QETH_CARD_TEXT_(card, 2, "err%04x", retcode);
43 switch (retcode) {
44 case IPA_RC_SUCCESS:
45 rc = 0;
46 break;
47 case IPA_RC_L2_UNSUPPORTED_CMD:
48 rc = -EOPNOTSUPP;
49 break;
50 case IPA_RC_L2_ADDR_TABLE_FULL:
51 rc = -ENOSPC;
52 break;
53 case IPA_RC_L2_DUP_MAC:
54 case IPA_RC_L2_DUP_LAYER3_MAC:
55 rc = -EEXIST;
56 break;
57 case IPA_RC_L2_MAC_NOT_AUTH_BY_HYP:
58 case IPA_RC_L2_MAC_NOT_AUTH_BY_ADP:
59 rc = -EPERM;
60 break;
61 case IPA_RC_L2_MAC_NOT_FOUND:
62 rc = -ENOENT;
63 break;
64 default:
65 rc = -EIO;
66 break;
67 }
68 return rc;
69 }
70
71 static int qeth_l2_send_setdelmac_cb(struct qeth_card *card,
72 struct qeth_reply *reply,
73 unsigned long data)
74 {
75 struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *) data;
76
77 return qeth_l2_setdelmac_makerc(card, cmd->hdr.return_code);
78 }
79
80 static int qeth_l2_send_setdelmac(struct qeth_card *card, __u8 *mac,
81 enum qeth_ipa_cmds ipacmd)
82 {
83 struct qeth_ipa_cmd *cmd;
84 struct qeth_cmd_buffer *iob;
85
86 QETH_CARD_TEXT(card, 2, "L2sdmac");
87 iob = qeth_ipa_alloc_cmd(card, ipacmd, QETH_PROT_IPV4,
88 IPA_DATA_SIZEOF(setdelmac));
89 if (!iob)
90 return -ENOMEM;
91 cmd = __ipa_cmd(iob);
92 cmd->data.setdelmac.mac_length = ETH_ALEN;
93 ether_addr_copy(cmd->data.setdelmac.mac, mac);
94 return qeth_send_ipa_cmd(card, iob, qeth_l2_send_setdelmac_cb, NULL);
95 }
96
97 static int qeth_l2_send_setmac(struct qeth_card *card, __u8 *mac)
98 {
99 int rc;
100
101 QETH_CARD_TEXT(card, 2, "L2Setmac");
102 rc = qeth_l2_send_setdelmac(card, mac, IPA_CMD_SETVMAC);
103 if (rc == 0) {
104 dev_info(&card->gdev->dev,
105 "MAC address %pM successfully registered\n", mac);
106 } else {
107 switch (rc) {
108 case -EEXIST:
109 dev_warn(&card->gdev->dev,
110 "MAC address %pM already exists\n", mac);
111 break;
112 case -EPERM:
113 dev_warn(&card->gdev->dev,
114 "MAC address %pM is not authorized\n", mac);
115 break;
116 }
117 }
118 return rc;
119 }
120
121 static int qeth_l2_write_mac(struct qeth_card *card, u8 *mac)
122 {
123 enum qeth_ipa_cmds cmd = is_multicast_ether_addr(mac) ?
124 IPA_CMD_SETGMAC : IPA_CMD_SETVMAC;
125 int rc;
126
127 QETH_CARD_TEXT(card, 2, "L2Wmac");
128 rc = qeth_l2_send_setdelmac(card, mac, cmd);
129 if (rc == -EEXIST)
130 QETH_DBF_MESSAGE(2, "MAC already registered on device %x\n",
131 CARD_DEVID(card));
132 else if (rc)
133 QETH_DBF_MESSAGE(2, "Failed to register MAC on device %x: %d\n",
134 CARD_DEVID(card), rc);
135 return rc;
136 }
137
138 static int qeth_l2_remove_mac(struct qeth_card *card, u8 *mac)
139 {
140 enum qeth_ipa_cmds cmd = is_multicast_ether_addr(mac) ?
141 IPA_CMD_DELGMAC : IPA_CMD_DELVMAC;
142 int rc;
143
144 QETH_CARD_TEXT(card, 2, "L2Rmac");
145 rc = qeth_l2_send_setdelmac(card, mac, cmd);
146 if (rc)
147 QETH_DBF_MESSAGE(2, "Failed to delete MAC on device %u: %d\n",
148 CARD_DEVID(card), rc);
149 return rc;
150 }
151
152 static void qeth_l2_drain_rx_mode_cache(struct qeth_card *card)
153 {
154 struct qeth_mac *mac;
155 struct hlist_node *tmp;
156 int i;
157
158 hash_for_each_safe(card->mac_htable, i, tmp, mac, hnode) {
159 hash_del(&mac->hnode);
160 kfree(mac);
161 }
162 }
163
164 static void qeth_l2_fill_header(struct qeth_qdio_out_q *queue,
165 struct qeth_hdr *hdr, struct sk_buff *skb,
166 int ipv, unsigned int data_len)
167 {
168 int cast_type = qeth_get_ether_cast_type(skb);
169 struct vlan_ethhdr *veth = vlan_eth_hdr(skb);
170
171 hdr->hdr.l2.pkt_length = data_len;
172
173 if (skb_is_gso(skb)) {
174 hdr->hdr.l2.id = QETH_HEADER_TYPE_L2_TSO;
175 } else {
176 hdr->hdr.l2.id = QETH_HEADER_TYPE_LAYER2;
177 if (skb->ip_summed == CHECKSUM_PARTIAL)
178 qeth_tx_csum(skb, &hdr->hdr.l2.flags[1], ipv);
179 }
180
181 /* set byte byte 3 to casting flags */
182 if (cast_type == RTN_MULTICAST)
183 hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_MULTICAST;
184 else if (cast_type == RTN_BROADCAST)
185 hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_BROADCAST;
186 else
187 hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_UNICAST;
188
189 /* VSWITCH relies on the VLAN
190 * information to be present in
191 * the QDIO header */
192 if (veth->h_vlan_proto == __constant_htons(ETH_P_8021Q)) {
193 hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_VLAN;
194 hdr->hdr.l2.vlan_id = ntohs(veth->h_vlan_TCI);
195 }
196 }
197
198 static int qeth_l2_setdelvlan_makerc(struct qeth_card *card, u16 retcode)
199 {
200 if (retcode)
201 QETH_CARD_TEXT_(card, 2, "err%04x", retcode);
202
203 switch (retcode) {
204 case IPA_RC_SUCCESS:
205 return 0;
206 case IPA_RC_L2_INVALID_VLAN_ID:
207 return -EINVAL;
208 case IPA_RC_L2_DUP_VLAN_ID:
209 return -EEXIST;
210 case IPA_RC_L2_VLAN_ID_NOT_FOUND:
211 return -ENOENT;
212 case IPA_RC_L2_VLAN_ID_NOT_ALLOWED:
213 return -EPERM;
214 default:
215 return -EIO;
216 }
217 }
218
219 static int qeth_l2_send_setdelvlan_cb(struct qeth_card *card,
220 struct qeth_reply *reply,
221 unsigned long data)
222 {
223 struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *) data;
224
225 QETH_CARD_TEXT(card, 2, "L2sdvcb");
226 if (cmd->hdr.return_code) {
227 QETH_DBF_MESSAGE(2, "Error in processing VLAN %u on device %x: %#x.\n",
228 cmd->data.setdelvlan.vlan_id,
229 CARD_DEVID(card), cmd->hdr.return_code);
230 QETH_CARD_TEXT_(card, 2, "L2VL%4x", cmd->hdr.command);
231 }
232 return qeth_l2_setdelvlan_makerc(card, cmd->hdr.return_code);
233 }
234
235 static int qeth_l2_send_setdelvlan(struct qeth_card *card, __u16 i,
236 enum qeth_ipa_cmds ipacmd)
237 {
238 struct qeth_ipa_cmd *cmd;
239 struct qeth_cmd_buffer *iob;
240
241 QETH_CARD_TEXT_(card, 4, "L2sdv%x", ipacmd);
242 iob = qeth_ipa_alloc_cmd(card, ipacmd, QETH_PROT_IPV4,
243 IPA_DATA_SIZEOF(setdelvlan));
244 if (!iob)
245 return -ENOMEM;
246 cmd = __ipa_cmd(iob);
247 cmd->data.setdelvlan.vlan_id = i;
248 return qeth_send_ipa_cmd(card, iob, qeth_l2_send_setdelvlan_cb, NULL);
249 }
250
251 static int qeth_l2_vlan_rx_add_vid(struct net_device *dev,
252 __be16 proto, u16 vid)
253 {
254 struct qeth_card *card = dev->ml_priv;
255
256 QETH_CARD_TEXT_(card, 4, "aid:%d", vid);
257 if (!vid)
258 return 0;
259
260 return qeth_l2_send_setdelvlan(card, vid, IPA_CMD_SETVLAN);
261 }
262
263 static int qeth_l2_vlan_rx_kill_vid(struct net_device *dev,
264 __be16 proto, u16 vid)
265 {
266 struct qeth_card *card = dev->ml_priv;
267
268 QETH_CARD_TEXT_(card, 4, "kid:%d", vid);
269 if (!vid)
270 return 0;
271
272 return qeth_l2_send_setdelvlan(card, vid, IPA_CMD_DELVLAN);
273 }
274
275 static void qeth_l2_stop_card(struct qeth_card *card)
276 {
277 QETH_CARD_TEXT(card, 2, "stopcard");
278
279 qeth_set_allowed_threads(card, 0, 1);
280
281 cancel_work_sync(&card->rx_mode_work);
282 qeth_l2_drain_rx_mode_cache(card);
283
284 if (card->state == CARD_STATE_SOFTSETUP) {
285 qeth_clear_ipacmd_list(card);
286 qeth_drain_output_queues(card);
287 card->state = CARD_STATE_DOWN;
288 }
289
290 qeth_qdio_clear_card(card, 0);
291 qeth_clear_working_pool_list(card);
292 flush_workqueue(card->event_wq);
293 card->info.mac_bits &= ~QETH_LAYER2_MAC_REGISTERED;
294 card->info.promisc_mode = 0;
295 }
296
297 static int qeth_l2_request_initial_mac(struct qeth_card *card)
298 {
299 int rc = 0;
300
301 QETH_CARD_TEXT(card, 2, "l2reqmac");
302
303 if (MACHINE_IS_VM) {
304 rc = qeth_vm_request_mac(card);
305 if (!rc)
306 goto out;
307 QETH_DBF_MESSAGE(2, "z/VM MAC Service failed on device %x: %#x\n",
308 CARD_DEVID(card), rc);
309 QETH_CARD_TEXT_(card, 2, "err%04x", rc);
310 /* fall back to alternative mechanism: */
311 }
312
313 if (!IS_OSN(card)) {
314 rc = qeth_setadpparms_change_macaddr(card);
315 if (!rc)
316 goto out;
317 QETH_DBF_MESSAGE(2, "READ_MAC Assist failed on device %x: %#x\n",
318 CARD_DEVID(card), rc);
319 QETH_CARD_TEXT_(card, 2, "1err%04x", rc);
320 /* fall back once more: */
321 }
322
323 /* some devices don't support a custom MAC address: */
324 if (IS_OSM(card) || IS_OSX(card))
325 return (rc) ? rc : -EADDRNOTAVAIL;
326 eth_hw_addr_random(card->dev);
327
328 out:
329 QETH_CARD_HEX(card, 2, card->dev->dev_addr, card->dev->addr_len);
330 return 0;
331 }
332
333 static void qeth_l2_register_dev_addr(struct qeth_card *card)
334 {
335 if (!is_valid_ether_addr(card->dev->dev_addr))
336 qeth_l2_request_initial_mac(card);
337
338 if (!IS_OSN(card) && !qeth_l2_send_setmac(card, card->dev->dev_addr))
339 card->info.mac_bits |= QETH_LAYER2_MAC_REGISTERED;
340 }
341
342 static int qeth_l2_validate_addr(struct net_device *dev)
343 {
344 struct qeth_card *card = dev->ml_priv;
345
346 if (card->info.mac_bits & QETH_LAYER2_MAC_REGISTERED)
347 return eth_validate_addr(dev);
348
349 QETH_CARD_TEXT(card, 4, "nomacadr");
350 return -EPERM;
351 }
352
353 static int qeth_l2_set_mac_address(struct net_device *dev, void *p)
354 {
355 struct sockaddr *addr = p;
356 struct qeth_card *card = dev->ml_priv;
357 u8 old_addr[ETH_ALEN];
358 int rc = 0;
359
360 QETH_CARD_TEXT(card, 3, "setmac");
361
362 if (IS_OSM(card) || IS_OSX(card)) {
363 QETH_CARD_TEXT(card, 3, "setmcTYP");
364 return -EOPNOTSUPP;
365 }
366 QETH_CARD_HEX(card, 3, addr->sa_data, ETH_ALEN);
367 if (!is_valid_ether_addr(addr->sa_data))
368 return -EADDRNOTAVAIL;
369
370 /* don't register the same address twice */
371 if (ether_addr_equal_64bits(dev->dev_addr, addr->sa_data) &&
372 (card->info.mac_bits & QETH_LAYER2_MAC_REGISTERED))
373 return 0;
374
375 /* add the new address, switch over, drop the old */
376 rc = qeth_l2_send_setmac(card, addr->sa_data);
377 if (rc)
378 return rc;
379 ether_addr_copy(old_addr, dev->dev_addr);
380 ether_addr_copy(dev->dev_addr, addr->sa_data);
381
382 if (card->info.mac_bits & QETH_LAYER2_MAC_REGISTERED)
383 qeth_l2_remove_mac(card, old_addr);
384 card->info.mac_bits |= QETH_LAYER2_MAC_REGISTERED;
385 return 0;
386 }
387
388 static void qeth_l2_promisc_to_bridge(struct qeth_card *card, bool enable)
389 {
390 int role;
391 int rc;
392
393 QETH_CARD_TEXT(card, 3, "pmisc2br");
394
395 if (enable) {
396 if (card->options.sbp.reflect_promisc_primary)
397 role = QETH_SBP_ROLE_PRIMARY;
398 else
399 role = QETH_SBP_ROLE_SECONDARY;
400 } else
401 role = QETH_SBP_ROLE_NONE;
402
403 rc = qeth_bridgeport_setrole(card, role);
404 QETH_CARD_TEXT_(card, 2, "bpm%c%04x", enable ? '+' : '-', rc);
405 if (!rc) {
406 card->options.sbp.role = role;
407 card->info.promisc_mode = enable;
408 }
409 }
410
411 static void qeth_l2_set_promisc_mode(struct qeth_card *card)
412 {
413 bool enable = card->dev->flags & IFF_PROMISC;
414
415 if (card->info.promisc_mode == enable)
416 return;
417
418 if (qeth_adp_supported(card, IPA_SETADP_SET_PROMISC_MODE)) {
419 qeth_setadp_promisc_mode(card, enable);
420 } else {
421 mutex_lock(&card->sbp_lock);
422 if (card->options.sbp.reflect_promisc)
423 qeth_l2_promisc_to_bridge(card, enable);
424 mutex_unlock(&card->sbp_lock);
425 }
426 }
427
428 /* New MAC address is added to the hash table and marked to be written on card
429 * only if there is not in the hash table storage already
430 *
431 */
432 static void qeth_l2_add_mac(struct qeth_card *card, struct netdev_hw_addr *ha)
433 {
434 u32 mac_hash = get_unaligned((u32 *)(&ha->addr[2]));
435 struct qeth_mac *mac;
436
437 hash_for_each_possible(card->mac_htable, mac, hnode, mac_hash) {
438 if (ether_addr_equal_64bits(ha->addr, mac->mac_addr)) {
439 mac->disp_flag = QETH_DISP_ADDR_DO_NOTHING;
440 return;
441 }
442 }
443
444 mac = kzalloc(sizeof(struct qeth_mac), GFP_ATOMIC);
445 if (!mac)
446 return;
447
448 ether_addr_copy(mac->mac_addr, ha->addr);
449 mac->disp_flag = QETH_DISP_ADDR_ADD;
450
451 hash_add(card->mac_htable, &mac->hnode, mac_hash);
452 }
453
454 static void qeth_l2_rx_mode_work(struct work_struct *work)
455 {
456 struct qeth_card *card = container_of(work, struct qeth_card,
457 rx_mode_work);
458 struct net_device *dev = card->dev;
459 struct netdev_hw_addr *ha;
460 struct qeth_mac *mac;
461 struct hlist_node *tmp;
462 int i;
463 int rc;
464
465 QETH_CARD_TEXT(card, 3, "setmulti");
466
467 netif_addr_lock_bh(dev);
468 netdev_for_each_mc_addr(ha, dev)
469 qeth_l2_add_mac(card, ha);
470 netdev_for_each_uc_addr(ha, dev)
471 qeth_l2_add_mac(card, ha);
472 netif_addr_unlock_bh(dev);
473
474 hash_for_each_safe(card->mac_htable, i, tmp, mac, hnode) {
475 switch (mac->disp_flag) {
476 case QETH_DISP_ADDR_DELETE:
477 qeth_l2_remove_mac(card, mac->mac_addr);
478 hash_del(&mac->hnode);
479 kfree(mac);
480 break;
481 case QETH_DISP_ADDR_ADD:
482 rc = qeth_l2_write_mac(card, mac->mac_addr);
483 if (rc) {
484 hash_del(&mac->hnode);
485 kfree(mac);
486 break;
487 }
488 /* fall through */
489 default:
490 /* for next call to set_rx_mode(): */
491 mac->disp_flag = QETH_DISP_ADDR_DELETE;
492 }
493 }
494
495 qeth_l2_set_promisc_mode(card);
496 }
497
498 static int qeth_l2_xmit_osn(struct qeth_card *card, struct sk_buff *skb,
499 struct qeth_qdio_out_q *queue)
500 {
501 struct qeth_hdr *hdr = (struct qeth_hdr *)skb->data;
502 addr_t end = (addr_t)(skb->data + sizeof(*hdr));
503 addr_t start = (addr_t)skb->data;
504 unsigned int elements = 0;
505 unsigned int hd_len = 0;
506 int rc;
507
508 if (skb->protocol == htons(ETH_P_IPV6))
509 return -EPROTONOSUPPORT;
510
511 if (qeth_get_elements_for_range(start, end) > 1) {
512 /* Misaligned HW header, move it to its own buffer element. */
513 hdr = kmem_cache_alloc(qeth_core_header_cache, GFP_ATOMIC);
514 if (!hdr)
515 return -ENOMEM;
516 hd_len = sizeof(*hdr);
517 skb_copy_from_linear_data(skb, (char *)hdr, hd_len);
518 elements++;
519 }
520
521 elements += qeth_count_elements(skb, hd_len);
522 if (elements > queue->max_elements) {
523 rc = -E2BIG;
524 goto out;
525 }
526
527 rc = qeth_do_send_packet(card, queue, skb, hdr, hd_len, hd_len,
528 elements);
529 out:
530 if (rc && hd_len)
531 kmem_cache_free(qeth_core_header_cache, hdr);
532 return rc;
533 }
534
535 static netdev_tx_t qeth_l2_hard_start_xmit(struct sk_buff *skb,
536 struct net_device *dev)
537 {
538 struct qeth_card *card = dev->ml_priv;
539 u16 txq = skb_get_queue_mapping(skb);
540 struct qeth_qdio_out_q *queue;
541 int rc;
542
543 if (!skb_is_gso(skb))
544 qdisc_skb_cb(skb)->pkt_len = skb->len;
545 if (IS_IQD(card))
546 txq = qeth_iqd_translate_txq(dev, txq);
547 queue = card->qdio.out_qs[txq];
548
549 if (IS_OSN(card))
550 rc = qeth_l2_xmit_osn(card, skb, queue);
551 else
552 rc = qeth_xmit(card, skb, queue, qeth_get_ip_version(skb),
553 qeth_l2_fill_header);
554
555 if (!rc)
556 return NETDEV_TX_OK;
557
558 QETH_TXQ_STAT_INC(queue, tx_dropped);
559 kfree_skb(skb);
560 return NETDEV_TX_OK;
561 }
562
563 static u16 qeth_l2_select_queue(struct net_device *dev, struct sk_buff *skb,
564 struct net_device *sb_dev)
565 {
566 struct qeth_card *card = dev->ml_priv;
567
568 if (IS_IQD(card))
569 return qeth_iqd_select_queue(dev, skb,
570 qeth_get_ether_cast_type(skb),
571 sb_dev);
572 return qeth_get_priority_queue(card, skb);
573 }
574
575 static const struct device_type qeth_l2_devtype = {
576 .name = "qeth_layer2",
577 .groups = qeth_l2_attr_groups,
578 };
579
580 static int qeth_l2_probe_device(struct ccwgroup_device *gdev)
581 {
582 struct qeth_card *card = dev_get_drvdata(&gdev->dev);
583 int rc;
584
585 qeth_l2_vnicc_set_defaults(card);
586 mutex_init(&card->sbp_lock);
587
588 if (gdev->dev.type == &qeth_generic_devtype) {
589 rc = qeth_l2_create_device_attributes(&gdev->dev);
590 if (rc)
591 return rc;
592 }
593
594 hash_init(card->mac_htable);
595 INIT_WORK(&card->rx_mode_work, qeth_l2_rx_mode_work);
596 return 0;
597 }
598
599 static void qeth_l2_remove_device(struct ccwgroup_device *cgdev)
600 {
601 struct qeth_card *card = dev_get_drvdata(&cgdev->dev);
602
603 if (cgdev->dev.type == &qeth_generic_devtype)
604 qeth_l2_remove_device_attributes(&cgdev->dev);
605 qeth_set_allowed_threads(card, 0, 1);
606 wait_event(card->wait_q, qeth_threads_running(card, 0xffffffff) == 0);
607
608 if (cgdev->state == CCWGROUP_ONLINE)
609 qeth_set_offline(card, false);
610
611 cancel_work_sync(&card->close_dev_work);
612 if (qeth_netdev_is_registered(card->dev))
613 unregister_netdev(card->dev);
614 }
615
616 static void qeth_l2_set_rx_mode(struct net_device *dev)
617 {
618 struct qeth_card *card = dev->ml_priv;
619
620 schedule_work(&card->rx_mode_work);
621 }
622
623 static const struct net_device_ops qeth_l2_netdev_ops = {
624 .ndo_open = qeth_open,
625 .ndo_stop = qeth_stop,
626 .ndo_get_stats64 = qeth_get_stats64,
627 .ndo_start_xmit = qeth_l2_hard_start_xmit,
628 .ndo_features_check = qeth_features_check,
629 .ndo_select_queue = qeth_l2_select_queue,
630 .ndo_validate_addr = qeth_l2_validate_addr,
631 .ndo_set_rx_mode = qeth_l2_set_rx_mode,
632 .ndo_do_ioctl = qeth_do_ioctl,
633 .ndo_set_mac_address = qeth_l2_set_mac_address,
634 .ndo_vlan_rx_add_vid = qeth_l2_vlan_rx_add_vid,
635 .ndo_vlan_rx_kill_vid = qeth_l2_vlan_rx_kill_vid,
636 .ndo_tx_timeout = qeth_tx_timeout,
637 .ndo_fix_features = qeth_fix_features,
638 .ndo_set_features = qeth_set_features
639 };
640
641 static const struct net_device_ops qeth_osn_netdev_ops = {
642 .ndo_open = qeth_open,
643 .ndo_stop = qeth_stop,
644 .ndo_get_stats64 = qeth_get_stats64,
645 .ndo_start_xmit = qeth_l2_hard_start_xmit,
646 .ndo_validate_addr = eth_validate_addr,
647 .ndo_tx_timeout = qeth_tx_timeout,
648 };
649
650 static int qeth_l2_setup_netdev(struct qeth_card *card, bool carrier_ok)
651 {
652 int rc;
653
654 if (IS_OSN(card)) {
655 card->dev->netdev_ops = &qeth_osn_netdev_ops;
656 card->dev->flags |= IFF_NOARP;
657 goto add_napi;
658 }
659
660 card->dev->needed_headroom = sizeof(struct qeth_hdr);
661 card->dev->netdev_ops = &qeth_l2_netdev_ops;
662 card->dev->priv_flags |= IFF_UNICAST_FLT;
663
664 if (IS_OSM(card)) {
665 card->dev->features |= NETIF_F_VLAN_CHALLENGED;
666 } else {
667 if (!IS_VM_NIC(card))
668 card->dev->hw_features |= NETIF_F_HW_VLAN_CTAG_FILTER;
669 card->dev->features |= NETIF_F_HW_VLAN_CTAG_FILTER;
670 }
671
672 if (IS_OSD(card) && !IS_VM_NIC(card)) {
673 card->dev->features |= NETIF_F_SG;
674 /* OSA 3S and earlier has no RX/TX support */
675 if (qeth_is_supported(card, IPA_OUTBOUND_CHECKSUM)) {
676 card->dev->hw_features |= NETIF_F_IP_CSUM;
677 card->dev->vlan_features |= NETIF_F_IP_CSUM;
678 }
679 }
680 if (qeth_is_supported6(card, IPA_OUTBOUND_CHECKSUM_V6)) {
681 card->dev->hw_features |= NETIF_F_IPV6_CSUM;
682 card->dev->vlan_features |= NETIF_F_IPV6_CSUM;
683 }
684 if (qeth_is_supported(card, IPA_INBOUND_CHECKSUM) ||
685 qeth_is_supported6(card, IPA_INBOUND_CHECKSUM_V6)) {
686 card->dev->hw_features |= NETIF_F_RXCSUM;
687 card->dev->vlan_features |= NETIF_F_RXCSUM;
688 }
689 if (qeth_is_supported(card, IPA_OUTBOUND_TSO)) {
690 card->dev->hw_features |= NETIF_F_TSO;
691 card->dev->vlan_features |= NETIF_F_TSO;
692 }
693 if (qeth_is_supported6(card, IPA_OUTBOUND_TSO)) {
694 card->dev->hw_features |= NETIF_F_TSO6;
695 card->dev->vlan_features |= NETIF_F_TSO6;
696 }
697
698 if (card->dev->hw_features & (NETIF_F_TSO | NETIF_F_TSO6)) {
699 card->dev->needed_headroom = sizeof(struct qeth_hdr_tso);
700 netif_set_gso_max_size(card->dev,
701 PAGE_SIZE * (QDIO_MAX_ELEMENTS_PER_BUFFER - 1));
702 }
703
704 add_napi:
705 netif_napi_add(card->dev, &card->napi, qeth_poll, QETH_NAPI_WEIGHT);
706 rc = register_netdev(card->dev);
707 if (!rc && carrier_ok)
708 netif_carrier_on(card->dev);
709
710 if (rc)
711 card->dev->netdev_ops = NULL;
712 return rc;
713 }
714
715 static void qeth_l2_trace_features(struct qeth_card *card)
716 {
717 /* Set BridgePort features */
718 QETH_CARD_TEXT(card, 2, "featuSBP");
719 QETH_CARD_HEX(card, 2, &card->options.sbp.supported_funcs,
720 sizeof(card->options.sbp.supported_funcs));
721 /* VNIC Characteristics features */
722 QETH_CARD_TEXT(card, 2, "feaVNICC");
723 QETH_CARD_HEX(card, 2, &card->options.vnicc.sup_chars,
724 sizeof(card->options.vnicc.sup_chars));
725 }
726
727 static void qeth_l2_setup_bridgeport_attrs(struct qeth_card *card)
728 {
729 if (!card->options.sbp.reflect_promisc &&
730 card->options.sbp.role != QETH_SBP_ROLE_NONE) {
731 /* Conditional to avoid spurious error messages */
732 qeth_bridgeport_setrole(card, card->options.sbp.role);
733 /* Let the callback function refresh the stored role value. */
734 qeth_bridgeport_query_ports(card, &card->options.sbp.role,
735 NULL);
736 }
737 if (card->options.sbp.hostnotification) {
738 if (qeth_bridgeport_an_set(card, 1))
739 card->options.sbp.hostnotification = 0;
740 } else {
741 qeth_bridgeport_an_set(card, 0);
742 }
743 }
744
745 static int qeth_l2_set_online(struct qeth_card *card)
746 {
747 struct ccwgroup_device *gdev = card->gdev;
748 struct net_device *dev = card->dev;
749 int rc = 0;
750 bool carrier_ok;
751
752 rc = qeth_core_hardsetup_card(card, &carrier_ok);
753 if (rc) {
754 QETH_CARD_TEXT_(card, 2, "2err%04x", rc);
755 rc = -ENODEV;
756 goto out_remove;
757 }
758
759 mutex_lock(&card->sbp_lock);
760 qeth_bridgeport_query_support(card);
761 if (card->options.sbp.supported_funcs) {
762 qeth_l2_setup_bridgeport_attrs(card);
763 dev_info(&card->gdev->dev,
764 "The device represents a Bridge Capable Port\n");
765 }
766 mutex_unlock(&card->sbp_lock);
767
768 qeth_l2_register_dev_addr(card);
769
770 /* for the rx_bcast characteristic, init VNICC after setmac */
771 qeth_l2_vnicc_init(card);
772
773 qeth_trace_features(card);
774 qeth_l2_trace_features(card);
775
776 qeth_print_status_message(card);
777
778 /* softsetup */
779 QETH_CARD_TEXT(card, 2, "softsetp");
780
781 card->state = CARD_STATE_SOFTSETUP;
782
783 qeth_set_allowed_threads(card, 0xffffffff, 0);
784
785 if (!qeth_netdev_is_registered(dev)) {
786 rc = qeth_l2_setup_netdev(card, carrier_ok);
787 if (rc)
788 goto out_remove;
789 } else {
790 rtnl_lock();
791 if (carrier_ok)
792 netif_carrier_on(dev);
793 else
794 netif_carrier_off(dev);
795
796 netif_device_attach(dev);
797 qeth_enable_hw_features(dev);
798
799 if (card->info.open_when_online) {
800 card->info.open_when_online = 0;
801 dev_open(dev, NULL);
802 }
803 rtnl_unlock();
804 }
805 /* let user_space know that device is online */
806 kobject_uevent(&gdev->dev.kobj, KOBJ_CHANGE);
807 return 0;
808
809 out_remove:
810 qeth_l2_stop_card(card);
811 qeth_stop_channel(&card->data);
812 qeth_stop_channel(&card->write);
813 qeth_stop_channel(&card->read);
814 qdio_free(CARD_DDEV(card));
815 return rc;
816 }
817
818 static void qeth_l2_set_offline(struct qeth_card *card)
819 {
820 qeth_l2_stop_card(card);
821 }
822
823 static int __init qeth_l2_init(void)
824 {
825 pr_info("register layer 2 discipline\n");
826 return 0;
827 }
828
829 static void __exit qeth_l2_exit(void)
830 {
831 pr_info("unregister layer 2 discipline\n");
832 }
833
834 /* Returns zero if the command is successfully "consumed" */
835 static int qeth_l2_control_event(struct qeth_card *card,
836 struct qeth_ipa_cmd *cmd)
837 {
838 switch (cmd->hdr.command) {
839 case IPA_CMD_SETBRIDGEPORT_OSA:
840 case IPA_CMD_SETBRIDGEPORT_IQD:
841 if (cmd->data.sbp.hdr.command_code ==
842 IPA_SBP_BRIDGE_PORT_STATE_CHANGE) {
843 qeth_bridge_state_change(card, cmd);
844 return 0;
845 } else
846 return 1;
847 case IPA_CMD_ADDRESS_CHANGE_NOTIF:
848 qeth_bridge_host_event(card, cmd);
849 return 0;
850 default:
851 return 1;
852 }
853 }
854
855 struct qeth_discipline qeth_l2_discipline = {
856 .devtype = &qeth_l2_devtype,
857 .setup = qeth_l2_probe_device,
858 .remove = qeth_l2_remove_device,
859 .set_online = qeth_l2_set_online,
860 .set_offline = qeth_l2_set_offline,
861 .do_ioctl = NULL,
862 .control_event_handler = qeth_l2_control_event,
863 };
864 EXPORT_SYMBOL_GPL(qeth_l2_discipline);
865
866 static void qeth_osn_assist_cb(struct qeth_card *card,
867 struct qeth_cmd_buffer *iob,
868 unsigned int data_length)
869 {
870 qeth_notify_cmd(iob, 0);
871 qeth_put_cmd(iob);
872 }
873
874 int qeth_osn_assist(struct net_device *dev, void *data, int data_len)
875 {
876 struct qeth_cmd_buffer *iob;
877 struct qeth_card *card;
878
879 if (data_len < 0)
880 return -EINVAL;
881 if (!dev)
882 return -ENODEV;
883 card = dev->ml_priv;
884 if (!card)
885 return -ENODEV;
886 QETH_CARD_TEXT(card, 2, "osnsdmc");
887 if (!qeth_card_hw_is_reachable(card))
888 return -ENODEV;
889
890 iob = qeth_alloc_cmd(&card->write, IPA_PDU_HEADER_SIZE + data_len, 1,
891 QETH_IPA_TIMEOUT);
892 if (!iob)
893 return -ENOMEM;
894
895 qeth_prepare_ipa_cmd(card, iob, (u16) data_len, NULL);
896
897 memcpy(__ipa_cmd(iob), data, data_len);
898 iob->callback = qeth_osn_assist_cb;
899 return qeth_send_ipa_cmd(card, iob, NULL, NULL);
900 }
901 EXPORT_SYMBOL(qeth_osn_assist);
902
903 int qeth_osn_register(unsigned char *read_dev_no, struct net_device **dev,
904 int (*assist_cb)(struct net_device *, void *),
905 int (*data_cb)(struct sk_buff *))
906 {
907 struct qeth_card *card;
908 char bus_id[16];
909 u16 devno;
910
911 memcpy(&devno, read_dev_no, 2);
912 sprintf(bus_id, "0.0.%04x", devno);
913 card = qeth_get_card_by_busid(bus_id);
914 if (!card || !IS_OSN(card))
915 return -ENODEV;
916 *dev = card->dev;
917
918 QETH_CARD_TEXT(card, 2, "osnreg");
919 if ((assist_cb == NULL) || (data_cb == NULL))
920 return -EINVAL;
921 card->osn_info.assist_cb = assist_cb;
922 card->osn_info.data_cb = data_cb;
923 return 0;
924 }
925 EXPORT_SYMBOL(qeth_osn_register);
926
927 void qeth_osn_deregister(struct net_device *dev)
928 {
929 struct qeth_card *card;
930
931 if (!dev)
932 return;
933 card = dev->ml_priv;
934 if (!card)
935 return;
936 QETH_CARD_TEXT(card, 2, "osndereg");
937 card->osn_info.assist_cb = NULL;
938 card->osn_info.data_cb = NULL;
939 return;
940 }
941 EXPORT_SYMBOL(qeth_osn_deregister);
942
943 /* SETBRIDGEPORT support, async notifications */
944
945 enum qeth_an_event_type {anev_reg_unreg, anev_abort, anev_reset};
946
947 /**
948 * qeth_bridge_emit_host_event() - bridgeport address change notification
949 * @card: qeth_card structure pointer, for udev events.
950 * @evtype: "normal" register/unregister, or abort, or reset. For abort
951 * and reset token and addr_lnid are unused and may be NULL.
952 * @code: event bitmask: high order bit 0x80 value 1 means removal of an
953 * object, 0 - addition of an object.
954 * 0x01 - VLAN, 0x02 - MAC, 0x03 - VLAN and MAC.
955 * @token: "network token" structure identifying physical address of the port.
956 * @addr_lnid: pointer to structure with MAC address and VLAN ID.
957 *
958 * This function is called when registrations and deregistrations are
959 * reported by the hardware, and also when notifications are enabled -
960 * for all currently registered addresses.
961 */
962 static void qeth_bridge_emit_host_event(struct qeth_card *card,
963 enum qeth_an_event_type evtype,
964 u8 code, struct net_if_token *token, struct mac_addr_lnid *addr_lnid)
965 {
966 char str[7][32];
967 char *env[8];
968 int i = 0;
969
970 switch (evtype) {
971 case anev_reg_unreg:
972 snprintf(str[i], sizeof(str[i]), "BRIDGEDHOST=%s",
973 (code & IPA_ADDR_CHANGE_CODE_REMOVAL)
974 ? "deregister" : "register");
975 env[i] = str[i]; i++;
976 if (code & IPA_ADDR_CHANGE_CODE_VLANID) {
977 snprintf(str[i], sizeof(str[i]), "VLAN=%d",
978 addr_lnid->lnid);
979 env[i] = str[i]; i++;
980 }
981 if (code & IPA_ADDR_CHANGE_CODE_MACADDR) {
982 snprintf(str[i], sizeof(str[i]), "MAC=%pM",
983 addr_lnid->mac);
984 env[i] = str[i]; i++;
985 }
986 snprintf(str[i], sizeof(str[i]), "NTOK_BUSID=%x.%x.%04x",
987 token->cssid, token->ssid, token->devnum);
988 env[i] = str[i]; i++;
989 snprintf(str[i], sizeof(str[i]), "NTOK_IID=%02x", token->iid);
990 env[i] = str[i]; i++;
991 snprintf(str[i], sizeof(str[i]), "NTOK_CHPID=%02x",
992 token->chpid);
993 env[i] = str[i]; i++;
994 snprintf(str[i], sizeof(str[i]), "NTOK_CHID=%04x", token->chid);
995 env[i] = str[i]; i++;
996 break;
997 case anev_abort:
998 snprintf(str[i], sizeof(str[i]), "BRIDGEDHOST=abort");
999 env[i] = str[i]; i++;
1000 break;
1001 case anev_reset:
1002 snprintf(str[i], sizeof(str[i]), "BRIDGEDHOST=reset");
1003 env[i] = str[i]; i++;
1004 break;
1005 }
1006 env[i] = NULL;
1007 kobject_uevent_env(&card->gdev->dev.kobj, KOBJ_CHANGE, env);
1008 }
1009
1010 struct qeth_bridge_state_data {
1011 struct work_struct worker;
1012 struct qeth_card *card;
1013 struct qeth_sbp_state_change qports;
1014 };
1015
1016 static void qeth_bridge_state_change_worker(struct work_struct *work)
1017 {
1018 struct qeth_bridge_state_data *data =
1019 container_of(work, struct qeth_bridge_state_data, worker);
1020 /* We are only interested in the first entry - local port */
1021 struct qeth_sbp_port_entry *entry = &data->qports.entry[0];
1022 char env_locrem[32];
1023 char env_role[32];
1024 char env_state[32];
1025 char *env[] = {
1026 env_locrem,
1027 env_role,
1028 env_state,
1029 NULL
1030 };
1031
1032 /* Role should not change by itself, but if it did, */
1033 /* information from the hardware is authoritative. */
1034 mutex_lock(&data->card->sbp_lock);
1035 data->card->options.sbp.role = entry->role;
1036 mutex_unlock(&data->card->sbp_lock);
1037
1038 snprintf(env_locrem, sizeof(env_locrem), "BRIDGEPORT=statechange");
1039 snprintf(env_role, sizeof(env_role), "ROLE=%s",
1040 (entry->role == QETH_SBP_ROLE_NONE) ? "none" :
1041 (entry->role == QETH_SBP_ROLE_PRIMARY) ? "primary" :
1042 (entry->role == QETH_SBP_ROLE_SECONDARY) ? "secondary" :
1043 "<INVALID>");
1044 snprintf(env_state, sizeof(env_state), "STATE=%s",
1045 (entry->state == QETH_SBP_STATE_INACTIVE) ? "inactive" :
1046 (entry->state == QETH_SBP_STATE_STANDBY) ? "standby" :
1047 (entry->state == QETH_SBP_STATE_ACTIVE) ? "active" :
1048 "<INVALID>");
1049 kobject_uevent_env(&data->card->gdev->dev.kobj,
1050 KOBJ_CHANGE, env);
1051 kfree(data);
1052 }
1053
1054 static void qeth_bridge_state_change(struct qeth_card *card,
1055 struct qeth_ipa_cmd *cmd)
1056 {
1057 struct qeth_sbp_state_change *qports =
1058 &cmd->data.sbp.data.state_change;
1059 struct qeth_bridge_state_data *data;
1060 int extrasize;
1061
1062 QETH_CARD_TEXT(card, 2, "brstchng");
1063 if (qports->entry_length != sizeof(struct qeth_sbp_port_entry)) {
1064 QETH_CARD_TEXT_(card, 2, "BPsz%04x", qports->entry_length);
1065 return;
1066 }
1067 extrasize = sizeof(struct qeth_sbp_port_entry) * qports->num_entries;
1068 data = kzalloc(sizeof(struct qeth_bridge_state_data) + extrasize,
1069 GFP_ATOMIC);
1070 if (!data) {
1071 QETH_CARD_TEXT(card, 2, "BPSalloc");
1072 return;
1073 }
1074 INIT_WORK(&data->worker, qeth_bridge_state_change_worker);
1075 data->card = card;
1076 memcpy(&data->qports, qports,
1077 sizeof(struct qeth_sbp_state_change) + extrasize);
1078 queue_work(card->event_wq, &data->worker);
1079 }
1080
1081 struct qeth_bridge_host_data {
1082 struct work_struct worker;
1083 struct qeth_card *card;
1084 struct qeth_ipacmd_addr_change hostevs;
1085 };
1086
1087 static void qeth_bridge_host_event_worker(struct work_struct *work)
1088 {
1089 struct qeth_bridge_host_data *data =
1090 container_of(work, struct qeth_bridge_host_data, worker);
1091 int i;
1092
1093 if (data->hostevs.lost_event_mask) {
1094 dev_info(&data->card->gdev->dev,
1095 "Address notification from the Bridge Port stopped %s (%s)\n",
1096 data->card->dev->name,
1097 (data->hostevs.lost_event_mask == 0x01)
1098 ? "Overflow"
1099 : (data->hostevs.lost_event_mask == 0x02)
1100 ? "Bridge port state change"
1101 : "Unknown reason");
1102 mutex_lock(&data->card->sbp_lock);
1103 data->card->options.sbp.hostnotification = 0;
1104 mutex_unlock(&data->card->sbp_lock);
1105 qeth_bridge_emit_host_event(data->card, anev_abort,
1106 0, NULL, NULL);
1107 } else
1108 for (i = 0; i < data->hostevs.num_entries; i++) {
1109 struct qeth_ipacmd_addr_change_entry *entry =
1110 &data->hostevs.entry[i];
1111 qeth_bridge_emit_host_event(data->card,
1112 anev_reg_unreg,
1113 entry->change_code,
1114 &entry->token, &entry->addr_lnid);
1115 }
1116 kfree(data);
1117 }
1118
1119 static void qeth_bridge_host_event(struct qeth_card *card,
1120 struct qeth_ipa_cmd *cmd)
1121 {
1122 struct qeth_ipacmd_addr_change *hostevs =
1123 &cmd->data.addrchange;
1124 struct qeth_bridge_host_data *data;
1125 int extrasize;
1126
1127 QETH_CARD_TEXT(card, 2, "brhostev");
1128 if (cmd->hdr.return_code != 0x0000) {
1129 if (cmd->hdr.return_code == 0x0010) {
1130 if (hostevs->lost_event_mask == 0x00)
1131 hostevs->lost_event_mask = 0xff;
1132 } else {
1133 QETH_CARD_TEXT_(card, 2, "BPHe%04x",
1134 cmd->hdr.return_code);
1135 return;
1136 }
1137 }
1138 extrasize = sizeof(struct qeth_ipacmd_addr_change_entry) *
1139 hostevs->num_entries;
1140 data = kzalloc(sizeof(struct qeth_bridge_host_data) + extrasize,
1141 GFP_ATOMIC);
1142 if (!data) {
1143 QETH_CARD_TEXT(card, 2, "BPHalloc");
1144 return;
1145 }
1146 INIT_WORK(&data->worker, qeth_bridge_host_event_worker);
1147 data->card = card;
1148 memcpy(&data->hostevs, hostevs,
1149 sizeof(struct qeth_ipacmd_addr_change) + extrasize);
1150 queue_work(card->event_wq, &data->worker);
1151 }
1152
1153 /* SETBRIDGEPORT support; sending commands */
1154
1155 struct _qeth_sbp_cbctl {
1156 union {
1157 u32 supported;
1158 struct {
1159 enum qeth_sbp_roles *role;
1160 enum qeth_sbp_states *state;
1161 } qports;
1162 } data;
1163 };
1164
1165 static int qeth_bridgeport_makerc(struct qeth_card *card,
1166 struct qeth_ipa_cmd *cmd)
1167 {
1168 struct qeth_ipacmd_setbridgeport *sbp = &cmd->data.sbp;
1169 enum qeth_ipa_sbp_cmd setcmd = sbp->hdr.command_code;
1170 u16 ipa_rc = cmd->hdr.return_code;
1171 u16 sbp_rc = sbp->hdr.return_code;
1172 int rc;
1173
1174 if (ipa_rc == IPA_RC_SUCCESS && sbp_rc == IPA_RC_SUCCESS)
1175 return 0;
1176
1177 if ((IS_IQD(card) && ipa_rc == IPA_RC_SUCCESS) ||
1178 (!IS_IQD(card) && ipa_rc == sbp_rc)) {
1179 switch (sbp_rc) {
1180 case IPA_RC_SUCCESS:
1181 rc = 0;
1182 break;
1183 case IPA_RC_L2_UNSUPPORTED_CMD:
1184 case IPA_RC_UNSUPPORTED_COMMAND:
1185 rc = -EOPNOTSUPP;
1186 break;
1187 case IPA_RC_SBP_OSA_NOT_CONFIGURED:
1188 case IPA_RC_SBP_IQD_NOT_CONFIGURED:
1189 rc = -ENODEV; /* maybe not the best code here? */
1190 dev_err(&card->gdev->dev,
1191 "The device is not configured as a Bridge Port\n");
1192 break;
1193 case IPA_RC_SBP_OSA_OS_MISMATCH:
1194 case IPA_RC_SBP_IQD_OS_MISMATCH:
1195 rc = -EPERM;
1196 dev_err(&card->gdev->dev,
1197 "A Bridge Port is already configured by a different operating system\n");
1198 break;
1199 case IPA_RC_SBP_OSA_ANO_DEV_PRIMARY:
1200 case IPA_RC_SBP_IQD_ANO_DEV_PRIMARY:
1201 switch (setcmd) {
1202 case IPA_SBP_SET_PRIMARY_BRIDGE_PORT:
1203 rc = -EEXIST;
1204 dev_err(&card->gdev->dev,
1205 "The LAN already has a primary Bridge Port\n");
1206 break;
1207 case IPA_SBP_SET_SECONDARY_BRIDGE_PORT:
1208 rc = -EBUSY;
1209 dev_err(&card->gdev->dev,
1210 "The device is already a primary Bridge Port\n");
1211 break;
1212 default:
1213 rc = -EIO;
1214 }
1215 break;
1216 case IPA_RC_SBP_OSA_CURRENT_SECOND:
1217 case IPA_RC_SBP_IQD_CURRENT_SECOND:
1218 rc = -EBUSY;
1219 dev_err(&card->gdev->dev,
1220 "The device is already a secondary Bridge Port\n");
1221 break;
1222 case IPA_RC_SBP_OSA_LIMIT_SECOND:
1223 case IPA_RC_SBP_IQD_LIMIT_SECOND:
1224 rc = -EEXIST;
1225 dev_err(&card->gdev->dev,
1226 "The LAN cannot have more secondary Bridge Ports\n");
1227 break;
1228 case IPA_RC_SBP_OSA_CURRENT_PRIMARY:
1229 case IPA_RC_SBP_IQD_CURRENT_PRIMARY:
1230 rc = -EBUSY;
1231 dev_err(&card->gdev->dev,
1232 "The device is already a primary Bridge Port\n");
1233 break;
1234 case IPA_RC_SBP_OSA_NOT_AUTHD_BY_ZMAN:
1235 case IPA_RC_SBP_IQD_NOT_AUTHD_BY_ZMAN:
1236 rc = -EACCES;
1237 dev_err(&card->gdev->dev,
1238 "The device is not authorized to be a Bridge Port\n");
1239 break;
1240 default:
1241 rc = -EIO;
1242 }
1243 } else {
1244 switch (ipa_rc) {
1245 case IPA_RC_NOTSUPP:
1246 rc = -EOPNOTSUPP;
1247 break;
1248 case IPA_RC_UNSUPPORTED_COMMAND:
1249 rc = -EOPNOTSUPP;
1250 break;
1251 default:
1252 rc = -EIO;
1253 }
1254 }
1255
1256 if (rc) {
1257 QETH_CARD_TEXT_(card, 2, "SBPi%04x", ipa_rc);
1258 QETH_CARD_TEXT_(card, 2, "SBPc%04x", sbp_rc);
1259 }
1260 return rc;
1261 }
1262
1263 static struct qeth_cmd_buffer *qeth_sbp_build_cmd(struct qeth_card *card,
1264 enum qeth_ipa_sbp_cmd sbp_cmd,
1265 unsigned int data_length)
1266 {
1267 enum qeth_ipa_cmds ipa_cmd = IS_IQD(card) ? IPA_CMD_SETBRIDGEPORT_IQD :
1268 IPA_CMD_SETBRIDGEPORT_OSA;
1269 struct qeth_ipacmd_sbp_hdr *hdr;
1270 struct qeth_cmd_buffer *iob;
1271
1272 iob = qeth_ipa_alloc_cmd(card, ipa_cmd, QETH_PROT_NONE,
1273 data_length +
1274 offsetof(struct qeth_ipacmd_setbridgeport,
1275 data));
1276 if (!iob)
1277 return iob;
1278
1279 hdr = &__ipa_cmd(iob)->data.sbp.hdr;
1280 hdr->cmdlength = sizeof(*hdr) + data_length;
1281 hdr->command_code = sbp_cmd;
1282 hdr->used_total = 1;
1283 hdr->seq_no = 1;
1284 return iob;
1285 }
1286
1287 static int qeth_bridgeport_query_support_cb(struct qeth_card *card,
1288 struct qeth_reply *reply, unsigned long data)
1289 {
1290 struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *) data;
1291 struct _qeth_sbp_cbctl *cbctl = (struct _qeth_sbp_cbctl *)reply->param;
1292 int rc;
1293
1294 QETH_CARD_TEXT(card, 2, "brqsupcb");
1295 rc = qeth_bridgeport_makerc(card, cmd);
1296 if (rc)
1297 return rc;
1298
1299 cbctl->data.supported =
1300 cmd->data.sbp.data.query_cmds_supp.supported_cmds;
1301 return 0;
1302 }
1303
1304 /**
1305 * qeth_bridgeport_query_support() - store bitmask of supported subfunctions.
1306 * @card: qeth_card structure pointer.
1307 *
1308 * Sets bitmask of supported setbridgeport subfunctions in the qeth_card
1309 * strucutre: card->options.sbp.supported_funcs.
1310 */
1311 static void qeth_bridgeport_query_support(struct qeth_card *card)
1312 {
1313 struct qeth_cmd_buffer *iob;
1314 struct _qeth_sbp_cbctl cbctl;
1315
1316 QETH_CARD_TEXT(card, 2, "brqsuppo");
1317 iob = qeth_sbp_build_cmd(card, IPA_SBP_QUERY_COMMANDS_SUPPORTED,
1318 SBP_DATA_SIZEOF(query_cmds_supp));
1319 if (!iob)
1320 return;
1321
1322 if (qeth_send_ipa_cmd(card, iob, qeth_bridgeport_query_support_cb,
1323 &cbctl)) {
1324 card->options.sbp.role = QETH_SBP_ROLE_NONE;
1325 card->options.sbp.supported_funcs = 0;
1326 return;
1327 }
1328 card->options.sbp.supported_funcs = cbctl.data.supported;
1329 }
1330
1331 static int qeth_bridgeport_query_ports_cb(struct qeth_card *card,
1332 struct qeth_reply *reply, unsigned long data)
1333 {
1334 struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *) data;
1335 struct qeth_sbp_query_ports *qports = &cmd->data.sbp.data.query_ports;
1336 struct _qeth_sbp_cbctl *cbctl = (struct _qeth_sbp_cbctl *)reply->param;
1337 int rc;
1338
1339 QETH_CARD_TEXT(card, 2, "brqprtcb");
1340 rc = qeth_bridgeport_makerc(card, cmd);
1341 if (rc)
1342 return rc;
1343
1344 if (qports->entry_length != sizeof(struct qeth_sbp_port_entry)) {
1345 QETH_CARD_TEXT_(card, 2, "SBPs%04x", qports->entry_length);
1346 return -EINVAL;
1347 }
1348 /* first entry contains the state of the local port */
1349 if (qports->num_entries > 0) {
1350 if (cbctl->data.qports.role)
1351 *cbctl->data.qports.role = qports->entry[0].role;
1352 if (cbctl->data.qports.state)
1353 *cbctl->data.qports.state = qports->entry[0].state;
1354 }
1355 return 0;
1356 }
1357
1358 /**
1359 * qeth_bridgeport_query_ports() - query local bridgeport status.
1360 * @card: qeth_card structure pointer.
1361 * @role: Role of the port: 0-none, 1-primary, 2-secondary.
1362 * @state: State of the port: 0-inactive, 1-standby, 2-active.
1363 *
1364 * Returns negative errno-compatible error indication or 0 on success.
1365 *
1366 * 'role' and 'state' are not updated in case of hardware operation failure.
1367 */
1368 int qeth_bridgeport_query_ports(struct qeth_card *card,
1369 enum qeth_sbp_roles *role, enum qeth_sbp_states *state)
1370 {
1371 struct qeth_cmd_buffer *iob;
1372 struct _qeth_sbp_cbctl cbctl = {
1373 .data = {
1374 .qports = {
1375 .role = role,
1376 .state = state,
1377 },
1378 },
1379 };
1380
1381 QETH_CARD_TEXT(card, 2, "brqports");
1382 if (!(card->options.sbp.supported_funcs & IPA_SBP_QUERY_BRIDGE_PORTS))
1383 return -EOPNOTSUPP;
1384 iob = qeth_sbp_build_cmd(card, IPA_SBP_QUERY_BRIDGE_PORTS, 0);
1385 if (!iob)
1386 return -ENOMEM;
1387
1388 return qeth_send_ipa_cmd(card, iob, qeth_bridgeport_query_ports_cb,
1389 &cbctl);
1390 }
1391
1392 static int qeth_bridgeport_set_cb(struct qeth_card *card,
1393 struct qeth_reply *reply, unsigned long data)
1394 {
1395 struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *)data;
1396
1397 QETH_CARD_TEXT(card, 2, "brsetrcb");
1398 return qeth_bridgeport_makerc(card, cmd);
1399 }
1400
1401 /**
1402 * qeth_bridgeport_setrole() - Assign primary role to the port.
1403 * @card: qeth_card structure pointer.
1404 * @role: Role to assign.
1405 *
1406 * Returns negative errno-compatible error indication or 0 on success.
1407 */
1408 int qeth_bridgeport_setrole(struct qeth_card *card, enum qeth_sbp_roles role)
1409 {
1410 struct qeth_cmd_buffer *iob;
1411 enum qeth_ipa_sbp_cmd setcmd;
1412 unsigned int cmdlength = 0;
1413
1414 QETH_CARD_TEXT(card, 2, "brsetrol");
1415 switch (role) {
1416 case QETH_SBP_ROLE_NONE:
1417 setcmd = IPA_SBP_RESET_BRIDGE_PORT_ROLE;
1418 break;
1419 case QETH_SBP_ROLE_PRIMARY:
1420 setcmd = IPA_SBP_SET_PRIMARY_BRIDGE_PORT;
1421 cmdlength = SBP_DATA_SIZEOF(set_primary);
1422 break;
1423 case QETH_SBP_ROLE_SECONDARY:
1424 setcmd = IPA_SBP_SET_SECONDARY_BRIDGE_PORT;
1425 break;
1426 default:
1427 return -EINVAL;
1428 }
1429 if (!(card->options.sbp.supported_funcs & setcmd))
1430 return -EOPNOTSUPP;
1431 iob = qeth_sbp_build_cmd(card, setcmd, cmdlength);
1432 if (!iob)
1433 return -ENOMEM;
1434
1435 return qeth_send_ipa_cmd(card, iob, qeth_bridgeport_set_cb, NULL);
1436 }
1437
1438 /**
1439 * qeth_anset_makerc() - derive "traditional" error from hardware codes.
1440 * @card: qeth_card structure pointer, for debug messages.
1441 *
1442 * Returns negative errno-compatible error indication or 0 on success.
1443 */
1444 static int qeth_anset_makerc(struct qeth_card *card, int pnso_rc, u16 response)
1445 {
1446 int rc;
1447
1448 if (pnso_rc == 0)
1449 switch (response) {
1450 case 0x0001:
1451 rc = 0;
1452 break;
1453 case 0x0004:
1454 case 0x0100:
1455 case 0x0106:
1456 rc = -EOPNOTSUPP;
1457 dev_err(&card->gdev->dev,
1458 "Setting address notification failed\n");
1459 break;
1460 case 0x0107:
1461 rc = -EAGAIN;
1462 break;
1463 default:
1464 rc = -EIO;
1465 }
1466 else
1467 rc = -EIO;
1468
1469 if (rc) {
1470 QETH_CARD_TEXT_(card, 2, "SBPp%04x", pnso_rc);
1471 QETH_CARD_TEXT_(card, 2, "SBPr%04x", response);
1472 }
1473 return rc;
1474 }
1475
1476 static void qeth_bridgeport_an_set_cb(void *priv,
1477 enum qdio_brinfo_entry_type type, void *entry)
1478 {
1479 struct qeth_card *card = (struct qeth_card *)priv;
1480 struct qdio_brinfo_entry_l2 *l2entry;
1481 u8 code;
1482
1483 if (type != l2_addr_lnid) {
1484 WARN_ON_ONCE(1);
1485 return;
1486 }
1487
1488 l2entry = (struct qdio_brinfo_entry_l2 *)entry;
1489 code = IPA_ADDR_CHANGE_CODE_MACADDR;
1490 if (l2entry->addr_lnid.lnid < VLAN_N_VID)
1491 code |= IPA_ADDR_CHANGE_CODE_VLANID;
1492 qeth_bridge_emit_host_event(card, anev_reg_unreg, code,
1493 (struct net_if_token *)&l2entry->nit,
1494 (struct mac_addr_lnid *)&l2entry->addr_lnid);
1495 }
1496
1497 /**
1498 * qeth_bridgeport_an_set() - Enable or disable bridgeport address notification
1499 * @card: qeth_card structure pointer.
1500 * @enable: 0 - disable, non-zero - enable notifications
1501 *
1502 * Returns negative errno-compatible error indication or 0 on success.
1503 *
1504 * On enable, emits a series of address notifications udev events for all
1505 * currently registered hosts.
1506 */
1507 int qeth_bridgeport_an_set(struct qeth_card *card, int enable)
1508 {
1509 int rc;
1510 u16 response;
1511 struct ccw_device *ddev;
1512 struct subchannel_id schid;
1513
1514 if (!card)
1515 return -EINVAL;
1516 if (!card->options.sbp.supported_funcs)
1517 return -EOPNOTSUPP;
1518 ddev = CARD_DDEV(card);
1519 ccw_device_get_schid(ddev, &schid);
1520
1521 if (enable) {
1522 qeth_bridge_emit_host_event(card, anev_reset, 0, NULL, NULL);
1523 rc = qdio_pnso_brinfo(schid, 1, &response,
1524 qeth_bridgeport_an_set_cb, card);
1525 } else
1526 rc = qdio_pnso_brinfo(schid, 0, &response, NULL, NULL);
1527 return qeth_anset_makerc(card, rc, response);
1528 }
1529
1530 static bool qeth_bridgeport_is_in_use(struct qeth_card *card)
1531 {
1532 return (card->options.sbp.role || card->options.sbp.reflect_promisc ||
1533 card->options.sbp.hostnotification);
1534 }
1535
1536 /* VNIC Characteristics support */
1537
1538 /* handle VNICC IPA command return codes; convert to error codes */
1539 static int qeth_l2_vnicc_makerc(struct qeth_card *card, u16 ipa_rc)
1540 {
1541 int rc;
1542
1543 switch (ipa_rc) {
1544 case IPA_RC_SUCCESS:
1545 return ipa_rc;
1546 case IPA_RC_L2_UNSUPPORTED_CMD:
1547 case IPA_RC_NOTSUPP:
1548 rc = -EOPNOTSUPP;
1549 break;
1550 case IPA_RC_VNICC_OOSEQ:
1551 rc = -EALREADY;
1552 break;
1553 case IPA_RC_VNICC_VNICBP:
1554 rc = -EBUSY;
1555 break;
1556 case IPA_RC_L2_ADDR_TABLE_FULL:
1557 rc = -ENOSPC;
1558 break;
1559 case IPA_RC_L2_MAC_NOT_AUTH_BY_ADP:
1560 rc = -EACCES;
1561 break;
1562 default:
1563 rc = -EIO;
1564 }
1565
1566 QETH_CARD_TEXT_(card, 2, "err%04x", ipa_rc);
1567 return rc;
1568 }
1569
1570 /* generic VNICC request call back control */
1571 struct _qeth_l2_vnicc_request_cbctl {
1572 struct {
1573 union{
1574 u32 *sup_cmds;
1575 u32 *timeout;
1576 };
1577 } result;
1578 };
1579
1580 /* generic VNICC request call back */
1581 static int qeth_l2_vnicc_request_cb(struct qeth_card *card,
1582 struct qeth_reply *reply,
1583 unsigned long data)
1584 {
1585 struct _qeth_l2_vnicc_request_cbctl *cbctl =
1586 (struct _qeth_l2_vnicc_request_cbctl *) reply->param;
1587 struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *) data;
1588 struct qeth_ipacmd_vnicc *rep = &cmd->data.vnicc;
1589 u32 sub_cmd = cmd->data.vnicc.hdr.sub_command;
1590
1591 QETH_CARD_TEXT(card, 2, "vniccrcb");
1592 if (cmd->hdr.return_code)
1593 return qeth_l2_vnicc_makerc(card, cmd->hdr.return_code);
1594 /* return results to caller */
1595 card->options.vnicc.sup_chars = rep->vnicc_cmds.supported;
1596 card->options.vnicc.cur_chars = rep->vnicc_cmds.enabled;
1597
1598 if (sub_cmd == IPA_VNICC_QUERY_CMDS)
1599 *cbctl->result.sup_cmds = rep->data.query_cmds.sup_cmds;
1600 else if (sub_cmd == IPA_VNICC_GET_TIMEOUT)
1601 *cbctl->result.timeout = rep->data.getset_timeout.timeout;
1602
1603 return 0;
1604 }
1605
1606 static struct qeth_cmd_buffer *qeth_l2_vnicc_build_cmd(struct qeth_card *card,
1607 u32 vnicc_cmd,
1608 unsigned int data_length)
1609 {
1610 struct qeth_ipacmd_vnicc_hdr *hdr;
1611 struct qeth_cmd_buffer *iob;
1612
1613 iob = qeth_ipa_alloc_cmd(card, IPA_CMD_VNICC, QETH_PROT_NONE,
1614 data_length +
1615 offsetof(struct qeth_ipacmd_vnicc, data));
1616 if (!iob)
1617 return NULL;
1618
1619 hdr = &__ipa_cmd(iob)->data.vnicc.hdr;
1620 hdr->data_length = sizeof(*hdr) + data_length;
1621 hdr->sub_command = vnicc_cmd;
1622 return iob;
1623 }
1624
1625 /* VNICC query VNIC characteristics request */
1626 static int qeth_l2_vnicc_query_chars(struct qeth_card *card)
1627 {
1628 struct qeth_cmd_buffer *iob;
1629
1630 QETH_CARD_TEXT(card, 2, "vniccqch");
1631 iob = qeth_l2_vnicc_build_cmd(card, IPA_VNICC_QUERY_CHARS, 0);
1632 if (!iob)
1633 return -ENOMEM;
1634
1635 return qeth_send_ipa_cmd(card, iob, qeth_l2_vnicc_request_cb, NULL);
1636 }
1637
1638 /* VNICC query sub commands request */
1639 static int qeth_l2_vnicc_query_cmds(struct qeth_card *card, u32 vnic_char,
1640 u32 *sup_cmds)
1641 {
1642 struct _qeth_l2_vnicc_request_cbctl cbctl;
1643 struct qeth_cmd_buffer *iob;
1644
1645 QETH_CARD_TEXT(card, 2, "vniccqcm");
1646 iob = qeth_l2_vnicc_build_cmd(card, IPA_VNICC_QUERY_CMDS,
1647 VNICC_DATA_SIZEOF(query_cmds));
1648 if (!iob)
1649 return -ENOMEM;
1650
1651 __ipa_cmd(iob)->data.vnicc.data.query_cmds.vnic_char = vnic_char;
1652
1653 /* prepare callback control */
1654 cbctl.result.sup_cmds = sup_cmds;
1655
1656 return qeth_send_ipa_cmd(card, iob, qeth_l2_vnicc_request_cb, &cbctl);
1657 }
1658
1659 /* VNICC enable/disable characteristic request */
1660 static int qeth_l2_vnicc_set_char(struct qeth_card *card, u32 vnic_char,
1661 u32 cmd)
1662 {
1663 struct qeth_cmd_buffer *iob;
1664
1665 QETH_CARD_TEXT(card, 2, "vniccedc");
1666 iob = qeth_l2_vnicc_build_cmd(card, cmd, VNICC_DATA_SIZEOF(set_char));
1667 if (!iob)
1668 return -ENOMEM;
1669
1670 __ipa_cmd(iob)->data.vnicc.data.set_char.vnic_char = vnic_char;
1671
1672 return qeth_send_ipa_cmd(card, iob, qeth_l2_vnicc_request_cb, NULL);
1673 }
1674
1675 /* VNICC get/set timeout for characteristic request */
1676 static int qeth_l2_vnicc_getset_timeout(struct qeth_card *card, u32 vnicc,
1677 u32 cmd, u32 *timeout)
1678 {
1679 struct qeth_vnicc_getset_timeout *getset_timeout;
1680 struct _qeth_l2_vnicc_request_cbctl cbctl;
1681 struct qeth_cmd_buffer *iob;
1682
1683 QETH_CARD_TEXT(card, 2, "vniccgst");
1684 iob = qeth_l2_vnicc_build_cmd(card, cmd,
1685 VNICC_DATA_SIZEOF(getset_timeout));
1686 if (!iob)
1687 return -ENOMEM;
1688
1689 getset_timeout = &__ipa_cmd(iob)->data.vnicc.data.getset_timeout;
1690 getset_timeout->vnic_char = vnicc;
1691
1692 if (cmd == IPA_VNICC_SET_TIMEOUT)
1693 getset_timeout->timeout = *timeout;
1694
1695 /* prepare callback control */
1696 if (cmd == IPA_VNICC_GET_TIMEOUT)
1697 cbctl.result.timeout = timeout;
1698
1699 return qeth_send_ipa_cmd(card, iob, qeth_l2_vnicc_request_cb, &cbctl);
1700 }
1701
1702 /* set current VNICC flag state; called from sysfs store function */
1703 int qeth_l2_vnicc_set_state(struct qeth_card *card, u32 vnicc, bool state)
1704 {
1705 int rc = 0;
1706 u32 cmd;
1707
1708 QETH_CARD_TEXT(card, 2, "vniccsch");
1709
1710 /* do not change anything if BridgePort is enabled */
1711 if (qeth_bridgeport_is_in_use(card))
1712 return -EBUSY;
1713
1714 /* check if characteristic and enable/disable are supported */
1715 if (!(card->options.vnicc.sup_chars & vnicc) ||
1716 !(card->options.vnicc.set_char_sup & vnicc))
1717 return -EOPNOTSUPP;
1718
1719 /* set enable/disable command and store wanted characteristic */
1720 if (state) {
1721 cmd = IPA_VNICC_ENABLE;
1722 card->options.vnicc.wanted_chars |= vnicc;
1723 } else {
1724 cmd = IPA_VNICC_DISABLE;
1725 card->options.vnicc.wanted_chars &= ~vnicc;
1726 }
1727
1728 /* do we need to do anything? */
1729 if (card->options.vnicc.cur_chars == card->options.vnicc.wanted_chars)
1730 return rc;
1731
1732 /* if card is not ready, simply stop here */
1733 if (!qeth_card_hw_is_reachable(card)) {
1734 if (state)
1735 card->options.vnicc.cur_chars |= vnicc;
1736 else
1737 card->options.vnicc.cur_chars &= ~vnicc;
1738 return rc;
1739 }
1740
1741 rc = qeth_l2_vnicc_set_char(card, vnicc, cmd);
1742 if (rc)
1743 card->options.vnicc.wanted_chars =
1744 card->options.vnicc.cur_chars;
1745 else {
1746 /* successful online VNICC change; handle special cases */
1747 if (state && vnicc == QETH_VNICC_RX_BCAST)
1748 card->options.vnicc.rx_bcast_enabled = true;
1749 if (!state && vnicc == QETH_VNICC_LEARNING)
1750 qeth_l2_vnicc_recover_timeout(card, vnicc,
1751 &card->options.vnicc.learning_timeout);
1752 }
1753
1754 return rc;
1755 }
1756
1757 /* get current VNICC flag state; called from sysfs show function */
1758 int qeth_l2_vnicc_get_state(struct qeth_card *card, u32 vnicc, bool *state)
1759 {
1760 int rc = 0;
1761
1762 QETH_CARD_TEXT(card, 2, "vniccgch");
1763
1764 /* do not get anything if BridgePort is enabled */
1765 if (qeth_bridgeport_is_in_use(card))
1766 return -EBUSY;
1767
1768 /* check if characteristic is supported */
1769 if (!(card->options.vnicc.sup_chars & vnicc))
1770 return -EOPNOTSUPP;
1771
1772 /* if card is ready, query current VNICC state */
1773 if (qeth_card_hw_is_reachable(card))
1774 rc = qeth_l2_vnicc_query_chars(card);
1775
1776 *state = (card->options.vnicc.cur_chars & vnicc) ? true : false;
1777 return rc;
1778 }
1779
1780 /* set VNICC timeout; called from sysfs store function. Currently, only learning
1781 * supports timeout
1782 */
1783 int qeth_l2_vnicc_set_timeout(struct qeth_card *card, u32 timeout)
1784 {
1785 int rc = 0;
1786
1787 QETH_CARD_TEXT(card, 2, "vniccsto");
1788
1789 /* do not change anything if BridgePort is enabled */
1790 if (qeth_bridgeport_is_in_use(card))
1791 return -EBUSY;
1792
1793 /* check if characteristic and set_timeout are supported */
1794 if (!(card->options.vnicc.sup_chars & QETH_VNICC_LEARNING) ||
1795 !(card->options.vnicc.getset_timeout_sup & QETH_VNICC_LEARNING))
1796 return -EOPNOTSUPP;
1797
1798 /* do we need to do anything? */
1799 if (card->options.vnicc.learning_timeout == timeout)
1800 return rc;
1801
1802 /* if card is not ready, simply store the value internally and return */
1803 if (!qeth_card_hw_is_reachable(card)) {
1804 card->options.vnicc.learning_timeout = timeout;
1805 return rc;
1806 }
1807
1808 /* send timeout value to card; if successful, store value internally */
1809 rc = qeth_l2_vnicc_getset_timeout(card, QETH_VNICC_LEARNING,
1810 IPA_VNICC_SET_TIMEOUT, &timeout);
1811 if (!rc)
1812 card->options.vnicc.learning_timeout = timeout;
1813
1814 return rc;
1815 }
1816
1817 /* get current VNICC timeout; called from sysfs show function. Currently, only
1818 * learning supports timeout
1819 */
1820 int qeth_l2_vnicc_get_timeout(struct qeth_card *card, u32 *timeout)
1821 {
1822 int rc = 0;
1823
1824 QETH_CARD_TEXT(card, 2, "vniccgto");
1825
1826 /* do not get anything if BridgePort is enabled */
1827 if (qeth_bridgeport_is_in_use(card))
1828 return -EBUSY;
1829
1830 /* check if characteristic and get_timeout are supported */
1831 if (!(card->options.vnicc.sup_chars & QETH_VNICC_LEARNING) ||
1832 !(card->options.vnicc.getset_timeout_sup & QETH_VNICC_LEARNING))
1833 return -EOPNOTSUPP;
1834 /* if card is ready, get timeout. Otherwise, just return stored value */
1835 *timeout = card->options.vnicc.learning_timeout;
1836 if (qeth_card_hw_is_reachable(card))
1837 rc = qeth_l2_vnicc_getset_timeout(card, QETH_VNICC_LEARNING,
1838 IPA_VNICC_GET_TIMEOUT,
1839 timeout);
1840
1841 return rc;
1842 }
1843
1844 /* check if VNICC is currently enabled */
1845 bool qeth_l2_vnicc_is_in_use(struct qeth_card *card)
1846 {
1847 if (!card->options.vnicc.sup_chars)
1848 return false;
1849 /* default values are only OK if rx_bcast was not enabled by user
1850 * or the card is offline.
1851 */
1852 if (card->options.vnicc.cur_chars == QETH_VNICC_DEFAULT) {
1853 if (!card->options.vnicc.rx_bcast_enabled ||
1854 !qeth_card_hw_is_reachable(card))
1855 return false;
1856 }
1857 return true;
1858 }
1859
1860 /* recover user timeout setting */
1861 static bool qeth_l2_vnicc_recover_timeout(struct qeth_card *card, u32 vnicc,
1862 u32 *timeout)
1863 {
1864 if (card->options.vnicc.sup_chars & vnicc &&
1865 card->options.vnicc.getset_timeout_sup & vnicc &&
1866 !qeth_l2_vnicc_getset_timeout(card, vnicc, IPA_VNICC_SET_TIMEOUT,
1867 timeout))
1868 return false;
1869 *timeout = QETH_VNICC_DEFAULT_TIMEOUT;
1870 return true;
1871 }
1872
1873 /* recover user characteristic setting */
1874 static bool qeth_l2_vnicc_recover_char(struct qeth_card *card, u32 vnicc,
1875 bool enable)
1876 {
1877 u32 cmd = enable ? IPA_VNICC_ENABLE : IPA_VNICC_DISABLE;
1878
1879 if (card->options.vnicc.sup_chars & vnicc &&
1880 card->options.vnicc.set_char_sup & vnicc &&
1881 !qeth_l2_vnicc_set_char(card, vnicc, cmd))
1882 return false;
1883 card->options.vnicc.wanted_chars &= ~vnicc;
1884 card->options.vnicc.wanted_chars |= QETH_VNICC_DEFAULT & vnicc;
1885 return true;
1886 }
1887
1888 /* (re-)initialize VNICC */
1889 static void qeth_l2_vnicc_init(struct qeth_card *card)
1890 {
1891 u32 *timeout = &card->options.vnicc.learning_timeout;
1892 bool enable, error = false;
1893 unsigned int chars_len, i;
1894 unsigned long chars_tmp;
1895 u32 sup_cmds, vnicc;
1896
1897 QETH_CARD_TEXT(card, 2, "vniccini");
1898 /* reset rx_bcast */
1899 card->options.vnicc.rx_bcast_enabled = 0;
1900 /* initial query and storage of VNIC characteristics */
1901 if (qeth_l2_vnicc_query_chars(card)) {
1902 if (card->options.vnicc.wanted_chars != QETH_VNICC_DEFAULT ||
1903 *timeout != QETH_VNICC_DEFAULT_TIMEOUT)
1904 dev_err(&card->gdev->dev, "Configuring the VNIC characteristics failed\n");
1905 /* fail quietly if user didn't change the default config */
1906 card->options.vnicc.sup_chars = 0;
1907 card->options.vnicc.cur_chars = 0;
1908 card->options.vnicc.wanted_chars = QETH_VNICC_DEFAULT;
1909 return;
1910 }
1911 /* get supported commands for each supported characteristic */
1912 chars_tmp = card->options.vnicc.sup_chars;
1913 chars_len = sizeof(card->options.vnicc.sup_chars) * BITS_PER_BYTE;
1914 for_each_set_bit(i, &chars_tmp, chars_len) {
1915 vnicc = BIT(i);
1916 if (qeth_l2_vnicc_query_cmds(card, vnicc, &sup_cmds)) {
1917 sup_cmds = 0;
1918 error = true;
1919 }
1920 if ((sup_cmds & IPA_VNICC_SET_TIMEOUT) &&
1921 (sup_cmds & IPA_VNICC_GET_TIMEOUT))
1922 card->options.vnicc.getset_timeout_sup |= vnicc;
1923 else
1924 card->options.vnicc.getset_timeout_sup &= ~vnicc;
1925 if ((sup_cmds & IPA_VNICC_ENABLE) &&
1926 (sup_cmds & IPA_VNICC_DISABLE))
1927 card->options.vnicc.set_char_sup |= vnicc;
1928 else
1929 card->options.vnicc.set_char_sup &= ~vnicc;
1930 }
1931 /* enforce assumed default values and recover settings, if changed */
1932 error |= qeth_l2_vnicc_recover_timeout(card, QETH_VNICC_LEARNING,
1933 timeout);
1934 /* Change chars, if necessary */
1935 chars_tmp = card->options.vnicc.wanted_chars ^
1936 card->options.vnicc.cur_chars;
1937 chars_len = sizeof(card->options.vnicc.wanted_chars) * BITS_PER_BYTE;
1938 for_each_set_bit(i, &chars_tmp, chars_len) {
1939 vnicc = BIT(i);
1940 enable = card->options.vnicc.wanted_chars & vnicc;
1941 error |= qeth_l2_vnicc_recover_char(card, vnicc, enable);
1942 }
1943 if (error)
1944 dev_err(&card->gdev->dev, "Configuring the VNIC characteristics failed\n");
1945 }
1946
1947 /* configure default values of VNIC characteristics */
1948 static void qeth_l2_vnicc_set_defaults(struct qeth_card *card)
1949 {
1950 /* characteristics values */
1951 card->options.vnicc.sup_chars = QETH_VNICC_ALL;
1952 card->options.vnicc.cur_chars = QETH_VNICC_DEFAULT;
1953 card->options.vnicc.learning_timeout = QETH_VNICC_DEFAULT_TIMEOUT;
1954 /* supported commands */
1955 card->options.vnicc.set_char_sup = QETH_VNICC_ALL;
1956 card->options.vnicc.getset_timeout_sup = QETH_VNICC_LEARNING;
1957 /* settings wanted by users */
1958 card->options.vnicc.wanted_chars = QETH_VNICC_DEFAULT;
1959 }
1960
1961 module_init(qeth_l2_init);
1962 module_exit(qeth_l2_exit);
1963 MODULE_AUTHOR("Frank Blaschka <frank.blaschka@de.ibm.com>");
1964 MODULE_DESCRIPTION("qeth layer 2 discipline");
1965 MODULE_LICENSE("GPL");
Linux with added FPC-III support