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