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