blob: 914d2c121fd87c92fe9ed4acbddee3b5bee2c95d [file] [log] [blame]
Frank Blaschka4a71df52008-02-15 09:19:42 +01001/*
Frank Blaschkabbcfcdc2009-06-16 10:30:31 +02002 * Copyright IBM Corp. 2007, 2009
Frank Blaschka4a71df52008-02-15 09:19:42 +01003 * 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>
7 */
8
Frank Blaschka74eacdb2008-12-25 13:39:49 +01009#define KMSG_COMPONENT "qeth"
10#define pr_fmt(fmt) KMSG_COMPONENT ": " fmt
11
Frank Blaschka4a71df52008-02-15 09:19:42 +010012#include <linux/module.h>
13#include <linux/moduleparam.h>
14#include <linux/string.h>
15#include <linux/errno.h>
16#include <linux/kernel.h>
Tejun Heo5a0e3ad2010-03-24 17:04:11 +090017#include <linux/slab.h>
Frank Blaschka4a71df52008-02-15 09:19:42 +010018#include <linux/etherdevice.h>
19#include <linux/mii.h>
20#include <linux/ip.h>
Jiri Pirkoccffad252009-05-22 23:22:17 +000021#include <linux/list.h>
Frank Blaschka4a71df52008-02-15 09:19:42 +010022
Frank Blaschka4a71df52008-02-15 09:19:42 +010023#include "qeth_core.h"
Eugene Crosserb4d72c02014-01-14 15:54:11 +010024#include "qeth_l2.h"
Frank Blaschka4a71df52008-02-15 09:19:42 +010025
Frank Blaschka4a71df52008-02-15 09:19:42 +010026static int qeth_l2_set_offline(struct ccwgroup_device *);
27static int qeth_l2_stop(struct net_device *);
28static int qeth_l2_send_delmac(struct qeth_card *, __u8 *);
29static int qeth_l2_send_setdelmac(struct qeth_card *, __u8 *,
30 enum qeth_ipa_cmds,
31 int (*reply_cb) (struct qeth_card *,
32 struct qeth_reply*,
33 unsigned long));
34static void qeth_l2_set_multicast_list(struct net_device *);
35static int qeth_l2_recover(void *);
36
37static int qeth_l2_do_ioctl(struct net_device *dev, struct ifreq *rq, int cmd)
38{
Heiko Carstens509e2562008-07-26 02:24:10 -070039 struct qeth_card *card = dev->ml_priv;
Frank Blaschka4a71df52008-02-15 09:19:42 +010040 struct mii_ioctl_data *mii_data;
41 int rc = 0;
42
43 if (!card)
44 return -ENODEV;
45
46 if ((card->state != CARD_STATE_UP) &&
47 (card->state != CARD_STATE_SOFTSETUP))
48 return -ENODEV;
49
50 if (card->info.type == QETH_CARD_TYPE_OSN)
51 return -EPERM;
52
53 switch (cmd) {
54 case SIOC_QETH_ADP_SET_SNMP_CONTROL:
55 rc = qeth_snmp_command(card, rq->ifr_ifru.ifru_data);
56 break;
57 case SIOC_QETH_GET_CARD_TYPE:
Ursula Braun5113fec2010-05-16 21:15:14 +000058 if ((card->info.type == QETH_CARD_TYPE_OSD ||
59 card->info.type == QETH_CARD_TYPE_OSM ||
60 card->info.type == QETH_CARD_TYPE_OSX) &&
Frank Blaschka4a71df52008-02-15 09:19:42 +010061 !card->info.guestlan)
62 return 1;
63 return 0;
64 break;
65 case SIOCGMIIPHY:
66 mii_data = if_mii(rq);
67 mii_data->phy_id = 0;
68 break;
69 case SIOCGMIIREG:
70 mii_data = if_mii(rq);
71 if (mii_data->phy_id != 0)
72 rc = -EINVAL;
73 else
74 mii_data->val_out = qeth_mdio_read(dev,
75 mii_data->phy_id, mii_data->reg_num);
76 break;
Frank Blaschkac3ab96f2012-02-08 00:19:49 +000077 case SIOC_QETH_QUERY_OAT:
78 rc = qeth_query_oat_command(card, rq->ifr_ifru.ifru_data);
79 break;
Frank Blaschka4a71df52008-02-15 09:19:42 +010080 default:
81 rc = -EOPNOTSUPP;
82 }
83 if (rc)
Carsten Otte847a50f2010-06-21 22:57:05 +000084 QETH_CARD_TEXT_(card, 2, "ioce%d", rc);
Frank Blaschka4a71df52008-02-15 09:19:42 +010085 return rc;
86}
87
88static int qeth_l2_verify_dev(struct net_device *dev)
89{
90 struct qeth_card *card;
91 unsigned long flags;
92 int rc = 0;
93
94 read_lock_irqsave(&qeth_core_card_list.rwlock, flags);
95 list_for_each_entry(card, &qeth_core_card_list.list, list) {
96 if (card->dev == dev) {
97 rc = QETH_REAL_CARD;
98 break;
99 }
100 }
101 read_unlock_irqrestore(&qeth_core_card_list.rwlock, flags);
102
103 return rc;
104}
105
106static struct net_device *qeth_l2_netdev_by_devno(unsigned char *read_dev_no)
107{
108 struct qeth_card *card;
109 struct net_device *ndev;
Cornelia Huckf06f6f32008-06-06 12:37:45 +0200110 __u16 temp_dev_no;
Frank Blaschka4a71df52008-02-15 09:19:42 +0100111 unsigned long flags;
Cornelia Huckf06f6f32008-06-06 12:37:45 +0200112 struct ccw_dev_id read_devid;
Frank Blaschka4a71df52008-02-15 09:19:42 +0100113
114 ndev = NULL;
115 memcpy(&temp_dev_no, read_dev_no, 2);
116 read_lock_irqsave(&qeth_core_card_list.rwlock, flags);
117 list_for_each_entry(card, &qeth_core_card_list.list, list) {
Cornelia Huckf06f6f32008-06-06 12:37:45 +0200118 ccw_device_get_id(CARD_RDEV(card), &read_devid);
119 if (read_devid.devno == temp_dev_no) {
Frank Blaschka4a71df52008-02-15 09:19:42 +0100120 ndev = card->dev;
121 break;
122 }
123 }
124 read_unlock_irqrestore(&qeth_core_card_list.rwlock, flags);
125 return ndev;
126}
127
128static int qeth_l2_send_setgroupmac_cb(struct qeth_card *card,
129 struct qeth_reply *reply,
130 unsigned long data)
131{
132 struct qeth_ipa_cmd *cmd;
133 __u8 *mac;
134
Carsten Otte847a50f2010-06-21 22:57:05 +0000135 QETH_CARD_TEXT(card, 2, "L2Sgmacb");
Frank Blaschka4a71df52008-02-15 09:19:42 +0100136 cmd = (struct qeth_ipa_cmd *) data;
137 mac = &cmd->data.setdelmac.mac[0];
138 /* MAC already registered, needed in couple/uncouple case */
Ursula Braun0666eb062009-05-19 21:38:39 +0000139 if (cmd->hdr.return_code == IPA_RC_L2_DUP_MAC) {
Johannes Berg7c510e42008-10-27 17:47:26 -0700140 QETH_DBF_MESSAGE(2, "Group MAC %pM already existing on %s \n",
141 mac, QETH_CARD_IFNAME(card));
Frank Blaschka4a71df52008-02-15 09:19:42 +0100142 cmd->hdr.return_code = 0;
143 }
144 if (cmd->hdr.return_code)
Johannes Berg7c510e42008-10-27 17:47:26 -0700145 QETH_DBF_MESSAGE(2, "Could not set group MAC %pM on %s: %x\n",
146 mac, QETH_CARD_IFNAME(card), cmd->hdr.return_code);
Frank Blaschka4a71df52008-02-15 09:19:42 +0100147 return 0;
148}
149
150static int qeth_l2_send_setgroupmac(struct qeth_card *card, __u8 *mac)
151{
Carsten Otte847a50f2010-06-21 22:57:05 +0000152 QETH_CARD_TEXT(card, 2, "L2Sgmac");
Frank Blaschka4a71df52008-02-15 09:19:42 +0100153 return qeth_l2_send_setdelmac(card, mac, IPA_CMD_SETGMAC,
154 qeth_l2_send_setgroupmac_cb);
155}
156
157static int qeth_l2_send_delgroupmac_cb(struct qeth_card *card,
158 struct qeth_reply *reply,
159 unsigned long data)
160{
161 struct qeth_ipa_cmd *cmd;
162 __u8 *mac;
163
Carsten Otte847a50f2010-06-21 22:57:05 +0000164 QETH_CARD_TEXT(card, 2, "L2Dgmacb");
Frank Blaschka4a71df52008-02-15 09:19:42 +0100165 cmd = (struct qeth_ipa_cmd *) data;
166 mac = &cmd->data.setdelmac.mac[0];
167 if (cmd->hdr.return_code)
Johannes Berg7c510e42008-10-27 17:47:26 -0700168 QETH_DBF_MESSAGE(2, "Could not delete group MAC %pM on %s: %x\n",
169 mac, QETH_CARD_IFNAME(card), cmd->hdr.return_code);
Frank Blaschka4a71df52008-02-15 09:19:42 +0100170 return 0;
171}
172
173static int qeth_l2_send_delgroupmac(struct qeth_card *card, __u8 *mac)
174{
Carsten Otte847a50f2010-06-21 22:57:05 +0000175 QETH_CARD_TEXT(card, 2, "L2Dgmac");
Frank Blaschka4a71df52008-02-15 09:19:42 +0100176 return qeth_l2_send_setdelmac(card, mac, IPA_CMD_DELGMAC,
177 qeth_l2_send_delgroupmac_cb);
178}
179
Frank Blaschka7db22662008-08-15 08:02:59 +0200180static void qeth_l2_add_mc(struct qeth_card *card, __u8 *mac, int vmac)
Frank Blaschka4a71df52008-02-15 09:19:42 +0100181{
182 struct qeth_mc_mac *mc;
Frank Blaschka7db22662008-08-15 08:02:59 +0200183 int rc;
Frank Blaschka4a71df52008-02-15 09:19:42 +0100184
185 mc = kmalloc(sizeof(struct qeth_mc_mac), GFP_ATOMIC);
186
Frank Blaschka14cc21b2008-06-06 12:37:46 +0200187 if (!mc)
Frank Blaschka4a71df52008-02-15 09:19:42 +0100188 return;
Frank Blaschka4a71df52008-02-15 09:19:42 +0100189
190 memcpy(mc->mc_addr, mac, OSA_ADDR_LEN);
191 mc->mc_addrlen = OSA_ADDR_LEN;
Frank Blaschka7db22662008-08-15 08:02:59 +0200192 mc->is_vmac = vmac;
Frank Blaschka4a71df52008-02-15 09:19:42 +0100193
Frank Blaschka7db22662008-08-15 08:02:59 +0200194 if (vmac) {
195 rc = qeth_l2_send_setdelmac(card, mac, IPA_CMD_SETVMAC,
196 NULL);
197 } else {
198 rc = qeth_l2_send_setgroupmac(card, mac);
199 }
200
201 if (!rc)
Frank Blaschka4a71df52008-02-15 09:19:42 +0100202 list_add_tail(&mc->list, &card->mc_list);
203 else
204 kfree(mc);
205}
206
Ursula Braun70919e22011-02-26 22:41:36 -0800207static void qeth_l2_del_all_mc(struct qeth_card *card, int del)
Frank Blaschka4a71df52008-02-15 09:19:42 +0100208{
209 struct qeth_mc_mac *mc, *tmp;
210
211 spin_lock_bh(&card->mclock);
212 list_for_each_entry_safe(mc, tmp, &card->mc_list, list) {
Ursula Braun70919e22011-02-26 22:41:36 -0800213 if (del) {
214 if (mc->is_vmac)
215 qeth_l2_send_setdelmac(card, mc->mc_addr,
Frank Blaschka7db22662008-08-15 08:02:59 +0200216 IPA_CMD_DELVMAC, NULL);
Ursula Braun70919e22011-02-26 22:41:36 -0800217 else
218 qeth_l2_send_delgroupmac(card, mc->mc_addr);
219 }
Frank Blaschka4a71df52008-02-15 09:19:42 +0100220 list_del(&mc->list);
221 kfree(mc);
222 }
223 spin_unlock_bh(&card->mclock);
224}
225
Klaus-Dieter Wackerce73e102009-08-26 02:01:08 +0000226static inline int qeth_l2_get_cast_type(struct qeth_card *card,
227 struct sk_buff *skb)
Frank Blaschka4a71df52008-02-15 09:19:42 +0100228{
Klaus-Dieter Wackerce73e102009-08-26 02:01:08 +0000229 if (card->info.type == QETH_CARD_TYPE_OSN)
230 return RTN_UNSPEC;
231 if (is_broadcast_ether_addr(skb->data))
232 return RTN_BROADCAST;
233 if (is_multicast_ether_addr(skb->data))
234 return RTN_MULTICAST;
235 return RTN_UNSPEC;
Frank Blaschka4a71df52008-02-15 09:19:42 +0100236}
237
238static void qeth_l2_fill_header(struct qeth_card *card, struct qeth_hdr *hdr,
239 struct sk_buff *skb, int ipv, int cast_type)
240{
Frank Blaschka683d7182008-08-01 16:39:13 +0200241 struct vlan_ethhdr *veth = (struct vlan_ethhdr *)skb_mac_header(skb);
Frank Blaschka4a71df52008-02-15 09:19:42 +0100242
243 memset(hdr, 0, sizeof(struct qeth_hdr));
244 hdr->hdr.l2.id = QETH_HEADER_TYPE_LAYER2;
245
246 /* set byte byte 3 to casting flags */
247 if (cast_type == RTN_MULTICAST)
248 hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_MULTICAST;
249 else if (cast_type == RTN_BROADCAST)
250 hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_BROADCAST;
251 else
Klaus-Dieter Wackerce73e102009-08-26 02:01:08 +0000252 hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_UNICAST;
Frank Blaschka4a71df52008-02-15 09:19:42 +0100253
254 hdr->hdr.l2.pkt_length = skb->len-QETH_HEADER_SIZE;
255 /* VSWITCH relies on the VLAN
256 * information to be present in
257 * the QDIO header */
258 if (veth->h_vlan_proto == __constant_htons(ETH_P_8021Q)) {
259 hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_VLAN;
260 hdr->hdr.l2.vlan_id = ntohs(veth->h_vlan_TCI);
261 }
262}
263
264static int qeth_l2_send_setdelvlan_cb(struct qeth_card *card,
265 struct qeth_reply *reply, unsigned long data)
266{
267 struct qeth_ipa_cmd *cmd;
268
Carsten Otte847a50f2010-06-21 22:57:05 +0000269 QETH_CARD_TEXT(card, 2, "L2sdvcb");
Frank Blaschka4a71df52008-02-15 09:19:42 +0100270 cmd = (struct qeth_ipa_cmd *) data;
271 if (cmd->hdr.return_code) {
Frank Blaschka14cc21b2008-06-06 12:37:46 +0200272 QETH_DBF_MESSAGE(2, "Error in processing VLAN %i on %s: 0x%x. "
Frank Blaschka4a71df52008-02-15 09:19:42 +0100273 "Continuing\n", cmd->data.setdelvlan.vlan_id,
274 QETH_CARD_IFNAME(card), cmd->hdr.return_code);
Carsten Otte847a50f2010-06-21 22:57:05 +0000275 QETH_CARD_TEXT_(card, 2, "L2VL%4x", cmd->hdr.command);
276 QETH_CARD_TEXT_(card, 2, "err%d", cmd->hdr.return_code);
Frank Blaschka4a71df52008-02-15 09:19:42 +0100277 }
278 return 0;
279}
280
281static int qeth_l2_send_setdelvlan(struct qeth_card *card, __u16 i,
282 enum qeth_ipa_cmds ipacmd)
283{
284 struct qeth_ipa_cmd *cmd;
285 struct qeth_cmd_buffer *iob;
286
Carsten Otte847a50f2010-06-21 22:57:05 +0000287 QETH_CARD_TEXT_(card, 4, "L2sdv%x", ipacmd);
Frank Blaschka4a71df52008-02-15 09:19:42 +0100288 iob = qeth_get_ipacmd_buffer(card, ipacmd, QETH_PROT_IPV4);
289 cmd = (struct qeth_ipa_cmd *)(iob->data+IPA_PDU_HEADER_SIZE);
290 cmd->data.setdelvlan.vlan_id = i;
291 return qeth_send_ipa_cmd(card, iob,
292 qeth_l2_send_setdelvlan_cb, NULL);
293}
294
Ursula Braun70919e22011-02-26 22:41:36 -0800295static void qeth_l2_process_vlans(struct qeth_card *card)
Frank Blaschka4a71df52008-02-15 09:19:42 +0100296{
297 struct qeth_vlan_vid *id;
Carsten Otte847a50f2010-06-21 22:57:05 +0000298 QETH_CARD_TEXT(card, 3, "L2prcvln");
Frank Blaschka4a71df52008-02-15 09:19:42 +0100299 spin_lock_bh(&card->vlanlock);
300 list_for_each_entry(id, &card->vid_list, list) {
Ursula Braun70919e22011-02-26 22:41:36 -0800301 qeth_l2_send_setdelvlan(card, id->vid, IPA_CMD_SETVLAN);
Frank Blaschka4a71df52008-02-15 09:19:42 +0100302 }
303 spin_unlock_bh(&card->vlanlock);
304}
305
Patrick McHardy80d5c362013-04-19 02:04:28 +0000306static int qeth_l2_vlan_rx_add_vid(struct net_device *dev,
307 __be16 proto, u16 vid)
Frank Blaschka4a71df52008-02-15 09:19:42 +0100308{
Heiko Carstens509e2562008-07-26 02:24:10 -0700309 struct qeth_card *card = dev->ml_priv;
Frank Blaschka4a71df52008-02-15 09:19:42 +0100310 struct qeth_vlan_vid *id;
311
Carsten Otte847a50f2010-06-21 22:57:05 +0000312 QETH_CARD_TEXT_(card, 4, "aid:%d", vid);
Ursula Braun10651db2010-10-01 02:51:13 +0000313 if (!vid)
Jiri Pirko8e586132011-12-08 19:52:37 -0500314 return 0;
Ursula Braun5113fec2010-05-16 21:15:14 +0000315 if (card->info.type == QETH_CARD_TYPE_OSM) {
Carsten Otte847a50f2010-06-21 22:57:05 +0000316 QETH_CARD_TEXT(card, 3, "aidOSM");
Jiri Pirko8e586132011-12-08 19:52:37 -0500317 return 0;
Ursula Braun5113fec2010-05-16 21:15:14 +0000318 }
Ursula Braun8e98ac42009-03-24 20:57:18 +0000319 if (qeth_wait_for_threads(card, QETH_RECOVER_THREAD)) {
Carsten Otte847a50f2010-06-21 22:57:05 +0000320 QETH_CARD_TEXT(card, 3, "aidREC");
Jiri Pirko8e586132011-12-08 19:52:37 -0500321 return 0;
Ursula Braun8e98ac42009-03-24 20:57:18 +0000322 }
Frank Blaschka4a71df52008-02-15 09:19:42 +0100323 id = kmalloc(sizeof(struct qeth_vlan_vid), GFP_ATOMIC);
324 if (id) {
325 id->vid = vid;
326 qeth_l2_send_setdelvlan(card, vid, IPA_CMD_SETVLAN);
327 spin_lock_bh(&card->vlanlock);
328 list_add_tail(&id->list, &card->vid_list);
329 spin_unlock_bh(&card->vlanlock);
Jiri Pirko8e586132011-12-08 19:52:37 -0500330 } else {
331 return -ENOMEM;
Frank Blaschka4a71df52008-02-15 09:19:42 +0100332 }
Jiri Pirko8e586132011-12-08 19:52:37 -0500333 return 0;
Frank Blaschka4a71df52008-02-15 09:19:42 +0100334}
335
Patrick McHardy80d5c362013-04-19 02:04:28 +0000336static int qeth_l2_vlan_rx_kill_vid(struct net_device *dev,
337 __be16 proto, u16 vid)
Frank Blaschka4a71df52008-02-15 09:19:42 +0100338{
339 struct qeth_vlan_vid *id, *tmpid = NULL;
Heiko Carstens509e2562008-07-26 02:24:10 -0700340 struct qeth_card *card = dev->ml_priv;
Frank Blaschka4a71df52008-02-15 09:19:42 +0100341
Carsten Otte847a50f2010-06-21 22:57:05 +0000342 QETH_CARD_TEXT_(card, 4, "kid:%d", vid);
Ursula Braun5113fec2010-05-16 21:15:14 +0000343 if (card->info.type == QETH_CARD_TYPE_OSM) {
Carsten Otte847a50f2010-06-21 22:57:05 +0000344 QETH_CARD_TEXT(card, 3, "kidOSM");
Jiri Pirko8e586132011-12-08 19:52:37 -0500345 return 0;
Ursula Braun5113fec2010-05-16 21:15:14 +0000346 }
Ursula Braun8e98ac42009-03-24 20:57:18 +0000347 if (qeth_wait_for_threads(card, QETH_RECOVER_THREAD)) {
Carsten Otte847a50f2010-06-21 22:57:05 +0000348 QETH_CARD_TEXT(card, 3, "kidREC");
Jiri Pirko8e586132011-12-08 19:52:37 -0500349 return 0;
Ursula Braun8e98ac42009-03-24 20:57:18 +0000350 }
Frank Blaschka4a71df52008-02-15 09:19:42 +0100351 spin_lock_bh(&card->vlanlock);
352 list_for_each_entry(id, &card->vid_list, list) {
353 if (id->vid == vid) {
354 list_del(&id->list);
355 tmpid = id;
356 break;
357 }
358 }
359 spin_unlock_bh(&card->vlanlock);
360 if (tmpid) {
361 qeth_l2_send_setdelvlan(card, vid, IPA_CMD_DELVLAN);
362 kfree(tmpid);
363 }
364 qeth_l2_set_multicast_list(card->dev);
Jiri Pirko8e586132011-12-08 19:52:37 -0500365 return 0;
Frank Blaschka4a71df52008-02-15 09:19:42 +0100366}
367
368static int qeth_l2_stop_card(struct qeth_card *card, int recovery_mode)
369{
370 int rc = 0;
371
Peter Tiedemannd11ba0c2008-04-01 10:26:58 +0200372 QETH_DBF_TEXT(SETUP , 2, "stopcard");
373 QETH_DBF_HEX(SETUP, 2, &card, sizeof(void *));
Frank Blaschka4a71df52008-02-15 09:19:42 +0100374
375 qeth_set_allowed_threads(card, 0, 1);
Frank Blaschka4a71df52008-02-15 09:19:42 +0100376 if (card->read.state == CH_STATE_UP &&
377 card->write.state == CH_STATE_UP &&
378 (card->state == CARD_STATE_UP)) {
379 if (recovery_mode &&
380 card->info.type != QETH_CARD_TYPE_OSN) {
381 qeth_l2_stop(card->dev);
382 } else {
383 rtnl_lock();
384 dev_close(card->dev);
385 rtnl_unlock();
386 }
Ursula Braun70919e22011-02-26 22:41:36 -0800387 card->info.mac_bits &= ~QETH_LAYER2_MAC_REGISTERED;
Frank Blaschka4a71df52008-02-15 09:19:42 +0100388 card->state = CARD_STATE_SOFTSETUP;
389 }
390 if (card->state == CARD_STATE_SOFTSETUP) {
Ursula Braun70919e22011-02-26 22:41:36 -0800391 qeth_l2_del_all_mc(card, 0);
Frank Blaschka4a71df52008-02-15 09:19:42 +0100392 qeth_clear_ipacmd_list(card);
393 card->state = CARD_STATE_HARDSETUP;
394 }
395 if (card->state == CARD_STATE_HARDSETUP) {
396 qeth_qdio_clear_card(card, 0);
397 qeth_clear_qdio_buffers(card);
398 qeth_clear_working_pool_list(card);
399 card->state = CARD_STATE_DOWN;
400 }
401 if (card->state == CARD_STATE_DOWN) {
402 qeth_clear_cmd_buffers(&card->read);
403 qeth_clear_cmd_buffers(&card->write);
404 }
Frank Blaschka4a71df52008-02-15 09:19:42 +0100405 return rc;
406}
407
Frank Blaschkaa1c3ed42010-09-07 21:14:42 +0000408static int qeth_l2_process_inbound_buffer(struct qeth_card *card,
409 int budget, int *done)
Frank Blaschka4a71df52008-02-15 09:19:42 +0100410{
Frank Blaschkaa1c3ed42010-09-07 21:14:42 +0000411 int work_done = 0;
Frank Blaschka4a71df52008-02-15 09:19:42 +0100412 struct sk_buff *skb;
413 struct qeth_hdr *hdr;
Frank Blaschka4a71df52008-02-15 09:19:42 +0100414 unsigned int len;
415
Frank Blaschkaa1c3ed42010-09-07 21:14:42 +0000416 *done = 0;
Stefan Raspl18af5c12012-11-19 02:46:50 +0000417 WARN_ON_ONCE(!budget);
Frank Blaschkaa1c3ed42010-09-07 21:14:42 +0000418 while (budget) {
419 skb = qeth_core_get_next_skb(card,
Frank Blaschkab3332932011-08-08 01:33:59 +0000420 &card->qdio.in_q->bufs[card->rx.b_index],
Frank Blaschkaa1c3ed42010-09-07 21:14:42 +0000421 &card->rx.b_element, &card->rx.e_offset, &hdr);
422 if (!skb) {
423 *done = 1;
424 break;
Frank Blaschka4a71df52008-02-15 09:19:42 +0100425 }
Frank Blaschkaa1c3ed42010-09-07 21:14:42 +0000426 skb->dev = card->dev;
Frank Blaschka4a71df52008-02-15 09:19:42 +0100427 switch (hdr->hdr.l2.id) {
428 case QETH_HEADER_TYPE_LAYER2:
429 skb->pkt_type = PACKET_HOST;
430 skb->protocol = eth_type_trans(skb, skb->dev);
Frank Blaschkac5e631a2011-05-12 18:45:01 +0000431 skb->ip_summed = CHECKSUM_NONE;
Ursula Braun12883722008-04-01 10:26:56 +0200432 if (skb->protocol == htons(ETH_P_802_2))
433 *((__u32 *)skb->cb) = ++card->seqno.pkt_seqno;
Frank Blaschka4a71df52008-02-15 09:19:42 +0100434 len = skb->len;
Frank Blaschkaa1c3ed42010-09-07 21:14:42 +0000435 netif_receive_skb(skb);
Frank Blaschka4a71df52008-02-15 09:19:42 +0100436 break;
437 case QETH_HEADER_TYPE_OSN:
Ursula Braun2d488c22008-10-24 11:16:55 +0200438 if (card->info.type == QETH_CARD_TYPE_OSN) {
439 skb_push(skb, sizeof(struct qeth_hdr));
440 skb_copy_to_linear_data(skb, hdr,
Frank Blaschka4a71df52008-02-15 09:19:42 +0100441 sizeof(struct qeth_hdr));
Ursula Braun2d488c22008-10-24 11:16:55 +0200442 len = skb->len;
443 card->osn_info.data_cb(skb);
444 break;
445 }
446 /* else unknown */
Frank Blaschka4a71df52008-02-15 09:19:42 +0100447 default:
448 dev_kfree_skb_any(skb);
Carsten Otte847a50f2010-06-21 22:57:05 +0000449 QETH_CARD_TEXT(card, 3, "inbunkno");
Peter Tiedemannd11ba0c2008-04-01 10:26:58 +0200450 QETH_DBF_HEX(CTRL, 3, hdr, QETH_DBF_CTRL_LEN);
Frank Blaschka4a71df52008-02-15 09:19:42 +0100451 continue;
452 }
Frank Blaschkaa1c3ed42010-09-07 21:14:42 +0000453 work_done++;
454 budget--;
Frank Blaschka4a71df52008-02-15 09:19:42 +0100455 card->stats.rx_packets++;
456 card->stats.rx_bytes += len;
457 }
Frank Blaschkaa1c3ed42010-09-07 21:14:42 +0000458 return work_done;
459}
460
461static int qeth_l2_poll(struct napi_struct *napi, int budget)
462{
463 struct qeth_card *card = container_of(napi, struct qeth_card, napi);
464 int work_done = 0;
465 struct qeth_qdio_buffer *buffer;
466 int done;
467 int new_budget = budget;
468
469 if (card->options.performance_stats) {
470 card->perf_stats.inbound_cnt++;
471 card->perf_stats.inbound_start_time = qeth_get_micros();
472 }
473
474 while (1) {
475 if (!card->rx.b_count) {
476 card->rx.qdio_err = 0;
477 card->rx.b_count = qdio_get_next_buffers(
478 card->data.ccwdev, 0, &card->rx.b_index,
479 &card->rx.qdio_err);
480 if (card->rx.b_count <= 0) {
481 card->rx.b_count = 0;
482 break;
483 }
484 card->rx.b_element =
485 &card->qdio.in_q->bufs[card->rx.b_index]
486 .buffer->element[0];
487 card->rx.e_offset = 0;
488 }
489
490 while (card->rx.b_count) {
491 buffer = &card->qdio.in_q->bufs[card->rx.b_index];
492 if (!(card->rx.qdio_err &&
493 qeth_check_qdio_errors(card, buffer->buffer,
494 card->rx.qdio_err, "qinerr")))
495 work_done += qeth_l2_process_inbound_buffer(
496 card, new_budget, &done);
497 else
498 done = 1;
499
500 if (done) {
501 if (card->options.performance_stats)
502 card->perf_stats.bufs_rec++;
503 qeth_put_buffer_pool_entry(card,
504 buffer->pool_entry);
505 qeth_queue_input_buffer(card, card->rx.b_index);
506 card->rx.b_count--;
507 if (card->rx.b_count) {
508 card->rx.b_index =
509 (card->rx.b_index + 1) %
510 QDIO_MAX_BUFFERS_PER_Q;
511 card->rx.b_element =
512 &card->qdio.in_q
513 ->bufs[card->rx.b_index]
514 .buffer->element[0];
515 card->rx.e_offset = 0;
516 }
517 }
518
519 if (work_done >= budget)
520 goto out;
521 else
522 new_budget = budget - work_done;
523 }
524 }
525
526 napi_complete(napi);
527 if (qdio_start_irq(card->data.ccwdev, 0))
528 napi_schedule(&card->napi);
529out:
530 if (card->options.performance_stats)
531 card->perf_stats.inbound_time += qeth_get_micros() -
532 card->perf_stats.inbound_start_time;
533 return work_done;
Frank Blaschka4a71df52008-02-15 09:19:42 +0100534}
535
536static int qeth_l2_send_setdelmac(struct qeth_card *card, __u8 *mac,
537 enum qeth_ipa_cmds ipacmd,
538 int (*reply_cb) (struct qeth_card *,
539 struct qeth_reply*,
540 unsigned long))
541{
542 struct qeth_ipa_cmd *cmd;
543 struct qeth_cmd_buffer *iob;
544
Carsten Otte847a50f2010-06-21 22:57:05 +0000545 QETH_CARD_TEXT(card, 2, "L2sdmac");
Frank Blaschka4a71df52008-02-15 09:19:42 +0100546 iob = qeth_get_ipacmd_buffer(card, ipacmd, QETH_PROT_IPV4);
547 cmd = (struct qeth_ipa_cmd *)(iob->data+IPA_PDU_HEADER_SIZE);
548 cmd->data.setdelmac.mac_length = OSA_ADDR_LEN;
549 memcpy(&cmd->data.setdelmac.mac, mac, OSA_ADDR_LEN);
550 return qeth_send_ipa_cmd(card, iob, reply_cb, NULL);
551}
552
553static int qeth_l2_send_setmac_cb(struct qeth_card *card,
554 struct qeth_reply *reply,
555 unsigned long data)
556{
557 struct qeth_ipa_cmd *cmd;
558
Carsten Otte847a50f2010-06-21 22:57:05 +0000559 QETH_CARD_TEXT(card, 2, "L2Smaccb");
Frank Blaschka4a71df52008-02-15 09:19:42 +0100560 cmd = (struct qeth_ipa_cmd *) data;
561 if (cmd->hdr.return_code) {
Carsten Otte847a50f2010-06-21 22:57:05 +0000562 QETH_CARD_TEXT_(card, 2, "L2er%x", cmd->hdr.return_code);
Frank Blaschka4a71df52008-02-15 09:19:42 +0100563 card->info.mac_bits &= ~QETH_LAYER2_MAC_REGISTERED;
Ursula Braun0666eb062009-05-19 21:38:39 +0000564 switch (cmd->hdr.return_code) {
565 case IPA_RC_L2_DUP_MAC:
566 case IPA_RC_L2_DUP_LAYER3_MAC:
567 dev_warn(&card->gdev->dev,
H Hartley Sweetend998ab02009-12-29 20:05:37 -0800568 "MAC address %pM already exists\n",
Ursula Braun221c17f2011-02-02 06:04:31 +0000569 cmd->data.setdelmac.mac);
Ursula Braun0666eb062009-05-19 21:38:39 +0000570 break;
571 case IPA_RC_L2_MAC_NOT_AUTH_BY_HYP:
572 case IPA_RC_L2_MAC_NOT_AUTH_BY_ADP:
573 dev_warn(&card->gdev->dev,
H Hartley Sweetend998ab02009-12-29 20:05:37 -0800574 "MAC address %pM is not authorized\n",
Ursula Braun221c17f2011-02-02 06:04:31 +0000575 cmd->data.setdelmac.mac);
Ursula Braun0666eb062009-05-19 21:38:39 +0000576 break;
577 default:
578 break;
579 }
Frank Blaschka4a71df52008-02-15 09:19:42 +0100580 } else {
581 card->info.mac_bits |= QETH_LAYER2_MAC_REGISTERED;
582 memcpy(card->dev->dev_addr, cmd->data.setdelmac.mac,
583 OSA_ADDR_LEN);
Frank Blaschka74eacdb2008-12-25 13:39:49 +0100584 dev_info(&card->gdev->dev,
H Hartley Sweetend998ab02009-12-29 20:05:37 -0800585 "MAC address %pM successfully registered on device %s\n",
586 card->dev->dev_addr, card->dev->name);
Frank Blaschka4a71df52008-02-15 09:19:42 +0100587 }
588 return 0;
589}
590
591static int qeth_l2_send_setmac(struct qeth_card *card, __u8 *mac)
592{
Carsten Otte847a50f2010-06-21 22:57:05 +0000593 QETH_CARD_TEXT(card, 2, "L2Setmac");
Frank Blaschka4a71df52008-02-15 09:19:42 +0100594 return qeth_l2_send_setdelmac(card, mac, IPA_CMD_SETVMAC,
595 qeth_l2_send_setmac_cb);
596}
597
598static int qeth_l2_send_delmac_cb(struct qeth_card *card,
599 struct qeth_reply *reply,
600 unsigned long data)
601{
602 struct qeth_ipa_cmd *cmd;
603
Carsten Otte847a50f2010-06-21 22:57:05 +0000604 QETH_CARD_TEXT(card, 2, "L2Dmaccb");
Frank Blaschka4a71df52008-02-15 09:19:42 +0100605 cmd = (struct qeth_ipa_cmd *) data;
606 if (cmd->hdr.return_code) {
Carsten Otte847a50f2010-06-21 22:57:05 +0000607 QETH_CARD_TEXT_(card, 2, "err%d", cmd->hdr.return_code);
Frank Blaschka4a71df52008-02-15 09:19:42 +0100608 return 0;
609 }
610 card->info.mac_bits &= ~QETH_LAYER2_MAC_REGISTERED;
611
612 return 0;
613}
614
615static int qeth_l2_send_delmac(struct qeth_card *card, __u8 *mac)
616{
Carsten Otte847a50f2010-06-21 22:57:05 +0000617 QETH_CARD_TEXT(card, 2, "L2Delmac");
Frank Blaschka4a71df52008-02-15 09:19:42 +0100618 if (!(card->info.mac_bits & QETH_LAYER2_MAC_REGISTERED))
619 return 0;
620 return qeth_l2_send_setdelmac(card, mac, IPA_CMD_DELVMAC,
621 qeth_l2_send_delmac_cb);
622}
623
624static int qeth_l2_request_initial_mac(struct qeth_card *card)
625{
626 int rc = 0;
627 char vendor_pre[] = {0x02, 0x00, 0x00};
628
Peter Tiedemannd11ba0c2008-04-01 10:26:58 +0200629 QETH_DBF_TEXT(SETUP, 2, "doL2init");
630 QETH_DBF_TEXT_(SETUP, 2, "doL2%s", CARD_BUS_ID(card));
Frank Blaschka4a71df52008-02-15 09:19:42 +0100631
Stefan Raspla1348842012-11-12 23:05:16 +0000632 if (qeth_is_supported(card, IPA_SETADAPTERPARMS)) {
633 rc = qeth_query_setadapterparms(card);
634 if (rc) {
635 QETH_DBF_MESSAGE(2, "could not query adapter "
636 "parameters on device %s: x%x\n",
637 CARD_BUS_ID(card), rc);
638 }
Frank Blaschka4a71df52008-02-15 09:19:42 +0100639 }
640
Ursula Braun5113fec2010-05-16 21:15:14 +0000641 if (card->info.type == QETH_CARD_TYPE_IQD ||
642 card->info.type == QETH_CARD_TYPE_OSM ||
643 card->info.type == QETH_CARD_TYPE_OSX ||
644 card->info.guestlan) {
Frank Blaschka4a71df52008-02-15 09:19:42 +0100645 rc = qeth_setadpparms_change_macaddr(card);
646 if (rc) {
Frank Blaschka14cc21b2008-06-06 12:37:46 +0200647 QETH_DBF_MESSAGE(2, "couldn't get MAC address on "
648 "device %s: x%x\n", CARD_BUS_ID(card), rc);
Peter Tiedemannd11ba0c2008-04-01 10:26:58 +0200649 QETH_DBF_TEXT_(SETUP, 2, "1err%d", rc);
Frank Blaschka4a71df52008-02-15 09:19:42 +0100650 return rc;
651 }
Peter Tiedemannd11ba0c2008-04-01 10:26:58 +0200652 QETH_DBF_HEX(SETUP, 2, card->dev->dev_addr, OSA_ADDR_LEN);
Frank Blaschka4a71df52008-02-15 09:19:42 +0100653 } else {
Joe Perches18336112012-07-12 22:33:10 -0700654 eth_random_addr(card->dev->dev_addr);
Frank Blaschka4a71df52008-02-15 09:19:42 +0100655 memcpy(card->dev->dev_addr, vendor_pre, 3);
656 }
657 return 0;
658}
659
660static int qeth_l2_set_mac_address(struct net_device *dev, void *p)
661{
662 struct sockaddr *addr = p;
Heiko Carstens509e2562008-07-26 02:24:10 -0700663 struct qeth_card *card = dev->ml_priv;
Frank Blaschka4a71df52008-02-15 09:19:42 +0100664 int rc = 0;
665
Carsten Otte847a50f2010-06-21 22:57:05 +0000666 QETH_CARD_TEXT(card, 3, "setmac");
Frank Blaschka4a71df52008-02-15 09:19:42 +0100667
668 if (qeth_l2_verify_dev(dev) != QETH_REAL_CARD) {
Carsten Otte847a50f2010-06-21 22:57:05 +0000669 QETH_CARD_TEXT(card, 3, "setmcINV");
Frank Blaschka4a71df52008-02-15 09:19:42 +0100670 return -EOPNOTSUPP;
671 }
672
Ursula Braun5113fec2010-05-16 21:15:14 +0000673 if (card->info.type == QETH_CARD_TYPE_OSN ||
674 card->info.type == QETH_CARD_TYPE_OSM ||
675 card->info.type == QETH_CARD_TYPE_OSX) {
Carsten Otte847a50f2010-06-21 22:57:05 +0000676 QETH_CARD_TEXT(card, 3, "setmcTYP");
Frank Blaschka4a71df52008-02-15 09:19:42 +0100677 return -EOPNOTSUPP;
678 }
Carsten Otte847a50f2010-06-21 22:57:05 +0000679 QETH_CARD_HEX(card, 3, addr->sa_data, OSA_ADDR_LEN);
Ursula Braun8e98ac42009-03-24 20:57:18 +0000680 if (qeth_wait_for_threads(card, QETH_RECOVER_THREAD)) {
Carsten Otte847a50f2010-06-21 22:57:05 +0000681 QETH_CARD_TEXT(card, 3, "setmcREC");
Ursula Braun8e98ac42009-03-24 20:57:18 +0000682 return -ERESTARTSYS;
683 }
Frank Blaschka4a71df52008-02-15 09:19:42 +0100684 rc = qeth_l2_send_delmac(card, &card->dev->dev_addr[0]);
Ursula Braun77027452012-11-12 23:05:17 +0000685 if (!rc || (rc == IPA_RC_L2_MAC_NOT_FOUND))
Frank Blaschka4a71df52008-02-15 09:19:42 +0100686 rc = qeth_l2_send_setmac(card, addr->sa_data);
Ursula Braune0a81142012-03-07 02:06:28 +0000687 return rc ? -EINVAL : 0;
Frank Blaschka4a71df52008-02-15 09:19:42 +0100688}
689
690static void qeth_l2_set_multicast_list(struct net_device *dev)
691{
Heiko Carstens509e2562008-07-26 02:24:10 -0700692 struct qeth_card *card = dev->ml_priv;
Jiri Pirkoccffad252009-05-22 23:22:17 +0000693 struct netdev_hw_addr *ha;
Frank Blaschka4a71df52008-02-15 09:19:42 +0100694
695 if (card->info.type == QETH_CARD_TYPE_OSN)
696 return ;
697
Carsten Otte847a50f2010-06-21 22:57:05 +0000698 QETH_CARD_TEXT(card, 3, "setmulti");
Ursula Braun8e98ac42009-03-24 20:57:18 +0000699 if (qeth_threads_running(card, QETH_RECOVER_THREAD) &&
700 (card->state != CARD_STATE_UP))
701 return;
Ursula Braun70919e22011-02-26 22:41:36 -0800702 qeth_l2_del_all_mc(card, 1);
Frank Blaschka4a71df52008-02-15 09:19:42 +0100703 spin_lock_bh(&card->mclock);
Jiri Pirko22bedad32010-04-01 21:22:57 +0000704 netdev_for_each_mc_addr(ha, dev)
705 qeth_l2_add_mc(card, ha->addr, 0);
Frank Blaschka7db22662008-08-15 08:02:59 +0200706
Jiri Pirko32e7bfc2010-01-25 13:36:10 -0800707 netdev_for_each_uc_addr(ha, dev)
Jiri Pirkoccffad252009-05-22 23:22:17 +0000708 qeth_l2_add_mc(card, ha->addr, 1);
Frank Blaschka7db22662008-08-15 08:02:59 +0200709
Frank Blaschka4a71df52008-02-15 09:19:42 +0100710 spin_unlock_bh(&card->mclock);
711 if (!qeth_adp_supported(card, IPA_SETADP_SET_PROMISC_MODE))
712 return;
713 qeth_setadp_promisc_mode(card);
714}
715
716static int qeth_l2_hard_start_xmit(struct sk_buff *skb, struct net_device *dev)
717{
718 int rc;
719 struct qeth_hdr *hdr = NULL;
720 int elements = 0;
Heiko Carstens509e2562008-07-26 02:24:10 -0700721 struct qeth_card *card = dev->ml_priv;
Frank Blaschka4a71df52008-02-15 09:19:42 +0100722 struct sk_buff *new_skb = skb;
723 int ipv = qeth_get_ip_version(skb);
Klaus-Dieter Wackerce73e102009-08-26 02:01:08 +0000724 int cast_type = qeth_l2_get_cast_type(card, skb);
Frank Blaschka4a71df52008-02-15 09:19:42 +0100725 struct qeth_qdio_out_q *queue = card->qdio.out_qs
726 [qeth_get_priority_queue(card, skb, ipv, cast_type)];
727 int tx_bytes = skb->len;
Frank Blaschka683d7182008-08-01 16:39:13 +0200728 int data_offset = -1;
729 int elements_needed = 0;
730 int hd_len = 0;
Frank Blaschka4a71df52008-02-15 09:19:42 +0100731
Frank Blaschka4a71df52008-02-15 09:19:42 +0100732 if ((card->state != CARD_STATE_UP) || !card->lan_online) {
733 card->stats.tx_carrier_errors++;
734 goto tx_drop;
735 }
736
737 if ((card->info.type == QETH_CARD_TYPE_OSN) &&
738 (skb->protocol == htons(ETH_P_IPV6)))
739 goto tx_drop;
740
741 if (card->options.performance_stats) {
742 card->perf_stats.outbound_cnt++;
743 card->perf_stats.outbound_start_time = qeth_get_micros();
744 }
745 netif_stop_queue(dev);
746
Frank Blaschka4a71df52008-02-15 09:19:42 +0100747 if (card->info.type == QETH_CARD_TYPE_OSN)
748 hdr = (struct qeth_hdr *)skb->data;
749 else {
Frank Blaschka64ef8952009-03-24 20:57:16 +0000750 if (card->info.type == QETH_CARD_TYPE_IQD) {
Frank Blaschka683d7182008-08-01 16:39:13 +0200751 new_skb = skb;
752 data_offset = ETH_HLEN;
753 hd_len = ETH_HLEN;
754 hdr = kmem_cache_alloc(qeth_core_header_cache,
755 GFP_ATOMIC);
756 if (!hdr)
757 goto tx_drop;
758 elements_needed++;
759 skb_reset_mac_header(new_skb);
760 qeth_l2_fill_header(card, hdr, new_skb, ipv, cast_type);
761 hdr->hdr.l2.pkt_length = new_skb->len;
762 memcpy(((char *)hdr) + sizeof(struct qeth_hdr),
763 skb_mac_header(new_skb), ETH_HLEN);
764 } else {
765 /* create a clone with writeable headroom */
766 new_skb = skb_realloc_headroom(skb,
Frank Blaschkaf90b7442008-04-24 10:15:24 +0200767 sizeof(struct qeth_hdr));
Frank Blaschka683d7182008-08-01 16:39:13 +0200768 if (!new_skb)
769 goto tx_drop;
770 hdr = (struct qeth_hdr *)skb_push(new_skb,
771 sizeof(struct qeth_hdr));
772 skb_set_mac_header(new_skb, sizeof(struct qeth_hdr));
773 qeth_l2_fill_header(card, hdr, new_skb, ipv, cast_type);
774 }
Frank Blaschka4a71df52008-02-15 09:19:42 +0100775 }
776
Stefan Raspl065cc782013-04-22 01:12:28 +0000777 elements = qeth_get_elements_no(card, new_skb, elements_needed);
Frank Blaschka64ef8952009-03-24 20:57:16 +0000778 if (!elements) {
779 if (data_offset >= 0)
780 kmem_cache_free(qeth_core_header_cache, hdr);
781 goto tx_drop;
Frank Blaschkaf61a0d02009-03-24 20:57:15 +0000782 }
Frank Blaschka4a71df52008-02-15 09:19:42 +0100783
Frank Blaschka51aa1652010-06-21 22:57:10 +0000784 if (card->info.type != QETH_CARD_TYPE_IQD) {
Stefan Raspld4ae1f52013-04-22 01:12:29 +0000785 if (qeth_hdr_chk_and_bounce(new_skb, &hdr,
Frank Blaschka51aa1652010-06-21 22:57:10 +0000786 sizeof(struct qeth_hdr_layer2)))
787 goto tx_drop;
Frank Blaschka4a71df52008-02-15 09:19:42 +0100788 rc = qeth_do_send_packet(card, queue, new_skb, hdr,
Frank Blaschka64ef8952009-03-24 20:57:16 +0000789 elements);
Frank Blaschka51aa1652010-06-21 22:57:10 +0000790 } else
Frank Blaschka4a71df52008-02-15 09:19:42 +0100791 rc = qeth_do_send_packet_fast(card, queue, new_skb, hdr,
Frank Blaschka64ef8952009-03-24 20:57:16 +0000792 elements, data_offset, hd_len);
Frank Blaschka4a71df52008-02-15 09:19:42 +0100793 if (!rc) {
794 card->stats.tx_packets++;
795 card->stats.tx_bytes += tx_bytes;
796 if (new_skb != skb)
797 dev_kfree_skb_any(skb);
Patrick McHardyec634fe2009-07-05 19:23:38 -0700798 rc = NETDEV_TX_OK;
Frank Blaschka4a71df52008-02-15 09:19:42 +0100799 } else {
Frank Blaschka683d7182008-08-01 16:39:13 +0200800 if (data_offset >= 0)
801 kmem_cache_free(qeth_core_header_cache, hdr);
802
Frank Blaschka4a71df52008-02-15 09:19:42 +0100803 if (rc == -EBUSY) {
804 if (new_skb != skb)
805 dev_kfree_skb_any(new_skb);
806 return NETDEV_TX_BUSY;
807 } else
808 goto tx_drop;
809 }
810
811 netif_wake_queue(dev);
812 if (card->options.performance_stats)
813 card->perf_stats.outbound_time += qeth_get_micros() -
814 card->perf_stats.outbound_start_time;
815 return rc;
816
817tx_drop:
818 card->stats.tx_dropped++;
819 card->stats.tx_errors++;
820 if ((new_skb != skb) && new_skb)
821 dev_kfree_skb_any(new_skb);
822 dev_kfree_skb_any(skb);
Frank Blaschkad0ec0f52008-06-06 12:37:48 +0200823 netif_wake_queue(dev);
Frank Blaschka4a71df52008-02-15 09:19:42 +0100824 return NETDEV_TX_OK;
825}
826
Ursula Braun39423442011-01-12 20:42:24 +0000827static int __qeth_l2_open(struct net_device *dev)
Frank Blaschka4a71df52008-02-15 09:19:42 +0100828{
Heiko Carstens509e2562008-07-26 02:24:10 -0700829 struct qeth_card *card = dev->ml_priv;
Frank Blaschkaa1c3ed42010-09-07 21:14:42 +0000830 int rc = 0;
Frank Blaschka4a71df52008-02-15 09:19:42 +0100831
Carsten Otte847a50f2010-06-21 22:57:05 +0000832 QETH_CARD_TEXT(card, 4, "qethopen");
Ursula Braun39423442011-01-12 20:42:24 +0000833 if (card->state == CARD_STATE_UP)
834 return rc;
Frank Blaschka4a71df52008-02-15 09:19:42 +0100835 if (card->state != CARD_STATE_SOFTSETUP)
836 return -ENODEV;
837
838 if ((card->info.type != QETH_CARD_TYPE_OSN) &&
839 (!(card->info.mac_bits & QETH_LAYER2_MAC_REGISTERED))) {
Carsten Otte847a50f2010-06-21 22:57:05 +0000840 QETH_CARD_TEXT(card, 4, "nomacadr");
Frank Blaschka4a71df52008-02-15 09:19:42 +0100841 return -EPERM;
842 }
843 card->data.state = CH_STATE_UP;
844 card->state = CARD_STATE_UP;
Frank Blaschka4a71df52008-02-15 09:19:42 +0100845 netif_start_queue(dev);
846
Frank Blaschkaa1c3ed42010-09-07 21:14:42 +0000847 if (qdio_stop_irq(card->data.ccwdev, 0) >= 0) {
848 napi_enable(&card->napi);
849 napi_schedule(&card->napi);
850 } else
851 rc = -EIO;
852 return rc;
Frank Blaschka4a71df52008-02-15 09:19:42 +0100853}
854
Ursula Braun39423442011-01-12 20:42:24 +0000855static int qeth_l2_open(struct net_device *dev)
856{
857 struct qeth_card *card = dev->ml_priv;
858
859 QETH_CARD_TEXT(card, 5, "qethope_");
860 if (qeth_wait_for_threads(card, QETH_RECOVER_THREAD)) {
861 QETH_CARD_TEXT(card, 3, "openREC");
862 return -ERESTARTSYS;
863 }
864 return __qeth_l2_open(dev);
865}
866
Frank Blaschka4a71df52008-02-15 09:19:42 +0100867static int qeth_l2_stop(struct net_device *dev)
868{
Heiko Carstens509e2562008-07-26 02:24:10 -0700869 struct qeth_card *card = dev->ml_priv;
Frank Blaschka4a71df52008-02-15 09:19:42 +0100870
Carsten Otte847a50f2010-06-21 22:57:05 +0000871 QETH_CARD_TEXT(card, 4, "qethstop");
Frank Blaschka4a71df52008-02-15 09:19:42 +0100872 netif_tx_disable(dev);
Frank Blaschkaa1c3ed42010-09-07 21:14:42 +0000873 if (card->state == CARD_STATE_UP) {
Frank Blaschka4a71df52008-02-15 09:19:42 +0100874 card->state = CARD_STATE_SOFTSETUP;
Frank Blaschkaa1c3ed42010-09-07 21:14:42 +0000875 napi_disable(&card->napi);
876 }
Frank Blaschka4a71df52008-02-15 09:19:42 +0100877 return 0;
878}
879
880static int qeth_l2_probe_device(struct ccwgroup_device *gdev)
881{
882 struct qeth_card *card = dev_get_drvdata(&gdev->dev);
883
Eugene Crosserb4d72c02014-01-14 15:54:11 +0100884 qeth_l2_create_device_attributes(&gdev->dev);
Frank Blaschka4a71df52008-02-15 09:19:42 +0100885 INIT_LIST_HEAD(&card->vid_list);
886 INIT_LIST_HEAD(&card->mc_list);
887 card->options.layer2 = 1;
Frank Blaschka1da74b12011-05-12 18:45:02 +0000888 card->info.hwtrap = 0;
Frank Blaschka4a71df52008-02-15 09:19:42 +0100889 return 0;
890}
891
892static void qeth_l2_remove_device(struct ccwgroup_device *cgdev)
893{
894 struct qeth_card *card = dev_get_drvdata(&cgdev->dev);
895
Eugene Crosserb4d72c02014-01-14 15:54:11 +0100896 qeth_l2_remove_device_attributes(&cgdev->dev);
Ursula Braunf2148562009-05-19 21:38:37 +0000897 qeth_set_allowed_threads(card, 0, 1);
Frank Blaschka4a71df52008-02-15 09:19:42 +0100898 wait_event(card->wait_q, qeth_threads_running(card, 0xffffffff) == 0);
899
Ursula Braun70919e22011-02-26 22:41:36 -0800900 if (cgdev->state == CCWGROUP_ONLINE)
Frank Blaschka4a71df52008-02-15 09:19:42 +0100901 qeth_l2_set_offline(cgdev);
Frank Blaschka4a71df52008-02-15 09:19:42 +0100902
903 if (card->dev) {
904 unregister_netdev(card->dev);
905 card->dev = NULL;
906 }
Frank Blaschka4a71df52008-02-15 09:19:42 +0100907 return;
908}
909
Stephen Hemminger0fc0b732009-09-02 01:03:33 -0700910static const struct ethtool_ops qeth_l2_ethtool_ops = {
Frank Blaschka4a71df52008-02-15 09:19:42 +0100911 .get_link = ethtool_op_get_link,
Frank Blaschka4a71df52008-02-15 09:19:42 +0100912 .get_strings = qeth_core_get_strings,
913 .get_ethtool_stats = qeth_core_get_ethtool_stats,
Ben Hutchingsdf8b4ec2009-10-01 11:24:32 +0000914 .get_sset_count = qeth_core_get_sset_count,
Frank Blaschka4a71df52008-02-15 09:19:42 +0100915 .get_drvinfo = qeth_core_get_drvinfo,
Frank Blaschka3f9975a2008-04-24 10:15:23 +0200916 .get_settings = qeth_core_ethtool_get_settings,
Frank Blaschka4a71df52008-02-15 09:19:42 +0100917};
918
Stephen Hemminger0fc0b732009-09-02 01:03:33 -0700919static const struct ethtool_ops qeth_l2_osn_ops = {
Frank Blaschka4a71df52008-02-15 09:19:42 +0100920 .get_strings = qeth_core_get_strings,
921 .get_ethtool_stats = qeth_core_get_ethtool_stats,
Ben Hutchingsdf8b4ec2009-10-01 11:24:32 +0000922 .get_sset_count = qeth_core_get_sset_count,
Frank Blaschka4a71df52008-02-15 09:19:42 +0100923 .get_drvinfo = qeth_core_get_drvinfo,
924};
925
Frank Blaschka3d58cef2009-01-09 03:44:00 +0000926static const struct net_device_ops qeth_l2_netdev_ops = {
Frank Blaschka8403b132009-01-08 10:50:55 -0800927 .ndo_open = qeth_l2_open,
928 .ndo_stop = qeth_l2_stop,
929 .ndo_get_stats = qeth_get_stats,
930 .ndo_start_xmit = qeth_l2_hard_start_xmit,
931 .ndo_validate_addr = eth_validate_addr,
Jiri Pirkoafc4b132011-08-16 06:29:01 +0000932 .ndo_set_rx_mode = qeth_l2_set_multicast_list,
Frank Blaschka8403b132009-01-08 10:50:55 -0800933 .ndo_do_ioctl = qeth_l2_do_ioctl,
934 .ndo_set_mac_address = qeth_l2_set_mac_address,
935 .ndo_change_mtu = qeth_change_mtu,
936 .ndo_vlan_rx_add_vid = qeth_l2_vlan_rx_add_vid,
937 .ndo_vlan_rx_kill_vid = qeth_l2_vlan_rx_kill_vid,
938 .ndo_tx_timeout = qeth_tx_timeout,
939};
940
Frank Blaschka4a71df52008-02-15 09:19:42 +0100941static int qeth_l2_setup_netdev(struct qeth_card *card)
942{
943 switch (card->info.type) {
Frank Blaschka4a71df52008-02-15 09:19:42 +0100944 case QETH_CARD_TYPE_IQD:
945 card->dev = alloc_netdev(0, "hsi%d", ether_setup);
946 break;
947 case QETH_CARD_TYPE_OSN:
948 card->dev = alloc_netdev(0, "osn%d", ether_setup);
949 card->dev->flags |= IFF_NOARP;
950 break;
951 default:
952 card->dev = alloc_etherdev(0);
953 }
954
955 if (!card->dev)
956 return -ENODEV;
957
Heiko Carstens509e2562008-07-26 02:24:10 -0700958 card->dev->ml_priv = card;
Frank Blaschka4a71df52008-02-15 09:19:42 +0100959 card->dev->watchdog_timeo = QETH_TX_TIMEOUT;
Frank Blaschka4a71df52008-02-15 09:19:42 +0100960 card->dev->mtu = card->info.initial_mtu;
Frank Blaschka8403b132009-01-08 10:50:55 -0800961 card->dev->netdev_ops = &qeth_l2_netdev_ops;
Frank Blaschka4a71df52008-02-15 09:19:42 +0100962 if (card->info.type != QETH_CARD_TYPE_OSN)
963 SET_ETHTOOL_OPS(card->dev, &qeth_l2_ethtool_ops);
964 else
965 SET_ETHTOOL_OPS(card->dev, &qeth_l2_osn_ops);
Patrick McHardyf6469682013-04-19 02:04:27 +0000966 card->dev->features |= NETIF_F_HW_VLAN_CTAG_FILTER;
Frank Blaschka4a71df52008-02-15 09:19:42 +0100967 card->info.broadcast_capable = 1;
968 qeth_l2_request_initial_mac(card);
969 SET_NETDEV_DEV(card->dev, &card->gdev->dev);
Frank Blaschkaa1c3ed42010-09-07 21:14:42 +0000970 netif_napi_add(card->dev, &card->napi, qeth_l2_poll, QETH_NAPI_WEIGHT);
Frank Blaschka4a71df52008-02-15 09:19:42 +0100971 return register_netdev(card->dev);
972}
973
974static int __qeth_l2_set_online(struct ccwgroup_device *gdev, int recovery_mode)
975{
976 struct qeth_card *card = dev_get_drvdata(&gdev->dev);
977 int rc = 0;
978 enum qeth_card_states recover_flag;
979
Ursula Braun9dc48cc2010-07-22 23:15:05 +0000980 mutex_lock(&card->discipline_mutex);
Frank Blaschkac4949f02010-05-11 19:34:47 +0000981 mutex_lock(&card->conf_mutex);
Peter Tiedemannd11ba0c2008-04-01 10:26:58 +0200982 QETH_DBF_TEXT(SETUP, 2, "setonlin");
983 QETH_DBF_HEX(SETUP, 2, &card, sizeof(void *));
Frank Blaschka4a71df52008-02-15 09:19:42 +0100984
Frank Blaschka4a71df52008-02-15 09:19:42 +0100985 recover_flag = card->state;
Frank Blaschka4a71df52008-02-15 09:19:42 +0100986 rc = qeth_core_hardsetup_card(card);
987 if (rc) {
Peter Tiedemannd11ba0c2008-04-01 10:26:58 +0200988 QETH_DBF_TEXT_(SETUP, 2, "2err%d", rc);
Ursula Braunaa909222009-11-12 00:11:43 +0000989 rc = -ENODEV;
Frank Blaschka4a71df52008-02-15 09:19:42 +0100990 goto out_remove;
991 }
Stefan Raspl395672e02012-11-19 02:46:49 +0000992 qeth_trace_features(card);
Frank Blaschka4a71df52008-02-15 09:19:42 +0100993
Ursula Braunaa909222009-11-12 00:11:43 +0000994 if (!card->dev && qeth_l2_setup_netdev(card)) {
995 rc = -ENODEV;
Frank Blaschka4a71df52008-02-15 09:19:42 +0100996 goto out_remove;
Ursula Braunaa909222009-11-12 00:11:43 +0000997 }
Frank Blaschka4a71df52008-02-15 09:19:42 +0100998
999 if (card->info.type != QETH_CARD_TYPE_OSN)
1000 qeth_l2_send_setmac(card, &card->dev->dev_addr[0]);
1001
Frank Blaschka1da74b12011-05-12 18:45:02 +00001002 if (qeth_is_diagass_supported(card, QETH_DIAGS_CMD_TRAP)) {
1003 if (card->info.hwtrap &&
1004 qeth_hw_trap(card, QETH_DIAGS_TRAP_ARM))
1005 card->info.hwtrap = 0;
1006 } else
1007 card->info.hwtrap = 0;
1008
Eugene Crosserb4d72c02014-01-14 15:54:11 +01001009 qeth_l2_setup_bridgeport_attrs(card);
1010
Frank Blaschka4a71df52008-02-15 09:19:42 +01001011 card->state = CARD_STATE_HARDSETUP;
Frank Blaschkaa1c3ed42010-09-07 21:14:42 +00001012 memset(&card->rx, 0, sizeof(struct qeth_rx));
Frank Blaschka4a71df52008-02-15 09:19:42 +01001013 qeth_print_status_message(card);
1014
1015 /* softsetup */
Peter Tiedemannd11ba0c2008-04-01 10:26:58 +02001016 QETH_DBF_TEXT(SETUP, 2, "softsetp");
Frank Blaschka4a71df52008-02-15 09:19:42 +01001017
1018 rc = qeth_send_startlan(card);
1019 if (rc) {
Peter Tiedemannd11ba0c2008-04-01 10:26:58 +02001020 QETH_DBF_TEXT_(SETUP, 2, "1err%d", rc);
Frank Blaschka4a71df52008-02-15 09:19:42 +01001021 if (rc == 0xe080) {
Frank Blaschka74eacdb2008-12-25 13:39:49 +01001022 dev_warn(&card->gdev->dev,
1023 "The LAN is offline\n");
Frank Blaschka4a71df52008-02-15 09:19:42 +01001024 card->lan_online = 0;
Ursula Braun2b6203b2010-11-26 02:41:19 +00001025 goto contin;
Frank Blaschka4a71df52008-02-15 09:19:42 +01001026 }
Ursula Braunaa909222009-11-12 00:11:43 +00001027 rc = -ENODEV;
Ursula Braunf2148562009-05-19 21:38:37 +00001028 goto out_remove;
Frank Blaschka4a71df52008-02-15 09:19:42 +01001029 } else
1030 card->lan_online = 1;
1031
Ursula Braun2b6203b2010-11-26 02:41:19 +00001032contin:
Ursula Braun5113fec2010-05-16 21:15:14 +00001033 if ((card->info.type == QETH_CARD_TYPE_OSD) ||
Stefan Raspl0f547612013-01-21 02:30:20 +00001034 (card->info.type == QETH_CARD_TYPE_OSX)) {
Einar Lueckd64ecc22009-11-12 00:11:41 +00001035 /* configure isolation level */
Stefan Raspl0f547612013-01-21 02:30:20 +00001036 rc = qeth_set_access_ctrl_online(card, 0);
1037 if (rc) {
1038 rc = -ENODEV;
1039 goto out_remove;
1040 }
1041 }
Ursula Braun5113fec2010-05-16 21:15:14 +00001042
1043 if (card->info.type != QETH_CARD_TYPE_OSN &&
1044 card->info.type != QETH_CARD_TYPE_OSM)
Ursula Braun70919e22011-02-26 22:41:36 -08001045 qeth_l2_process_vlans(card);
Frank Blaschka4a71df52008-02-15 09:19:42 +01001046
1047 netif_tx_disable(card->dev);
1048
1049 rc = qeth_init_qdio_queues(card);
1050 if (rc) {
Peter Tiedemannd11ba0c2008-04-01 10:26:58 +02001051 QETH_DBF_TEXT_(SETUP, 2, "6err%d", rc);
Ursula Braunaa909222009-11-12 00:11:43 +00001052 rc = -ENODEV;
Frank Blaschka4a71df52008-02-15 09:19:42 +01001053 goto out_remove;
1054 }
1055 card->state = CARD_STATE_SOFTSETUP;
Ursula Braun2b6203b2010-11-26 02:41:19 +00001056 if (card->lan_online)
1057 netif_carrier_on(card->dev);
1058 else
1059 netif_carrier_off(card->dev);
Frank Blaschka4a71df52008-02-15 09:19:42 +01001060
1061 qeth_set_allowed_threads(card, 0xffffffff, 0);
1062 if (recover_flag == CARD_STATE_RECOVER) {
1063 if (recovery_mode &&
1064 card->info.type != QETH_CARD_TYPE_OSN) {
Ursula Braun39423442011-01-12 20:42:24 +00001065 __qeth_l2_open(card->dev);
Frank Blaschka4a71df52008-02-15 09:19:42 +01001066 } else {
1067 rtnl_lock();
1068 dev_open(card->dev);
1069 rtnl_unlock();
1070 }
1071 /* this also sets saved unicast addresses */
1072 qeth_l2_set_multicast_list(card->dev);
1073 }
1074 /* let user_space know that device is online */
1075 kobject_uevent(&gdev->dev.kobj, KOBJ_CHANGE);
Frank Blaschkac4949f02010-05-11 19:34:47 +00001076 mutex_unlock(&card->conf_mutex);
Ursula Braun9dc48cc2010-07-22 23:15:05 +00001077 mutex_unlock(&card->discipline_mutex);
Frank Blaschka4a71df52008-02-15 09:19:42 +01001078 return 0;
Ursula Braunaa909222009-11-12 00:11:43 +00001079
Frank Blaschka4a71df52008-02-15 09:19:42 +01001080out_remove:
Frank Blaschka4a71df52008-02-15 09:19:42 +01001081 qeth_l2_stop_card(card, 0);
1082 ccw_device_set_offline(CARD_DDEV(card));
1083 ccw_device_set_offline(CARD_WDEV(card));
1084 ccw_device_set_offline(CARD_RDEV(card));
1085 if (recover_flag == CARD_STATE_RECOVER)
1086 card->state = CARD_STATE_RECOVER;
1087 else
1088 card->state = CARD_STATE_DOWN;
Frank Blaschkac4949f02010-05-11 19:34:47 +00001089 mutex_unlock(&card->conf_mutex);
Ursula Braun9dc48cc2010-07-22 23:15:05 +00001090 mutex_unlock(&card->discipline_mutex);
Ursula Braunaa909222009-11-12 00:11:43 +00001091 return rc;
Frank Blaschka4a71df52008-02-15 09:19:42 +01001092}
1093
1094static int qeth_l2_set_online(struct ccwgroup_device *gdev)
1095{
1096 return __qeth_l2_set_online(gdev, 0);
1097}
1098
1099static int __qeth_l2_set_offline(struct ccwgroup_device *cgdev,
1100 int recovery_mode)
1101{
1102 struct qeth_card *card = dev_get_drvdata(&cgdev->dev);
1103 int rc = 0, rc2 = 0, rc3 = 0;
1104 enum qeth_card_states recover_flag;
1105
Ursula Braun9dc48cc2010-07-22 23:15:05 +00001106 mutex_lock(&card->discipline_mutex);
Frank Blaschkac4949f02010-05-11 19:34:47 +00001107 mutex_lock(&card->conf_mutex);
Peter Tiedemannd11ba0c2008-04-01 10:26:58 +02001108 QETH_DBF_TEXT(SETUP, 3, "setoffl");
1109 QETH_DBF_HEX(SETUP, 3, &card, sizeof(void *));
Frank Blaschka4a71df52008-02-15 09:19:42 +01001110
1111 if (card->dev && netif_carrier_ok(card->dev))
1112 netif_carrier_off(card->dev);
1113 recover_flag = card->state;
Frank Blaschka1da74b12011-05-12 18:45:02 +00001114 if ((!recovery_mode && card->info.hwtrap) || card->info.hwtrap == 2) {
1115 qeth_hw_trap(card, QETH_DIAGS_TRAP_DISARM);
1116 card->info.hwtrap = 1;
1117 }
Ursula Braun0f5623c2008-10-24 11:16:52 +02001118 qeth_l2_stop_card(card, recovery_mode);
Frank Blaschka4a71df52008-02-15 09:19:42 +01001119 rc = ccw_device_set_offline(CARD_DDEV(card));
1120 rc2 = ccw_device_set_offline(CARD_WDEV(card));
1121 rc3 = ccw_device_set_offline(CARD_RDEV(card));
1122 if (!rc)
1123 rc = (rc2) ? rc2 : rc3;
1124 if (rc)
Peter Tiedemannd11ba0c2008-04-01 10:26:58 +02001125 QETH_DBF_TEXT_(SETUP, 2, "1err%d", rc);
Frank Blaschka4a71df52008-02-15 09:19:42 +01001126 if (recover_flag == CARD_STATE_UP)
1127 card->state = CARD_STATE_RECOVER;
1128 /* let user_space know that device is offline */
1129 kobject_uevent(&cgdev->dev.kobj, KOBJ_CHANGE);
Frank Blaschkac4949f02010-05-11 19:34:47 +00001130 mutex_unlock(&card->conf_mutex);
Ursula Braun9dc48cc2010-07-22 23:15:05 +00001131 mutex_unlock(&card->discipline_mutex);
Frank Blaschka4a71df52008-02-15 09:19:42 +01001132 return 0;
1133}
1134
1135static int qeth_l2_set_offline(struct ccwgroup_device *cgdev)
1136{
1137 return __qeth_l2_set_offline(cgdev, 0);
1138}
1139
1140static int qeth_l2_recover(void *ptr)
1141{
1142 struct qeth_card *card;
1143 int rc = 0;
1144
1145 card = (struct qeth_card *) ptr;
Carsten Otte847a50f2010-06-21 22:57:05 +00001146 QETH_CARD_TEXT(card, 2, "recover1");
Frank Blaschka4a71df52008-02-15 09:19:42 +01001147 if (!qeth_do_run_thread(card, QETH_RECOVER_THREAD))
1148 return 0;
Carsten Otte847a50f2010-06-21 22:57:05 +00001149 QETH_CARD_TEXT(card, 2, "recover2");
Frank Blaschka74eacdb2008-12-25 13:39:49 +01001150 dev_warn(&card->gdev->dev,
1151 "A recovery process has been started for the device\n");
Stefan Raspl65d80132013-04-07 22:19:27 +00001152 qeth_set_recovery_task(card);
Frank Blaschka4a71df52008-02-15 09:19:42 +01001153 __qeth_l2_set_offline(card->gdev, 1);
1154 rc = __qeth_l2_set_online(card->gdev, 1);
Frank Blaschka4a71df52008-02-15 09:19:42 +01001155 if (!rc)
Frank Blaschka74eacdb2008-12-25 13:39:49 +01001156 dev_info(&card->gdev->dev,
1157 "Device successfully recovered!\n");
Ursula Braun28a7e4c2008-09-19 12:56:03 +02001158 else {
Stefan Raspl0f547612013-01-21 02:30:20 +00001159 qeth_close_dev(card);
1160 dev_warn(&card->gdev->dev, "The qeth device driver "
Stefan Raspl2efaf5f2012-10-15 19:21:18 +00001161 "failed to recover an error on the device\n");
Ursula Braun28a7e4c2008-09-19 12:56:03 +02001162 }
Stefan Raspl65d80132013-04-07 22:19:27 +00001163 qeth_clear_recovery_task(card);
Frank Blaschkaa1c3ed42010-09-07 21:14:42 +00001164 qeth_clear_thread_start_bit(card, QETH_RECOVER_THREAD);
1165 qeth_clear_thread_running_bit(card, QETH_RECOVER_THREAD);
Frank Blaschka4a71df52008-02-15 09:19:42 +01001166 return 0;
1167}
1168
1169static int __init qeth_l2_init(void)
1170{
Frank Blaschka74eacdb2008-12-25 13:39:49 +01001171 pr_info("register layer 2 discipline\n");
Frank Blaschka4a71df52008-02-15 09:19:42 +01001172 return 0;
1173}
1174
1175static void __exit qeth_l2_exit(void)
1176{
Frank Blaschka74eacdb2008-12-25 13:39:49 +01001177 pr_info("unregister layer 2 discipline\n");
Frank Blaschka4a71df52008-02-15 09:19:42 +01001178}
1179
1180static void qeth_l2_shutdown(struct ccwgroup_device *gdev)
1181{
1182 struct qeth_card *card = dev_get_drvdata(&gdev->dev);
Ursula Braunf78ac2b2011-12-19 22:56:33 +00001183 qeth_set_allowed_threads(card, 0, 1);
Frank Blaschka1da74b12011-05-12 18:45:02 +00001184 if ((gdev->state == CCWGROUP_ONLINE) && card->info.hwtrap)
1185 qeth_hw_trap(card, QETH_DIAGS_TRAP_DISARM);
Frank Blaschka4a71df52008-02-15 09:19:42 +01001186 qeth_qdio_clear_card(card, 0);
1187 qeth_clear_qdio_buffers(card);
1188}
1189
Frank Blaschkabbcfcdc2009-06-16 10:30:31 +02001190static int qeth_l2_pm_suspend(struct ccwgroup_device *gdev)
1191{
1192 struct qeth_card *card = dev_get_drvdata(&gdev->dev);
1193
1194 if (card->dev)
1195 netif_device_detach(card->dev);
1196 qeth_set_allowed_threads(card, 0, 1);
1197 wait_event(card->wait_q, qeth_threads_running(card, 0xffffffff) == 0);
1198 if (gdev->state == CCWGROUP_OFFLINE)
1199 return 0;
1200 if (card->state == CARD_STATE_UP) {
Frank Blaschka1da74b12011-05-12 18:45:02 +00001201 if (card->info.hwtrap)
1202 qeth_hw_trap(card, QETH_DIAGS_TRAP_DISARM);
Frank Blaschkabbcfcdc2009-06-16 10:30:31 +02001203 __qeth_l2_set_offline(card->gdev, 1);
1204 } else
1205 __qeth_l2_set_offline(card->gdev, 0);
1206 return 0;
1207}
1208
1209static int qeth_l2_pm_resume(struct ccwgroup_device *gdev)
1210{
1211 struct qeth_card *card = dev_get_drvdata(&gdev->dev);
1212 int rc = 0;
1213
1214 if (gdev->state == CCWGROUP_OFFLINE)
1215 goto out;
1216
1217 if (card->state == CARD_STATE_RECOVER) {
1218 rc = __qeth_l2_set_online(card->gdev, 1);
1219 if (rc) {
Ursula Braun869da902010-03-08 20:36:56 +00001220 rtnl_lock();
1221 dev_close(card->dev);
1222 rtnl_unlock();
Frank Blaschkabbcfcdc2009-06-16 10:30:31 +02001223 }
1224 } else
1225 rc = __qeth_l2_set_online(card->gdev, 0);
1226out:
1227 qeth_set_allowed_threads(card, 0xffffffff, 0);
1228 if (card->dev)
1229 netif_device_attach(card->dev);
1230 if (rc)
1231 dev_warn(&card->gdev->dev, "The qeth device driver "
1232 "failed to recover an error on the device\n");
1233 return rc;
1234}
1235
Sebastian Ottc041f2d4872012-05-15 18:02:21 +02001236struct qeth_discipline qeth_l2_discipline = {
1237 .start_poll = qeth_qdio_start_poll,
1238 .input_handler = (qdio_handler_t *) qeth_qdio_input_handler,
1239 .output_handler = (qdio_handler_t *) qeth_qdio_output_handler,
1240 .recover = qeth_l2_recover,
1241 .setup = qeth_l2_probe_device,
Frank Blaschka4a71df52008-02-15 09:19:42 +01001242 .remove = qeth_l2_remove_device,
1243 .set_online = qeth_l2_set_online,
1244 .set_offline = qeth_l2_set_offline,
1245 .shutdown = qeth_l2_shutdown,
Frank Blaschkabbcfcdc2009-06-16 10:30:31 +02001246 .freeze = qeth_l2_pm_suspend,
1247 .thaw = qeth_l2_pm_resume,
1248 .restore = qeth_l2_pm_resume,
Frank Blaschka4a71df52008-02-15 09:19:42 +01001249};
Sebastian Ottc041f2d4872012-05-15 18:02:21 +02001250EXPORT_SYMBOL_GPL(qeth_l2_discipline);
Frank Blaschka4a71df52008-02-15 09:19:42 +01001251
1252static int qeth_osn_send_control_data(struct qeth_card *card, int len,
1253 struct qeth_cmd_buffer *iob)
1254{
1255 unsigned long flags;
1256 int rc = 0;
1257
Carsten Otte847a50f2010-06-21 22:57:05 +00001258 QETH_CARD_TEXT(card, 5, "osndctrd");
Frank Blaschka4a71df52008-02-15 09:19:42 +01001259
1260 wait_event(card->wait_q,
1261 atomic_cmpxchg(&card->write.irq_pending, 0, 1) == 0);
1262 qeth_prepare_control_data(card, len, iob);
Carsten Otte847a50f2010-06-21 22:57:05 +00001263 QETH_CARD_TEXT(card, 6, "osnoirqp");
Frank Blaschka4a71df52008-02-15 09:19:42 +01001264 spin_lock_irqsave(get_ccwdev_lock(card->write.ccwdev), flags);
1265 rc = ccw_device_start(card->write.ccwdev, &card->write.ccw,
1266 (addr_t) iob, 0, 0);
1267 spin_unlock_irqrestore(get_ccwdev_lock(card->write.ccwdev), flags);
1268 if (rc) {
Frank Blaschka14cc21b2008-06-06 12:37:46 +02001269 QETH_DBF_MESSAGE(2, "qeth_osn_send_control_data: "
Frank Blaschka4a71df52008-02-15 09:19:42 +01001270 "ccw_device_start rc = %i\n", rc);
Carsten Otte847a50f2010-06-21 22:57:05 +00001271 QETH_CARD_TEXT_(card, 2, " err%d", rc);
Frank Blaschka4a71df52008-02-15 09:19:42 +01001272 qeth_release_buffer(iob->channel, iob);
1273 atomic_set(&card->write.irq_pending, 0);
1274 wake_up(&card->wait_q);
1275 }
1276 return rc;
1277}
1278
1279static int qeth_osn_send_ipa_cmd(struct qeth_card *card,
1280 struct qeth_cmd_buffer *iob, int data_len)
1281{
1282 u16 s1, s2;
1283
Carsten Otte847a50f2010-06-21 22:57:05 +00001284 QETH_CARD_TEXT(card, 4, "osndipa");
Frank Blaschka4a71df52008-02-15 09:19:42 +01001285
1286 qeth_prepare_ipa_cmd(card, iob, QETH_PROT_OSN2);
1287 s1 = (u16)(IPA_PDU_HEADER_SIZE + data_len);
1288 s2 = (u16)data_len;
1289 memcpy(QETH_IPA_PDU_LEN_TOTAL(iob->data), &s1, 2);
1290 memcpy(QETH_IPA_PDU_LEN_PDU1(iob->data), &s2, 2);
1291 memcpy(QETH_IPA_PDU_LEN_PDU2(iob->data), &s2, 2);
1292 memcpy(QETH_IPA_PDU_LEN_PDU3(iob->data), &s2, 2);
1293 return qeth_osn_send_control_data(card, s1, iob);
1294}
1295
1296int qeth_osn_assist(struct net_device *dev, void *data, int data_len)
1297{
1298 struct qeth_cmd_buffer *iob;
1299 struct qeth_card *card;
1300 int rc;
1301
Frank Blaschka4a71df52008-02-15 09:19:42 +01001302 if (!dev)
1303 return -ENODEV;
Heiko Carstens509e2562008-07-26 02:24:10 -07001304 card = dev->ml_priv;
Frank Blaschka4a71df52008-02-15 09:19:42 +01001305 if (!card)
1306 return -ENODEV;
Carsten Otte847a50f2010-06-21 22:57:05 +00001307 QETH_CARD_TEXT(card, 2, "osnsdmc");
Frank Blaschka4a71df52008-02-15 09:19:42 +01001308 if ((card->state != CARD_STATE_UP) &&
1309 (card->state != CARD_STATE_SOFTSETUP))
1310 return -ENODEV;
1311 iob = qeth_wait_for_buffer(&card->write);
1312 memcpy(iob->data+IPA_PDU_HEADER_SIZE, data, data_len);
1313 rc = qeth_osn_send_ipa_cmd(card, iob, data_len);
1314 return rc;
1315}
1316EXPORT_SYMBOL(qeth_osn_assist);
1317
1318int qeth_osn_register(unsigned char *read_dev_no, struct net_device **dev,
1319 int (*assist_cb)(struct net_device *, void *),
1320 int (*data_cb)(struct sk_buff *))
1321{
1322 struct qeth_card *card;
1323
Frank Blaschka4a71df52008-02-15 09:19:42 +01001324 *dev = qeth_l2_netdev_by_devno(read_dev_no);
1325 if (*dev == NULL)
1326 return -ENODEV;
Heiko Carstens509e2562008-07-26 02:24:10 -07001327 card = (*dev)->ml_priv;
Frank Blaschka4a71df52008-02-15 09:19:42 +01001328 if (!card)
1329 return -ENODEV;
Carsten Otte847a50f2010-06-21 22:57:05 +00001330 QETH_CARD_TEXT(card, 2, "osnreg");
Frank Blaschka4a71df52008-02-15 09:19:42 +01001331 if ((assist_cb == NULL) || (data_cb == NULL))
1332 return -EINVAL;
1333 card->osn_info.assist_cb = assist_cb;
1334 card->osn_info.data_cb = data_cb;
1335 return 0;
1336}
1337EXPORT_SYMBOL(qeth_osn_register);
1338
1339void qeth_osn_deregister(struct net_device *dev)
1340{
1341 struct qeth_card *card;
1342
Frank Blaschka4a71df52008-02-15 09:19:42 +01001343 if (!dev)
1344 return;
Heiko Carstens509e2562008-07-26 02:24:10 -07001345 card = dev->ml_priv;
Frank Blaschka4a71df52008-02-15 09:19:42 +01001346 if (!card)
1347 return;
Carsten Otte847a50f2010-06-21 22:57:05 +00001348 QETH_CARD_TEXT(card, 2, "osndereg");
Frank Blaschka4a71df52008-02-15 09:19:42 +01001349 card->osn_info.assist_cb = NULL;
1350 card->osn_info.data_cb = NULL;
1351 return;
1352}
1353EXPORT_SYMBOL(qeth_osn_deregister);
1354
Eugene Crosserb4d72c02014-01-14 15:54:11 +01001355/* SETBRIDGEPORT support, async notifications */
1356
Eugene Crosser9f48b9d2014-01-14 15:54:13 +01001357enum qeth_an_event_type {anev_reg_unreg, anev_abort, anev_reset};
1358
1359/**
1360 * qeth_bridge_emit_host_event() - bridgeport address change notification
1361 * @card: qeth_card structure pointer, for udev events.
1362 * @evtype: "normal" register/unregister, or abort, or reset. For abort
1363 * and reset token and addr_lnid are unused and may be NULL.
1364 * @code: event bitmask: high order bit 0x80 value 1 means removal of an
1365 * object, 0 - addition of an object.
1366 * 0x01 - VLAN, 0x02 - MAC, 0x03 - VLAN and MAC.
1367 * @token: "network token" structure identifying physical address of the port.
1368 * @addr_lnid: pointer to structure with MAC address and VLAN ID.
1369 *
1370 * This function is called when registrations and deregistrations are
1371 * reported by the hardware, and also when notifications are enabled -
1372 * for all currently registered addresses.
1373 */
1374static void qeth_bridge_emit_host_event(struct qeth_card *card,
1375 enum qeth_an_event_type evtype,
1376 u8 code, struct net_if_token *token, struct mac_addr_lnid *addr_lnid)
1377{
1378 char str[7][32];
1379 char *env[8];
1380 int i = 0;
1381
1382 switch (evtype) {
1383 case anev_reg_unreg:
1384 snprintf(str[i], sizeof(str[i]), "BRIDGEDHOST=%s",
1385 (code & IPA_ADDR_CHANGE_CODE_REMOVAL)
1386 ? "deregister" : "register");
1387 env[i] = str[i]; i++;
1388 if (code & IPA_ADDR_CHANGE_CODE_VLANID) {
1389 snprintf(str[i], sizeof(str[i]), "VLAN=%d",
1390 addr_lnid->lnid);
1391 env[i] = str[i]; i++;
1392 }
1393 if (code & IPA_ADDR_CHANGE_CODE_MACADDR) {
1394 snprintf(str[i], sizeof(str[i]), "MAC=%pM6",
1395 &addr_lnid->mac);
1396 env[i] = str[i]; i++;
1397 }
1398 snprintf(str[i], sizeof(str[i]), "NTOK_BUSID=%x.%x.%04x",
1399 token->cssid, token->ssid, token->devnum);
1400 env[i] = str[i]; i++;
1401 snprintf(str[i], sizeof(str[i]), "NTOK_IID=%02x", token->iid);
1402 env[i] = str[i]; i++;
1403 snprintf(str[i], sizeof(str[i]), "NTOK_CHPID=%02x",
1404 token->chpid);
1405 env[i] = str[i]; i++;
1406 snprintf(str[i], sizeof(str[i]), "NTOK_CHID=%04x", token->chid);
1407 env[i] = str[i]; i++;
1408 break;
1409 case anev_abort:
1410 snprintf(str[i], sizeof(str[i]), "BRIDGEDHOST=abort");
1411 env[i] = str[i]; i++;
1412 break;
1413 case anev_reset:
1414 snprintf(str[i], sizeof(str[i]), "BRIDGEDHOST=reset");
1415 env[i] = str[i]; i++;
1416 break;
1417 }
1418 env[i] = NULL;
1419 kobject_uevent_env(&card->gdev->dev.kobj, KOBJ_CHANGE, env);
1420}
1421
Eugene Crosserb4d72c02014-01-14 15:54:11 +01001422struct qeth_bridge_state_data {
1423 struct work_struct worker;
1424 struct qeth_card *card;
1425 struct qeth_sbp_state_change qports;
1426};
1427
1428static void qeth_bridge_state_change_worker(struct work_struct *work)
1429{
1430 struct qeth_bridge_state_data *data =
1431 container_of(work, struct qeth_bridge_state_data, worker);
1432 /* We are only interested in the first entry - local port */
1433 struct qeth_sbp_port_entry *entry = &data->qports.entry[0];
1434 char env_locrem[32];
1435 char env_role[32];
1436 char env_state[32];
1437 char *env[] = {
1438 env_locrem,
1439 env_role,
1440 env_state,
1441 NULL
1442 };
1443
1444 /* Role should not change by itself, but if it did, */
1445 /* information from the hardware is authoritative. */
1446 mutex_lock(&data->card->conf_mutex);
1447 data->card->options.sbp.role = entry->role;
1448 mutex_unlock(&data->card->conf_mutex);
1449
1450 snprintf(env_locrem, sizeof(env_locrem), "BRIDGEPORT=statechange");
1451 snprintf(env_role, sizeof(env_role), "ROLE=%s",
1452 (entry->role == QETH_SBP_ROLE_NONE) ? "none" :
1453 (entry->role == QETH_SBP_ROLE_PRIMARY) ? "primary" :
1454 (entry->role == QETH_SBP_ROLE_SECONDARY) ? "secondary" :
1455 "<INVALID>");
1456 snprintf(env_state, sizeof(env_state), "STATE=%s",
1457 (entry->state == QETH_SBP_STATE_INACTIVE) ? "inactive" :
1458 (entry->state == QETH_SBP_STATE_STANDBY) ? "standby" :
1459 (entry->state == QETH_SBP_STATE_ACTIVE) ? "active" :
1460 "<INVALID>");
1461 kobject_uevent_env(&data->card->gdev->dev.kobj,
1462 KOBJ_CHANGE, env);
1463 kfree(data);
1464}
1465
1466void qeth_bridge_state_change(struct qeth_card *card, struct qeth_ipa_cmd *cmd)
1467{
1468 struct qeth_sbp_state_change *qports =
1469 &cmd->data.sbp.data.state_change;
1470 struct qeth_bridge_state_data *data;
1471 int extrasize;
1472
1473 QETH_CARD_TEXT(card, 2, "brstchng");
1474 if (qports->entry_length != sizeof(struct qeth_sbp_port_entry)) {
1475 QETH_CARD_TEXT_(card, 2, "BPsz%.8d", qports->entry_length);
1476 return;
1477 }
1478 extrasize = sizeof(struct qeth_sbp_port_entry) * qports->num_entries;
1479 data = kzalloc(sizeof(struct qeth_bridge_state_data) + extrasize,
1480 GFP_ATOMIC);
1481 if (!data) {
1482 QETH_CARD_TEXT(card, 2, "BPSalloc");
1483 return;
1484 }
1485 INIT_WORK(&data->worker, qeth_bridge_state_change_worker);
1486 data->card = card;
1487 memcpy(&data->qports, qports,
1488 sizeof(struct qeth_sbp_state_change) + extrasize);
1489 queue_work(qeth_wq, &data->worker);
1490}
1491EXPORT_SYMBOL(qeth_bridge_state_change);
1492
Eugene Crosser9f48b9d2014-01-14 15:54:13 +01001493struct qeth_bridge_host_data {
1494 struct work_struct worker;
1495 struct qeth_card *card;
1496 struct qeth_ipacmd_addr_change hostevs;
1497};
1498
1499static void qeth_bridge_host_event_worker(struct work_struct *work)
1500{
1501 struct qeth_bridge_host_data *data =
1502 container_of(work, struct qeth_bridge_host_data, worker);
1503 int i;
1504
1505 if (data->hostevs.lost_event_mask) {
1506 dev_info(&data->card->gdev->dev,
1507"Address notification from the HiperSockets Bridge Port stopped %s (%s)\n",
1508 data->card->dev->name,
1509 (data->hostevs.lost_event_mask == 0x01)
1510 ? "Overflow"
1511 : (data->hostevs.lost_event_mask == 0x02)
1512 ? "Bridge port state change"
1513 : "Unknown reason");
1514 mutex_lock(&data->card->conf_mutex);
1515 data->card->options.sbp.hostnotification = 0;
1516 mutex_unlock(&data->card->conf_mutex);
1517 qeth_bridge_emit_host_event(data->card, anev_abort,
1518 0, NULL, NULL);
1519 } else
1520 for (i = 0; i < data->hostevs.num_entries; i++) {
1521 struct qeth_ipacmd_addr_change_entry *entry =
1522 &data->hostevs.entry[i];
1523 qeth_bridge_emit_host_event(data->card,
1524 anev_reg_unreg,
1525 entry->change_code,
1526 &entry->token, &entry->addr_lnid);
1527 }
1528 kfree(data);
1529}
1530
1531void qeth_bridge_host_event(struct qeth_card *card, struct qeth_ipa_cmd *cmd)
1532{
1533 struct qeth_ipacmd_addr_change *hostevs =
1534 &cmd->data.addrchange;
1535 struct qeth_bridge_host_data *data;
1536 int extrasize;
1537
1538 QETH_CARD_TEXT(card, 2, "brhostev");
1539 if (cmd->hdr.return_code != 0x0000) {
1540 if (cmd->hdr.return_code == 0x0010) {
1541 if (hostevs->lost_event_mask == 0x00)
1542 hostevs->lost_event_mask = 0xff;
1543 } else {
1544 QETH_CARD_TEXT_(card, 2, "BPHe%04x",
1545 cmd->hdr.return_code);
1546 return;
1547 }
1548 }
1549 extrasize = sizeof(struct qeth_ipacmd_addr_change_entry) *
1550 hostevs->num_entries;
1551 data = kzalloc(sizeof(struct qeth_bridge_host_data) + extrasize,
1552 GFP_ATOMIC);
1553 if (!data) {
1554 QETH_CARD_TEXT(card, 2, "BPHalloc");
1555 return;
1556 }
1557 INIT_WORK(&data->worker, qeth_bridge_host_event_worker);
1558 data->card = card;
1559 memcpy(&data->hostevs, hostevs,
1560 sizeof(struct qeth_ipacmd_addr_change) + extrasize);
1561 queue_work(qeth_wq, &data->worker);
1562}
1563EXPORT_SYMBOL(qeth_bridge_host_event);
1564
Eugene Crosserb4d72c02014-01-14 15:54:11 +01001565/* SETBRIDGEPORT support; sending commands */
1566
1567struct _qeth_sbp_cbctl {
1568 u16 ipa_rc;
1569 u16 cmd_rc;
1570 union {
1571 u32 supported;
1572 struct {
1573 enum qeth_sbp_roles *role;
1574 enum qeth_sbp_states *state;
1575 } qports;
1576 } data;
1577};
1578
1579/**
1580 * qeth_bridgeport_makerc() - derive "traditional" error from hardware codes.
1581 * @card: qeth_card structure pointer, for debug messages.
1582 * @cbctl: state structure with hardware return codes.
1583 * @setcmd: IPA command code
1584 *
1585 * Returns negative errno-compatible error indication or 0 on success.
1586 */
1587static int qeth_bridgeport_makerc(struct qeth_card *card,
1588 struct _qeth_sbp_cbctl *cbctl, enum qeth_ipa_sbp_cmd setcmd)
1589{
1590 int rc;
1591
1592 switch (cbctl->ipa_rc) {
1593 case IPA_RC_SUCCESS:
1594 switch (cbctl->cmd_rc) {
1595 case 0x0000:
1596 rc = 0;
1597 break;
1598 case 0x0004:
1599 rc = -ENOSYS;
1600 break;
1601 case 0x000C: /* Not configured as bridge Port */
1602 rc = -ENODEV; /* maybe not the best code here? */
1603 dev_err(&card->gdev->dev,
1604 "The HiperSockets device is not configured as a Bridge Port\n");
1605 break;
1606 case 0x0014: /* Another device is Primary */
1607 switch (setcmd) {
1608 case IPA_SBP_SET_PRIMARY_BRIDGE_PORT:
1609 rc = -EEXIST;
1610 dev_err(&card->gdev->dev,
1611 "The HiperSockets LAN already has a primary Bridge Port\n");
1612 break;
1613 case IPA_SBP_SET_SECONDARY_BRIDGE_PORT:
1614 rc = -EBUSY;
1615 dev_err(&card->gdev->dev,
1616 "The HiperSockets device is already a primary Bridge Port\n");
1617 break;
1618 default:
1619 rc = -EIO;
1620 }
1621 break;
1622 case 0x0018: /* This device is currently Secondary */
1623 rc = -EBUSY;
1624 dev_err(&card->gdev->dev,
1625 "The HiperSockets device is already a secondary Bridge Port\n");
1626 break;
1627 case 0x001C: /* Limit for Secondary devices reached */
1628 rc = -EEXIST;
1629 dev_err(&card->gdev->dev,
1630 "The HiperSockets LAN cannot have more secondary Bridge Ports\n");
1631 break;
1632 case 0x0024: /* This device is currently Primary */
1633 rc = -EBUSY;
1634 dev_err(&card->gdev->dev,
1635 "The HiperSockets device is already a primary Bridge Port\n");
1636 break;
1637 case 0x0020: /* Not authorized by zManager */
1638 rc = -EACCES;
1639 dev_err(&card->gdev->dev,
1640 "The HiperSockets device is not authorized to be a Bridge Port\n");
1641 break;
1642 default:
1643 rc = -EIO;
1644 }
1645 break;
1646 case IPA_RC_NOTSUPP:
1647 rc = -ENOSYS;
1648 break;
1649 case IPA_RC_UNSUPPORTED_COMMAND:
1650 rc = -ENOSYS;
1651 break;
1652 default:
1653 rc = -EIO;
1654 }
1655 if (rc) {
1656 QETH_CARD_TEXT_(card, 2, "SBPi%04x", cbctl->ipa_rc);
1657 QETH_CARD_TEXT_(card, 2, "SBPc%04x", cbctl->cmd_rc);
1658 }
1659 return rc;
1660}
1661
1662static int qeth_bridgeport_query_support_cb(struct qeth_card *card,
1663 struct qeth_reply *reply, unsigned long data)
1664{
1665 struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *) data;
1666 struct _qeth_sbp_cbctl *cbctl = (struct _qeth_sbp_cbctl *)reply->param;
1667 QETH_CARD_TEXT(card, 2, "brqsupcb");
1668 cbctl->ipa_rc = cmd->hdr.return_code;
1669 cbctl->cmd_rc = cmd->data.sbp.hdr.return_code;
1670 if ((cbctl->ipa_rc == 0) && (cbctl->cmd_rc == 0)) {
1671 cbctl->data.supported =
1672 cmd->data.sbp.data.query_cmds_supp.supported_cmds;
1673 } else {
1674 cbctl->data.supported = 0;
1675 }
1676 return 0;
1677}
1678
1679/**
1680 * qeth_bridgeport_query_support() - store bitmask of supported subfunctions.
1681 * @card: qeth_card structure pointer.
1682 *
1683 * Sets bitmask of supported setbridgeport subfunctions in the qeth_card
1684 * strucutre: card->options.sbp.supported_funcs.
1685 */
1686void qeth_bridgeport_query_support(struct qeth_card *card)
1687{
1688 struct qeth_cmd_buffer *iob;
1689 struct qeth_ipa_cmd *cmd;
1690 struct _qeth_sbp_cbctl cbctl;
1691
1692 QETH_CARD_TEXT(card, 2, "brqsuppo");
1693 iob = qeth_get_ipacmd_buffer(card, IPA_CMD_SETBRIDGEPORT, 0);
1694 cmd = (struct qeth_ipa_cmd *)(iob->data+IPA_PDU_HEADER_SIZE);
1695 cmd->data.sbp.hdr.cmdlength =
1696 sizeof(struct qeth_ipacmd_sbp_hdr) +
1697 sizeof(struct qeth_sbp_query_cmds_supp);
1698 cmd->data.sbp.hdr.command_code =
1699 IPA_SBP_QUERY_COMMANDS_SUPPORTED;
1700 cmd->data.sbp.hdr.used_total = 1;
1701 cmd->data.sbp.hdr.seq_no = 1;
1702 if (qeth_send_ipa_cmd(card, iob, qeth_bridgeport_query_support_cb,
1703 (void *)&cbctl) ||
1704 qeth_bridgeport_makerc(card, &cbctl,
1705 IPA_SBP_QUERY_COMMANDS_SUPPORTED)) {
1706 /* non-zero makerc signifies failure, and produce messages */
1707 card->options.sbp.role = QETH_SBP_ROLE_NONE;
1708 return;
1709 }
1710 card->options.sbp.supported_funcs = cbctl.data.supported;
1711}
1712EXPORT_SYMBOL_GPL(qeth_bridgeport_query_support);
1713
1714static int qeth_bridgeport_query_ports_cb(struct qeth_card *card,
1715 struct qeth_reply *reply, unsigned long data)
1716{
1717 struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *) data;
1718 struct qeth_sbp_query_ports *qports = &cmd->data.sbp.data.query_ports;
1719 struct _qeth_sbp_cbctl *cbctl = (struct _qeth_sbp_cbctl *)reply->param;
1720
1721 QETH_CARD_TEXT(card, 2, "brqprtcb");
1722 cbctl->ipa_rc = cmd->hdr.return_code;
1723 cbctl->cmd_rc = cmd->data.sbp.hdr.return_code;
1724 if ((cbctl->ipa_rc != 0) || (cbctl->cmd_rc != 0))
1725 return 0;
1726 if (qports->entry_length != sizeof(struct qeth_sbp_port_entry)) {
1727 cbctl->cmd_rc = 0xffff;
1728 QETH_CARD_TEXT_(card, 2, "SBPs%04x", qports->entry_length);
1729 return 0;
1730 }
1731 /* first entry contains the state of the local port */
1732 if (qports->num_entries > 0) {
1733 if (cbctl->data.qports.role)
1734 *cbctl->data.qports.role = qports->entry[0].role;
1735 if (cbctl->data.qports.state)
1736 *cbctl->data.qports.state = qports->entry[0].state;
1737 }
1738 return 0;
1739}
1740
1741/**
1742 * qeth_bridgeport_query_ports() - query local bridgeport status.
1743 * @card: qeth_card structure pointer.
1744 * @role: Role of the port: 0-none, 1-primary, 2-secondary.
1745 * @state: State of the port: 0-inactive, 1-standby, 2-active.
1746 *
1747 * Returns negative errno-compatible error indication or 0 on success.
1748 *
1749 * 'role' and 'state' are not updated in case of hardware operation failure.
1750 */
1751int qeth_bridgeport_query_ports(struct qeth_card *card,
1752 enum qeth_sbp_roles *role, enum qeth_sbp_states *state)
1753{
1754 int rc = 0;
1755 struct qeth_cmd_buffer *iob;
1756 struct qeth_ipa_cmd *cmd;
1757 struct _qeth_sbp_cbctl cbctl = {
1758 .data = {
1759 .qports = {
1760 .role = role,
1761 .state = state,
1762 },
1763 },
1764 };
1765
1766 QETH_CARD_TEXT(card, 2, "brqports");
1767 if (!(card->options.sbp.supported_funcs & IPA_SBP_QUERY_BRIDGE_PORTS))
1768 return -EOPNOTSUPP;
1769 iob = qeth_get_ipacmd_buffer(card, IPA_CMD_SETBRIDGEPORT, 0);
1770 cmd = (struct qeth_ipa_cmd *)(iob->data+IPA_PDU_HEADER_SIZE);
1771 cmd->data.sbp.hdr.cmdlength =
1772 sizeof(struct qeth_ipacmd_sbp_hdr);
1773 cmd->data.sbp.hdr.command_code =
1774 IPA_SBP_QUERY_BRIDGE_PORTS;
1775 cmd->data.sbp.hdr.used_total = 1;
1776 cmd->data.sbp.hdr.seq_no = 1;
1777 rc = qeth_send_ipa_cmd(card, iob, qeth_bridgeport_query_ports_cb,
1778 (void *)&cbctl);
1779 if (rc)
1780 return rc;
1781 rc = qeth_bridgeport_makerc(card, &cbctl, IPA_SBP_QUERY_BRIDGE_PORTS);
1782 if (rc)
1783 return rc;
1784 return 0;
1785}
1786EXPORT_SYMBOL_GPL(qeth_bridgeport_query_ports);
1787
1788static int qeth_bridgeport_set_cb(struct qeth_card *card,
1789 struct qeth_reply *reply, unsigned long data)
1790{
1791 struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *)data;
1792 struct _qeth_sbp_cbctl *cbctl = (struct _qeth_sbp_cbctl *)reply->param;
1793 QETH_CARD_TEXT(card, 2, "brsetrcb");
1794 cbctl->ipa_rc = cmd->hdr.return_code;
1795 cbctl->cmd_rc = cmd->data.sbp.hdr.return_code;
1796 return 0;
1797}
1798
1799/**
1800 * qeth_bridgeport_setrole() - Assign primary role to the port.
1801 * @card: qeth_card structure pointer.
1802 * @role: Role to assign.
1803 *
1804 * Returns negative errno-compatible error indication or 0 on success.
1805 */
1806int qeth_bridgeport_setrole(struct qeth_card *card, enum qeth_sbp_roles role)
1807{
1808 int rc = 0;
1809 int cmdlength;
1810 struct qeth_cmd_buffer *iob;
1811 struct qeth_ipa_cmd *cmd;
1812 struct _qeth_sbp_cbctl cbctl;
1813 enum qeth_ipa_sbp_cmd setcmd;
1814
1815 QETH_CARD_TEXT(card, 2, "brsetrol");
1816 switch (role) {
1817 case QETH_SBP_ROLE_NONE:
1818 setcmd = IPA_SBP_RESET_BRIDGE_PORT_ROLE;
1819 cmdlength = sizeof(struct qeth_ipacmd_sbp_hdr) +
1820 sizeof(struct qeth_sbp_reset_role);
1821 break;
1822 case QETH_SBP_ROLE_PRIMARY:
1823 setcmd = IPA_SBP_SET_PRIMARY_BRIDGE_PORT;
1824 cmdlength = sizeof(struct qeth_ipacmd_sbp_hdr) +
1825 sizeof(struct qeth_sbp_set_primary);
1826 break;
1827 case QETH_SBP_ROLE_SECONDARY:
1828 setcmd = IPA_SBP_SET_SECONDARY_BRIDGE_PORT;
1829 cmdlength = sizeof(struct qeth_ipacmd_sbp_hdr) +
1830 sizeof(struct qeth_sbp_set_secondary);
1831 break;
1832 default:
1833 return -EINVAL;
1834 }
1835 if (!(card->options.sbp.supported_funcs & setcmd))
1836 return -EOPNOTSUPP;
1837 iob = qeth_get_ipacmd_buffer(card, IPA_CMD_SETBRIDGEPORT, 0);
1838 cmd = (struct qeth_ipa_cmd *)(iob->data+IPA_PDU_HEADER_SIZE);
1839 cmd->data.sbp.hdr.cmdlength = cmdlength;
1840 cmd->data.sbp.hdr.command_code = setcmd;
1841 cmd->data.sbp.hdr.used_total = 1;
1842 cmd->data.sbp.hdr.seq_no = 1;
1843 rc = qeth_send_ipa_cmd(card, iob, qeth_bridgeport_set_cb,
1844 (void *)&cbctl);
1845 if (rc)
1846 return rc;
1847 rc = qeth_bridgeport_makerc(card, &cbctl, setcmd);
1848 return rc;
1849}
1850
Eugene Crosser9f48b9d2014-01-14 15:54:13 +01001851/**
1852 * qeth_anset_makerc() - derive "traditional" error from hardware codes.
1853 * @card: qeth_card structure pointer, for debug messages.
1854 *
1855 * Returns negative errno-compatible error indication or 0 on success.
1856 */
1857static int qeth_anset_makerc(struct qeth_card *card, int pnso_rc, u16 response)
1858{
1859 int rc;
1860
1861 if (pnso_rc == 0)
1862 switch (response) {
1863 case 0x0001:
1864 rc = 0;
1865 break;
1866 case 0x0004:
1867 case 0x0100:
1868 case 0x0106:
1869 rc = -ENOSYS;
1870 dev_err(&card->gdev->dev,
1871 "Setting address notification failed\n");
1872 break;
1873 case 0x0107:
1874 rc = -EAGAIN;
1875 break;
1876 default:
1877 rc = -EIO;
1878 }
1879 else
1880 rc = -EIO;
1881
1882 if (rc) {
1883 QETH_CARD_TEXT_(card, 2, "SBPp%04x", pnso_rc);
1884 QETH_CARD_TEXT_(card, 2, "SBPr%04x", response);
1885 }
1886 return rc;
1887}
1888
1889static void qeth_bridgeport_an_set_cb(void *priv,
1890 enum qdio_brinfo_entry_type type, void *entry)
1891{
1892 struct qeth_card *card = (struct qeth_card *)priv;
1893 struct qdio_brinfo_entry_l2 *l2entry;
1894 u8 code;
1895
1896 if (type != l2_addr_lnid) {
1897 WARN_ON_ONCE(1);
1898 return;
1899 }
1900
1901 l2entry = (struct qdio_brinfo_entry_l2 *)entry;
1902 code = IPA_ADDR_CHANGE_CODE_MACADDR;
1903 if (l2entry->addr_lnid.lnid)
1904 code |= IPA_ADDR_CHANGE_CODE_VLANID;
1905 qeth_bridge_emit_host_event(card, anev_reg_unreg, code,
1906 (struct net_if_token *)&l2entry->nit,
1907 (struct mac_addr_lnid *)&l2entry->addr_lnid);
1908}
1909
1910/**
1911 * qeth_bridgeport_an_set() - Enable or disable bridgeport address notification
1912 * @card: qeth_card structure pointer.
1913 * @enable: 0 - disable, non-zero - enable notifications
1914 *
1915 * Returns negative errno-compatible error indication or 0 on success.
1916 *
1917 * On enable, emits a series of address notifications udev events for all
1918 * currently registered hosts.
1919 */
1920int qeth_bridgeport_an_set(struct qeth_card *card, int enable)
1921{
1922 int rc;
1923 u16 response;
1924 struct ccw_device *ddev;
1925 struct subchannel_id schid;
1926
1927 if (!card)
1928 return -EINVAL;
1929 if (!card->options.sbp.supported_funcs)
1930 return -EOPNOTSUPP;
1931 ddev = CARD_DDEV(card);
1932 ccw_device_get_schid(ddev, &schid);
1933
1934 if (enable) {
1935 qeth_bridge_emit_host_event(card, anev_reset, 0, NULL, NULL);
1936 rc = qdio_pnso_brinfo(schid, 1, &response,
1937 qeth_bridgeport_an_set_cb, card);
1938 } else
1939 rc = qdio_pnso_brinfo(schid, 0, &response, NULL, NULL);
1940 return qeth_anset_makerc(card, rc, response);
1941}
1942EXPORT_SYMBOL_GPL(qeth_bridgeport_an_set);
1943
Frank Blaschka4a71df52008-02-15 09:19:42 +01001944module_init(qeth_l2_init);
1945module_exit(qeth_l2_exit);
1946MODULE_AUTHOR("Frank Blaschka <frank.blaschka@de.ibm.com>");
1947MODULE_DESCRIPTION("qeth layer 2 discipline");
1948MODULE_LICENSE("GPL");