1 // SPDX-License-Identifier: GPL-2.0
2 /*
3 * Copyright IBM Corp. 2007
4 * Author(s): Utz Bacher <utz.bacher@de.ibm.com>,
5 * Frank Pavlic <fpavlic@de.ibm.com>,
6 * Thomas Spatzier <tspat@de.ibm.com>,
7 * Frank Blaschka <frank.blaschka@de.ibm.com>
8 */
9
10 #include <linux/slab.h>
11 #include <asm/ebcdic.h>
12 #include <linux/hashtable.h>
13 #include <linux/inet.h>
14 #include "qeth_l3.h"
15
16 #define QETH_DEVICE_ATTR(_id, _name, _mode, _show, _store) \
17 struct device_attribute dev_attr_##_id = __ATTR(_name, _mode, _show, _store)
18
qeth_l3_string_to_ipaddr(const char * buf,enum qeth_prot_versions proto,u8 * addr)19 static int qeth_l3_string_to_ipaddr(const char *buf,
20 enum qeth_prot_versions proto, u8 *addr)
21 {
22 const char *end;
23
24 if ((proto == QETH_PROT_IPV4 && !in4_pton(buf, -1, addr, -1, &end)) ||
25 (proto == QETH_PROT_IPV6 && !in6_pton(buf, -1, addr, -1, &end)))
26 return -EINVAL;
27 return 0;
28 }
29
qeth_l3_dev_route_show(struct qeth_card * card,struct qeth_routing_info * route,char * buf)30 static ssize_t qeth_l3_dev_route_show(struct qeth_card *card,
31 struct qeth_routing_info *route, char *buf)
32 {
33 switch (route->type) {
34 case PRIMARY_ROUTER:
35 return sprintf(buf, "%s\n", "primary router");
36 case SECONDARY_ROUTER:
37 return sprintf(buf, "%s\n", "secondary router");
38 case MULTICAST_ROUTER:
39 if (card->info.broadcast_capable == QETH_BROADCAST_WITHOUT_ECHO)
40 return sprintf(buf, "%s\n", "multicast router+");
41 else
42 return sprintf(buf, "%s\n", "multicast router");
43 case PRIMARY_CONNECTOR:
44 if (card->info.broadcast_capable == QETH_BROADCAST_WITHOUT_ECHO)
45 return sprintf(buf, "%s\n", "primary connector+");
46 else
47 return sprintf(buf, "%s\n", "primary connector");
48 case SECONDARY_CONNECTOR:
49 if (card->info.broadcast_capable == QETH_BROADCAST_WITHOUT_ECHO)
50 return sprintf(buf, "%s\n", "secondary connector+");
51 else
52 return sprintf(buf, "%s\n", "secondary connector");
53 default:
54 return sprintf(buf, "%s\n", "no");
55 }
56 }
57
qeth_l3_dev_route4_show(struct device * dev,struct device_attribute * attr,char * buf)58 static ssize_t qeth_l3_dev_route4_show(struct device *dev,
59 struct device_attribute *attr, char *buf)
60 {
61 struct qeth_card *card = dev_get_drvdata(dev);
62
63 if (!card)
64 return -EINVAL;
65
66 return qeth_l3_dev_route_show(card, &card->options.route4, buf);
67 }
68
qeth_l3_dev_route_store(struct qeth_card * card,struct qeth_routing_info * route,enum qeth_prot_versions prot,const char * buf,size_t count)69 static ssize_t qeth_l3_dev_route_store(struct qeth_card *card,
70 struct qeth_routing_info *route, enum qeth_prot_versions prot,
71 const char *buf, size_t count)
72 {
73 enum qeth_routing_types old_route_type = route->type;
74 int rc = 0;
75
76 mutex_lock(&card->conf_mutex);
77 if (sysfs_streq(buf, "no_router")) {
78 route->type = NO_ROUTER;
79 } else if (sysfs_streq(buf, "primary_connector")) {
80 route->type = PRIMARY_CONNECTOR;
81 } else if (sysfs_streq(buf, "secondary_connector")) {
82 route->type = SECONDARY_CONNECTOR;
83 } else if (sysfs_streq(buf, "primary_router")) {
84 route->type = PRIMARY_ROUTER;
85 } else if (sysfs_streq(buf, "secondary_router")) {
86 route->type = SECONDARY_ROUTER;
87 } else if (sysfs_streq(buf, "multicast_router")) {
88 route->type = MULTICAST_ROUTER;
89 } else {
90 rc = -EINVAL;
91 goto out;
92 }
93 if (qeth_card_hw_is_reachable(card) &&
94 (old_route_type != route->type)) {
95 if (prot == QETH_PROT_IPV4)
96 rc = qeth_l3_setrouting_v4(card);
97 else if (prot == QETH_PROT_IPV6)
98 rc = qeth_l3_setrouting_v6(card);
99 }
100 out:
101 if (rc)
102 route->type = old_route_type;
103 mutex_unlock(&card->conf_mutex);
104 return rc ? rc : count;
105 }
106
qeth_l3_dev_route4_store(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)107 static ssize_t qeth_l3_dev_route4_store(struct device *dev,
108 struct device_attribute *attr, const char *buf, size_t count)
109 {
110 struct qeth_card *card = dev_get_drvdata(dev);
111
112 if (!card)
113 return -EINVAL;
114
115 return qeth_l3_dev_route_store(card, &card->options.route4,
116 QETH_PROT_IPV4, buf, count);
117 }
118
119 static DEVICE_ATTR(route4, 0644, qeth_l3_dev_route4_show,
120 qeth_l3_dev_route4_store);
121
qeth_l3_dev_route6_show(struct device * dev,struct device_attribute * attr,char * buf)122 static ssize_t qeth_l3_dev_route6_show(struct device *dev,
123 struct device_attribute *attr, char *buf)
124 {
125 struct qeth_card *card = dev_get_drvdata(dev);
126
127 if (!card)
128 return -EINVAL;
129
130 return qeth_l3_dev_route_show(card, &card->options.route6, buf);
131 }
132
qeth_l3_dev_route6_store(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)133 static ssize_t qeth_l3_dev_route6_store(struct device *dev,
134 struct device_attribute *attr, const char *buf, size_t count)
135 {
136 struct qeth_card *card = dev_get_drvdata(dev);
137
138 if (!card)
139 return -EINVAL;
140
141 return qeth_l3_dev_route_store(card, &card->options.route6,
142 QETH_PROT_IPV6, buf, count);
143 }
144
145 static DEVICE_ATTR(route6, 0644, qeth_l3_dev_route6_show,
146 qeth_l3_dev_route6_store);
147
qeth_l3_dev_fake_broadcast_show(struct device * dev,struct device_attribute * attr,char * buf)148 static ssize_t qeth_l3_dev_fake_broadcast_show(struct device *dev,
149 struct device_attribute *attr, char *buf)
150 {
151 struct qeth_card *card = dev_get_drvdata(dev);
152
153 if (!card)
154 return -EINVAL;
155
156 return sprintf(buf, "%i\n", card->options.fake_broadcast? 1:0);
157 }
158
qeth_l3_dev_fake_broadcast_store(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)159 static ssize_t qeth_l3_dev_fake_broadcast_store(struct device *dev,
160 struct device_attribute *attr, const char *buf, size_t count)
161 {
162 struct qeth_card *card = dev_get_drvdata(dev);
163 char *tmp;
164 int i, rc = 0;
165
166 if (!card)
167 return -EINVAL;
168
169 mutex_lock(&card->conf_mutex);
170 if ((card->state != CARD_STATE_DOWN) &&
171 (card->state != CARD_STATE_RECOVER)) {
172 rc = -EPERM;
173 goto out;
174 }
175
176 i = simple_strtoul(buf, &tmp, 16);
177 if ((i == 0) || (i == 1))
178 card->options.fake_broadcast = i;
179 else
180 rc = -EINVAL;
181 out:
182 mutex_unlock(&card->conf_mutex);
183 return rc ? rc : count;
184 }
185
186 static DEVICE_ATTR(fake_broadcast, 0644, qeth_l3_dev_fake_broadcast_show,
187 qeth_l3_dev_fake_broadcast_store);
188
qeth_l3_dev_sniffer_show(struct device * dev,struct device_attribute * attr,char * buf)189 static ssize_t qeth_l3_dev_sniffer_show(struct device *dev,
190 struct device_attribute *attr, char *buf)
191 {
192 struct qeth_card *card = dev_get_drvdata(dev);
193
194 if (!card)
195 return -EINVAL;
196
197 return sprintf(buf, "%i\n", card->options.sniffer ? 1 : 0);
198 }
199
qeth_l3_dev_sniffer_store(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)200 static ssize_t qeth_l3_dev_sniffer_store(struct device *dev,
201 struct device_attribute *attr, const char *buf, size_t count)
202 {
203 struct qeth_card *card = dev_get_drvdata(dev);
204 int rc = 0;
205 unsigned long i;
206
207 if (!card)
208 return -EINVAL;
209
210 if (card->info.type != QETH_CARD_TYPE_IQD)
211 return -EPERM;
212 if (card->options.cq == QETH_CQ_ENABLED)
213 return -EPERM;
214
215 mutex_lock(&card->conf_mutex);
216 if ((card->state != CARD_STATE_DOWN) &&
217 (card->state != CARD_STATE_RECOVER)) {
218 rc = -EPERM;
219 goto out;
220 }
221
222 rc = kstrtoul(buf, 16, &i);
223 if (rc) {
224 rc = -EINVAL;
225 goto out;
226 }
227 switch (i) {
228 case 0:
229 card->options.sniffer = i;
230 break;
231 case 1:
232 qdio_get_ssqd_desc(CARD_DDEV(card), &card->ssqd);
233 if (card->ssqd.qdioac2 & QETH_SNIFF_AVAIL) {
234 card->options.sniffer = i;
235 if (card->qdio.init_pool.buf_count !=
236 QETH_IN_BUF_COUNT_MAX)
237 qeth_realloc_buffer_pool(card,
238 QETH_IN_BUF_COUNT_MAX);
239 } else
240 rc = -EPERM;
241 break;
242 default:
243 rc = -EINVAL;
244 }
245 out:
246 mutex_unlock(&card->conf_mutex);
247 return rc ? rc : count;
248 }
249
250 static DEVICE_ATTR(sniffer, 0644, qeth_l3_dev_sniffer_show,
251 qeth_l3_dev_sniffer_store);
252
253
qeth_l3_dev_hsuid_show(struct device * dev,struct device_attribute * attr,char * buf)254 static ssize_t qeth_l3_dev_hsuid_show(struct device *dev,
255 struct device_attribute *attr, char *buf)
256 {
257 struct qeth_card *card = dev_get_drvdata(dev);
258 char tmp_hsuid[9];
259
260 if (!card)
261 return -EINVAL;
262
263 if (card->info.type != QETH_CARD_TYPE_IQD)
264 return -EPERM;
265
266 memcpy(tmp_hsuid, card->options.hsuid, sizeof(tmp_hsuid));
267 EBCASC(tmp_hsuid, 8);
268 return sprintf(buf, "%s\n", tmp_hsuid);
269 }
270
qeth_l3_dev_hsuid_store(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)271 static ssize_t qeth_l3_dev_hsuid_store(struct device *dev,
272 struct device_attribute *attr, const char *buf, size_t count)
273 {
274 struct qeth_card *card = dev_get_drvdata(dev);
275 char *tmp;
276 int rc;
277
278 if (!card)
279 return -EINVAL;
280
281 if (card->info.type != QETH_CARD_TYPE_IQD)
282 return -EPERM;
283 if (card->state != CARD_STATE_DOWN &&
284 card->state != CARD_STATE_RECOVER)
285 return -EPERM;
286 if (card->options.sniffer)
287 return -EPERM;
288 if (card->options.cq == QETH_CQ_NOTAVAILABLE)
289 return -EPERM;
290
291 tmp = strsep((char **)&buf, "\n");
292 if (strlen(tmp) > 8)
293 return -EINVAL;
294
295 if (card->options.hsuid[0])
296 /* delete old ip address */
297 qeth_l3_modify_hsuid(card, false);
298
299 if (strlen(tmp) == 0) {
300 /* delete ip address only */
301 card->options.hsuid[0] = '\0';
302 memcpy(card->dev->perm_addr, card->options.hsuid, 9);
303 qeth_configure_cq(card, QETH_CQ_DISABLED);
304 return count;
305 }
306
307 if (qeth_configure_cq(card, QETH_CQ_ENABLED))
308 return -EPERM;
309
310 snprintf(card->options.hsuid, sizeof(card->options.hsuid),
311 "%-8s", tmp);
312 ASCEBC(card->options.hsuid, 8);
313 memcpy(card->dev->perm_addr, card->options.hsuid, 9);
314
315 rc = qeth_l3_modify_hsuid(card, true);
316
317 return rc ? rc : count;
318 }
319
320 static DEVICE_ATTR(hsuid, 0644, qeth_l3_dev_hsuid_show,
321 qeth_l3_dev_hsuid_store);
322
323
324 static struct attribute *qeth_l3_device_attrs[] = {
325 &dev_attr_route4.attr,
326 &dev_attr_route6.attr,
327 &dev_attr_fake_broadcast.attr,
328 &dev_attr_sniffer.attr,
329 &dev_attr_hsuid.attr,
330 NULL,
331 };
332
333 static const struct attribute_group qeth_l3_device_attr_group = {
334 .attrs = qeth_l3_device_attrs,
335 };
336
qeth_l3_dev_ipato_enable_show(struct device * dev,struct device_attribute * attr,char * buf)337 static ssize_t qeth_l3_dev_ipato_enable_show(struct device *dev,
338 struct device_attribute *attr, char *buf)
339 {
340 struct qeth_card *card = dev_get_drvdata(dev);
341
342 if (!card)
343 return -EINVAL;
344
345 return sprintf(buf, "%i\n", card->ipato.enabled? 1:0);
346 }
347
qeth_l3_dev_ipato_enable_store(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)348 static ssize_t qeth_l3_dev_ipato_enable_store(struct device *dev,
349 struct device_attribute *attr, const char *buf, size_t count)
350 {
351 struct qeth_card *card = dev_get_drvdata(dev);
352 bool enable;
353 int rc = 0;
354
355 if (!card)
356 return -EINVAL;
357
358 mutex_lock(&card->conf_mutex);
359 if ((card->state != CARD_STATE_DOWN) &&
360 (card->state != CARD_STATE_RECOVER)) {
361 rc = -EPERM;
362 goto out;
363 }
364
365 if (sysfs_streq(buf, "toggle")) {
366 enable = !card->ipato.enabled;
367 } else if (kstrtobool(buf, &enable)) {
368 rc = -EINVAL;
369 goto out;
370 }
371
372 if (card->ipato.enabled != enable) {
373 card->ipato.enabled = enable;
374 spin_lock_bh(&card->ip_lock);
375 qeth_l3_update_ipato(card);
376 spin_unlock_bh(&card->ip_lock);
377 }
378 out:
379 mutex_unlock(&card->conf_mutex);
380 return rc ? rc : count;
381 }
382
383 static QETH_DEVICE_ATTR(ipato_enable, enable, 0644,
384 qeth_l3_dev_ipato_enable_show,
385 qeth_l3_dev_ipato_enable_store);
386
qeth_l3_dev_ipato_invert4_show(struct device * dev,struct device_attribute * attr,char * buf)387 static ssize_t qeth_l3_dev_ipato_invert4_show(struct device *dev,
388 struct device_attribute *attr, char *buf)
389 {
390 struct qeth_card *card = dev_get_drvdata(dev);
391
392 if (!card)
393 return -EINVAL;
394
395 return sprintf(buf, "%i\n", card->ipato.invert4? 1:0);
396 }
397
qeth_l3_dev_ipato_invert4_store(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)398 static ssize_t qeth_l3_dev_ipato_invert4_store(struct device *dev,
399 struct device_attribute *attr,
400 const char *buf, size_t count)
401 {
402 struct qeth_card *card = dev_get_drvdata(dev);
403 bool invert;
404 int rc = 0;
405
406 if (!card)
407 return -EINVAL;
408
409 mutex_lock(&card->conf_mutex);
410 if (sysfs_streq(buf, "toggle")) {
411 invert = !card->ipato.invert4;
412 } else if (kstrtobool(buf, &invert)) {
413 rc = -EINVAL;
414 goto out;
415 }
416
417 if (card->ipato.invert4 != invert) {
418 card->ipato.invert4 = invert;
419 spin_lock_bh(&card->ip_lock);
420 qeth_l3_update_ipato(card);
421 spin_unlock_bh(&card->ip_lock);
422 }
423 out:
424 mutex_unlock(&card->conf_mutex);
425 return rc ? rc : count;
426 }
427
428 static QETH_DEVICE_ATTR(ipato_invert4, invert4, 0644,
429 qeth_l3_dev_ipato_invert4_show,
430 qeth_l3_dev_ipato_invert4_store);
431
qeth_l3_dev_ipato_add_show(char * buf,struct qeth_card * card,enum qeth_prot_versions proto)432 static ssize_t qeth_l3_dev_ipato_add_show(char *buf, struct qeth_card *card,
433 enum qeth_prot_versions proto)
434 {
435 struct qeth_ipato_entry *ipatoe;
436 char addr_str[40];
437 int entry_len; /* length of 1 entry string, differs between v4 and v6 */
438 int i = 0;
439
440 entry_len = (proto == QETH_PROT_IPV4)? 12 : 40;
441 /* add strlen for "/<mask>\n" */
442 entry_len += (proto == QETH_PROT_IPV4)? 5 : 6;
443 spin_lock_bh(&card->ip_lock);
444 list_for_each_entry(ipatoe, &card->ipato.entries, entry) {
445 if (ipatoe->proto != proto)
446 continue;
447 /* String must not be longer than PAGE_SIZE. So we check if
448 * string length gets near PAGE_SIZE. Then we can savely display
449 * the next IPv6 address (worst case, compared to IPv4) */
450 if ((PAGE_SIZE - i) <= entry_len)
451 break;
452 qeth_l3_ipaddr_to_string(proto, ipatoe->addr, addr_str);
453 i += snprintf(buf + i, PAGE_SIZE - i,
454 "%s/%i\n", addr_str, ipatoe->mask_bits);
455 }
456 spin_unlock_bh(&card->ip_lock);
457 i += snprintf(buf + i, PAGE_SIZE - i, "\n");
458
459 return i;
460 }
461
qeth_l3_dev_ipato_add4_show(struct device * dev,struct device_attribute * attr,char * buf)462 static ssize_t qeth_l3_dev_ipato_add4_show(struct device *dev,
463 struct device_attribute *attr, char *buf)
464 {
465 struct qeth_card *card = dev_get_drvdata(dev);
466
467 if (!card)
468 return -EINVAL;
469
470 return qeth_l3_dev_ipato_add_show(buf, card, QETH_PROT_IPV4);
471 }
472
qeth_l3_parse_ipatoe(const char * buf,enum qeth_prot_versions proto,u8 * addr,int * mask_bits)473 static int qeth_l3_parse_ipatoe(const char *buf, enum qeth_prot_versions proto,
474 u8 *addr, int *mask_bits)
475 {
476 const char *start, *end;
477 char *tmp;
478 char buffer[40] = {0, };
479
480 start = buf;
481 /* get address string */
482 end = strchr(start, '/');
483 if (!end || (end - start >= 40)) {
484 return -EINVAL;
485 }
486 strncpy(buffer, start, end - start);
487 if (qeth_l3_string_to_ipaddr(buffer, proto, addr)) {
488 return -EINVAL;
489 }
490 start = end + 1;
491 *mask_bits = simple_strtoul(start, &tmp, 10);
492 if (!strlen(start) ||
493 (tmp == start) ||
494 (*mask_bits > ((proto == QETH_PROT_IPV4) ? 32 : 128))) {
495 return -EINVAL;
496 }
497 return 0;
498 }
499
qeth_l3_dev_ipato_add_store(const char * buf,size_t count,struct qeth_card * card,enum qeth_prot_versions proto)500 static ssize_t qeth_l3_dev_ipato_add_store(const char *buf, size_t count,
501 struct qeth_card *card, enum qeth_prot_versions proto)
502 {
503 struct qeth_ipato_entry *ipatoe;
504 u8 addr[16];
505 int mask_bits;
506 int rc = 0;
507
508 mutex_lock(&card->conf_mutex);
509 rc = qeth_l3_parse_ipatoe(buf, proto, addr, &mask_bits);
510 if (rc)
511 goto out;
512
513 ipatoe = kzalloc(sizeof(struct qeth_ipato_entry), GFP_KERNEL);
514 if (!ipatoe) {
515 rc = -ENOMEM;
516 goto out;
517 }
518 ipatoe->proto = proto;
519 memcpy(ipatoe->addr, addr, (proto == QETH_PROT_IPV4)? 4:16);
520 ipatoe->mask_bits = mask_bits;
521
522 rc = qeth_l3_add_ipato_entry(card, ipatoe);
523 if (rc)
524 kfree(ipatoe);
525 out:
526 mutex_unlock(&card->conf_mutex);
527 return rc ? rc : count;
528 }
529
qeth_l3_dev_ipato_add4_store(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)530 static ssize_t qeth_l3_dev_ipato_add4_store(struct device *dev,
531 struct device_attribute *attr, const char *buf, size_t count)
532 {
533 struct qeth_card *card = dev_get_drvdata(dev);
534
535 if (!card)
536 return -EINVAL;
537
538 return qeth_l3_dev_ipato_add_store(buf, count, card, QETH_PROT_IPV4);
539 }
540
541 static QETH_DEVICE_ATTR(ipato_add4, add4, 0644,
542 qeth_l3_dev_ipato_add4_show,
543 qeth_l3_dev_ipato_add4_store);
544
qeth_l3_dev_ipato_del_store(const char * buf,size_t count,struct qeth_card * card,enum qeth_prot_versions proto)545 static ssize_t qeth_l3_dev_ipato_del_store(const char *buf, size_t count,
546 struct qeth_card *card, enum qeth_prot_versions proto)
547 {
548 u8 addr[16];
549 int mask_bits;
550 int rc = 0;
551
552 mutex_lock(&card->conf_mutex);
553 rc = qeth_l3_parse_ipatoe(buf, proto, addr, &mask_bits);
554 if (!rc)
555 rc = qeth_l3_del_ipato_entry(card, proto, addr, mask_bits);
556 mutex_unlock(&card->conf_mutex);
557 return rc ? rc : count;
558 }
559
qeth_l3_dev_ipato_del4_store(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)560 static ssize_t qeth_l3_dev_ipato_del4_store(struct device *dev,
561 struct device_attribute *attr, const char *buf, size_t count)
562 {
563 struct qeth_card *card = dev_get_drvdata(dev);
564
565 if (!card)
566 return -EINVAL;
567
568 return qeth_l3_dev_ipato_del_store(buf, count, card, QETH_PROT_IPV4);
569 }
570
571 static QETH_DEVICE_ATTR(ipato_del4, del4, 0200, NULL,
572 qeth_l3_dev_ipato_del4_store);
573
qeth_l3_dev_ipato_invert6_show(struct device * dev,struct device_attribute * attr,char * buf)574 static ssize_t qeth_l3_dev_ipato_invert6_show(struct device *dev,
575 struct device_attribute *attr, char *buf)
576 {
577 struct qeth_card *card = dev_get_drvdata(dev);
578
579 if (!card)
580 return -EINVAL;
581
582 return sprintf(buf, "%i\n", card->ipato.invert6? 1:0);
583 }
584
qeth_l3_dev_ipato_invert6_store(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)585 static ssize_t qeth_l3_dev_ipato_invert6_store(struct device *dev,
586 struct device_attribute *attr, const char *buf, size_t count)
587 {
588 struct qeth_card *card = dev_get_drvdata(dev);
589 bool invert;
590 int rc = 0;
591
592 if (!card)
593 return -EINVAL;
594
595 mutex_lock(&card->conf_mutex);
596 if (sysfs_streq(buf, "toggle")) {
597 invert = !card->ipato.invert6;
598 } else if (kstrtobool(buf, &invert)) {
599 rc = -EINVAL;
600 goto out;
601 }
602
603 if (card->ipato.invert6 != invert) {
604 card->ipato.invert6 = invert;
605 spin_lock_bh(&card->ip_lock);
606 qeth_l3_update_ipato(card);
607 spin_unlock_bh(&card->ip_lock);
608 }
609 out:
610 mutex_unlock(&card->conf_mutex);
611 return rc ? rc : count;
612 }
613
614 static QETH_DEVICE_ATTR(ipato_invert6, invert6, 0644,
615 qeth_l3_dev_ipato_invert6_show,
616 qeth_l3_dev_ipato_invert6_store);
617
618
qeth_l3_dev_ipato_add6_show(struct device * dev,struct device_attribute * attr,char * buf)619 static ssize_t qeth_l3_dev_ipato_add6_show(struct device *dev,
620 struct device_attribute *attr, char *buf)
621 {
622 struct qeth_card *card = dev_get_drvdata(dev);
623
624 if (!card)
625 return -EINVAL;
626
627 return qeth_l3_dev_ipato_add_show(buf, card, QETH_PROT_IPV6);
628 }
629
qeth_l3_dev_ipato_add6_store(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)630 static ssize_t qeth_l3_dev_ipato_add6_store(struct device *dev,
631 struct device_attribute *attr, const char *buf, size_t count)
632 {
633 struct qeth_card *card = dev_get_drvdata(dev);
634
635 if (!card)
636 return -EINVAL;
637
638 return qeth_l3_dev_ipato_add_store(buf, count, card, QETH_PROT_IPV6);
639 }
640
641 static QETH_DEVICE_ATTR(ipato_add6, add6, 0644,
642 qeth_l3_dev_ipato_add6_show,
643 qeth_l3_dev_ipato_add6_store);
644
qeth_l3_dev_ipato_del6_store(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)645 static ssize_t qeth_l3_dev_ipato_del6_store(struct device *dev,
646 struct device_attribute *attr, const char *buf, size_t count)
647 {
648 struct qeth_card *card = dev_get_drvdata(dev);
649
650 if (!card)
651 return -EINVAL;
652
653 return qeth_l3_dev_ipato_del_store(buf, count, card, QETH_PROT_IPV6);
654 }
655
656 static QETH_DEVICE_ATTR(ipato_del6, del6, 0200, NULL,
657 qeth_l3_dev_ipato_del6_store);
658
659 static struct attribute *qeth_ipato_device_attrs[] = {
660 &dev_attr_ipato_enable.attr,
661 &dev_attr_ipato_invert4.attr,
662 &dev_attr_ipato_add4.attr,
663 &dev_attr_ipato_del4.attr,
664 &dev_attr_ipato_invert6.attr,
665 &dev_attr_ipato_add6.attr,
666 &dev_attr_ipato_del6.attr,
667 NULL,
668 };
669
670 static const struct attribute_group qeth_device_ipato_group = {
671 .name = "ipa_takeover",
672 .attrs = qeth_ipato_device_attrs,
673 };
674
qeth_l3_dev_ip_add_show(struct device * dev,char * buf,enum qeth_prot_versions proto,enum qeth_ip_types type)675 static ssize_t qeth_l3_dev_ip_add_show(struct device *dev, char *buf,
676 enum qeth_prot_versions proto,
677 enum qeth_ip_types type)
678 {
679 struct qeth_card *card = dev_get_drvdata(dev);
680 struct qeth_ipaddr *ipaddr;
681 char addr_str[40];
682 int str_len = 0;
683 int entry_len; /* length of 1 entry string, differs between v4 and v6 */
684 int i;
685
686 if (!card)
687 return -EINVAL;
688
689 entry_len = (proto == QETH_PROT_IPV4)? 12 : 40;
690 entry_len += 2; /* \n + terminator */
691 spin_lock_bh(&card->ip_lock);
692 hash_for_each(card->ip_htable, i, ipaddr, hnode) {
693 if (ipaddr->proto != proto || ipaddr->type != type)
694 continue;
695 /* String must not be longer than PAGE_SIZE. So we check if
696 * string length gets near PAGE_SIZE. Then we can savely display
697 * the next IPv6 address (worst case, compared to IPv4) */
698 if ((PAGE_SIZE - str_len) <= entry_len)
699 break;
700 qeth_l3_ipaddr_to_string(proto, (const u8 *)&ipaddr->u,
701 addr_str);
702 str_len += snprintf(buf + str_len, PAGE_SIZE - str_len, "%s\n",
703 addr_str);
704 }
705 spin_unlock_bh(&card->ip_lock);
706 str_len += snprintf(buf + str_len, PAGE_SIZE - str_len, "\n");
707
708 return str_len;
709 }
710
qeth_l3_dev_vipa_add4_show(struct device * dev,struct device_attribute * attr,char * buf)711 static ssize_t qeth_l3_dev_vipa_add4_show(struct device *dev,
712 struct device_attribute *attr,
713 char *buf)
714 {
715 return qeth_l3_dev_ip_add_show(dev, buf, QETH_PROT_IPV4,
716 QETH_IP_TYPE_VIPA);
717 }
718
qeth_l3_parse_vipae(const char * buf,enum qeth_prot_versions proto,u8 * addr)719 static int qeth_l3_parse_vipae(const char *buf, enum qeth_prot_versions proto,
720 u8 *addr)
721 {
722 if (qeth_l3_string_to_ipaddr(buf, proto, addr)) {
723 return -EINVAL;
724 }
725 return 0;
726 }
727
qeth_l3_dev_vipa_add_store(const char * buf,size_t count,struct qeth_card * card,enum qeth_prot_versions proto)728 static ssize_t qeth_l3_dev_vipa_add_store(const char *buf, size_t count,
729 struct qeth_card *card, enum qeth_prot_versions proto)
730 {
731 u8 addr[16] = {0, };
732 int rc;
733
734 mutex_lock(&card->conf_mutex);
735 rc = qeth_l3_parse_vipae(buf, proto, addr);
736 if (!rc)
737 rc = qeth_l3_modify_rxip_vipa(card, true, addr,
738 QETH_IP_TYPE_VIPA, proto);
739 mutex_unlock(&card->conf_mutex);
740 return rc ? rc : count;
741 }
742
qeth_l3_dev_vipa_add4_store(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)743 static ssize_t qeth_l3_dev_vipa_add4_store(struct device *dev,
744 struct device_attribute *attr, const char *buf, size_t count)
745 {
746 struct qeth_card *card = dev_get_drvdata(dev);
747
748 if (!card)
749 return -EINVAL;
750
751 return qeth_l3_dev_vipa_add_store(buf, count, card, QETH_PROT_IPV4);
752 }
753
754 static QETH_DEVICE_ATTR(vipa_add4, add4, 0644,
755 qeth_l3_dev_vipa_add4_show,
756 qeth_l3_dev_vipa_add4_store);
757
qeth_l3_dev_vipa_del_store(const char * buf,size_t count,struct qeth_card * card,enum qeth_prot_versions proto)758 static ssize_t qeth_l3_dev_vipa_del_store(const char *buf, size_t count,
759 struct qeth_card *card, enum qeth_prot_versions proto)
760 {
761 u8 addr[16];
762 int rc;
763
764 mutex_lock(&card->conf_mutex);
765 rc = qeth_l3_parse_vipae(buf, proto, addr);
766 if (!rc)
767 rc = qeth_l3_modify_rxip_vipa(card, false, addr,
768 QETH_IP_TYPE_VIPA, proto);
769 mutex_unlock(&card->conf_mutex);
770 return rc ? rc : count;
771 }
772
qeth_l3_dev_vipa_del4_store(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)773 static ssize_t qeth_l3_dev_vipa_del4_store(struct device *dev,
774 struct device_attribute *attr, const char *buf, size_t count)
775 {
776 struct qeth_card *card = dev_get_drvdata(dev);
777
778 if (!card)
779 return -EINVAL;
780
781 return qeth_l3_dev_vipa_del_store(buf, count, card, QETH_PROT_IPV4);
782 }
783
784 static QETH_DEVICE_ATTR(vipa_del4, del4, 0200, NULL,
785 qeth_l3_dev_vipa_del4_store);
786
qeth_l3_dev_vipa_add6_show(struct device * dev,struct device_attribute * attr,char * buf)787 static ssize_t qeth_l3_dev_vipa_add6_show(struct device *dev,
788 struct device_attribute *attr,
789 char *buf)
790 {
791 return qeth_l3_dev_ip_add_show(dev, buf, QETH_PROT_IPV6,
792 QETH_IP_TYPE_VIPA);
793 }
794
qeth_l3_dev_vipa_add6_store(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)795 static ssize_t qeth_l3_dev_vipa_add6_store(struct device *dev,
796 struct device_attribute *attr, const char *buf, size_t count)
797 {
798 struct qeth_card *card = dev_get_drvdata(dev);
799
800 if (!card)
801 return -EINVAL;
802
803 return qeth_l3_dev_vipa_add_store(buf, count, card, QETH_PROT_IPV6);
804 }
805
806 static QETH_DEVICE_ATTR(vipa_add6, add6, 0644,
807 qeth_l3_dev_vipa_add6_show,
808 qeth_l3_dev_vipa_add6_store);
809
qeth_l3_dev_vipa_del6_store(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)810 static ssize_t qeth_l3_dev_vipa_del6_store(struct device *dev,
811 struct device_attribute *attr, const char *buf, size_t count)
812 {
813 struct qeth_card *card = dev_get_drvdata(dev);
814
815 if (!card)
816 return -EINVAL;
817
818 return qeth_l3_dev_vipa_del_store(buf, count, card, QETH_PROT_IPV6);
819 }
820
821 static QETH_DEVICE_ATTR(vipa_del6, del6, 0200, NULL,
822 qeth_l3_dev_vipa_del6_store);
823
824 static struct attribute *qeth_vipa_device_attrs[] = {
825 &dev_attr_vipa_add4.attr,
826 &dev_attr_vipa_del4.attr,
827 &dev_attr_vipa_add6.attr,
828 &dev_attr_vipa_del6.attr,
829 NULL,
830 };
831
832 static const struct attribute_group qeth_device_vipa_group = {
833 .name = "vipa",
834 .attrs = qeth_vipa_device_attrs,
835 };
836
qeth_l3_dev_rxip_add4_show(struct device * dev,struct device_attribute * attr,char * buf)837 static ssize_t qeth_l3_dev_rxip_add4_show(struct device *dev,
838 struct device_attribute *attr,
839 char *buf)
840 {
841 return qeth_l3_dev_ip_add_show(dev, buf, QETH_PROT_IPV4,
842 QETH_IP_TYPE_RXIP);
843 }
844
qeth_l3_parse_rxipe(const char * buf,enum qeth_prot_versions proto,u8 * addr)845 static int qeth_l3_parse_rxipe(const char *buf, enum qeth_prot_versions proto,
846 u8 *addr)
847 {
848 __be32 ipv4_addr;
849 struct in6_addr ipv6_addr;
850
851 if (qeth_l3_string_to_ipaddr(buf, proto, addr)) {
852 return -EINVAL;
853 }
854 if (proto == QETH_PROT_IPV4) {
855 memcpy(&ipv4_addr, addr, sizeof(ipv4_addr));
856 if (ipv4_is_multicast(ipv4_addr)) {
857 QETH_DBF_MESSAGE(2, "multicast rxip not supported.\n");
858 return -EINVAL;
859 }
860 } else if (proto == QETH_PROT_IPV6) {
861 memcpy(&ipv6_addr, addr, sizeof(ipv6_addr));
862 if (ipv6_addr_is_multicast(&ipv6_addr)) {
863 QETH_DBF_MESSAGE(2, "multicast rxip not supported.\n");
864 return -EINVAL;
865 }
866 }
867
868 return 0;
869 }
870
qeth_l3_dev_rxip_add_store(const char * buf,size_t count,struct qeth_card * card,enum qeth_prot_versions proto)871 static ssize_t qeth_l3_dev_rxip_add_store(const char *buf, size_t count,
872 struct qeth_card *card, enum qeth_prot_versions proto)
873 {
874 u8 addr[16] = {0, };
875 int rc;
876
877 mutex_lock(&card->conf_mutex);
878 rc = qeth_l3_parse_rxipe(buf, proto, addr);
879 if (!rc)
880 rc = qeth_l3_modify_rxip_vipa(card, true, addr,
881 QETH_IP_TYPE_RXIP, proto);
882 mutex_unlock(&card->conf_mutex);
883 return rc ? rc : count;
884 }
885
qeth_l3_dev_rxip_add4_store(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)886 static ssize_t qeth_l3_dev_rxip_add4_store(struct device *dev,
887 struct device_attribute *attr, const char *buf, size_t count)
888 {
889 struct qeth_card *card = dev_get_drvdata(dev);
890
891 if (!card)
892 return -EINVAL;
893
894 return qeth_l3_dev_rxip_add_store(buf, count, card, QETH_PROT_IPV4);
895 }
896
897 static QETH_DEVICE_ATTR(rxip_add4, add4, 0644,
898 qeth_l3_dev_rxip_add4_show,
899 qeth_l3_dev_rxip_add4_store);
900
qeth_l3_dev_rxip_del_store(const char * buf,size_t count,struct qeth_card * card,enum qeth_prot_versions proto)901 static ssize_t qeth_l3_dev_rxip_del_store(const char *buf, size_t count,
902 struct qeth_card *card, enum qeth_prot_versions proto)
903 {
904 u8 addr[16];
905 int rc;
906
907 mutex_lock(&card->conf_mutex);
908 rc = qeth_l3_parse_rxipe(buf, proto, addr);
909 if (!rc)
910 rc = qeth_l3_modify_rxip_vipa(card, false, addr,
911 QETH_IP_TYPE_RXIP, proto);
912 mutex_unlock(&card->conf_mutex);
913 return rc ? rc : count;
914 }
915
qeth_l3_dev_rxip_del4_store(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)916 static ssize_t qeth_l3_dev_rxip_del4_store(struct device *dev,
917 struct device_attribute *attr, const char *buf, size_t count)
918 {
919 struct qeth_card *card = dev_get_drvdata(dev);
920
921 if (!card)
922 return -EINVAL;
923
924 return qeth_l3_dev_rxip_del_store(buf, count, card, QETH_PROT_IPV4);
925 }
926
927 static QETH_DEVICE_ATTR(rxip_del4, del4, 0200, NULL,
928 qeth_l3_dev_rxip_del4_store);
929
qeth_l3_dev_rxip_add6_show(struct device * dev,struct device_attribute * attr,char * buf)930 static ssize_t qeth_l3_dev_rxip_add6_show(struct device *dev,
931 struct device_attribute *attr,
932 char *buf)
933 {
934 return qeth_l3_dev_ip_add_show(dev, buf, QETH_PROT_IPV6,
935 QETH_IP_TYPE_RXIP);
936 }
937
qeth_l3_dev_rxip_add6_store(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)938 static ssize_t qeth_l3_dev_rxip_add6_store(struct device *dev,
939 struct device_attribute *attr, const char *buf, size_t count)
940 {
941 struct qeth_card *card = dev_get_drvdata(dev);
942
943 if (!card)
944 return -EINVAL;
945
946 return qeth_l3_dev_rxip_add_store(buf, count, card, QETH_PROT_IPV6);
947 }
948
949 static QETH_DEVICE_ATTR(rxip_add6, add6, 0644,
950 qeth_l3_dev_rxip_add6_show,
951 qeth_l3_dev_rxip_add6_store);
952
qeth_l3_dev_rxip_del6_store(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)953 static ssize_t qeth_l3_dev_rxip_del6_store(struct device *dev,
954 struct device_attribute *attr, const char *buf, size_t count)
955 {
956 struct qeth_card *card = dev_get_drvdata(dev);
957
958 if (!card)
959 return -EINVAL;
960
961 return qeth_l3_dev_rxip_del_store(buf, count, card, QETH_PROT_IPV6);
962 }
963
964 static QETH_DEVICE_ATTR(rxip_del6, del6, 0200, NULL,
965 qeth_l3_dev_rxip_del6_store);
966
967 static struct attribute *qeth_rxip_device_attrs[] = {
968 &dev_attr_rxip_add4.attr,
969 &dev_attr_rxip_del4.attr,
970 &dev_attr_rxip_add6.attr,
971 &dev_attr_rxip_del6.attr,
972 NULL,
973 };
974
975 static const struct attribute_group qeth_device_rxip_group = {
976 .name = "rxip",
977 .attrs = qeth_rxip_device_attrs,
978 };
979
980 static const struct attribute_group *qeth_l3_only_attr_groups[] = {
981 &qeth_l3_device_attr_group,
982 &qeth_device_ipato_group,
983 &qeth_device_vipa_group,
984 &qeth_device_rxip_group,
985 NULL,
986 };
987
qeth_l3_create_device_attributes(struct device * dev)988 int qeth_l3_create_device_attributes(struct device *dev)
989 {
990 return sysfs_create_groups(&dev->kobj, qeth_l3_only_attr_groups);
991 }
992
qeth_l3_remove_device_attributes(struct device * dev)993 void qeth_l3_remove_device_attributes(struct device *dev)
994 {
995 sysfs_remove_groups(&dev->kobj, qeth_l3_only_attr_groups);
996 }
997
998 const struct attribute_group *qeth_l3_attr_groups[] = {
999 &qeth_device_attr_group,
1000 &qeth_device_blkt_group,
1001 /* l3 specific, see qeth_l3_only_attr_groups: */
1002 &qeth_l3_device_attr_group,
1003 &qeth_device_ipato_group,
1004 &qeth_device_vipa_group,
1005 &qeth_device_rxip_group,
1006 NULL,
1007 };
1008