2 * drivers/s390/net/qeth_l2_main.c
4 * Copyright IBM Corp. 2007, 2009
5 * Author(s): Utz Bacher <utz.bacher@de.ibm.com>,
6 * Frank Pavlic <fpavlic@de.ibm.com>,
7 * Thomas Spatzier <tspat@de.ibm.com>,
8 * Frank Blaschka <frank.blaschka@de.ibm.com>
11 #define KMSG_COMPONENT "qeth"
12 #define pr_fmt(fmt) KMSG_COMPONENT ": " fmt
14 #include <linux/module.h>
15 #include <linux/moduleparam.h>
16 #include <linux/string.h>
17 #include <linux/errno.h>
18 #include <linux/kernel.h>
19 #include <linux/etherdevice.h>
20 #include <linux/mii.h>
22 #include <linux/list.h>
24 #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 *);
37 static int qeth_l2_do_ioctl(struct net_device
*dev
, struct ifreq
*rq
, int cmd
)
39 struct qeth_card
*card
= dev
->ml_priv
;
40 struct mii_ioctl_data
*mii_data
;
46 if ((card
->state
!= CARD_STATE_UP
) &&
47 (card
->state
!= CARD_STATE_SOFTSETUP
))
50 if (card
->info
.type
== QETH_CARD_TYPE_OSN
)
54 case SIOC_QETH_ADP_SET_SNMP_CONTROL
:
55 rc
= qeth_snmp_command(card
, rq
->ifr_ifru
.ifru_data
);
57 case SIOC_QETH_GET_CARD_TYPE
:
58 if ((card
->info
.type
== QETH_CARD_TYPE_OSAE
) &&
64 mii_data
= if_mii(rq
);
68 mii_data
= if_mii(rq
);
69 if (mii_data
->phy_id
!= 0)
72 mii_data
->val_out
= qeth_mdio_read(dev
,
73 mii_data
->phy_id
, mii_data
->reg_num
);
79 QETH_DBF_TEXT_(TRACE
, 2, "ioce%d", rc
);
83 static int qeth_l2_verify_dev(struct net_device
*dev
)
85 struct qeth_card
*card
;
89 read_lock_irqsave(&qeth_core_card_list
.rwlock
, flags
);
90 list_for_each_entry(card
, &qeth_core_card_list
.list
, list
) {
91 if (card
->dev
== dev
) {
96 read_unlock_irqrestore(&qeth_core_card_list
.rwlock
, flags
);
101 static struct net_device
*qeth_l2_netdev_by_devno(unsigned char *read_dev_no
)
103 struct qeth_card
*card
;
104 struct net_device
*ndev
;
107 struct ccw_dev_id read_devid
;
110 memcpy(&temp_dev_no
, read_dev_no
, 2);
111 read_lock_irqsave(&qeth_core_card_list
.rwlock
, flags
);
112 list_for_each_entry(card
, &qeth_core_card_list
.list
, list
) {
113 ccw_device_get_id(CARD_RDEV(card
), &read_devid
);
114 if (read_devid
.devno
== temp_dev_no
) {
119 read_unlock_irqrestore(&qeth_core_card_list
.rwlock
, flags
);
123 static int qeth_l2_send_setgroupmac_cb(struct qeth_card
*card
,
124 struct qeth_reply
*reply
,
127 struct qeth_ipa_cmd
*cmd
;
130 QETH_DBF_TEXT(TRACE
, 2, "L2Sgmacb");
131 cmd
= (struct qeth_ipa_cmd
*) data
;
132 mac
= &cmd
->data
.setdelmac
.mac
[0];
133 /* MAC already registered, needed in couple/uncouple case */
134 if (cmd
->hdr
.return_code
== IPA_RC_L2_DUP_MAC
) {
135 QETH_DBF_MESSAGE(2, "Group MAC %pM already existing on %s \n",
136 mac
, QETH_CARD_IFNAME(card
));
137 cmd
->hdr
.return_code
= 0;
139 if (cmd
->hdr
.return_code
)
140 QETH_DBF_MESSAGE(2, "Could not set group MAC %pM on %s: %x\n",
141 mac
, QETH_CARD_IFNAME(card
), cmd
->hdr
.return_code
);
145 static int qeth_l2_send_setgroupmac(struct qeth_card
*card
, __u8
*mac
)
147 QETH_DBF_TEXT(TRACE
, 2, "L2Sgmac");
148 return qeth_l2_send_setdelmac(card
, mac
, IPA_CMD_SETGMAC
,
149 qeth_l2_send_setgroupmac_cb
);
152 static int qeth_l2_send_delgroupmac_cb(struct qeth_card
*card
,
153 struct qeth_reply
*reply
,
156 struct qeth_ipa_cmd
*cmd
;
159 QETH_DBF_TEXT(TRACE
, 2, "L2Dgmacb");
160 cmd
= (struct qeth_ipa_cmd
*) data
;
161 mac
= &cmd
->data
.setdelmac
.mac
[0];
162 if (cmd
->hdr
.return_code
)
163 QETH_DBF_MESSAGE(2, "Could not delete group MAC %pM on %s: %x\n",
164 mac
, QETH_CARD_IFNAME(card
), cmd
->hdr
.return_code
);
168 static int qeth_l2_send_delgroupmac(struct qeth_card
*card
, __u8
*mac
)
170 QETH_DBF_TEXT(TRACE
, 2, "L2Dgmac");
171 return qeth_l2_send_setdelmac(card
, mac
, IPA_CMD_DELGMAC
,
172 qeth_l2_send_delgroupmac_cb
);
175 static void qeth_l2_add_mc(struct qeth_card
*card
, __u8
*mac
, int vmac
)
177 struct qeth_mc_mac
*mc
;
180 mc
= kmalloc(sizeof(struct qeth_mc_mac
), GFP_ATOMIC
);
185 memcpy(mc
->mc_addr
, mac
, OSA_ADDR_LEN
);
186 mc
->mc_addrlen
= OSA_ADDR_LEN
;
190 rc
= qeth_l2_send_setdelmac(card
, mac
, IPA_CMD_SETVMAC
,
193 rc
= qeth_l2_send_setgroupmac(card
, mac
);
197 list_add_tail(&mc
->list
, &card
->mc_list
);
202 static void qeth_l2_del_all_mc(struct qeth_card
*card
)
204 struct qeth_mc_mac
*mc
, *tmp
;
206 spin_lock_bh(&card
->mclock
);
207 list_for_each_entry_safe(mc
, tmp
, &card
->mc_list
, list
) {
209 qeth_l2_send_setdelmac(card
, mc
->mc_addr
,
210 IPA_CMD_DELVMAC
, NULL
);
212 qeth_l2_send_delgroupmac(card
, mc
->mc_addr
);
216 spin_unlock_bh(&card
->mclock
);
219 static inline int qeth_l2_get_cast_type(struct qeth_card
*card
,
222 if (card
->info
.type
== QETH_CARD_TYPE_OSN
)
224 if (is_broadcast_ether_addr(skb
->data
))
225 return RTN_BROADCAST
;
226 if (is_multicast_ether_addr(skb
->data
))
227 return RTN_MULTICAST
;
231 static void qeth_l2_fill_header(struct qeth_card
*card
, struct qeth_hdr
*hdr
,
232 struct sk_buff
*skb
, int ipv
, int cast_type
)
234 struct vlan_ethhdr
*veth
= (struct vlan_ethhdr
*)skb_mac_header(skb
);
236 memset(hdr
, 0, sizeof(struct qeth_hdr
));
237 hdr
->hdr
.l2
.id
= QETH_HEADER_TYPE_LAYER2
;
239 /* set byte byte 3 to casting flags */
240 if (cast_type
== RTN_MULTICAST
)
241 hdr
->hdr
.l2
.flags
[2] |= QETH_LAYER2_FLAG_MULTICAST
;
242 else if (cast_type
== RTN_BROADCAST
)
243 hdr
->hdr
.l2
.flags
[2] |= QETH_LAYER2_FLAG_BROADCAST
;
245 hdr
->hdr
.l2
.flags
[2] |= QETH_LAYER2_FLAG_UNICAST
;
247 hdr
->hdr
.l2
.pkt_length
= skb
->len
-QETH_HEADER_SIZE
;
248 /* VSWITCH relies on the VLAN
249 * information to be present in
251 if (veth
->h_vlan_proto
== __constant_htons(ETH_P_8021Q
)) {
252 hdr
->hdr
.l2
.flags
[2] |= QETH_LAYER2_FLAG_VLAN
;
253 hdr
->hdr
.l2
.vlan_id
= ntohs(veth
->h_vlan_TCI
);
257 static int qeth_l2_send_setdelvlan_cb(struct qeth_card
*card
,
258 struct qeth_reply
*reply
, unsigned long data
)
260 struct qeth_ipa_cmd
*cmd
;
262 QETH_DBF_TEXT(TRACE
, 2, "L2sdvcb");
263 cmd
= (struct qeth_ipa_cmd
*) data
;
264 if (cmd
->hdr
.return_code
) {
265 QETH_DBF_MESSAGE(2, "Error in processing VLAN %i on %s: 0x%x. "
266 "Continuing\n", cmd
->data
.setdelvlan
.vlan_id
,
267 QETH_CARD_IFNAME(card
), cmd
->hdr
.return_code
);
268 QETH_DBF_TEXT_(TRACE
, 2, "L2VL%4x", cmd
->hdr
.command
);
269 QETH_DBF_TEXT_(TRACE
, 2, "L2%s", CARD_BUS_ID(card
));
270 QETH_DBF_TEXT_(TRACE
, 2, "err%d", cmd
->hdr
.return_code
);
275 static int qeth_l2_send_setdelvlan(struct qeth_card
*card
, __u16 i
,
276 enum qeth_ipa_cmds ipacmd
)
278 struct qeth_ipa_cmd
*cmd
;
279 struct qeth_cmd_buffer
*iob
;
281 QETH_DBF_TEXT_(TRACE
, 4, "L2sdv%x", ipacmd
);
282 iob
= qeth_get_ipacmd_buffer(card
, ipacmd
, QETH_PROT_IPV4
);
283 cmd
= (struct qeth_ipa_cmd
*)(iob
->data
+IPA_PDU_HEADER_SIZE
);
284 cmd
->data
.setdelvlan
.vlan_id
= i
;
285 return qeth_send_ipa_cmd(card
, iob
,
286 qeth_l2_send_setdelvlan_cb
, NULL
);
289 static void qeth_l2_process_vlans(struct qeth_card
*card
, int clear
)
291 struct qeth_vlan_vid
*id
;
292 QETH_DBF_TEXT(TRACE
, 3, "L2prcvln");
293 spin_lock_bh(&card
->vlanlock
);
294 list_for_each_entry(id
, &card
->vid_list
, list
) {
296 qeth_l2_send_setdelvlan(card
, id
->vid
,
299 qeth_l2_send_setdelvlan(card
, id
->vid
,
302 spin_unlock_bh(&card
->vlanlock
);
305 static void qeth_l2_vlan_rx_add_vid(struct net_device
*dev
, unsigned short vid
)
307 struct qeth_card
*card
= dev
->ml_priv
;
308 struct qeth_vlan_vid
*id
;
310 QETH_DBF_TEXT_(TRACE
, 4, "aid:%d", vid
);
311 if (qeth_wait_for_threads(card
, QETH_RECOVER_THREAD
)) {
312 QETH_DBF_TEXT(TRACE
, 3, "aidREC");
315 id
= kmalloc(sizeof(struct qeth_vlan_vid
), GFP_ATOMIC
);
318 qeth_l2_send_setdelvlan(card
, vid
, IPA_CMD_SETVLAN
);
319 spin_lock_bh(&card
->vlanlock
);
320 list_add_tail(&id
->list
, &card
->vid_list
);
321 spin_unlock_bh(&card
->vlanlock
);
325 static void qeth_l2_vlan_rx_kill_vid(struct net_device
*dev
, unsigned short vid
)
327 struct qeth_vlan_vid
*id
, *tmpid
= NULL
;
328 struct qeth_card
*card
= dev
->ml_priv
;
330 QETH_DBF_TEXT_(TRACE
, 4, "kid:%d", vid
);
331 if (qeth_wait_for_threads(card
, QETH_RECOVER_THREAD
)) {
332 QETH_DBF_TEXT(TRACE
, 3, "kidREC");
335 spin_lock_bh(&card
->vlanlock
);
336 list_for_each_entry(id
, &card
->vid_list
, list
) {
337 if (id
->vid
== vid
) {
343 spin_unlock_bh(&card
->vlanlock
);
345 qeth_l2_send_setdelvlan(card
, vid
, IPA_CMD_DELVLAN
);
348 qeth_l2_set_multicast_list(card
->dev
);
351 static int qeth_l2_stop_card(struct qeth_card
*card
, int recovery_mode
)
355 QETH_DBF_TEXT(SETUP
, 2, "stopcard");
356 QETH_DBF_HEX(SETUP
, 2, &card
, sizeof(void *));
358 qeth_set_allowed_threads(card
, 0, 1);
359 if (card
->read
.state
== CH_STATE_UP
&&
360 card
->write
.state
== CH_STATE_UP
&&
361 (card
->state
== CARD_STATE_UP
)) {
363 card
->info
.type
!= QETH_CARD_TYPE_OSN
) {
364 qeth_l2_stop(card
->dev
);
367 dev_close(card
->dev
);
370 if (!card
->use_hard_stop
||
372 __u8
*mac
= &card
->dev
->dev_addr
[0];
373 rc
= qeth_l2_send_delmac(card
, mac
);
374 QETH_DBF_TEXT_(SETUP
, 2, "Lerr%d", rc
);
376 card
->state
= CARD_STATE_SOFTSETUP
;
378 if (card
->state
== CARD_STATE_SOFTSETUP
) {
379 qeth_l2_process_vlans(card
, 1);
380 if (!card
->use_hard_stop
||
382 qeth_l2_del_all_mc(card
);
383 qeth_clear_ipacmd_list(card
);
384 card
->state
= CARD_STATE_HARDSETUP
;
386 if (card
->state
== CARD_STATE_HARDSETUP
) {
387 qeth_qdio_clear_card(card
, 0);
388 qeth_clear_qdio_buffers(card
);
389 qeth_clear_working_pool_list(card
);
390 card
->state
= CARD_STATE_DOWN
;
392 if (card
->state
== CARD_STATE_DOWN
) {
393 qeth_clear_cmd_buffers(&card
->read
);
394 qeth_clear_cmd_buffers(&card
->write
);
396 card
->use_hard_stop
= 0;
400 static void qeth_l2_process_inbound_buffer(struct qeth_card
*card
,
401 struct qeth_qdio_buffer
*buf
, int index
)
403 struct qdio_buffer_element
*element
;
405 struct qeth_hdr
*hdr
;
409 /* get first element of current buffer */
410 element
= (struct qdio_buffer_element
*)&buf
->buffer
->element
[0];
412 if (card
->options
.performance_stats
)
413 card
->perf_stats
.bufs_rec
++;
414 while ((skb
= qeth_core_get_next_skb(card
, buf
->buffer
, &element
,
416 skb
->dev
= card
->dev
;
418 if (!(card
->dev
->flags
& IFF_UP
)) {
419 dev_kfree_skb_any(skb
);
423 switch (hdr
->hdr
.l2
.id
) {
424 case QETH_HEADER_TYPE_LAYER2
:
425 skb
->pkt_type
= PACKET_HOST
;
426 skb
->protocol
= eth_type_trans(skb
, skb
->dev
);
427 if (card
->options
.checksum_type
== NO_CHECKSUMMING
)
428 skb
->ip_summed
= CHECKSUM_UNNECESSARY
;
430 skb
->ip_summed
= CHECKSUM_NONE
;
431 if (skb
->protocol
== htons(ETH_P_802_2
))
432 *((__u32
*)skb
->cb
) = ++card
->seqno
.pkt_seqno
;
436 case QETH_HEADER_TYPE_OSN
:
437 if (card
->info
.type
== QETH_CARD_TYPE_OSN
) {
438 skb_push(skb
, sizeof(struct qeth_hdr
));
439 skb_copy_to_linear_data(skb
, hdr
,
440 sizeof(struct qeth_hdr
));
442 card
->osn_info
.data_cb(skb
);
447 dev_kfree_skb_any(skb
);
448 QETH_DBF_TEXT(TRACE
, 3, "inbunkno");
449 QETH_DBF_HEX(CTRL
, 3, hdr
, QETH_DBF_CTRL_LEN
);
452 card
->stats
.rx_packets
++;
453 card
->stats
.rx_bytes
+= len
;
457 static int qeth_l2_send_setdelmac(struct qeth_card
*card
, __u8
*mac
,
458 enum qeth_ipa_cmds ipacmd
,
459 int (*reply_cb
) (struct qeth_card
*,
463 struct qeth_ipa_cmd
*cmd
;
464 struct qeth_cmd_buffer
*iob
;
466 QETH_DBF_TEXT(TRACE
, 2, "L2sdmac");
467 iob
= qeth_get_ipacmd_buffer(card
, ipacmd
, QETH_PROT_IPV4
);
468 cmd
= (struct qeth_ipa_cmd
*)(iob
->data
+IPA_PDU_HEADER_SIZE
);
469 cmd
->data
.setdelmac
.mac_length
= OSA_ADDR_LEN
;
470 memcpy(&cmd
->data
.setdelmac
.mac
, mac
, OSA_ADDR_LEN
);
471 return qeth_send_ipa_cmd(card
, iob
, reply_cb
, NULL
);
474 static int qeth_l2_send_setmac_cb(struct qeth_card
*card
,
475 struct qeth_reply
*reply
,
478 struct qeth_ipa_cmd
*cmd
;
480 QETH_DBF_TEXT(TRACE
, 2, "L2Smaccb");
481 cmd
= (struct qeth_ipa_cmd
*) data
;
482 if (cmd
->hdr
.return_code
) {
483 QETH_DBF_TEXT_(TRACE
, 2, "L2er%x", cmd
->hdr
.return_code
);
484 card
->info
.mac_bits
&= ~QETH_LAYER2_MAC_REGISTERED
;
485 switch (cmd
->hdr
.return_code
) {
486 case IPA_RC_L2_DUP_MAC
:
487 case IPA_RC_L2_DUP_LAYER3_MAC
:
488 dev_warn(&card
->gdev
->dev
,
489 "MAC address %pM already exists\n",
490 card
->dev
->dev_addr
);
492 case IPA_RC_L2_MAC_NOT_AUTH_BY_HYP
:
493 case IPA_RC_L2_MAC_NOT_AUTH_BY_ADP
:
494 dev_warn(&card
->gdev
->dev
,
495 "MAC address %pM is not authorized\n",
496 card
->dev
->dev_addr
);
501 cmd
->hdr
.return_code
= -EIO
;
503 card
->info
.mac_bits
|= QETH_LAYER2_MAC_REGISTERED
;
504 memcpy(card
->dev
->dev_addr
, cmd
->data
.setdelmac
.mac
,
506 dev_info(&card
->gdev
->dev
,
507 "MAC address %pM successfully registered on device %s\n",
508 card
->dev
->dev_addr
, card
->dev
->name
);
513 static int qeth_l2_send_setmac(struct qeth_card
*card
, __u8
*mac
)
515 QETH_DBF_TEXT(TRACE
, 2, "L2Setmac");
516 return qeth_l2_send_setdelmac(card
, mac
, IPA_CMD_SETVMAC
,
517 qeth_l2_send_setmac_cb
);
520 static int qeth_l2_send_delmac_cb(struct qeth_card
*card
,
521 struct qeth_reply
*reply
,
524 struct qeth_ipa_cmd
*cmd
;
526 QETH_DBF_TEXT(TRACE
, 2, "L2Dmaccb");
527 cmd
= (struct qeth_ipa_cmd
*) data
;
528 if (cmd
->hdr
.return_code
) {
529 QETH_DBF_TEXT_(TRACE
, 2, "err%d", cmd
->hdr
.return_code
);
530 cmd
->hdr
.return_code
= -EIO
;
533 card
->info
.mac_bits
&= ~QETH_LAYER2_MAC_REGISTERED
;
538 static int qeth_l2_send_delmac(struct qeth_card
*card
, __u8
*mac
)
540 QETH_DBF_TEXT(TRACE
, 2, "L2Delmac");
541 if (!(card
->info
.mac_bits
& QETH_LAYER2_MAC_REGISTERED
))
543 return qeth_l2_send_setdelmac(card
, mac
, IPA_CMD_DELVMAC
,
544 qeth_l2_send_delmac_cb
);
547 static int qeth_l2_request_initial_mac(struct qeth_card
*card
)
550 char vendor_pre
[] = {0x02, 0x00, 0x00};
552 QETH_DBF_TEXT(SETUP
, 2, "doL2init");
553 QETH_DBF_TEXT_(SETUP
, 2, "doL2%s", CARD_BUS_ID(card
));
555 rc
= qeth_query_setadapterparms(card
);
557 QETH_DBF_MESSAGE(2, "could not query adapter parameters on "
558 "device %s: x%x\n", CARD_BUS_ID(card
), rc
);
561 if ((card
->info
.type
== QETH_CARD_TYPE_IQD
) ||
562 (card
->info
.guestlan
)) {
563 rc
= qeth_setadpparms_change_macaddr(card
);
565 QETH_DBF_MESSAGE(2, "couldn't get MAC address on "
566 "device %s: x%x\n", CARD_BUS_ID(card
), rc
);
567 QETH_DBF_TEXT_(SETUP
, 2, "1err%d", rc
);
570 QETH_DBF_HEX(SETUP
, 2, card
->dev
->dev_addr
, OSA_ADDR_LEN
);
572 random_ether_addr(card
->dev
->dev_addr
);
573 memcpy(card
->dev
->dev_addr
, vendor_pre
, 3);
578 static int qeth_l2_set_mac_address(struct net_device
*dev
, void *p
)
580 struct sockaddr
*addr
= p
;
581 struct qeth_card
*card
= dev
->ml_priv
;
584 QETH_DBF_TEXT(TRACE
, 3, "setmac");
586 if (qeth_l2_verify_dev(dev
) != QETH_REAL_CARD
) {
587 QETH_DBF_TEXT(TRACE
, 3, "setmcINV");
591 if (card
->info
.type
== QETH_CARD_TYPE_OSN
) {
592 QETH_DBF_TEXT(TRACE
, 3, "setmcOSN");
595 QETH_DBF_TEXT_(TRACE
, 3, "%s", CARD_BUS_ID(card
));
596 QETH_DBF_HEX(TRACE
, 3, addr
->sa_data
, OSA_ADDR_LEN
);
597 if (qeth_wait_for_threads(card
, QETH_RECOVER_THREAD
)) {
598 QETH_DBF_TEXT(TRACE
, 3, "setmcREC");
601 rc
= qeth_l2_send_delmac(card
, &card
->dev
->dev_addr
[0]);
603 rc
= qeth_l2_send_setmac(card
, addr
->sa_data
);
607 static void qeth_l2_set_multicast_list(struct net_device
*dev
)
609 struct qeth_card
*card
= dev
->ml_priv
;
610 struct dev_addr_list
*dm
;
611 struct netdev_hw_addr
*ha
;
613 if (card
->info
.type
== QETH_CARD_TYPE_OSN
)
616 QETH_DBF_TEXT(TRACE
, 3, "setmulti");
617 if (qeth_threads_running(card
, QETH_RECOVER_THREAD
) &&
618 (card
->state
!= CARD_STATE_UP
))
620 qeth_l2_del_all_mc(card
);
621 spin_lock_bh(&card
->mclock
);
622 for (dm
= dev
->mc_list
; dm
; dm
= dm
->next
)
623 qeth_l2_add_mc(card
, dm
->da_addr
, 0);
625 netdev_for_each_uc_addr(ha
, dev
)
626 qeth_l2_add_mc(card
, ha
->addr
, 1);
628 spin_unlock_bh(&card
->mclock
);
629 if (!qeth_adp_supported(card
, IPA_SETADP_SET_PROMISC_MODE
))
631 qeth_setadp_promisc_mode(card
);
634 static int qeth_l2_hard_start_xmit(struct sk_buff
*skb
, struct net_device
*dev
)
637 struct qeth_hdr
*hdr
= NULL
;
639 struct qeth_card
*card
= dev
->ml_priv
;
640 struct sk_buff
*new_skb
= skb
;
641 int ipv
= qeth_get_ip_version(skb
);
642 int cast_type
= qeth_l2_get_cast_type(card
, skb
);
643 struct qeth_qdio_out_q
*queue
= card
->qdio
.out_qs
644 [qeth_get_priority_queue(card
, skb
, ipv
, cast_type
)];
645 int tx_bytes
= skb
->len
;
646 int data_offset
= -1;
647 int elements_needed
= 0;
650 if ((card
->state
!= CARD_STATE_UP
) || !card
->lan_online
) {
651 card
->stats
.tx_carrier_errors
++;
655 if ((card
->info
.type
== QETH_CARD_TYPE_OSN
) &&
656 (skb
->protocol
== htons(ETH_P_IPV6
)))
659 if (card
->options
.performance_stats
) {
660 card
->perf_stats
.outbound_cnt
++;
661 card
->perf_stats
.outbound_start_time
= qeth_get_micros();
663 netif_stop_queue(dev
);
665 if (card
->info
.type
== QETH_CARD_TYPE_OSN
)
666 hdr
= (struct qeth_hdr
*)skb
->data
;
668 if (card
->info
.type
== QETH_CARD_TYPE_IQD
) {
670 data_offset
= ETH_HLEN
;
672 hdr
= kmem_cache_alloc(qeth_core_header_cache
,
677 skb_reset_mac_header(new_skb
);
678 qeth_l2_fill_header(card
, hdr
, new_skb
, ipv
, cast_type
);
679 hdr
->hdr
.l2
.pkt_length
= new_skb
->len
;
680 memcpy(((char *)hdr
) + sizeof(struct qeth_hdr
),
681 skb_mac_header(new_skb
), ETH_HLEN
);
683 /* create a clone with writeable headroom */
684 new_skb
= skb_realloc_headroom(skb
,
685 sizeof(struct qeth_hdr
));
688 hdr
= (struct qeth_hdr
*)skb_push(new_skb
,
689 sizeof(struct qeth_hdr
));
690 skb_set_mac_header(new_skb
, sizeof(struct qeth_hdr
));
691 qeth_l2_fill_header(card
, hdr
, new_skb
, ipv
, cast_type
);
695 elements
= qeth_get_elements_no(card
, (void *)hdr
, new_skb
,
698 if (data_offset
>= 0)
699 kmem_cache_free(qeth_core_header_cache
, hdr
);
703 if (card
->info
.type
!= QETH_CARD_TYPE_IQD
)
704 rc
= qeth_do_send_packet(card
, queue
, new_skb
, hdr
,
707 rc
= qeth_do_send_packet_fast(card
, queue
, new_skb
, hdr
,
708 elements
, data_offset
, hd_len
);
710 card
->stats
.tx_packets
++;
711 card
->stats
.tx_bytes
+= tx_bytes
;
713 dev_kfree_skb_any(skb
);
716 if (data_offset
>= 0)
717 kmem_cache_free(qeth_core_header_cache
, hdr
);
721 dev_kfree_skb_any(new_skb
);
722 return NETDEV_TX_BUSY
;
727 netif_wake_queue(dev
);
728 if (card
->options
.performance_stats
)
729 card
->perf_stats
.outbound_time
+= qeth_get_micros() -
730 card
->perf_stats
.outbound_start_time
;
734 card
->stats
.tx_dropped
++;
735 card
->stats
.tx_errors
++;
736 if ((new_skb
!= skb
) && new_skb
)
737 dev_kfree_skb_any(new_skb
);
738 dev_kfree_skb_any(skb
);
739 netif_wake_queue(dev
);
743 static void qeth_l2_qdio_input_handler(struct ccw_device
*ccwdev
,
744 unsigned int qdio_err
, unsigned int queue
,
745 int first_element
, int count
, unsigned long card_ptr
)
747 struct net_device
*net_dev
;
748 struct qeth_card
*card
;
749 struct qeth_qdio_buffer
*buffer
;
753 card
= (struct qeth_card
*) card_ptr
;
755 if (card
->options
.performance_stats
) {
756 card
->perf_stats
.inbound_cnt
++;
757 card
->perf_stats
.inbound_start_time
= qeth_get_micros();
759 if (qdio_err
& QDIO_ERROR_ACTIVATE_CHECK_CONDITION
) {
760 QETH_DBF_TEXT(TRACE
, 1, "qdinchk");
761 QETH_DBF_TEXT_(TRACE
, 1, "%s", CARD_BUS_ID(card
));
762 QETH_DBF_TEXT_(TRACE
, 1, "%04X%04X", first_element
,
764 QETH_DBF_TEXT_(TRACE
, 1, "%04X", queue
);
765 qeth_schedule_recovery(card
);
768 for (i
= first_element
; i
< (first_element
+ count
); ++i
) {
769 index
= i
% QDIO_MAX_BUFFERS_PER_Q
;
770 buffer
= &card
->qdio
.in_q
->bufs
[index
];
772 qeth_check_qdio_errors(card
, buffer
->buffer
, qdio_err
,
774 qeth_l2_process_inbound_buffer(card
, buffer
, index
);
775 /* clear buffer and give back to hardware */
776 qeth_put_buffer_pool_entry(card
, buffer
->pool_entry
);
777 qeth_queue_input_buffer(card
, index
);
779 if (card
->options
.performance_stats
)
780 card
->perf_stats
.inbound_time
+= qeth_get_micros() -
781 card
->perf_stats
.inbound_start_time
;
784 static int qeth_l2_open(struct net_device
*dev
)
786 struct qeth_card
*card
= dev
->ml_priv
;
788 QETH_DBF_TEXT(TRACE
, 4, "qethopen");
789 if (card
->state
!= CARD_STATE_SOFTSETUP
)
792 if ((card
->info
.type
!= QETH_CARD_TYPE_OSN
) &&
793 (!(card
->info
.mac_bits
& QETH_LAYER2_MAC_REGISTERED
))) {
794 QETH_DBF_TEXT(TRACE
, 4, "nomacadr");
797 card
->data
.state
= CH_STATE_UP
;
798 card
->state
= CARD_STATE_UP
;
799 netif_start_queue(dev
);
801 if (!card
->lan_online
&& netif_carrier_ok(dev
))
802 netif_carrier_off(dev
);
807 static int qeth_l2_stop(struct net_device
*dev
)
809 struct qeth_card
*card
= dev
->ml_priv
;
811 QETH_DBF_TEXT(TRACE
, 4, "qethstop");
812 netif_tx_disable(dev
);
813 if (card
->state
== CARD_STATE_UP
)
814 card
->state
= CARD_STATE_SOFTSETUP
;
818 static int qeth_l2_probe_device(struct ccwgroup_device
*gdev
)
820 struct qeth_card
*card
= dev_get_drvdata(&gdev
->dev
);
822 INIT_LIST_HEAD(&card
->vid_list
);
823 INIT_LIST_HEAD(&card
->mc_list
);
824 card
->options
.layer2
= 1;
825 card
->discipline
.input_handler
= (qdio_handler_t
*)
826 qeth_l2_qdio_input_handler
;
827 card
->discipline
.output_handler
= (qdio_handler_t
*)
828 qeth_qdio_output_handler
;
829 card
->discipline
.recover
= qeth_l2_recover
;
833 static void qeth_l2_remove_device(struct ccwgroup_device
*cgdev
)
835 struct qeth_card
*card
= dev_get_drvdata(&cgdev
->dev
);
837 qeth_set_allowed_threads(card
, 0, 1);
838 wait_event(card
->wait_q
, qeth_threads_running(card
, 0xffffffff) == 0);
840 if (cgdev
->state
== CCWGROUP_ONLINE
) {
841 card
->use_hard_stop
= 1;
842 qeth_l2_set_offline(cgdev
);
846 unregister_netdev(card
->dev
);
850 qeth_l2_del_all_mc(card
);
854 static const struct ethtool_ops qeth_l2_ethtool_ops
= {
855 .get_link
= ethtool_op_get_link
,
856 .get_strings
= qeth_core_get_strings
,
857 .get_ethtool_stats
= qeth_core_get_ethtool_stats
,
858 .get_sset_count
= qeth_core_get_sset_count
,
859 .get_drvinfo
= qeth_core_get_drvinfo
,
860 .get_settings
= qeth_core_ethtool_get_settings
,
863 static const struct ethtool_ops qeth_l2_osn_ops
= {
864 .get_strings
= qeth_core_get_strings
,
865 .get_ethtool_stats
= qeth_core_get_ethtool_stats
,
866 .get_sset_count
= qeth_core_get_sset_count
,
867 .get_drvinfo
= qeth_core_get_drvinfo
,
870 static const struct net_device_ops qeth_l2_netdev_ops
= {
871 .ndo_open
= qeth_l2_open
,
872 .ndo_stop
= qeth_l2_stop
,
873 .ndo_get_stats
= qeth_get_stats
,
874 .ndo_start_xmit
= qeth_l2_hard_start_xmit
,
875 .ndo_validate_addr
= eth_validate_addr
,
876 .ndo_set_multicast_list
= qeth_l2_set_multicast_list
,
877 .ndo_do_ioctl
= qeth_l2_do_ioctl
,
878 .ndo_set_mac_address
= qeth_l2_set_mac_address
,
879 .ndo_change_mtu
= qeth_change_mtu
,
880 .ndo_vlan_rx_add_vid
= qeth_l2_vlan_rx_add_vid
,
881 .ndo_vlan_rx_kill_vid
= qeth_l2_vlan_rx_kill_vid
,
882 .ndo_tx_timeout
= qeth_tx_timeout
,
885 static int qeth_l2_setup_netdev(struct qeth_card
*card
)
887 switch (card
->info
.type
) {
888 case QETH_CARD_TYPE_OSAE
:
889 card
->dev
= alloc_etherdev(0);
891 case QETH_CARD_TYPE_IQD
:
892 card
->dev
= alloc_netdev(0, "hsi%d", ether_setup
);
894 case QETH_CARD_TYPE_OSN
:
895 card
->dev
= alloc_netdev(0, "osn%d", ether_setup
);
896 card
->dev
->flags
|= IFF_NOARP
;
899 card
->dev
= alloc_etherdev(0);
905 card
->dev
->ml_priv
= card
;
906 card
->dev
->watchdog_timeo
= QETH_TX_TIMEOUT
;
907 card
->dev
->mtu
= card
->info
.initial_mtu
;
908 card
->dev
->netdev_ops
= &qeth_l2_netdev_ops
;
909 if (card
->info
.type
!= QETH_CARD_TYPE_OSN
)
910 SET_ETHTOOL_OPS(card
->dev
, &qeth_l2_ethtool_ops
);
912 SET_ETHTOOL_OPS(card
->dev
, &qeth_l2_osn_ops
);
913 card
->dev
->features
|= NETIF_F_HW_VLAN_FILTER
;
914 card
->info
.broadcast_capable
= 1;
915 qeth_l2_request_initial_mac(card
);
916 SET_NETDEV_DEV(card
->dev
, &card
->gdev
->dev
);
917 return register_netdev(card
->dev
);
920 static int __qeth_l2_set_online(struct ccwgroup_device
*gdev
, int recovery_mode
)
922 struct qeth_card
*card
= dev_get_drvdata(&gdev
->dev
);
924 enum qeth_card_states recover_flag
;
927 QETH_DBF_TEXT(SETUP
, 2, "setonlin");
928 QETH_DBF_HEX(SETUP
, 2, &card
, sizeof(void *));
930 recover_flag
= card
->state
;
931 rc
= qeth_core_hardsetup_card(card
);
933 QETH_DBF_TEXT_(SETUP
, 2, "2err%d", rc
);
938 if (!card
->dev
&& qeth_l2_setup_netdev(card
)) {
943 if (card
->info
.type
!= QETH_CARD_TYPE_OSN
)
944 qeth_l2_send_setmac(card
, &card
->dev
->dev_addr
[0]);
946 card
->state
= CARD_STATE_HARDSETUP
;
947 qeth_print_status_message(card
);
950 QETH_DBF_TEXT(SETUP
, 2, "softsetp");
952 rc
= qeth_send_startlan(card
);
954 QETH_DBF_TEXT_(SETUP
, 2, "1err%d", rc
);
956 dev_warn(&card
->gdev
->dev
,
957 "The LAN is offline\n");
958 card
->lan_online
= 0;
964 card
->lan_online
= 1;
966 if (card
->info
.type
!= QETH_CARD_TYPE_OSN
) {
967 /* configure isolation level */
968 qeth_set_access_ctrl_online(card
);
969 qeth_l2_process_vlans(card
, 0);
972 netif_tx_disable(card
->dev
);
974 rc
= qeth_init_qdio_queues(card
);
976 QETH_DBF_TEXT_(SETUP
, 2, "6err%d", rc
);
980 card
->state
= CARD_STATE_SOFTSETUP
;
981 netif_carrier_on(card
->dev
);
983 qeth_set_allowed_threads(card
, 0xffffffff, 0);
984 if (recover_flag
== CARD_STATE_RECOVER
) {
986 card
->info
.type
!= QETH_CARD_TYPE_OSN
) {
987 qeth_l2_open(card
->dev
);
993 /* this also sets saved unicast addresses */
994 qeth_l2_set_multicast_list(card
->dev
);
996 /* let user_space know that device is online */
997 kobject_uevent(&gdev
->dev
.kobj
, KOBJ_CHANGE
);
1001 card
->use_hard_stop
= 1;
1002 qeth_l2_stop_card(card
, 0);
1003 ccw_device_set_offline(CARD_DDEV(card
));
1004 ccw_device_set_offline(CARD_WDEV(card
));
1005 ccw_device_set_offline(CARD_RDEV(card
));
1006 if (recover_flag
== CARD_STATE_RECOVER
)
1007 card
->state
= CARD_STATE_RECOVER
;
1009 card
->state
= CARD_STATE_DOWN
;
1013 static int qeth_l2_set_online(struct ccwgroup_device
*gdev
)
1015 return __qeth_l2_set_online(gdev
, 0);
1018 static int __qeth_l2_set_offline(struct ccwgroup_device
*cgdev
,
1021 struct qeth_card
*card
= dev_get_drvdata(&cgdev
->dev
);
1022 int rc
= 0, rc2
= 0, rc3
= 0;
1023 enum qeth_card_states recover_flag
;
1025 QETH_DBF_TEXT(SETUP
, 3, "setoffl");
1026 QETH_DBF_HEX(SETUP
, 3, &card
, sizeof(void *));
1028 if (card
->dev
&& netif_carrier_ok(card
->dev
))
1029 netif_carrier_off(card
->dev
);
1030 recover_flag
= card
->state
;
1031 qeth_l2_stop_card(card
, recovery_mode
);
1032 rc
= ccw_device_set_offline(CARD_DDEV(card
));
1033 rc2
= ccw_device_set_offline(CARD_WDEV(card
));
1034 rc3
= ccw_device_set_offline(CARD_RDEV(card
));
1036 rc
= (rc2
) ? rc2
: rc3
;
1038 QETH_DBF_TEXT_(SETUP
, 2, "1err%d", rc
);
1039 if (recover_flag
== CARD_STATE_UP
)
1040 card
->state
= CARD_STATE_RECOVER
;
1041 /* let user_space know that device is offline */
1042 kobject_uevent(&cgdev
->dev
.kobj
, KOBJ_CHANGE
);
1046 static int qeth_l2_set_offline(struct ccwgroup_device
*cgdev
)
1048 return __qeth_l2_set_offline(cgdev
, 0);
1051 static int qeth_l2_recover(void *ptr
)
1053 struct qeth_card
*card
;
1056 card
= (struct qeth_card
*) ptr
;
1057 QETH_DBF_TEXT(TRACE
, 2, "recover1");
1058 QETH_DBF_HEX(TRACE
, 2, &card
, sizeof(void *));
1059 if (!qeth_do_run_thread(card
, QETH_RECOVER_THREAD
))
1061 QETH_DBF_TEXT(TRACE
, 2, "recover2");
1062 dev_warn(&card
->gdev
->dev
,
1063 "A recovery process has been started for the device\n");
1064 card
->use_hard_stop
= 1;
1065 __qeth_l2_set_offline(card
->gdev
, 1);
1066 rc
= __qeth_l2_set_online(card
->gdev
, 1);
1067 /* don't run another scheduled recovery */
1068 qeth_clear_thread_start_bit(card
, QETH_RECOVER_THREAD
);
1069 qeth_clear_thread_running_bit(card
, QETH_RECOVER_THREAD
);
1071 dev_info(&card
->gdev
->dev
,
1072 "Device successfully recovered!\n");
1075 dev_close(card
->dev
);
1077 dev_warn(&card
->gdev
->dev
, "The qeth device driver "
1078 "failed to recover an error on the device\n");
1083 static int __init
qeth_l2_init(void)
1085 pr_info("register layer 2 discipline\n");
1089 static void __exit
qeth_l2_exit(void)
1091 pr_info("unregister layer 2 discipline\n");
1094 static void qeth_l2_shutdown(struct ccwgroup_device
*gdev
)
1096 struct qeth_card
*card
= dev_get_drvdata(&gdev
->dev
);
1097 qeth_qdio_clear_card(card
, 0);
1098 qeth_clear_qdio_buffers(card
);
1101 static int qeth_l2_pm_suspend(struct ccwgroup_device
*gdev
)
1103 struct qeth_card
*card
= dev_get_drvdata(&gdev
->dev
);
1106 netif_device_detach(card
->dev
);
1107 qeth_set_allowed_threads(card
, 0, 1);
1108 wait_event(card
->wait_q
, qeth_threads_running(card
, 0xffffffff) == 0);
1109 if (gdev
->state
== CCWGROUP_OFFLINE
)
1111 if (card
->state
== CARD_STATE_UP
) {
1112 card
->use_hard_stop
= 1;
1113 __qeth_l2_set_offline(card
->gdev
, 1);
1115 __qeth_l2_set_offline(card
->gdev
, 0);
1119 static int qeth_l2_pm_resume(struct ccwgroup_device
*gdev
)
1121 struct qeth_card
*card
= dev_get_drvdata(&gdev
->dev
);
1124 if (gdev
->state
== CCWGROUP_OFFLINE
)
1127 if (card
->state
== CARD_STATE_RECOVER
) {
1128 rc
= __qeth_l2_set_online(card
->gdev
, 1);
1131 dev_close(card
->dev
);
1135 rc
= __qeth_l2_set_online(card
->gdev
, 0);
1137 qeth_set_allowed_threads(card
, 0xffffffff, 0);
1139 netif_device_attach(card
->dev
);
1141 dev_warn(&card
->gdev
->dev
, "The qeth device driver "
1142 "failed to recover an error on the device\n");
1146 struct ccwgroup_driver qeth_l2_ccwgroup_driver
= {
1147 .probe
= qeth_l2_probe_device
,
1148 .remove
= qeth_l2_remove_device
,
1149 .set_online
= qeth_l2_set_online
,
1150 .set_offline
= qeth_l2_set_offline
,
1151 .shutdown
= qeth_l2_shutdown
,
1152 .freeze
= qeth_l2_pm_suspend
,
1153 .thaw
= qeth_l2_pm_resume
,
1154 .restore
= qeth_l2_pm_resume
,
1156 EXPORT_SYMBOL_GPL(qeth_l2_ccwgroup_driver
);
1158 static int qeth_osn_send_control_data(struct qeth_card
*card
, int len
,
1159 struct qeth_cmd_buffer
*iob
)
1161 unsigned long flags
;
1164 QETH_DBF_TEXT(TRACE
, 5, "osndctrd");
1166 wait_event(card
->wait_q
,
1167 atomic_cmpxchg(&card
->write
.irq_pending
, 0, 1) == 0);
1168 qeth_prepare_control_data(card
, len
, iob
);
1169 QETH_DBF_TEXT(TRACE
, 6, "osnoirqp");
1170 spin_lock_irqsave(get_ccwdev_lock(card
->write
.ccwdev
), flags
);
1171 rc
= ccw_device_start(card
->write
.ccwdev
, &card
->write
.ccw
,
1172 (addr_t
) iob
, 0, 0);
1173 spin_unlock_irqrestore(get_ccwdev_lock(card
->write
.ccwdev
), flags
);
1175 QETH_DBF_MESSAGE(2, "qeth_osn_send_control_data: "
1176 "ccw_device_start rc = %i\n", rc
);
1177 QETH_DBF_TEXT_(TRACE
, 2, " err%d", rc
);
1178 qeth_release_buffer(iob
->channel
, iob
);
1179 atomic_set(&card
->write
.irq_pending
, 0);
1180 wake_up(&card
->wait_q
);
1185 static int qeth_osn_send_ipa_cmd(struct qeth_card
*card
,
1186 struct qeth_cmd_buffer
*iob
, int data_len
)
1190 QETH_DBF_TEXT(TRACE
, 4, "osndipa");
1192 qeth_prepare_ipa_cmd(card
, iob
, QETH_PROT_OSN2
);
1193 s1
= (u16
)(IPA_PDU_HEADER_SIZE
+ data_len
);
1195 memcpy(QETH_IPA_PDU_LEN_TOTAL(iob
->data
), &s1
, 2);
1196 memcpy(QETH_IPA_PDU_LEN_PDU1(iob
->data
), &s2
, 2);
1197 memcpy(QETH_IPA_PDU_LEN_PDU2(iob
->data
), &s2
, 2);
1198 memcpy(QETH_IPA_PDU_LEN_PDU3(iob
->data
), &s2
, 2);
1199 return qeth_osn_send_control_data(card
, s1
, iob
);
1202 int qeth_osn_assist(struct net_device
*dev
, void *data
, int data_len
)
1204 struct qeth_cmd_buffer
*iob
;
1205 struct qeth_card
*card
;
1208 QETH_DBF_TEXT(TRACE
, 2, "osnsdmc");
1211 card
= dev
->ml_priv
;
1214 if ((card
->state
!= CARD_STATE_UP
) &&
1215 (card
->state
!= CARD_STATE_SOFTSETUP
))
1217 iob
= qeth_wait_for_buffer(&card
->write
);
1218 memcpy(iob
->data
+IPA_PDU_HEADER_SIZE
, data
, data_len
);
1219 rc
= qeth_osn_send_ipa_cmd(card
, iob
, data_len
);
1222 EXPORT_SYMBOL(qeth_osn_assist
);
1224 int qeth_osn_register(unsigned char *read_dev_no
, struct net_device
**dev
,
1225 int (*assist_cb
)(struct net_device
*, void *),
1226 int (*data_cb
)(struct sk_buff
*))
1228 struct qeth_card
*card
;
1230 QETH_DBF_TEXT(TRACE
, 2, "osnreg");
1231 *dev
= qeth_l2_netdev_by_devno(read_dev_no
);
1234 card
= (*dev
)->ml_priv
;
1237 if ((assist_cb
== NULL
) || (data_cb
== NULL
))
1239 card
->osn_info
.assist_cb
= assist_cb
;
1240 card
->osn_info
.data_cb
= data_cb
;
1243 EXPORT_SYMBOL(qeth_osn_register
);
1245 void qeth_osn_deregister(struct net_device
*dev
)
1247 struct qeth_card
*card
;
1249 QETH_DBF_TEXT(TRACE
, 2, "osndereg");
1252 card
= dev
->ml_priv
;
1255 card
->osn_info
.assist_cb
= NULL
;
1256 card
->osn_info
.data_cb
= NULL
;
1259 EXPORT_SYMBOL(qeth_osn_deregister
);
1261 module_init(qeth_l2_init
);
1262 module_exit(qeth_l2_exit
);
1263 MODULE_AUTHOR("Frank Blaschka <frank.blaschka@de.ibm.com>");
1264 MODULE_DESCRIPTION("qeth layer 2 discipline");
1265 MODULE_LICENSE("GPL");