drivers/s390/net/ctcmain.c

   1 /*
   2  * $Id: ctcmain.c,v 1.65 2004/10/27 09:12:48 mschwide Exp $
   3  *
   4  * CTC / ESCON network driver
   5  *
   6  * Copyright (C) 2001 IBM Deutschland Entwicklung GmbH, IBM Corporation
   7  * Author(s): Fritz Elfert (elfert@de.ibm.com, felfert@millenux.com)
   8  * Fixes by : Jochen Röhrig (roehrig@de.ibm.com)
   9  *            Arnaldo Carvalho de Melo <acme@conectiva.com.br>
  10  * Driver Model stuff by : Cornelia Huck <cohuck@de.ibm.com>
  11  *
  12  * Documentation used:
  13  *  - Principles of Operation (IBM doc#: SA22-7201-06)
  14  *  - Common IO/-Device Commands and Self Description (IBM doc#: SA22-7204-02)
  15  *  - Common IO/-Device Commands and Self Description (IBM doc#: SN22-5535)
  16  *  - ESCON Channel-to-Channel Adapter (IBM doc#: SA22-7203-00)
  17  *  - ESCON I/O Interface (IBM doc#: SA22-7202-029
  18  *
  19  * and the source of the original CTC driver by:
  20  *  Dieter Wellerdiek (wel@de.ibm.com)
  21  *  Martin Schwidefsky (schwidefsky@de.ibm.com)
  22  *  Denis Joseph Barrow (djbarrow@de.ibm.com,barrow_dj@yahoo.com)
  23  *  Jochen Röhrig (roehrig@de.ibm.com)
  24  *
  25  * This program is free software; you can redistribute it and/or modify
  26  * it under the terms of the GNU General Public License as published by
  27  * the Free Software Foundation; either version 2, or (at your option)
  28  * any later version.
  29  *
  30  * This program is distributed in the hope that it will be useful,
  31  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  32  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  33  * GNU General Public License for more details.
  34  *
  35  * You should have received a copy of the GNU General Public License
  36  * along with this program; if not, write to the Free Software
  37  * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  38  *
  39  * RELEASE-TAG: CTC/ESCON network driver $Revision: 1.65 $
  40  *
  41  */
  42 \f
  43 #undef DEBUG
  44
  45 #include <linux/module.h>
  46 #include <linux/init.h>
  47 #include <linux/kernel.h>
  48 #include <linux/slab.h>
  49 #include <linux/errno.h>
  50 #include <linux/types.h>
  51 #include <linux/interrupt.h>
  52 #include <linux/timer.h>
  53 #include <linux/sched.h>
  54 #include <linux/bitops.h>
  55
  56 #include <linux/signal.h>
  57 #include <linux/string.h>
  58
  59 #include <linux/ip.h>
  60 #include <linux/if_arp.h>
  61 #include <linux/tcp.h>
  62 #include <linux/skbuff.h>
  63 #include <linux/ctype.h>
  64 #include <net/dst.h>
  65
  66 #include <asm/io.h>
  67 #include <asm/ccwdev.h>
  68 #include <asm/ccwgroup.h>
  69 #include <asm/uaccess.h>
  70
  71 #include <asm/idals.h>
  72
  73 #include "ctctty.h"
  74 #include "fsm.h"
  75 #include "cu3088.h"
  76 #include "ctcdbug.h"
  77
  78 MODULE_AUTHOR("(C) 2000 IBM Corp. by Fritz Elfert (felfert@millenux.com)");
  79 MODULE_DESCRIPTION("Linux for S/390 CTC/Escon Driver");
  80 MODULE_LICENSE("GPL");
  81
  82 /**
  83  * CCW commands, used in this driver.
  84  */
  85 #define CCW_CMD_WRITE           0x01
  86 #define CCW_CMD_READ            0x02
  87 #define CCW_CMD_SET_EXTENDED    0xc3
  88 #define CCW_CMD_PREPARE         0xe3
  89
  90 #define CTC_PROTO_S390          0
  91 #define CTC_PROTO_LINUX         1
  92 #define CTC_PROTO_LINUX_TTY     2
  93 #define CTC_PROTO_OS390         3
  94 #define CTC_PROTO_MAX           3
  95
  96 #define CTC_BUFSIZE_LIMIT       65535
  97 #define CTC_BUFSIZE_DEFAULT     32768
  98
  99 #define CTC_TIMEOUT_5SEC        5000
 100
 101 #define CTC_INITIAL_BLOCKLEN    2
 102
 103 #define READ                    0
 104 #define WRITE                   1
 105
 106 #define CTC_ID_SIZE             BUS_ID_SIZE+3
 107 \f
 108
 109 struct ctc_profile {
 110         unsigned long maxmulti;
 111         unsigned long maxcqueue;
 112         unsigned long doios_single;
 113         unsigned long doios_multi;
 114         unsigned long txlen;
 115         unsigned long tx_time;
 116         struct timespec send_stamp;
 117 };
 118
 119 /**
 120  * Definition of one channel
 121  */
 122 struct channel {
 123
 124         /**
 125          * Pointer to next channel in list.
 126          */
 127         struct channel *next;
 128         char id[CTC_ID_SIZE];
 129         struct ccw_device *cdev;
 130
 131         /**
 132          * Type of this channel.
 133          * CTC/A or Escon for valid channels.
 134          */
 135         enum channel_types type;
 136
 137         /**
 138          * Misc. flags. See CHANNEL_FLAGS_... below
 139          */
 140         __u32 flags;
 141
 142         /**
 143          * The protocol of this channel
 144          */
 145         __u16 protocol;
 146
 147         /**
 148          * I/O and irq related stuff
 149          */
 150         struct ccw1 *ccw;
 151         struct irb *irb;
 152
 153         /**
 154          * RX/TX buffer size
 155          */
 156         int max_bufsize;
 157
 158         /**
 159          * Transmit/Receive buffer.
 160          */
 161         struct sk_buff *trans_skb;
 162
 163         /**
 164          * Universal I/O queue.
 165          */
 166         struct sk_buff_head io_queue;
 167
 168         /**
 169          * TX queue for collecting skb's during busy.
 170          */
 171         struct sk_buff_head collect_queue;
 172
 173         /**
 174          * Amount of data in collect_queue.
 175          */
 176         int collect_len;
 177
 178         /**
 179          * spinlock for collect_queue and collect_len
 180          */
 181         spinlock_t collect_lock;
 182
 183         /**
 184          * Timer for detecting unresposive
 185          * I/O operations.
 186          */
 187         fsm_timer timer;
 188
 189         /**
 190          * Retry counter for misc. operations.
 191          */
 192         int retry;
 193
 194         /**
 195          * The finite state machine of this channel
 196          */
 197         fsm_instance *fsm;
 198
 199         /**
 200          * The corresponding net_device this channel
 201          * belongs to.
 202          */
 203         struct net_device *netdev;
 204
 205         struct ctc_profile prof;
 206
 207         unsigned char *trans_skb_data;
 208
 209         __u16 logflags;
 210 };
 211
 212 #define CHANNEL_FLAGS_READ            0
 213 #define CHANNEL_FLAGS_WRITE           1
 214 #define CHANNEL_FLAGS_INUSE           2
 215 #define CHANNEL_FLAGS_BUFSIZE_CHANGED 4
 216 #define CHANNEL_FLAGS_FAILED          8
 217 #define CHANNEL_FLAGS_WAITIRQ        16
 218 #define CHANNEL_FLAGS_RWMASK 1
 219 #define CHANNEL_DIRECTION(f) (f & CHANNEL_FLAGS_RWMASK)
 220
 221 #define LOG_FLAG_ILLEGALPKT  1
 222 #define LOG_FLAG_ILLEGALSIZE 2
 223 #define LOG_FLAG_OVERRUN     4
 224 #define LOG_FLAG_NOMEM       8
 225
 226 #define CTC_LOGLEVEL_INFO     1
 227 #define CTC_LOGLEVEL_NOTICE   2
 228 #define CTC_LOGLEVEL_WARN     4
 229 #define CTC_LOGLEVEL_EMERG    8
 230 #define CTC_LOGLEVEL_ERR     16
 231 #define CTC_LOGLEVEL_DEBUG   32
 232 #define CTC_LOGLEVEL_CRIT    64
 233
 234 #define CTC_LOGLEVEL_DEFAULT \
 235 (CTC_LOGLEVEL_INFO | CTC_LOGLEVEL_NOTICE | CTC_LOGLEVEL_WARN | CTC_LOGLEVEL_CRIT)
 236
 237 #define CTC_LOGLEVEL_MAX     ((CTC_LOGLEVEL_CRIT<<1)-1)
 238
 239 static int loglevel = CTC_LOGLEVEL_DEFAULT;
 240
 241 #define ctc_pr_debug(fmt, arg...) \
 242 do { if (loglevel & CTC_LOGLEVEL_DEBUG) printk(KERN_DEBUG fmt,##arg); } while (0)
 243
 244 #define ctc_pr_info(fmt, arg...) \
 245 do { if (loglevel & CTC_LOGLEVEL_INFO) printk(KERN_INFO fmt,##arg); } while (0)
 246
 247 #define ctc_pr_notice(fmt, arg...) \
 248 do { if (loglevel & CTC_LOGLEVEL_NOTICE) printk(KERN_NOTICE fmt,##arg); } while (0)
 249
 250 #define ctc_pr_warn(fmt, arg...) \
 251 do { if (loglevel & CTC_LOGLEVEL_WARN) printk(KERN_WARNING fmt,##arg); } while (0)
 252
 253 #define ctc_pr_emerg(fmt, arg...) \
 254 do { if (loglevel & CTC_LOGLEVEL_EMERG) printk(KERN_EMERG fmt,##arg); } while (0)
 255
 256 #define ctc_pr_err(fmt, arg...) \
 257 do { if (loglevel & CTC_LOGLEVEL_ERR) printk(KERN_ERR fmt,##arg); } while (0)
 258
 259 #define ctc_pr_crit(fmt, arg...) \
 260 do { if (loglevel & CTC_LOGLEVEL_CRIT) printk(KERN_CRIT fmt,##arg); } while (0)
 261
 262 /**
 263  * Linked list of all detected channels.
 264  */
 265 static struct channel *channels = NULL;
 266
 267 struct ctc_priv {
 268         struct net_device_stats stats;
 269         unsigned long tbusy;
 270         /**
 271          * The finite state machine of this interface.
 272          */
 273         fsm_instance *fsm;
 274         /**
 275          * The protocol of this device
 276          */
 277         __u16 protocol;
 278         /**
 279          * Timer for restarting after I/O Errors
 280          */
 281         fsm_timer               restart_timer;
 282
 283         struct channel *channel[2];
 284 };
 285
 286 /**
 287  * Definition of our link level header.
 288  */
 289 struct ll_header {
 290         __u16 length;
 291         __u16 type;
 292         __u16 unused;
 293 };
 294 #define LL_HEADER_LENGTH (sizeof(struct ll_header))
 295
 296 /**
 297  * Compatibility macros for busy handling
 298  * of network devices.
 299  */
 300 static __inline__ void
 301 ctc_clear_busy(struct net_device * dev)
 302 {
 303         clear_bit(0, &(((struct ctc_priv *) dev->priv)->tbusy));
 304         if (((struct ctc_priv *)dev->priv)->protocol != CTC_PROTO_LINUX_TTY)
 305                 netif_wake_queue(dev);
 306 }
 307
 308 static __inline__ int
 309 ctc_test_and_set_busy(struct net_device * dev)
 310 {
 311         if (((struct ctc_priv *)dev->priv)->protocol != CTC_PROTO_LINUX_TTY)
 312                 netif_stop_queue(dev);
 313         return test_and_set_bit(0, &((struct ctc_priv *) dev->priv)->tbusy);
 314 }
 315
 316 /**
 317  * Print Banner.
 318  */
 319 static void
 320 print_banner(void)
 321 {
 322         static int printed = 0;
 323         char vbuf[] = "$Revision: 1.65 $";
 324         char *version = vbuf;
 325
 326         if (printed)
 327                 return;
 328         if ((version = strchr(version, ':'))) {
 329                 char *p = strchr(version + 1, '$');
 330                 if (p)
 331                         *p = '\0';
 332         } else
 333                 version = " ??? ";
 334         printk(KERN_INFO "CTC driver Version%s"
 335 #ifdef DEBUG
 336                     " (DEBUG-VERSION, " __DATE__ __TIME__ ")"
 337 #endif
 338                     " initialized\n", version);
 339         printed = 1;
 340 }
 341 \f
 342 /**
 343  * Return type of a detected device.
 344  */
 345 static enum channel_types
 346 get_channel_type(struct ccw_device_id *id)
 347 {
 348         enum channel_types type = (enum channel_types) id->driver_info;
 349
 350         if (type == channel_type_ficon)
 351                 type = channel_type_escon;
 352
 353         return type;
 354 }
 355 \f
 356 /**
 357  * States of the interface statemachine.
 358  */
 359 enum dev_states {
 360         DEV_STATE_STOPPED,
 361         DEV_STATE_STARTWAIT_RXTX,
 362         DEV_STATE_STARTWAIT_RX,
 363         DEV_STATE_STARTWAIT_TX,
 364         DEV_STATE_STOPWAIT_RXTX,
 365         DEV_STATE_STOPWAIT_RX,
 366         DEV_STATE_STOPWAIT_TX,
 367         DEV_STATE_RUNNING,
 368         /**
 369          * MUST be always the last element!!
 370          */
 371         NR_DEV_STATES
 372 };
 373
 374 static const char *dev_state_names[] = {
 375         "Stopped",
 376         "StartWait RXTX",
 377         "StartWait RX",
 378         "StartWait TX",
 379         "StopWait RXTX",
 380         "StopWait RX",
 381         "StopWait TX",
 382         "Running",
 383 };
 384
 385 /**
 386  * Events of the interface statemachine.
 387  */
 388 enum dev_events {
 389         DEV_EVENT_START,
 390         DEV_EVENT_STOP,
 391         DEV_EVENT_RXUP,
 392         DEV_EVENT_TXUP,
 393         DEV_EVENT_RXDOWN,
 394         DEV_EVENT_TXDOWN,
 395         DEV_EVENT_RESTART,
 396         /**
 397          * MUST be always the last element!!
 398          */
 399         NR_DEV_EVENTS
 400 };
 401
 402 static const char *dev_event_names[] = {
 403         "Start",
 404         "Stop",
 405         "RX up",
 406         "TX up",
 407         "RX down",
 408         "TX down",
 409         "Restart",
 410 };
 411 \f
 412 /**
 413  * Events of the channel statemachine
 414  */
 415 enum ch_events {
 416         /**
 417          * Events, representing return code of
 418          * I/O operations (ccw_device_start, ccw_device_halt et al.)
 419          */
 420         CH_EVENT_IO_SUCCESS,
 421         CH_EVENT_IO_EBUSY,
 422         CH_EVENT_IO_ENODEV,
 423         CH_EVENT_IO_EIO,
 424         CH_EVENT_IO_UNKNOWN,
 425
 426         CH_EVENT_ATTNBUSY,
 427         CH_EVENT_ATTN,
 428         CH_EVENT_BUSY,
 429
 430         /**
 431          * Events, representing unit-check
 432          */
 433         CH_EVENT_UC_RCRESET,
 434         CH_EVENT_UC_RSRESET,
 435         CH_EVENT_UC_TXTIMEOUT,
 436         CH_EVENT_UC_TXPARITY,
 437         CH_EVENT_UC_HWFAIL,
 438         CH_EVENT_UC_RXPARITY,
 439         CH_EVENT_UC_ZERO,
 440         CH_EVENT_UC_UNKNOWN,
 441
 442         /**
 443          * Events, representing subchannel-check
 444          */
 445         CH_EVENT_SC_UNKNOWN,
 446
 447         /**
 448          * Events, representing machine checks
 449          */
 450         CH_EVENT_MC_FAIL,
 451         CH_EVENT_MC_GOOD,
 452
 453         /**
 454          * Event, representing normal IRQ
 455          */
 456         CH_EVENT_IRQ,
 457         CH_EVENT_FINSTAT,
 458
 459         /**
 460          * Event, representing timer expiry.
 461          */
 462         CH_EVENT_TIMER,
 463
 464         /**
 465          * Events, representing commands from upper levels.
 466          */
 467         CH_EVENT_START,
 468         CH_EVENT_STOP,
 469
 470         /**
 471          * MUST be always the last element!!
 472          */
 473         NR_CH_EVENTS,
 474 };
 475
 476 static const char *ch_event_names[] = {
 477         "ccw_device success",
 478         "ccw_device busy",
 479         "ccw_device enodev",
 480         "ccw_device ioerr",
 481         "ccw_device unknown",
 482
 483         "Status ATTN & BUSY",
 484         "Status ATTN",
 485         "Status BUSY",
 486
 487         "Unit check remote reset",
 488         "Unit check remote system reset",
 489         "Unit check TX timeout",
 490         "Unit check TX parity",
 491         "Unit check Hardware failure",
 492         "Unit check RX parity",
 493         "Unit check ZERO",
 494         "Unit check Unknown",
 495
 496         "SubChannel check Unknown",
 497
 498         "Machine check failure",
 499         "Machine check operational",
 500
 501         "IRQ normal",
 502         "IRQ final",
 503
 504         "Timer",
 505
 506         "Start",
 507         "Stop",
 508 };
 509
 510 /**
 511  * States of the channel statemachine.
 512  */
 513 enum ch_states {
 514         /**
 515          * Channel not assigned to any device,
 516          * initial state, direction invalid
 517          */
 518         CH_STATE_IDLE,
 519
 520         /**
 521          * Channel assigned but not operating
 522          */
 523         CH_STATE_STOPPED,
 524         CH_STATE_STARTWAIT,
 525         CH_STATE_STARTRETRY,
 526         CH_STATE_SETUPWAIT,
 527         CH_STATE_RXINIT,
 528         CH_STATE_TXINIT,
 529         CH_STATE_RX,
 530         CH_STATE_TX,
 531         CH_STATE_RXIDLE,
 532         CH_STATE_TXIDLE,
 533         CH_STATE_RXERR,
 534         CH_STATE_TXERR,
 535         CH_STATE_TERM,
 536         CH_STATE_DTERM,
 537         CH_STATE_NOTOP,
 538
 539         /**
 540          * MUST be always the last element!!
 541          */
 542         NR_CH_STATES,
 543 };
 544
 545 static const char *ch_state_names[] = {
 546         "Idle",
 547         "Stopped",
 548         "StartWait",
 549         "StartRetry",
 550         "SetupWait",
 551         "RX init",
 552         "TX init",
 553         "RX",
 554         "TX",
 555         "RX idle",
 556         "TX idle",
 557         "RX error",
 558         "TX error",
 559         "Terminating",
 560         "Restarting",
 561         "Not operational",
 562 };
 563 \f
 564 #ifdef DEBUG
 565 /**
 566  * Dump header and first 16 bytes of an sk_buff for debugging purposes.
 567  *
 568  * @param skb    The sk_buff to dump.
 569  * @param offset Offset relative to skb-data, where to start the dump.
 570  */
 571 static void
 572 ctc_dump_skb(struct sk_buff *skb, int offset)
 573 {
 574         unsigned char *p = skb->data;
 575         __u16 bl;
 576         struct ll_header *header;
 577         int i;
 578
 579         if (!(loglevel & CTC_LOGLEVEL_DEBUG))
 580                 return;
 581         p += offset;
 582         bl = *((__u16 *) p);
 583         p += 2;
 584         header = (struct ll_header *) p;
 585         p -= 2;
 586
 587         printk(KERN_DEBUG "dump:\n");
 588         printk(KERN_DEBUG "blocklen=%d %04x\n", bl, bl);
 589
 590         printk(KERN_DEBUG "h->length=%d %04x\n", header->length,
 591                header->length);
 592         printk(KERN_DEBUG "h->type=%04x\n", header->type);
 593         printk(KERN_DEBUG "h->unused=%04x\n", header->unused);
 594         if (bl > 16)
 595                 bl = 16;
 596         printk(KERN_DEBUG "data: ");
 597         for (i = 0; i < bl; i++)
 598                 printk("%02x%s", *p++, (i % 16) ? " " : "\n<7>");
 599         printk("\n");
 600 }
 601 #else
 602 static inline void
 603 ctc_dump_skb(struct sk_buff *skb, int offset)
 604 {
 605 }
 606 #endif
 607
 608 /**
 609  * Unpack a just received skb and hand it over to
 610  * upper layers.
 611  *
 612  * @param ch The channel where this skb has been received.
 613  * @param pskb The received skb.
 614  */
 615 static __inline__ void
 616 ctc_unpack_skb(struct channel *ch, struct sk_buff *pskb)
 617 {
 618         struct net_device *dev = ch->netdev;
 619         struct ctc_priv *privptr = (struct ctc_priv *) dev->priv;
 620         __u16 len = *((__u16 *) pskb->data);
 621
 622         DBF_TEXT(trace, 4, __FUNCTION__);
 623         skb_put(pskb, 2 + LL_HEADER_LENGTH);
 624         skb_pull(pskb, 2);
 625         pskb->dev = dev;
 626         pskb->ip_summed = CHECKSUM_UNNECESSARY;
 627         while (len > 0) {
 628                 struct sk_buff *skb;
 629                 struct ll_header *header = (struct ll_header *) pskb->data;
 630
 631                 skb_pull(pskb, LL_HEADER_LENGTH);
 632                 if ((ch->protocol == CTC_PROTO_S390) &&
 633                     (header->type != ETH_P_IP)) {
 634
 635 #ifndef DEBUG
 636                         if (!(ch->logflags & LOG_FLAG_ILLEGALPKT)) {
 637 #endif
 638                                 /**
 639                                  * Check packet type only if we stick strictly
 640                                  * to S/390's protocol of OS390. This only
 641                                  * supports IP. Otherwise allow any packet
 642                                  * type.
 643                                  */
 644                                 ctc_pr_warn(
 645                                         "%s Illegal packet type 0x%04x received, dropping\n",
 646                                         dev->name, header->type);
 647                                 ch->logflags |= LOG_FLAG_ILLEGALPKT;
 648 #ifndef DEBUG
 649                         }
 650 #endif
 651 #ifdef DEBUG
 652                         ctc_dump_skb(pskb, -6);
 653 #endif
 654                         privptr->stats.rx_dropped++;
 655                         privptr->stats.rx_frame_errors++;
 656                         return;
 657                 }
 658                 pskb->protocol = ntohs(header->type);
 659                 if (header->length <= LL_HEADER_LENGTH) {
 660 #ifndef DEBUG
 661                         if (!(ch->logflags & LOG_FLAG_ILLEGALSIZE)) {
 662 #endif
 663                                 ctc_pr_warn(
 664                                        "%s Illegal packet size %d "
 665                                        "received (MTU=%d blocklen=%d), "
 666                                        "dropping\n", dev->name, header->length,
 667                                        dev->mtu, len);
 668                                 ch->logflags |= LOG_FLAG_ILLEGALSIZE;
 669 #ifndef DEBUG
 670                         }
 671 #endif
 672 #ifdef DEBUG
 673                         ctc_dump_skb(pskb, -6);
 674 #endif
 675                         privptr->stats.rx_dropped++;
 676                         privptr->stats.rx_length_errors++;
 677                         return;
 678                 }
 679                 header->length -= LL_HEADER_LENGTH;
 680                 len -= LL_HEADER_LENGTH;
 681                 if ((header->length > skb_tailroom(pskb)) ||
 682                     (header->length > len)) {
 683 #ifndef DEBUG
 684                         if (!(ch->logflags & LOG_FLAG_OVERRUN)) {
 685 #endif
 686                                 ctc_pr_warn(
 687                                         "%s Illegal packet size %d "
 688                                         "(beyond the end of received data), "
 689                                         "dropping\n", dev->name, header->length);
 690                                 ch->logflags |= LOG_FLAG_OVERRUN;
 691 #ifndef DEBUG
 692                         }
 693 #endif
 694 #ifdef DEBUG
 695                         ctc_dump_skb(pskb, -6);
 696 #endif
 697                         privptr->stats.rx_dropped++;
 698                         privptr->stats.rx_length_errors++;
 699                         return;
 700                 }
 701                 skb_put(pskb, header->length);
 702                 pskb->mac.raw = pskb->data;
 703                 len -= header->length;
 704                 skb = dev_alloc_skb(pskb->len);
 705                 if (!skb) {
 706 #ifndef DEBUG
 707                         if (!(ch->logflags & LOG_FLAG_NOMEM)) {
 708 #endif
 709                                 ctc_pr_warn(
 710                                         "%s Out of memory in ctc_unpack_skb\n",
 711                                         dev->name);
 712                                 ch->logflags |= LOG_FLAG_NOMEM;
 713 #ifndef DEBUG
 714                         }
 715 #endif
 716                         privptr->stats.rx_dropped++;
 717                         return;
 718                 }
 719                 memcpy(skb_put(skb, pskb->len), pskb->data, pskb->len);
 720                 skb->mac.raw = skb->data;
 721                 skb->dev = pskb->dev;
 722                 skb->protocol = pskb->protocol;
 723                 pskb->ip_summed = CHECKSUM_UNNECESSARY;
 724                 if (ch->protocol == CTC_PROTO_LINUX_TTY)
 725                         ctc_tty_netif_rx(skb);
 726                 else
 727                         netif_rx_ni(skb);
 728                 /**
 729                  * Successful rx; reset logflags
 730                  */
 731                 ch->logflags = 0;
 732                 dev->last_rx = jiffies;
 733                 privptr->stats.rx_packets++;
 734                 privptr->stats.rx_bytes += skb->len;
 735                 if (len > 0) {
 736                         skb_pull(pskb, header->length);
 737                         if (skb_tailroom(pskb) < LL_HEADER_LENGTH) {
 738 #ifndef DEBUG
 739                                 if (!(ch->logflags & LOG_FLAG_OVERRUN)) {
 740 #endif
 741                                         ctc_pr_warn(
 742                                                 "%s Overrun in ctc_unpack_skb\n",
 743                                                 dev->name);
 744                                         ch->logflags |= LOG_FLAG_OVERRUN;
 745 #ifndef DEBUG
 746                                 }
 747 #endif
 748                                 return;
 749                         }
 750                         skb_put(pskb, LL_HEADER_LENGTH);
 751                 }
 752         }
 753 }
 754
 755 /**
 756  * Check return code of a preceeding ccw_device call, halt_IO etc...
 757  *
 758  * @param ch          The channel, the error belongs to.
 759  * @param return_code The error code to inspect.
 760  */
 761 static void inline
 762 ccw_check_return_code(struct channel *ch, int return_code, char *msg)
 763 {
 764         DBF_TEXT(trace, 5, __FUNCTION__);
 765         switch (return_code) {
 766                 case 0:
 767                         fsm_event(ch->fsm, CH_EVENT_IO_SUCCESS, ch);
 768                         break;
 769                 case -EBUSY:
 770                         ctc_pr_warn("%s (%s): Busy !\n", ch->id, msg);
 771                         fsm_event(ch->fsm, CH_EVENT_IO_EBUSY, ch);
 772                         break;
 773                 case -ENODEV:
 774                         ctc_pr_emerg("%s (%s): Invalid device called for IO\n",
 775                                      ch->id, msg);
 776                         fsm_event(ch->fsm, CH_EVENT_IO_ENODEV, ch);
 777                         break;
 778                 case -EIO:
 779                         ctc_pr_emerg("%s (%s): Status pending... \n",
 780                                      ch->id, msg);
 781                         fsm_event(ch->fsm, CH_EVENT_IO_EIO, ch);
 782                         break;
 783                 default:
 784                         ctc_pr_emerg("%s (%s): Unknown error in do_IO %04x\n",
 785                                      ch->id, msg, return_code);
 786                         fsm_event(ch->fsm, CH_EVENT_IO_UNKNOWN, ch);
 787         }
 788 }
 789
 790 /**
 791  * Check sense of a unit check.
 792  *
 793  * @param ch    The channel, the sense code belongs to.
 794  * @param sense The sense code to inspect.
 795  */
 796 static void inline
 797 ccw_unit_check(struct channel *ch, unsigned char sense)
 798 {
 799         DBF_TEXT(trace, 5, __FUNCTION__);
 800         if (sense & SNS0_INTERVENTION_REQ) {
 801                 if (sense & 0x01) {
 802                         if (ch->protocol != CTC_PROTO_LINUX_TTY)
 803                                 ctc_pr_debug("%s: Interface disc. or Sel. reset "
 804                                         "(remote)\n", ch->id);
 805                         fsm_event(ch->fsm, CH_EVENT_UC_RCRESET, ch);
 806                 } else {
 807                         ctc_pr_debug("%s: System reset (remote)\n", ch->id);
 808                         fsm_event(ch->fsm, CH_EVENT_UC_RSRESET, ch);
 809                 }
 810         } else if (sense & SNS0_EQUIPMENT_CHECK) {
 811                 if (sense & SNS0_BUS_OUT_CHECK) {
 812                         ctc_pr_warn("%s: Hardware malfunction (remote)\n",
 813                                     ch->id);
 814                         fsm_event(ch->fsm, CH_EVENT_UC_HWFAIL, ch);
 815                 } else {
 816                         ctc_pr_warn("%s: Read-data parity error (remote)\n",
 817                                     ch->id);
 818                         fsm_event(ch->fsm, CH_EVENT_UC_RXPARITY, ch);
 819                 }
 820         } else if (sense & SNS0_BUS_OUT_CHECK) {
 821                 if (sense & 0x04) {
 822                         ctc_pr_warn("%s: Data-streaming timeout)\n", ch->id);
 823                         fsm_event(ch->fsm, CH_EVENT_UC_TXTIMEOUT, ch);
 824                 } else {
 825                         ctc_pr_warn("%s: Data-transfer parity error\n", ch->id);
 826                         fsm_event(ch->fsm, CH_EVENT_UC_TXPARITY, ch);
 827                 }
 828         } else if (sense & SNS0_CMD_REJECT) {
 829                 ctc_pr_warn("%s: Command reject\n", ch->id);
 830         } else if (sense == 0) {
 831                 ctc_pr_debug("%s: Unit check ZERO\n", ch->id);
 832                 fsm_event(ch->fsm, CH_EVENT_UC_ZERO, ch);
 833         } else {
 834                 ctc_pr_warn("%s: Unit Check with sense code: %02x\n",
 835                             ch->id, sense);
 836                 fsm_event(ch->fsm, CH_EVENT_UC_UNKNOWN, ch);
 837         }
 838 }
 839
 840 static void
 841 ctc_purge_skb_queue(struct sk_buff_head *q)
 842 {
 843         struct sk_buff *skb;
 844
 845         DBF_TEXT(trace, 5, __FUNCTION__);
 846
 847         while ((skb = skb_dequeue(q))) {
 848                 atomic_dec(&skb->users);
 849                 dev_kfree_skb_irq(skb);
 850         }
 851 }
 852
 853 static __inline__ int
 854 ctc_checkalloc_buffer(struct channel *ch, int warn)
 855 {
 856         DBF_TEXT(trace, 5, __FUNCTION__);
 857         if ((ch->trans_skb == NULL) ||
 858             (ch->flags & CHANNEL_FLAGS_BUFSIZE_CHANGED)) {
 859                 if (ch->trans_skb != NULL)
 860                         dev_kfree_skb(ch->trans_skb);
 861                 clear_normalized_cda(&ch->ccw[1]);
 862                 ch->trans_skb = __dev_alloc_skb(ch->max_bufsize,
 863                                                 GFP_ATOMIC | GFP_DMA);
 864                 if (ch->trans_skb == NULL) {
 865                         if (warn)
 866                                 ctc_pr_warn(
 867                                         "%s: Couldn't alloc %s trans_skb\n",
 868                                         ch->id,
 869                                         (CHANNEL_DIRECTION(ch->flags) == READ) ?
 870                                         "RX" : "TX");
 871                         return -ENOMEM;
 872                 }
 873                 ch->ccw[1].count = ch->max_bufsize;
 874                 if (set_normalized_cda(&ch->ccw[1], ch->trans_skb->data)) {
 875                         dev_kfree_skb(ch->trans_skb);
 876                         ch->trans_skb = NULL;
 877                         if (warn)
 878                                 ctc_pr_warn(
 879                                         "%s: set_normalized_cda for %s "
 880                                         "trans_skb failed, dropping packets\n",
 881                                         ch->id,
 882                                         (CHANNEL_DIRECTION(ch->flags) == READ) ?
 883                                         "RX" : "TX");
 884                         return -ENOMEM;
 885                 }
 886                 ch->ccw[1].count = 0;
 887                 ch->trans_skb_data = ch->trans_skb->data;
 888                 ch->flags &= ~CHANNEL_FLAGS_BUFSIZE_CHANGED;
 889         }
 890         return 0;
 891 }
 892
 893 /**
 894  * Dummy NOP action for statemachines
 895  */
 896 static void
 897 fsm_action_nop(fsm_instance * fi, int event, void *arg)
 898 {
 899 }
 900 \f
 901 /**
 902  * Actions for channel - statemachines.
 903  *****************************************************************************/
 904
 905 /**
 906  * Normal data has been send. Free the corresponding
 907  * skb (it's in io_queue), reset dev->tbusy and
 908  * revert to idle state.
 909  *
 910  * @param fi    An instance of a channel statemachine.
 911  * @param event The event, just happened.
 912  * @param arg   Generic pointer, casted from channel * upon call.
 913  */
 914 static void
 915 ch_action_txdone(fsm_instance * fi, int event, void *arg)
 916 {
 917         struct channel *ch = (struct channel *) arg;
 918         struct net_device *dev = ch->netdev;
 919         struct ctc_priv *privptr = dev->priv;
 920         struct sk_buff *skb;
 921         int first = 1;
 922         int i;
 923         unsigned long duration;
 924         struct timespec done_stamp = xtime;
 925
 926         DBF_TEXT(trace, 4, __FUNCTION__);
 927
 928         duration =
 929             (done_stamp.tv_sec - ch->prof.send_stamp.tv_sec) * 1000000 +
 930             (done_stamp.tv_nsec - ch->prof.send_stamp.tv_nsec) / 1000;
 931         if (duration > ch->prof.tx_time)
 932                 ch->prof.tx_time = duration;
 933
 934         if (ch->irb->scsw.count != 0)
 935                 ctc_pr_debug("%s: TX not complete, remaining %d bytes\n",
 936                              dev->name, ch->irb->scsw.count);
 937         fsm_deltimer(&ch->timer);
 938         while ((skb = skb_dequeue(&ch->io_queue))) {
 939                 privptr->stats.tx_packets++;
 940                 privptr->stats.tx_bytes += skb->len - LL_HEADER_LENGTH;
 941                 if (first) {
 942                         privptr->stats.tx_bytes += 2;
 943                         first = 0;
 944                 }
 945                 atomic_dec(&skb->users);
 946                 dev_kfree_skb_irq(skb);
 947         }
 948         spin_lock(&ch->collect_lock);
 949         clear_normalized_cda(&ch->ccw[4]);
 950         if (ch->collect_len > 0) {
 951                 int rc;
 952
 953                 if (ctc_checkalloc_buffer(ch, 1)) {
 954                         spin_unlock(&ch->collect_lock);
 955                         return;
 956                 }
 957                 ch->trans_skb->tail = ch->trans_skb->data = ch->trans_skb_data;
 958                 ch->trans_skb->len = 0;
 959                 if (ch->prof.maxmulti < (ch->collect_len + 2))
 960                         ch->prof.maxmulti = ch->collect_len + 2;
 961                 if (ch->prof.maxcqueue < skb_queue_len(&ch->collect_queue))
 962                         ch->prof.maxcqueue = skb_queue_len(&ch->collect_queue);
 963                 *((__u16 *) skb_put(ch->trans_skb, 2)) = ch->collect_len + 2;
 964                 i = 0;
 965                 while ((skb = skb_dequeue(&ch->collect_queue))) {
 966                         memcpy(skb_put(ch->trans_skb, skb->len), skb->data,
 967                                skb->len);
 968                         privptr->stats.tx_packets++;
 969                         privptr->stats.tx_bytes += skb->len - LL_HEADER_LENGTH;
 970                         atomic_dec(&skb->users);
 971                         dev_kfree_skb_irq(skb);
 972                         i++;
 973                 }
 974                 ch->collect_len = 0;
 975                 spin_unlock(&ch->collect_lock);
 976                 ch->ccw[1].count = ch->trans_skb->len;
 977                 fsm_addtimer(&ch->timer, CTC_TIMEOUT_5SEC, CH_EVENT_TIMER, ch);
 978                 ch->prof.send_stamp = xtime;
 979                 rc = ccw_device_start(ch->cdev, &ch->ccw[0],
 980                                       (unsigned long) ch, 0xff, 0);
 981                 ch->prof.doios_multi++;
 982                 if (rc != 0) {
 983                         privptr->stats.tx_dropped += i;
 984                         privptr->stats.tx_errors += i;
 985                         fsm_deltimer(&ch->timer);
 986                         ccw_check_return_code(ch, rc, "chained TX");
 987                 }
 988         } else {
 989                 spin_unlock(&ch->collect_lock);
 990                 fsm_newstate(fi, CH_STATE_TXIDLE);
 991         }
 992         ctc_clear_busy(dev);
 993 }
 994
 995 /**
 996  * Initial data is sent.
 997  * Notify device statemachine that we are up and
 998  * running.
 999  *
1000  * @param fi    An instance of a channel statemachine.
1001  * @param event The event, just happened.
1002  * @param arg   Generic pointer, casted from channel * upon call.
1003  */
1004 static void
1005 ch_action_txidle(fsm_instance * fi, int event, void *arg)
1006 {
1007         struct channel *ch = (struct channel *) arg;
1008
1009         DBF_TEXT(trace, 4, __FUNCTION__);
1010         fsm_deltimer(&ch->timer);
1011         fsm_newstate(fi, CH_STATE_TXIDLE);
1012         fsm_event(((struct ctc_priv *) ch->netdev->priv)->fsm, DEV_EVENT_TXUP,
1013                   ch->netdev);
1014 }
1015
1016 /**
1017  * Got normal data, check for sanity, queue it up, allocate new buffer
1018  * trigger bottom half, and initiate next read.
1019  *
1020  * @param fi    An instance of a channel statemachine.
1021  * @param event The event, just happened.
1022  * @param arg   Generic pointer, casted from channel * upon call.
1023  */
1024 static void
1025 ch_action_rx(fsm_instance * fi, int event, void *arg)
1026 {
1027         struct channel *ch = (struct channel *) arg;
1028         struct net_device *dev = ch->netdev;
1029         struct ctc_priv *privptr = dev->priv;
1030         int len = ch->max_bufsize - ch->irb->scsw.count;
1031         struct sk_buff *skb = ch->trans_skb;
1032         __u16 block_len = *((__u16 *) skb->data);
1033         int check_len;
1034         int rc;
1035
1036         DBF_TEXT(trace, 4, __FUNCTION__);
1037         fsm_deltimer(&ch->timer);
1038         if (len < 8) {
1039                 ctc_pr_debug("%s: got packet with length %d < 8\n",
1040                              dev->name, len);
1041                 privptr->stats.rx_dropped++;
1042                 privptr->stats.rx_length_errors++;
1043                 goto again;
1044         }
1045         if (len > ch->max_bufsize) {
1046                 ctc_pr_debug("%s: got packet with length %d > %d\n",
1047                              dev->name, len, ch->max_bufsize);
1048                 privptr->stats.rx_dropped++;
1049                 privptr->stats.rx_length_errors++;
1050                 goto again;
1051         }
1052
1053         /**
1054          * VM TCP seems to have a bug sending 2 trailing bytes of garbage.
1055          */
1056         switch (ch->protocol) {
1057                 case CTC_PROTO_S390:
1058                 case CTC_PROTO_OS390:
1059                         check_len = block_len + 2;
1060                         break;
1061                 default:
1062                         check_len = block_len;
1063                         break;
1064         }
1065         if ((len < block_len) || (len > check_len)) {
1066                 ctc_pr_debug("%s: got block length %d != rx length %d\n",
1067                              dev->name, block_len, len);
1068 #ifdef DEBUG
1069                 ctc_dump_skb(skb, 0);
1070 #endif
1071                 *((__u16 *) skb->data) = len;
1072                 privptr->stats.rx_dropped++;
1073                 privptr->stats.rx_length_errors++;
1074                 goto again;
1075         }
1076         block_len -= 2;
1077         if (block_len > 0) {
1078                 *((__u16 *) skb->data) = block_len;
1079                 ctc_unpack_skb(ch, skb);
1080         }
1081  again:
1082         skb->data = skb->tail = ch->trans_skb_data;
1083         skb->len = 0;
1084         if (ctc_checkalloc_buffer(ch, 1))
1085                 return;
1086         ch->ccw[1].count = ch->max_bufsize;
1087         rc = ccw_device_start(ch->cdev, &ch->ccw[0], (unsigned long) ch, 0xff, 0);
1088         if (rc != 0)
1089                 ccw_check_return_code(ch, rc, "normal RX");
1090 }
1091
1092 static void ch_action_rxidle(fsm_instance * fi, int event, void *arg);
1093
1094 /**
1095  * Initialize connection by sending a __u16 of value 0.
1096  *
1097  * @param fi    An instance of a channel statemachine.
1098  * @param event The event, just happened.
1099  * @param arg   Generic pointer, casted from channel * upon call.
1100  */
1101 static void
1102 ch_action_firstio(fsm_instance * fi, int event, void *arg)
1103 {
1104         struct channel *ch = (struct channel *) arg;
1105         int rc;
1106
1107         DBF_TEXT(trace, 4, __FUNCTION__);
1108
1109         if (fsm_getstate(fi) == CH_STATE_TXIDLE)
1110                 ctc_pr_debug("%s: remote side issued READ?, init ...\n", ch->id);
1111         fsm_deltimer(&ch->timer);
1112         if (ctc_checkalloc_buffer(ch, 1))
1113                 return;
1114         if ((fsm_getstate(fi) == CH_STATE_SETUPWAIT) &&
1115             (ch->protocol == CTC_PROTO_OS390)) {
1116                 /* OS/390 resp. z/OS */
1117                 if (CHANNEL_DIRECTION(ch->flags) == READ) {
1118                         *((__u16 *) ch->trans_skb->data) = CTC_INITIAL_BLOCKLEN;
1119                         fsm_addtimer(&ch->timer, CTC_TIMEOUT_5SEC,
1120                                      CH_EVENT_TIMER, ch);
1121                         ch_action_rxidle(fi, event, arg);
1122                 } else {
1123                         struct net_device *dev = ch->netdev;
1124                         fsm_newstate(fi, CH_STATE_TXIDLE);
1125                         fsm_event(((struct ctc_priv *) dev->priv)->fsm,
1126                                   DEV_EVENT_TXUP, dev);
1127                 }
1128                 return;
1129         }
1130
1131         /**
1132          * Don´t setup a timer for receiving the initial RX frame
1133          * if in compatibility mode, since VM TCP delays the initial
1134          * frame until it has some data to send.
1135          */
1136         if ((CHANNEL_DIRECTION(ch->flags) == WRITE) ||
1137             (ch->protocol != CTC_PROTO_S390))
1138                 fsm_addtimer(&ch->timer, CTC_TIMEOUT_5SEC, CH_EVENT_TIMER, ch);
1139
1140         *((__u16 *) ch->trans_skb->data) = CTC_INITIAL_BLOCKLEN;
1141         ch->ccw[1].count = 2;   /* Transfer only length */
1142
1143         fsm_newstate(fi, (CHANNEL_DIRECTION(ch->flags) == READ)
1144                      ? CH_STATE_RXINIT : CH_STATE_TXINIT);
1145         rc = ccw_device_start(ch->cdev, &ch->ccw[0], (unsigned long) ch, 0xff, 0);
1146         if (rc != 0) {
1147                 fsm_deltimer(&ch->timer);
1148                 fsm_newstate(fi, CH_STATE_SETUPWAIT);
1149                 ccw_check_return_code(ch, rc, "init IO");
1150         }
1151         /**
1152          * If in compatibility mode since we don´t setup a timer, we
1153          * also signal RX channel up immediately. This enables us
1154          * to send packets early which in turn usually triggers some
1155          * reply from VM TCP which brings up the RX channel to it´s
1156          * final state.
1157          */
1158         if ((CHANNEL_DIRECTION(ch->flags) == READ) &&
1159             (ch->protocol == CTC_PROTO_S390)) {
1160                 struct net_device *dev = ch->netdev;
1161                 fsm_event(((struct ctc_priv *) dev->priv)->fsm, DEV_EVENT_RXUP,
1162                           dev);
1163         }
1164 }
1165
1166 /**
1167  * Got initial data, check it. If OK,
1168  * notify device statemachine that we are up and
1169  * running.
1170  *
1171  * @param fi    An instance of a channel statemachine.
1172  * @param event The event, just happened.
1173  * @param arg   Generic pointer, casted from channel * upon call.
1174  */
1175 static void
1176 ch_action_rxidle(fsm_instance * fi, int event, void *arg)
1177 {
1178         struct channel *ch = (struct channel *) arg;
1179         struct net_device *dev = ch->netdev;
1180         __u16 buflen;
1181         int rc;
1182
1183         DBF_TEXT(trace, 4, __FUNCTION__);
1184         fsm_deltimer(&ch->timer);
1185         buflen = *((__u16 *) ch->trans_skb->data);
1186 #ifdef DEBUG
1187         ctc_pr_debug("%s: Initial RX count %d\n", dev->name, buflen);
1188 #endif
1189         if (buflen >= CTC_INITIAL_BLOCKLEN) {
1190                 if (ctc_checkalloc_buffer(ch, 1))
1191                         return;
1192                 ch->ccw[1].count = ch->max_bufsize;
1193                 fsm_newstate(fi, CH_STATE_RXIDLE);
1194                 rc = ccw_device_start(ch->cdev, &ch->ccw[0],
1195                                       (unsigned long) ch, 0xff, 0);
1196                 if (rc != 0) {
1197                         fsm_newstate(fi, CH_STATE_RXINIT);
1198                         ccw_check_return_code(ch, rc, "initial RX");
1199                 } else
1200                         fsm_event(((struct ctc_priv *) dev->priv)->fsm,
1201                                   DEV_EVENT_RXUP, dev);
1202         } else {
1203                 ctc_pr_debug("%s: Initial RX count %d not %d\n",
1204                              dev->name, buflen, CTC_INITIAL_BLOCKLEN);
1205                 ch_action_firstio(fi, event, arg);
1206         }
1207 }
1208
1209 /**
1210  * Set channel into extended mode.
1211  *
1212  * @param fi    An instance of a channel statemachine.
1213  * @param event The event, just happened.
1214  * @param arg   Generic pointer, casted from channel * upon call.
1215  */
1216 static void
1217 ch_action_setmode(fsm_instance * fi, int event, void *arg)
1218 {
1219         struct channel *ch = (struct channel *) arg;
1220         int rc;
1221         unsigned long saveflags;
1222
1223         DBF_TEXT(trace, 4, __FUNCTION__);
1224         fsm_deltimer(&ch->timer);
1225         fsm_addtimer(&ch->timer, CTC_TIMEOUT_5SEC, CH_EVENT_TIMER, ch);
1226         fsm_newstate(fi, CH_STATE_SETUPWAIT);
1227         saveflags = 0;  /* avoids compiler warning with
1228                            spin_unlock_irqrestore */
1229         if (event == CH_EVENT_TIMER)    // only for timer not yet locked
1230                 spin_lock_irqsave(get_ccwdev_lock(ch->cdev), saveflags);
1231         rc = ccw_device_start(ch->cdev, &ch->ccw[6], (unsigned long) ch, 0xff, 0);
1232         if (event == CH_EVENT_TIMER)
1233                 spin_unlock_irqrestore(get_ccwdev_lock(ch->cdev), saveflags);
1234         if (rc != 0) {
1235                 fsm_deltimer(&ch->timer);
1236                 fsm_newstate(fi, CH_STATE_STARTWAIT);
1237                 ccw_check_return_code(ch, rc, "set Mode");
1238         } else
1239                 ch->retry = 0;
1240 }
1241
1242 /**
1243  * Setup channel.
1244  *
1245  * @param fi    An instance of a channel statemachine.
1246  * @param event The event, just happened.
1247  * @param arg   Generic pointer, casted from channel * upon call.
1248  */
1249 static void
1250 ch_action_start(fsm_instance * fi, int event, void *arg)
1251 {
1252         struct channel *ch = (struct channel *) arg;
1253         unsigned long saveflags;
1254         int rc;
1255         struct net_device *dev;
1256
1257         DBF_TEXT(trace, 4, __FUNCTION__);
1258         if (ch == NULL) {
1259                 ctc_pr_warn("ch_action_start ch=NULL\n");
1260                 return;
1261         }
1262         if (ch->netdev == NULL) {
1263                 ctc_pr_warn("ch_action_start dev=NULL, id=%s\n", ch->id);
1264                 return;
1265         }
1266         dev = ch->netdev;
1267
1268 #ifdef DEBUG
1269         ctc_pr_debug("%s: %s channel start\n", dev->name,
1270                      (CHANNEL_DIRECTION(ch->flags) == READ) ? "RX" : "TX");
1271 #endif
1272
1273         if (ch->trans_skb != NULL) {
1274                 clear_normalized_cda(&ch->ccw[1]);
1275                 dev_kfree_skb(ch->trans_skb);
1276                 ch->trans_skb = NULL;
1277         }
1278         if (CHANNEL_DIRECTION(ch->flags) == READ) {
1279                 ch->ccw[1].cmd_code = CCW_CMD_READ;
1280                 ch->ccw[1].flags = CCW_FLAG_SLI;
1281                 ch->ccw[1].count = 0;
1282         } else {
1283                 ch->ccw[1].cmd_code = CCW_CMD_WRITE;
1284                 ch->ccw[1].flags = CCW_FLAG_SLI | CCW_FLAG_CC;
1285                 ch->ccw[1].count = 0;
1286         }
1287         if (ctc_checkalloc_buffer(ch, 0)) {
1288                 ctc_pr_notice(
1289                         "%s: Could not allocate %s trans_skb, delaying "
1290                         "allocation until first transfer\n",
1291                         dev->name,
1292                         (CHANNEL_DIRECTION(ch->flags) == READ) ? "RX" : "TX");
1293         }
1294
1295         ch->ccw[0].cmd_code = CCW_CMD_PREPARE;
1296         ch->ccw[0].flags = CCW_FLAG_SLI | CCW_FLAG_CC;
1297         ch->ccw[0].count = 0;
1298         ch->ccw[0].cda = 0;
1299         ch->ccw[2].cmd_code = CCW_CMD_NOOP;     /* jointed CE + DE */
1300         ch->ccw[2].flags = CCW_FLAG_SLI;
1301         ch->ccw[2].count = 0;
1302         ch->ccw[2].cda = 0;
1303         memcpy(&ch->ccw[3], &ch->ccw[0], sizeof (struct ccw1) * 3);
1304         ch->ccw[4].cda = 0;
1305         ch->ccw[4].flags &= ~CCW_FLAG_IDA;
1306
1307         fsm_newstate(fi, CH_STATE_STARTWAIT);
1308         fsm_addtimer(&ch->timer, 1000, CH_EVENT_TIMER, ch);
1309         spin_lock_irqsave(get_ccwdev_lock(ch->cdev), saveflags);
1310         rc = ccw_device_halt(ch->cdev, (unsigned long) ch);
1311         spin_unlock_irqrestore(get_ccwdev_lock(ch->cdev), saveflags);
1312         if (rc != 0) {
1313                 if (rc != -EBUSY)
1314                     fsm_deltimer(&ch->timer);
1315                 ccw_check_return_code(ch, rc, "initial HaltIO");
1316         }
1317 #ifdef DEBUG
1318         ctc_pr_debug("ctc: %s(): leaving\n", __func__);
1319 #endif
1320 }
1321
1322 /**
1323  * Shutdown a channel.
1324  *
1325  * @param fi    An instance of a channel statemachine.
1326  * @param event The event, just happened.
1327  * @param arg   Generic pointer, casted from channel * upon call.
1328  */
1329 static void
1330 ch_action_haltio(fsm_instance * fi, int event, void *arg)
1331 {
1332         struct channel *ch = (struct channel *) arg;
1333         unsigned long saveflags;
1334         int rc;
1335         int oldstate;
1336
1337         DBF_TEXT(trace, 3, __FUNCTION__);
1338         fsm_deltimer(&ch->timer);
1339         fsm_addtimer(&ch->timer, CTC_TIMEOUT_5SEC, CH_EVENT_TIMER, ch);
1340         saveflags = 0;  /* avoids comp warning with
1341                            spin_unlock_irqrestore */
1342         if (event == CH_EVENT_STOP)     // only for STOP not yet locked
1343                 spin_lock_irqsave(get_ccwdev_lock(ch->cdev), saveflags);
1344         oldstate = fsm_getstate(fi);
1345         fsm_newstate(fi, CH_STATE_TERM);
1346         rc = ccw_device_halt(ch->cdev, (unsigned long) ch);
1347         if (event == CH_EVENT_STOP)
1348                 spin_unlock_irqrestore(get_ccwdev_lock(ch->cdev), saveflags);
1349         if (rc != 0) {
1350                 if (rc != -EBUSY) {
1351                     fsm_deltimer(&ch->timer);
1352                     fsm_newstate(fi, oldstate);
1353                 }
1354                 ccw_check_return_code(ch, rc, "HaltIO in ch_action_haltio");
1355         }
1356 }
1357
1358 /**
1359  * A channel has successfully been halted.
1360  * Cleanup it's queue and notify interface statemachine.
1361  *
1362  * @param fi    An instance of a channel statemachine.
1363  * @param event The event, just happened.
1364  * @param arg   Generic pointer, casted from channel * upon call.
1365  */
1366 static void
1367 ch_action_stopped(fsm_instance * fi, int event, void *arg)
1368 {
1369         struct channel *ch = (struct channel *) arg;
1370         struct net_device *dev = ch->netdev;
1371
1372         DBF_TEXT(trace, 3, __FUNCTION__);
1373         fsm_deltimer(&ch->timer);
1374         fsm_newstate(fi, CH_STATE_STOPPED);
1375         if (ch->trans_skb != NULL) {
1376                 clear_normalized_cda(&ch->ccw[1]);
1377                 dev_kfree_skb(ch->trans_skb);
1378                 ch->trans_skb = NULL;
1379         }
1380         if (CHANNEL_DIRECTION(ch->flags) == READ) {
1381                 skb_queue_purge(&ch->io_queue);
1382                 fsm_event(((struct ctc_priv *) dev->priv)->fsm,
1383                           DEV_EVENT_RXDOWN, dev);
1384         } else {
1385                 ctc_purge_skb_queue(&ch->io_queue);
1386                 spin_lock(&ch->collect_lock);
1387                 ctc_purge_skb_queue(&ch->collect_queue);
1388                 ch->collect_len = 0;
1389                 spin_unlock(&ch->collect_lock);
1390                 fsm_event(((struct ctc_priv *) dev->priv)->fsm,
1391                           DEV_EVENT_TXDOWN, dev);
1392         }
1393 }
1394
1395 /**
1396  * A stop command from device statemachine arrived and we are in
1397  * not operational mode. Set state to stopped.
1398  *
1399  * @param fi    An instance of a channel statemachine.
1400  * @param event The event, just happened.
1401  * @param arg   Generic pointer, casted from channel * upon call.
1402  */
1403 static void
1404 ch_action_stop(fsm_instance * fi, int event, void *arg)
1405 {
1406         fsm_newstate(fi, CH_STATE_STOPPED);
1407 }
1408
1409 /**
1410  * A machine check for no path, not operational status or gone device has
1411  * happened.
1412  * Cleanup queue and notify interface statemachine.
1413  *
1414  * @param fi    An instance of a channel statemachine.
1415  * @param event The event, just happened.
1416  * @param arg   Generic pointer, casted from channel * upon call.
1417  */
1418 static void
1419 ch_action_fail(fsm_instance * fi, int event, void *arg)
1420 {
1421         struct channel *ch = (struct channel *) arg;
1422         struct net_device *dev = ch->netdev;
1423
1424         DBF_TEXT(trace, 3, __FUNCTION__);
1425         fsm_deltimer(&ch->timer);
1426         fsm_newstate(fi, CH_STATE_NOTOP);
1427         if (CHANNEL_DIRECTION(ch->flags) == READ) {
1428                 skb_queue_purge(&ch->io_queue);
1429                 fsm_event(((struct ctc_priv *) dev->priv)->fsm,
1430                           DEV_EVENT_RXDOWN, dev);
1431         } else {
1432                 ctc_purge_skb_queue(&ch->io_queue);
1433                 spin_lock(&ch->collect_lock);
1434                 ctc_purge_skb_queue(&ch->collect_queue);
1435                 ch->collect_len = 0;
1436                 spin_unlock(&ch->collect_lock);
1437                 fsm_event(((struct ctc_priv *) dev->priv)->fsm,
1438                           DEV_EVENT_TXDOWN, dev);
1439         }
1440 }
1441
1442 /**
1443  * Handle error during setup of channel.
1444  *
1445  * @param fi    An instance of a channel statemachine.
1446  * @param event The event, just happened.
1447  * @param arg   Generic pointer, casted from channel * upon call.
1448  */
1449 static void
1450 ch_action_setuperr(fsm_instance * fi, int event, void *arg)
1451 {
1452         struct channel *ch = (struct channel *) arg;
1453         struct net_device *dev = ch->netdev;
1454
1455         DBF_TEXT(setup, 3, __FUNCTION__);
1456         /**
1457          * Special case: Got UC_RCRESET on setmode.
1458          * This means that remote side isn't setup. In this case
1459          * simply retry after some 10 secs...
1460          */
1461         if ((fsm_getstate(fi) == CH_STATE_SETUPWAIT) &&
1462             ((event == CH_EVENT_UC_RCRESET) ||
1463              (event == CH_EVENT_UC_RSRESET))) {
1464                 fsm_newstate(fi, CH_STATE_STARTRETRY);
1465                 fsm_deltimer(&ch->timer);
1466                 fsm_addtimer(&ch->timer, CTC_TIMEOUT_5SEC, CH_EVENT_TIMER, ch);
1467                 if (CHANNEL_DIRECTION(ch->flags) == READ) {
1468                         int rc = ccw_device_halt(ch->cdev, (unsigned long) ch);
1469                         if (rc != 0)
1470                                 ccw_check_return_code(
1471                                         ch, rc, "HaltIO in ch_action_setuperr");
1472                 }
1473                 return;
1474         }
1475
1476         ctc_pr_debug("%s: Error %s during %s channel setup state=%s\n",
1477                      dev->name, ch_event_names[event],
1478                      (CHANNEL_DIRECTION(ch->flags) == READ) ? "RX" : "TX",
1479                      fsm_getstate_str(fi));
1480         if (CHANNEL_DIRECTION(ch->flags) == READ) {
1481                 fsm_newstate(fi, CH_STATE_RXERR);
1482                 fsm_event(((struct ctc_priv *) dev->priv)->fsm,
1483                           DEV_EVENT_RXDOWN, dev);
1484         } else {
1485                 fsm_newstate(fi, CH_STATE_TXERR);
1486                 fsm_event(((struct ctc_priv *) dev->priv)->fsm,
1487                           DEV_EVENT_TXDOWN, dev);
1488         }
1489 }
1490
1491 /**
1492  * Restart a channel after an error.
1493  *
1494  * @param fi    An instance of a channel statemachine.
1495  * @param event The event, just happened.
1496  * @param arg   Generic pointer, casted from channel * upon call.
1497  */
1498 static void
1499 ch_action_restart(fsm_instance * fi, int event, void *arg)
1500 {
1501         unsigned long saveflags;
1502         int oldstate;
1503         int rc;
1504
1505         struct channel *ch = (struct channel *) arg;
1506         struct net_device *dev = ch->netdev;
1507
1508         DBF_TEXT(trace, 3, __FUNCTION__);
1509         fsm_deltimer(&ch->timer);
1510         ctc_pr_debug("%s: %s channel restart\n", dev->name,
1511                      (CHANNEL_DIRECTION(ch->flags) == READ) ? "RX" : "TX");
1512         fsm_addtimer(&ch->timer, CTC_TIMEOUT_5SEC, CH_EVENT_TIMER, ch);
1513         oldstate = fsm_getstate(fi);
1514         fsm_newstate(fi, CH_STATE_STARTWAIT);
1515         saveflags = 0;  /* avoids compiler warning with
1516                            spin_unlock_irqrestore */
1517         if (event == CH_EVENT_TIMER)    // only for timer not yet locked
1518                 spin_lock_irqsave(get_ccwdev_lock(ch->cdev), saveflags);
1519         rc = ccw_device_halt(ch->cdev, (unsigned long) ch);
1520         if (event == CH_EVENT_TIMER)
1521                 spin_unlock_irqrestore(get_ccwdev_lock(ch->cdev), saveflags);
1522         if (rc != 0) {
1523                 if (rc != -EBUSY) {
1524                     fsm_deltimer(&ch->timer);
1525                     fsm_newstate(fi, oldstate);
1526                 }
1527                 ccw_check_return_code(ch, rc, "HaltIO in ch_action_restart");
1528         }
1529 }
1530
1531 /**
1532  * Handle error during RX initial handshake (exchange of
1533  * 0-length block header)
1534  *
1535  * @param fi    An instance of a channel statemachine.
1536  * @param event The event, just happened.
1537  * @param arg   Generic pointer, casted from channel * upon call.
1538  */
1539 static void
1540 ch_action_rxiniterr(fsm_instance * fi, int event, void *arg)
1541 {
1542         struct channel *ch = (struct channel *) arg;
1543         struct net_device *dev = ch->netdev;
1544
1545         DBF_TEXT(setup, 3, __FUNCTION__);
1546         if (event == CH_EVENT_TIMER) {
1547                 fsm_deltimer(&ch->timer);
1548                 ctc_pr_debug("%s: Timeout during RX init handshake\n", dev->name);
1549                 if (ch->retry++ < 3)
1550                         ch_action_restart(fi, event, arg);
1551                 else {
1552                         fsm_newstate(fi, CH_STATE_RXERR);
1553                         fsm_event(((struct ctc_priv *) dev->priv)->fsm,
1554                                   DEV_EVENT_RXDOWN, dev);
1555                 }
1556         } else
1557                 ctc_pr_warn("%s: Error during RX init handshake\n", dev->name);
1558 }
1559
1560 /**
1561  * Notify device statemachine if we gave up initialization
1562  * of RX channel.
1563  *
1564  * @param fi    An instance of a channel statemachine.
1565  * @param event The event, just happened.
1566  * @param arg   Generic pointer, casted from channel * upon call.
1567  */
1568 static void
1569 ch_action_rxinitfail(fsm_instance * fi, int event, void *arg)
1570 {
1571         struct channel *ch = (struct channel *) arg;
1572         struct net_device *dev = ch->netdev;
1573
1574         DBF_TEXT(setup, 3, __FUNCTION__);
1575         fsm_newstate(fi, CH_STATE_RXERR);
1576         ctc_pr_warn("%s: RX initialization failed\n", dev->name);
1577         ctc_pr_warn("%s: RX <-> RX connection detected\n", dev->name);
1578         fsm_event(((struct ctc_priv *) dev->priv)->fsm, DEV_EVENT_RXDOWN, dev);
1579 }
1580
1581 /**
1582  * Handle RX Unit check remote reset (remote disconnected)
1583  *
1584  * @param fi    An instance of a channel statemachine.
1585  * @param event The event, just happened.
1586  * @param arg   Generic pointer, casted from channel * upon call.
1587  */
1588 static void
1589 ch_action_rxdisc(fsm_instance * fi, int event, void *arg)
1590 {
1591         struct channel *ch = (struct channel *) arg;
1592         struct channel *ch2;
1593         struct net_device *dev = ch->netdev;
1594
1595         DBF_TEXT(trace, 3, __FUNCTION__);
1596         fsm_deltimer(&ch->timer);
1597         ctc_pr_debug("%s: Got remote disconnect, re-initializing ...\n",
1598                      dev->name);
1599
1600         /**
1601          * Notify device statemachine
1602          */
1603         fsm_event(((struct ctc_priv *) dev->priv)->fsm, DEV_EVENT_RXDOWN, dev);
1604         fsm_event(((struct ctc_priv *) dev->priv)->fsm, DEV_EVENT_TXDOWN, dev);
1605
1606         fsm_newstate(fi, CH_STATE_DTERM);
1607         ch2 = ((struct ctc_priv *) dev->priv)->channel[WRITE];
1608         fsm_newstate(ch2->fsm, CH_STATE_DTERM);
1609
1610         ccw_device_halt(ch->cdev, (unsigned long) ch);
1611         ccw_device_halt(ch2->cdev, (unsigned long) ch2);
1612 }
1613
1614 /**
1615  * Handle error during TX channel initialization.
1616  *
1617  * @param fi    An instance of a channel statemachine.
1618  * @param event The event, just happened.
1619  * @param arg   Generic pointer, casted from channel * upon call.
1620  */
1621 static void
1622 ch_action_txiniterr(fsm_instance * fi, int event, void *arg)
1623 {
1624         struct channel *ch = (struct channel *) arg;
1625         struct net_device *dev = ch->netdev;
1626
1627         DBF_TEXT(setup, 2, __FUNCTION__);
1628         if (event == CH_EVENT_TIMER) {
1629                 fsm_deltimer(&ch->timer);
1630                 ctc_pr_debug("%s: Timeout during TX init handshake\n", dev->name);
1631                 if (ch->retry++ < 3)
1632                         ch_action_restart(fi, event, arg);
1633                 else {
1634                         fsm_newstate(fi, CH_STATE_TXERR);
1635                         fsm_event(((struct ctc_priv *) dev->priv)->fsm,
1636                                   DEV_EVENT_TXDOWN, dev);
1637                 }
1638         } else
1639                 ctc_pr_warn("%s: Error during TX init handshake\n", dev->name);
1640 }
1641
1642 /**
1643  * Handle TX timeout by retrying operation.
1644  *
1645  * @param fi    An instance of a channel statemachine.
1646  * @param event The event, just happened.
1647  * @param arg   Generic pointer, casted from channel * upon call.
1648  */
1649 static void
1650 ch_action_txretry(fsm_instance * fi, int event, void *arg)
1651 {
1652         struct channel *ch = (struct channel *) arg;
1653         struct net_device *dev = ch->netdev;
1654         unsigned long saveflags;
1655
1656         DBF_TEXT(trace, 4, __FUNCTION__);
1657         fsm_deltimer(&ch->timer);
1658         if (ch->retry++ > 3) {
1659                 ctc_pr_debug("%s: TX retry failed, restarting channel\n",
1660                              dev->name);
1661                 fsm_event(((struct ctc_priv *) dev->priv)->fsm,
1662                           DEV_EVENT_TXDOWN, dev);
1663                 ch_action_restart(fi, event, arg);
1664         } else {
1665                 struct sk_buff *skb;
1666
1667                 ctc_pr_debug("%s: TX retry %d\n", dev->name, ch->retry);
1668                 if ((skb = skb_peek(&ch->io_queue))) {
1669                         int rc = 0;
1670
1671                         clear_normalized_cda(&ch->ccw[4]);
1672                         ch->ccw[4].count = skb->len;
1673                         if (set_normalized_cda(&ch->ccw[4], skb->data)) {
1674                                 ctc_pr_debug(
1675                                         "%s: IDAL alloc failed, chan restart\n",
1676                                         dev->name);
1677                                 fsm_event(((struct ctc_priv *) dev->priv)->fsm,
1678                                           DEV_EVENT_TXDOWN, dev);
1679                                 ch_action_restart(fi, event, arg);
1680                                 return;
1681                         }
1682                         fsm_addtimer(&ch->timer, 1000, CH_EVENT_TIMER, ch);
1683                         saveflags = 0;  /* avoids compiler warning with
1684                                            spin_unlock_irqrestore */
1685                         if (event == CH_EVENT_TIMER) // only for TIMER not yet locked
1686                                 spin_lock_irqsave(get_ccwdev_lock(ch->cdev),
1687                                                   saveflags);
1688                         rc = ccw_device_start(ch->cdev, &ch->ccw[3],
1689                                               (unsigned long) ch, 0xff, 0);
1690                         if (event == CH_EVENT_TIMER)
1691                                 spin_unlock_irqrestore(get_ccwdev_lock(ch->cdev),
1692                                                        saveflags);
1693                         if (rc != 0) {
1694                                 fsm_deltimer(&ch->timer);
1695                                 ccw_check_return_code(ch, rc, "TX in ch_action_txretry");
1696                                 ctc_purge_skb_queue(&ch->io_queue);
1697                         }
1698                 }
1699         }
1700
1701 }
1702
1703 /**
1704  * Handle fatal errors during an I/O command.
1705  *
1706  * @param fi    An instance of a channel statemachine.
1707  * @param event The event, just happened.
1708  * @param arg   Generic pointer, casted from channel * upon call.
1709  */
1710 static void
1711 ch_action_iofatal(fsm_instance * fi, int event, void *arg)
1712 {
1713         struct channel *ch = (struct channel *) arg;
1714         struct net_device *dev = ch->netdev;
1715
1716         DBF_TEXT(trace, 3, __FUNCTION__);
1717         fsm_deltimer(&ch->timer);
1718         if (CHANNEL_DIRECTION(ch->flags) == READ) {
1719                 ctc_pr_debug("%s: RX I/O error\n", dev->name);
1720                 fsm_newstate(fi, CH_STATE_RXERR);
1721                 fsm_event(((struct ctc_priv *) dev->priv)->fsm,
1722                           DEV_EVENT_RXDOWN, dev);
1723         } else {
1724                 ctc_pr_debug("%s: TX I/O error\n", dev->name);
1725                 fsm_newstate(fi, CH_STATE_TXERR);
1726                 fsm_event(((struct ctc_priv *) dev->priv)->fsm,
1727                           DEV_EVENT_TXDOWN, dev);
1728         }
1729 }
1730
1731 static void
1732 ch_action_reinit(fsm_instance *fi, int event, void *arg)
1733 {
1734         struct channel *ch = (struct channel *)arg;
1735         struct net_device *dev = ch->netdev;
1736         struct ctc_priv *privptr = dev->priv;
1737
1738         DBF_TEXT(trace, 4, __FUNCTION__);
1739         ch_action_iofatal(fi, event, arg);
1740         fsm_addtimer(&privptr->restart_timer, 1000, DEV_EVENT_RESTART, dev);
1741 }
1742
1743 \f
1744 /**
1745  * The statemachine for a channel.
1746  */
1747 static const fsm_node ch_fsm[] = {
1748         {CH_STATE_STOPPED,    CH_EVENT_STOP,       fsm_action_nop       },
1749         {CH_STATE_STOPPED,    CH_EVENT_START,      ch_action_start      },
1750         {CH_STATE_STOPPED,    CH_EVENT_FINSTAT,    fsm_action_nop       },
1751         {CH_STATE_STOPPED,    CH_EVENT_MC_FAIL,    fsm_action_nop       },
1752
1753         {CH_STATE_NOTOP,      CH_EVENT_STOP,       ch_action_stop       },
1754         {CH_STATE_NOTOP,      CH_EVENT_START,      fsm_action_nop       },
1755         {CH_STATE_NOTOP,      CH_EVENT_FINSTAT,    fsm_action_nop       },
1756         {CH_STATE_NOTOP,      CH_EVENT_MC_FAIL,    fsm_action_nop       },
1757         {CH_STATE_NOTOP,      CH_EVENT_MC_GOOD,    ch_action_start      },
1758
1759         {CH_STATE_STARTWAIT,  CH_EVENT_STOP,       ch_action_haltio     },
1760         {CH_STATE_STARTWAIT,  CH_EVENT_START,      fsm_action_nop       },
1761         {CH_STATE_STARTWAIT,  CH_EVENT_FINSTAT,    ch_action_setmode    },
1762         {CH_STATE_STARTWAIT,  CH_EVENT_TIMER,      ch_action_setuperr   },
1763         {CH_STATE_STARTWAIT,  CH_EVENT_IO_ENODEV,  ch_action_iofatal    },
1764         {CH_STATE_STARTWAIT,  CH_EVENT_IO_EIO,     ch_action_reinit     },
1765         {CH_STATE_STARTWAIT,  CH_EVENT_MC_FAIL,    ch_action_fail       },
1766
1767         {CH_STATE_STARTRETRY, CH_EVENT_STOP,       ch_action_haltio     },
1768         {CH_STATE_STARTRETRY, CH_EVENT_TIMER,      ch_action_setmode    },
1769         {CH_STATE_STARTRETRY, CH_EVENT_FINSTAT,    fsm_action_nop       },
1770         {CH_STATE_STARTRETRY, CH_EVENT_MC_FAIL,    ch_action_fail       },
1771
1772         {CH_STATE_SETUPWAIT,  CH_EVENT_STOP,       ch_action_haltio     },
1773         {CH_STATE_SETUPWAIT,  CH_EVENT_START,      fsm_action_nop       },
1774         {CH_STATE_SETUPWAIT,  CH_EVENT_FINSTAT,    ch_action_firstio    },
1775         {CH_STATE_SETUPWAIT,  CH_EVENT_UC_RCRESET, ch_action_setuperr   },
1776         {CH_STATE_SETUPWAIT,  CH_EVENT_UC_RSRESET, ch_action_setuperr   },
1777         {CH_STATE_SETUPWAIT,  CH_EVENT_TIMER,      ch_action_setmode    },
1778         {CH_STATE_SETUPWAIT,  CH_EVENT_IO_ENODEV,  ch_action_iofatal    },
1779         {CH_STATE_SETUPWAIT,  CH_EVENT_IO_EIO,     ch_action_reinit     },
1780         {CH_STATE_SETUPWAIT,  CH_EVENT_MC_FAIL,    ch_action_fail       },
1781
1782         {CH_STATE_RXINIT,     CH_EVENT_STOP,       ch_action_haltio     },
1783         {CH_STATE_RXINIT,     CH_EVENT_START,      fsm_action_nop       },
1784         {CH_STATE_RXINIT,     CH_EVENT_FINSTAT,    ch_action_rxidle     },
1785         {CH_STATE_RXINIT,     CH_EVENT_UC_RCRESET, ch_action_rxiniterr  },
1786         {CH_STATE_RXINIT,     CH_EVENT_UC_RSRESET, ch_action_rxiniterr  },
1787         {CH_STATE_RXINIT,     CH_EVENT_TIMER,      ch_action_rxiniterr  },
1788         {CH_STATE_RXINIT,     CH_EVENT_ATTNBUSY,   ch_action_rxinitfail },
1789         {CH_STATE_RXINIT,     CH_EVENT_IO_ENODEV,  ch_action_iofatal    },
1790         {CH_STATE_RXINIT,     CH_EVENT_IO_EIO,     ch_action_reinit     },
1791         {CH_STATE_RXINIT,     CH_EVENT_UC_ZERO,    ch_action_firstio    },
1792         {CH_STATE_RXINIT,     CH_EVENT_MC_FAIL,    ch_action_fail       },
1793
1794         {CH_STATE_RXIDLE,     CH_EVENT_STOP,       ch_action_haltio     },
1795         {CH_STATE_RXIDLE,     CH_EVENT_START,      fsm_action_nop       },
1796         {CH_STATE_RXIDLE,     CH_EVENT_FINSTAT,    ch_action_rx         },
1797         {CH_STATE_RXIDLE,     CH_EVENT_UC_RCRESET, ch_action_rxdisc     },
1798 //      {CH_STATE_RXIDLE,     CH_EVENT_UC_RSRESET, ch_action_rxretry    },
1799         {CH_STATE_RXIDLE,     CH_EVENT_IO_ENODEV,  ch_action_iofatal    },
1800         {CH_STATE_RXIDLE,     CH_EVENT_IO_EIO,     ch_action_reinit     },
1801         {CH_STATE_RXIDLE,     CH_EVENT_MC_FAIL,    ch_action_fail       },
1802         {CH_STATE_RXIDLE,     CH_EVENT_UC_ZERO,    ch_action_rx         },
1803
1804         {CH_STATE_TXINIT,     CH_EVENT_STOP,       ch_action_haltio     },
1805         {CH_STATE_TXINIT,     CH_EVENT_START,      fsm_action_nop       },
1806         {CH_STATE_TXINIT,     CH_EVENT_FINSTAT,    ch_action_txidle     },
1807         {CH_STATE_TXINIT,     CH_EVENT_UC_RCRESET, ch_action_txiniterr  },
1808         {CH_STATE_TXINIT,     CH_EVENT_UC_RSRESET, ch_action_txiniterr  },
1809         {CH_STATE_TXINIT,     CH_EVENT_TIMER,      ch_action_txiniterr  },
1810         {CH_STATE_TXINIT,     CH_EVENT_IO_ENODEV,  ch_action_iofatal    },
1811         {CH_STATE_TXINIT,     CH_EVENT_IO_EIO,     ch_action_reinit     },
1812         {CH_STATE_TXINIT,     CH_EVENT_MC_FAIL,    ch_action_fail       },
1813
1814         {CH_STATE_TXIDLE,     CH_EVENT_STOP,       ch_action_haltio     },
1815         {CH_STATE_TXIDLE,     CH_EVENT_START,      fsm_action_nop       },
1816         {CH_STATE_TXIDLE,     CH_EVENT_FINSTAT,    ch_action_firstio    },
1817         {CH_STATE_TXIDLE,     CH_EVENT_UC_RCRESET, fsm_action_nop       },
1818         {CH_STATE_TXIDLE,     CH_EVENT_UC_RSRESET, fsm_action_nop       },
1819         {CH_STATE_TXIDLE,     CH_EVENT_IO_ENODEV,  ch_action_iofatal    },
1820         {CH_STATE_TXIDLE,     CH_EVENT_IO_EIO,     ch_action_reinit     },
1821         {CH_STATE_TXIDLE,     CH_EVENT_MC_FAIL,    ch_action_fail       },
1822
1823         {CH_STATE_TERM,       CH_EVENT_STOP,       fsm_action_nop       },
1824         {CH_STATE_TERM,       CH_EVENT_START,      ch_action_restart    },
1825         {CH_STATE_TERM,       CH_EVENT_FINSTAT,    ch_action_stopped    },
1826         {CH_STATE_TERM,       CH_EVENT_UC_RCRESET, fsm_action_nop       },
1827         {CH_STATE_TERM,       CH_EVENT_UC_RSRESET, fsm_action_nop       },
1828         {CH_STATE_TERM,       CH_EVENT_MC_FAIL,    ch_action_fail       },
1829
1830         {CH_STATE_DTERM,      CH_EVENT_STOP,       ch_action_haltio     },
1831         {CH_STATE_DTERM,      CH_EVENT_START,      ch_action_restart    },
1832         {CH_STATE_DTERM,      CH_EVENT_FINSTAT,    ch_action_setmode    },
1833         {CH_STATE_DTERM,      CH_EVENT_UC_RCRESET, fsm_action_nop       },
1834         {CH_STATE_DTERM,      CH_EVENT_UC_RSRESET, fsm_action_nop       },
1835         {CH_STATE_DTERM,      CH_EVENT_MC_FAIL,    ch_action_fail       },
1836
1837         {CH_STATE_TX,         CH_EVENT_STOP,       ch_action_haltio     },
1838         {CH_STATE_TX,         CH_EVENT_START,      fsm_action_nop       },
1839         {CH_STATE_TX,         CH_EVENT_FINSTAT,    ch_action_txdone     },
1840         {CH_STATE_TX,         CH_EVENT_UC_RCRESET, ch_action_txretry    },
1841         {CH_STATE_TX,         CH_EVENT_UC_RSRESET, ch_action_txretry    },
1842         {CH_STATE_TX,         CH_EVENT_TIMER,      ch_action_txretry    },
1843         {CH_STATE_TX,         CH_EVENT_IO_ENODEV,  ch_action_iofatal    },
1844         {CH_STATE_TX,         CH_EVENT_IO_EIO,     ch_action_reinit     },
1845         {CH_STATE_TX,         CH_EVENT_MC_FAIL,    ch_action_fail       },
1846
1847         {CH_STATE_RXERR,      CH_EVENT_STOP,       ch_action_haltio     },
1848         {CH_STATE_TXERR,      CH_EVENT_STOP,       ch_action_haltio     },
1849         {CH_STATE_TXERR,      CH_EVENT_MC_FAIL,    ch_action_fail       },
1850         {CH_STATE_RXERR,      CH_EVENT_MC_FAIL,    ch_action_fail       },
1851 };
1852
1853 static const int CH_FSM_LEN = sizeof (ch_fsm) / sizeof (fsm_node);
1854 \f
1855 /**
1856  * Functions related to setup and device detection.
1857  *****************************************************************************/
1858
1859 static inline int
1860 less_than(char *id1, char *id2)
1861 {
1862         int dev1, dev2, i;
1863
1864         for (i = 0; i < 5; i++) {
1865                 id1++;
1866                 id2++;
1867         }
1868         dev1 = simple_strtoul(id1, &id1, 16);
1869         dev2 = simple_strtoul(id2, &id2, 16);
1870
1871         return (dev1 < dev2);
1872 }
1873
1874 /**
1875  * Add a new channel to the list of channels.
1876  * Keeps the channel list sorted.
1877  *
1878  * @param cdev  The ccw_device to be added.
1879  * @param type  The type class of the new channel.
1880  *
1881  * @return 0 on success, !0 on error.
1882  */
1883 static int
1884 add_channel(struct ccw_device *cdev, enum channel_types type)
1885 {
1886         struct channel **c = &channels;
1887         struct channel *ch;
1888
1889         DBF_TEXT(trace, 2, __FUNCTION__);
1890         if ((ch =
1891              (struct channel *) kmalloc(sizeof (struct channel),
1892                                         GFP_KERNEL)) == NULL) {
1893                 ctc_pr_warn("ctc: Out of memory in add_channel\n");
1894                 return -1;
1895         }
1896         memset(ch, 0, sizeof (struct channel));
1897         if ((ch->ccw = (struct ccw1 *) kmalloc(sizeof (struct ccw1) * 8,
1898                                                GFP_KERNEL | GFP_DMA)) == NULL) {
1899                 kfree(ch);
1900                 ctc_pr_warn("ctc: Out of memory in add_channel\n");
1901                 return -1;
1902         }
1903
1904         /**
1905          * "static" ccws are used in the following way:
1906          *
1907          * ccw[0..2] (Channel program for generic I/O):
1908          *           0: prepare
1909          *           1: read or write (depending on direction) with fixed
1910          *              buffer (idal allocated once when buffer is allocated)
1911          *           2: nop
1912          * ccw[3..5] (Channel program for direct write of packets)
1913          *           3: prepare
1914          *           4: write (idal allocated on every write).
1915          *           5: nop
1916          * ccw[6..7] (Channel program for initial channel setup):
1917          *           3: set extended mode
1918          *           4: nop
1919          *
1920          * ch->ccw[0..5] are initialized in ch_action_start because
1921          * the channel's direction is yet unknown here.
1922          */
1923         ch->ccw[6].cmd_code = CCW_CMD_SET_EXTENDED;
1924         ch->ccw[6].flags = CCW_FLAG_SLI;
1925         ch->ccw[6].count = 0;
1926         ch->ccw[6].cda = 0;
1927
1928         ch->ccw[7].cmd_code = CCW_CMD_NOOP;
1929         ch->ccw[7].flags = CCW_FLAG_SLI;
1930         ch->ccw[7].count = 0;
1931         ch->ccw[7].cda = 0;
1932
1933         ch->cdev = cdev;
1934         snprintf(ch->id, CTC_ID_SIZE, "ch-%s", cdev->dev.bus_id);
1935         ch->type = type;
1936         loglevel = CTC_LOGLEVEL_DEFAULT;
1937         ch->fsm = init_fsm(ch->id, ch_state_names,
1938                            ch_event_names, NR_CH_STATES, NR_CH_EVENTS,
1939                            ch_fsm, CH_FSM_LEN, GFP_KERNEL);
1940         if (ch->fsm == NULL) {
1941                 ctc_pr_warn("ctc: Could not create FSM in add_channel\n");
1942                 kfree(ch);
1943                 return -1;
1944         }
1945         fsm_newstate(ch->fsm, CH_STATE_IDLE);
1946         if ((ch->irb = (struct irb *) kmalloc(sizeof (struct irb),
1947                                               GFP_KERNEL)) == NULL) {
1948                 ctc_pr_warn("ctc: Out of memory in add_channel\n");
1949                 kfree_fsm(ch->fsm);
1950                 kfree(ch);
1951                 return -1;
1952         }
1953         memset(ch->irb, 0, sizeof (struct irb));
1954         while (*c && less_than((*c)->id, ch->id))
1955                 c = &(*c)->next;
1956         if (!strncmp((*c)->id, ch->id, CTC_ID_SIZE)) {
1957                 ctc_pr_debug(
1958                         "ctc: add_channel: device %s already in list, "
1959                         "using old entry\n", (*c)->id);
1960                 kfree(ch->irb);
1961                 kfree_fsm(ch->fsm);
1962                 kfree(ch);
1963                 return 0;
1964         }
1965         fsm_settimer(ch->fsm, &ch->timer);
1966         skb_queue_head_init(&ch->io_queue);
1967         skb_queue_head_init(&ch->collect_queue);
1968         ch->next = *c;
1969         *c = ch;
1970         return 0;
1971 }
1972
1973 /**
1974  * Release a specific channel in the channel list.
1975  *
1976  * @param ch Pointer to channel struct to be released.
1977  */
1978 static void
1979 channel_free(struct channel *ch)
1980 {
1981         ch->flags &= ~CHANNEL_FLAGS_INUSE;
1982         fsm_newstate(ch->fsm, CH_STATE_IDLE);
1983 }
1984
1985 /**
1986  * Remove a specific channel in the channel list.
1987  *
1988  * @param ch Pointer to channel struct to be released.
1989  */
1990 static void
1991 channel_remove(struct channel *ch)
1992 {
1993         struct channel **c = &channels;
1994
1995         DBF_TEXT(trace, 2, __FUNCTION__);
1996         if (ch == NULL)
1997                 return;
1998
1999         channel_free(ch);
2000         while (*c) {
2001                 if (*c == ch) {
2002                         *c = ch->next;
2003                         fsm_deltimer(&ch->timer);
2004                         kfree_fsm(ch->fsm);
2005                         clear_normalized_cda(&ch->ccw[4]);
2006                         if (ch->trans_skb != NULL) {
2007                                 clear_normalized_cda(&ch->ccw[1]);
2008                                 dev_kfree_skb(ch->trans_skb);
2009                         }
2010                         kfree(ch->ccw);
2011                         return;
2012                 }
2013                 c = &((*c)->next);
2014         }
2015 }
2016
2017 /**
2018  * Get a specific channel from the channel list.
2019  *
2020  * @param type Type of channel we are interested in.
2021  * @param id Id of channel we are interested in.
2022  * @param direction Direction we want to use this channel for.
2023  *
2024  * @return Pointer to a channel or NULL if no matching channel available.
2025  */
2026 static struct channel
2027 *
2028 channel_get(enum channel_types type, char *id, int direction)
2029 {
2030         struct channel *ch = channels;
2031
2032         DBF_TEXT(trace, 3, __FUNCTION__);
2033 #ifdef DEBUG
2034         ctc_pr_debug("ctc: %s(): searching for ch with id %s and type %d\n",
2035                      __func__, id, type);
2036 #endif
2037
2038         while (ch && ((strncmp(ch->id, id, CTC_ID_SIZE)) || (ch->type != type))) {
2039 #ifdef DEBUG
2040                 ctc_pr_debug("ctc: %s(): ch=0x%p (id=%s, type=%d\n",
2041                              __func__, ch, ch->id, ch->type);
2042 #endif
2043                 ch = ch->next;
2044         }
2045 #ifdef DEBUG
2046         ctc_pr_debug("ctc: %s(): ch=0x%pq (id=%s, type=%d\n",
2047                      __func__, ch, ch->id, ch->type);
2048 #endif
2049         if (!ch) {
2050                 ctc_pr_warn("ctc: %s(): channel with id %s "
2051                             "and type %d not found in channel list\n",
2052                             __func__, id, type);
2053         } else {
2054                 if (ch->flags & CHANNEL_FLAGS_INUSE)
2055                         ch = NULL;
2056                 else {
2057                         ch->flags |= CHANNEL_FLAGS_INUSE;
2058                         ch->flags &= ~CHANNEL_FLAGS_RWMASK;
2059                         ch->flags |= (direction == WRITE)
2060                             ? CHANNEL_FLAGS_WRITE : CHANNEL_FLAGS_READ;
2061                         fsm_newstate(ch->fsm, CH_STATE_STOPPED);
2062                 }
2063         }
2064         return ch;
2065 }
2066
2067 /**
2068  * Return the channel type by name.
2069  *
2070  * @param name Name of network interface.
2071  *
2072  * @return Type class of channel to be used for that interface.
2073  */
2074 static enum channel_types inline
2075 extract_channel_media(char *name)
2076 {
2077         enum channel_types ret = channel_type_unknown;
2078
2079         if (name != NULL) {
2080                 if (strncmp(name, "ctc", 3) == 0)
2081                         ret = channel_type_parallel;
2082                 if (strncmp(name, "escon", 5) == 0)
2083                         ret = channel_type_escon;
2084         }
2085         return ret;
2086 }
2087
2088 static long
2089 __ctc_check_irb_error(struct ccw_device *cdev, struct irb *irb)
2090 {
2091         if (!IS_ERR(irb))
2092                 return 0;
2093
2094         switch (PTR_ERR(irb)) {
2095         case -EIO:
2096                 ctc_pr_warn("i/o-error on device %s\n", cdev->dev.bus_id);
2097 //              CTC_DBF_TEXT(trace, 2, "ckirberr");
2098 //              CTC_DBF_TEXT_(trace, 2, "  rc%d", -EIO);
2099                 break;
2100         case -ETIMEDOUT:
2101                 ctc_pr_warn("timeout on device %s\n", cdev->dev.bus_id);
2102 //              CTC_DBF_TEXT(trace, 2, "ckirberr");
2103 //              CTC_DBF_TEXT_(trace, 2, "  rc%d", -ETIMEDOUT);
2104                 break;
2105         default:
2106                 ctc_pr_warn("unknown error %ld on device %s\n", PTR_ERR(irb),
2107                            cdev->dev.bus_id);
2108 //              CTC_DBF_TEXT(trace, 2, "ckirberr");
2109 //              CTC_DBF_TEXT(trace, 2, "  rc???");
2110         }
2111         return PTR_ERR(irb);
2112 }
2113
2114 /**
2115  * Main IRQ handler.
2116  *
2117  * @param cdev    The ccw_device the interrupt is for.
2118  * @param intparm interruption parameter.
2119  * @param irb     interruption response block.
2120  */
2121 static void
2122 ctc_irq_handler(struct ccw_device *cdev, unsigned long intparm, struct irb *irb)
2123 {
2124         struct channel *ch;
2125         struct net_device *dev;
2126         struct ctc_priv *priv;
2127
2128         DBF_TEXT(trace, 5, __FUNCTION__);
2129         if (__ctc_check_irb_error(cdev, irb))
2130                 return;
2131
2132         /* Check for unsolicited interrupts. */
2133         if (!cdev->dev.driver_data) {
2134                 ctc_pr_warn("ctc: Got unsolicited irq: %s c-%02x d-%02x\n",
2135                             cdev->dev.bus_id, irb->scsw.cstat,
2136                             irb->scsw.dstat);
2137                 return;
2138         }
2139
2140         priv = ((struct ccwgroup_device *)cdev->dev.driver_data)
2141                 ->dev.driver_data;
2142
2143         /* Try to extract channel from driver data. */
2144         if (priv->channel[READ]->cdev == cdev)
2145                 ch = priv->channel[READ];
2146         else if (priv->channel[WRITE]->cdev == cdev)
2147                 ch = priv->channel[WRITE];
2148         else {
2149                 ctc_pr_err("ctc: Can't determine channel for interrupt, "
2150                            "device %s\n", cdev->dev.bus_id);
2151                 return;
2152         }
2153
2154         dev = (struct net_device *) (ch->netdev);
2155         if (dev == NULL) {
2156                 ctc_pr_crit("ctc: ctc_irq_handler dev=NULL bus_id=%s, ch=0x%p\n",
2157                             cdev->dev.bus_id, ch);
2158                 return;
2159         }
2160
2161 #ifdef DEBUG
2162         ctc_pr_debug("%s: interrupt for device: %s received c-%02x d-%02x\n",
2163                      dev->name, ch->id, irb->scsw.cstat, irb->scsw.dstat);
2164 #endif
2165
2166         /* Copy interruption response block. */
2167         memcpy(ch->irb, irb, sizeof(struct irb));
2168
2169         /* Check for good subchannel return code, otherwise error message */
2170         if (ch->irb->scsw.cstat) {
2171                 fsm_event(ch->fsm, CH_EVENT_SC_UNKNOWN, ch);
2172                 ctc_pr_warn("%s: subchannel check for device: %s - %02x %02x\n",
2173                             dev->name, ch->id, ch->irb->scsw.cstat,
2174                             ch->irb->scsw.dstat);
2175                 return;
2176         }
2177
2178         /* Check the reason-code of a unit check */
2179         if (ch->irb->scsw.dstat & DEV_STAT_UNIT_CHECK) {
2180                 ccw_unit_check(ch, ch->irb->ecw[0]);
2181                 return;
2182         }
2183         if (ch->irb->scsw.dstat & DEV_STAT_BUSY) {
2184                 if (ch->irb->scsw.dstat & DEV_STAT_ATTENTION)
2185                         fsm_event(ch->fsm, CH_EVENT_ATTNBUSY, ch);
2186                 else
2187                         fsm_event(ch->fsm, CH_EVENT_BUSY, ch);
2188                 return;
2189         }
2190         if (ch->irb->scsw.dstat & DEV_STAT_ATTENTION) {
2191                 fsm_event(ch->fsm, CH_EVENT_ATTN, ch);
2192                 return;
2193         }
2194         if ((ch->irb->scsw.stctl & SCSW_STCTL_SEC_STATUS) ||
2195             (ch->irb->scsw.stctl == SCSW_STCTL_STATUS_PEND) ||
2196             (ch->irb->scsw.stctl ==
2197              (SCSW_STCTL_ALERT_STATUS | SCSW_STCTL_STATUS_PEND)))
2198                 fsm_event(ch->fsm, CH_EVENT_FINSTAT, ch);
2199         else
2200                 fsm_event(ch->fsm, CH_EVENT_IRQ, ch);
2201
2202 }
2203 \f
2204 /**
2205  * Actions for interface - statemachine.
2206  *****************************************************************************/
2207
2208 /**
2209  * Startup channels by sending CH_EVENT_START to each channel.
2210  *
2211  * @param fi    An instance of an interface statemachine.
2212  * @param event The event, just happened.
2213  * @param arg   Generic pointer, casted from struct net_device * upon call.
2214  */
2215 static void
2216 dev_action_start(fsm_instance * fi, int event, void *arg)
2217 {
2218         struct net_device *dev = (struct net_device *) arg;
2219         struct ctc_priv *privptr = dev->priv;
2220         int direction;
2221
2222         DBF_TEXT(setup, 3, __FUNCTION__);
2223         fsm_deltimer(&privptr->restart_timer);
2224         fsm_newstate(fi, DEV_STATE_STARTWAIT_RXTX);
2225         for (direction = READ; direction <= WRITE; direction++) {
2226                 struct channel *ch = privptr->channel[direction];
2227                 fsm_event(ch->fsm, CH_EVENT_START, ch);
2228         }
2229 }
2230
2231 /**
2232  * Shutdown channels by sending CH_EVENT_STOP to each channel.
2233  *
2234  * @param fi    An instance of an interface statemachine.
2235  * @param event The event, just happened.
2236  * @param arg   Generic pointer, casted from struct net_device * upon call.
2237  */
2238 static void
2239 dev_action_stop(fsm_instance * fi, int event, void *arg)
2240 {
2241         struct net_device *dev = (struct net_device *) arg;
2242         struct ctc_priv *privptr = dev->priv;
2243         int direction;
2244
2245         DBF_TEXT(trace, 3, __FUNCTION__);
2246         fsm_newstate(fi, DEV_STATE_STOPWAIT_RXTX);
2247         for (direction = READ; direction <= WRITE; direction++) {
2248                 struct channel *ch = privptr->channel[direction];
2249                 fsm_event(ch->fsm, CH_EVENT_STOP, ch);
2250         }
2251 }
2252 static void
2253 dev_action_restart(fsm_instance *fi, int event, void *arg)
2254 {
2255         struct net_device *dev = (struct net_device *)arg;
2256         struct ctc_priv *privptr = dev->priv;
2257
2258         DBF_TEXT(trace, 3, __FUNCTION__);
2259         ctc_pr_debug("%s: Restarting\n", dev->name);
2260         dev_action_stop(fi, event, arg);
2261         fsm_event(privptr->fsm, DEV_EVENT_STOP, dev);
2262         fsm_addtimer(&privptr->restart_timer, CTC_TIMEOUT_5SEC,
2263                      DEV_EVENT_START, dev);
2264 }
2265
2266 /**
2267  * Called from channel statemachine
2268  * when a channel is up and running.
2269  *
2270  * @param fi    An instance of an interface statemachine.
2271  * @param event The event, just happened.
2272  * @param arg   Generic pointer, casted from struct net_device * upon call.
2273  */
2274 static void
2275 dev_action_chup(fsm_instance * fi, int event, void *arg)
2276 {
2277         struct net_device *dev = (struct net_device *) arg;
2278         struct ctc_priv *privptr = dev->priv;
2279
2280         DBF_TEXT(trace, 3, __FUNCTION__);
2281         switch (fsm_getstate(fi)) {
2282                 case DEV_STATE_STARTWAIT_RXTX:
2283                         if (event == DEV_EVENT_RXUP)
2284                                 fsm_newstate(fi, DEV_STATE_STARTWAIT_TX);
2285                         else
2286                                 fsm_newstate(fi, DEV_STATE_STARTWAIT_RX);
2287                         break;
2288                 case DEV_STATE_STARTWAIT_RX:
2289                         if (event == DEV_EVENT_RXUP) {
2290                                 fsm_newstate(fi, DEV_STATE_RUNNING);
2291                                 ctc_pr_info("%s: connected with remote side\n",
2292                                             dev->name);
2293                                 if (privptr->protocol == CTC_PROTO_LINUX_TTY)
2294                                         ctc_tty_setcarrier(dev, 1);
2295                                 ctc_clear_busy(dev);
2296                         }
2297                         break;
2298                 case DEV_STATE_STARTWAIT_TX:
2299                         if (event == DEV_EVENT_TXUP) {
2300                                 fsm_newstate(fi, DEV_STATE_RUNNING);
2301                                 ctc_pr_info("%s: connected with remote side\n",
2302                                             dev->name);
2303                                 if (privptr->protocol == CTC_PROTO_LINUX_TTY)
2304                                         ctc_tty_setcarrier(dev, 1);
2305                                 ctc_clear_busy(dev);
2306                         }
2307                         break;
2308                 case DEV_STATE_STOPWAIT_TX:
2309                         if (event == DEV_EVENT_RXUP)
2310                                 fsm_newstate(fi, DEV_STATE_STOPWAIT_RXTX);
2311                         break;
2312                 case DEV_STATE_STOPWAIT_RX:
2313                         if (event == DEV_EVENT_TXUP)
2314                                 fsm_newstate(fi, DEV_STATE_STOPWAIT_RXTX);
2315                         break;
2316         }
2317 }
2318
2319 /**
2320  * Called from channel statemachine
2321  * when a channel has been shutdown.
2322  *
2323  * @param fi    An instance of an interface statemachine.
2324  * @param event The event, just happened.
2325  * @param arg   Generic pointer, casted from struct net_device * upon call.
2326  */
2327 static void
2328 dev_action_chdown(fsm_instance * fi, int event, void *arg)
2329 {
2330         struct net_device *dev = (struct net_device *) arg;
2331         struct ctc_priv *privptr = dev->priv;
2332
2333         DBF_TEXT(trace, 3, __FUNCTION__);
2334         switch (fsm_getstate(fi)) {
2335                 case DEV_STATE_RUNNING:
2336                         if (privptr->protocol == CTC_PROTO_LINUX_TTY)
2337                                 ctc_tty_setcarrier(dev, 0);
2338                         if (event == DEV_EVENT_TXDOWN)
2339                                 fsm_newstate(fi, DEV_STATE_STARTWAIT_TX);
2340                         else
2341                                 fsm_newstate(fi, DEV_STATE_STARTWAIT_RX);
2342                         break;
2343                 case DEV_STATE_STARTWAIT_RX:
2344                         if (event == DEV_EVENT_TXDOWN)
2345                                 fsm_newstate(fi, DEV_STATE_STARTWAIT_RXTX);
2346                         break;
2347                 case DEV_STATE_STARTWAIT_TX:
2348                         if (event == DEV_EVENT_RXDOWN)
2349                                 fsm_newstate(fi, DEV_STATE_STARTWAIT_RXTX);
2350                         break;
2351                 case DEV_STATE_STOPWAIT_RXTX:
2352                         if (event == DEV_EVENT_TXDOWN)
2353                                 fsm_newstate(fi, DEV_STATE_STOPWAIT_RX);
2354                         else
2355                                 fsm_newstate(fi, DEV_STATE_STOPWAIT_TX);
2356                         break;
2357                 case DEV_STATE_STOPWAIT_RX:
2358                         if (event == DEV_EVENT_RXDOWN)
2359                                 fsm_newstate(fi, DEV_STATE_STOPPED);
2360                         break;
2361                 case DEV_STATE_STOPWAIT_TX:
2362                         if (event == DEV_EVENT_TXDOWN)
2363                                 fsm_newstate(fi, DEV_STATE_STOPPED);
2364                         break;
2365         }
2366 }
2367
2368 static const fsm_node dev_fsm[] = {
2369         {DEV_STATE_STOPPED, DEV_EVENT_START, dev_action_start},
2370
2371         {DEV_STATE_STOPWAIT_RXTX,  DEV_EVENT_START,   dev_action_start   },
2372         {DEV_STATE_STOPWAIT_RXTX,  DEV_EVENT_RXDOWN,  dev_action_chdown  },
2373         {DEV_STATE_STOPWAIT_RXTX,  DEV_EVENT_TXDOWN,  dev_action_chdown  },
2374         {DEV_STATE_STOPWAIT_RXTX,  DEV_EVENT_RESTART, dev_action_restart },
2375
2376         {DEV_STATE_STOPWAIT_RX,    DEV_EVENT_START,   dev_action_start   },
2377         {DEV_STATE_STOPWAIT_RX,    DEV_EVENT_RXUP,    dev_action_chup    },
2378         {DEV_STATE_STOPWAIT_RX,    DEV_EVENT_TXUP,    dev_action_chup    },
2379         {DEV_STATE_STOPWAIT_RX,    DEV_EVENT_RXDOWN,  dev_action_chdown  },
2380         {DEV_STATE_STOPWAIT_RX,    DEV_EVENT_RESTART, dev_action_restart },
2381
2382         {DEV_STATE_STOPWAIT_TX,    DEV_EVENT_START,   dev_action_start   },
2383         {DEV_STATE_STOPWAIT_TX,    DEV_EVENT_RXUP,    dev_action_chup    },
2384         {DEV_STATE_STOPWAIT_TX,    DEV_EVENT_TXUP,    dev_action_chup    },
2385         {DEV_STATE_STOPWAIT_TX,    DEV_EVENT_TXDOWN,  dev_action_chdown  },
2386         {DEV_STATE_STOPWAIT_TX,    DEV_EVENT_RESTART, dev_action_restart },
2387
2388         {DEV_STATE_STARTWAIT_RXTX, DEV_EVENT_STOP,    dev_action_stop    },
2389         {DEV_STATE_STARTWAIT_RXTX, DEV_EVENT_RXUP,    dev_action_chup    },
2390         {DEV_STATE_STARTWAIT_RXTX, DEV_EVENT_TXUP,    dev_action_chup    },
2391         {DEV_STATE_STARTWAIT_RXTX, DEV_EVENT_RXDOWN,  dev_action_chdown  },
2392         {DEV_STATE_STARTWAIT_RXTX, DEV_EVENT_TXDOWN,  dev_action_chdown  },
2393         {DEV_STATE_STARTWAIT_RXTX, DEV_EVENT_RESTART, dev_action_restart },
2394
2395         {DEV_STATE_STARTWAIT_TX,   DEV_EVENT_STOP,    dev_action_stop    },
2396         {DEV_STATE_STARTWAIT_TX,   DEV_EVENT_RXUP,    dev_action_chup    },
2397         {DEV_STATE_STARTWAIT_TX,   DEV_EVENT_TXUP,    dev_action_chup    },
2398         {DEV_STATE_STARTWAIT_TX,   DEV_EVENT_RXDOWN,  dev_action_chdown  },
2399         {DEV_STATE_STARTWAIT_TX,   DEV_EVENT_RESTART, dev_action_restart },
2400
2401         {DEV_STATE_STARTWAIT_RX,   DEV_EVENT_STOP,    dev_action_stop    },
2402         {DEV_STATE_STARTWAIT_RX,   DEV_EVENT_RXUP,    dev_action_chup    },
2403         {DEV_STATE_STARTWAIT_RX,   DEV_EVENT_TXUP,    dev_action_chup    },
2404         {DEV_STATE_STARTWAIT_RX,   DEV_EVENT_TXDOWN,  dev_action_chdown  },
2405         {DEV_STATE_STARTWAIT_RX,   DEV_EVENT_RESTART, dev_action_restart },
2406
2407         {DEV_STATE_RUNNING,        DEV_EVENT_STOP,    dev_action_stop    },
2408         {DEV_STATE_RUNNING,        DEV_EVENT_RXDOWN,  dev_action_chdown  },
2409         {DEV_STATE_RUNNING,        DEV_EVENT_TXDOWN,  dev_action_chdown  },
2410         {DEV_STATE_RUNNING,        DEV_EVENT_TXUP,    fsm_action_nop     },
2411         {DEV_STATE_RUNNING,        DEV_EVENT_RXUP,    fsm_action_nop     },
2412         {DEV_STATE_RUNNING,        DEV_EVENT_RESTART, dev_action_restart },
2413 };
2414
2415 static const int DEV_FSM_LEN = sizeof (dev_fsm) / sizeof (fsm_node);
2416
2417 /**
2418  * Transmit a packet.
2419  * This is a helper function for ctc_tx().
2420  *
2421  * @param ch Channel to be used for sending.
2422  * @param skb Pointer to struct sk_buff of packet to send.
2423  *            The linklevel header has already been set up
2424  *            by ctc_tx().
2425  *
2426  * @return 0 on success, -ERRNO on failure. (Never fails.)
2427  */
2428 static int
2429 transmit_skb(struct channel *ch, struct sk_buff *skb)
2430 {
2431         unsigned long saveflags;
2432         struct ll_header header;
2433         int rc = 0;
2434
2435         DBF_TEXT(trace, 5, __FUNCTION__);
2436         if (fsm_getstate(ch->fsm) != CH_STATE_TXIDLE) {
2437                 int l = skb->len + LL_HEADER_LENGTH;
2438
2439                 spin_lock_irqsave(&ch->collect_lock, saveflags);
2440                 if (ch->collect_len + l > ch->max_bufsize - 2)
2441                         rc = -EBUSY;
2442                 else {
2443                         atomic_inc(&skb->users);
2444                         header.length = l;
2445                         header.type = skb->protocol;
2446                         header.unused = 0;
2447                         memcpy(skb_push(skb, LL_HEADER_LENGTH), &header,
2448                                LL_HEADER_LENGTH);
2449                         skb_queue_tail(&ch->collect_queue, skb);
2450                         ch->collect_len += l;
2451                 }
2452                 spin_unlock_irqrestore(&ch->collect_lock, saveflags);
2453         } else {
2454                 __u16 block_len;
2455                 int ccw_idx;
2456                 struct sk_buff *nskb;
2457                 unsigned long hi;
2458
2459                 /**
2460                  * Protect skb against beeing free'd by upper
2461                  * layers.
2462                  */
2463                 atomic_inc(&skb->users);
2464                 ch->prof.txlen += skb->len;
2465                 header.length = skb->len + LL_HEADER_LENGTH;
2466                 header.type = skb->protocol;
2467                 header.unused = 0;
2468                 memcpy(skb_push(skb, LL_HEADER_LENGTH), &header,
2469                        LL_HEADER_LENGTH);
2470                 block_len = skb->len + 2;
2471                 *((__u16 *) skb_push(skb, 2)) = block_len;
2472
2473                 /**
2474                  * IDAL support in CTC is broken, so we have to
2475                  * care about skb's above 2G ourselves.
2476                  */
2477                 hi = ((unsigned long) skb->tail + LL_HEADER_LENGTH) >> 31;
2478                 if (hi) {
2479                         nskb = alloc_skb(skb->len, GFP_ATOMIC | GFP_DMA);
2480                         if (!nskb) {
2481                                 atomic_dec(&skb->users);
2482                                 skb_pull(skb, LL_HEADER_LENGTH + 2);
2483                                 return -ENOMEM;
2484                         } else {
2485                                 memcpy(skb_put(nskb, skb->len),
2486                                        skb->data, skb->len);
2487                                 atomic_inc(&nskb->users);
2488                                 atomic_dec(&skb->users);
2489                                 dev_kfree_skb_irq(skb);
2490                                 skb = nskb;
2491                         }
2492                 }
2493
2494                 ch->ccw[4].count = block_len;
2495                 if (set_normalized_cda(&ch->ccw[4], skb->data)) {
2496                         /**
2497                          * idal allocation failed, try via copying to
2498                          * trans_skb. trans_skb usually has a pre-allocated
2499                          * idal.
2500                          */
2501                         if (ctc_checkalloc_buffer(ch, 1)) {
2502                                 /**
2503                                  * Remove our header. It gets added
2504                                  * again on retransmit.
2505                                  */
2506                                 atomic_dec(&skb->users);
2507                                 skb_pull(skb, LL_HEADER_LENGTH + 2);
2508                                 return -EBUSY;
2509                         }
2510
2511                         ch->trans_skb->tail = ch->trans_skb->data;
2512                         ch->trans_skb->len = 0;
2513                         ch->ccw[1].count = skb->len;
2514                         memcpy(skb_put(ch->trans_skb, skb->len), skb->data,
2515                                skb->len);
2516                         atomic_dec(&skb->users);
2517                         dev_kfree_skb_irq(skb);
2518                         ccw_idx = 0;
2519                 } else {
2520                         skb_queue_tail(&ch->io_queue, skb);
2521                         ccw_idx = 3;
2522                 }
2523                 ch->retry = 0;
2524                 fsm_newstate(ch->fsm, CH_STATE_TX);
2525                 fsm_addtimer(&ch->timer, CTC_TIMEOUT_5SEC, CH_EVENT_TIMER, ch);
2526                 spin_lock_irqsave(get_ccwdev_lock(ch->cdev), saveflags);
2527                 ch->prof.send_stamp = xtime;
2528                 rc = ccw_device_start(ch->cdev, &ch->ccw[ccw_idx],
2529                                       (unsigned long) ch, 0xff, 0);
2530                 spin_unlock_irqrestore(get_ccwdev_lock(ch->cdev), saveflags);
2531                 if (ccw_idx == 3)
2532                         ch->prof.doios_single++;
2533                 if (rc != 0) {
2534                         fsm_deltimer(&ch->timer);
2535                         ccw_check_return_code(ch, rc, "single skb TX");
2536                         if (ccw_idx == 3)
2537                                 skb_dequeue_tail(&ch->io_queue);
2538                         /**
2539                          * Remove our header. It gets added
2540                          * again on retransmit.
2541                          */
2542                         skb_pull(skb, LL_HEADER_LENGTH + 2);
2543                 } else {
2544                         if (ccw_idx == 0) {
2545                                 struct net_device *dev = ch->netdev;
2546                                 struct ctc_priv *privptr = dev->priv;
2547                                 privptr->stats.tx_packets++;
2548                                 privptr->stats.tx_bytes +=
2549                                     skb->len - LL_HEADER_LENGTH;
2550                         }
2551                 }
2552         }
2553
2554         return rc;
2555 }
2556 \f
2557 /**
2558  * Interface API for upper network layers
2559  *****************************************************************************/
2560
2561 /**
2562  * Open an interface.
2563  * Called from generic network layer when ifconfig up is run.
2564  *
2565  * @param dev Pointer to interface struct.
2566  *
2567  * @return 0 on success, -ERRNO on failure. (Never fails.)
2568  */
2569 static int
2570 ctc_open(struct net_device * dev)
2571 {
2572         DBF_TEXT(trace, 5, __FUNCTION__);
2573         fsm_event(((struct ctc_priv *) dev->priv)->fsm, DEV_EVENT_START, dev);
2574         return 0;
2575 }
2576
2577 /**
2578  * Close an interface.
2579  * Called from generic network layer when ifconfig down is run.
2580  *
2581  * @param dev Pointer to interface struct.
2582  *
2583  * @return 0 on success, -ERRNO on failure. (Never fails.)
2584  */
2585 static int
2586 ctc_close(struct net_device * dev)
2587 {
2588         DBF_TEXT(trace, 5, __FUNCTION__);
2589         fsm_event(((struct ctc_priv *) dev->priv)->fsm, DEV_EVENT_STOP, dev);
2590         return 0;
2591 }
2592
2593 /**
2594  * Start transmission of a packet.
2595  * Called from generic network device layer.
2596  *
2597  * @param skb Pointer to buffer containing the packet.
2598  * @param dev Pointer to interface struct.
2599  *
2600  * @return 0 if packet consumed, !0 if packet rejected.
2601  *         Note: If we return !0, then the packet is free'd by
2602  *               the generic network layer.
2603  */
2604 static int
2605 ctc_tx(struct sk_buff *skb, struct net_device * dev)
2606 {
2607         int rc = 0;
2608         struct ctc_priv *privptr = (struct ctc_priv *) dev->priv;
2609
2610         DBF_TEXT(trace, 5, __FUNCTION__);
2611         /**
2612          * Some sanity checks ...
2613          */
2614         if (skb == NULL) {
2615                 ctc_pr_warn("%s: NULL sk_buff passed\n", dev->name);
2616                 privptr->stats.tx_dropped++;
2617                 return 0;
2618         }
2619         if (skb_headroom(skb) < (LL_HEADER_LENGTH + 2)) {
2620                 ctc_pr_warn("%s: Got sk_buff with head room < %ld bytes\n",
2621                             dev->name, LL_HEADER_LENGTH + 2);
2622                 dev_kfree_skb(skb);
2623                 privptr->stats.tx_dropped++;
2624                 return 0;
2625         }
2626
2627         /**
2628          * If channels are not running, try to restart them
2629          * and throw away packet.
2630          */
2631         if (fsm_getstate(privptr->fsm) != DEV_STATE_RUNNING) {
2632                 fsm_event(privptr->fsm, DEV_EVENT_START, dev);
2633                 if (privptr->protocol == CTC_PROTO_LINUX_TTY)
2634                         return -EBUSY;
2635                 dev_kfree_skb(skb);
2636                 privptr->stats.tx_dropped++;
2637                 privptr->stats.tx_errors++;
2638                 privptr->stats.tx_carrier_errors++;
2639                 return 0;
2640         }
2641
2642         if (ctc_test_and_set_busy(dev))
2643                 return -EBUSY;
2644
2645         dev->trans_start = jiffies;
2646         if (transmit_skb(privptr->channel[WRITE], skb) != 0)
2647                 rc = 1;
2648         ctc_clear_busy(dev);
2649         return rc;
2650 }
2651
2652 /**
2653  * Sets MTU of an interface.
2654  *
2655  * @param dev     Pointer to interface struct.
2656  * @param new_mtu The new MTU to use for this interface.
2657  *
2658  * @return 0 on success, -EINVAL if MTU is out of valid range.
2659  *         (valid range is 576 .. 65527). If VM is on the
2660  *         remote side, maximum MTU is 32760, however this is
2661  *         <em>not</em> checked here.
2662  */
2663 static int
2664 ctc_change_mtu(struct net_device * dev, int new_mtu)
2665 {
2666         struct ctc_priv *privptr = (struct ctc_priv *) dev->priv;
2667
2668         DBF_TEXT(trace, 3, __FUNCTION__);
2669         if ((new_mtu < 576) || (new_mtu > 65527) ||
2670             (new_mtu > (privptr->channel[READ]->max_bufsize -
2671                         LL_HEADER_LENGTH - 2)))
2672                 return -EINVAL;
2673         dev->mtu = new_mtu;
2674         dev->hard_header_len = LL_HEADER_LENGTH + 2;
2675         return 0;
2676 }
2677
2678 /**
2679  * Returns interface statistics of a device.
2680  *
2681  * @param dev Pointer to interface struct.
2682  *
2683  * @return Pointer to stats struct of this interface.
2684  */
2685 static struct net_device_stats *
2686 ctc_stats(struct net_device * dev)
2687 {
2688         return &((struct ctc_priv *) dev->priv)->stats;
2689 }
2690
2691 /*
2692  * sysfs attributes
2693  */
2694 static ssize_t
2695 buffer_show(struct device *dev, char *buf)
2696 {
2697         struct ctc_priv *priv;
2698
2699         priv = dev->driver_data;
2700         if (!priv)
2701                 return -ENODEV;
2702         return sprintf(buf, "%d\n",
2703                        priv->channel[READ]->max_bufsize);
2704 }
2705
2706 static ssize_t
2707 buffer_write(struct device *dev, const char *buf, size_t count)
2708 {
2709         struct ctc_priv *priv;
2710         struct net_device *ndev;
2711         int bs1;
2712
2713         DBF_TEXT(trace, 5, __FUNCTION__);
2714         priv = dev->driver_data;
2715         if (!priv)
2716                 return -ENODEV;
2717         ndev = priv->channel[READ]->netdev;
2718         if (!ndev)
2719                 return -ENODEV;
2720         sscanf(buf, "%u", &bs1);
2721
2722         if (bs1 > CTC_BUFSIZE_LIMIT)
2723                 return -EINVAL;
2724         if ((ndev->flags & IFF_RUNNING) &&
2725             (bs1 < (ndev->mtu + LL_HEADER_LENGTH + 2)))
2726                 return -EINVAL;
2727         if (bs1 < (576 + LL_HEADER_LENGTH + 2))
2728                 return -EINVAL;
2729
2730         priv->channel[READ]->max_bufsize =
2731             priv->channel[WRITE]->max_bufsize = bs1;
2732         if (!(ndev->flags & IFF_RUNNING))
2733                 ndev->mtu = bs1 - LL_HEADER_LENGTH - 2;
2734         priv->channel[READ]->flags |= CHANNEL_FLAGS_BUFSIZE_CHANGED;
2735         priv->channel[WRITE]->flags |= CHANNEL_FLAGS_BUFSIZE_CHANGED;
2736
2737         return count;
2738
2739 }
2740
2741 static ssize_t
2742 loglevel_show(struct device *dev, char *buf)
2743 {
2744         struct ctc_priv *priv;
2745
2746         priv = dev->driver_data;
2747         if (!priv)
2748                 return -ENODEV;
2749         return sprintf(buf, "%d\n", loglevel);
2750 }
2751
2752 static ssize_t
2753 loglevel_write(struct device *dev, const char *buf, size_t count)
2754 {
2755         struct ctc_priv *priv;
2756         int ll1;
2757
2758         DBF_TEXT(trace, 5, __FUNCTION__);
2759         priv = dev->driver_data;
2760         if (!priv)
2761                 return -ENODEV;
2762         sscanf(buf, "%i", &ll1);
2763
2764         if ((ll1 > CTC_LOGLEVEL_MAX) || (ll1 < 0))
2765                 return -EINVAL;
2766         loglevel = ll1;
2767         return count;
2768 }
2769
2770 static void
2771 ctc_print_statistics(struct ctc_priv *priv)
2772 {
2773         char *sbuf;
2774         char *p;
2775
2776         DBF_TEXT(trace, 4, __FUNCTION__);
2777         if (!priv)
2778                 return;
2779         sbuf = (char *)kmalloc(2048, GFP_KERNEL);
2780         if (sbuf == NULL)
2781                 return;
2782         p = sbuf;
2783
2784         p += sprintf(p, "  Device FSM state: %s\n",
2785                      fsm_getstate_str(priv->fsm));
2786         p += sprintf(p, "  RX channel FSM state: %s\n",
2787                      fsm_getstate_str(priv->channel[READ]->fsm));
2788         p += sprintf(p, "  TX channel FSM state: %s\n",
2789                      fsm_getstate_str(priv->channel[WRITE]->fsm));
2790         p += sprintf(p, "  Max. TX buffer used: %ld\n",
2791                      priv->channel[WRITE]->prof.maxmulti);
2792         p += sprintf(p, "  Max. chained SKBs: %ld\n",
2793                      priv->channel[WRITE]->prof.maxcqueue);
2794         p += sprintf(p, "  TX single write ops: %ld\n",
2795                      priv->channel[WRITE]->prof.doios_single);
2796         p += sprintf(p, "  TX multi write ops: %ld\n",
2797                      priv->channel[WRITE]->prof.doios_multi);
2798         p += sprintf(p, "  Netto bytes written: %ld\n",
2799                      priv->channel[WRITE]->prof.txlen);
2800         p += sprintf(p, "  Max. TX IO-time: %ld\n",
2801                      priv->channel[WRITE]->prof.tx_time);
2802
2803         ctc_pr_debug("Statistics for %s:\n%s",
2804                      priv->channel[WRITE]->netdev->name, sbuf);
2805         kfree(sbuf);
2806         return;
2807 }
2808
2809 static ssize_t
2810 stats_show(struct device *dev, char *buf)
2811 {
2812         struct ctc_priv *priv = dev->driver_data;
2813         if (!priv)
2814                 return -ENODEV;
2815         ctc_print_statistics(priv);
2816         return sprintf(buf, "0\n");
2817 }
2818
2819 static ssize_t
2820 stats_write(struct device *dev, const char *buf, size_t count)
2821 {
2822         struct ctc_priv *priv = dev->driver_data;
2823         if (!priv)
2824                 return -ENODEV;
2825         /* Reset statistics */
2826         memset(&priv->channel[WRITE]->prof, 0,
2827                         sizeof(priv->channel[WRITE]->prof));
2828         return count;
2829 }
2830
2831 static DEVICE_ATTR(buffer, 0644, buffer_show, buffer_write);
2832 static DEVICE_ATTR(loglevel, 0644, loglevel_show, loglevel_write);
2833 static DEVICE_ATTR(stats, 0644, stats_show, stats_write);
2834
2835 static int
2836 ctc_add_attributes(struct device *dev)
2837 {
2838         device_create_file(dev, &dev_attr_buffer);
2839         device_create_file(dev, &dev_attr_loglevel);
2840         device_create_file(dev, &dev_attr_stats);
2841         return 0;
2842 }
2843
2844 static void
2845 ctc_remove_attributes(struct device *dev)
2846 {
2847         device_remove_file(dev, &dev_attr_stats);
2848         device_remove_file(dev, &dev_attr_loglevel);
2849         device_remove_file(dev, &dev_attr_buffer);
2850 }
2851
2852 \f
2853 static void
2854 ctc_netdev_unregister(struct net_device * dev)
2855 {
2856         struct ctc_priv *privptr;
2857
2858         if (!dev)
2859                 return;
2860         privptr = (struct ctc_priv *) dev->priv;
2861         if (privptr->protocol != CTC_PROTO_LINUX_TTY)
2862                 unregister_netdev(dev);
2863         else
2864                 ctc_tty_unregister_netdev(dev);
2865 }
2866
2867 static int
2868 ctc_netdev_register(struct net_device * dev)
2869 {
2870         struct ctc_priv *privptr = (struct ctc_priv *) dev->priv;
2871         if (privptr->protocol != CTC_PROTO_LINUX_TTY)
2872                 return register_netdev(dev);
2873         else
2874                 return ctc_tty_register_netdev(dev);
2875 }
2876
2877 static void
2878 ctc_free_netdevice(struct net_device * dev, int free_dev)
2879 {
2880         struct ctc_priv *privptr;
2881         if (!dev)
2882                 return;
2883         privptr = dev->priv;
2884         if (privptr) {
2885                 if (privptr->fsm)
2886                         kfree_fsm(privptr->fsm);
2887                 kfree(privptr);
2888         }
2889 #ifdef MODULE
2890         if (free_dev)
2891                 free_netdev(dev);
2892 #endif
2893 }
2894
2895 /**
2896  * Initialize everything of the net device except the name and the
2897  * channel structs.
2898  */
2899 static struct net_device *
2900 ctc_init_netdevice(struct net_device * dev, int alloc_device,
2901                    struct ctc_priv *privptr)
2902 {
2903         if (!privptr)
2904                 return NULL;
2905
2906         DBF_TEXT(setup, 3, __FUNCTION__);
2907         if (alloc_device) {
2908                 dev = kmalloc(sizeof (struct net_device), GFP_KERNEL);
2909                 if (!dev)
2910                         return NULL;
2911                 memset(dev, 0, sizeof (struct net_device));
2912         }
2913
2914         dev->priv = privptr;
2915         privptr->fsm = init_fsm("ctcdev", dev_state_names,
2916                                 dev_event_names, NR_DEV_STATES, NR_DEV_EVENTS,
2917                                 dev_fsm, DEV_FSM_LEN, GFP_KERNEL);
2918         if (privptr->fsm == NULL) {
2919                 if (alloc_device)
2920                         kfree(dev);
2921                 return NULL;
2922         }
2923         fsm_newstate(privptr->fsm, DEV_STATE_STOPPED);
2924         fsm_settimer(privptr->fsm, &privptr->restart_timer);
2925         dev->mtu = CTC_BUFSIZE_DEFAULT - LL_HEADER_LENGTH - 2;
2926         dev->hard_start_xmit = ctc_tx;
2927         dev->open = ctc_open;
2928         dev->stop = ctc_close;
2929         dev->get_stats = ctc_stats;
2930         dev->change_mtu = ctc_change_mtu;
2931         dev->hard_header_len = LL_HEADER_LENGTH + 2;
2932         dev->addr_len = 0;
2933         dev->type = ARPHRD_SLIP;
2934         dev->tx_queue_len = 100;
2935         dev->flags = IFF_POINTOPOINT | IFF_NOARP;
2936         SET_MODULE_OWNER(dev);
2937         return dev;
2938 }
2939
2940 static ssize_t
2941 ctc_proto_show(struct device *dev, char *buf)
2942 {
2943         struct ctc_priv *priv;
2944
2945         priv = dev->driver_data;
2946         if (!priv)
2947                 return -ENODEV;
2948
2949         return sprintf(buf, "%d\n", priv->protocol);
2950 }
2951
2952 static ssize_t
2953 ctc_proto_store(struct device *dev, const char *buf, size_t count)
2954 {
2955         struct ctc_priv *priv;
2956         int value;
2957
2958         DBF_TEXT(trace, 3, __FUNCTION__);
2959         pr_debug("%s() called\n", __FUNCTION__);
2960
2961         priv = dev->driver_data;
2962         if (!priv)
2963                 return -ENODEV;
2964         sscanf(buf, "%u", &value);
2965         if ((value < 0) || (value > CTC_PROTO_MAX))
2966                 return -EINVAL;
2967         priv->protocol = value;
2968
2969         return count;
2970 }
2971
2972 static DEVICE_ATTR(protocol, 0644, ctc_proto_show, ctc_proto_store);
2973
2974 static ssize_t
2975 ctc_type_show(struct device *dev, char *buf)
2976 {
2977         struct ccwgroup_device *cgdev;
2978
2979         cgdev = to_ccwgroupdev(dev);
2980         if (!cgdev)
2981                 return -ENODEV;
2982
2983         return sprintf(buf, "%s\n", cu3088_type[cgdev->cdev[0]->id.driver_info]);
2984 }
2985
2986 static DEVICE_ATTR(type, 0444, ctc_type_show, NULL);
2987
2988 static struct attribute *ctc_attr[] = {
2989         &dev_attr_protocol.attr,
2990         &dev_attr_type.attr,
2991         NULL,
2992 };
2993
2994 static struct attribute_group ctc_attr_group = {
2995         .attrs = ctc_attr,
2996 };
2997
2998 static int
2999 ctc_add_files(struct device *dev)
3000 {
3001         pr_debug("%s() called\n", __FUNCTION__);
3002
3003         return sysfs_create_group(&dev->kobj, &ctc_attr_group);
3004 }
3005
3006 static void
3007 ctc_remove_files(struct device *dev)
3008 {
3009         pr_debug("%s() called\n", __FUNCTION__);
3010
3011         sysfs_remove_group(&dev->kobj, &ctc_attr_group);
3012 }
3013
3014 /**
3015  * Add ctc specific attributes.
3016  * Add ctc private data.
3017  *
3018  * @param cgdev pointer to ccwgroup_device just added
3019  *
3020  * @returns 0 on success, !0 on failure.
3021  */
3022
3023 static int
3024 ctc_probe_device(struct ccwgroup_device *cgdev)
3025 {
3026         struct ctc_priv *priv;
3027         int rc;
3028
3029         pr_debug("%s() called\n", __FUNCTION__);
3030         DBF_TEXT(trace, 3, __FUNCTION__);
3031
3032         if (!get_device(&cgdev->dev))
3033                 return -ENODEV;
3034
3035         priv = kmalloc(sizeof (struct ctc_priv), GFP_KERNEL);
3036         if (!priv) {
3037                 ctc_pr_err("%s: Out of memory\n", __func__);
3038                 put_device(&cgdev->dev);
3039                 return -ENOMEM;
3040         }
3041
3042         memset(priv, 0, sizeof (struct ctc_priv));
3043         rc = ctc_add_files(&cgdev->dev);
3044         if (rc) {
3045                 kfree(priv);
3046                 put_device(&cgdev->dev);
3047                 return rc;
3048         }
3049
3050         cgdev->cdev[0]->handler = ctc_irq_handler;
3051         cgdev->cdev[1]->handler = ctc_irq_handler;
3052         cgdev->dev.driver_data = priv;
3053
3054         return 0;
3055 }
3056
3057 /**
3058  *
3059  * Setup an interface.
3060  *
3061  * @param cgdev  Device to be setup.
3062  *
3063  * @returns 0 on success, !0 on failure.
3064  */
3065 static int
3066 ctc_new_device(struct ccwgroup_device *cgdev)
3067 {
3068         char read_id[CTC_ID_SIZE];
3069         char write_id[CTC_ID_SIZE];
3070         int direction;
3071         enum channel_types type;
3072         struct ctc_priv *privptr;
3073         struct net_device *dev;
3074         int ret;
3075
3076         pr_debug("%s() called\n", __FUNCTION__);
3077         DBF_TEXT(setup, 3, __FUNCTION__);
3078
3079         privptr = cgdev->dev.driver_data;
3080         if (!privptr)
3081                 return -ENODEV;
3082
3083         type = get_channel_type(&cgdev->cdev[0]->id);
3084
3085         snprintf(read_id, CTC_ID_SIZE, "ch-%s", cgdev->cdev[0]->dev.bus_id);
3086         snprintf(write_id, CTC_ID_SIZE, "ch-%s", cgdev->cdev[1]->dev.bus_id);
3087
3088         if (add_channel(cgdev->cdev[0], type))
3089                 return -ENOMEM;
3090         if (add_channel(cgdev->cdev[1], type))
3091                 return -ENOMEM;
3092
3093         ret = ccw_device_set_online(cgdev->cdev[0]);
3094         if (ret != 0) {
3095                         printk(KERN_WARNING
3096                         "ccw_device_set_online (cdev[0]) failed with ret = %d\n", ret);
3097         }
3098
3099         ret = ccw_device_set_online(cgdev->cdev[1]);
3100         if (ret != 0) {
3101                         printk(KERN_WARNING
3102                         "ccw_device_set_online (cdev[1]) failed with ret = %d\n", ret);
3103         }
3104
3105         dev = ctc_init_netdevice(NULL, 1, privptr);
3106
3107         if (!dev) {
3108                 ctc_pr_warn("ctc_init_netdevice failed\n");
3109                 goto out;
3110         }
3111
3112         if (privptr->protocol == CTC_PROTO_LINUX_TTY)
3113                 strlcpy(dev->name, "ctctty%d", IFNAMSIZ);
3114         else
3115                 strlcpy(dev->name, "ctc%d", IFNAMSIZ);
3116
3117         for (direction = READ; direction <= WRITE; direction++) {
3118                 privptr->channel[direction] =
3119                     channel_get(type, direction == READ ? read_id : write_id,
3120                                 direction);
3121                 if (privptr->channel[direction] == NULL) {
3122                         if (direction == WRITE)
3123                                 channel_free(privptr->channel[READ]);
3124
3125                         ctc_free_netdevice(dev, 1);
3126                         goto out;
3127                 }
3128                 privptr->channel[direction]->netdev = dev;
3129                 privptr->channel[direction]->protocol = privptr->protocol;
3130                 privptr->channel[direction]->max_bufsize = CTC_BUFSIZE_DEFAULT;
3131         }
3132         /* sysfs magic */
3133         SET_NETDEV_DEV(dev, &cgdev->dev);
3134
3135         if (ctc_netdev_register(dev) != 0) {
3136                 ctc_free_netdevice(dev, 1);
3137                 goto out;
3138         }
3139
3140         ctc_add_attributes(&cgdev->dev);
3141
3142         strlcpy(privptr->fsm->name, dev->name, sizeof (privptr->fsm->name));
3143
3144         print_banner();
3145
3146         ctc_pr_info("%s: read: %s, write: %s, proto: %d\n",
3147                     dev->name, privptr->channel[READ]->id,
3148                     privptr->channel[WRITE]->id, privptr->protocol);
3149
3150         return 0;
3151 out:
3152         ccw_device_set_offline(cgdev->cdev[1]);
3153         ccw_device_set_offline(cgdev->cdev[0]);
3154
3155         return -ENODEV;
3156 }
3157
3158 /**
3159  * Shutdown an interface.
3160  *
3161  * @param cgdev  Device to be shut down.
3162  *
3163  * @returns 0 on success, !0 on failure.
3164  */
3165 static int
3166 ctc_shutdown_device(struct ccwgroup_device *cgdev)
3167 {
3168         struct ctc_priv *priv;
3169         struct net_device *ndev;
3170
3171         DBF_TEXT(trace, 3, __FUNCTION__);
3172         pr_debug("%s() called\n", __FUNCTION__);
3173
3174         priv = cgdev->dev.driver_data;
3175         ndev = NULL;
3176         if (!priv)
3177                 return -ENODEV;
3178
3179         if (priv->channel[READ]) {
3180                 ndev = priv->channel[READ]->netdev;
3181
3182                 /* Close the device */
3183                 ctc_close(ndev);
3184                 ndev->flags &=~IFF_RUNNING;
3185
3186                 ctc_remove_attributes(&cgdev->dev);
3187
3188                 channel_free(priv->channel[READ]);
3189         }
3190         if (priv->channel[WRITE])
3191                 channel_free(priv->channel[WRITE]);
3192
3193         if (ndev) {
3194                 ctc_netdev_unregister(ndev);
3195                 ndev->priv = NULL;
3196                 ctc_free_netdevice(ndev, 1);
3197         }
3198
3199         if (priv->fsm)
3200                 kfree_fsm(priv->fsm);
3201
3202         ccw_device_set_offline(cgdev->cdev[1]);
3203         ccw_device_set_offline(cgdev->cdev[0]);
3204
3205         if (priv->channel[READ])
3206                 channel_remove(priv->channel[READ]);
3207         if (priv->channel[WRITE])
3208                 channel_remove(priv->channel[WRITE]);
3209
3210         priv->channel[READ] = priv->channel[WRITE] = NULL;
3211
3212         return 0;
3213
3214 }
3215
3216 static void
3217 ctc_remove_device(struct ccwgroup_device *cgdev)
3218 {
3219         struct ctc_priv *priv;
3220
3221         pr_debug("%s() called\n", __FUNCTION__);
3222         DBF_TEXT(trace, 3, __FUNCTION__);
3223
3224         priv = cgdev->dev.driver_data;
3225         if (!priv)
3226                 return;
3227         if (cgdev->state == CCWGROUP_ONLINE)
3228                 ctc_shutdown_device(cgdev);
3229         ctc_remove_files(&cgdev->dev);
3230         cgdev->dev.driver_data = NULL;
3231         kfree(priv);
3232         put_device(&cgdev->dev);
3233 }
3234
3235 static struct ccwgroup_driver ctc_group_driver = {
3236         .owner       = THIS_MODULE,
3237         .name        = "ctc",
3238         .max_slaves  = 2,
3239         .driver_id   = 0xC3E3C3,
3240         .probe       = ctc_probe_device,
3241         .remove      = ctc_remove_device,
3242         .set_online  = ctc_new_device,
3243         .set_offline = ctc_shutdown_device,
3244 };
3245
3246 /**
3247  * Module related routines
3248  *****************************************************************************/
3249
3250 /**
3251  * Prepare to be unloaded. Free IRQ's and release all resources.
3252  * This is called just before this module is unloaded. It is
3253  * <em>not</em> called, if the usage count is !0, so we don't need to check
3254  * for that.
3255  */
3256 static void __exit
3257 ctc_exit(void)
3258 {
3259         unregister_cu3088_discipline(&ctc_group_driver);
3260         ctc_tty_cleanup();
3261         ctc_unregister_dbf_views();
3262         ctc_pr_info("CTC driver unloaded\n");
3263 }
3264
3265 /**
3266  * Initialize module.
3267  * This is called just after the module is loaded.
3268  *
3269  * @return 0 on success, !0 on error.
3270  */
3271 static int __init
3272 ctc_init(void)
3273 {
3274         int ret = 0;
3275
3276         print_banner();
3277
3278         ret = ctc_register_dbf_views();
3279         if (ret){
3280                 ctc_pr_crit("ctc_init failed with ctc_register_dbf_views rc = %d\n", ret);
3281                 return ret;
3282         }
3283         ctc_tty_init();
3284         ret = register_cu3088_discipline(&ctc_group_driver);
3285         if (ret) {
3286                 ctc_tty_cleanup();
3287                 ctc_unregister_dbf_views();
3288         }
3289         return ret;
3290 }
3291
3292 module_init(ctc_init);
3293 module_exit(ctc_exit);
3294
3295 /* --- This is the END my friend --- */