OMAPDSS: VENC: fix NULL pointer dereference in DSS2 VENC sysfs debug attr on OMAP4
[zen-stable.git] / drivers / s390 / net / netiucv.c
blob8160591913f95bd7555ac70129bbd06ef9ea0b60
1 /*
2 * IUCV network driver
4 * Copyright IBM Corp. 2001, 2009
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)
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
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.
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.
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.
38 #define KMSG_COMPONENT "netiucv"
39 #define pr_fmt(fmt) KMSG_COMPONENT ": " fmt
41 #undef DEBUG
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>
53 #include <linux/signal.h>
54 #include <linux/string.h>
55 #include <linux/device.h>
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>
64 #include <asm/io.h>
65 #include <asm/uaccess.h>
66 #include <asm/ebcdic.h>
68 #include <net/iucv/iucv.h>
69 #include "fsm.h"
71 MODULE_AUTHOR
72 ("(C) 2001 IBM Corporation by Fritz Elfert (felfert@millenux.com)");
73 MODULE_DESCRIPTION ("Linux for S/390 IUCV network driver");
75 /**
76 * Debug Facility stuff
78 #define IUCV_DBF_SETUP_NAME "iucv_setup"
79 #define IUCV_DBF_SETUP_LEN 64
80 #define IUCV_DBF_SETUP_PAGES 2
81 #define IUCV_DBF_SETUP_NR_AREAS 1
82 #define IUCV_DBF_SETUP_LEVEL 3
84 #define IUCV_DBF_DATA_NAME "iucv_data"
85 #define IUCV_DBF_DATA_LEN 128
86 #define IUCV_DBF_DATA_PAGES 2
87 #define IUCV_DBF_DATA_NR_AREAS 1
88 #define IUCV_DBF_DATA_LEVEL 2
90 #define IUCV_DBF_TRACE_NAME "iucv_trace"
91 #define IUCV_DBF_TRACE_LEN 16
92 #define IUCV_DBF_TRACE_PAGES 4
93 #define IUCV_DBF_TRACE_NR_AREAS 1
94 #define IUCV_DBF_TRACE_LEVEL 3
96 #define IUCV_DBF_TEXT(name,level,text) \
97 do { \
98 debug_text_event(iucv_dbf_##name,level,text); \
99 } while (0)
101 #define IUCV_DBF_HEX(name,level,addr,len) \
102 do { \
103 debug_event(iucv_dbf_##name,level,(void*)(addr),len); \
104 } while (0)
106 DECLARE_PER_CPU(char[256], iucv_dbf_txt_buf);
108 /* Allow to sort out low debug levels early to avoid wasted sprints */
109 static inline int iucv_dbf_passes(debug_info_t *dbf_grp, int level)
111 return (level <= dbf_grp->level);
114 #define IUCV_DBF_TEXT_(name, level, text...) \
115 do { \
116 if (iucv_dbf_passes(iucv_dbf_##name, level)) { \
117 char* __buf = get_cpu_var(iucv_dbf_txt_buf); \
118 sprintf(__buf, text); \
119 debug_text_event(iucv_dbf_##name, level, __buf); \
120 put_cpu_var(iucv_dbf_txt_buf); \
122 } while (0)
124 #define IUCV_DBF_SPRINTF(name,level,text...) \
125 do { \
126 debug_sprintf_event(iucv_dbf_trace, level, ##text ); \
127 debug_sprintf_event(iucv_dbf_trace, level, text ); \
128 } while (0)
131 * some more debug stuff
133 #define IUCV_HEXDUMP16(importance,header,ptr) \
134 PRINT_##importance(header "%02x %02x %02x %02x %02x %02x %02x %02x " \
135 "%02x %02x %02x %02x %02x %02x %02x %02x\n", \
136 *(((char*)ptr)),*(((char*)ptr)+1),*(((char*)ptr)+2), \
137 *(((char*)ptr)+3),*(((char*)ptr)+4),*(((char*)ptr)+5), \
138 *(((char*)ptr)+6),*(((char*)ptr)+7),*(((char*)ptr)+8), \
139 *(((char*)ptr)+9),*(((char*)ptr)+10),*(((char*)ptr)+11), \
140 *(((char*)ptr)+12),*(((char*)ptr)+13), \
141 *(((char*)ptr)+14),*(((char*)ptr)+15)); \
142 PRINT_##importance(header "%02x %02x %02x %02x %02x %02x %02x %02x " \
143 "%02x %02x %02x %02x %02x %02x %02x %02x\n", \
144 *(((char*)ptr)+16),*(((char*)ptr)+17), \
145 *(((char*)ptr)+18),*(((char*)ptr)+19), \
146 *(((char*)ptr)+20),*(((char*)ptr)+21), \
147 *(((char*)ptr)+22),*(((char*)ptr)+23), \
148 *(((char*)ptr)+24),*(((char*)ptr)+25), \
149 *(((char*)ptr)+26),*(((char*)ptr)+27), \
150 *(((char*)ptr)+28),*(((char*)ptr)+29), \
151 *(((char*)ptr)+30),*(((char*)ptr)+31));
153 #define PRINTK_HEADER " iucv: " /* for debugging */
155 /* dummy device to make sure netiucv_pm functions are called */
156 static struct device *netiucv_dev;
158 static int netiucv_pm_prepare(struct device *);
159 static void netiucv_pm_complete(struct device *);
160 static int netiucv_pm_freeze(struct device *);
161 static int netiucv_pm_restore_thaw(struct device *);
163 static const struct dev_pm_ops netiucv_pm_ops = {
164 .prepare = netiucv_pm_prepare,
165 .complete = netiucv_pm_complete,
166 .freeze = netiucv_pm_freeze,
167 .thaw = netiucv_pm_restore_thaw,
168 .restore = netiucv_pm_restore_thaw,
171 static struct device_driver netiucv_driver = {
172 .owner = THIS_MODULE,
173 .name = "netiucv",
174 .bus = &iucv_bus,
175 .pm = &netiucv_pm_ops,
178 static int netiucv_callback_connreq(struct iucv_path *,
179 u8 ipvmid[8], u8 ipuser[16]);
180 static void netiucv_callback_connack(struct iucv_path *, u8 ipuser[16]);
181 static void netiucv_callback_connrej(struct iucv_path *, u8 ipuser[16]);
182 static void netiucv_callback_connsusp(struct iucv_path *, u8 ipuser[16]);
183 static void netiucv_callback_connres(struct iucv_path *, u8 ipuser[16]);
184 static void netiucv_callback_rx(struct iucv_path *, struct iucv_message *);
185 static void netiucv_callback_txdone(struct iucv_path *, struct iucv_message *);
187 static struct iucv_handler netiucv_handler = {
188 .path_pending = netiucv_callback_connreq,
189 .path_complete = netiucv_callback_connack,
190 .path_severed = netiucv_callback_connrej,
191 .path_quiesced = netiucv_callback_connsusp,
192 .path_resumed = netiucv_callback_connres,
193 .message_pending = netiucv_callback_rx,
194 .message_complete = netiucv_callback_txdone
198 * Per connection profiling data
200 struct connection_profile {
201 unsigned long maxmulti;
202 unsigned long maxcqueue;
203 unsigned long doios_single;
204 unsigned long doios_multi;
205 unsigned long txlen;
206 unsigned long tx_time;
207 struct timespec send_stamp;
208 unsigned long tx_pending;
209 unsigned long tx_max_pending;
213 * Representation of one iucv connection
215 struct iucv_connection {
216 struct list_head list;
217 struct iucv_path *path;
218 struct sk_buff *rx_buff;
219 struct sk_buff *tx_buff;
220 struct sk_buff_head collect_queue;
221 struct sk_buff_head commit_queue;
222 spinlock_t collect_lock;
223 int collect_len;
224 int max_buffsize;
225 fsm_timer timer;
226 fsm_instance *fsm;
227 struct net_device *netdev;
228 struct connection_profile prof;
229 char userid[9];
230 char userdata[17];
234 * Linked list of all connection structs.
236 static LIST_HEAD(iucv_connection_list);
237 static DEFINE_RWLOCK(iucv_connection_rwlock);
240 * Representation of event-data for the
241 * connection state machine.
243 struct iucv_event {
244 struct iucv_connection *conn;
245 void *data;
249 * Private part of the network device structure
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;
261 * Link level header for a packet.
263 struct ll_header {
264 u16 next;
267 #define NETIUCV_HDRLEN (sizeof(struct ll_header))
268 #define NETIUCV_BUFSIZE_MAX 65537
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
276 * Compatibility macros for busy handling
277 * of network devices.
279 static inline void netiucv_clear_busy(struct net_device *dev)
281 struct netiucv_priv *priv = netdev_priv(dev);
282 clear_bit(0, &priv->tbusy);
283 netif_wake_queue(dev);
286 static inline int netiucv_test_and_set_busy(struct net_device *dev)
288 struct netiucv_priv *priv = netdev_priv(dev);
289 netif_stop_queue(dev);
290 return test_and_set_bit(0, &priv->tbusy);
293 static u8 iucvMagic_ascii[16] = {
294 0x30, 0x20, 0x20, 0x20, 0x20, 0x20, 0x20, 0x20,
295 0x30, 0x20, 0x20, 0x20, 0x20, 0x20, 0x20, 0x20
298 static u8 iucvMagic_ebcdic[16] = {
299 0xF0, 0x40, 0x40, 0x40, 0x40, 0x40, 0x40, 0x40,
300 0xF0, 0x40, 0x40, 0x40, 0x40, 0x40, 0x40, 0x40
304 * Convert an iucv userId to its printable
305 * form (strip whitespace at end).
307 * @param An iucv userId
309 * @returns The printable string (static data!!)
311 static char *netiucv_printname(char *name, int len)
313 static char tmp[17];
314 char *p = tmp;
315 memcpy(tmp, name, len);
316 tmp[len] = '\0';
317 while (*p && ((p - tmp) < len) && (!isspace(*p)))
318 p++;
319 *p = '\0';
320 return tmp;
323 static char *netiucv_printuser(struct iucv_connection *conn)
325 static char tmp_uid[9];
326 static char tmp_udat[17];
327 static char buf[100];
329 if (memcmp(conn->userdata, iucvMagic_ebcdic, 16)) {
330 tmp_uid[8] = '\0';
331 tmp_udat[16] = '\0';
332 memcpy(tmp_uid, conn->userid, 8);
333 memcpy(tmp_uid, netiucv_printname(tmp_uid, 8), 8);
334 memcpy(tmp_udat, conn->userdata, 16);
335 EBCASC(tmp_udat, 16);
336 memcpy(tmp_udat, netiucv_printname(tmp_udat, 16), 16);
337 sprintf(buf, "%s.%s", tmp_uid, tmp_udat);
338 return buf;
339 } else
340 return netiucv_printname(conn->userid, 8);
344 * States of the interface statemachine.
346 enum dev_states {
347 DEV_STATE_STOPPED,
348 DEV_STATE_STARTWAIT,
349 DEV_STATE_STOPWAIT,
350 DEV_STATE_RUNNING,
352 * MUST be always the last element!!
354 NR_DEV_STATES
357 static const char *dev_state_names[] = {
358 "Stopped",
359 "StartWait",
360 "StopWait",
361 "Running",
365 * Events of the interface statemachine.
367 enum dev_events {
368 DEV_EVENT_START,
369 DEV_EVENT_STOP,
370 DEV_EVENT_CONUP,
371 DEV_EVENT_CONDOWN,
373 * MUST be always the last element!!
375 NR_DEV_EVENTS
378 static const char *dev_event_names[] = {
379 "Start",
380 "Stop",
381 "Connection up",
382 "Connection down",
386 * Events of the connection statemachine
388 enum conn_events {
390 * Events, representing callbacks from
391 * lowlevel iucv layer)
393 CONN_EVENT_CONN_REQ,
394 CONN_EVENT_CONN_ACK,
395 CONN_EVENT_CONN_REJ,
396 CONN_EVENT_CONN_SUS,
397 CONN_EVENT_CONN_RES,
398 CONN_EVENT_RX,
399 CONN_EVENT_TXDONE,
402 * Events, representing errors return codes from
403 * calls to lowlevel iucv layer
407 * Event, representing timer expiry.
409 CONN_EVENT_TIMER,
412 * Events, representing commands from upper levels.
414 CONN_EVENT_START,
415 CONN_EVENT_STOP,
418 * MUST be always the last element!!
420 NR_CONN_EVENTS,
423 static const char *conn_event_names[] = {
424 "Remote connection request",
425 "Remote connection acknowledge",
426 "Remote connection reject",
427 "Connection suspended",
428 "Connection resumed",
429 "Data received",
430 "Data sent",
432 "Timer",
434 "Start",
435 "Stop",
439 * States of the connection statemachine.
441 enum conn_states {
443 * Connection not assigned to any device,
444 * initial state, invalid
446 CONN_STATE_INVALID,
449 * Userid assigned but not operating
451 CONN_STATE_STOPPED,
454 * Connection registered,
455 * no connection request sent yet,
456 * no connection request received
458 CONN_STATE_STARTWAIT,
461 * Connection registered and connection request sent,
462 * no acknowledge and no connection request received yet.
464 CONN_STATE_SETUPWAIT,
467 * Connection up and running idle
469 CONN_STATE_IDLE,
472 * Data sent, awaiting CONN_EVENT_TXDONE
474 CONN_STATE_TX,
477 * Error during registration.
479 CONN_STATE_REGERR,
482 * Error during registration.
484 CONN_STATE_CONNERR,
487 * MUST be always the last element!!
489 NR_CONN_STATES,
492 static const char *conn_state_names[] = {
493 "Invalid",
494 "Stopped",
495 "StartWait",
496 "SetupWait",
497 "Idle",
498 "TX",
499 "Terminating",
500 "Registration error",
501 "Connect error",
506 * Debug Facility Stuff
508 static debug_info_t *iucv_dbf_setup = NULL;
509 static debug_info_t *iucv_dbf_data = NULL;
510 static debug_info_t *iucv_dbf_trace = NULL;
512 DEFINE_PER_CPU(char[256], iucv_dbf_txt_buf);
514 static void iucv_unregister_dbf_views(void)
516 if (iucv_dbf_setup)
517 debug_unregister(iucv_dbf_setup);
518 if (iucv_dbf_data)
519 debug_unregister(iucv_dbf_data);
520 if (iucv_dbf_trace)
521 debug_unregister(iucv_dbf_trace);
523 static int iucv_register_dbf_views(void)
525 iucv_dbf_setup = debug_register(IUCV_DBF_SETUP_NAME,
526 IUCV_DBF_SETUP_PAGES,
527 IUCV_DBF_SETUP_NR_AREAS,
528 IUCV_DBF_SETUP_LEN);
529 iucv_dbf_data = debug_register(IUCV_DBF_DATA_NAME,
530 IUCV_DBF_DATA_PAGES,
531 IUCV_DBF_DATA_NR_AREAS,
532 IUCV_DBF_DATA_LEN);
533 iucv_dbf_trace = debug_register(IUCV_DBF_TRACE_NAME,
534 IUCV_DBF_TRACE_PAGES,
535 IUCV_DBF_TRACE_NR_AREAS,
536 IUCV_DBF_TRACE_LEN);
538 if ((iucv_dbf_setup == NULL) || (iucv_dbf_data == NULL) ||
539 (iucv_dbf_trace == NULL)) {
540 iucv_unregister_dbf_views();
541 return -ENOMEM;
543 debug_register_view(iucv_dbf_setup, &debug_hex_ascii_view);
544 debug_set_level(iucv_dbf_setup, IUCV_DBF_SETUP_LEVEL);
546 debug_register_view(iucv_dbf_data, &debug_hex_ascii_view);
547 debug_set_level(iucv_dbf_data, IUCV_DBF_DATA_LEVEL);
549 debug_register_view(iucv_dbf_trace, &debug_hex_ascii_view);
550 debug_set_level(iucv_dbf_trace, IUCV_DBF_TRACE_LEVEL);
552 return 0;
556 * Callback-wrappers, called from lowlevel iucv layer.
559 static void netiucv_callback_rx(struct iucv_path *path,
560 struct iucv_message *msg)
562 struct iucv_connection *conn = path->private;
563 struct iucv_event ev;
565 ev.conn = conn;
566 ev.data = msg;
567 fsm_event(conn->fsm, CONN_EVENT_RX, &ev);
570 static void netiucv_callback_txdone(struct iucv_path *path,
571 struct iucv_message *msg)
573 struct iucv_connection *conn = path->private;
574 struct iucv_event ev;
576 ev.conn = conn;
577 ev.data = msg;
578 fsm_event(conn->fsm, CONN_EVENT_TXDONE, &ev);
581 static void netiucv_callback_connack(struct iucv_path *path, u8 ipuser[16])
583 struct iucv_connection *conn = path->private;
585 fsm_event(conn->fsm, CONN_EVENT_CONN_ACK, conn);
588 static int netiucv_callback_connreq(struct iucv_path *path,
589 u8 ipvmid[8], u8 ipuser[16])
591 struct iucv_connection *conn = path->private;
592 struct iucv_event ev;
593 static char tmp_user[9];
594 static char tmp_udat[17];
595 int rc;
597 rc = -EINVAL;
598 memcpy(tmp_user, netiucv_printname(ipvmid, 8), 8);
599 memcpy(tmp_udat, ipuser, 16);
600 EBCASC(tmp_udat, 16);
601 read_lock_bh(&iucv_connection_rwlock);
602 list_for_each_entry(conn, &iucv_connection_list, list) {
603 if (strncmp(ipvmid, conn->userid, 8) ||
604 strncmp(ipuser, conn->userdata, 16))
605 continue;
606 /* Found a matching connection for this path. */
607 conn->path = path;
608 ev.conn = conn;
609 ev.data = path;
610 fsm_event(conn->fsm, CONN_EVENT_CONN_REQ, &ev);
611 rc = 0;
613 IUCV_DBF_TEXT_(setup, 2, "Connection requested for %s.%s\n",
614 tmp_user, netiucv_printname(tmp_udat, 16));
615 read_unlock_bh(&iucv_connection_rwlock);
616 return rc;
619 static void netiucv_callback_connrej(struct iucv_path *path, u8 ipuser[16])
621 struct iucv_connection *conn = path->private;
623 fsm_event(conn->fsm, CONN_EVENT_CONN_REJ, conn);
626 static void netiucv_callback_connsusp(struct iucv_path *path, u8 ipuser[16])
628 struct iucv_connection *conn = path->private;
630 fsm_event(conn->fsm, CONN_EVENT_CONN_SUS, conn);
633 static void netiucv_callback_connres(struct iucv_path *path, u8 ipuser[16])
635 struct iucv_connection *conn = path->private;
637 fsm_event(conn->fsm, CONN_EVENT_CONN_RES, conn);
641 * NOP action for statemachines
643 static void netiucv_action_nop(fsm_instance *fi, int event, void *arg)
648 * Actions of the connection statemachine
652 * netiucv_unpack_skb
653 * @conn: The connection where this skb has been received.
654 * @pskb: The received skb.
656 * Unpack a just received skb and hand it over to upper layers.
657 * Helper function for conn_action_rx.
659 static void netiucv_unpack_skb(struct iucv_connection *conn,
660 struct sk_buff *pskb)
662 struct net_device *dev = conn->netdev;
663 struct netiucv_priv *privptr = netdev_priv(dev);
664 u16 offset = 0;
666 skb_put(pskb, NETIUCV_HDRLEN);
667 pskb->dev = dev;
668 pskb->ip_summed = CHECKSUM_NONE;
669 pskb->protocol = ntohs(ETH_P_IP);
671 while (1) {
672 struct sk_buff *skb;
673 struct ll_header *header = (struct ll_header *) pskb->data;
675 if (!header->next)
676 break;
678 skb_pull(pskb, NETIUCV_HDRLEN);
679 header->next -= offset;
680 offset += header->next;
681 header->next -= NETIUCV_HDRLEN;
682 if (skb_tailroom(pskb) < header->next) {
683 IUCV_DBF_TEXT_(data, 2, "Illegal next field: %d > %d\n",
684 header->next, skb_tailroom(pskb));
685 return;
687 skb_put(pskb, header->next);
688 skb_reset_mac_header(pskb);
689 skb = dev_alloc_skb(pskb->len);
690 if (!skb) {
691 IUCV_DBF_TEXT(data, 2,
692 "Out of memory in netiucv_unpack_skb\n");
693 privptr->stats.rx_dropped++;
694 return;
696 skb_copy_from_linear_data(pskb, skb_put(skb, pskb->len),
697 pskb->len);
698 skb_reset_mac_header(skb);
699 skb->dev = pskb->dev;
700 skb->protocol = pskb->protocol;
701 pskb->ip_summed = CHECKSUM_UNNECESSARY;
702 privptr->stats.rx_packets++;
703 privptr->stats.rx_bytes += skb->len;
705 * Since receiving is always initiated from a tasklet (in iucv.c),
706 * we must use netif_rx_ni() instead of netif_rx()
708 netif_rx_ni(skb);
709 skb_pull(pskb, header->next);
710 skb_put(pskb, NETIUCV_HDRLEN);
714 static void conn_action_rx(fsm_instance *fi, int event, void *arg)
716 struct iucv_event *ev = arg;
717 struct iucv_connection *conn = ev->conn;
718 struct iucv_message *msg = ev->data;
719 struct netiucv_priv *privptr = netdev_priv(conn->netdev);
720 int rc;
722 IUCV_DBF_TEXT(trace, 4, __func__);
724 if (!conn->netdev) {
725 iucv_message_reject(conn->path, msg);
726 IUCV_DBF_TEXT(data, 2,
727 "Received data for unlinked connection\n");
728 return;
730 if (msg->length > conn->max_buffsize) {
731 iucv_message_reject(conn->path, msg);
732 privptr->stats.rx_dropped++;
733 IUCV_DBF_TEXT_(data, 2, "msglen %d > max_buffsize %d\n",
734 msg->length, conn->max_buffsize);
735 return;
737 conn->rx_buff->data = conn->rx_buff->head;
738 skb_reset_tail_pointer(conn->rx_buff);
739 conn->rx_buff->len = 0;
740 rc = iucv_message_receive(conn->path, msg, 0, conn->rx_buff->data,
741 msg->length, NULL);
742 if (rc || msg->length < 5) {
743 privptr->stats.rx_errors++;
744 IUCV_DBF_TEXT_(data, 2, "rc %d from iucv_receive\n", rc);
745 return;
747 netiucv_unpack_skb(conn, conn->rx_buff);
750 static void conn_action_txdone(fsm_instance *fi, int event, void *arg)
752 struct iucv_event *ev = arg;
753 struct iucv_connection *conn = ev->conn;
754 struct iucv_message *msg = ev->data;
755 struct iucv_message txmsg;
756 struct netiucv_priv *privptr = NULL;
757 u32 single_flag = msg->tag;
758 u32 txbytes = 0;
759 u32 txpackets = 0;
760 u32 stat_maxcq = 0;
761 struct sk_buff *skb;
762 unsigned long saveflags;
763 struct ll_header header;
764 int rc;
766 IUCV_DBF_TEXT(trace, 4, __func__);
768 if (conn && conn->netdev)
769 privptr = netdev_priv(conn->netdev);
770 conn->prof.tx_pending--;
771 if (single_flag) {
772 if ((skb = skb_dequeue(&conn->commit_queue))) {
773 atomic_dec(&skb->users);
774 if (privptr) {
775 privptr->stats.tx_packets++;
776 privptr->stats.tx_bytes +=
777 (skb->len - NETIUCV_HDRLEN
778 - NETIUCV_HDRLEN);
780 dev_kfree_skb_any(skb);
783 conn->tx_buff->data = conn->tx_buff->head;
784 skb_reset_tail_pointer(conn->tx_buff);
785 conn->tx_buff->len = 0;
786 spin_lock_irqsave(&conn->collect_lock, saveflags);
787 while ((skb = skb_dequeue(&conn->collect_queue))) {
788 header.next = conn->tx_buff->len + skb->len + NETIUCV_HDRLEN;
789 memcpy(skb_put(conn->tx_buff, NETIUCV_HDRLEN), &header,
790 NETIUCV_HDRLEN);
791 skb_copy_from_linear_data(skb,
792 skb_put(conn->tx_buff, skb->len),
793 skb->len);
794 txbytes += skb->len;
795 txpackets++;
796 stat_maxcq++;
797 atomic_dec(&skb->users);
798 dev_kfree_skb_any(skb);
800 if (conn->collect_len > conn->prof.maxmulti)
801 conn->prof.maxmulti = conn->collect_len;
802 conn->collect_len = 0;
803 spin_unlock_irqrestore(&conn->collect_lock, saveflags);
804 if (conn->tx_buff->len == 0) {
805 fsm_newstate(fi, CONN_STATE_IDLE);
806 return;
809 header.next = 0;
810 memcpy(skb_put(conn->tx_buff, NETIUCV_HDRLEN), &header, NETIUCV_HDRLEN);
811 conn->prof.send_stamp = current_kernel_time();
812 txmsg.class = 0;
813 txmsg.tag = 0;
814 rc = iucv_message_send(conn->path, &txmsg, 0, 0,
815 conn->tx_buff->data, conn->tx_buff->len);
816 conn->prof.doios_multi++;
817 conn->prof.txlen += conn->tx_buff->len;
818 conn->prof.tx_pending++;
819 if (conn->prof.tx_pending > conn->prof.tx_max_pending)
820 conn->prof.tx_max_pending = conn->prof.tx_pending;
821 if (rc) {
822 conn->prof.tx_pending--;
823 fsm_newstate(fi, CONN_STATE_IDLE);
824 if (privptr)
825 privptr->stats.tx_errors += txpackets;
826 IUCV_DBF_TEXT_(data, 2, "rc %d from iucv_send\n", rc);
827 } else {
828 if (privptr) {
829 privptr->stats.tx_packets += txpackets;
830 privptr->stats.tx_bytes += txbytes;
832 if (stat_maxcq > conn->prof.maxcqueue)
833 conn->prof.maxcqueue = stat_maxcq;
837 static void conn_action_connaccept(fsm_instance *fi, int event, void *arg)
839 struct iucv_event *ev = arg;
840 struct iucv_connection *conn = ev->conn;
841 struct iucv_path *path = ev->data;
842 struct net_device *netdev = conn->netdev;
843 struct netiucv_priv *privptr = netdev_priv(netdev);
844 int rc;
846 IUCV_DBF_TEXT(trace, 3, __func__);
848 conn->path = path;
849 path->msglim = NETIUCV_QUEUELEN_DEFAULT;
850 path->flags = 0;
851 rc = iucv_path_accept(path, &netiucv_handler, conn->userdata , conn);
852 if (rc) {
853 IUCV_DBF_TEXT_(setup, 2, "rc %d from iucv_accept", rc);
854 return;
856 fsm_newstate(fi, CONN_STATE_IDLE);
857 netdev->tx_queue_len = conn->path->msglim;
858 fsm_event(privptr->fsm, DEV_EVENT_CONUP, netdev);
861 static void conn_action_connreject(fsm_instance *fi, int event, void *arg)
863 struct iucv_event *ev = arg;
864 struct iucv_path *path = ev->data;
866 IUCV_DBF_TEXT(trace, 3, __func__);
867 iucv_path_sever(path, NULL);
870 static void conn_action_connack(fsm_instance *fi, int event, void *arg)
872 struct iucv_connection *conn = arg;
873 struct net_device *netdev = conn->netdev;
874 struct netiucv_priv *privptr = netdev_priv(netdev);
876 IUCV_DBF_TEXT(trace, 3, __func__);
877 fsm_deltimer(&conn->timer);
878 fsm_newstate(fi, CONN_STATE_IDLE);
879 netdev->tx_queue_len = conn->path->msglim;
880 fsm_event(privptr->fsm, DEV_EVENT_CONUP, netdev);
883 static void conn_action_conntimsev(fsm_instance *fi, int event, void *arg)
885 struct iucv_connection *conn = arg;
887 IUCV_DBF_TEXT(trace, 3, __func__);
888 fsm_deltimer(&conn->timer);
889 iucv_path_sever(conn->path, conn->userdata);
890 fsm_newstate(fi, CONN_STATE_STARTWAIT);
893 static void conn_action_connsever(fsm_instance *fi, int event, void *arg)
895 struct iucv_connection *conn = arg;
896 struct net_device *netdev = conn->netdev;
897 struct netiucv_priv *privptr = netdev_priv(netdev);
899 IUCV_DBF_TEXT(trace, 3, __func__);
901 fsm_deltimer(&conn->timer);
902 iucv_path_sever(conn->path, conn->userdata);
903 dev_info(privptr->dev, "The peer z/VM guest %s has closed the "
904 "connection\n", netiucv_printuser(conn));
905 IUCV_DBF_TEXT(data, 2,
906 "conn_action_connsever: Remote dropped connection\n");
907 fsm_newstate(fi, CONN_STATE_STARTWAIT);
908 fsm_event(privptr->fsm, DEV_EVENT_CONDOWN, netdev);
911 static void conn_action_start(fsm_instance *fi, int event, void *arg)
913 struct iucv_connection *conn = arg;
914 struct net_device *netdev = conn->netdev;
915 struct netiucv_priv *privptr = netdev_priv(netdev);
916 int rc;
918 IUCV_DBF_TEXT(trace, 3, __func__);
920 fsm_newstate(fi, CONN_STATE_STARTWAIT);
923 * We must set the state before calling iucv_connect because the
924 * callback handler could be called at any point after the connection
925 * request is sent
928 fsm_newstate(fi, CONN_STATE_SETUPWAIT);
929 conn->path = iucv_path_alloc(NETIUCV_QUEUELEN_DEFAULT, 0, GFP_KERNEL);
930 IUCV_DBF_TEXT_(setup, 2, "%s: connecting to %s ...\n",
931 netdev->name, netiucv_printuser(conn));
933 rc = iucv_path_connect(conn->path, &netiucv_handler, conn->userid,
934 NULL, conn->userdata, conn);
935 switch (rc) {
936 case 0:
937 netdev->tx_queue_len = conn->path->msglim;
938 fsm_addtimer(&conn->timer, NETIUCV_TIMEOUT_5SEC,
939 CONN_EVENT_TIMER, conn);
940 return;
941 case 11:
942 dev_warn(privptr->dev,
943 "The IUCV device failed to connect to z/VM guest %s\n",
944 netiucv_printname(conn->userid, 8));
945 fsm_newstate(fi, CONN_STATE_STARTWAIT);
946 break;
947 case 12:
948 dev_warn(privptr->dev,
949 "The IUCV device failed to connect to the peer on z/VM"
950 " guest %s\n", netiucv_printname(conn->userid, 8));
951 fsm_newstate(fi, CONN_STATE_STARTWAIT);
952 break;
953 case 13:
954 dev_err(privptr->dev,
955 "Connecting the IUCV device would exceed the maximum"
956 " number of IUCV connections\n");
957 fsm_newstate(fi, CONN_STATE_CONNERR);
958 break;
959 case 14:
960 dev_err(privptr->dev,
961 "z/VM guest %s has too many IUCV connections"
962 " to connect with the IUCV device\n",
963 netiucv_printname(conn->userid, 8));
964 fsm_newstate(fi, CONN_STATE_CONNERR);
965 break;
966 case 15:
967 dev_err(privptr->dev,
968 "The IUCV device cannot connect to a z/VM guest with no"
969 " IUCV authorization\n");
970 fsm_newstate(fi, CONN_STATE_CONNERR);
971 break;
972 default:
973 dev_err(privptr->dev,
974 "Connecting the IUCV device failed with error %d\n",
975 rc);
976 fsm_newstate(fi, CONN_STATE_CONNERR);
977 break;
979 IUCV_DBF_TEXT_(setup, 5, "iucv_connect rc is %d\n", rc);
980 kfree(conn->path);
981 conn->path = NULL;
984 static void netiucv_purge_skb_queue(struct sk_buff_head *q)
986 struct sk_buff *skb;
988 while ((skb = skb_dequeue(q))) {
989 atomic_dec(&skb->users);
990 dev_kfree_skb_any(skb);
994 static void conn_action_stop(fsm_instance *fi, int event, void *arg)
996 struct iucv_event *ev = arg;
997 struct iucv_connection *conn = ev->conn;
998 struct net_device *netdev = conn->netdev;
999 struct netiucv_priv *privptr = netdev_priv(netdev);
1001 IUCV_DBF_TEXT(trace, 3, __func__);
1003 fsm_deltimer(&conn->timer);
1004 fsm_newstate(fi, CONN_STATE_STOPPED);
1005 netiucv_purge_skb_queue(&conn->collect_queue);
1006 if (conn->path) {
1007 IUCV_DBF_TEXT(trace, 5, "calling iucv_path_sever\n");
1008 iucv_path_sever(conn->path, conn->userdata);
1009 kfree(conn->path);
1010 conn->path = NULL;
1012 netiucv_purge_skb_queue(&conn->commit_queue);
1013 fsm_event(privptr->fsm, DEV_EVENT_CONDOWN, netdev);
1016 static void conn_action_inval(fsm_instance *fi, int event, void *arg)
1018 struct iucv_connection *conn = arg;
1019 struct net_device *netdev = conn->netdev;
1021 IUCV_DBF_TEXT_(data, 2, "%s('%s'): conn_action_inval called\n",
1022 netdev->name, conn->userid);
1025 static const fsm_node conn_fsm[] = {
1026 { CONN_STATE_INVALID, CONN_EVENT_START, conn_action_inval },
1027 { CONN_STATE_STOPPED, CONN_EVENT_START, conn_action_start },
1029 { CONN_STATE_STOPPED, CONN_EVENT_STOP, conn_action_stop },
1030 { CONN_STATE_STARTWAIT, CONN_EVENT_STOP, conn_action_stop },
1031 { CONN_STATE_SETUPWAIT, CONN_EVENT_STOP, conn_action_stop },
1032 { CONN_STATE_IDLE, CONN_EVENT_STOP, conn_action_stop },
1033 { CONN_STATE_TX, CONN_EVENT_STOP, conn_action_stop },
1034 { CONN_STATE_REGERR, CONN_EVENT_STOP, conn_action_stop },
1035 { CONN_STATE_CONNERR, CONN_EVENT_STOP, conn_action_stop },
1037 { CONN_STATE_STOPPED, CONN_EVENT_CONN_REQ, conn_action_connreject },
1038 { CONN_STATE_STARTWAIT, CONN_EVENT_CONN_REQ, conn_action_connaccept },
1039 { CONN_STATE_SETUPWAIT, CONN_EVENT_CONN_REQ, conn_action_connaccept },
1040 { CONN_STATE_IDLE, CONN_EVENT_CONN_REQ, conn_action_connreject },
1041 { CONN_STATE_TX, CONN_EVENT_CONN_REQ, conn_action_connreject },
1043 { CONN_STATE_SETUPWAIT, CONN_EVENT_CONN_ACK, conn_action_connack },
1044 { CONN_STATE_SETUPWAIT, CONN_EVENT_TIMER, conn_action_conntimsev },
1046 { CONN_STATE_SETUPWAIT, CONN_EVENT_CONN_REJ, conn_action_connsever },
1047 { CONN_STATE_IDLE, CONN_EVENT_CONN_REJ, conn_action_connsever },
1048 { CONN_STATE_TX, CONN_EVENT_CONN_REJ, conn_action_connsever },
1050 { CONN_STATE_IDLE, CONN_EVENT_RX, conn_action_rx },
1051 { CONN_STATE_TX, CONN_EVENT_RX, conn_action_rx },
1053 { CONN_STATE_TX, CONN_EVENT_TXDONE, conn_action_txdone },
1054 { CONN_STATE_IDLE, CONN_EVENT_TXDONE, conn_action_txdone },
1057 static const int CONN_FSM_LEN = sizeof(conn_fsm) / sizeof(fsm_node);
1061 * Actions for interface - statemachine.
1065 * dev_action_start
1066 * @fi: An instance of an interface statemachine.
1067 * @event: The event, just happened.
1068 * @arg: Generic pointer, casted from struct net_device * upon call.
1070 * Startup connection by sending CONN_EVENT_START to it.
1072 static void dev_action_start(fsm_instance *fi, int event, void *arg)
1074 struct net_device *dev = arg;
1075 struct netiucv_priv *privptr = netdev_priv(dev);
1077 IUCV_DBF_TEXT(trace, 3, __func__);
1079 fsm_newstate(fi, DEV_STATE_STARTWAIT);
1080 fsm_event(privptr->conn->fsm, CONN_EVENT_START, privptr->conn);
1084 * Shutdown connection by sending CONN_EVENT_STOP to it.
1086 * @param fi An instance of an interface statemachine.
1087 * @param event The event, just happened.
1088 * @param arg Generic pointer, casted from struct net_device * upon call.
1090 static void
1091 dev_action_stop(fsm_instance *fi, int event, void *arg)
1093 struct net_device *dev = arg;
1094 struct netiucv_priv *privptr = netdev_priv(dev);
1095 struct iucv_event ev;
1097 IUCV_DBF_TEXT(trace, 3, __func__);
1099 ev.conn = privptr->conn;
1101 fsm_newstate(fi, DEV_STATE_STOPWAIT);
1102 fsm_event(privptr->conn->fsm, CONN_EVENT_STOP, &ev);
1106 * Called from connection statemachine
1107 * when a connection is up and running.
1109 * @param fi An instance of an interface statemachine.
1110 * @param event The event, just happened.
1111 * @param arg Generic pointer, casted from struct net_device * upon call.
1113 static void
1114 dev_action_connup(fsm_instance *fi, int event, void *arg)
1116 struct net_device *dev = arg;
1117 struct netiucv_priv *privptr = netdev_priv(dev);
1119 IUCV_DBF_TEXT(trace, 3, __func__);
1121 switch (fsm_getstate(fi)) {
1122 case DEV_STATE_STARTWAIT:
1123 fsm_newstate(fi, DEV_STATE_RUNNING);
1124 dev_info(privptr->dev,
1125 "The IUCV device has been connected"
1126 " successfully to %s\n",
1127 netiucv_printuser(privptr->conn));
1128 IUCV_DBF_TEXT(setup, 3,
1129 "connection is up and running\n");
1130 break;
1131 case DEV_STATE_STOPWAIT:
1132 IUCV_DBF_TEXT(data, 2,
1133 "dev_action_connup: in DEV_STATE_STOPWAIT\n");
1134 break;
1139 * Called from connection statemachine
1140 * when a connection has been shutdown.
1142 * @param fi An instance of an interface statemachine.
1143 * @param event The event, just happened.
1144 * @param arg Generic pointer, casted from struct net_device * upon call.
1146 static void
1147 dev_action_conndown(fsm_instance *fi, int event, void *arg)
1149 IUCV_DBF_TEXT(trace, 3, __func__);
1151 switch (fsm_getstate(fi)) {
1152 case DEV_STATE_RUNNING:
1153 fsm_newstate(fi, DEV_STATE_STARTWAIT);
1154 break;
1155 case DEV_STATE_STOPWAIT:
1156 fsm_newstate(fi, DEV_STATE_STOPPED);
1157 IUCV_DBF_TEXT(setup, 3, "connection is down\n");
1158 break;
1162 static const fsm_node dev_fsm[] = {
1163 { DEV_STATE_STOPPED, DEV_EVENT_START, dev_action_start },
1165 { DEV_STATE_STOPWAIT, DEV_EVENT_START, dev_action_start },
1166 { DEV_STATE_STOPWAIT, DEV_EVENT_CONDOWN, dev_action_conndown },
1168 { DEV_STATE_STARTWAIT, DEV_EVENT_STOP, dev_action_stop },
1169 { DEV_STATE_STARTWAIT, DEV_EVENT_CONUP, dev_action_connup },
1171 { DEV_STATE_RUNNING, DEV_EVENT_STOP, dev_action_stop },
1172 { DEV_STATE_RUNNING, DEV_EVENT_CONDOWN, dev_action_conndown },
1173 { DEV_STATE_RUNNING, DEV_EVENT_CONUP, netiucv_action_nop },
1176 static const int DEV_FSM_LEN = sizeof(dev_fsm) / sizeof(fsm_node);
1179 * Transmit a packet.
1180 * This is a helper function for netiucv_tx().
1182 * @param conn Connection to be used for sending.
1183 * @param skb Pointer to struct sk_buff of packet to send.
1184 * The linklevel header has already been set up
1185 * by netiucv_tx().
1187 * @return 0 on success, -ERRNO on failure. (Never fails.)
1189 static int netiucv_transmit_skb(struct iucv_connection *conn,
1190 struct sk_buff *skb)
1192 struct iucv_message msg;
1193 unsigned long saveflags;
1194 struct ll_header header;
1195 int rc;
1197 if (fsm_getstate(conn->fsm) != CONN_STATE_IDLE) {
1198 int l = skb->len + NETIUCV_HDRLEN;
1200 spin_lock_irqsave(&conn->collect_lock, saveflags);
1201 if (conn->collect_len + l >
1202 (conn->max_buffsize - NETIUCV_HDRLEN)) {
1203 rc = -EBUSY;
1204 IUCV_DBF_TEXT(data, 2,
1205 "EBUSY from netiucv_transmit_skb\n");
1206 } else {
1207 atomic_inc(&skb->users);
1208 skb_queue_tail(&conn->collect_queue, skb);
1209 conn->collect_len += l;
1210 rc = 0;
1212 spin_unlock_irqrestore(&conn->collect_lock, saveflags);
1213 } else {
1214 struct sk_buff *nskb = skb;
1216 * Copy the skb to a new allocated skb in lowmem only if the
1217 * data is located above 2G in memory or tailroom is < 2.
1219 unsigned long hi = ((unsigned long)(skb_tail_pointer(skb) +
1220 NETIUCV_HDRLEN)) >> 31;
1221 int copied = 0;
1222 if (hi || (skb_tailroom(skb) < 2)) {
1223 nskb = alloc_skb(skb->len + NETIUCV_HDRLEN +
1224 NETIUCV_HDRLEN, GFP_ATOMIC | GFP_DMA);
1225 if (!nskb) {
1226 IUCV_DBF_TEXT(data, 2, "alloc_skb failed\n");
1227 rc = -ENOMEM;
1228 return rc;
1229 } else {
1230 skb_reserve(nskb, NETIUCV_HDRLEN);
1231 memcpy(skb_put(nskb, skb->len),
1232 skb->data, skb->len);
1234 copied = 1;
1237 * skb now is below 2G and has enough room. Add headers.
1239 header.next = nskb->len + NETIUCV_HDRLEN;
1240 memcpy(skb_push(nskb, NETIUCV_HDRLEN), &header, NETIUCV_HDRLEN);
1241 header.next = 0;
1242 memcpy(skb_put(nskb, NETIUCV_HDRLEN), &header, NETIUCV_HDRLEN);
1244 fsm_newstate(conn->fsm, CONN_STATE_TX);
1245 conn->prof.send_stamp = current_kernel_time();
1247 msg.tag = 1;
1248 msg.class = 0;
1249 rc = iucv_message_send(conn->path, &msg, 0, 0,
1250 nskb->data, nskb->len);
1251 conn->prof.doios_single++;
1252 conn->prof.txlen += skb->len;
1253 conn->prof.tx_pending++;
1254 if (conn->prof.tx_pending > conn->prof.tx_max_pending)
1255 conn->prof.tx_max_pending = conn->prof.tx_pending;
1256 if (rc) {
1257 struct netiucv_priv *privptr;
1258 fsm_newstate(conn->fsm, CONN_STATE_IDLE);
1259 conn->prof.tx_pending--;
1260 privptr = netdev_priv(conn->netdev);
1261 if (privptr)
1262 privptr->stats.tx_errors++;
1263 if (copied)
1264 dev_kfree_skb(nskb);
1265 else {
1267 * Remove our headers. They get added
1268 * again on retransmit.
1270 skb_pull(skb, NETIUCV_HDRLEN);
1271 skb_trim(skb, skb->len - NETIUCV_HDRLEN);
1273 IUCV_DBF_TEXT_(data, 2, "rc %d from iucv_send\n", rc);
1274 } else {
1275 if (copied)
1276 dev_kfree_skb(skb);
1277 atomic_inc(&nskb->users);
1278 skb_queue_tail(&conn->commit_queue, nskb);
1282 return rc;
1286 * Interface API for upper network layers
1290 * Open an interface.
1291 * Called from generic network layer when ifconfig up is run.
1293 * @param dev Pointer to interface struct.
1295 * @return 0 on success, -ERRNO on failure. (Never fails.)
1297 static int netiucv_open(struct net_device *dev)
1299 struct netiucv_priv *priv = netdev_priv(dev);
1301 fsm_event(priv->fsm, DEV_EVENT_START, dev);
1302 return 0;
1306 * Close an interface.
1307 * Called from generic network layer when ifconfig down is run.
1309 * @param dev Pointer to interface struct.
1311 * @return 0 on success, -ERRNO on failure. (Never fails.)
1313 static int netiucv_close(struct net_device *dev)
1315 struct netiucv_priv *priv = netdev_priv(dev);
1317 fsm_event(priv->fsm, DEV_EVENT_STOP, dev);
1318 return 0;
1321 static int netiucv_pm_prepare(struct device *dev)
1323 IUCV_DBF_TEXT(trace, 3, __func__);
1324 return 0;
1327 static void netiucv_pm_complete(struct device *dev)
1329 IUCV_DBF_TEXT(trace, 3, __func__);
1330 return;
1334 * netiucv_pm_freeze() - Freeze PM callback
1335 * @dev: netiucv device
1337 * close open netiucv interfaces
1339 static int netiucv_pm_freeze(struct device *dev)
1341 struct netiucv_priv *priv = dev_get_drvdata(dev);
1342 struct net_device *ndev = NULL;
1343 int rc = 0;
1345 IUCV_DBF_TEXT(trace, 3, __func__);
1346 if (priv && priv->conn)
1347 ndev = priv->conn->netdev;
1348 if (!ndev)
1349 goto out;
1350 netif_device_detach(ndev);
1351 priv->pm_state = fsm_getstate(priv->fsm);
1352 rc = netiucv_close(ndev);
1353 out:
1354 return rc;
1358 * netiucv_pm_restore_thaw() - Thaw and restore PM callback
1359 * @dev: netiucv device
1361 * re-open netiucv interfaces closed during freeze
1363 static int netiucv_pm_restore_thaw(struct device *dev)
1365 struct netiucv_priv *priv = dev_get_drvdata(dev);
1366 struct net_device *ndev = NULL;
1367 int rc = 0;
1369 IUCV_DBF_TEXT(trace, 3, __func__);
1370 if (priv && priv->conn)
1371 ndev = priv->conn->netdev;
1372 if (!ndev)
1373 goto out;
1374 switch (priv->pm_state) {
1375 case DEV_STATE_RUNNING:
1376 case DEV_STATE_STARTWAIT:
1377 rc = netiucv_open(ndev);
1378 break;
1379 default:
1380 break;
1382 netif_device_attach(ndev);
1383 out:
1384 return rc;
1388 * Start transmission of a packet.
1389 * Called from generic network device layer.
1391 * @param skb Pointer to buffer containing the packet.
1392 * @param dev Pointer to interface struct.
1394 * @return 0 if packet consumed, !0 if packet rejected.
1395 * Note: If we return !0, then the packet is free'd by
1396 * the generic network layer.
1398 static int netiucv_tx(struct sk_buff *skb, struct net_device *dev)
1400 struct netiucv_priv *privptr = netdev_priv(dev);
1401 int rc;
1403 IUCV_DBF_TEXT(trace, 4, __func__);
1405 * Some sanity checks ...
1407 if (skb == NULL) {
1408 IUCV_DBF_TEXT(data, 2, "netiucv_tx: skb is NULL\n");
1409 privptr->stats.tx_dropped++;
1410 return NETDEV_TX_OK;
1412 if (skb_headroom(skb) < NETIUCV_HDRLEN) {
1413 IUCV_DBF_TEXT(data, 2,
1414 "netiucv_tx: skb_headroom < NETIUCV_HDRLEN\n");
1415 dev_kfree_skb(skb);
1416 privptr->stats.tx_dropped++;
1417 return NETDEV_TX_OK;
1421 * If connection is not running, try to restart it
1422 * and throw away packet.
1424 if (fsm_getstate(privptr->fsm) != DEV_STATE_RUNNING) {
1425 dev_kfree_skb(skb);
1426 privptr->stats.tx_dropped++;
1427 privptr->stats.tx_errors++;
1428 privptr->stats.tx_carrier_errors++;
1429 return NETDEV_TX_OK;
1432 if (netiucv_test_and_set_busy(dev)) {
1433 IUCV_DBF_TEXT(data, 2, "EBUSY from netiucv_tx\n");
1434 return NETDEV_TX_BUSY;
1436 dev->trans_start = jiffies;
1437 rc = netiucv_transmit_skb(privptr->conn, skb);
1438 netiucv_clear_busy(dev);
1439 return rc ? NETDEV_TX_BUSY : NETDEV_TX_OK;
1443 * netiucv_stats
1444 * @dev: Pointer to interface struct.
1446 * Returns interface statistics of a device.
1448 * Returns pointer to stats struct of this interface.
1450 static struct net_device_stats *netiucv_stats (struct net_device * dev)
1452 struct netiucv_priv *priv = netdev_priv(dev);
1454 IUCV_DBF_TEXT(trace, 5, __func__);
1455 return &priv->stats;
1459 * netiucv_change_mtu
1460 * @dev: Pointer to interface struct.
1461 * @new_mtu: The new MTU to use for this interface.
1463 * Sets MTU of an interface.
1465 * Returns 0 on success, -EINVAL if MTU is out of valid range.
1466 * (valid range is 576 .. NETIUCV_MTU_MAX).
1468 static int netiucv_change_mtu(struct net_device * dev, int new_mtu)
1470 IUCV_DBF_TEXT(trace, 3, __func__);
1471 if (new_mtu < 576 || new_mtu > NETIUCV_MTU_MAX) {
1472 IUCV_DBF_TEXT(setup, 2, "given MTU out of valid range\n");
1473 return -EINVAL;
1475 dev->mtu = new_mtu;
1476 return 0;
1480 * attributes in sysfs
1483 static ssize_t user_show(struct device *dev, struct device_attribute *attr,
1484 char *buf)
1486 struct netiucv_priv *priv = dev_get_drvdata(dev);
1488 IUCV_DBF_TEXT(trace, 5, __func__);
1489 return sprintf(buf, "%s\n", netiucv_printuser(priv->conn));
1492 static int netiucv_check_user(const char *buf, size_t count, char *username,
1493 char *userdata)
1495 const char *p;
1496 int i;
1498 p = strchr(buf, '.');
1499 if ((p && ((count > 26) ||
1500 ((p - buf) > 8) ||
1501 (buf + count - p > 18))) ||
1502 (!p && (count > 9))) {
1503 IUCV_DBF_TEXT(setup, 2, "conn_write: too long\n");
1504 return -EINVAL;
1507 for (i = 0, p = buf; i < 8 && *p && *p != '.'; i++, p++) {
1508 if (isalnum(*p) || *p == '$') {
1509 username[i] = toupper(*p);
1510 continue;
1512 if (*p == '\n')
1513 /* trailing lf, grr */
1514 break;
1515 IUCV_DBF_TEXT_(setup, 2,
1516 "conn_write: invalid character %02x\n", *p);
1517 return -EINVAL;
1519 while (i < 8)
1520 username[i++] = ' ';
1521 username[8] = '\0';
1523 if (*p == '.') {
1524 p++;
1525 for (i = 0; i < 16 && *p; i++, p++) {
1526 if (*p == '\n')
1527 break;
1528 userdata[i] = toupper(*p);
1530 while (i > 0 && i < 16)
1531 userdata[i++] = ' ';
1532 } else
1533 memcpy(userdata, iucvMagic_ascii, 16);
1534 userdata[16] = '\0';
1535 ASCEBC(userdata, 16);
1537 return 0;
1540 static ssize_t user_write(struct device *dev, struct device_attribute *attr,
1541 const char *buf, size_t count)
1543 struct netiucv_priv *priv = dev_get_drvdata(dev);
1544 struct net_device *ndev = priv->conn->netdev;
1545 char username[9];
1546 char userdata[17];
1547 int rc;
1548 struct iucv_connection *cp;
1550 IUCV_DBF_TEXT(trace, 3, __func__);
1551 rc = netiucv_check_user(buf, count, username, userdata);
1552 if (rc)
1553 return rc;
1555 if (memcmp(username, priv->conn->userid, 9) &&
1556 (ndev->flags & (IFF_UP | IFF_RUNNING))) {
1557 /* username changed while the interface is active. */
1558 IUCV_DBF_TEXT(setup, 2, "user_write: device active\n");
1559 return -EPERM;
1561 read_lock_bh(&iucv_connection_rwlock);
1562 list_for_each_entry(cp, &iucv_connection_list, list) {
1563 if (!strncmp(username, cp->userid, 9) &&
1564 !strncmp(userdata, cp->userdata, 17) && cp->netdev != ndev) {
1565 read_unlock_bh(&iucv_connection_rwlock);
1566 IUCV_DBF_TEXT_(setup, 2, "user_write: Connection to %s "
1567 "already exists\n", netiucv_printuser(cp));
1568 return -EEXIST;
1571 read_unlock_bh(&iucv_connection_rwlock);
1572 memcpy(priv->conn->userid, username, 9);
1573 memcpy(priv->conn->userdata, userdata, 17);
1574 return count;
1577 static DEVICE_ATTR(user, 0644, user_show, user_write);
1579 static ssize_t buffer_show (struct device *dev, struct device_attribute *attr,
1580 char *buf)
1582 struct netiucv_priv *priv = dev_get_drvdata(dev);
1584 IUCV_DBF_TEXT(trace, 5, __func__);
1585 return sprintf(buf, "%d\n", priv->conn->max_buffsize);
1588 static ssize_t buffer_write (struct device *dev, struct device_attribute *attr,
1589 const char *buf, size_t count)
1591 struct netiucv_priv *priv = dev_get_drvdata(dev);
1592 struct net_device *ndev = priv->conn->netdev;
1593 char *e;
1594 int bs1;
1596 IUCV_DBF_TEXT(trace, 3, __func__);
1597 if (count >= 39)
1598 return -EINVAL;
1600 bs1 = simple_strtoul(buf, &e, 0);
1602 if (e && (!isspace(*e))) {
1603 IUCV_DBF_TEXT_(setup, 2, "buffer_write: invalid char %02x\n",
1604 *e);
1605 return -EINVAL;
1607 if (bs1 > NETIUCV_BUFSIZE_MAX) {
1608 IUCV_DBF_TEXT_(setup, 2,
1609 "buffer_write: buffer size %d too large\n",
1610 bs1);
1611 return -EINVAL;
1613 if ((ndev->flags & IFF_RUNNING) &&
1614 (bs1 < (ndev->mtu + NETIUCV_HDRLEN + 2))) {
1615 IUCV_DBF_TEXT_(setup, 2,
1616 "buffer_write: buffer size %d too small\n",
1617 bs1);
1618 return -EINVAL;
1620 if (bs1 < (576 + NETIUCV_HDRLEN + NETIUCV_HDRLEN)) {
1621 IUCV_DBF_TEXT_(setup, 2,
1622 "buffer_write: buffer size %d too small\n",
1623 bs1);
1624 return -EINVAL;
1627 priv->conn->max_buffsize = bs1;
1628 if (!(ndev->flags & IFF_RUNNING))
1629 ndev->mtu = bs1 - NETIUCV_HDRLEN - NETIUCV_HDRLEN;
1631 return count;
1635 static DEVICE_ATTR(buffer, 0644, buffer_show, buffer_write);
1637 static ssize_t dev_fsm_show (struct device *dev, struct device_attribute *attr,
1638 char *buf)
1640 struct netiucv_priv *priv = dev_get_drvdata(dev);
1642 IUCV_DBF_TEXT(trace, 5, __func__);
1643 return sprintf(buf, "%s\n", fsm_getstate_str(priv->fsm));
1646 static DEVICE_ATTR(device_fsm_state, 0444, dev_fsm_show, NULL);
1648 static ssize_t conn_fsm_show (struct device *dev,
1649 struct device_attribute *attr, char *buf)
1651 struct netiucv_priv *priv = dev_get_drvdata(dev);
1653 IUCV_DBF_TEXT(trace, 5, __func__);
1654 return sprintf(buf, "%s\n", fsm_getstate_str(priv->conn->fsm));
1657 static DEVICE_ATTR(connection_fsm_state, 0444, conn_fsm_show, NULL);
1659 static ssize_t maxmulti_show (struct device *dev,
1660 struct device_attribute *attr, char *buf)
1662 struct netiucv_priv *priv = dev_get_drvdata(dev);
1664 IUCV_DBF_TEXT(trace, 5, __func__);
1665 return sprintf(buf, "%ld\n", priv->conn->prof.maxmulti);
1668 static ssize_t maxmulti_write (struct device *dev,
1669 struct device_attribute *attr,
1670 const char *buf, size_t count)
1672 struct netiucv_priv *priv = dev_get_drvdata(dev);
1674 IUCV_DBF_TEXT(trace, 4, __func__);
1675 priv->conn->prof.maxmulti = 0;
1676 return count;
1679 static DEVICE_ATTR(max_tx_buffer_used, 0644, maxmulti_show, maxmulti_write);
1681 static ssize_t maxcq_show (struct device *dev, struct device_attribute *attr,
1682 char *buf)
1684 struct netiucv_priv *priv = dev_get_drvdata(dev);
1686 IUCV_DBF_TEXT(trace, 5, __func__);
1687 return sprintf(buf, "%ld\n", priv->conn->prof.maxcqueue);
1690 static ssize_t maxcq_write (struct device *dev, struct device_attribute *attr,
1691 const char *buf, size_t count)
1693 struct netiucv_priv *priv = dev_get_drvdata(dev);
1695 IUCV_DBF_TEXT(trace, 4, __func__);
1696 priv->conn->prof.maxcqueue = 0;
1697 return count;
1700 static DEVICE_ATTR(max_chained_skbs, 0644, maxcq_show, maxcq_write);
1702 static ssize_t sdoio_show (struct device *dev, struct device_attribute *attr,
1703 char *buf)
1705 struct netiucv_priv *priv = dev_get_drvdata(dev);
1707 IUCV_DBF_TEXT(trace, 5, __func__);
1708 return sprintf(buf, "%ld\n", priv->conn->prof.doios_single);
1711 static ssize_t sdoio_write (struct device *dev, struct device_attribute *attr,
1712 const char *buf, size_t count)
1714 struct netiucv_priv *priv = dev_get_drvdata(dev);
1716 IUCV_DBF_TEXT(trace, 4, __func__);
1717 priv->conn->prof.doios_single = 0;
1718 return count;
1721 static DEVICE_ATTR(tx_single_write_ops, 0644, sdoio_show, sdoio_write);
1723 static ssize_t mdoio_show (struct device *dev, struct device_attribute *attr,
1724 char *buf)
1726 struct netiucv_priv *priv = dev_get_drvdata(dev);
1728 IUCV_DBF_TEXT(trace, 5, __func__);
1729 return sprintf(buf, "%ld\n", priv->conn->prof.doios_multi);
1732 static ssize_t mdoio_write (struct device *dev, struct device_attribute *attr,
1733 const char *buf, size_t count)
1735 struct netiucv_priv *priv = dev_get_drvdata(dev);
1737 IUCV_DBF_TEXT(trace, 5, __func__);
1738 priv->conn->prof.doios_multi = 0;
1739 return count;
1742 static DEVICE_ATTR(tx_multi_write_ops, 0644, mdoio_show, mdoio_write);
1744 static ssize_t txlen_show (struct device *dev, struct device_attribute *attr,
1745 char *buf)
1747 struct netiucv_priv *priv = dev_get_drvdata(dev);
1749 IUCV_DBF_TEXT(trace, 5, __func__);
1750 return sprintf(buf, "%ld\n", priv->conn->prof.txlen);
1753 static ssize_t txlen_write (struct device *dev, struct device_attribute *attr,
1754 const char *buf, size_t count)
1756 struct netiucv_priv *priv = dev_get_drvdata(dev);
1758 IUCV_DBF_TEXT(trace, 4, __func__);
1759 priv->conn->prof.txlen = 0;
1760 return count;
1763 static DEVICE_ATTR(netto_bytes, 0644, txlen_show, txlen_write);
1765 static ssize_t txtime_show (struct device *dev, struct device_attribute *attr,
1766 char *buf)
1768 struct netiucv_priv *priv = dev_get_drvdata(dev);
1770 IUCV_DBF_TEXT(trace, 5, __func__);
1771 return sprintf(buf, "%ld\n", priv->conn->prof.tx_time);
1774 static ssize_t txtime_write (struct device *dev, struct device_attribute *attr,
1775 const char *buf, size_t count)
1777 struct netiucv_priv *priv = dev_get_drvdata(dev);
1779 IUCV_DBF_TEXT(trace, 4, __func__);
1780 priv->conn->prof.tx_time = 0;
1781 return count;
1784 static DEVICE_ATTR(max_tx_io_time, 0644, txtime_show, txtime_write);
1786 static ssize_t txpend_show (struct device *dev, struct device_attribute *attr,
1787 char *buf)
1789 struct netiucv_priv *priv = dev_get_drvdata(dev);
1791 IUCV_DBF_TEXT(trace, 5, __func__);
1792 return sprintf(buf, "%ld\n", priv->conn->prof.tx_pending);
1795 static ssize_t txpend_write (struct device *dev, struct device_attribute *attr,
1796 const char *buf, size_t count)
1798 struct netiucv_priv *priv = dev_get_drvdata(dev);
1800 IUCV_DBF_TEXT(trace, 4, __func__);
1801 priv->conn->prof.tx_pending = 0;
1802 return count;
1805 static DEVICE_ATTR(tx_pending, 0644, txpend_show, txpend_write);
1807 static ssize_t txmpnd_show (struct device *dev, struct device_attribute *attr,
1808 char *buf)
1810 struct netiucv_priv *priv = dev_get_drvdata(dev);
1812 IUCV_DBF_TEXT(trace, 5, __func__);
1813 return sprintf(buf, "%ld\n", priv->conn->prof.tx_max_pending);
1816 static ssize_t txmpnd_write (struct device *dev, struct device_attribute *attr,
1817 const char *buf, size_t count)
1819 struct netiucv_priv *priv = dev_get_drvdata(dev);
1821 IUCV_DBF_TEXT(trace, 4, __func__);
1822 priv->conn->prof.tx_max_pending = 0;
1823 return count;
1826 static DEVICE_ATTR(tx_max_pending, 0644, txmpnd_show, txmpnd_write);
1828 static struct attribute *netiucv_attrs[] = {
1829 &dev_attr_buffer.attr,
1830 &dev_attr_user.attr,
1831 NULL,
1834 static struct attribute_group netiucv_attr_group = {
1835 .attrs = netiucv_attrs,
1838 static struct attribute *netiucv_stat_attrs[] = {
1839 &dev_attr_device_fsm_state.attr,
1840 &dev_attr_connection_fsm_state.attr,
1841 &dev_attr_max_tx_buffer_used.attr,
1842 &dev_attr_max_chained_skbs.attr,
1843 &dev_attr_tx_single_write_ops.attr,
1844 &dev_attr_tx_multi_write_ops.attr,
1845 &dev_attr_netto_bytes.attr,
1846 &dev_attr_max_tx_io_time.attr,
1847 &dev_attr_tx_pending.attr,
1848 &dev_attr_tx_max_pending.attr,
1849 NULL,
1852 static struct attribute_group netiucv_stat_attr_group = {
1853 .name = "stats",
1854 .attrs = netiucv_stat_attrs,
1857 static int netiucv_add_files(struct device *dev)
1859 int ret;
1861 IUCV_DBF_TEXT(trace, 3, __func__);
1862 ret = sysfs_create_group(&dev->kobj, &netiucv_attr_group);
1863 if (ret)
1864 return ret;
1865 ret = sysfs_create_group(&dev->kobj, &netiucv_stat_attr_group);
1866 if (ret)
1867 sysfs_remove_group(&dev->kobj, &netiucv_attr_group);
1868 return ret;
1871 static void netiucv_remove_files(struct device *dev)
1873 IUCV_DBF_TEXT(trace, 3, __func__);
1874 sysfs_remove_group(&dev->kobj, &netiucv_stat_attr_group);
1875 sysfs_remove_group(&dev->kobj, &netiucv_attr_group);
1878 static int netiucv_register_device(struct net_device *ndev)
1880 struct netiucv_priv *priv = netdev_priv(ndev);
1881 struct device *dev = kzalloc(sizeof(struct device), GFP_KERNEL);
1882 int ret;
1884 IUCV_DBF_TEXT(trace, 3, __func__);
1886 if (dev) {
1887 dev_set_name(dev, "net%s", ndev->name);
1888 dev->bus = &iucv_bus;
1889 dev->parent = iucv_root;
1891 * The release function could be called after the
1892 * module has been unloaded. It's _only_ task is to
1893 * free the struct. Therefore, we specify kfree()
1894 * directly here. (Probably a little bit obfuscating
1895 * but legitime ...).
1897 dev->release = (void (*)(struct device *))kfree;
1898 dev->driver = &netiucv_driver;
1899 } else
1900 return -ENOMEM;
1902 ret = device_register(dev);
1903 if (ret) {
1904 put_device(dev);
1905 return ret;
1907 ret = netiucv_add_files(dev);
1908 if (ret)
1909 goto out_unreg;
1910 priv->dev = dev;
1911 dev_set_drvdata(dev, priv);
1912 return 0;
1914 out_unreg:
1915 device_unregister(dev);
1916 return ret;
1919 static void netiucv_unregister_device(struct device *dev)
1921 IUCV_DBF_TEXT(trace, 3, __func__);
1922 netiucv_remove_files(dev);
1923 device_unregister(dev);
1927 * Allocate and initialize a new connection structure.
1928 * Add it to the list of netiucv connections;
1930 static struct iucv_connection *netiucv_new_connection(struct net_device *dev,
1931 char *username,
1932 char *userdata)
1934 struct iucv_connection *conn;
1936 conn = kzalloc(sizeof(*conn), GFP_KERNEL);
1937 if (!conn)
1938 goto out;
1939 skb_queue_head_init(&conn->collect_queue);
1940 skb_queue_head_init(&conn->commit_queue);
1941 spin_lock_init(&conn->collect_lock);
1942 conn->max_buffsize = NETIUCV_BUFSIZE_DEFAULT;
1943 conn->netdev = dev;
1945 conn->rx_buff = alloc_skb(conn->max_buffsize, GFP_KERNEL | GFP_DMA);
1946 if (!conn->rx_buff)
1947 goto out_conn;
1948 conn->tx_buff = alloc_skb(conn->max_buffsize, GFP_KERNEL | GFP_DMA);
1949 if (!conn->tx_buff)
1950 goto out_rx;
1951 conn->fsm = init_fsm("netiucvconn", conn_state_names,
1952 conn_event_names, NR_CONN_STATES,
1953 NR_CONN_EVENTS, conn_fsm, CONN_FSM_LEN,
1954 GFP_KERNEL);
1955 if (!conn->fsm)
1956 goto out_tx;
1958 fsm_settimer(conn->fsm, &conn->timer);
1959 fsm_newstate(conn->fsm, CONN_STATE_INVALID);
1961 if (userdata)
1962 memcpy(conn->userdata, userdata, 17);
1963 if (username) {
1964 memcpy(conn->userid, username, 9);
1965 fsm_newstate(conn->fsm, CONN_STATE_STOPPED);
1968 write_lock_bh(&iucv_connection_rwlock);
1969 list_add_tail(&conn->list, &iucv_connection_list);
1970 write_unlock_bh(&iucv_connection_rwlock);
1971 return conn;
1973 out_tx:
1974 kfree_skb(conn->tx_buff);
1975 out_rx:
1976 kfree_skb(conn->rx_buff);
1977 out_conn:
1978 kfree(conn);
1979 out:
1980 return NULL;
1984 * Release a connection structure and remove it from the
1985 * list of netiucv connections.
1987 static void netiucv_remove_connection(struct iucv_connection *conn)
1990 IUCV_DBF_TEXT(trace, 3, __func__);
1991 write_lock_bh(&iucv_connection_rwlock);
1992 list_del_init(&conn->list);
1993 write_unlock_bh(&iucv_connection_rwlock);
1994 fsm_deltimer(&conn->timer);
1995 netiucv_purge_skb_queue(&conn->collect_queue);
1996 if (conn->path) {
1997 iucv_path_sever(conn->path, conn->userdata);
1998 kfree(conn->path);
1999 conn->path = NULL;
2001 netiucv_purge_skb_queue(&conn->commit_queue);
2002 kfree_fsm(conn->fsm);
2003 kfree_skb(conn->rx_buff);
2004 kfree_skb(conn->tx_buff);
2008 * Release everything of a net device.
2010 static void netiucv_free_netdevice(struct net_device *dev)
2012 struct netiucv_priv *privptr = netdev_priv(dev);
2014 IUCV_DBF_TEXT(trace, 3, __func__);
2016 if (!dev)
2017 return;
2019 if (privptr) {
2020 if (privptr->conn)
2021 netiucv_remove_connection(privptr->conn);
2022 if (privptr->fsm)
2023 kfree_fsm(privptr->fsm);
2024 privptr->conn = NULL; privptr->fsm = NULL;
2025 /* privptr gets freed by free_netdev() */
2027 free_netdev(dev);
2031 * Initialize a net device. (Called from kernel in alloc_netdev())
2033 static const struct net_device_ops netiucv_netdev_ops = {
2034 .ndo_open = netiucv_open,
2035 .ndo_stop = netiucv_close,
2036 .ndo_get_stats = netiucv_stats,
2037 .ndo_start_xmit = netiucv_tx,
2038 .ndo_change_mtu = netiucv_change_mtu,
2041 static void netiucv_setup_netdevice(struct net_device *dev)
2043 dev->mtu = NETIUCV_MTU_DEFAULT;
2044 dev->destructor = netiucv_free_netdevice;
2045 dev->hard_header_len = NETIUCV_HDRLEN;
2046 dev->addr_len = 0;
2047 dev->type = ARPHRD_SLIP;
2048 dev->tx_queue_len = NETIUCV_QUEUELEN_DEFAULT;
2049 dev->flags = IFF_POINTOPOINT | IFF_NOARP;
2050 dev->netdev_ops = &netiucv_netdev_ops;
2054 * Allocate and initialize everything of a net device.
2056 static struct net_device *netiucv_init_netdevice(char *username, char *userdata)
2058 struct netiucv_priv *privptr;
2059 struct net_device *dev;
2061 dev = alloc_netdev(sizeof(struct netiucv_priv), "iucv%d",
2062 netiucv_setup_netdevice);
2063 if (!dev)
2064 return NULL;
2065 if (dev_alloc_name(dev, dev->name) < 0)
2066 goto out_netdev;
2068 privptr = netdev_priv(dev);
2069 privptr->fsm = init_fsm("netiucvdev", dev_state_names,
2070 dev_event_names, NR_DEV_STATES, NR_DEV_EVENTS,
2071 dev_fsm, DEV_FSM_LEN, GFP_KERNEL);
2072 if (!privptr->fsm)
2073 goto out_netdev;
2075 privptr->conn = netiucv_new_connection(dev, username, userdata);
2076 if (!privptr->conn) {
2077 IUCV_DBF_TEXT(setup, 2, "NULL from netiucv_new_connection\n");
2078 goto out_fsm;
2080 fsm_newstate(privptr->fsm, DEV_STATE_STOPPED);
2081 return dev;
2083 out_fsm:
2084 kfree_fsm(privptr->fsm);
2085 out_netdev:
2086 free_netdev(dev);
2087 return NULL;
2090 static ssize_t conn_write(struct device_driver *drv,
2091 const char *buf, size_t count)
2093 char username[9];
2094 char userdata[17];
2095 int rc;
2096 struct net_device *dev;
2097 struct netiucv_priv *priv;
2098 struct iucv_connection *cp;
2100 IUCV_DBF_TEXT(trace, 3, __func__);
2101 rc = netiucv_check_user(buf, count, username, userdata);
2102 if (rc)
2103 return rc;
2105 read_lock_bh(&iucv_connection_rwlock);
2106 list_for_each_entry(cp, &iucv_connection_list, list) {
2107 if (!strncmp(username, cp->userid, 9) &&
2108 !strncmp(userdata, cp->userdata, 17)) {
2109 read_unlock_bh(&iucv_connection_rwlock);
2110 IUCV_DBF_TEXT_(setup, 2, "conn_write: Connection to %s "
2111 "already exists\n", netiucv_printuser(cp));
2112 return -EEXIST;
2115 read_unlock_bh(&iucv_connection_rwlock);
2117 dev = netiucv_init_netdevice(username, userdata);
2118 if (!dev) {
2119 IUCV_DBF_TEXT(setup, 2, "NULL from netiucv_init_netdevice\n");
2120 return -ENODEV;
2123 rc = netiucv_register_device(dev);
2124 if (rc) {
2125 IUCV_DBF_TEXT_(setup, 2,
2126 "ret %d from netiucv_register_device\n", rc);
2127 goto out_free_ndev;
2130 /* sysfs magic */
2131 priv = netdev_priv(dev);
2132 SET_NETDEV_DEV(dev, priv->dev);
2134 rc = register_netdev(dev);
2135 if (rc)
2136 goto out_unreg;
2138 dev_info(priv->dev, "The IUCV interface to %s has been established "
2139 "successfully\n",
2140 netiucv_printuser(priv->conn));
2142 return count;
2144 out_unreg:
2145 netiucv_unregister_device(priv->dev);
2146 out_free_ndev:
2147 netiucv_free_netdevice(dev);
2148 return rc;
2151 static DRIVER_ATTR(connection, 0200, NULL, conn_write);
2153 static ssize_t remove_write (struct device_driver *drv,
2154 const char *buf, size_t count)
2156 struct iucv_connection *cp;
2157 struct net_device *ndev;
2158 struct netiucv_priv *priv;
2159 struct device *dev;
2160 char name[IFNAMSIZ];
2161 const char *p;
2162 int i;
2164 IUCV_DBF_TEXT(trace, 3, __func__);
2166 if (count >= IFNAMSIZ)
2167 count = IFNAMSIZ - 1;
2169 for (i = 0, p = buf; i < count && *p; i++, p++) {
2170 if (*p == '\n' || *p == ' ')
2171 /* trailing lf, grr */
2172 break;
2173 name[i] = *p;
2175 name[i] = '\0';
2177 read_lock_bh(&iucv_connection_rwlock);
2178 list_for_each_entry(cp, &iucv_connection_list, list) {
2179 ndev = cp->netdev;
2180 priv = netdev_priv(ndev);
2181 dev = priv->dev;
2182 if (strncmp(name, ndev->name, count))
2183 continue;
2184 read_unlock_bh(&iucv_connection_rwlock);
2185 if (ndev->flags & (IFF_UP | IFF_RUNNING)) {
2186 dev_warn(dev, "The IUCV device is connected"
2187 " to %s and cannot be removed\n",
2188 priv->conn->userid);
2189 IUCV_DBF_TEXT(data, 2, "remove_write: still active\n");
2190 return -EPERM;
2192 unregister_netdev(ndev);
2193 netiucv_unregister_device(dev);
2194 return count;
2196 read_unlock_bh(&iucv_connection_rwlock);
2197 IUCV_DBF_TEXT(data, 2, "remove_write: unknown device\n");
2198 return -EINVAL;
2201 static DRIVER_ATTR(remove, 0200, NULL, remove_write);
2203 static struct attribute * netiucv_drv_attrs[] = {
2204 &driver_attr_connection.attr,
2205 &driver_attr_remove.attr,
2206 NULL,
2209 static struct attribute_group netiucv_drv_attr_group = {
2210 .attrs = netiucv_drv_attrs,
2213 static const struct attribute_group *netiucv_drv_attr_groups[] = {
2214 &netiucv_drv_attr_group,
2215 NULL,
2218 static void netiucv_banner(void)
2220 pr_info("driver initialized\n");
2223 static void __exit netiucv_exit(void)
2225 struct iucv_connection *cp;
2226 struct net_device *ndev;
2227 struct netiucv_priv *priv;
2228 struct device *dev;
2230 IUCV_DBF_TEXT(trace, 3, __func__);
2231 while (!list_empty(&iucv_connection_list)) {
2232 cp = list_entry(iucv_connection_list.next,
2233 struct iucv_connection, list);
2234 ndev = cp->netdev;
2235 priv = netdev_priv(ndev);
2236 dev = priv->dev;
2238 unregister_netdev(ndev);
2239 netiucv_unregister_device(dev);
2242 device_unregister(netiucv_dev);
2243 driver_unregister(&netiucv_driver);
2244 iucv_unregister(&netiucv_handler, 1);
2245 iucv_unregister_dbf_views();
2247 pr_info("driver unloaded\n");
2248 return;
2251 static int __init netiucv_init(void)
2253 int rc;
2255 rc = iucv_register_dbf_views();
2256 if (rc)
2257 goto out;
2258 rc = iucv_register(&netiucv_handler, 1);
2259 if (rc)
2260 goto out_dbf;
2261 IUCV_DBF_TEXT(trace, 3, __func__);
2262 netiucv_driver.groups = netiucv_drv_attr_groups;
2263 rc = driver_register(&netiucv_driver);
2264 if (rc) {
2265 IUCV_DBF_TEXT_(setup, 2, "ret %d from driver_register\n", rc);
2266 goto out_iucv;
2268 /* establish dummy device */
2269 netiucv_dev = kzalloc(sizeof(struct device), GFP_KERNEL);
2270 if (!netiucv_dev) {
2271 rc = -ENOMEM;
2272 goto out_driver;
2274 dev_set_name(netiucv_dev, "netiucv");
2275 netiucv_dev->bus = &iucv_bus;
2276 netiucv_dev->parent = iucv_root;
2277 netiucv_dev->release = (void (*)(struct device *))kfree;
2278 netiucv_dev->driver = &netiucv_driver;
2279 rc = device_register(netiucv_dev);
2280 if (rc) {
2281 put_device(netiucv_dev);
2282 goto out_driver;
2284 netiucv_banner();
2285 return rc;
2287 out_driver:
2288 driver_unregister(&netiucv_driver);
2289 out_iucv:
2290 iucv_unregister(&netiucv_handler, 1);
2291 out_dbf:
2292 iucv_unregister_dbf_views();
2293 out:
2294 return rc;
2297 module_init(netiucv_init);
2298 module_exit(netiucv_exit);
2299 MODULE_LICENSE("GPL");