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