Merge git://git.kernel.org/pub/scm/linux/kernel/git/davem/ide-2.6
[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_get_drvdata(dev);
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_get_drvdata(dev);
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_get_drvdata(dev);
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_get_drvdata(dev);
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 {
1522 struct netiucv_priv *priv = dev_get_drvdata(dev);
1523
1524 IUCV_DBF_TEXT(trace, 5, __func__);
1525 return sprintf(buf, "%d\n", priv->conn->max_buffsize);
1526 }
1527
1528 static ssize_t buffer_write (struct device *dev, struct device_attribute *attr,
1529 const char *buf, size_t count)
1530 {
1531 struct netiucv_priv *priv = dev_get_drvdata(dev);
1532 struct net_device *ndev = priv->conn->netdev;
1533 char *e;
1534 int bs1;
1535
1536 IUCV_DBF_TEXT(trace, 3, __func__);
1537 if (count >= 39)
1538 return -EINVAL;
1539
1540 bs1 = simple_strtoul(buf, &e, 0);
1541
1542 if (e && (!isspace(*e))) {
1543 IUCV_DBF_TEXT_(setup, 2, "buffer_write: invalid char %c\n", *e);
1544 return -EINVAL;
1545 }
1546 if (bs1 > NETIUCV_BUFSIZE_MAX) {
1547 IUCV_DBF_TEXT_(setup, 2,
1548 "buffer_write: buffer size %d too large\n",
1549 bs1);
1550 return -EINVAL;
1551 }
1552 if ((ndev->flags & IFF_RUNNING) &&
1553 (bs1 < (ndev->mtu + NETIUCV_HDRLEN + 2))) {
1554 IUCV_DBF_TEXT_(setup, 2,
1555 "buffer_write: buffer size %d too small\n",
1556 bs1);
1557 return -EINVAL;
1558 }
1559 if (bs1 < (576 + NETIUCV_HDRLEN + NETIUCV_HDRLEN)) {
1560 IUCV_DBF_TEXT_(setup, 2,
1561 "buffer_write: buffer size %d too small\n",
1562 bs1);
1563 return -EINVAL;
1564 }
1565
1566 priv->conn->max_buffsize = bs1;
1567 if (!(ndev->flags & IFF_RUNNING))
1568 ndev->mtu = bs1 - NETIUCV_HDRLEN - NETIUCV_HDRLEN;
1569
1570 return count;
1571
1572 }
1573
1574 static DEVICE_ATTR(buffer, 0644, buffer_show, buffer_write);
1575
1576 static ssize_t dev_fsm_show (struct device *dev, struct device_attribute *attr,
1577 char *buf)
1578 {
1579 struct netiucv_priv *priv = dev_get_drvdata(dev);
1580
1581 IUCV_DBF_TEXT(trace, 5, __func__);
1582 return sprintf(buf, "%s\n", fsm_getstate_str(priv->fsm));
1583 }
1584
1585 static DEVICE_ATTR(device_fsm_state, 0444, dev_fsm_show, NULL);
1586
1587 static ssize_t conn_fsm_show (struct device *dev,
1588 struct device_attribute *attr, char *buf)
1589 {
1590 struct netiucv_priv *priv = dev_get_drvdata(dev);
1591
1592 IUCV_DBF_TEXT(trace, 5, __func__);
1593 return sprintf(buf, "%s\n", fsm_getstate_str(priv->conn->fsm));
1594 }
1595
1596 static DEVICE_ATTR(connection_fsm_state, 0444, conn_fsm_show, NULL);
1597
1598 static ssize_t maxmulti_show (struct device *dev,
1599 struct device_attribute *attr, char *buf)
1600 {
1601 struct netiucv_priv *priv = dev_get_drvdata(dev);
1602
1603 IUCV_DBF_TEXT(trace, 5, __func__);
1604 return sprintf(buf, "%ld\n", priv->conn->prof.maxmulti);
1605 }
1606
1607 static ssize_t maxmulti_write (struct device *dev,
1608 struct device_attribute *attr,
1609 const char *buf, size_t count)
1610 {
1611 struct netiucv_priv *priv = dev_get_drvdata(dev);
1612
1613 IUCV_DBF_TEXT(trace, 4, __func__);
1614 priv->conn->prof.maxmulti = 0;
1615 return count;
1616 }
1617
1618 static DEVICE_ATTR(max_tx_buffer_used, 0644, maxmulti_show, maxmulti_write);
1619
1620 static ssize_t maxcq_show (struct device *dev, struct device_attribute *attr,
1621 char *buf)
1622 {
1623 struct netiucv_priv *priv = dev_get_drvdata(dev);
1624
1625 IUCV_DBF_TEXT(trace, 5, __func__);
1626 return sprintf(buf, "%ld\n", priv->conn->prof.maxcqueue);
1627 }
1628
1629 static ssize_t maxcq_write (struct device *dev, struct device_attribute *attr,
1630 const char *buf, size_t count)
1631 {
1632 struct netiucv_priv *priv = dev_get_drvdata(dev);
1633
1634 IUCV_DBF_TEXT(trace, 4, __func__);
1635 priv->conn->prof.maxcqueue = 0;
1636 return count;
1637 }
1638
1639 static DEVICE_ATTR(max_chained_skbs, 0644, maxcq_show, maxcq_write);
1640
1641 static ssize_t sdoio_show (struct device *dev, struct device_attribute *attr,
1642 char *buf)
1643 {
1644 struct netiucv_priv *priv = dev_get_drvdata(dev);
1645
1646 IUCV_DBF_TEXT(trace, 5, __func__);
1647 return sprintf(buf, "%ld\n", priv->conn->prof.doios_single);
1648 }
1649
1650 static ssize_t sdoio_write (struct device *dev, struct device_attribute *attr,
1651 const char *buf, size_t count)
1652 {
1653 struct netiucv_priv *priv = dev_get_drvdata(dev);
1654
1655 IUCV_DBF_TEXT(trace, 4, __func__);
1656 priv->conn->prof.doios_single = 0;
1657 return count;
1658 }
1659
1660 static DEVICE_ATTR(tx_single_write_ops, 0644, sdoio_show, sdoio_write);
1661
1662 static ssize_t mdoio_show (struct device *dev, struct device_attribute *attr,
1663 char *buf)
1664 {
1665 struct netiucv_priv *priv = dev_get_drvdata(dev);
1666
1667 IUCV_DBF_TEXT(trace, 5, __func__);
1668 return sprintf(buf, "%ld\n", priv->conn->prof.doios_multi);
1669 }
1670
1671 static ssize_t mdoio_write (struct device *dev, struct device_attribute *attr,
1672 const char *buf, size_t count)
1673 {
1674 struct netiucv_priv *priv = dev_get_drvdata(dev);
1675
1676 IUCV_DBF_TEXT(trace, 5, __func__);
1677 priv->conn->prof.doios_multi = 0;
1678 return count;
1679 }
1680
1681 static DEVICE_ATTR(tx_multi_write_ops, 0644, mdoio_show, mdoio_write);
1682
1683 static ssize_t txlen_show (struct device *dev, struct device_attribute *attr,
1684 char *buf)
1685 {
1686 struct netiucv_priv *priv = dev_get_drvdata(dev);
1687
1688 IUCV_DBF_TEXT(trace, 5, __func__);
1689 return sprintf(buf, "%ld\n", priv->conn->prof.txlen);
1690 }
1691
1692 static ssize_t txlen_write (struct device *dev, struct device_attribute *attr,
1693 const char *buf, size_t count)
1694 {
1695 struct netiucv_priv *priv = dev_get_drvdata(dev);
1696
1697 IUCV_DBF_TEXT(trace, 4, __func__);
1698 priv->conn->prof.txlen = 0;
1699 return count;
1700 }
1701
1702 static DEVICE_ATTR(netto_bytes, 0644, txlen_show, txlen_write);
1703
1704 static ssize_t txtime_show (struct device *dev, struct device_attribute *attr,
1705 char *buf)
1706 {
1707 struct netiucv_priv *priv = dev_get_drvdata(dev);
1708
1709 IUCV_DBF_TEXT(trace, 5, __func__);
1710 return sprintf(buf, "%ld\n", priv->conn->prof.tx_time);
1711 }
1712
1713 static ssize_t txtime_write (struct device *dev, struct device_attribute *attr,
1714 const char *buf, size_t count)
1715 {
1716 struct netiucv_priv *priv = dev_get_drvdata(dev);
1717
1718 IUCV_DBF_TEXT(trace, 4, __func__);
1719 priv->conn->prof.tx_time = 0;
1720 return count;
1721 }
1722
1723 static DEVICE_ATTR(max_tx_io_time, 0644, txtime_show, txtime_write);
1724
1725 static ssize_t txpend_show (struct device *dev, struct device_attribute *attr,
1726 char *buf)
1727 {
1728 struct netiucv_priv *priv = dev_get_drvdata(dev);
1729
1730 IUCV_DBF_TEXT(trace, 5, __func__);
1731 return sprintf(buf, "%ld\n", priv->conn->prof.tx_pending);
1732 }
1733
1734 static ssize_t txpend_write (struct device *dev, struct device_attribute *attr,
1735 const char *buf, size_t count)
1736 {
1737 struct netiucv_priv *priv = dev_get_drvdata(dev);
1738
1739 IUCV_DBF_TEXT(trace, 4, __func__);
1740 priv->conn->prof.tx_pending = 0;
1741 return count;
1742 }
1743
1744 static DEVICE_ATTR(tx_pending, 0644, txpend_show, txpend_write);
1745
1746 static ssize_t txmpnd_show (struct device *dev, struct device_attribute *attr,
1747 char *buf)
1748 {
1749 struct netiucv_priv *priv = dev_get_drvdata(dev);
1750
1751 IUCV_DBF_TEXT(trace, 5, __func__);
1752 return sprintf(buf, "%ld\n", priv->conn->prof.tx_max_pending);
1753 }
1754
1755 static ssize_t txmpnd_write (struct device *dev, struct device_attribute *attr,
1756 const char *buf, size_t count)
1757 {
1758 struct netiucv_priv *priv = dev_get_drvdata(dev);
1759
1760 IUCV_DBF_TEXT(trace, 4, __func__);
1761 priv->conn->prof.tx_max_pending = 0;
1762 return count;
1763 }
1764
1765 static DEVICE_ATTR(tx_max_pending, 0644, txmpnd_show, txmpnd_write);
1766
1767 static struct attribute *netiucv_attrs[] = {
1768 &dev_attr_buffer.attr,
1769 &dev_attr_user.attr,
1770 NULL,
1771 };
1772
1773 static struct attribute_group netiucv_attr_group = {
1774 .attrs = netiucv_attrs,
1775 };
1776
1777 static struct attribute *netiucv_stat_attrs[] = {
1778 &dev_attr_device_fsm_state.attr,
1779 &dev_attr_connection_fsm_state.attr,
1780 &dev_attr_max_tx_buffer_used.attr,
1781 &dev_attr_max_chained_skbs.attr,
1782 &dev_attr_tx_single_write_ops.attr,
1783 &dev_attr_tx_multi_write_ops.attr,
1784 &dev_attr_netto_bytes.attr,
1785 &dev_attr_max_tx_io_time.attr,
1786 &dev_attr_tx_pending.attr,
1787 &dev_attr_tx_max_pending.attr,
1788 NULL,
1789 };
1790
1791 static struct attribute_group netiucv_stat_attr_group = {
1792 .name = "stats",
1793 .attrs = netiucv_stat_attrs,
1794 };
1795
1796 static int netiucv_add_files(struct device *dev)
1797 {
1798 int ret;
1799
1800 IUCV_DBF_TEXT(trace, 3, __func__);
1801 ret = sysfs_create_group(&dev->kobj, &netiucv_attr_group);
1802 if (ret)
1803 return ret;
1804 ret = sysfs_create_group(&dev->kobj, &netiucv_stat_attr_group);
1805 if (ret)
1806 sysfs_remove_group(&dev->kobj, &netiucv_attr_group);
1807 return ret;
1808 }
1809
1810 static void netiucv_remove_files(struct device *dev)
1811 {
1812 IUCV_DBF_TEXT(trace, 3, __func__);
1813 sysfs_remove_group(&dev->kobj, &netiucv_stat_attr_group);
1814 sysfs_remove_group(&dev->kobj, &netiucv_attr_group);
1815 }
1816
1817 static int netiucv_register_device(struct net_device *ndev)
1818 {
1819 struct netiucv_priv *priv = netdev_priv(ndev);
1820 struct device *dev = kzalloc(sizeof(struct device), GFP_KERNEL);
1821 int ret;
1822
1823 IUCV_DBF_TEXT(trace, 3, __func__);
1824
1825 if (dev) {
1826 dev_set_name(dev, "net%s", ndev->name);
1827 dev->bus = &iucv_bus;
1828 dev->parent = iucv_root;
1829 /*
1830 * The release function could be called after the
1831 * module has been unloaded. It's _only_ task is to
1832 * free the struct. Therefore, we specify kfree()
1833 * directly here. (Probably a little bit obfuscating
1834 * but legitime ...).
1835 */
1836 dev->release = (void (*)(struct device *))kfree;
1837 dev->driver = &netiucv_driver;
1838 } else
1839 return -ENOMEM;
1840
1841 ret = device_register(dev);
1842
1843 if (ret)
1844 return ret;
1845 ret = netiucv_add_files(dev);
1846 if (ret)
1847 goto out_unreg;
1848 priv->dev = dev;
1849 dev_set_drvdata(dev, priv);
1850 return 0;
1851
1852 out_unreg:
1853 device_unregister(dev);
1854 return ret;
1855 }
1856
1857 static void netiucv_unregister_device(struct device *dev)
1858 {
1859 IUCV_DBF_TEXT(trace, 3, __func__);
1860 netiucv_remove_files(dev);
1861 device_unregister(dev);
1862 }
1863
1864 /**
1865 * Allocate and initialize a new connection structure.
1866 * Add it to the list of netiucv connections;
1867 */
1868 static struct iucv_connection *netiucv_new_connection(struct net_device *dev,
1869 char *username)
1870 {
1871 struct iucv_connection *conn;
1872
1873 conn = kzalloc(sizeof(*conn), GFP_KERNEL);
1874 if (!conn)
1875 goto out;
1876 skb_queue_head_init(&conn->collect_queue);
1877 skb_queue_head_init(&conn->commit_queue);
1878 spin_lock_init(&conn->collect_lock);
1879 conn->max_buffsize = NETIUCV_BUFSIZE_DEFAULT;
1880 conn->netdev = dev;
1881
1882 conn->rx_buff = alloc_skb(conn->max_buffsize, GFP_KERNEL | GFP_DMA);
1883 if (!conn->rx_buff)
1884 goto out_conn;
1885 conn->tx_buff = alloc_skb(conn->max_buffsize, GFP_KERNEL | GFP_DMA);
1886 if (!conn->tx_buff)
1887 goto out_rx;
1888 conn->fsm = init_fsm("netiucvconn", conn_state_names,
1889 conn_event_names, NR_CONN_STATES,
1890 NR_CONN_EVENTS, conn_fsm, CONN_FSM_LEN,
1891 GFP_KERNEL);
1892 if (!conn->fsm)
1893 goto out_tx;
1894
1895 fsm_settimer(conn->fsm, &conn->timer);
1896 fsm_newstate(conn->fsm, CONN_STATE_INVALID);
1897
1898 if (username) {
1899 memcpy(conn->userid, username, 9);
1900 fsm_newstate(conn->fsm, CONN_STATE_STOPPED);
1901 }
1902
1903 write_lock_bh(&iucv_connection_rwlock);
1904 list_add_tail(&conn->list, &iucv_connection_list);
1905 write_unlock_bh(&iucv_connection_rwlock);
1906 return conn;
1907
1908 out_tx:
1909 kfree_skb(conn->tx_buff);
1910 out_rx:
1911 kfree_skb(conn->rx_buff);
1912 out_conn:
1913 kfree(conn);
1914 out:
1915 return NULL;
1916 }
1917
1918 /**
1919 * Release a connection structure and remove it from the
1920 * list of netiucv connections.
1921 */
1922 static void netiucv_remove_connection(struct iucv_connection *conn)
1923 {
1924 IUCV_DBF_TEXT(trace, 3, __func__);
1925 write_lock_bh(&iucv_connection_rwlock);
1926 list_del_init(&conn->list);
1927 write_unlock_bh(&iucv_connection_rwlock);
1928 fsm_deltimer(&conn->timer);
1929 netiucv_purge_skb_queue(&conn->collect_queue);
1930 if (conn->path) {
1931 iucv_path_sever(conn->path, iucvMagic);
1932 kfree(conn->path);
1933 conn->path = NULL;
1934 }
1935 netiucv_purge_skb_queue(&conn->commit_queue);
1936 kfree_fsm(conn->fsm);
1937 kfree_skb(conn->rx_buff);
1938 kfree_skb(conn->tx_buff);
1939 }
1940
1941 /**
1942 * Release everything of a net device.
1943 */
1944 static void netiucv_free_netdevice(struct net_device *dev)
1945 {
1946 struct netiucv_priv *privptr = netdev_priv(dev);
1947
1948 IUCV_DBF_TEXT(trace, 3, __func__);
1949
1950 if (!dev)
1951 return;
1952
1953 if (privptr) {
1954 if (privptr->conn)
1955 netiucv_remove_connection(privptr->conn);
1956 if (privptr->fsm)
1957 kfree_fsm(privptr->fsm);
1958 privptr->conn = NULL; privptr->fsm = NULL;
1959 /* privptr gets freed by free_netdev() */
1960 }
1961 free_netdev(dev);
1962 }
1963
1964 /**
1965 * Initialize a net device. (Called from kernel in alloc_netdev())
1966 */
1967 static const struct net_device_ops netiucv_netdev_ops = {
1968 .ndo_open = netiucv_open,
1969 .ndo_stop = netiucv_close,
1970 .ndo_get_stats = netiucv_stats,
1971 .ndo_start_xmit = netiucv_tx,
1972 .ndo_change_mtu = netiucv_change_mtu,
1973 };
1974
1975 static void netiucv_setup_netdevice(struct net_device *dev)
1976 {
1977 dev->mtu = NETIUCV_MTU_DEFAULT;
1978 dev->destructor = netiucv_free_netdevice;
1979 dev->hard_header_len = NETIUCV_HDRLEN;
1980 dev->addr_len = 0;
1981 dev->type = ARPHRD_SLIP;
1982 dev->tx_queue_len = NETIUCV_QUEUELEN_DEFAULT;
1983 dev->flags = IFF_POINTOPOINT | IFF_NOARP;
1984 dev->netdev_ops = &netiucv_netdev_ops;
1985 }
1986
1987 /**
1988 * Allocate and initialize everything of a net device.
1989 */
1990 static struct net_device *netiucv_init_netdevice(char *username)
1991 {
1992 struct netiucv_priv *privptr;
1993 struct net_device *dev;
1994
1995 dev = alloc_netdev(sizeof(struct netiucv_priv), "iucv%d",
1996 netiucv_setup_netdevice);
1997 if (!dev)
1998 return NULL;
1999 if (dev_alloc_name(dev, dev->name) < 0)
2000 goto out_netdev;
2001
2002 privptr = netdev_priv(dev);
2003 privptr->fsm = init_fsm("netiucvdev", dev_state_names,
2004 dev_event_names, NR_DEV_STATES, NR_DEV_EVENTS,
2005 dev_fsm, DEV_FSM_LEN, GFP_KERNEL);
2006 if (!privptr->fsm)
2007 goto out_netdev;
2008
2009 privptr->conn = netiucv_new_connection(dev, username);
2010 if (!privptr->conn) {
2011 IUCV_DBF_TEXT(setup, 2, "NULL from netiucv_new_connection\n");
2012 goto out_fsm;
2013 }
2014 fsm_newstate(privptr->fsm, DEV_STATE_STOPPED);
2015 return dev;
2016
2017 out_fsm:
2018 kfree_fsm(privptr->fsm);
2019 out_netdev:
2020 free_netdev(dev);
2021 return NULL;
2022 }
2023
2024 static ssize_t conn_write(struct device_driver *drv,
2025 const char *buf, size_t count)
2026 {
2027 const char *p;
2028 char username[9];
2029 int i, rc;
2030 struct net_device *dev;
2031 struct netiucv_priv *priv;
2032 struct iucv_connection *cp;
2033
2034 IUCV_DBF_TEXT(trace, 3, __func__);
2035 if (count>9) {
2036 IUCV_DBF_TEXT(setup, 2, "conn_write: too long\n");
2037 return -EINVAL;
2038 }
2039
2040 for (i = 0, p = buf; i < 8 && *p; i++, p++) {
2041 if (isalnum(*p) || *p == '$') {
2042 username[i] = toupper(*p);
2043 continue;
2044 }
2045 if (*p == '\n')
2046 /* trailing lf, grr */
2047 break;
2048 IUCV_DBF_TEXT_(setup, 2,
2049 "conn_write: invalid character %c\n", *p);
2050 return -EINVAL;
2051 }
2052 while (i < 8)
2053 username[i++] = ' ';
2054 username[8] = '\0';
2055
2056 read_lock_bh(&iucv_connection_rwlock);
2057 list_for_each_entry(cp, &iucv_connection_list, list) {
2058 if (!strncmp(username, cp->userid, 9)) {
2059 read_unlock_bh(&iucv_connection_rwlock);
2060 IUCV_DBF_TEXT_(setup, 2, "conn_write: Connection "
2061 "to %s already exists\n", username);
2062 return -EEXIST;
2063 }
2064 }
2065 read_unlock_bh(&iucv_connection_rwlock);
2066
2067 dev = netiucv_init_netdevice(username);
2068 if (!dev) {
2069 IUCV_DBF_TEXT(setup, 2, "NULL from netiucv_init_netdevice\n");
2070 return -ENODEV;
2071 }
2072
2073 rc = netiucv_register_device(dev);
2074 if (rc) {
2075 IUCV_DBF_TEXT_(setup, 2,
2076 "ret %d from netiucv_register_device\n", rc);
2077 goto out_free_ndev;
2078 }
2079
2080 /* sysfs magic */
2081 priv = netdev_priv(dev);
2082 SET_NETDEV_DEV(dev, priv->dev);
2083
2084 rc = register_netdev(dev);
2085 if (rc)
2086 goto out_unreg;
2087
2088 dev_info(priv->dev, "The IUCV interface to %s has been"
2089 " established successfully\n", netiucv_printname(username));
2090
2091 return count;
2092
2093 out_unreg:
2094 netiucv_unregister_device(priv->dev);
2095 out_free_ndev:
2096 netiucv_free_netdevice(dev);
2097 return rc;
2098 }
2099
2100 static DRIVER_ATTR(connection, 0200, NULL, conn_write);
2101
2102 static ssize_t remove_write (struct device_driver *drv,
2103 const char *buf, size_t count)
2104 {
2105 struct iucv_connection *cp;
2106 struct net_device *ndev;
2107 struct netiucv_priv *priv;
2108 struct device *dev;
2109 char name[IFNAMSIZ];
2110 const char *p;
2111 int i;
2112
2113 IUCV_DBF_TEXT(trace, 3, __func__);
2114
2115 if (count >= IFNAMSIZ)
2116 count = IFNAMSIZ - 1;;
2117
2118 for (i = 0, p = buf; i < count && *p; i++, p++) {
2119 if (*p == '\n' || *p == ' ')
2120 /* trailing lf, grr */
2121 break;
2122 name[i] = *p;
2123 }
2124 name[i] = '\0';
2125
2126 read_lock_bh(&iucv_connection_rwlock);
2127 list_for_each_entry(cp, &iucv_connection_list, list) {
2128 ndev = cp->netdev;
2129 priv = netdev_priv(ndev);
2130 dev = priv->dev;
2131 if (strncmp(name, ndev->name, count))
2132 continue;
2133 read_unlock_bh(&iucv_connection_rwlock);
2134 if (ndev->flags & (IFF_UP | IFF_RUNNING)) {
2135 dev_warn(dev, "The IUCV device is connected"
2136 " to %s and cannot be removed\n",
2137 priv->conn->userid);
2138 IUCV_DBF_TEXT(data, 2, "remove_write: still active\n");
2139 return -EPERM;
2140 }
2141 unregister_netdev(ndev);
2142 netiucv_unregister_device(dev);
2143 return count;
2144 }
2145 read_unlock_bh(&iucv_connection_rwlock);
2146 IUCV_DBF_TEXT(data, 2, "remove_write: unknown device\n");
2147 return -EINVAL;
2148 }
2149
2150 static DRIVER_ATTR(remove, 0200, NULL, remove_write);
2151
2152 static struct attribute * netiucv_drv_attrs[] = {
2153 &driver_attr_connection.attr,
2154 &driver_attr_remove.attr,
2155 NULL,
2156 };
2157
2158 static struct attribute_group netiucv_drv_attr_group = {
2159 .attrs = netiucv_drv_attrs,
2160 };
2161
2162 static struct attribute_group *netiucv_drv_attr_groups[] = {
2163 &netiucv_drv_attr_group,
2164 NULL,
2165 };
2166
2167 static void netiucv_banner(void)
2168 {
2169 pr_info("driver initialized\n");
2170 }
2171
2172 static void __exit netiucv_exit(void)
2173 {
2174 struct iucv_connection *cp;
2175 struct net_device *ndev;
2176 struct netiucv_priv *priv;
2177 struct device *dev;
2178
2179 IUCV_DBF_TEXT(trace, 3, __func__);
2180 while (!list_empty(&iucv_connection_list)) {
2181 cp = list_entry(iucv_connection_list.next,
2182 struct iucv_connection, list);
2183 ndev = cp->netdev;
2184 priv = netdev_priv(ndev);
2185 dev = priv->dev;
2186
2187 unregister_netdev(ndev);
2188 netiucv_unregister_device(dev);
2189 }
2190
2191 device_unregister(netiucv_dev);
2192 driver_unregister(&netiucv_driver);
2193 iucv_unregister(&netiucv_handler, 1);
2194 iucv_unregister_dbf_views();
2195
2196 pr_info("driver unloaded\n");
2197 return;
2198 }
2199
2200 static int __init netiucv_init(void)
2201 {
2202 int rc;
2203
2204 rc = iucv_register_dbf_views();
2205 if (rc)
2206 goto out;
2207 rc = iucv_register(&netiucv_handler, 1);
2208 if (rc)
2209 goto out_dbf;
2210 IUCV_DBF_TEXT(trace, 3, __func__);
2211 netiucv_driver.groups = netiucv_drv_attr_groups;
2212 rc = driver_register(&netiucv_driver);
2213 if (rc) {
2214 IUCV_DBF_TEXT_(setup, 2, "ret %d from driver_register\n", rc);
2215 goto out_iucv;
2216 }
2217 /* establish dummy device */
2218 netiucv_dev = kzalloc(sizeof(struct device), GFP_KERNEL);
2219 if (!netiucv_dev) {
2220 rc = -ENOMEM;
2221 goto out_driver;
2222 }
2223 dev_set_name(netiucv_dev, "netiucv");
2224 netiucv_dev->bus = &iucv_bus;
2225 netiucv_dev->parent = iucv_root;
2226 netiucv_dev->release = (void (*)(struct device *))kfree;
2227 netiucv_dev->driver = &netiucv_driver;
2228 rc = device_register(netiucv_dev);
2229 if (rc)
2230 goto out_driver;
2231 netiucv_banner();
2232 return rc;
2233
2234 out_driver:
2235 driver_unregister(&netiucv_driver);
2236 out_iucv:
2237 iucv_unregister(&netiucv_handler, 1);
2238 out_dbf:
2239 iucv_unregister_dbf_views();
2240 out:
2241 return rc;
2242 }
2243
2244 module_init(netiucv_init);
2245 module_exit(netiucv_exit);
2246 MODULE_LICENSE("GPL");
This page took 0.074777 seconds and 6 git commands to generate.