2 * Copyright IBM Corp. 2007, 2009
3 * Author(s): Utz Bacher <utz.bacher@de.ibm.com>,
4 * Frank Pavlic <fpavlic@de.ibm.com>,
5 * Thomas Spatzier <tspat@de.ibm.com>,
6 * Frank Blaschka <frank.blaschka@de.ibm.com>
9 #define KMSG_COMPONENT "qeth"
10 #define pr_fmt(fmt) KMSG_COMPONENT ": " fmt
12 #include <linux/module.h>
13 #include <linux/moduleparam.h>
14 #include <linux/string.h>
15 #include <linux/errno.h>
16 #include <linux/kernel.h>
17 #include <linux/slab.h>
18 #include <linux/etherdevice.h>
19 #include <linux/mii.h>
21 #include <linux/list.h>
23 #include "qeth_core.h"
26 static int qeth_l2_set_offline(struct ccwgroup_device
*);
27 static int qeth_l2_stop(struct net_device
*);
28 static int qeth_l2_send_delmac(struct qeth_card
*, __u8
*);
29 static int qeth_l2_send_setdelmac(struct qeth_card
*, __u8
*,
31 int (*reply_cb
) (struct qeth_card
*,
34 static void qeth_l2_set_multicast_list(struct net_device
*);
35 static int qeth_l2_recover(void *);
36 static void qeth_bridgeport_query_support(struct qeth_card
*card
);
37 static void qeth_bridge_state_change(struct qeth_card
*card
,
38 struct qeth_ipa_cmd
*cmd
);
39 static void qeth_bridge_host_event(struct qeth_card
*card
,
40 struct qeth_ipa_cmd
*cmd
);
42 static int qeth_l2_do_ioctl(struct net_device
*dev
, struct ifreq
*rq
, int cmd
)
44 struct qeth_card
*card
= dev
->ml_priv
;
45 struct mii_ioctl_data
*mii_data
;
51 if ((card
->state
!= CARD_STATE_UP
) &&
52 (card
->state
!= CARD_STATE_SOFTSETUP
))
55 if (card
->info
.type
== QETH_CARD_TYPE_OSN
)
59 case SIOC_QETH_ADP_SET_SNMP_CONTROL
:
60 rc
= qeth_snmp_command(card
, rq
->ifr_ifru
.ifru_data
);
62 case SIOC_QETH_GET_CARD_TYPE
:
63 if ((card
->info
.type
== QETH_CARD_TYPE_OSD
||
64 card
->info
.type
== QETH_CARD_TYPE_OSM
||
65 card
->info
.type
== QETH_CARD_TYPE_OSX
) &&
71 mii_data
= if_mii(rq
);
75 mii_data
= if_mii(rq
);
76 if (mii_data
->phy_id
!= 0)
79 mii_data
->val_out
= qeth_mdio_read(dev
,
80 mii_data
->phy_id
, mii_data
->reg_num
);
82 case SIOC_QETH_QUERY_OAT
:
83 rc
= qeth_query_oat_command(card
, rq
->ifr_ifru
.ifru_data
);
89 QETH_CARD_TEXT_(card
, 2, "ioce%d", rc
);
93 static int qeth_l2_verify_dev(struct net_device
*dev
)
95 struct qeth_card
*card
;
99 read_lock_irqsave(&qeth_core_card_list
.rwlock
, flags
);
100 list_for_each_entry(card
, &qeth_core_card_list
.list
, list
) {
101 if (card
->dev
== dev
) {
106 read_unlock_irqrestore(&qeth_core_card_list
.rwlock
, flags
);
111 static struct net_device
*qeth_l2_netdev_by_devno(unsigned char *read_dev_no
)
113 struct qeth_card
*card
;
114 struct net_device
*ndev
;
117 struct ccw_dev_id read_devid
;
120 memcpy(&temp_dev_no
, read_dev_no
, 2);
121 read_lock_irqsave(&qeth_core_card_list
.rwlock
, flags
);
122 list_for_each_entry(card
, &qeth_core_card_list
.list
, list
) {
123 ccw_device_get_id(CARD_RDEV(card
), &read_devid
);
124 if (read_devid
.devno
== temp_dev_no
) {
129 read_unlock_irqrestore(&qeth_core_card_list
.rwlock
, flags
);
133 static int qeth_l2_send_setgroupmac_cb(struct qeth_card
*card
,
134 struct qeth_reply
*reply
,
137 struct qeth_ipa_cmd
*cmd
;
140 QETH_CARD_TEXT(card
, 2, "L2Sgmacb");
141 cmd
= (struct qeth_ipa_cmd
*) data
;
142 mac
= &cmd
->data
.setdelmac
.mac
[0];
143 /* MAC already registered, needed in couple/uncouple case */
144 if (cmd
->hdr
.return_code
== IPA_RC_L2_DUP_MAC
) {
145 QETH_DBF_MESSAGE(2, "Group MAC %pM already existing on %s \n",
146 mac
, QETH_CARD_IFNAME(card
));
147 cmd
->hdr
.return_code
= 0;
149 if (cmd
->hdr
.return_code
)
150 QETH_DBF_MESSAGE(2, "Could not set group MAC %pM on %s: %x\n",
151 mac
, QETH_CARD_IFNAME(card
), cmd
->hdr
.return_code
);
155 static int qeth_l2_send_setgroupmac(struct qeth_card
*card
, __u8
*mac
)
157 QETH_CARD_TEXT(card
, 2, "L2Sgmac");
158 return qeth_l2_send_setdelmac(card
, mac
, IPA_CMD_SETGMAC
,
159 qeth_l2_send_setgroupmac_cb
);
162 static int qeth_l2_send_delgroupmac_cb(struct qeth_card
*card
,
163 struct qeth_reply
*reply
,
166 struct qeth_ipa_cmd
*cmd
;
169 QETH_CARD_TEXT(card
, 2, "L2Dgmacb");
170 cmd
= (struct qeth_ipa_cmd
*) data
;
171 mac
= &cmd
->data
.setdelmac
.mac
[0];
172 if (cmd
->hdr
.return_code
)
173 QETH_DBF_MESSAGE(2, "Could not delete group MAC %pM on %s: %x\n",
174 mac
, QETH_CARD_IFNAME(card
), cmd
->hdr
.return_code
);
178 static int qeth_l2_send_delgroupmac(struct qeth_card
*card
, __u8
*mac
)
180 QETH_CARD_TEXT(card
, 2, "L2Dgmac");
181 return qeth_l2_send_setdelmac(card
, mac
, IPA_CMD_DELGMAC
,
182 qeth_l2_send_delgroupmac_cb
);
185 static void qeth_l2_add_mc(struct qeth_card
*card
, __u8
*mac
, int vmac
)
187 struct qeth_mc_mac
*mc
;
190 mc
= kmalloc(sizeof(struct qeth_mc_mac
), GFP_ATOMIC
);
195 memcpy(mc
->mc_addr
, mac
, OSA_ADDR_LEN
);
196 mc
->mc_addrlen
= OSA_ADDR_LEN
;
200 rc
= qeth_l2_send_setdelmac(card
, mac
, IPA_CMD_SETVMAC
,
203 rc
= qeth_l2_send_setgroupmac(card
, mac
);
207 list_add_tail(&mc
->list
, &card
->mc_list
);
212 static void qeth_l2_del_all_mc(struct qeth_card
*card
, int del
)
214 struct qeth_mc_mac
*mc
, *tmp
;
216 spin_lock_bh(&card
->mclock
);
217 list_for_each_entry_safe(mc
, tmp
, &card
->mc_list
, list
) {
220 qeth_l2_send_setdelmac(card
, mc
->mc_addr
,
221 IPA_CMD_DELVMAC
, NULL
);
223 qeth_l2_send_delgroupmac(card
, mc
->mc_addr
);
228 spin_unlock_bh(&card
->mclock
);
231 static inline int qeth_l2_get_cast_type(struct qeth_card
*card
,
234 if (card
->info
.type
== QETH_CARD_TYPE_OSN
)
236 if (is_broadcast_ether_addr(skb
->data
))
237 return RTN_BROADCAST
;
238 if (is_multicast_ether_addr(skb
->data
))
239 return RTN_MULTICAST
;
243 static void qeth_l2_fill_header(struct qeth_card
*card
, struct qeth_hdr
*hdr
,
244 struct sk_buff
*skb
, int cast_type
)
246 struct vlan_ethhdr
*veth
= (struct vlan_ethhdr
*)skb_mac_header(skb
);
248 memset(hdr
, 0, sizeof(struct qeth_hdr
));
249 hdr
->hdr
.l2
.id
= QETH_HEADER_TYPE_LAYER2
;
251 /* set byte byte 3 to casting flags */
252 if (cast_type
== RTN_MULTICAST
)
253 hdr
->hdr
.l2
.flags
[2] |= QETH_LAYER2_FLAG_MULTICAST
;
254 else if (cast_type
== RTN_BROADCAST
)
255 hdr
->hdr
.l2
.flags
[2] |= QETH_LAYER2_FLAG_BROADCAST
;
257 hdr
->hdr
.l2
.flags
[2] |= QETH_LAYER2_FLAG_UNICAST
;
259 hdr
->hdr
.l2
.pkt_length
= skb
->len
-QETH_HEADER_SIZE
;
260 /* VSWITCH relies on the VLAN
261 * information to be present in
263 if (veth
->h_vlan_proto
== __constant_htons(ETH_P_8021Q
)) {
264 hdr
->hdr
.l2
.flags
[2] |= QETH_LAYER2_FLAG_VLAN
;
265 hdr
->hdr
.l2
.vlan_id
= ntohs(veth
->h_vlan_TCI
);
269 static int qeth_l2_send_setdelvlan_cb(struct qeth_card
*card
,
270 struct qeth_reply
*reply
, unsigned long data
)
272 struct qeth_ipa_cmd
*cmd
;
274 QETH_CARD_TEXT(card
, 2, "L2sdvcb");
275 cmd
= (struct qeth_ipa_cmd
*) data
;
276 if (cmd
->hdr
.return_code
) {
277 QETH_DBF_MESSAGE(2, "Error in processing VLAN %i on %s: 0x%x. "
278 "Continuing\n", cmd
->data
.setdelvlan
.vlan_id
,
279 QETH_CARD_IFNAME(card
), cmd
->hdr
.return_code
);
280 QETH_CARD_TEXT_(card
, 2, "L2VL%4x", cmd
->hdr
.command
);
281 QETH_CARD_TEXT_(card
, 2, "err%d", cmd
->hdr
.return_code
);
286 static int qeth_l2_send_setdelvlan(struct qeth_card
*card
, __u16 i
,
287 enum qeth_ipa_cmds ipacmd
)
289 struct qeth_ipa_cmd
*cmd
;
290 struct qeth_cmd_buffer
*iob
;
292 QETH_CARD_TEXT_(card
, 4, "L2sdv%x", ipacmd
);
293 iob
= qeth_get_ipacmd_buffer(card
, ipacmd
, QETH_PROT_IPV4
);
294 cmd
= (struct qeth_ipa_cmd
*)(iob
->data
+IPA_PDU_HEADER_SIZE
);
295 cmd
->data
.setdelvlan
.vlan_id
= i
;
296 return qeth_send_ipa_cmd(card
, iob
,
297 qeth_l2_send_setdelvlan_cb
, NULL
);
300 static void qeth_l2_process_vlans(struct qeth_card
*card
)
302 struct qeth_vlan_vid
*id
;
303 QETH_CARD_TEXT(card
, 3, "L2prcvln");
304 spin_lock_bh(&card
->vlanlock
);
305 list_for_each_entry(id
, &card
->vid_list
, list
) {
306 qeth_l2_send_setdelvlan(card
, id
->vid
, IPA_CMD_SETVLAN
);
308 spin_unlock_bh(&card
->vlanlock
);
311 static int qeth_l2_vlan_rx_add_vid(struct net_device
*dev
,
312 __be16 proto
, u16 vid
)
314 struct qeth_card
*card
= dev
->ml_priv
;
315 struct qeth_vlan_vid
*id
;
317 QETH_CARD_TEXT_(card
, 4, "aid:%d", vid
);
320 if (card
->info
.type
== QETH_CARD_TYPE_OSM
) {
321 QETH_CARD_TEXT(card
, 3, "aidOSM");
324 if (qeth_wait_for_threads(card
, QETH_RECOVER_THREAD
)) {
325 QETH_CARD_TEXT(card
, 3, "aidREC");
328 id
= kmalloc(sizeof(struct qeth_vlan_vid
), GFP_ATOMIC
);
331 qeth_l2_send_setdelvlan(card
, vid
, IPA_CMD_SETVLAN
);
332 spin_lock_bh(&card
->vlanlock
);
333 list_add_tail(&id
->list
, &card
->vid_list
);
334 spin_unlock_bh(&card
->vlanlock
);
341 static int qeth_l2_vlan_rx_kill_vid(struct net_device
*dev
,
342 __be16 proto
, u16 vid
)
344 struct qeth_vlan_vid
*id
, *tmpid
= NULL
;
345 struct qeth_card
*card
= dev
->ml_priv
;
347 QETH_CARD_TEXT_(card
, 4, "kid:%d", vid
);
348 if (card
->info
.type
== QETH_CARD_TYPE_OSM
) {
349 QETH_CARD_TEXT(card
, 3, "kidOSM");
352 if (qeth_wait_for_threads(card
, QETH_RECOVER_THREAD
)) {
353 QETH_CARD_TEXT(card
, 3, "kidREC");
356 spin_lock_bh(&card
->vlanlock
);
357 list_for_each_entry(id
, &card
->vid_list
, list
) {
358 if (id
->vid
== vid
) {
364 spin_unlock_bh(&card
->vlanlock
);
366 qeth_l2_send_setdelvlan(card
, vid
, IPA_CMD_DELVLAN
);
369 qeth_l2_set_multicast_list(card
->dev
);
373 static int qeth_l2_stop_card(struct qeth_card
*card
, int recovery_mode
)
377 QETH_DBF_TEXT(SETUP
, 2, "stopcard");
378 QETH_DBF_HEX(SETUP
, 2, &card
, sizeof(void *));
380 qeth_set_allowed_threads(card
, 0, 1);
381 if (card
->read
.state
== CH_STATE_UP
&&
382 card
->write
.state
== CH_STATE_UP
&&
383 (card
->state
== CARD_STATE_UP
)) {
385 card
->info
.type
!= QETH_CARD_TYPE_OSN
) {
386 qeth_l2_stop(card
->dev
);
389 dev_close(card
->dev
);
392 card
->info
.mac_bits
&= ~QETH_LAYER2_MAC_REGISTERED
;
393 card
->state
= CARD_STATE_SOFTSETUP
;
395 if (card
->state
== CARD_STATE_SOFTSETUP
) {
396 qeth_l2_del_all_mc(card
, 0);
397 qeth_clear_ipacmd_list(card
);
398 card
->state
= CARD_STATE_HARDSETUP
;
400 if (card
->state
== CARD_STATE_HARDSETUP
) {
401 qeth_qdio_clear_card(card
, 0);
402 qeth_clear_qdio_buffers(card
);
403 qeth_clear_working_pool_list(card
);
404 card
->state
= CARD_STATE_DOWN
;
406 if (card
->state
== CARD_STATE_DOWN
) {
407 qeth_clear_cmd_buffers(&card
->read
);
408 qeth_clear_cmd_buffers(&card
->write
);
413 static int qeth_l2_process_inbound_buffer(struct qeth_card
*card
,
414 int budget
, int *done
)
418 struct qeth_hdr
*hdr
;
422 WARN_ON_ONCE(!budget
);
424 skb
= qeth_core_get_next_skb(card
,
425 &card
->qdio
.in_q
->bufs
[card
->rx
.b_index
],
426 &card
->rx
.b_element
, &card
->rx
.e_offset
, &hdr
);
431 skb
->dev
= card
->dev
;
432 switch (hdr
->hdr
.l2
.id
) {
433 case QETH_HEADER_TYPE_LAYER2
:
434 skb
->pkt_type
= PACKET_HOST
;
435 skb
->protocol
= eth_type_trans(skb
, skb
->dev
);
436 skb
->ip_summed
= CHECKSUM_NONE
;
437 if (skb
->protocol
== htons(ETH_P_802_2
))
438 *((__u32
*)skb
->cb
) = ++card
->seqno
.pkt_seqno
;
440 netif_receive_skb(skb
);
442 case QETH_HEADER_TYPE_OSN
:
443 if (card
->info
.type
== QETH_CARD_TYPE_OSN
) {
444 skb_push(skb
, sizeof(struct qeth_hdr
));
445 skb_copy_to_linear_data(skb
, hdr
,
446 sizeof(struct qeth_hdr
));
448 card
->osn_info
.data_cb(skb
);
453 dev_kfree_skb_any(skb
);
454 QETH_CARD_TEXT(card
, 3, "inbunkno");
455 QETH_DBF_HEX(CTRL
, 3, hdr
, QETH_DBF_CTRL_LEN
);
460 card
->stats
.rx_packets
++;
461 card
->stats
.rx_bytes
+= len
;
466 static int qeth_l2_poll(struct napi_struct
*napi
, int budget
)
468 struct qeth_card
*card
= container_of(napi
, struct qeth_card
, napi
);
470 struct qeth_qdio_buffer
*buffer
;
472 int new_budget
= budget
;
474 if (card
->options
.performance_stats
) {
475 card
->perf_stats
.inbound_cnt
++;
476 card
->perf_stats
.inbound_start_time
= qeth_get_micros();
480 if (!card
->rx
.b_count
) {
481 card
->rx
.qdio_err
= 0;
482 card
->rx
.b_count
= qdio_get_next_buffers(
483 card
->data
.ccwdev
, 0, &card
->rx
.b_index
,
485 if (card
->rx
.b_count
<= 0) {
486 card
->rx
.b_count
= 0;
490 &card
->qdio
.in_q
->bufs
[card
->rx
.b_index
]
492 card
->rx
.e_offset
= 0;
495 while (card
->rx
.b_count
) {
496 buffer
= &card
->qdio
.in_q
->bufs
[card
->rx
.b_index
];
497 if (!(card
->rx
.qdio_err
&&
498 qeth_check_qdio_errors(card
, buffer
->buffer
,
499 card
->rx
.qdio_err
, "qinerr")))
500 work_done
+= qeth_l2_process_inbound_buffer(
501 card
, new_budget
, &done
);
506 if (card
->options
.performance_stats
)
507 card
->perf_stats
.bufs_rec
++;
508 qeth_put_buffer_pool_entry(card
,
510 qeth_queue_input_buffer(card
, card
->rx
.b_index
);
512 if (card
->rx
.b_count
) {
514 (card
->rx
.b_index
+ 1) %
515 QDIO_MAX_BUFFERS_PER_Q
;
518 ->bufs
[card
->rx
.b_index
]
520 card
->rx
.e_offset
= 0;
524 if (work_done
>= budget
)
527 new_budget
= budget
- work_done
;
532 if (qdio_start_irq(card
->data
.ccwdev
, 0))
533 napi_schedule(&card
->napi
);
535 if (card
->options
.performance_stats
)
536 card
->perf_stats
.inbound_time
+= qeth_get_micros() -
537 card
->perf_stats
.inbound_start_time
;
541 static int qeth_l2_send_setdelmac(struct qeth_card
*card
, __u8
*mac
,
542 enum qeth_ipa_cmds ipacmd
,
543 int (*reply_cb
) (struct qeth_card
*,
547 struct qeth_ipa_cmd
*cmd
;
548 struct qeth_cmd_buffer
*iob
;
550 QETH_CARD_TEXT(card
, 2, "L2sdmac");
551 iob
= qeth_get_ipacmd_buffer(card
, ipacmd
, QETH_PROT_IPV4
);
552 cmd
= (struct qeth_ipa_cmd
*)(iob
->data
+IPA_PDU_HEADER_SIZE
);
553 cmd
->data
.setdelmac
.mac_length
= OSA_ADDR_LEN
;
554 memcpy(&cmd
->data
.setdelmac
.mac
, mac
, OSA_ADDR_LEN
);
555 return qeth_send_ipa_cmd(card
, iob
, reply_cb
, NULL
);
558 static int qeth_l2_send_setmac_cb(struct qeth_card
*card
,
559 struct qeth_reply
*reply
,
562 struct qeth_ipa_cmd
*cmd
;
564 QETH_CARD_TEXT(card
, 2, "L2Smaccb");
565 cmd
= (struct qeth_ipa_cmd
*) data
;
566 if (cmd
->hdr
.return_code
) {
567 QETH_CARD_TEXT_(card
, 2, "L2er%x", cmd
->hdr
.return_code
);
568 card
->info
.mac_bits
&= ~QETH_LAYER2_MAC_REGISTERED
;
569 switch (cmd
->hdr
.return_code
) {
570 case IPA_RC_L2_DUP_MAC
:
571 case IPA_RC_L2_DUP_LAYER3_MAC
:
572 dev_warn(&card
->gdev
->dev
,
573 "MAC address %pM already exists\n",
574 cmd
->data
.setdelmac
.mac
);
576 case IPA_RC_L2_MAC_NOT_AUTH_BY_HYP
:
577 case IPA_RC_L2_MAC_NOT_AUTH_BY_ADP
:
578 dev_warn(&card
->gdev
->dev
,
579 "MAC address %pM is not authorized\n",
580 cmd
->data
.setdelmac
.mac
);
586 card
->info
.mac_bits
|= QETH_LAYER2_MAC_REGISTERED
;
587 memcpy(card
->dev
->dev_addr
, cmd
->data
.setdelmac
.mac
,
589 dev_info(&card
->gdev
->dev
,
590 "MAC address %pM successfully registered on device %s\n",
591 card
->dev
->dev_addr
, card
->dev
->name
);
596 static int qeth_l2_send_setmac(struct qeth_card
*card
, __u8
*mac
)
598 QETH_CARD_TEXT(card
, 2, "L2Setmac");
599 return qeth_l2_send_setdelmac(card
, mac
, IPA_CMD_SETVMAC
,
600 qeth_l2_send_setmac_cb
);
603 static int qeth_l2_send_delmac_cb(struct qeth_card
*card
,
604 struct qeth_reply
*reply
,
607 struct qeth_ipa_cmd
*cmd
;
609 QETH_CARD_TEXT(card
, 2, "L2Dmaccb");
610 cmd
= (struct qeth_ipa_cmd
*) data
;
611 if (cmd
->hdr
.return_code
) {
612 QETH_CARD_TEXT_(card
, 2, "err%d", cmd
->hdr
.return_code
);
615 card
->info
.mac_bits
&= ~QETH_LAYER2_MAC_REGISTERED
;
620 static int qeth_l2_send_delmac(struct qeth_card
*card
, __u8
*mac
)
622 QETH_CARD_TEXT(card
, 2, "L2Delmac");
623 if (!(card
->info
.mac_bits
& QETH_LAYER2_MAC_REGISTERED
))
625 return qeth_l2_send_setdelmac(card
, mac
, IPA_CMD_DELVMAC
,
626 qeth_l2_send_delmac_cb
);
629 static int qeth_l2_request_initial_mac(struct qeth_card
*card
)
632 char vendor_pre
[] = {0x02, 0x00, 0x00};
634 QETH_DBF_TEXT(SETUP
, 2, "doL2init");
635 QETH_DBF_TEXT_(SETUP
, 2, "doL2%s", CARD_BUS_ID(card
));
637 if (qeth_is_supported(card
, IPA_SETADAPTERPARMS
)) {
638 rc
= qeth_query_setadapterparms(card
);
640 QETH_DBF_MESSAGE(2, "could not query adapter "
641 "parameters on device %s: x%x\n",
642 CARD_BUS_ID(card
), rc
);
646 if (card
->info
.type
== QETH_CARD_TYPE_IQD
||
647 card
->info
.type
== QETH_CARD_TYPE_OSM
||
648 card
->info
.type
== QETH_CARD_TYPE_OSX
||
649 card
->info
.guestlan
) {
650 rc
= qeth_setadpparms_change_macaddr(card
);
652 QETH_DBF_MESSAGE(2, "couldn't get MAC address on "
653 "device %s: x%x\n", CARD_BUS_ID(card
), rc
);
654 QETH_DBF_TEXT_(SETUP
, 2, "1err%d", rc
);
657 QETH_DBF_HEX(SETUP
, 2, card
->dev
->dev_addr
, OSA_ADDR_LEN
);
659 eth_random_addr(card
->dev
->dev_addr
);
660 memcpy(card
->dev
->dev_addr
, vendor_pre
, 3);
665 static int qeth_l2_set_mac_address(struct net_device
*dev
, void *p
)
667 struct sockaddr
*addr
= p
;
668 struct qeth_card
*card
= dev
->ml_priv
;
671 QETH_CARD_TEXT(card
, 3, "setmac");
673 if (qeth_l2_verify_dev(dev
) != QETH_REAL_CARD
) {
674 QETH_CARD_TEXT(card
, 3, "setmcINV");
678 if (card
->info
.type
== QETH_CARD_TYPE_OSN
||
679 card
->info
.type
== QETH_CARD_TYPE_OSM
||
680 card
->info
.type
== QETH_CARD_TYPE_OSX
) {
681 QETH_CARD_TEXT(card
, 3, "setmcTYP");
684 QETH_CARD_HEX(card
, 3, addr
->sa_data
, OSA_ADDR_LEN
);
685 if (qeth_wait_for_threads(card
, QETH_RECOVER_THREAD
)) {
686 QETH_CARD_TEXT(card
, 3, "setmcREC");
689 rc
= qeth_l2_send_delmac(card
, &card
->dev
->dev_addr
[0]);
690 if (!rc
|| (rc
== IPA_RC_L2_MAC_NOT_FOUND
))
691 rc
= qeth_l2_send_setmac(card
, addr
->sa_data
);
692 return rc
? -EINVAL
: 0;
695 static void qeth_l2_set_multicast_list(struct net_device
*dev
)
697 struct qeth_card
*card
= dev
->ml_priv
;
698 struct netdev_hw_addr
*ha
;
700 if (card
->info
.type
== QETH_CARD_TYPE_OSN
)
703 QETH_CARD_TEXT(card
, 3, "setmulti");
704 if (qeth_threads_running(card
, QETH_RECOVER_THREAD
) &&
705 (card
->state
!= CARD_STATE_UP
))
707 qeth_l2_del_all_mc(card
, 1);
708 spin_lock_bh(&card
->mclock
);
709 netdev_for_each_mc_addr(ha
, dev
)
710 qeth_l2_add_mc(card
, ha
->addr
, 0);
712 netdev_for_each_uc_addr(ha
, dev
)
713 qeth_l2_add_mc(card
, ha
->addr
, 1);
715 spin_unlock_bh(&card
->mclock
);
716 if (!qeth_adp_supported(card
, IPA_SETADP_SET_PROMISC_MODE
))
718 qeth_setadp_promisc_mode(card
);
721 static int qeth_l2_hard_start_xmit(struct sk_buff
*skb
, struct net_device
*dev
)
724 struct qeth_hdr
*hdr
= NULL
;
726 struct qeth_card
*card
= dev
->ml_priv
;
727 struct sk_buff
*new_skb
= skb
;
728 int cast_type
= qeth_l2_get_cast_type(card
, skb
);
729 struct qeth_qdio_out_q
*queue
;
730 int tx_bytes
= skb
->len
;
731 int data_offset
= -1;
732 int elements_needed
= 0;
735 if (card
->qdio
.do_prio_queueing
|| (cast_type
&&
736 card
->info
.is_multicast_different
))
737 queue
= card
->qdio
.out_qs
[qeth_get_priority_queue(card
, skb
,
738 qeth_get_ip_version(skb
), cast_type
)];
740 queue
= card
->qdio
.out_qs
[card
->qdio
.default_out_queue
];
742 if ((card
->state
!= CARD_STATE_UP
) || !card
->lan_online
) {
743 card
->stats
.tx_carrier_errors
++;
747 if ((card
->info
.type
== QETH_CARD_TYPE_OSN
) &&
748 (skb
->protocol
== htons(ETH_P_IPV6
)))
751 if (card
->options
.performance_stats
) {
752 card
->perf_stats
.outbound_cnt
++;
753 card
->perf_stats
.outbound_start_time
= qeth_get_micros();
755 netif_stop_queue(dev
);
757 if (card
->info
.type
== QETH_CARD_TYPE_OSN
)
758 hdr
= (struct qeth_hdr
*)skb
->data
;
760 if (card
->info
.type
== QETH_CARD_TYPE_IQD
) {
762 data_offset
= ETH_HLEN
;
764 hdr
= kmem_cache_alloc(qeth_core_header_cache
,
769 skb_reset_mac_header(new_skb
);
770 qeth_l2_fill_header(card
, hdr
, new_skb
, cast_type
);
771 hdr
->hdr
.l2
.pkt_length
= new_skb
->len
;
772 memcpy(((char *)hdr
) + sizeof(struct qeth_hdr
),
773 skb_mac_header(new_skb
), ETH_HLEN
);
775 /* create a clone with writeable headroom */
776 new_skb
= skb_realloc_headroom(skb
,
777 sizeof(struct qeth_hdr
));
780 hdr
= (struct qeth_hdr
*)skb_push(new_skb
,
781 sizeof(struct qeth_hdr
));
782 skb_set_mac_header(new_skb
, sizeof(struct qeth_hdr
));
783 qeth_l2_fill_header(card
, hdr
, new_skb
, cast_type
);
787 elements
= qeth_get_elements_no(card
, new_skb
, elements_needed
);
789 if (data_offset
>= 0)
790 kmem_cache_free(qeth_core_header_cache
, hdr
);
794 if (card
->info
.type
!= QETH_CARD_TYPE_IQD
) {
795 if (qeth_hdr_chk_and_bounce(new_skb
, &hdr
,
796 sizeof(struct qeth_hdr_layer2
)))
798 rc
= qeth_do_send_packet(card
, queue
, new_skb
, hdr
,
801 rc
= qeth_do_send_packet_fast(card
, queue
, new_skb
, hdr
,
802 elements
, data_offset
, hd_len
);
804 card
->stats
.tx_packets
++;
805 card
->stats
.tx_bytes
+= tx_bytes
;
807 dev_kfree_skb_any(skb
);
810 if (data_offset
>= 0)
811 kmem_cache_free(qeth_core_header_cache
, hdr
);
815 dev_kfree_skb_any(new_skb
);
816 return NETDEV_TX_BUSY
;
821 netif_wake_queue(dev
);
822 if (card
->options
.performance_stats
)
823 card
->perf_stats
.outbound_time
+= qeth_get_micros() -
824 card
->perf_stats
.outbound_start_time
;
828 card
->stats
.tx_dropped
++;
829 card
->stats
.tx_errors
++;
830 if ((new_skb
!= skb
) && new_skb
)
831 dev_kfree_skb_any(new_skb
);
832 dev_kfree_skb_any(skb
);
833 netif_wake_queue(dev
);
837 static int __qeth_l2_open(struct net_device
*dev
)
839 struct qeth_card
*card
= dev
->ml_priv
;
842 QETH_CARD_TEXT(card
, 4, "qethopen");
843 if (card
->state
== CARD_STATE_UP
)
845 if (card
->state
!= CARD_STATE_SOFTSETUP
)
848 if ((card
->info
.type
!= QETH_CARD_TYPE_OSN
) &&
849 (!(card
->info
.mac_bits
& QETH_LAYER2_MAC_REGISTERED
))) {
850 QETH_CARD_TEXT(card
, 4, "nomacadr");
853 card
->data
.state
= CH_STATE_UP
;
854 card
->state
= CARD_STATE_UP
;
855 netif_start_queue(dev
);
857 if (qdio_stop_irq(card
->data
.ccwdev
, 0) >= 0) {
858 napi_enable(&card
->napi
);
859 napi_schedule(&card
->napi
);
865 static int qeth_l2_open(struct net_device
*dev
)
867 struct qeth_card
*card
= dev
->ml_priv
;
869 QETH_CARD_TEXT(card
, 5, "qethope_");
870 if (qeth_wait_for_threads(card
, QETH_RECOVER_THREAD
)) {
871 QETH_CARD_TEXT(card
, 3, "openREC");
874 return __qeth_l2_open(dev
);
877 static int qeth_l2_stop(struct net_device
*dev
)
879 struct qeth_card
*card
= dev
->ml_priv
;
881 QETH_CARD_TEXT(card
, 4, "qethstop");
882 netif_tx_disable(dev
);
883 if (card
->state
== CARD_STATE_UP
) {
884 card
->state
= CARD_STATE_SOFTSETUP
;
885 napi_disable(&card
->napi
);
890 static int qeth_l2_probe_device(struct ccwgroup_device
*gdev
)
892 struct qeth_card
*card
= dev_get_drvdata(&gdev
->dev
);
894 qeth_l2_create_device_attributes(&gdev
->dev
);
895 INIT_LIST_HEAD(&card
->vid_list
);
896 INIT_LIST_HEAD(&card
->mc_list
);
897 card
->options
.layer2
= 1;
898 card
->info
.hwtrap
= 0;
902 static void qeth_l2_remove_device(struct ccwgroup_device
*cgdev
)
904 struct qeth_card
*card
= dev_get_drvdata(&cgdev
->dev
);
906 qeth_l2_remove_device_attributes(&cgdev
->dev
);
907 qeth_set_allowed_threads(card
, 0, 1);
908 wait_event(card
->wait_q
, qeth_threads_running(card
, 0xffffffff) == 0);
910 if (cgdev
->state
== CCWGROUP_ONLINE
)
911 qeth_l2_set_offline(cgdev
);
914 unregister_netdev(card
->dev
);
920 static const struct ethtool_ops qeth_l2_ethtool_ops
= {
921 .get_link
= ethtool_op_get_link
,
922 .get_strings
= qeth_core_get_strings
,
923 .get_ethtool_stats
= qeth_core_get_ethtool_stats
,
924 .get_sset_count
= qeth_core_get_sset_count
,
925 .get_drvinfo
= qeth_core_get_drvinfo
,
926 .get_settings
= qeth_core_ethtool_get_settings
,
929 static const struct ethtool_ops qeth_l2_osn_ops
= {
930 .get_strings
= qeth_core_get_strings
,
931 .get_ethtool_stats
= qeth_core_get_ethtool_stats
,
932 .get_sset_count
= qeth_core_get_sset_count
,
933 .get_drvinfo
= qeth_core_get_drvinfo
,
936 static const struct net_device_ops qeth_l2_netdev_ops
= {
937 .ndo_open
= qeth_l2_open
,
938 .ndo_stop
= qeth_l2_stop
,
939 .ndo_get_stats
= qeth_get_stats
,
940 .ndo_start_xmit
= qeth_l2_hard_start_xmit
,
941 .ndo_validate_addr
= eth_validate_addr
,
942 .ndo_set_rx_mode
= qeth_l2_set_multicast_list
,
943 .ndo_do_ioctl
= qeth_l2_do_ioctl
,
944 .ndo_set_mac_address
= qeth_l2_set_mac_address
,
945 .ndo_change_mtu
= qeth_change_mtu
,
946 .ndo_vlan_rx_add_vid
= qeth_l2_vlan_rx_add_vid
,
947 .ndo_vlan_rx_kill_vid
= qeth_l2_vlan_rx_kill_vid
,
948 .ndo_tx_timeout
= qeth_tx_timeout
,
951 static int qeth_l2_setup_netdev(struct qeth_card
*card
)
953 switch (card
->info
.type
) {
954 case QETH_CARD_TYPE_IQD
:
955 card
->dev
= alloc_netdev(0, "hsi%d", NET_NAME_UNKNOWN
,
958 case QETH_CARD_TYPE_OSN
:
959 card
->dev
= alloc_netdev(0, "osn%d", NET_NAME_UNKNOWN
,
961 card
->dev
->flags
|= IFF_NOARP
;
964 card
->dev
= alloc_etherdev(0);
970 card
->dev
->ml_priv
= card
;
971 card
->dev
->watchdog_timeo
= QETH_TX_TIMEOUT
;
972 card
->dev
->mtu
= card
->info
.initial_mtu
;
973 card
->dev
->netdev_ops
= &qeth_l2_netdev_ops
;
974 card
->dev
->ethtool_ops
=
975 (card
->info
.type
!= QETH_CARD_TYPE_OSN
) ?
976 &qeth_l2_ethtool_ops
: &qeth_l2_osn_ops
;
977 card
->dev
->features
|= NETIF_F_HW_VLAN_CTAG_FILTER
;
978 card
->info
.broadcast_capable
= 1;
979 qeth_l2_request_initial_mac(card
);
980 SET_NETDEV_DEV(card
->dev
, &card
->gdev
->dev
);
981 netif_napi_add(card
->dev
, &card
->napi
, qeth_l2_poll
, QETH_NAPI_WEIGHT
);
982 return register_netdev(card
->dev
);
985 static int __qeth_l2_set_online(struct ccwgroup_device
*gdev
, int recovery_mode
)
987 struct qeth_card
*card
= dev_get_drvdata(&gdev
->dev
);
989 enum qeth_card_states recover_flag
;
991 mutex_lock(&card
->discipline_mutex
);
992 mutex_lock(&card
->conf_mutex
);
993 QETH_DBF_TEXT(SETUP
, 2, "setonlin");
994 QETH_DBF_HEX(SETUP
, 2, &card
, sizeof(void *));
996 recover_flag
= card
->state
;
997 rc
= qeth_core_hardsetup_card(card
);
999 QETH_DBF_TEXT_(SETUP
, 2, "2err%d", rc
);
1003 qeth_bridgeport_query_support(card
);
1004 if (card
->options
.sbp
.supported_funcs
)
1005 dev_info(&card
->gdev
->dev
,
1006 "The device represents a HiperSockets Bridge Capable Port\n");
1007 qeth_trace_features(card
);
1009 if (!card
->dev
&& qeth_l2_setup_netdev(card
)) {
1014 if (card
->info
.type
!= QETH_CARD_TYPE_OSN
)
1015 qeth_l2_send_setmac(card
, &card
->dev
->dev_addr
[0]);
1017 if (qeth_is_diagass_supported(card
, QETH_DIAGS_CMD_TRAP
)) {
1018 if (card
->info
.hwtrap
&&
1019 qeth_hw_trap(card
, QETH_DIAGS_TRAP_ARM
))
1020 card
->info
.hwtrap
= 0;
1022 card
->info
.hwtrap
= 0;
1024 qeth_l2_setup_bridgeport_attrs(card
);
1026 card
->state
= CARD_STATE_HARDSETUP
;
1027 memset(&card
->rx
, 0, sizeof(struct qeth_rx
));
1028 qeth_print_status_message(card
);
1031 QETH_DBF_TEXT(SETUP
, 2, "softsetp");
1033 rc
= qeth_send_startlan(card
);
1035 QETH_DBF_TEXT_(SETUP
, 2, "1err%d", rc
);
1037 dev_warn(&card
->gdev
->dev
,
1038 "The LAN is offline\n");
1039 card
->lan_online
= 0;
1045 card
->lan_online
= 1;
1048 if ((card
->info
.type
== QETH_CARD_TYPE_OSD
) ||
1049 (card
->info
.type
== QETH_CARD_TYPE_OSX
)) {
1050 /* configure isolation level */
1051 rc
= qeth_set_access_ctrl_online(card
, 0);
1058 if (card
->info
.type
!= QETH_CARD_TYPE_OSN
&&
1059 card
->info
.type
!= QETH_CARD_TYPE_OSM
)
1060 qeth_l2_process_vlans(card
);
1062 netif_tx_disable(card
->dev
);
1064 rc
= qeth_init_qdio_queues(card
);
1066 QETH_DBF_TEXT_(SETUP
, 2, "6err%d", rc
);
1070 card
->state
= CARD_STATE_SOFTSETUP
;
1071 if (card
->lan_online
)
1072 netif_carrier_on(card
->dev
);
1074 netif_carrier_off(card
->dev
);
1076 qeth_set_allowed_threads(card
, 0xffffffff, 0);
1077 if (recover_flag
== CARD_STATE_RECOVER
) {
1078 if (recovery_mode
&&
1079 card
->info
.type
!= QETH_CARD_TYPE_OSN
) {
1080 __qeth_l2_open(card
->dev
);
1083 dev_open(card
->dev
);
1086 /* this also sets saved unicast addresses */
1087 qeth_l2_set_multicast_list(card
->dev
);
1089 /* let user_space know that device is online */
1090 kobject_uevent(&gdev
->dev
.kobj
, KOBJ_CHANGE
);
1091 mutex_unlock(&card
->conf_mutex
);
1092 mutex_unlock(&card
->discipline_mutex
);
1096 qeth_l2_stop_card(card
, 0);
1097 ccw_device_set_offline(CARD_DDEV(card
));
1098 ccw_device_set_offline(CARD_WDEV(card
));
1099 ccw_device_set_offline(CARD_RDEV(card
));
1100 qdio_free(CARD_DDEV(card
));
1101 if (recover_flag
== CARD_STATE_RECOVER
)
1102 card
->state
= CARD_STATE_RECOVER
;
1104 card
->state
= CARD_STATE_DOWN
;
1105 mutex_unlock(&card
->conf_mutex
);
1106 mutex_unlock(&card
->discipline_mutex
);
1110 static int qeth_l2_set_online(struct ccwgroup_device
*gdev
)
1112 return __qeth_l2_set_online(gdev
, 0);
1115 static int __qeth_l2_set_offline(struct ccwgroup_device
*cgdev
,
1118 struct qeth_card
*card
= dev_get_drvdata(&cgdev
->dev
);
1119 int rc
= 0, rc2
= 0, rc3
= 0;
1120 enum qeth_card_states recover_flag
;
1122 mutex_lock(&card
->discipline_mutex
);
1123 mutex_lock(&card
->conf_mutex
);
1124 QETH_DBF_TEXT(SETUP
, 3, "setoffl");
1125 QETH_DBF_HEX(SETUP
, 3, &card
, sizeof(void *));
1127 if (card
->dev
&& netif_carrier_ok(card
->dev
))
1128 netif_carrier_off(card
->dev
);
1129 recover_flag
= card
->state
;
1130 if ((!recovery_mode
&& card
->info
.hwtrap
) || card
->info
.hwtrap
== 2) {
1131 qeth_hw_trap(card
, QETH_DIAGS_TRAP_DISARM
);
1132 card
->info
.hwtrap
= 1;
1134 qeth_l2_stop_card(card
, recovery_mode
);
1135 rc
= ccw_device_set_offline(CARD_DDEV(card
));
1136 rc2
= ccw_device_set_offline(CARD_WDEV(card
));
1137 rc3
= ccw_device_set_offline(CARD_RDEV(card
));
1139 rc
= (rc2
) ? rc2
: rc3
;
1141 QETH_DBF_TEXT_(SETUP
, 2, "1err%d", rc
);
1142 qdio_free(CARD_DDEV(card
));
1143 if (recover_flag
== CARD_STATE_UP
)
1144 card
->state
= CARD_STATE_RECOVER
;
1145 /* let user_space know that device is offline */
1146 kobject_uevent(&cgdev
->dev
.kobj
, KOBJ_CHANGE
);
1147 mutex_unlock(&card
->conf_mutex
);
1148 mutex_unlock(&card
->discipline_mutex
);
1152 static int qeth_l2_set_offline(struct ccwgroup_device
*cgdev
)
1154 return __qeth_l2_set_offline(cgdev
, 0);
1157 static int qeth_l2_recover(void *ptr
)
1159 struct qeth_card
*card
;
1162 card
= (struct qeth_card
*) ptr
;
1163 QETH_CARD_TEXT(card
, 2, "recover1");
1164 if (!qeth_do_run_thread(card
, QETH_RECOVER_THREAD
))
1166 QETH_CARD_TEXT(card
, 2, "recover2");
1167 dev_warn(&card
->gdev
->dev
,
1168 "A recovery process has been started for the device\n");
1169 qeth_set_recovery_task(card
);
1170 __qeth_l2_set_offline(card
->gdev
, 1);
1171 rc
= __qeth_l2_set_online(card
->gdev
, 1);
1173 dev_info(&card
->gdev
->dev
,
1174 "Device successfully recovered!\n");
1176 qeth_close_dev(card
);
1177 dev_warn(&card
->gdev
->dev
, "The qeth device driver "
1178 "failed to recover an error on the device\n");
1180 qeth_clear_recovery_task(card
);
1181 qeth_clear_thread_start_bit(card
, QETH_RECOVER_THREAD
);
1182 qeth_clear_thread_running_bit(card
, QETH_RECOVER_THREAD
);
1186 static int __init
qeth_l2_init(void)
1188 pr_info("register layer 2 discipline\n");
1192 static void __exit
qeth_l2_exit(void)
1194 pr_info("unregister layer 2 discipline\n");
1197 static void qeth_l2_shutdown(struct ccwgroup_device
*gdev
)
1199 struct qeth_card
*card
= dev_get_drvdata(&gdev
->dev
);
1200 qeth_set_allowed_threads(card
, 0, 1);
1201 if ((gdev
->state
== CCWGROUP_ONLINE
) && card
->info
.hwtrap
)
1202 qeth_hw_trap(card
, QETH_DIAGS_TRAP_DISARM
);
1203 qeth_qdio_clear_card(card
, 0);
1204 qeth_clear_qdio_buffers(card
);
1205 qdio_free(CARD_DDEV(card
));
1208 static int qeth_l2_pm_suspend(struct ccwgroup_device
*gdev
)
1210 struct qeth_card
*card
= dev_get_drvdata(&gdev
->dev
);
1213 netif_device_detach(card
->dev
);
1214 qeth_set_allowed_threads(card
, 0, 1);
1215 wait_event(card
->wait_q
, qeth_threads_running(card
, 0xffffffff) == 0);
1216 if (gdev
->state
== CCWGROUP_OFFLINE
)
1218 if (card
->state
== CARD_STATE_UP
) {
1219 if (card
->info
.hwtrap
)
1220 qeth_hw_trap(card
, QETH_DIAGS_TRAP_DISARM
);
1221 __qeth_l2_set_offline(card
->gdev
, 1);
1223 __qeth_l2_set_offline(card
->gdev
, 0);
1227 static int qeth_l2_pm_resume(struct ccwgroup_device
*gdev
)
1229 struct qeth_card
*card
= dev_get_drvdata(&gdev
->dev
);
1232 if (gdev
->state
== CCWGROUP_OFFLINE
)
1235 if (card
->state
== CARD_STATE_RECOVER
) {
1236 rc
= __qeth_l2_set_online(card
->gdev
, 1);
1239 dev_close(card
->dev
);
1243 rc
= __qeth_l2_set_online(card
->gdev
, 0);
1245 qeth_set_allowed_threads(card
, 0xffffffff, 0);
1247 netif_device_attach(card
->dev
);
1249 dev_warn(&card
->gdev
->dev
, "The qeth device driver "
1250 "failed to recover an error on the device\n");
1254 /* Returns zero if the command is successfully "consumed" */
1255 static int qeth_l2_control_event(struct qeth_card
*card
,
1256 struct qeth_ipa_cmd
*cmd
)
1258 switch (cmd
->hdr
.command
) {
1259 case IPA_CMD_SETBRIDGEPORT
:
1260 if (cmd
->data
.sbp
.hdr
.command_code
==
1261 IPA_SBP_BRIDGE_PORT_STATE_CHANGE
) {
1262 qeth_bridge_state_change(card
, cmd
);
1266 case IPA_CMD_ADDRESS_CHANGE_NOTIF
:
1267 qeth_bridge_host_event(card
, cmd
);
1274 struct qeth_discipline qeth_l2_discipline
= {
1275 .start_poll
= qeth_qdio_start_poll
,
1276 .input_handler
= (qdio_handler_t
*) qeth_qdio_input_handler
,
1277 .output_handler
= (qdio_handler_t
*) qeth_qdio_output_handler
,
1278 .recover
= qeth_l2_recover
,
1279 .setup
= qeth_l2_probe_device
,
1280 .remove
= qeth_l2_remove_device
,
1281 .set_online
= qeth_l2_set_online
,
1282 .set_offline
= qeth_l2_set_offline
,
1283 .shutdown
= qeth_l2_shutdown
,
1284 .freeze
= qeth_l2_pm_suspend
,
1285 .thaw
= qeth_l2_pm_resume
,
1286 .restore
= qeth_l2_pm_resume
,
1287 .control_event_handler
= qeth_l2_control_event
,
1289 EXPORT_SYMBOL_GPL(qeth_l2_discipline
);
1291 static int qeth_osn_send_control_data(struct qeth_card
*card
, int len
,
1292 struct qeth_cmd_buffer
*iob
)
1294 unsigned long flags
;
1297 QETH_CARD_TEXT(card
, 5, "osndctrd");
1299 wait_event(card
->wait_q
,
1300 atomic_cmpxchg(&card
->write
.irq_pending
, 0, 1) == 0);
1301 qeth_prepare_control_data(card
, len
, iob
);
1302 QETH_CARD_TEXT(card
, 6, "osnoirqp");
1303 spin_lock_irqsave(get_ccwdev_lock(card
->write
.ccwdev
), flags
);
1304 rc
= ccw_device_start(card
->write
.ccwdev
, &card
->write
.ccw
,
1305 (addr_t
) iob
, 0, 0);
1306 spin_unlock_irqrestore(get_ccwdev_lock(card
->write
.ccwdev
), flags
);
1308 QETH_DBF_MESSAGE(2, "qeth_osn_send_control_data: "
1309 "ccw_device_start rc = %i\n", rc
);
1310 QETH_CARD_TEXT_(card
, 2, " err%d", rc
);
1311 qeth_release_buffer(iob
->channel
, iob
);
1312 atomic_set(&card
->write
.irq_pending
, 0);
1313 wake_up(&card
->wait_q
);
1318 static int qeth_osn_send_ipa_cmd(struct qeth_card
*card
,
1319 struct qeth_cmd_buffer
*iob
, int data_len
)
1323 QETH_CARD_TEXT(card
, 4, "osndipa");
1325 qeth_prepare_ipa_cmd(card
, iob
, QETH_PROT_OSN2
);
1326 s1
= (u16
)(IPA_PDU_HEADER_SIZE
+ data_len
);
1328 memcpy(QETH_IPA_PDU_LEN_TOTAL(iob
->data
), &s1
, 2);
1329 memcpy(QETH_IPA_PDU_LEN_PDU1(iob
->data
), &s2
, 2);
1330 memcpy(QETH_IPA_PDU_LEN_PDU2(iob
->data
), &s2
, 2);
1331 memcpy(QETH_IPA_PDU_LEN_PDU3(iob
->data
), &s2
, 2);
1332 return qeth_osn_send_control_data(card
, s1
, iob
);
1335 int qeth_osn_assist(struct net_device
*dev
, void *data
, int data_len
)
1337 struct qeth_cmd_buffer
*iob
;
1338 struct qeth_card
*card
;
1343 card
= dev
->ml_priv
;
1346 QETH_CARD_TEXT(card
, 2, "osnsdmc");
1347 if ((card
->state
!= CARD_STATE_UP
) &&
1348 (card
->state
!= CARD_STATE_SOFTSETUP
))
1350 iob
= qeth_wait_for_buffer(&card
->write
);
1351 memcpy(iob
->data
+IPA_PDU_HEADER_SIZE
, data
, data_len
);
1352 rc
= qeth_osn_send_ipa_cmd(card
, iob
, data_len
);
1355 EXPORT_SYMBOL(qeth_osn_assist
);
1357 int qeth_osn_register(unsigned char *read_dev_no
, struct net_device
**dev
,
1358 int (*assist_cb
)(struct net_device
*, void *),
1359 int (*data_cb
)(struct sk_buff
*))
1361 struct qeth_card
*card
;
1363 *dev
= qeth_l2_netdev_by_devno(read_dev_no
);
1366 card
= (*dev
)->ml_priv
;
1369 QETH_CARD_TEXT(card
, 2, "osnreg");
1370 if ((assist_cb
== NULL
) || (data_cb
== NULL
))
1372 card
->osn_info
.assist_cb
= assist_cb
;
1373 card
->osn_info
.data_cb
= data_cb
;
1376 EXPORT_SYMBOL(qeth_osn_register
);
1378 void qeth_osn_deregister(struct net_device
*dev
)
1380 struct qeth_card
*card
;
1384 card
= dev
->ml_priv
;
1387 QETH_CARD_TEXT(card
, 2, "osndereg");
1388 card
->osn_info
.assist_cb
= NULL
;
1389 card
->osn_info
.data_cb
= NULL
;
1392 EXPORT_SYMBOL(qeth_osn_deregister
);
1394 /* SETBRIDGEPORT support, async notifications */
1396 enum qeth_an_event_type
{anev_reg_unreg
, anev_abort
, anev_reset
};
1399 * qeth_bridge_emit_host_event() - bridgeport address change notification
1400 * @card: qeth_card structure pointer, for udev events.
1401 * @evtype: "normal" register/unregister, or abort, or reset. For abort
1402 * and reset token and addr_lnid are unused and may be NULL.
1403 * @code: event bitmask: high order bit 0x80 value 1 means removal of an
1404 * object, 0 - addition of an object.
1405 * 0x01 - VLAN, 0x02 - MAC, 0x03 - VLAN and MAC.
1406 * @token: "network token" structure identifying physical address of the port.
1407 * @addr_lnid: pointer to structure with MAC address and VLAN ID.
1409 * This function is called when registrations and deregistrations are
1410 * reported by the hardware, and also when notifications are enabled -
1411 * for all currently registered addresses.
1413 static void qeth_bridge_emit_host_event(struct qeth_card
*card
,
1414 enum qeth_an_event_type evtype
,
1415 u8 code
, struct net_if_token
*token
, struct mac_addr_lnid
*addr_lnid
)
1422 case anev_reg_unreg
:
1423 snprintf(str
[i
], sizeof(str
[i
]), "BRIDGEDHOST=%s",
1424 (code
& IPA_ADDR_CHANGE_CODE_REMOVAL
)
1425 ? "deregister" : "register");
1426 env
[i
] = str
[i
]; i
++;
1427 if (code
& IPA_ADDR_CHANGE_CODE_VLANID
) {
1428 snprintf(str
[i
], sizeof(str
[i
]), "VLAN=%d",
1430 env
[i
] = str
[i
]; i
++;
1432 if (code
& IPA_ADDR_CHANGE_CODE_MACADDR
) {
1433 snprintf(str
[i
], sizeof(str
[i
]), "MAC=%pM6",
1435 env
[i
] = str
[i
]; i
++;
1437 snprintf(str
[i
], sizeof(str
[i
]), "NTOK_BUSID=%x.%x.%04x",
1438 token
->cssid
, token
->ssid
, token
->devnum
);
1439 env
[i
] = str
[i
]; i
++;
1440 snprintf(str
[i
], sizeof(str
[i
]), "NTOK_IID=%02x", token
->iid
);
1441 env
[i
] = str
[i
]; i
++;
1442 snprintf(str
[i
], sizeof(str
[i
]), "NTOK_CHPID=%02x",
1444 env
[i
] = str
[i
]; i
++;
1445 snprintf(str
[i
], sizeof(str
[i
]), "NTOK_CHID=%04x", token
->chid
);
1446 env
[i
] = str
[i
]; i
++;
1449 snprintf(str
[i
], sizeof(str
[i
]), "BRIDGEDHOST=abort");
1450 env
[i
] = str
[i
]; i
++;
1453 snprintf(str
[i
], sizeof(str
[i
]), "BRIDGEDHOST=reset");
1454 env
[i
] = str
[i
]; i
++;
1458 kobject_uevent_env(&card
->gdev
->dev
.kobj
, KOBJ_CHANGE
, env
);
1461 struct qeth_bridge_state_data
{
1462 struct work_struct worker
;
1463 struct qeth_card
*card
;
1464 struct qeth_sbp_state_change qports
;
1467 static void qeth_bridge_state_change_worker(struct work_struct
*work
)
1469 struct qeth_bridge_state_data
*data
=
1470 container_of(work
, struct qeth_bridge_state_data
, worker
);
1471 /* We are only interested in the first entry - local port */
1472 struct qeth_sbp_port_entry
*entry
= &data
->qports
.entry
[0];
1473 char env_locrem
[32];
1483 /* Role should not change by itself, but if it did, */
1484 /* information from the hardware is authoritative. */
1485 mutex_lock(&data
->card
->conf_mutex
);
1486 data
->card
->options
.sbp
.role
= entry
->role
;
1487 mutex_unlock(&data
->card
->conf_mutex
);
1489 snprintf(env_locrem
, sizeof(env_locrem
), "BRIDGEPORT=statechange");
1490 snprintf(env_role
, sizeof(env_role
), "ROLE=%s",
1491 (entry
->role
== QETH_SBP_ROLE_NONE
) ? "none" :
1492 (entry
->role
== QETH_SBP_ROLE_PRIMARY
) ? "primary" :
1493 (entry
->role
== QETH_SBP_ROLE_SECONDARY
) ? "secondary" :
1495 snprintf(env_state
, sizeof(env_state
), "STATE=%s",
1496 (entry
->state
== QETH_SBP_STATE_INACTIVE
) ? "inactive" :
1497 (entry
->state
== QETH_SBP_STATE_STANDBY
) ? "standby" :
1498 (entry
->state
== QETH_SBP_STATE_ACTIVE
) ? "active" :
1500 kobject_uevent_env(&data
->card
->gdev
->dev
.kobj
,
1505 static void qeth_bridge_state_change(struct qeth_card
*card
,
1506 struct qeth_ipa_cmd
*cmd
)
1508 struct qeth_sbp_state_change
*qports
=
1509 &cmd
->data
.sbp
.data
.state_change
;
1510 struct qeth_bridge_state_data
*data
;
1513 QETH_CARD_TEXT(card
, 2, "brstchng");
1514 if (qports
->entry_length
!= sizeof(struct qeth_sbp_port_entry
)) {
1515 QETH_CARD_TEXT_(card
, 2, "BPsz%04x", qports
->entry_length
);
1518 extrasize
= sizeof(struct qeth_sbp_port_entry
) * qports
->num_entries
;
1519 data
= kzalloc(sizeof(struct qeth_bridge_state_data
) + extrasize
,
1522 QETH_CARD_TEXT(card
, 2, "BPSalloc");
1525 INIT_WORK(&data
->worker
, qeth_bridge_state_change_worker
);
1527 memcpy(&data
->qports
, qports
,
1528 sizeof(struct qeth_sbp_state_change
) + extrasize
);
1529 queue_work(qeth_wq
, &data
->worker
);
1532 struct qeth_bridge_host_data
{
1533 struct work_struct worker
;
1534 struct qeth_card
*card
;
1535 struct qeth_ipacmd_addr_change hostevs
;
1538 static void qeth_bridge_host_event_worker(struct work_struct
*work
)
1540 struct qeth_bridge_host_data
*data
=
1541 container_of(work
, struct qeth_bridge_host_data
, worker
);
1544 if (data
->hostevs
.lost_event_mask
) {
1545 dev_info(&data
->card
->gdev
->dev
,
1546 "Address notification from the HiperSockets Bridge Port stopped %s (%s)\n",
1547 data
->card
->dev
->name
,
1548 (data
->hostevs
.lost_event_mask
== 0x01)
1550 : (data
->hostevs
.lost_event_mask
== 0x02)
1551 ? "Bridge port state change"
1552 : "Unknown reason");
1553 mutex_lock(&data
->card
->conf_mutex
);
1554 data
->card
->options
.sbp
.hostnotification
= 0;
1555 mutex_unlock(&data
->card
->conf_mutex
);
1556 qeth_bridge_emit_host_event(data
->card
, anev_abort
,
1559 for (i
= 0; i
< data
->hostevs
.num_entries
; i
++) {
1560 struct qeth_ipacmd_addr_change_entry
*entry
=
1561 &data
->hostevs
.entry
[i
];
1562 qeth_bridge_emit_host_event(data
->card
,
1565 &entry
->token
, &entry
->addr_lnid
);
1570 static void qeth_bridge_host_event(struct qeth_card
*card
,
1571 struct qeth_ipa_cmd
*cmd
)
1573 struct qeth_ipacmd_addr_change
*hostevs
=
1574 &cmd
->data
.addrchange
;
1575 struct qeth_bridge_host_data
*data
;
1578 QETH_CARD_TEXT(card
, 2, "brhostev");
1579 if (cmd
->hdr
.return_code
!= 0x0000) {
1580 if (cmd
->hdr
.return_code
== 0x0010) {
1581 if (hostevs
->lost_event_mask
== 0x00)
1582 hostevs
->lost_event_mask
= 0xff;
1584 QETH_CARD_TEXT_(card
, 2, "BPHe%04x",
1585 cmd
->hdr
.return_code
);
1589 extrasize
= sizeof(struct qeth_ipacmd_addr_change_entry
) *
1590 hostevs
->num_entries
;
1591 data
= kzalloc(sizeof(struct qeth_bridge_host_data
) + extrasize
,
1594 QETH_CARD_TEXT(card
, 2, "BPHalloc");
1597 INIT_WORK(&data
->worker
, qeth_bridge_host_event_worker
);
1599 memcpy(&data
->hostevs
, hostevs
,
1600 sizeof(struct qeth_ipacmd_addr_change
) + extrasize
);
1601 queue_work(qeth_wq
, &data
->worker
);
1604 /* SETBRIDGEPORT support; sending commands */
1606 struct _qeth_sbp_cbctl
{
1612 enum qeth_sbp_roles
*role
;
1613 enum qeth_sbp_states
*state
;
1619 * qeth_bridgeport_makerc() - derive "traditional" error from hardware codes.
1620 * @card: qeth_card structure pointer, for debug messages.
1621 * @cbctl: state structure with hardware return codes.
1622 * @setcmd: IPA command code
1624 * Returns negative errno-compatible error indication or 0 on success.
1626 static int qeth_bridgeport_makerc(struct qeth_card
*card
,
1627 struct _qeth_sbp_cbctl
*cbctl
, enum qeth_ipa_sbp_cmd setcmd
)
1631 switch (cbctl
->ipa_rc
) {
1632 case IPA_RC_SUCCESS
:
1633 switch (cbctl
->cmd_rc
) {
1640 case 0x000C: /* Not configured as bridge Port */
1641 rc
= -ENODEV
; /* maybe not the best code here? */
1642 dev_err(&card
->gdev
->dev
,
1643 "The HiperSockets device is not configured as a Bridge Port\n");
1645 case 0x0014: /* Another device is Primary */
1647 case IPA_SBP_SET_PRIMARY_BRIDGE_PORT
:
1649 dev_err(&card
->gdev
->dev
,
1650 "The HiperSockets LAN already has a primary Bridge Port\n");
1652 case IPA_SBP_SET_SECONDARY_BRIDGE_PORT
:
1654 dev_err(&card
->gdev
->dev
,
1655 "The HiperSockets device is already a primary Bridge Port\n");
1661 case 0x0018: /* This device is currently Secondary */
1663 dev_err(&card
->gdev
->dev
,
1664 "The HiperSockets device is already a secondary Bridge Port\n");
1666 case 0x001C: /* Limit for Secondary devices reached */
1668 dev_err(&card
->gdev
->dev
,
1669 "The HiperSockets LAN cannot have more secondary Bridge Ports\n");
1671 case 0x0024: /* This device is currently Primary */
1673 dev_err(&card
->gdev
->dev
,
1674 "The HiperSockets device is already a primary Bridge Port\n");
1676 case 0x0020: /* Not authorized by zManager */
1678 dev_err(&card
->gdev
->dev
,
1679 "The HiperSockets device is not authorized to be a Bridge Port\n");
1685 case IPA_RC_NOTSUPP
:
1688 case IPA_RC_UNSUPPORTED_COMMAND
:
1695 QETH_CARD_TEXT_(card
, 2, "SBPi%04x", cbctl
->ipa_rc
);
1696 QETH_CARD_TEXT_(card
, 2, "SBPc%04x", cbctl
->cmd_rc
);
1701 static int qeth_bridgeport_query_support_cb(struct qeth_card
*card
,
1702 struct qeth_reply
*reply
, unsigned long data
)
1704 struct qeth_ipa_cmd
*cmd
= (struct qeth_ipa_cmd
*) data
;
1705 struct _qeth_sbp_cbctl
*cbctl
= (struct _qeth_sbp_cbctl
*)reply
->param
;
1706 QETH_CARD_TEXT(card
, 2, "brqsupcb");
1707 cbctl
->ipa_rc
= cmd
->hdr
.return_code
;
1708 cbctl
->cmd_rc
= cmd
->data
.sbp
.hdr
.return_code
;
1709 if ((cbctl
->ipa_rc
== 0) && (cbctl
->cmd_rc
== 0)) {
1710 cbctl
->data
.supported
=
1711 cmd
->data
.sbp
.data
.query_cmds_supp
.supported_cmds
;
1713 cbctl
->data
.supported
= 0;
1719 * qeth_bridgeport_query_support() - store bitmask of supported subfunctions.
1720 * @card: qeth_card structure pointer.
1722 * Sets bitmask of supported setbridgeport subfunctions in the qeth_card
1723 * strucutre: card->options.sbp.supported_funcs.
1725 static void qeth_bridgeport_query_support(struct qeth_card
*card
)
1727 struct qeth_cmd_buffer
*iob
;
1728 struct qeth_ipa_cmd
*cmd
;
1729 struct _qeth_sbp_cbctl cbctl
;
1731 QETH_CARD_TEXT(card
, 2, "brqsuppo");
1732 iob
= qeth_get_ipacmd_buffer(card
, IPA_CMD_SETBRIDGEPORT
, 0);
1733 cmd
= (struct qeth_ipa_cmd
*)(iob
->data
+IPA_PDU_HEADER_SIZE
);
1734 cmd
->data
.sbp
.hdr
.cmdlength
=
1735 sizeof(struct qeth_ipacmd_sbp_hdr
) +
1736 sizeof(struct qeth_sbp_query_cmds_supp
);
1737 cmd
->data
.sbp
.hdr
.command_code
=
1738 IPA_SBP_QUERY_COMMANDS_SUPPORTED
;
1739 cmd
->data
.sbp
.hdr
.used_total
= 1;
1740 cmd
->data
.sbp
.hdr
.seq_no
= 1;
1741 if (qeth_send_ipa_cmd(card
, iob
, qeth_bridgeport_query_support_cb
,
1743 qeth_bridgeport_makerc(card
, &cbctl
,
1744 IPA_SBP_QUERY_COMMANDS_SUPPORTED
)) {
1745 /* non-zero makerc signifies failure, and produce messages */
1746 card
->options
.sbp
.role
= QETH_SBP_ROLE_NONE
;
1749 card
->options
.sbp
.supported_funcs
= cbctl
.data
.supported
;
1752 static int qeth_bridgeport_query_ports_cb(struct qeth_card
*card
,
1753 struct qeth_reply
*reply
, unsigned long data
)
1755 struct qeth_ipa_cmd
*cmd
= (struct qeth_ipa_cmd
*) data
;
1756 struct qeth_sbp_query_ports
*qports
= &cmd
->data
.sbp
.data
.query_ports
;
1757 struct _qeth_sbp_cbctl
*cbctl
= (struct _qeth_sbp_cbctl
*)reply
->param
;
1759 QETH_CARD_TEXT(card
, 2, "brqprtcb");
1760 cbctl
->ipa_rc
= cmd
->hdr
.return_code
;
1761 cbctl
->cmd_rc
= cmd
->data
.sbp
.hdr
.return_code
;
1762 if ((cbctl
->ipa_rc
!= 0) || (cbctl
->cmd_rc
!= 0))
1764 if (qports
->entry_length
!= sizeof(struct qeth_sbp_port_entry
)) {
1765 cbctl
->cmd_rc
= 0xffff;
1766 QETH_CARD_TEXT_(card
, 2, "SBPs%04x", qports
->entry_length
);
1769 /* first entry contains the state of the local port */
1770 if (qports
->num_entries
> 0) {
1771 if (cbctl
->data
.qports
.role
)
1772 *cbctl
->data
.qports
.role
= qports
->entry
[0].role
;
1773 if (cbctl
->data
.qports
.state
)
1774 *cbctl
->data
.qports
.state
= qports
->entry
[0].state
;
1780 * qeth_bridgeport_query_ports() - query local bridgeport status.
1781 * @card: qeth_card structure pointer.
1782 * @role: Role of the port: 0-none, 1-primary, 2-secondary.
1783 * @state: State of the port: 0-inactive, 1-standby, 2-active.
1785 * Returns negative errno-compatible error indication or 0 on success.
1787 * 'role' and 'state' are not updated in case of hardware operation failure.
1789 int qeth_bridgeport_query_ports(struct qeth_card
*card
,
1790 enum qeth_sbp_roles
*role
, enum qeth_sbp_states
*state
)
1793 struct qeth_cmd_buffer
*iob
;
1794 struct qeth_ipa_cmd
*cmd
;
1795 struct _qeth_sbp_cbctl cbctl
= {
1804 QETH_CARD_TEXT(card
, 2, "brqports");
1805 if (!(card
->options
.sbp
.supported_funcs
& IPA_SBP_QUERY_BRIDGE_PORTS
))
1807 iob
= qeth_get_ipacmd_buffer(card
, IPA_CMD_SETBRIDGEPORT
, 0);
1808 cmd
= (struct qeth_ipa_cmd
*)(iob
->data
+IPA_PDU_HEADER_SIZE
);
1809 cmd
->data
.sbp
.hdr
.cmdlength
=
1810 sizeof(struct qeth_ipacmd_sbp_hdr
);
1811 cmd
->data
.sbp
.hdr
.command_code
=
1812 IPA_SBP_QUERY_BRIDGE_PORTS
;
1813 cmd
->data
.sbp
.hdr
.used_total
= 1;
1814 cmd
->data
.sbp
.hdr
.seq_no
= 1;
1815 rc
= qeth_send_ipa_cmd(card
, iob
, qeth_bridgeport_query_ports_cb
,
1819 rc
= qeth_bridgeport_makerc(card
, &cbctl
, IPA_SBP_QUERY_BRIDGE_PORTS
);
1824 EXPORT_SYMBOL_GPL(qeth_bridgeport_query_ports
);
1826 static int qeth_bridgeport_set_cb(struct qeth_card
*card
,
1827 struct qeth_reply
*reply
, unsigned long data
)
1829 struct qeth_ipa_cmd
*cmd
= (struct qeth_ipa_cmd
*)data
;
1830 struct _qeth_sbp_cbctl
*cbctl
= (struct _qeth_sbp_cbctl
*)reply
->param
;
1831 QETH_CARD_TEXT(card
, 2, "brsetrcb");
1832 cbctl
->ipa_rc
= cmd
->hdr
.return_code
;
1833 cbctl
->cmd_rc
= cmd
->data
.sbp
.hdr
.return_code
;
1838 * qeth_bridgeport_setrole() - Assign primary role to the port.
1839 * @card: qeth_card structure pointer.
1840 * @role: Role to assign.
1842 * Returns negative errno-compatible error indication or 0 on success.
1844 int qeth_bridgeport_setrole(struct qeth_card
*card
, enum qeth_sbp_roles role
)
1848 struct qeth_cmd_buffer
*iob
;
1849 struct qeth_ipa_cmd
*cmd
;
1850 struct _qeth_sbp_cbctl cbctl
;
1851 enum qeth_ipa_sbp_cmd setcmd
;
1853 QETH_CARD_TEXT(card
, 2, "brsetrol");
1855 case QETH_SBP_ROLE_NONE
:
1856 setcmd
= IPA_SBP_RESET_BRIDGE_PORT_ROLE
;
1857 cmdlength
= sizeof(struct qeth_ipacmd_sbp_hdr
) +
1858 sizeof(struct qeth_sbp_reset_role
);
1860 case QETH_SBP_ROLE_PRIMARY
:
1861 setcmd
= IPA_SBP_SET_PRIMARY_BRIDGE_PORT
;
1862 cmdlength
= sizeof(struct qeth_ipacmd_sbp_hdr
) +
1863 sizeof(struct qeth_sbp_set_primary
);
1865 case QETH_SBP_ROLE_SECONDARY
:
1866 setcmd
= IPA_SBP_SET_SECONDARY_BRIDGE_PORT
;
1867 cmdlength
= sizeof(struct qeth_ipacmd_sbp_hdr
) +
1868 sizeof(struct qeth_sbp_set_secondary
);
1873 if (!(card
->options
.sbp
.supported_funcs
& setcmd
))
1875 iob
= qeth_get_ipacmd_buffer(card
, IPA_CMD_SETBRIDGEPORT
, 0);
1876 cmd
= (struct qeth_ipa_cmd
*)(iob
->data
+IPA_PDU_HEADER_SIZE
);
1877 cmd
->data
.sbp
.hdr
.cmdlength
= cmdlength
;
1878 cmd
->data
.sbp
.hdr
.command_code
= setcmd
;
1879 cmd
->data
.sbp
.hdr
.used_total
= 1;
1880 cmd
->data
.sbp
.hdr
.seq_no
= 1;
1881 rc
= qeth_send_ipa_cmd(card
, iob
, qeth_bridgeport_set_cb
,
1885 rc
= qeth_bridgeport_makerc(card
, &cbctl
, setcmd
);
1890 * qeth_anset_makerc() - derive "traditional" error from hardware codes.
1891 * @card: qeth_card structure pointer, for debug messages.
1893 * Returns negative errno-compatible error indication or 0 on success.
1895 static int qeth_anset_makerc(struct qeth_card
*card
, int pnso_rc
, u16 response
)
1908 dev_err(&card
->gdev
->dev
,
1909 "Setting address notification failed\n");
1921 QETH_CARD_TEXT_(card
, 2, "SBPp%04x", pnso_rc
);
1922 QETH_CARD_TEXT_(card
, 2, "SBPr%04x", response
);
1927 static void qeth_bridgeport_an_set_cb(void *priv
,
1928 enum qdio_brinfo_entry_type type
, void *entry
)
1930 struct qeth_card
*card
= (struct qeth_card
*)priv
;
1931 struct qdio_brinfo_entry_l2
*l2entry
;
1934 if (type
!= l2_addr_lnid
) {
1939 l2entry
= (struct qdio_brinfo_entry_l2
*)entry
;
1940 code
= IPA_ADDR_CHANGE_CODE_MACADDR
;
1941 if (l2entry
->addr_lnid
.lnid
)
1942 code
|= IPA_ADDR_CHANGE_CODE_VLANID
;
1943 qeth_bridge_emit_host_event(card
, anev_reg_unreg
, code
,
1944 (struct net_if_token
*)&l2entry
->nit
,
1945 (struct mac_addr_lnid
*)&l2entry
->addr_lnid
);
1949 * qeth_bridgeport_an_set() - Enable or disable bridgeport address notification
1950 * @card: qeth_card structure pointer.
1951 * @enable: 0 - disable, non-zero - enable notifications
1953 * Returns negative errno-compatible error indication or 0 on success.
1955 * On enable, emits a series of address notifications udev events for all
1956 * currently registered hosts.
1958 int qeth_bridgeport_an_set(struct qeth_card
*card
, int enable
)
1962 struct ccw_device
*ddev
;
1963 struct subchannel_id schid
;
1967 if (!card
->options
.sbp
.supported_funcs
)
1969 ddev
= CARD_DDEV(card
);
1970 ccw_device_get_schid(ddev
, &schid
);
1973 qeth_bridge_emit_host_event(card
, anev_reset
, 0, NULL
, NULL
);
1974 rc
= qdio_pnso_brinfo(schid
, 1, &response
,
1975 qeth_bridgeport_an_set_cb
, card
);
1977 rc
= qdio_pnso_brinfo(schid
, 0, &response
, NULL
, NULL
);
1978 return qeth_anset_makerc(card
, rc
, response
);
1980 EXPORT_SYMBOL_GPL(qeth_bridgeport_an_set
);
1982 module_init(qeth_l2_init
);
1983 module_exit(qeth_l2_exit
);
1984 MODULE_AUTHOR("Frank Blaschka <frank.blaschka@de.ibm.com>");
1985 MODULE_DESCRIPTION("qeth layer 2 discipline");
1986 MODULE_LICENSE("GPL");