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