xref: /openbmc/linux/drivers/s390/net/netiucv.c (revision 31b90347)
1 /*
2  * IUCV network driver
3  *
4  * Copyright IBM Corp. 2001, 2009
5  *
6  * Author(s):
7  *	Original netiucv driver:
8  *		Fritz Elfert (elfert@de.ibm.com, felfert@millenux.com)
9  *	Sysfs integration and all bugs therein:
10  *		Cornelia Huck (cornelia.huck@de.ibm.com)
11  *	PM functions:
12  *		Ursula Braun (ursula.braun@de.ibm.com)
13  *
14  * Documentation used:
15  *  the source of the original IUCV driver by:
16  *    Stefan Hegewald <hegewald@de.ibm.com>
17  *    Hartmut Penner <hpenner@de.ibm.com>
18  *    Denis Joseph Barrow (djbarrow@de.ibm.com,barrow_dj@yahoo.com)
19  *    Martin Schwidefsky (schwidefsky@de.ibm.com)
20  *    Alan Altmark (Alan_Altmark@us.ibm.com)  Sept. 2000
21  *
22  * This program is free software; you can redistribute it and/or modify
23  * it under the terms of the GNU General Public License as published by
24  * the Free Software Foundation; either version 2, or (at your option)
25  * any later version.
26  *
27  * This program is distributed in the hope that it will be useful,
28  * but WITHOUT ANY WARRANTY; without even the implied warranty of
29  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
30  * GNU General Public License for more details.
31  *
32  * You should have received a copy of the GNU General Public License
33  * along with this program; if not, write to the Free Software
34  * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
35  *
36  */
37 
38 #define KMSG_COMPONENT "netiucv"
39 #define pr_fmt(fmt) KMSG_COMPONENT ": " fmt
40 
41 #undef DEBUG
42 
43 #include <linux/module.h>
44 #include <linux/init.h>
45 #include <linux/kernel.h>
46 #include <linux/slab.h>
47 #include <linux/errno.h>
48 #include <linux/types.h>
49 #include <linux/interrupt.h>
50 #include <linux/timer.h>
51 #include <linux/bitops.h>
52 
53 #include <linux/signal.h>
54 #include <linux/string.h>
55 #include <linux/device.h>
56 
57 #include <linux/ip.h>
58 #include <linux/if_arp.h>
59 #include <linux/tcp.h>
60 #include <linux/skbuff.h>
61 #include <linux/ctype.h>
62 #include <net/dst.h>
63 
64 #include <asm/io.h>
65 #include <asm/uaccess.h>
66 #include <asm/ebcdic.h>
67 
68 #include <net/iucv/iucv.h>
69 #include "fsm.h"
70 
71 MODULE_AUTHOR
72     ("(C) 2001 IBM Corporation by Fritz Elfert (felfert@millenux.com)");
73 MODULE_DESCRIPTION ("Linux for S/390 IUCV network driver");
74 
75 /**
76  * Debug Facility stuff
77  */
78 #define IUCV_DBF_SETUP_NAME "iucv_setup"
79 #define IUCV_DBF_SETUP_LEN 64
80 #define IUCV_DBF_SETUP_PAGES 2
81 #define IUCV_DBF_SETUP_NR_AREAS 1
82 #define IUCV_DBF_SETUP_LEVEL 3
83 
84 #define IUCV_DBF_DATA_NAME "iucv_data"
85 #define IUCV_DBF_DATA_LEN 128
86 #define IUCV_DBF_DATA_PAGES 2
87 #define IUCV_DBF_DATA_NR_AREAS 1
88 #define IUCV_DBF_DATA_LEVEL 2
89 
90 #define IUCV_DBF_TRACE_NAME "iucv_trace"
91 #define IUCV_DBF_TRACE_LEN 16
92 #define IUCV_DBF_TRACE_PAGES 4
93 #define IUCV_DBF_TRACE_NR_AREAS 1
94 #define IUCV_DBF_TRACE_LEVEL 3
95 
96 #define IUCV_DBF_TEXT(name,level,text) \
97 	do { \
98 		debug_text_event(iucv_dbf_##name,level,text); \
99 	} while (0)
100 
101 #define IUCV_DBF_HEX(name,level,addr,len) \
102 	do { \
103 		debug_event(iucv_dbf_##name,level,(void*)(addr),len); \
104 	} while (0)
105 
106 DECLARE_PER_CPU(char[256], iucv_dbf_txt_buf);
107 
108 #define IUCV_DBF_TEXT_(name, level, text...) \
109 	do { \
110 		if (debug_level_enabled(iucv_dbf_##name, level)) { \
111 			char* __buf = get_cpu_var(iucv_dbf_txt_buf); \
112 			sprintf(__buf, text); \
113 			debug_text_event(iucv_dbf_##name, level, __buf); \
114 			put_cpu_var(iucv_dbf_txt_buf); \
115 		} \
116 	} while (0)
117 
118 #define IUCV_DBF_SPRINTF(name,level,text...) \
119 	do { \
120 		debug_sprintf_event(iucv_dbf_trace, level, ##text ); \
121 		debug_sprintf_event(iucv_dbf_trace, level, text ); \
122 	} while (0)
123 
124 /**
125  * some more debug stuff
126  */
127 #define PRINTK_HEADER " iucv: "       /* for debugging */
128 
129 /* dummy device to make sure netiucv_pm functions are called */
130 static struct device *netiucv_dev;
131 
132 static int netiucv_pm_prepare(struct device *);
133 static void netiucv_pm_complete(struct device *);
134 static int netiucv_pm_freeze(struct device *);
135 static int netiucv_pm_restore_thaw(struct device *);
136 
137 static const struct dev_pm_ops netiucv_pm_ops = {
138 	.prepare = netiucv_pm_prepare,
139 	.complete = netiucv_pm_complete,
140 	.freeze = netiucv_pm_freeze,
141 	.thaw = netiucv_pm_restore_thaw,
142 	.restore = netiucv_pm_restore_thaw,
143 };
144 
145 static struct device_driver netiucv_driver = {
146 	.owner = THIS_MODULE,
147 	.name = "netiucv",
148 	.bus  = &iucv_bus,
149 	.pm = &netiucv_pm_ops,
150 };
151 
152 static int netiucv_callback_connreq(struct iucv_path *,
153 				    u8 ipvmid[8], u8 ipuser[16]);
154 static void netiucv_callback_connack(struct iucv_path *, u8 ipuser[16]);
155 static void netiucv_callback_connrej(struct iucv_path *, u8 ipuser[16]);
156 static void netiucv_callback_connsusp(struct iucv_path *, u8 ipuser[16]);
157 static void netiucv_callback_connres(struct iucv_path *, u8 ipuser[16]);
158 static void netiucv_callback_rx(struct iucv_path *, struct iucv_message *);
159 static void netiucv_callback_txdone(struct iucv_path *, struct iucv_message *);
160 
161 static struct iucv_handler netiucv_handler = {
162 	.path_pending	  = netiucv_callback_connreq,
163 	.path_complete	  = netiucv_callback_connack,
164 	.path_severed	  = netiucv_callback_connrej,
165 	.path_quiesced	  = netiucv_callback_connsusp,
166 	.path_resumed	  = netiucv_callback_connres,
167 	.message_pending  = netiucv_callback_rx,
168 	.message_complete = netiucv_callback_txdone
169 };
170 
171 /**
172  * Per connection profiling data
173  */
174 struct connection_profile {
175 	unsigned long maxmulti;
176 	unsigned long maxcqueue;
177 	unsigned long doios_single;
178 	unsigned long doios_multi;
179 	unsigned long txlen;
180 	unsigned long tx_time;
181 	struct timespec send_stamp;
182 	unsigned long tx_pending;
183 	unsigned long tx_max_pending;
184 };
185 
186 /**
187  * Representation of one iucv connection
188  */
189 struct iucv_connection {
190 	struct list_head	  list;
191 	struct iucv_path	  *path;
192 	struct sk_buff            *rx_buff;
193 	struct sk_buff            *tx_buff;
194 	struct sk_buff_head       collect_queue;
195 	struct sk_buff_head	  commit_queue;
196 	spinlock_t                collect_lock;
197 	int                       collect_len;
198 	int                       max_buffsize;
199 	fsm_timer                 timer;
200 	fsm_instance              *fsm;
201 	struct net_device         *netdev;
202 	struct connection_profile prof;
203 	char                      userid[9];
204 	char			  userdata[17];
205 };
206 
207 /**
208  * Linked list of all connection structs.
209  */
210 static LIST_HEAD(iucv_connection_list);
211 static DEFINE_RWLOCK(iucv_connection_rwlock);
212 
213 /**
214  * Representation of event-data for the
215  * connection state machine.
216  */
217 struct iucv_event {
218 	struct iucv_connection *conn;
219 	void                   *data;
220 };
221 
222 /**
223  * Private part of the network device structure
224  */
225 struct netiucv_priv {
226 	struct net_device_stats stats;
227 	unsigned long           tbusy;
228 	fsm_instance            *fsm;
229         struct iucv_connection  *conn;
230 	struct device           *dev;
231 	int			 pm_state;
232 };
233 
234 /**
235  * Link level header for a packet.
236  */
237 struct ll_header {
238 	u16 next;
239 };
240 
241 #define NETIUCV_HDRLEN		 (sizeof(struct ll_header))
242 #define NETIUCV_BUFSIZE_MAX	 65537
243 #define NETIUCV_BUFSIZE_DEFAULT  NETIUCV_BUFSIZE_MAX
244 #define NETIUCV_MTU_MAX          (NETIUCV_BUFSIZE_MAX - NETIUCV_HDRLEN)
245 #define NETIUCV_MTU_DEFAULT      9216
246 #define NETIUCV_QUEUELEN_DEFAULT 50
247 #define NETIUCV_TIMEOUT_5SEC     5000
248 
249 /**
250  * Compatibility macros for busy handling
251  * of network devices.
252  */
253 static inline void netiucv_clear_busy(struct net_device *dev)
254 {
255 	struct netiucv_priv *priv = netdev_priv(dev);
256 	clear_bit(0, &priv->tbusy);
257 	netif_wake_queue(dev);
258 }
259 
260 static inline int netiucv_test_and_set_busy(struct net_device *dev)
261 {
262 	struct netiucv_priv *priv = netdev_priv(dev);
263 	netif_stop_queue(dev);
264 	return test_and_set_bit(0, &priv->tbusy);
265 }
266 
267 static u8 iucvMagic_ascii[16] = {
268 	0x30, 0x20, 0x20, 0x20, 0x20, 0x20, 0x20, 0x20,
269 	0x30, 0x20, 0x20, 0x20, 0x20, 0x20, 0x20, 0x20
270 };
271 
272 static u8 iucvMagic_ebcdic[16] = {
273 	0xF0, 0x40, 0x40, 0x40, 0x40, 0x40, 0x40, 0x40,
274 	0xF0, 0x40, 0x40, 0x40, 0x40, 0x40, 0x40, 0x40
275 };
276 
277 /**
278  * Convert an iucv userId to its printable
279  * form (strip whitespace at end).
280  *
281  * @param An iucv userId
282  *
283  * @returns The printable string (static data!!)
284  */
285 static char *netiucv_printname(char *name, int len)
286 {
287 	static char tmp[17];
288 	char *p = tmp;
289 	memcpy(tmp, name, len);
290 	tmp[len] = '\0';
291 	while (*p && ((p - tmp) < len) && (!isspace(*p)))
292 		p++;
293 	*p = '\0';
294 	return tmp;
295 }
296 
297 static char *netiucv_printuser(struct iucv_connection *conn)
298 {
299 	static char tmp_uid[9];
300 	static char tmp_udat[17];
301 	static char buf[100];
302 
303 	if (memcmp(conn->userdata, iucvMagic_ebcdic, 16)) {
304 		tmp_uid[8] = '\0';
305 		tmp_udat[16] = '\0';
306 		memcpy(tmp_uid, conn->userid, 8);
307 		memcpy(tmp_uid, netiucv_printname(tmp_uid, 8), 8);
308 		memcpy(tmp_udat, conn->userdata, 16);
309 		EBCASC(tmp_udat, 16);
310 		memcpy(tmp_udat, netiucv_printname(tmp_udat, 16), 16);
311 		sprintf(buf, "%s.%s", tmp_uid, tmp_udat);
312 		return buf;
313 	} else
314 		return netiucv_printname(conn->userid, 8);
315 }
316 
317 /**
318  * States of the interface statemachine.
319  */
320 enum dev_states {
321 	DEV_STATE_STOPPED,
322 	DEV_STATE_STARTWAIT,
323 	DEV_STATE_STOPWAIT,
324 	DEV_STATE_RUNNING,
325 	/**
326 	 * MUST be always the last element!!
327 	 */
328 	NR_DEV_STATES
329 };
330 
331 static const char *dev_state_names[] = {
332 	"Stopped",
333 	"StartWait",
334 	"StopWait",
335 	"Running",
336 };
337 
338 /**
339  * Events of the interface statemachine.
340  */
341 enum dev_events {
342 	DEV_EVENT_START,
343 	DEV_EVENT_STOP,
344 	DEV_EVENT_CONUP,
345 	DEV_EVENT_CONDOWN,
346 	/**
347 	 * MUST be always the last element!!
348 	 */
349 	NR_DEV_EVENTS
350 };
351 
352 static const char *dev_event_names[] = {
353 	"Start",
354 	"Stop",
355 	"Connection up",
356 	"Connection down",
357 };
358 
359 /**
360  * Events of the connection statemachine
361  */
362 enum conn_events {
363 	/**
364 	 * Events, representing callbacks from
365 	 * lowlevel iucv layer)
366 	 */
367 	CONN_EVENT_CONN_REQ,
368 	CONN_EVENT_CONN_ACK,
369 	CONN_EVENT_CONN_REJ,
370 	CONN_EVENT_CONN_SUS,
371 	CONN_EVENT_CONN_RES,
372 	CONN_EVENT_RX,
373 	CONN_EVENT_TXDONE,
374 
375 	/**
376 	 * Events, representing errors return codes from
377 	 * calls to lowlevel iucv layer
378 	 */
379 
380 	/**
381 	 * Event, representing timer expiry.
382 	 */
383 	CONN_EVENT_TIMER,
384 
385 	/**
386 	 * Events, representing commands from upper levels.
387 	 */
388 	CONN_EVENT_START,
389 	CONN_EVENT_STOP,
390 
391 	/**
392 	 * MUST be always the last element!!
393 	 */
394 	NR_CONN_EVENTS,
395 };
396 
397 static const char *conn_event_names[] = {
398 	"Remote connection request",
399 	"Remote connection acknowledge",
400 	"Remote connection reject",
401 	"Connection suspended",
402 	"Connection resumed",
403 	"Data received",
404 	"Data sent",
405 
406 	"Timer",
407 
408 	"Start",
409 	"Stop",
410 };
411 
412 /**
413  * States of the connection statemachine.
414  */
415 enum conn_states {
416 	/**
417 	 * Connection not assigned to any device,
418 	 * initial state, invalid
419 	 */
420 	CONN_STATE_INVALID,
421 
422 	/**
423 	 * Userid assigned but not operating
424 	 */
425 	CONN_STATE_STOPPED,
426 
427 	/**
428 	 * Connection registered,
429 	 * no connection request sent yet,
430 	 * no connection request received
431 	 */
432 	CONN_STATE_STARTWAIT,
433 
434 	/**
435 	 * Connection registered and connection request sent,
436 	 * no acknowledge and no connection request received yet.
437 	 */
438 	CONN_STATE_SETUPWAIT,
439 
440 	/**
441 	 * Connection up and running idle
442 	 */
443 	CONN_STATE_IDLE,
444 
445 	/**
446 	 * Data sent, awaiting CONN_EVENT_TXDONE
447 	 */
448 	CONN_STATE_TX,
449 
450 	/**
451 	 * Error during registration.
452 	 */
453 	CONN_STATE_REGERR,
454 
455 	/**
456 	 * Error during registration.
457 	 */
458 	CONN_STATE_CONNERR,
459 
460 	/**
461 	 * MUST be always the last element!!
462 	 */
463 	NR_CONN_STATES,
464 };
465 
466 static const char *conn_state_names[] = {
467 	"Invalid",
468 	"Stopped",
469 	"StartWait",
470 	"SetupWait",
471 	"Idle",
472 	"TX",
473 	"Terminating",
474 	"Registration error",
475 	"Connect error",
476 };
477 
478 
479 /**
480  * Debug Facility Stuff
481  */
482 static debug_info_t *iucv_dbf_setup = NULL;
483 static debug_info_t *iucv_dbf_data = NULL;
484 static debug_info_t *iucv_dbf_trace = NULL;
485 
486 DEFINE_PER_CPU(char[256], iucv_dbf_txt_buf);
487 
488 static void iucv_unregister_dbf_views(void)
489 {
490 	if (iucv_dbf_setup)
491 		debug_unregister(iucv_dbf_setup);
492 	if (iucv_dbf_data)
493 		debug_unregister(iucv_dbf_data);
494 	if (iucv_dbf_trace)
495 		debug_unregister(iucv_dbf_trace);
496 }
497 static int iucv_register_dbf_views(void)
498 {
499 	iucv_dbf_setup = debug_register(IUCV_DBF_SETUP_NAME,
500 					IUCV_DBF_SETUP_PAGES,
501 					IUCV_DBF_SETUP_NR_AREAS,
502 					IUCV_DBF_SETUP_LEN);
503 	iucv_dbf_data = debug_register(IUCV_DBF_DATA_NAME,
504 				       IUCV_DBF_DATA_PAGES,
505 				       IUCV_DBF_DATA_NR_AREAS,
506 				       IUCV_DBF_DATA_LEN);
507 	iucv_dbf_trace = debug_register(IUCV_DBF_TRACE_NAME,
508 					IUCV_DBF_TRACE_PAGES,
509 					IUCV_DBF_TRACE_NR_AREAS,
510 					IUCV_DBF_TRACE_LEN);
511 
512 	if ((iucv_dbf_setup == NULL) || (iucv_dbf_data == NULL) ||
513 	    (iucv_dbf_trace == NULL)) {
514 		iucv_unregister_dbf_views();
515 		return -ENOMEM;
516 	}
517 	debug_register_view(iucv_dbf_setup, &debug_hex_ascii_view);
518 	debug_set_level(iucv_dbf_setup, IUCV_DBF_SETUP_LEVEL);
519 
520 	debug_register_view(iucv_dbf_data, &debug_hex_ascii_view);
521 	debug_set_level(iucv_dbf_data, IUCV_DBF_DATA_LEVEL);
522 
523 	debug_register_view(iucv_dbf_trace, &debug_hex_ascii_view);
524 	debug_set_level(iucv_dbf_trace, IUCV_DBF_TRACE_LEVEL);
525 
526 	return 0;
527 }
528 
529 /*
530  * Callback-wrappers, called from lowlevel iucv layer.
531  */
532 
533 static void netiucv_callback_rx(struct iucv_path *path,
534 				struct iucv_message *msg)
535 {
536 	struct iucv_connection *conn = path->private;
537 	struct iucv_event ev;
538 
539 	ev.conn = conn;
540 	ev.data = msg;
541 	fsm_event(conn->fsm, CONN_EVENT_RX, &ev);
542 }
543 
544 static void netiucv_callback_txdone(struct iucv_path *path,
545 				    struct iucv_message *msg)
546 {
547 	struct iucv_connection *conn = path->private;
548 	struct iucv_event ev;
549 
550 	ev.conn = conn;
551 	ev.data = msg;
552 	fsm_event(conn->fsm, CONN_EVENT_TXDONE, &ev);
553 }
554 
555 static void netiucv_callback_connack(struct iucv_path *path, u8 ipuser[16])
556 {
557 	struct iucv_connection *conn = path->private;
558 
559 	fsm_event(conn->fsm, CONN_EVENT_CONN_ACK, conn);
560 }
561 
562 static int netiucv_callback_connreq(struct iucv_path *path,
563 				    u8 ipvmid[8], u8 ipuser[16])
564 {
565 	struct iucv_connection *conn = path->private;
566 	struct iucv_event ev;
567 	static char tmp_user[9];
568 	static char tmp_udat[17];
569 	int rc;
570 
571 	rc = -EINVAL;
572 	memcpy(tmp_user, netiucv_printname(ipvmid, 8), 8);
573 	memcpy(tmp_udat, ipuser, 16);
574 	EBCASC(tmp_udat, 16);
575 	read_lock_bh(&iucv_connection_rwlock);
576 	list_for_each_entry(conn, &iucv_connection_list, list) {
577 		if (strncmp(ipvmid, conn->userid, 8) ||
578 		    strncmp(ipuser, conn->userdata, 16))
579 			continue;
580 		/* Found a matching connection for this path. */
581 		conn->path = path;
582 		ev.conn = conn;
583 		ev.data = path;
584 		fsm_event(conn->fsm, CONN_EVENT_CONN_REQ, &ev);
585 		rc = 0;
586 	}
587 	IUCV_DBF_TEXT_(setup, 2, "Connection requested for %s.%s\n",
588 		       tmp_user, netiucv_printname(tmp_udat, 16));
589 	read_unlock_bh(&iucv_connection_rwlock);
590 	return rc;
591 }
592 
593 static void netiucv_callback_connrej(struct iucv_path *path, u8 ipuser[16])
594 {
595 	struct iucv_connection *conn = path->private;
596 
597 	fsm_event(conn->fsm, CONN_EVENT_CONN_REJ, conn);
598 }
599 
600 static void netiucv_callback_connsusp(struct iucv_path *path, u8 ipuser[16])
601 {
602 	struct iucv_connection *conn = path->private;
603 
604 	fsm_event(conn->fsm, CONN_EVENT_CONN_SUS, conn);
605 }
606 
607 static void netiucv_callback_connres(struct iucv_path *path, u8 ipuser[16])
608 {
609 	struct iucv_connection *conn = path->private;
610 
611 	fsm_event(conn->fsm, CONN_EVENT_CONN_RES, conn);
612 }
613 
614 /**
615  * NOP action for statemachines
616  */
617 static void netiucv_action_nop(fsm_instance *fi, int event, void *arg)
618 {
619 }
620 
621 /*
622  * Actions of the connection statemachine
623  */
624 
625 /**
626  * netiucv_unpack_skb
627  * @conn: The connection where this skb has been received.
628  * @pskb: The received skb.
629  *
630  * Unpack a just received skb and hand it over to upper layers.
631  * Helper function for conn_action_rx.
632  */
633 static void netiucv_unpack_skb(struct iucv_connection *conn,
634 			       struct sk_buff *pskb)
635 {
636 	struct net_device     *dev = conn->netdev;
637 	struct netiucv_priv   *privptr = netdev_priv(dev);
638 	u16 offset = 0;
639 
640 	skb_put(pskb, NETIUCV_HDRLEN);
641 	pskb->dev = dev;
642 	pskb->ip_summed = CHECKSUM_NONE;
643 	pskb->protocol = ntohs(ETH_P_IP);
644 
645 	while (1) {
646 		struct sk_buff *skb;
647 		struct ll_header *header = (struct ll_header *) pskb->data;
648 
649 		if (!header->next)
650 			break;
651 
652 		skb_pull(pskb, NETIUCV_HDRLEN);
653 		header->next -= offset;
654 		offset += header->next;
655 		header->next -= NETIUCV_HDRLEN;
656 		if (skb_tailroom(pskb) < header->next) {
657 			IUCV_DBF_TEXT_(data, 2, "Illegal next field: %d > %d\n",
658 				header->next, skb_tailroom(pskb));
659 			return;
660 		}
661 		skb_put(pskb, header->next);
662 		skb_reset_mac_header(pskb);
663 		skb = dev_alloc_skb(pskb->len);
664 		if (!skb) {
665 			IUCV_DBF_TEXT(data, 2,
666 				"Out of memory in netiucv_unpack_skb\n");
667 			privptr->stats.rx_dropped++;
668 			return;
669 		}
670 		skb_copy_from_linear_data(pskb, skb_put(skb, pskb->len),
671 					  pskb->len);
672 		skb_reset_mac_header(skb);
673 		skb->dev = pskb->dev;
674 		skb->protocol = pskb->protocol;
675 		pskb->ip_summed = CHECKSUM_UNNECESSARY;
676 		privptr->stats.rx_packets++;
677 		privptr->stats.rx_bytes += skb->len;
678 		/*
679 		 * Since receiving is always initiated from a tasklet (in iucv.c),
680 		 * we must use netif_rx_ni() instead of netif_rx()
681 		 */
682 		netif_rx_ni(skb);
683 		skb_pull(pskb, header->next);
684 		skb_put(pskb, NETIUCV_HDRLEN);
685 	}
686 }
687 
688 static void conn_action_rx(fsm_instance *fi, int event, void *arg)
689 {
690 	struct iucv_event *ev = arg;
691 	struct iucv_connection *conn = ev->conn;
692 	struct iucv_message *msg = ev->data;
693 	struct netiucv_priv *privptr = netdev_priv(conn->netdev);
694 	int rc;
695 
696 	IUCV_DBF_TEXT(trace, 4, __func__);
697 
698 	if (!conn->netdev) {
699 		iucv_message_reject(conn->path, msg);
700 		IUCV_DBF_TEXT(data, 2,
701 			      "Received data for unlinked connection\n");
702 		return;
703 	}
704 	if (msg->length > conn->max_buffsize) {
705 		iucv_message_reject(conn->path, msg);
706 		privptr->stats.rx_dropped++;
707 		IUCV_DBF_TEXT_(data, 2, "msglen %d > max_buffsize %d\n",
708 			       msg->length, conn->max_buffsize);
709 		return;
710 	}
711 	conn->rx_buff->data = conn->rx_buff->head;
712 	skb_reset_tail_pointer(conn->rx_buff);
713 	conn->rx_buff->len = 0;
714 	rc = iucv_message_receive(conn->path, msg, 0, conn->rx_buff->data,
715 				  msg->length, NULL);
716 	if (rc || msg->length < 5) {
717 		privptr->stats.rx_errors++;
718 		IUCV_DBF_TEXT_(data, 2, "rc %d from iucv_receive\n", rc);
719 		return;
720 	}
721 	netiucv_unpack_skb(conn, conn->rx_buff);
722 }
723 
724 static void conn_action_txdone(fsm_instance *fi, int event, void *arg)
725 {
726 	struct iucv_event *ev = arg;
727 	struct iucv_connection *conn = ev->conn;
728 	struct iucv_message *msg = ev->data;
729 	struct iucv_message txmsg;
730 	struct netiucv_priv *privptr = NULL;
731 	u32 single_flag = msg->tag;
732 	u32 txbytes = 0;
733 	u32 txpackets = 0;
734 	u32 stat_maxcq = 0;
735 	struct sk_buff *skb;
736 	unsigned long saveflags;
737 	struct ll_header header;
738 	int rc;
739 
740 	IUCV_DBF_TEXT(trace, 4, __func__);
741 
742 	if (conn && conn->netdev)
743 		privptr = netdev_priv(conn->netdev);
744 	conn->prof.tx_pending--;
745 	if (single_flag) {
746 		if ((skb = skb_dequeue(&conn->commit_queue))) {
747 			atomic_dec(&skb->users);
748 			if (privptr) {
749 				privptr->stats.tx_packets++;
750 				privptr->stats.tx_bytes +=
751 					(skb->len - NETIUCV_HDRLEN
752 						  - NETIUCV_HDRLEN);
753 			}
754 			dev_kfree_skb_any(skb);
755 		}
756 	}
757 	conn->tx_buff->data = conn->tx_buff->head;
758 	skb_reset_tail_pointer(conn->tx_buff);
759 	conn->tx_buff->len = 0;
760 	spin_lock_irqsave(&conn->collect_lock, saveflags);
761 	while ((skb = skb_dequeue(&conn->collect_queue))) {
762 		header.next = conn->tx_buff->len + skb->len + NETIUCV_HDRLEN;
763 		memcpy(skb_put(conn->tx_buff, NETIUCV_HDRLEN), &header,
764 		       NETIUCV_HDRLEN);
765 		skb_copy_from_linear_data(skb,
766 					  skb_put(conn->tx_buff, skb->len),
767 					  skb->len);
768 		txbytes += skb->len;
769 		txpackets++;
770 		stat_maxcq++;
771 		atomic_dec(&skb->users);
772 		dev_kfree_skb_any(skb);
773 	}
774 	if (conn->collect_len > conn->prof.maxmulti)
775 		conn->prof.maxmulti = conn->collect_len;
776 	conn->collect_len = 0;
777 	spin_unlock_irqrestore(&conn->collect_lock, saveflags);
778 	if (conn->tx_buff->len == 0) {
779 		fsm_newstate(fi, CONN_STATE_IDLE);
780 		return;
781 	}
782 
783 	header.next = 0;
784 	memcpy(skb_put(conn->tx_buff, NETIUCV_HDRLEN), &header, NETIUCV_HDRLEN);
785 	conn->prof.send_stamp = current_kernel_time();
786 	txmsg.class = 0;
787 	txmsg.tag = 0;
788 	rc = iucv_message_send(conn->path, &txmsg, 0, 0,
789 			       conn->tx_buff->data, conn->tx_buff->len);
790 	conn->prof.doios_multi++;
791 	conn->prof.txlen += conn->tx_buff->len;
792 	conn->prof.tx_pending++;
793 	if (conn->prof.tx_pending > conn->prof.tx_max_pending)
794 		conn->prof.tx_max_pending = conn->prof.tx_pending;
795 	if (rc) {
796 		conn->prof.tx_pending--;
797 		fsm_newstate(fi, CONN_STATE_IDLE);
798 		if (privptr)
799 			privptr->stats.tx_errors += txpackets;
800 		IUCV_DBF_TEXT_(data, 2, "rc %d from iucv_send\n", rc);
801 	} else {
802 		if (privptr) {
803 			privptr->stats.tx_packets += txpackets;
804 			privptr->stats.tx_bytes += txbytes;
805 		}
806 		if (stat_maxcq > conn->prof.maxcqueue)
807 			conn->prof.maxcqueue = stat_maxcq;
808 	}
809 }
810 
811 static void conn_action_connaccept(fsm_instance *fi, int event, void *arg)
812 {
813 	struct iucv_event *ev = arg;
814 	struct iucv_connection *conn = ev->conn;
815 	struct iucv_path *path = ev->data;
816 	struct net_device *netdev = conn->netdev;
817 	struct netiucv_priv *privptr = netdev_priv(netdev);
818 	int rc;
819 
820 	IUCV_DBF_TEXT(trace, 3, __func__);
821 
822 	conn->path = path;
823 	path->msglim = NETIUCV_QUEUELEN_DEFAULT;
824 	path->flags = 0;
825 	rc = iucv_path_accept(path, &netiucv_handler, conn->userdata , conn);
826 	if (rc) {
827 		IUCV_DBF_TEXT_(setup, 2, "rc %d from iucv_accept", rc);
828 		return;
829 	}
830 	fsm_newstate(fi, CONN_STATE_IDLE);
831 	netdev->tx_queue_len = conn->path->msglim;
832 	fsm_event(privptr->fsm, DEV_EVENT_CONUP, netdev);
833 }
834 
835 static void conn_action_connreject(fsm_instance *fi, int event, void *arg)
836 {
837 	struct iucv_event *ev = arg;
838 	struct iucv_path *path = ev->data;
839 
840 	IUCV_DBF_TEXT(trace, 3, __func__);
841 	iucv_path_sever(path, NULL);
842 }
843 
844 static void conn_action_connack(fsm_instance *fi, int event, void *arg)
845 {
846 	struct iucv_connection *conn = arg;
847 	struct net_device *netdev = conn->netdev;
848 	struct netiucv_priv *privptr = netdev_priv(netdev);
849 
850 	IUCV_DBF_TEXT(trace, 3, __func__);
851 	fsm_deltimer(&conn->timer);
852 	fsm_newstate(fi, CONN_STATE_IDLE);
853 	netdev->tx_queue_len = conn->path->msglim;
854 	fsm_event(privptr->fsm, DEV_EVENT_CONUP, netdev);
855 }
856 
857 static void conn_action_conntimsev(fsm_instance *fi, int event, void *arg)
858 {
859 	struct iucv_connection *conn = arg;
860 
861 	IUCV_DBF_TEXT(trace, 3, __func__);
862 	fsm_deltimer(&conn->timer);
863 	iucv_path_sever(conn->path, conn->userdata);
864 	fsm_newstate(fi, CONN_STATE_STARTWAIT);
865 }
866 
867 static void conn_action_connsever(fsm_instance *fi, int event, void *arg)
868 {
869 	struct iucv_connection *conn = arg;
870 	struct net_device *netdev = conn->netdev;
871 	struct netiucv_priv *privptr = netdev_priv(netdev);
872 
873 	IUCV_DBF_TEXT(trace, 3, __func__);
874 
875 	fsm_deltimer(&conn->timer);
876 	iucv_path_sever(conn->path, conn->userdata);
877 	dev_info(privptr->dev, "The peer z/VM guest %s has closed the "
878 			       "connection\n", netiucv_printuser(conn));
879 	IUCV_DBF_TEXT(data, 2,
880 		      "conn_action_connsever: Remote dropped connection\n");
881 	fsm_newstate(fi, CONN_STATE_STARTWAIT);
882 	fsm_event(privptr->fsm, DEV_EVENT_CONDOWN, netdev);
883 }
884 
885 static void conn_action_start(fsm_instance *fi, int event, void *arg)
886 {
887 	struct iucv_connection *conn = arg;
888 	struct net_device *netdev = conn->netdev;
889 	struct netiucv_priv *privptr = netdev_priv(netdev);
890 	int rc;
891 
892 	IUCV_DBF_TEXT(trace, 3, __func__);
893 
894 	fsm_newstate(fi, CONN_STATE_STARTWAIT);
895 
896 	/*
897 	 * We must set the state before calling iucv_connect because the
898 	 * callback handler could be called at any point after the connection
899 	 * request is sent
900 	 */
901 
902 	fsm_newstate(fi, CONN_STATE_SETUPWAIT);
903 	conn->path = iucv_path_alloc(NETIUCV_QUEUELEN_DEFAULT, 0, GFP_KERNEL);
904 	IUCV_DBF_TEXT_(setup, 2, "%s: connecting to %s ...\n",
905 		netdev->name, netiucv_printuser(conn));
906 
907 	rc = iucv_path_connect(conn->path, &netiucv_handler, conn->userid,
908 			       NULL, conn->userdata, conn);
909 	switch (rc) {
910 	case 0:
911 		netdev->tx_queue_len = conn->path->msglim;
912 		fsm_addtimer(&conn->timer, NETIUCV_TIMEOUT_5SEC,
913 			     CONN_EVENT_TIMER, conn);
914 		return;
915 	case 11:
916 		dev_warn(privptr->dev,
917 			"The IUCV device failed to connect to z/VM guest %s\n",
918 			netiucv_printname(conn->userid, 8));
919 		fsm_newstate(fi, CONN_STATE_STARTWAIT);
920 		break;
921 	case 12:
922 		dev_warn(privptr->dev,
923 			"The IUCV device failed to connect to the peer on z/VM"
924 			" guest %s\n", netiucv_printname(conn->userid, 8));
925 		fsm_newstate(fi, CONN_STATE_STARTWAIT);
926 		break;
927 	case 13:
928 		dev_err(privptr->dev,
929 			"Connecting the IUCV device would exceed the maximum"
930 			" number of IUCV connections\n");
931 		fsm_newstate(fi, CONN_STATE_CONNERR);
932 		break;
933 	case 14:
934 		dev_err(privptr->dev,
935 			"z/VM guest %s has too many IUCV connections"
936 			" to connect with the IUCV device\n",
937 			netiucv_printname(conn->userid, 8));
938 		fsm_newstate(fi, CONN_STATE_CONNERR);
939 		break;
940 	case 15:
941 		dev_err(privptr->dev,
942 			"The IUCV device cannot connect to a z/VM guest with no"
943 			" IUCV authorization\n");
944 		fsm_newstate(fi, CONN_STATE_CONNERR);
945 		break;
946 	default:
947 		dev_err(privptr->dev,
948 			"Connecting the IUCV device failed with error %d\n",
949 			rc);
950 		fsm_newstate(fi, CONN_STATE_CONNERR);
951 		break;
952 	}
953 	IUCV_DBF_TEXT_(setup, 5, "iucv_connect rc is %d\n", rc);
954 	kfree(conn->path);
955 	conn->path = NULL;
956 }
957 
958 static void netiucv_purge_skb_queue(struct sk_buff_head *q)
959 {
960 	struct sk_buff *skb;
961 
962 	while ((skb = skb_dequeue(q))) {
963 		atomic_dec(&skb->users);
964 		dev_kfree_skb_any(skb);
965 	}
966 }
967 
968 static void conn_action_stop(fsm_instance *fi, int event, void *arg)
969 {
970 	struct iucv_event *ev = arg;
971 	struct iucv_connection *conn = ev->conn;
972 	struct net_device *netdev = conn->netdev;
973 	struct netiucv_priv *privptr = netdev_priv(netdev);
974 
975 	IUCV_DBF_TEXT(trace, 3, __func__);
976 
977 	fsm_deltimer(&conn->timer);
978 	fsm_newstate(fi, CONN_STATE_STOPPED);
979 	netiucv_purge_skb_queue(&conn->collect_queue);
980 	if (conn->path) {
981 		IUCV_DBF_TEXT(trace, 5, "calling iucv_path_sever\n");
982 		iucv_path_sever(conn->path, conn->userdata);
983 		kfree(conn->path);
984 		conn->path = NULL;
985 	}
986 	netiucv_purge_skb_queue(&conn->commit_queue);
987 	fsm_event(privptr->fsm, DEV_EVENT_CONDOWN, netdev);
988 }
989 
990 static void conn_action_inval(fsm_instance *fi, int event, void *arg)
991 {
992 	struct iucv_connection *conn = arg;
993 	struct net_device *netdev = conn->netdev;
994 
995 	IUCV_DBF_TEXT_(data, 2, "%s('%s'): conn_action_inval called\n",
996 		netdev->name, conn->userid);
997 }
998 
999 static const fsm_node conn_fsm[] = {
1000 	{ CONN_STATE_INVALID,   CONN_EVENT_START,    conn_action_inval      },
1001 	{ CONN_STATE_STOPPED,   CONN_EVENT_START,    conn_action_start      },
1002 
1003 	{ CONN_STATE_STOPPED,   CONN_EVENT_STOP,     conn_action_stop       },
1004 	{ CONN_STATE_STARTWAIT, CONN_EVENT_STOP,     conn_action_stop       },
1005 	{ CONN_STATE_SETUPWAIT, CONN_EVENT_STOP,     conn_action_stop       },
1006 	{ CONN_STATE_IDLE,      CONN_EVENT_STOP,     conn_action_stop       },
1007 	{ CONN_STATE_TX,        CONN_EVENT_STOP,     conn_action_stop       },
1008 	{ CONN_STATE_REGERR,    CONN_EVENT_STOP,     conn_action_stop       },
1009 	{ CONN_STATE_CONNERR,   CONN_EVENT_STOP,     conn_action_stop       },
1010 
1011 	{ CONN_STATE_STOPPED,   CONN_EVENT_CONN_REQ, conn_action_connreject },
1012         { CONN_STATE_STARTWAIT, CONN_EVENT_CONN_REQ, conn_action_connaccept },
1013 	{ CONN_STATE_SETUPWAIT, CONN_EVENT_CONN_REQ, conn_action_connaccept },
1014 	{ CONN_STATE_IDLE,      CONN_EVENT_CONN_REQ, conn_action_connreject },
1015 	{ CONN_STATE_TX,        CONN_EVENT_CONN_REQ, conn_action_connreject },
1016 
1017 	{ CONN_STATE_SETUPWAIT, CONN_EVENT_CONN_ACK, conn_action_connack    },
1018 	{ CONN_STATE_SETUPWAIT, CONN_EVENT_TIMER,    conn_action_conntimsev },
1019 
1020 	{ CONN_STATE_SETUPWAIT, CONN_EVENT_CONN_REJ, conn_action_connsever  },
1021 	{ CONN_STATE_IDLE,      CONN_EVENT_CONN_REJ, conn_action_connsever  },
1022 	{ CONN_STATE_TX,        CONN_EVENT_CONN_REJ, conn_action_connsever  },
1023 
1024 	{ CONN_STATE_IDLE,      CONN_EVENT_RX,       conn_action_rx         },
1025 	{ CONN_STATE_TX,        CONN_EVENT_RX,       conn_action_rx         },
1026 
1027 	{ CONN_STATE_TX,        CONN_EVENT_TXDONE,   conn_action_txdone     },
1028 	{ CONN_STATE_IDLE,      CONN_EVENT_TXDONE,   conn_action_txdone     },
1029 };
1030 
1031 static const int CONN_FSM_LEN = sizeof(conn_fsm) / sizeof(fsm_node);
1032 
1033 
1034 /*
1035  * Actions for interface - statemachine.
1036  */
1037 
1038 /**
1039  * dev_action_start
1040  * @fi: An instance of an interface statemachine.
1041  * @event: The event, just happened.
1042  * @arg: Generic pointer, casted from struct net_device * upon call.
1043  *
1044  * Startup connection by sending CONN_EVENT_START to it.
1045  */
1046 static void dev_action_start(fsm_instance *fi, int event, void *arg)
1047 {
1048 	struct net_device   *dev = arg;
1049 	struct netiucv_priv *privptr = netdev_priv(dev);
1050 
1051 	IUCV_DBF_TEXT(trace, 3, __func__);
1052 
1053 	fsm_newstate(fi, DEV_STATE_STARTWAIT);
1054 	fsm_event(privptr->conn->fsm, CONN_EVENT_START, privptr->conn);
1055 }
1056 
1057 /**
1058  * Shutdown connection by sending CONN_EVENT_STOP to it.
1059  *
1060  * @param fi    An instance of an interface statemachine.
1061  * @param event The event, just happened.
1062  * @param arg   Generic pointer, casted from struct net_device * upon call.
1063  */
1064 static void
1065 dev_action_stop(fsm_instance *fi, int event, void *arg)
1066 {
1067 	struct net_device   *dev = arg;
1068 	struct netiucv_priv *privptr = netdev_priv(dev);
1069 	struct iucv_event   ev;
1070 
1071 	IUCV_DBF_TEXT(trace, 3, __func__);
1072 
1073 	ev.conn = privptr->conn;
1074 
1075 	fsm_newstate(fi, DEV_STATE_STOPWAIT);
1076 	fsm_event(privptr->conn->fsm, CONN_EVENT_STOP, &ev);
1077 }
1078 
1079 /**
1080  * Called from connection statemachine
1081  * when a connection is up and running.
1082  *
1083  * @param fi    An instance of an interface statemachine.
1084  * @param event The event, just happened.
1085  * @param arg   Generic pointer, casted from struct net_device * upon call.
1086  */
1087 static void
1088 dev_action_connup(fsm_instance *fi, int event, void *arg)
1089 {
1090 	struct net_device   *dev = arg;
1091 	struct netiucv_priv *privptr = netdev_priv(dev);
1092 
1093 	IUCV_DBF_TEXT(trace, 3, __func__);
1094 
1095 	switch (fsm_getstate(fi)) {
1096 		case DEV_STATE_STARTWAIT:
1097 			fsm_newstate(fi, DEV_STATE_RUNNING);
1098 			dev_info(privptr->dev,
1099 				"The IUCV device has been connected"
1100 				" successfully to %s\n",
1101 				netiucv_printuser(privptr->conn));
1102 			IUCV_DBF_TEXT(setup, 3,
1103 				"connection is up and running\n");
1104 			break;
1105 		case DEV_STATE_STOPWAIT:
1106 			IUCV_DBF_TEXT(data, 2,
1107 				"dev_action_connup: in DEV_STATE_STOPWAIT\n");
1108 			break;
1109 	}
1110 }
1111 
1112 /**
1113  * Called from connection statemachine
1114  * when a connection has been shutdown.
1115  *
1116  * @param fi    An instance of an interface statemachine.
1117  * @param event The event, just happened.
1118  * @param arg   Generic pointer, casted from struct net_device * upon call.
1119  */
1120 static void
1121 dev_action_conndown(fsm_instance *fi, int event, void *arg)
1122 {
1123 	IUCV_DBF_TEXT(trace, 3, __func__);
1124 
1125 	switch (fsm_getstate(fi)) {
1126 		case DEV_STATE_RUNNING:
1127 			fsm_newstate(fi, DEV_STATE_STARTWAIT);
1128 			break;
1129 		case DEV_STATE_STOPWAIT:
1130 			fsm_newstate(fi, DEV_STATE_STOPPED);
1131 			IUCV_DBF_TEXT(setup, 3, "connection is down\n");
1132 			break;
1133 	}
1134 }
1135 
1136 static const fsm_node dev_fsm[] = {
1137 	{ DEV_STATE_STOPPED,    DEV_EVENT_START,   dev_action_start    },
1138 
1139 	{ DEV_STATE_STOPWAIT,   DEV_EVENT_START,   dev_action_start    },
1140 	{ DEV_STATE_STOPWAIT,   DEV_EVENT_CONDOWN, dev_action_conndown },
1141 
1142 	{ DEV_STATE_STARTWAIT,  DEV_EVENT_STOP,    dev_action_stop     },
1143 	{ DEV_STATE_STARTWAIT,  DEV_EVENT_CONUP,   dev_action_connup   },
1144 
1145 	{ DEV_STATE_RUNNING,    DEV_EVENT_STOP,    dev_action_stop     },
1146 	{ DEV_STATE_RUNNING,    DEV_EVENT_CONDOWN, dev_action_conndown },
1147 	{ DEV_STATE_RUNNING,    DEV_EVENT_CONUP,   netiucv_action_nop  },
1148 };
1149 
1150 static const int DEV_FSM_LEN = sizeof(dev_fsm) / sizeof(fsm_node);
1151 
1152 /**
1153  * Transmit a packet.
1154  * This is a helper function for netiucv_tx().
1155  *
1156  * @param conn Connection to be used for sending.
1157  * @param skb Pointer to struct sk_buff of packet to send.
1158  *            The linklevel header has already been set up
1159  *            by netiucv_tx().
1160  *
1161  * @return 0 on success, -ERRNO on failure. (Never fails.)
1162  */
1163 static int netiucv_transmit_skb(struct iucv_connection *conn,
1164 				struct sk_buff *skb)
1165 {
1166 	struct iucv_message msg;
1167 	unsigned long saveflags;
1168 	struct ll_header header;
1169 	int rc;
1170 
1171 	if (fsm_getstate(conn->fsm) != CONN_STATE_IDLE) {
1172 		int l = skb->len + NETIUCV_HDRLEN;
1173 
1174 		spin_lock_irqsave(&conn->collect_lock, saveflags);
1175 		if (conn->collect_len + l >
1176 		    (conn->max_buffsize - NETIUCV_HDRLEN)) {
1177 			rc = -EBUSY;
1178 			IUCV_DBF_TEXT(data, 2,
1179 				      "EBUSY from netiucv_transmit_skb\n");
1180 		} else {
1181 			atomic_inc(&skb->users);
1182 			skb_queue_tail(&conn->collect_queue, skb);
1183 			conn->collect_len += l;
1184 			rc = 0;
1185 		}
1186 		spin_unlock_irqrestore(&conn->collect_lock, saveflags);
1187 	} else {
1188 		struct sk_buff *nskb = skb;
1189 		/**
1190 		 * Copy the skb to a new allocated skb in lowmem only if the
1191 		 * data is located above 2G in memory or tailroom is < 2.
1192 		 */
1193 		unsigned long hi = ((unsigned long)(skb_tail_pointer(skb) +
1194 				    NETIUCV_HDRLEN)) >> 31;
1195 		int copied = 0;
1196 		if (hi || (skb_tailroom(skb) < 2)) {
1197 			nskb = alloc_skb(skb->len + NETIUCV_HDRLEN +
1198 					 NETIUCV_HDRLEN, GFP_ATOMIC | GFP_DMA);
1199 			if (!nskb) {
1200 				IUCV_DBF_TEXT(data, 2, "alloc_skb failed\n");
1201 				rc = -ENOMEM;
1202 				return rc;
1203 			} else {
1204 				skb_reserve(nskb, NETIUCV_HDRLEN);
1205 				memcpy(skb_put(nskb, skb->len),
1206 				       skb->data, skb->len);
1207 			}
1208 			copied = 1;
1209 		}
1210 		/**
1211 		 * skb now is below 2G and has enough room. Add headers.
1212 		 */
1213 		header.next = nskb->len + NETIUCV_HDRLEN;
1214 		memcpy(skb_push(nskb, NETIUCV_HDRLEN), &header, NETIUCV_HDRLEN);
1215 		header.next = 0;
1216 		memcpy(skb_put(nskb, NETIUCV_HDRLEN), &header,  NETIUCV_HDRLEN);
1217 
1218 		fsm_newstate(conn->fsm, CONN_STATE_TX);
1219 		conn->prof.send_stamp = current_kernel_time();
1220 
1221 		msg.tag = 1;
1222 		msg.class = 0;
1223 		rc = iucv_message_send(conn->path, &msg, 0, 0,
1224 				       nskb->data, nskb->len);
1225 		conn->prof.doios_single++;
1226 		conn->prof.txlen += skb->len;
1227 		conn->prof.tx_pending++;
1228 		if (conn->prof.tx_pending > conn->prof.tx_max_pending)
1229 			conn->prof.tx_max_pending = conn->prof.tx_pending;
1230 		if (rc) {
1231 			struct netiucv_priv *privptr;
1232 			fsm_newstate(conn->fsm, CONN_STATE_IDLE);
1233 			conn->prof.tx_pending--;
1234 			privptr = netdev_priv(conn->netdev);
1235 			if (privptr)
1236 				privptr->stats.tx_errors++;
1237 			if (copied)
1238 				dev_kfree_skb(nskb);
1239 			else {
1240 				/**
1241 				 * Remove our headers. They get added
1242 				 * again on retransmit.
1243 				 */
1244 				skb_pull(skb, NETIUCV_HDRLEN);
1245 				skb_trim(skb, skb->len - NETIUCV_HDRLEN);
1246 			}
1247 			IUCV_DBF_TEXT_(data, 2, "rc %d from iucv_send\n", rc);
1248 		} else {
1249 			if (copied)
1250 				dev_kfree_skb(skb);
1251 			atomic_inc(&nskb->users);
1252 			skb_queue_tail(&conn->commit_queue, nskb);
1253 		}
1254 	}
1255 
1256 	return rc;
1257 }
1258 
1259 /*
1260  * Interface API for upper network layers
1261  */
1262 
1263 /**
1264  * Open an interface.
1265  * Called from generic network layer when ifconfig up is run.
1266  *
1267  * @param dev Pointer to interface struct.
1268  *
1269  * @return 0 on success, -ERRNO on failure. (Never fails.)
1270  */
1271 static int netiucv_open(struct net_device *dev)
1272 {
1273 	struct netiucv_priv *priv = netdev_priv(dev);
1274 
1275 	fsm_event(priv->fsm, DEV_EVENT_START, dev);
1276 	return 0;
1277 }
1278 
1279 /**
1280  * Close an interface.
1281  * Called from generic network layer when ifconfig down is run.
1282  *
1283  * @param dev Pointer to interface struct.
1284  *
1285  * @return 0 on success, -ERRNO on failure. (Never fails.)
1286  */
1287 static int netiucv_close(struct net_device *dev)
1288 {
1289 	struct netiucv_priv *priv = netdev_priv(dev);
1290 
1291 	fsm_event(priv->fsm, DEV_EVENT_STOP, dev);
1292 	return 0;
1293 }
1294 
1295 static int netiucv_pm_prepare(struct device *dev)
1296 {
1297 	IUCV_DBF_TEXT(trace, 3, __func__);
1298 	return 0;
1299 }
1300 
1301 static void netiucv_pm_complete(struct device *dev)
1302 {
1303 	IUCV_DBF_TEXT(trace, 3, __func__);
1304 	return;
1305 }
1306 
1307 /**
1308  * netiucv_pm_freeze() - Freeze PM callback
1309  * @dev:	netiucv device
1310  *
1311  * close open netiucv interfaces
1312  */
1313 static int netiucv_pm_freeze(struct device *dev)
1314 {
1315 	struct netiucv_priv *priv = dev_get_drvdata(dev);
1316 	struct net_device *ndev = NULL;
1317 	int rc = 0;
1318 
1319 	IUCV_DBF_TEXT(trace, 3, __func__);
1320 	if (priv && priv->conn)
1321 		ndev = priv->conn->netdev;
1322 	if (!ndev)
1323 		goto out;
1324 	netif_device_detach(ndev);
1325 	priv->pm_state = fsm_getstate(priv->fsm);
1326 	rc = netiucv_close(ndev);
1327 out:
1328 	return rc;
1329 }
1330 
1331 /**
1332  * netiucv_pm_restore_thaw() - Thaw and restore PM callback
1333  * @dev:	netiucv device
1334  *
1335  * re-open netiucv interfaces closed during freeze
1336  */
1337 static int netiucv_pm_restore_thaw(struct device *dev)
1338 {
1339 	struct netiucv_priv *priv = dev_get_drvdata(dev);
1340 	struct net_device *ndev = NULL;
1341 	int rc = 0;
1342 
1343 	IUCV_DBF_TEXT(trace, 3, __func__);
1344 	if (priv && priv->conn)
1345 		ndev = priv->conn->netdev;
1346 	if (!ndev)
1347 		goto out;
1348 	switch (priv->pm_state) {
1349 	case DEV_STATE_RUNNING:
1350 	case DEV_STATE_STARTWAIT:
1351 		rc = netiucv_open(ndev);
1352 		break;
1353 	default:
1354 		break;
1355 	}
1356 	netif_device_attach(ndev);
1357 out:
1358 	return rc;
1359 }
1360 
1361 /**
1362  * Start transmission of a packet.
1363  * Called from generic network device layer.
1364  *
1365  * @param skb Pointer to buffer containing the packet.
1366  * @param dev Pointer to interface struct.
1367  *
1368  * @return 0 if packet consumed, !0 if packet rejected.
1369  *         Note: If we return !0, then the packet is free'd by
1370  *               the generic network layer.
1371  */
1372 static int netiucv_tx(struct sk_buff *skb, struct net_device *dev)
1373 {
1374 	struct netiucv_priv *privptr = netdev_priv(dev);
1375 	int rc;
1376 
1377 	IUCV_DBF_TEXT(trace, 4, __func__);
1378 	/**
1379 	 * Some sanity checks ...
1380 	 */
1381 	if (skb == NULL) {
1382 		IUCV_DBF_TEXT(data, 2, "netiucv_tx: skb is NULL\n");
1383 		privptr->stats.tx_dropped++;
1384 		return NETDEV_TX_OK;
1385 	}
1386 	if (skb_headroom(skb) < NETIUCV_HDRLEN) {
1387 		IUCV_DBF_TEXT(data, 2,
1388 			"netiucv_tx: skb_headroom < NETIUCV_HDRLEN\n");
1389 		dev_kfree_skb(skb);
1390 		privptr->stats.tx_dropped++;
1391 		return NETDEV_TX_OK;
1392 	}
1393 
1394 	/**
1395 	 * If connection is not running, try to restart it
1396 	 * and throw away packet.
1397 	 */
1398 	if (fsm_getstate(privptr->fsm) != DEV_STATE_RUNNING) {
1399 		dev_kfree_skb(skb);
1400 		privptr->stats.tx_dropped++;
1401 		privptr->stats.tx_errors++;
1402 		privptr->stats.tx_carrier_errors++;
1403 		return NETDEV_TX_OK;
1404 	}
1405 
1406 	if (netiucv_test_and_set_busy(dev)) {
1407 		IUCV_DBF_TEXT(data, 2, "EBUSY from netiucv_tx\n");
1408 		return NETDEV_TX_BUSY;
1409 	}
1410 	dev->trans_start = jiffies;
1411 	rc = netiucv_transmit_skb(privptr->conn, skb);
1412 	netiucv_clear_busy(dev);
1413 	return rc ? NETDEV_TX_BUSY : NETDEV_TX_OK;
1414 }
1415 
1416 /**
1417  * netiucv_stats
1418  * @dev: Pointer to interface struct.
1419  *
1420  * Returns interface statistics of a device.
1421  *
1422  * Returns pointer to stats struct of this interface.
1423  */
1424 static struct net_device_stats *netiucv_stats (struct net_device * dev)
1425 {
1426 	struct netiucv_priv *priv = netdev_priv(dev);
1427 
1428 	IUCV_DBF_TEXT(trace, 5, __func__);
1429 	return &priv->stats;
1430 }
1431 
1432 /**
1433  * netiucv_change_mtu
1434  * @dev: Pointer to interface struct.
1435  * @new_mtu: The new MTU to use for this interface.
1436  *
1437  * Sets MTU of an interface.
1438  *
1439  * Returns 0 on success, -EINVAL if MTU is out of valid range.
1440  *         (valid range is 576 .. NETIUCV_MTU_MAX).
1441  */
1442 static int netiucv_change_mtu(struct net_device * dev, int new_mtu)
1443 {
1444 	IUCV_DBF_TEXT(trace, 3, __func__);
1445 	if (new_mtu < 576 || new_mtu > NETIUCV_MTU_MAX) {
1446 		IUCV_DBF_TEXT(setup, 2, "given MTU out of valid range\n");
1447 		return -EINVAL;
1448 	}
1449 	dev->mtu = new_mtu;
1450 	return 0;
1451 }
1452 
1453 /*
1454  * attributes in sysfs
1455  */
1456 
1457 static ssize_t user_show(struct device *dev, struct device_attribute *attr,
1458 			 char *buf)
1459 {
1460 	struct netiucv_priv *priv = dev_get_drvdata(dev);
1461 
1462 	IUCV_DBF_TEXT(trace, 5, __func__);
1463 	return sprintf(buf, "%s\n", netiucv_printuser(priv->conn));
1464 }
1465 
1466 static int netiucv_check_user(const char *buf, size_t count, char *username,
1467 			      char *userdata)
1468 {
1469 	const char *p;
1470 	int i;
1471 
1472 	p = strchr(buf, '.');
1473 	if ((p && ((count > 26) ||
1474 		   ((p - buf) > 8) ||
1475 		   (buf + count - p > 18))) ||
1476 	    (!p && (count > 9))) {
1477 		IUCV_DBF_TEXT(setup, 2, "conn_write: too long\n");
1478 		return -EINVAL;
1479 	}
1480 
1481 	for (i = 0, p = buf; i < 8 && *p && *p != '.'; i++, p++) {
1482 		if (isalnum(*p) || *p == '$') {
1483 			username[i] = toupper(*p);
1484 			continue;
1485 		}
1486 		if (*p == '\n')
1487 			/* trailing lf, grr */
1488 			break;
1489 		IUCV_DBF_TEXT_(setup, 2,
1490 			       "conn_write: invalid character %02x\n", *p);
1491 		return -EINVAL;
1492 	}
1493 	while (i < 8)
1494 		username[i++] = ' ';
1495 	username[8] = '\0';
1496 
1497 	if (*p == '.') {
1498 		p++;
1499 		for (i = 0; i < 16 && *p; i++, p++) {
1500 			if (*p == '\n')
1501 				break;
1502 			userdata[i] = toupper(*p);
1503 		}
1504 		while (i > 0 && i < 16)
1505 			userdata[i++] = ' ';
1506 	} else
1507 		memcpy(userdata, iucvMagic_ascii, 16);
1508 	userdata[16] = '\0';
1509 	ASCEBC(userdata, 16);
1510 
1511 	return 0;
1512 }
1513 
1514 static ssize_t user_write(struct device *dev, struct device_attribute *attr,
1515 			  const char *buf, size_t count)
1516 {
1517 	struct netiucv_priv *priv = dev_get_drvdata(dev);
1518 	struct net_device *ndev = priv->conn->netdev;
1519 	char	username[9];
1520 	char	userdata[17];
1521 	int	rc;
1522 	struct iucv_connection *cp;
1523 
1524 	IUCV_DBF_TEXT(trace, 3, __func__);
1525 	rc = netiucv_check_user(buf, count, username, userdata);
1526 	if (rc)
1527 		return rc;
1528 
1529 	if (memcmp(username, priv->conn->userid, 9) &&
1530 	    (ndev->flags & (IFF_UP | IFF_RUNNING))) {
1531 		/* username changed while the interface is active. */
1532 		IUCV_DBF_TEXT(setup, 2, "user_write: device active\n");
1533 		return -EPERM;
1534 	}
1535 	read_lock_bh(&iucv_connection_rwlock);
1536 	list_for_each_entry(cp, &iucv_connection_list, list) {
1537 		if (!strncmp(username, cp->userid, 9) &&
1538 		   !strncmp(userdata, cp->userdata, 17) && cp->netdev != ndev) {
1539 			read_unlock_bh(&iucv_connection_rwlock);
1540 			IUCV_DBF_TEXT_(setup, 2, "user_write: Connection to %s "
1541 				"already exists\n", netiucv_printuser(cp));
1542 			return -EEXIST;
1543 		}
1544 	}
1545 	read_unlock_bh(&iucv_connection_rwlock);
1546 	memcpy(priv->conn->userid, username, 9);
1547 	memcpy(priv->conn->userdata, userdata, 17);
1548 	return count;
1549 }
1550 
1551 static DEVICE_ATTR(user, 0644, user_show, user_write);
1552 
1553 static ssize_t buffer_show (struct device *dev, struct device_attribute *attr,
1554 			    char *buf)
1555 {
1556 	struct netiucv_priv *priv = dev_get_drvdata(dev);
1557 
1558 	IUCV_DBF_TEXT(trace, 5, __func__);
1559 	return sprintf(buf, "%d\n", priv->conn->max_buffsize);
1560 }
1561 
1562 static ssize_t buffer_write (struct device *dev, struct device_attribute *attr,
1563 			     const char *buf, size_t count)
1564 {
1565 	struct netiucv_priv *priv = dev_get_drvdata(dev);
1566 	struct net_device *ndev = priv->conn->netdev;
1567 	char         *e;
1568 	int          bs1;
1569 
1570 	IUCV_DBF_TEXT(trace, 3, __func__);
1571 	if (count >= 39)
1572 		return -EINVAL;
1573 
1574 	bs1 = simple_strtoul(buf, &e, 0);
1575 
1576 	if (e && (!isspace(*e))) {
1577 		IUCV_DBF_TEXT_(setup, 2, "buffer_write: invalid char %02x\n",
1578 			*e);
1579 		return -EINVAL;
1580 	}
1581 	if (bs1 > NETIUCV_BUFSIZE_MAX) {
1582 		IUCV_DBF_TEXT_(setup, 2,
1583 			"buffer_write: buffer size %d too large\n",
1584 			bs1);
1585 		return -EINVAL;
1586 	}
1587 	if ((ndev->flags & IFF_RUNNING) &&
1588 	    (bs1 < (ndev->mtu + NETIUCV_HDRLEN + 2))) {
1589 		IUCV_DBF_TEXT_(setup, 2,
1590 			"buffer_write: buffer size %d too small\n",
1591 			bs1);
1592 		return -EINVAL;
1593 	}
1594 	if (bs1 < (576 + NETIUCV_HDRLEN + NETIUCV_HDRLEN)) {
1595 		IUCV_DBF_TEXT_(setup, 2,
1596 			"buffer_write: buffer size %d too small\n",
1597 			bs1);
1598 		return -EINVAL;
1599 	}
1600 
1601 	priv->conn->max_buffsize = bs1;
1602 	if (!(ndev->flags & IFF_RUNNING))
1603 		ndev->mtu = bs1 - NETIUCV_HDRLEN - NETIUCV_HDRLEN;
1604 
1605 	return count;
1606 
1607 }
1608 
1609 static DEVICE_ATTR(buffer, 0644, buffer_show, buffer_write);
1610 
1611 static ssize_t dev_fsm_show (struct device *dev, struct device_attribute *attr,
1612 			     char *buf)
1613 {
1614 	struct netiucv_priv *priv = dev_get_drvdata(dev);
1615 
1616 	IUCV_DBF_TEXT(trace, 5, __func__);
1617 	return sprintf(buf, "%s\n", fsm_getstate_str(priv->fsm));
1618 }
1619 
1620 static DEVICE_ATTR(device_fsm_state, 0444, dev_fsm_show, NULL);
1621 
1622 static ssize_t conn_fsm_show (struct device *dev,
1623 			      struct device_attribute *attr, char *buf)
1624 {
1625 	struct netiucv_priv *priv = dev_get_drvdata(dev);
1626 
1627 	IUCV_DBF_TEXT(trace, 5, __func__);
1628 	return sprintf(buf, "%s\n", fsm_getstate_str(priv->conn->fsm));
1629 }
1630 
1631 static DEVICE_ATTR(connection_fsm_state, 0444, conn_fsm_show, NULL);
1632 
1633 static ssize_t maxmulti_show (struct device *dev,
1634 			      struct device_attribute *attr, char *buf)
1635 {
1636 	struct netiucv_priv *priv = dev_get_drvdata(dev);
1637 
1638 	IUCV_DBF_TEXT(trace, 5, __func__);
1639 	return sprintf(buf, "%ld\n", priv->conn->prof.maxmulti);
1640 }
1641 
1642 static ssize_t maxmulti_write (struct device *dev,
1643 			       struct device_attribute *attr,
1644 			       const char *buf, size_t count)
1645 {
1646 	struct netiucv_priv *priv = dev_get_drvdata(dev);
1647 
1648 	IUCV_DBF_TEXT(trace, 4, __func__);
1649 	priv->conn->prof.maxmulti = 0;
1650 	return count;
1651 }
1652 
1653 static DEVICE_ATTR(max_tx_buffer_used, 0644, maxmulti_show, maxmulti_write);
1654 
1655 static ssize_t maxcq_show (struct device *dev, struct device_attribute *attr,
1656 			   char *buf)
1657 {
1658 	struct netiucv_priv *priv = dev_get_drvdata(dev);
1659 
1660 	IUCV_DBF_TEXT(trace, 5, __func__);
1661 	return sprintf(buf, "%ld\n", priv->conn->prof.maxcqueue);
1662 }
1663 
1664 static ssize_t maxcq_write (struct device *dev, struct device_attribute *attr,
1665 			    const char *buf, size_t count)
1666 {
1667 	struct netiucv_priv *priv = dev_get_drvdata(dev);
1668 
1669 	IUCV_DBF_TEXT(trace, 4, __func__);
1670 	priv->conn->prof.maxcqueue = 0;
1671 	return count;
1672 }
1673 
1674 static DEVICE_ATTR(max_chained_skbs, 0644, maxcq_show, maxcq_write);
1675 
1676 static ssize_t sdoio_show (struct device *dev, struct device_attribute *attr,
1677 			   char *buf)
1678 {
1679 	struct netiucv_priv *priv = dev_get_drvdata(dev);
1680 
1681 	IUCV_DBF_TEXT(trace, 5, __func__);
1682 	return sprintf(buf, "%ld\n", priv->conn->prof.doios_single);
1683 }
1684 
1685 static ssize_t sdoio_write (struct device *dev, struct device_attribute *attr,
1686 			    const char *buf, size_t count)
1687 {
1688 	struct netiucv_priv *priv = dev_get_drvdata(dev);
1689 
1690 	IUCV_DBF_TEXT(trace, 4, __func__);
1691 	priv->conn->prof.doios_single = 0;
1692 	return count;
1693 }
1694 
1695 static DEVICE_ATTR(tx_single_write_ops, 0644, sdoio_show, sdoio_write);
1696 
1697 static ssize_t mdoio_show (struct device *dev, struct device_attribute *attr,
1698 			   char *buf)
1699 {
1700 	struct netiucv_priv *priv = dev_get_drvdata(dev);
1701 
1702 	IUCV_DBF_TEXT(trace, 5, __func__);
1703 	return sprintf(buf, "%ld\n", priv->conn->prof.doios_multi);
1704 }
1705 
1706 static ssize_t mdoio_write (struct device *dev, struct device_attribute *attr,
1707 			    const char *buf, size_t count)
1708 {
1709 	struct netiucv_priv *priv = dev_get_drvdata(dev);
1710 
1711 	IUCV_DBF_TEXT(trace, 5, __func__);
1712 	priv->conn->prof.doios_multi = 0;
1713 	return count;
1714 }
1715 
1716 static DEVICE_ATTR(tx_multi_write_ops, 0644, mdoio_show, mdoio_write);
1717 
1718 static ssize_t txlen_show (struct device *dev, struct device_attribute *attr,
1719 			   char *buf)
1720 {
1721 	struct netiucv_priv *priv = dev_get_drvdata(dev);
1722 
1723 	IUCV_DBF_TEXT(trace, 5, __func__);
1724 	return sprintf(buf, "%ld\n", priv->conn->prof.txlen);
1725 }
1726 
1727 static ssize_t txlen_write (struct device *dev, struct device_attribute *attr,
1728 			    const char *buf, size_t count)
1729 {
1730 	struct netiucv_priv *priv = dev_get_drvdata(dev);
1731 
1732 	IUCV_DBF_TEXT(trace, 4, __func__);
1733 	priv->conn->prof.txlen = 0;
1734 	return count;
1735 }
1736 
1737 static DEVICE_ATTR(netto_bytes, 0644, txlen_show, txlen_write);
1738 
1739 static ssize_t txtime_show (struct device *dev, struct device_attribute *attr,
1740 			    char *buf)
1741 {
1742 	struct netiucv_priv *priv = dev_get_drvdata(dev);
1743 
1744 	IUCV_DBF_TEXT(trace, 5, __func__);
1745 	return sprintf(buf, "%ld\n", priv->conn->prof.tx_time);
1746 }
1747 
1748 static ssize_t txtime_write (struct device *dev, struct device_attribute *attr,
1749 			     const char *buf, size_t count)
1750 {
1751 	struct netiucv_priv *priv = dev_get_drvdata(dev);
1752 
1753 	IUCV_DBF_TEXT(trace, 4, __func__);
1754 	priv->conn->prof.tx_time = 0;
1755 	return count;
1756 }
1757 
1758 static DEVICE_ATTR(max_tx_io_time, 0644, txtime_show, txtime_write);
1759 
1760 static ssize_t txpend_show (struct device *dev, struct device_attribute *attr,
1761 			    char *buf)
1762 {
1763 	struct netiucv_priv *priv = dev_get_drvdata(dev);
1764 
1765 	IUCV_DBF_TEXT(trace, 5, __func__);
1766 	return sprintf(buf, "%ld\n", priv->conn->prof.tx_pending);
1767 }
1768 
1769 static ssize_t txpend_write (struct device *dev, struct device_attribute *attr,
1770 			     const char *buf, size_t count)
1771 {
1772 	struct netiucv_priv *priv = dev_get_drvdata(dev);
1773 
1774 	IUCV_DBF_TEXT(trace, 4, __func__);
1775 	priv->conn->prof.tx_pending = 0;
1776 	return count;
1777 }
1778 
1779 static DEVICE_ATTR(tx_pending, 0644, txpend_show, txpend_write);
1780 
1781 static ssize_t txmpnd_show (struct device *dev, struct device_attribute *attr,
1782 			    char *buf)
1783 {
1784 	struct netiucv_priv *priv = dev_get_drvdata(dev);
1785 
1786 	IUCV_DBF_TEXT(trace, 5, __func__);
1787 	return sprintf(buf, "%ld\n", priv->conn->prof.tx_max_pending);
1788 }
1789 
1790 static ssize_t txmpnd_write (struct device *dev, struct device_attribute *attr,
1791 			     const char *buf, size_t count)
1792 {
1793 	struct netiucv_priv *priv = dev_get_drvdata(dev);
1794 
1795 	IUCV_DBF_TEXT(trace, 4, __func__);
1796 	priv->conn->prof.tx_max_pending = 0;
1797 	return count;
1798 }
1799 
1800 static DEVICE_ATTR(tx_max_pending, 0644, txmpnd_show, txmpnd_write);
1801 
1802 static struct attribute *netiucv_attrs[] = {
1803 	&dev_attr_buffer.attr,
1804 	&dev_attr_user.attr,
1805 	NULL,
1806 };
1807 
1808 static struct attribute_group netiucv_attr_group = {
1809 	.attrs = netiucv_attrs,
1810 };
1811 
1812 static struct attribute *netiucv_stat_attrs[] = {
1813 	&dev_attr_device_fsm_state.attr,
1814 	&dev_attr_connection_fsm_state.attr,
1815 	&dev_attr_max_tx_buffer_used.attr,
1816 	&dev_attr_max_chained_skbs.attr,
1817 	&dev_attr_tx_single_write_ops.attr,
1818 	&dev_attr_tx_multi_write_ops.attr,
1819 	&dev_attr_netto_bytes.attr,
1820 	&dev_attr_max_tx_io_time.attr,
1821 	&dev_attr_tx_pending.attr,
1822 	&dev_attr_tx_max_pending.attr,
1823 	NULL,
1824 };
1825 
1826 static struct attribute_group netiucv_stat_attr_group = {
1827 	.name  = "stats",
1828 	.attrs = netiucv_stat_attrs,
1829 };
1830 
1831 static const struct attribute_group *netiucv_attr_groups[] = {
1832 	&netiucv_stat_attr_group,
1833 	&netiucv_attr_group,
1834 	NULL,
1835 };
1836 
1837 static int netiucv_register_device(struct net_device *ndev)
1838 {
1839 	struct netiucv_priv *priv = netdev_priv(ndev);
1840 	struct device *dev = kzalloc(sizeof(struct device), GFP_KERNEL);
1841 	int ret;
1842 
1843 	IUCV_DBF_TEXT(trace, 3, __func__);
1844 
1845 	if (dev) {
1846 		dev_set_name(dev, "net%s", ndev->name);
1847 		dev->bus = &iucv_bus;
1848 		dev->parent = iucv_root;
1849 		dev->groups = netiucv_attr_groups;
1850 		/*
1851 		 * The release function could be called after the
1852 		 * module has been unloaded. It's _only_ task is to
1853 		 * free the struct. Therefore, we specify kfree()
1854 		 * directly here. (Probably a little bit obfuscating
1855 		 * but legitime ...).
1856 		 */
1857 		dev->release = (void (*)(struct device *))kfree;
1858 		dev->driver = &netiucv_driver;
1859 	} else
1860 		return -ENOMEM;
1861 
1862 	ret = device_register(dev);
1863 	if (ret) {
1864 		put_device(dev);
1865 		return ret;
1866 	}
1867 	priv->dev = dev;
1868 	dev_set_drvdata(dev, priv);
1869 	return 0;
1870 }
1871 
1872 static void netiucv_unregister_device(struct device *dev)
1873 {
1874 	IUCV_DBF_TEXT(trace, 3, __func__);
1875 	device_unregister(dev);
1876 }
1877 
1878 /**
1879  * Allocate and initialize a new connection structure.
1880  * Add it to the list of netiucv connections;
1881  */
1882 static struct iucv_connection *netiucv_new_connection(struct net_device *dev,
1883 						      char *username,
1884 						      char *userdata)
1885 {
1886 	struct iucv_connection *conn;
1887 
1888 	conn = kzalloc(sizeof(*conn), GFP_KERNEL);
1889 	if (!conn)
1890 		goto out;
1891 	skb_queue_head_init(&conn->collect_queue);
1892 	skb_queue_head_init(&conn->commit_queue);
1893 	spin_lock_init(&conn->collect_lock);
1894 	conn->max_buffsize = NETIUCV_BUFSIZE_DEFAULT;
1895 	conn->netdev = dev;
1896 
1897 	conn->rx_buff = alloc_skb(conn->max_buffsize, GFP_KERNEL | GFP_DMA);
1898 	if (!conn->rx_buff)
1899 		goto out_conn;
1900 	conn->tx_buff = alloc_skb(conn->max_buffsize, GFP_KERNEL | GFP_DMA);
1901 	if (!conn->tx_buff)
1902 		goto out_rx;
1903 	conn->fsm = init_fsm("netiucvconn", conn_state_names,
1904 			     conn_event_names, NR_CONN_STATES,
1905 			     NR_CONN_EVENTS, conn_fsm, CONN_FSM_LEN,
1906 			     GFP_KERNEL);
1907 	if (!conn->fsm)
1908 		goto out_tx;
1909 
1910 	fsm_settimer(conn->fsm, &conn->timer);
1911 	fsm_newstate(conn->fsm, CONN_STATE_INVALID);
1912 
1913 	if (userdata)
1914 		memcpy(conn->userdata, userdata, 17);
1915 	if (username) {
1916 		memcpy(conn->userid, username, 9);
1917 		fsm_newstate(conn->fsm, CONN_STATE_STOPPED);
1918 	}
1919 
1920 	write_lock_bh(&iucv_connection_rwlock);
1921 	list_add_tail(&conn->list, &iucv_connection_list);
1922 	write_unlock_bh(&iucv_connection_rwlock);
1923 	return conn;
1924 
1925 out_tx:
1926 	kfree_skb(conn->tx_buff);
1927 out_rx:
1928 	kfree_skb(conn->rx_buff);
1929 out_conn:
1930 	kfree(conn);
1931 out:
1932 	return NULL;
1933 }
1934 
1935 /**
1936  * Release a connection structure and remove it from the
1937  * list of netiucv connections.
1938  */
1939 static void netiucv_remove_connection(struct iucv_connection *conn)
1940 {
1941 
1942 	IUCV_DBF_TEXT(trace, 3, __func__);
1943 	write_lock_bh(&iucv_connection_rwlock);
1944 	list_del_init(&conn->list);
1945 	write_unlock_bh(&iucv_connection_rwlock);
1946 	fsm_deltimer(&conn->timer);
1947 	netiucv_purge_skb_queue(&conn->collect_queue);
1948 	if (conn->path) {
1949 		iucv_path_sever(conn->path, conn->userdata);
1950 		kfree(conn->path);
1951 		conn->path = NULL;
1952 	}
1953 	netiucv_purge_skb_queue(&conn->commit_queue);
1954 	kfree_fsm(conn->fsm);
1955 	kfree_skb(conn->rx_buff);
1956 	kfree_skb(conn->tx_buff);
1957 }
1958 
1959 /**
1960  * Release everything of a net device.
1961  */
1962 static void netiucv_free_netdevice(struct net_device *dev)
1963 {
1964 	struct netiucv_priv *privptr = netdev_priv(dev);
1965 
1966 	IUCV_DBF_TEXT(trace, 3, __func__);
1967 
1968 	if (!dev)
1969 		return;
1970 
1971 	if (privptr) {
1972 		if (privptr->conn)
1973 			netiucv_remove_connection(privptr->conn);
1974 		if (privptr->fsm)
1975 			kfree_fsm(privptr->fsm);
1976 		privptr->conn = NULL; privptr->fsm = NULL;
1977 		/* privptr gets freed by free_netdev() */
1978 	}
1979 	free_netdev(dev);
1980 }
1981 
1982 /**
1983  * Initialize a net device. (Called from kernel in alloc_netdev())
1984  */
1985 static const struct net_device_ops netiucv_netdev_ops = {
1986 	.ndo_open		= netiucv_open,
1987 	.ndo_stop		= netiucv_close,
1988 	.ndo_get_stats		= netiucv_stats,
1989 	.ndo_start_xmit		= netiucv_tx,
1990 	.ndo_change_mtu	   	= netiucv_change_mtu,
1991 };
1992 
1993 static void netiucv_setup_netdevice(struct net_device *dev)
1994 {
1995 	dev->mtu	         = NETIUCV_MTU_DEFAULT;
1996 	dev->destructor          = netiucv_free_netdevice;
1997 	dev->hard_header_len     = NETIUCV_HDRLEN;
1998 	dev->addr_len            = 0;
1999 	dev->type                = ARPHRD_SLIP;
2000 	dev->tx_queue_len        = NETIUCV_QUEUELEN_DEFAULT;
2001 	dev->flags	         = IFF_POINTOPOINT | IFF_NOARP;
2002 	dev->netdev_ops		 = &netiucv_netdev_ops;
2003 }
2004 
2005 /**
2006  * Allocate and initialize everything of a net device.
2007  */
2008 static struct net_device *netiucv_init_netdevice(char *username, char *userdata)
2009 {
2010 	struct netiucv_priv *privptr;
2011 	struct net_device *dev;
2012 
2013 	dev = alloc_netdev(sizeof(struct netiucv_priv), "iucv%d",
2014 			   netiucv_setup_netdevice);
2015 	if (!dev)
2016 		return NULL;
2017 	rtnl_lock();
2018 	if (dev_alloc_name(dev, dev->name) < 0)
2019 		goto out_netdev;
2020 
2021 	privptr = netdev_priv(dev);
2022 	privptr->fsm = init_fsm("netiucvdev", dev_state_names,
2023 				dev_event_names, NR_DEV_STATES, NR_DEV_EVENTS,
2024 				dev_fsm, DEV_FSM_LEN, GFP_KERNEL);
2025 	if (!privptr->fsm)
2026 		goto out_netdev;
2027 
2028 	privptr->conn = netiucv_new_connection(dev, username, userdata);
2029 	if (!privptr->conn) {
2030 		IUCV_DBF_TEXT(setup, 2, "NULL from netiucv_new_connection\n");
2031 		goto out_fsm;
2032 	}
2033 	fsm_newstate(privptr->fsm, DEV_STATE_STOPPED);
2034 	return dev;
2035 
2036 out_fsm:
2037 	kfree_fsm(privptr->fsm);
2038 out_netdev:
2039 	rtnl_unlock();
2040 	free_netdev(dev);
2041 	return NULL;
2042 }
2043 
2044 static ssize_t conn_write(struct device_driver *drv,
2045 			  const char *buf, size_t count)
2046 {
2047 	char username[9];
2048 	char userdata[17];
2049 	int rc;
2050 	struct net_device *dev;
2051 	struct netiucv_priv *priv;
2052 	struct iucv_connection *cp;
2053 
2054 	IUCV_DBF_TEXT(trace, 3, __func__);
2055 	rc = netiucv_check_user(buf, count, username, userdata);
2056 	if (rc)
2057 		return rc;
2058 
2059 	read_lock_bh(&iucv_connection_rwlock);
2060 	list_for_each_entry(cp, &iucv_connection_list, list) {
2061 		if (!strncmp(username, cp->userid, 9) &&
2062 		    !strncmp(userdata, cp->userdata, 17)) {
2063 			read_unlock_bh(&iucv_connection_rwlock);
2064 			IUCV_DBF_TEXT_(setup, 2, "conn_write: Connection to %s "
2065 				"already exists\n", netiucv_printuser(cp));
2066 			return -EEXIST;
2067 		}
2068 	}
2069 	read_unlock_bh(&iucv_connection_rwlock);
2070 
2071 	dev = netiucv_init_netdevice(username, userdata);
2072 	if (!dev) {
2073 		IUCV_DBF_TEXT(setup, 2, "NULL from netiucv_init_netdevice\n");
2074 		return -ENODEV;
2075 	}
2076 
2077 	rc = netiucv_register_device(dev);
2078 	if (rc) {
2079 		rtnl_unlock();
2080 		IUCV_DBF_TEXT_(setup, 2,
2081 			"ret %d from netiucv_register_device\n", rc);
2082 		goto out_free_ndev;
2083 	}
2084 
2085 	/* sysfs magic */
2086 	priv = netdev_priv(dev);
2087 	SET_NETDEV_DEV(dev, priv->dev);
2088 
2089 	rc = register_netdevice(dev);
2090 	rtnl_unlock();
2091 	if (rc)
2092 		goto out_unreg;
2093 
2094 	dev_info(priv->dev, "The IUCV interface to %s has been established "
2095 			    "successfully\n",
2096 		netiucv_printuser(priv->conn));
2097 
2098 	return count;
2099 
2100 out_unreg:
2101 	netiucv_unregister_device(priv->dev);
2102 out_free_ndev:
2103 	netiucv_free_netdevice(dev);
2104 	return rc;
2105 }
2106 
2107 static DRIVER_ATTR(connection, 0200, NULL, conn_write);
2108 
2109 static ssize_t remove_write (struct device_driver *drv,
2110 			     const char *buf, size_t count)
2111 {
2112 	struct iucv_connection *cp;
2113         struct net_device *ndev;
2114         struct netiucv_priv *priv;
2115         struct device *dev;
2116         char name[IFNAMSIZ];
2117 	const char *p;
2118         int i;
2119 
2120 	IUCV_DBF_TEXT(trace, 3, __func__);
2121 
2122         if (count >= IFNAMSIZ)
2123                 count = IFNAMSIZ - 1;
2124 
2125 	for (i = 0, p = buf; i < count && *p; i++, p++) {
2126 		if (*p == '\n' || *p == ' ')
2127                         /* trailing lf, grr */
2128                         break;
2129 		name[i] = *p;
2130         }
2131         name[i] = '\0';
2132 
2133 	read_lock_bh(&iucv_connection_rwlock);
2134 	list_for_each_entry(cp, &iucv_connection_list, list) {
2135 		ndev = cp->netdev;
2136 		priv = netdev_priv(ndev);
2137                 dev = priv->dev;
2138 		if (strncmp(name, ndev->name, count))
2139 			continue;
2140 		read_unlock_bh(&iucv_connection_rwlock);
2141                 if (ndev->flags & (IFF_UP | IFF_RUNNING)) {
2142 			dev_warn(dev, "The IUCV device is connected"
2143 				" to %s and cannot be removed\n",
2144 				priv->conn->userid);
2145 			IUCV_DBF_TEXT(data, 2, "remove_write: still active\n");
2146 			return -EPERM;
2147                 }
2148                 unregister_netdev(ndev);
2149                 netiucv_unregister_device(dev);
2150                 return count;
2151         }
2152 	read_unlock_bh(&iucv_connection_rwlock);
2153 	IUCV_DBF_TEXT(data, 2, "remove_write: unknown device\n");
2154         return -EINVAL;
2155 }
2156 
2157 static DRIVER_ATTR(remove, 0200, NULL, remove_write);
2158 
2159 static struct attribute * netiucv_drv_attrs[] = {
2160 	&driver_attr_connection.attr,
2161 	&driver_attr_remove.attr,
2162 	NULL,
2163 };
2164 
2165 static struct attribute_group netiucv_drv_attr_group = {
2166 	.attrs = netiucv_drv_attrs,
2167 };
2168 
2169 static const struct attribute_group *netiucv_drv_attr_groups[] = {
2170 	&netiucv_drv_attr_group,
2171 	NULL,
2172 };
2173 
2174 static void netiucv_banner(void)
2175 {
2176 	pr_info("driver initialized\n");
2177 }
2178 
2179 static void __exit netiucv_exit(void)
2180 {
2181 	struct iucv_connection *cp;
2182 	struct net_device *ndev;
2183 	struct netiucv_priv *priv;
2184 	struct device *dev;
2185 
2186 	IUCV_DBF_TEXT(trace, 3, __func__);
2187 	while (!list_empty(&iucv_connection_list)) {
2188 		cp = list_entry(iucv_connection_list.next,
2189 				struct iucv_connection, list);
2190 		ndev = cp->netdev;
2191 		priv = netdev_priv(ndev);
2192 		dev = priv->dev;
2193 
2194 		unregister_netdev(ndev);
2195 		netiucv_unregister_device(dev);
2196 	}
2197 
2198 	device_unregister(netiucv_dev);
2199 	driver_unregister(&netiucv_driver);
2200 	iucv_unregister(&netiucv_handler, 1);
2201 	iucv_unregister_dbf_views();
2202 
2203 	pr_info("driver unloaded\n");
2204 	return;
2205 }
2206 
2207 static int __init netiucv_init(void)
2208 {
2209 	int rc;
2210 
2211 	rc = iucv_register_dbf_views();
2212 	if (rc)
2213 		goto out;
2214 	rc = iucv_register(&netiucv_handler, 1);
2215 	if (rc)
2216 		goto out_dbf;
2217 	IUCV_DBF_TEXT(trace, 3, __func__);
2218 	netiucv_driver.groups = netiucv_drv_attr_groups;
2219 	rc = driver_register(&netiucv_driver);
2220 	if (rc) {
2221 		IUCV_DBF_TEXT_(setup, 2, "ret %d from driver_register\n", rc);
2222 		goto out_iucv;
2223 	}
2224 	/* establish dummy device */
2225 	netiucv_dev = kzalloc(sizeof(struct device), GFP_KERNEL);
2226 	if (!netiucv_dev) {
2227 		rc = -ENOMEM;
2228 		goto out_driver;
2229 	}
2230 	dev_set_name(netiucv_dev, "netiucv");
2231 	netiucv_dev->bus = &iucv_bus;
2232 	netiucv_dev->parent = iucv_root;
2233 	netiucv_dev->release = (void (*)(struct device *))kfree;
2234 	netiucv_dev->driver = &netiucv_driver;
2235 	rc = device_register(netiucv_dev);
2236 	if (rc) {
2237 		put_device(netiucv_dev);
2238 		goto out_driver;
2239 	}
2240 	netiucv_banner();
2241 	return rc;
2242 
2243 out_driver:
2244 	driver_unregister(&netiucv_driver);
2245 out_iucv:
2246 	iucv_unregister(&netiucv_handler, 1);
2247 out_dbf:
2248 	iucv_unregister_dbf_views();
2249 out:
2250 	return rc;
2251 }
2252 
2253 module_init(netiucv_init);
2254 module_exit(netiucv_exit);
2255 MODULE_LICENSE("GPL");
2256