Merge tag 'mtd/for-5.11' of git://git.kernel.org/pub/scm/linux/kernel/git/mtd/linux
[linux-2.6-microblaze.git] / drivers / s390 / net / ctcm_fsms.c
1 // SPDX-License-Identifier: GPL-2.0
2 /*
3  * Copyright IBM Corp. 2001, 2007
4  * Authors:     Fritz Elfert (felfert@millenux.com)
5  *              Peter Tiedemann (ptiedem@de.ibm.com)
6  *      MPC additions :
7  *              Belinda Thompson (belindat@us.ibm.com)
8  *              Andy Richter (richtera@us.ibm.com)
9  */
10
11 #undef DEBUG
12 #undef DEBUGDATA
13 #undef DEBUGCCW
14
15 #define KMSG_COMPONENT "ctcm"
16 #define pr_fmt(fmt) KMSG_COMPONENT ": " fmt
17
18 #include <linux/module.h>
19 #include <linux/init.h>
20 #include <linux/kernel.h>
21 #include <linux/slab.h>
22 #include <linux/errno.h>
23 #include <linux/types.h>
24 #include <linux/interrupt.h>
25 #include <linux/timer.h>
26 #include <linux/bitops.h>
27
28 #include <linux/signal.h>
29 #include <linux/string.h>
30
31 #include <linux/ip.h>
32 #include <linux/if_arp.h>
33 #include <linux/tcp.h>
34 #include <linux/skbuff.h>
35 #include <linux/ctype.h>
36 #include <net/dst.h>
37
38 #include <linux/io.h>
39 #include <asm/ccwdev.h>
40 #include <asm/ccwgroup.h>
41 #include <linux/uaccess.h>
42
43 #include <asm/idals.h>
44
45 #include "fsm.h"
46
47 #include "ctcm_dbug.h"
48 #include "ctcm_main.h"
49 #include "ctcm_fsms.h"
50
51 const char *dev_state_names[] = {
52         [DEV_STATE_STOPPED]             = "Stopped",
53         [DEV_STATE_STARTWAIT_RXTX]      = "StartWait RXTX",
54         [DEV_STATE_STARTWAIT_RX]        = "StartWait RX",
55         [DEV_STATE_STARTWAIT_TX]        = "StartWait TX",
56         [DEV_STATE_STOPWAIT_RXTX]       = "StopWait RXTX",
57         [DEV_STATE_STOPWAIT_RX]         = "StopWait RX",
58         [DEV_STATE_STOPWAIT_TX]         = "StopWait TX",
59         [DEV_STATE_RUNNING]             = "Running",
60 };
61
62 const char *dev_event_names[] = {
63         [DEV_EVENT_START]       = "Start",
64         [DEV_EVENT_STOP]        = "Stop",
65         [DEV_EVENT_RXUP]        = "RX up",
66         [DEV_EVENT_TXUP]        = "TX up",
67         [DEV_EVENT_RXDOWN]      = "RX down",
68         [DEV_EVENT_TXDOWN]      = "TX down",
69         [DEV_EVENT_RESTART]     = "Restart",
70 };
71
72 const char *ctc_ch_event_names[] = {
73         [CTC_EVENT_IO_SUCCESS]  = "ccw_device success",
74         [CTC_EVENT_IO_EBUSY]    = "ccw_device busy",
75         [CTC_EVENT_IO_ENODEV]   = "ccw_device enodev",
76         [CTC_EVENT_IO_UNKNOWN]  = "ccw_device unknown",
77         [CTC_EVENT_ATTNBUSY]    = "Status ATTN & BUSY",
78         [CTC_EVENT_ATTN]        = "Status ATTN",
79         [CTC_EVENT_BUSY]        = "Status BUSY",
80         [CTC_EVENT_UC_RCRESET]  = "Unit check remote reset",
81         [CTC_EVENT_UC_RSRESET]  = "Unit check remote system reset",
82         [CTC_EVENT_UC_TXTIMEOUT] = "Unit check TX timeout",
83         [CTC_EVENT_UC_TXPARITY] = "Unit check TX parity",
84         [CTC_EVENT_UC_HWFAIL]   = "Unit check Hardware failure",
85         [CTC_EVENT_UC_RXPARITY] = "Unit check RX parity",
86         [CTC_EVENT_UC_ZERO]     = "Unit check ZERO",
87         [CTC_EVENT_UC_UNKNOWN]  = "Unit check Unknown",
88         [CTC_EVENT_SC_UNKNOWN]  = "SubChannel check Unknown",
89         [CTC_EVENT_MC_FAIL]     = "Machine check failure",
90         [CTC_EVENT_MC_GOOD]     = "Machine check operational",
91         [CTC_EVENT_IRQ]         = "IRQ normal",
92         [CTC_EVENT_FINSTAT]     = "IRQ final",
93         [CTC_EVENT_TIMER]       = "Timer",
94         [CTC_EVENT_START]       = "Start",
95         [CTC_EVENT_STOP]        = "Stop",
96         /*
97         * additional MPC events
98         */
99         [CTC_EVENT_SEND_XID]    = "XID Exchange",
100         [CTC_EVENT_RSWEEP_TIMER] = "MPC Group Sweep Timer",
101 };
102
103 const char *ctc_ch_state_names[] = {
104         [CTC_STATE_IDLE]        = "Idle",
105         [CTC_STATE_STOPPED]     = "Stopped",
106         [CTC_STATE_STARTWAIT]   = "StartWait",
107         [CTC_STATE_STARTRETRY]  = "StartRetry",
108         [CTC_STATE_SETUPWAIT]   = "SetupWait",
109         [CTC_STATE_RXINIT]      = "RX init",
110         [CTC_STATE_TXINIT]      = "TX init",
111         [CTC_STATE_RX]          = "RX",
112         [CTC_STATE_TX]          = "TX",
113         [CTC_STATE_RXIDLE]      = "RX idle",
114         [CTC_STATE_TXIDLE]      = "TX idle",
115         [CTC_STATE_RXERR]       = "RX error",
116         [CTC_STATE_TXERR]       = "TX error",
117         [CTC_STATE_TERM]        = "Terminating",
118         [CTC_STATE_DTERM]       = "Restarting",
119         [CTC_STATE_NOTOP]       = "Not operational",
120         /*
121         * additional MPC states
122         */
123         [CH_XID0_PENDING]       = "Pending XID0 Start",
124         [CH_XID0_INPROGRESS]    = "In XID0 Negotiations ",
125         [CH_XID7_PENDING]       = "Pending XID7 P1 Start",
126         [CH_XID7_PENDING1]      = "Active XID7 P1 Exchange ",
127         [CH_XID7_PENDING2]      = "Pending XID7 P2 Start ",
128         [CH_XID7_PENDING3]      = "Active XID7 P2 Exchange ",
129         [CH_XID7_PENDING4]      = "XID7 Complete - Pending READY ",
130 };
131
132 static void ctcm_action_nop(fsm_instance *fi, int event, void *arg);
133
134 /*
135  * ----- static ctcm actions for channel statemachine -----
136  *
137 */
138 static void chx_txdone(fsm_instance *fi, int event, void *arg);
139 static void chx_rx(fsm_instance *fi, int event, void *arg);
140 static void chx_rxidle(fsm_instance *fi, int event, void *arg);
141 static void chx_firstio(fsm_instance *fi, int event, void *arg);
142 static void ctcm_chx_setmode(fsm_instance *fi, int event, void *arg);
143 static void ctcm_chx_start(fsm_instance *fi, int event, void *arg);
144 static void ctcm_chx_haltio(fsm_instance *fi, int event, void *arg);
145 static void ctcm_chx_stopped(fsm_instance *fi, int event, void *arg);
146 static void ctcm_chx_stop(fsm_instance *fi, int event, void *arg);
147 static void ctcm_chx_fail(fsm_instance *fi, int event, void *arg);
148 static void ctcm_chx_setuperr(fsm_instance *fi, int event, void *arg);
149 static void ctcm_chx_restart(fsm_instance *fi, int event, void *arg);
150 static void ctcm_chx_rxiniterr(fsm_instance *fi, int event, void *arg);
151 static void ctcm_chx_rxinitfail(fsm_instance *fi, int event, void *arg);
152 static void ctcm_chx_rxdisc(fsm_instance *fi, int event, void *arg);
153 static void ctcm_chx_txiniterr(fsm_instance *fi, int event, void *arg);
154 static void ctcm_chx_txretry(fsm_instance *fi, int event, void *arg);
155 static void ctcm_chx_iofatal(fsm_instance *fi, int event, void *arg);
156
157 /*
158  * ----- static ctcmpc actions for ctcmpc channel statemachine -----
159  *
160 */
161 static void ctcmpc_chx_txdone(fsm_instance *fi, int event, void *arg);
162 static void ctcmpc_chx_rx(fsm_instance *fi, int event, void *arg);
163 static void ctcmpc_chx_firstio(fsm_instance *fi, int event, void *arg);
164 /* shared :
165 static void ctcm_chx_setmode(fsm_instance *fi, int event, void *arg);
166 static void ctcm_chx_start(fsm_instance *fi, int event, void *arg);
167 static void ctcm_chx_haltio(fsm_instance *fi, int event, void *arg);
168 static void ctcm_chx_stopped(fsm_instance *fi, int event, void *arg);
169 static void ctcm_chx_stop(fsm_instance *fi, int event, void *arg);
170 static void ctcm_chx_fail(fsm_instance *fi, int event, void *arg);
171 static void ctcm_chx_setuperr(fsm_instance *fi, int event, void *arg);
172 static void ctcm_chx_restart(fsm_instance *fi, int event, void *arg);
173 static void ctcm_chx_rxiniterr(fsm_instance *fi, int event, void *arg);
174 static void ctcm_chx_rxinitfail(fsm_instance *fi, int event, void *arg);
175 static void ctcm_chx_rxdisc(fsm_instance *fi, int event, void *arg);
176 static void ctcm_chx_txiniterr(fsm_instance *fi, int event, void *arg);
177 static void ctcm_chx_txretry(fsm_instance *fi, int event, void *arg);
178 static void ctcm_chx_iofatal(fsm_instance *fi, int event, void *arg);
179 */
180 static void ctcmpc_chx_attn(fsm_instance *fsm, int event, void *arg);
181 static void ctcmpc_chx_attnbusy(fsm_instance *, int, void *);
182 static void ctcmpc_chx_resend(fsm_instance *, int, void *);
183 static void ctcmpc_chx_send_sweep(fsm_instance *fsm, int event, void *arg);
184
185 /**
186  * Check return code of a preceding ccw_device call, halt_IO etc...
187  *
188  * ch   :       The channel, the error belongs to.
189  * Returns the error code (!= 0) to inspect.
190  */
191 void ctcm_ccw_check_rc(struct channel *ch, int rc, char *msg)
192 {
193         CTCM_DBF_TEXT_(ERROR, CTC_DBF_ERROR,
194                 "%s(%s): %s: %04x\n",
195                 CTCM_FUNTAIL, ch->id, msg, rc);
196         switch (rc) {
197         case -EBUSY:
198                 pr_info("%s: The communication peer is busy\n",
199                         ch->id);
200                 fsm_event(ch->fsm, CTC_EVENT_IO_EBUSY, ch);
201                 break;
202         case -ENODEV:
203                 pr_err("%s: The specified target device is not valid\n",
204                        ch->id);
205                 fsm_event(ch->fsm, CTC_EVENT_IO_ENODEV, ch);
206                 break;
207         default:
208                 pr_err("An I/O operation resulted in error %04x\n",
209                        rc);
210                 fsm_event(ch->fsm, CTC_EVENT_IO_UNKNOWN, ch);
211         }
212 }
213
214 void ctcm_purge_skb_queue(struct sk_buff_head *q)
215 {
216         struct sk_buff *skb;
217
218         CTCM_DBF_TEXT(TRACE, CTC_DBF_DEBUG, __func__);
219
220         while ((skb = skb_dequeue(q))) {
221                 refcount_dec(&skb->users);
222                 dev_kfree_skb_any(skb);
223         }
224 }
225
226 /**
227  * NOP action for statemachines
228  */
229 static void ctcm_action_nop(fsm_instance *fi, int event, void *arg)
230 {
231 }
232
233 /*
234  * Actions for channel - statemachines.
235  */
236
237 /**
238  * Normal data has been send. Free the corresponding
239  * skb (it's in io_queue), reset dev->tbusy and
240  * revert to idle state.
241  *
242  * fi           An instance of a channel statemachine.
243  * event        The event, just happened.
244  * arg          Generic pointer, casted from channel * upon call.
245  */
246 static void chx_txdone(fsm_instance *fi, int event, void *arg)
247 {
248         struct channel *ch = arg;
249         struct net_device *dev = ch->netdev;
250         struct ctcm_priv *priv = dev->ml_priv;
251         struct sk_buff *skb;
252         int first = 1;
253         int i;
254         unsigned long duration;
255         unsigned long done_stamp = jiffies;
256
257         CTCM_PR_DEBUG("%s(%s): %s\n", __func__, ch->id, dev->name);
258
259         duration = done_stamp - ch->prof.send_stamp;
260         if (duration > ch->prof.tx_time)
261                 ch->prof.tx_time = duration;
262
263         if (ch->irb->scsw.cmd.count != 0)
264                 CTCM_DBF_TEXT_(TRACE, CTC_DBF_DEBUG,
265                         "%s(%s): TX not complete, remaining %d bytes",
266                              CTCM_FUNTAIL, dev->name, ch->irb->scsw.cmd.count);
267         fsm_deltimer(&ch->timer);
268         while ((skb = skb_dequeue(&ch->io_queue))) {
269                 priv->stats.tx_packets++;
270                 priv->stats.tx_bytes += skb->len - LL_HEADER_LENGTH;
271                 if (first) {
272                         priv->stats.tx_bytes += 2;
273                         first = 0;
274                 }
275                 refcount_dec(&skb->users);
276                 dev_kfree_skb_irq(skb);
277         }
278         spin_lock(&ch->collect_lock);
279         clear_normalized_cda(&ch->ccw[4]);
280         if (ch->collect_len > 0) {
281                 int rc;
282
283                 if (ctcm_checkalloc_buffer(ch)) {
284                         spin_unlock(&ch->collect_lock);
285                         return;
286                 }
287                 ch->trans_skb->data = ch->trans_skb_data;
288                 skb_reset_tail_pointer(ch->trans_skb);
289                 ch->trans_skb->len = 0;
290                 if (ch->prof.maxmulti < (ch->collect_len + 2))
291                         ch->prof.maxmulti = ch->collect_len + 2;
292                 if (ch->prof.maxcqueue < skb_queue_len(&ch->collect_queue))
293                         ch->prof.maxcqueue = skb_queue_len(&ch->collect_queue);
294                 *((__u16 *)skb_put(ch->trans_skb, 2)) = ch->collect_len + 2;
295                 i = 0;
296                 while ((skb = skb_dequeue(&ch->collect_queue))) {
297                         skb_copy_from_linear_data(skb,
298                                 skb_put(ch->trans_skb, skb->len), skb->len);
299                         priv->stats.tx_packets++;
300                         priv->stats.tx_bytes += skb->len - LL_HEADER_LENGTH;
301                         refcount_dec(&skb->users);
302                         dev_kfree_skb_irq(skb);
303                         i++;
304                 }
305                 ch->collect_len = 0;
306                 spin_unlock(&ch->collect_lock);
307                 ch->ccw[1].count = ch->trans_skb->len;
308                 fsm_addtimer(&ch->timer, CTCM_TIME_5_SEC, CTC_EVENT_TIMER, ch);
309                 ch->prof.send_stamp = jiffies;
310                 rc = ccw_device_start(ch->cdev, &ch->ccw[0], 0, 0xff, 0);
311                 ch->prof.doios_multi++;
312                 if (rc != 0) {
313                         priv->stats.tx_dropped += i;
314                         priv->stats.tx_errors += i;
315                         fsm_deltimer(&ch->timer);
316                         ctcm_ccw_check_rc(ch, rc, "chained TX");
317                 }
318         } else {
319                 spin_unlock(&ch->collect_lock);
320                 fsm_newstate(fi, CTC_STATE_TXIDLE);
321         }
322         ctcm_clear_busy_do(dev);
323 }
324
325 /**
326  * Initial data is sent.
327  * Notify device statemachine that we are up and
328  * running.
329  *
330  * fi           An instance of a channel statemachine.
331  * event        The event, just happened.
332  * arg          Generic pointer, casted from channel * upon call.
333  */
334 void ctcm_chx_txidle(fsm_instance *fi, int event, void *arg)
335 {
336         struct channel *ch = arg;
337         struct net_device *dev = ch->netdev;
338         struct ctcm_priv *priv = dev->ml_priv;
339
340         CTCM_PR_DEBUG("%s(%s): %s\n", __func__, ch->id, dev->name);
341
342         fsm_deltimer(&ch->timer);
343         fsm_newstate(fi, CTC_STATE_TXIDLE);
344         fsm_event(priv->fsm, DEV_EVENT_TXUP, ch->netdev);
345 }
346
347 /**
348  * Got normal data, check for sanity, queue it up, allocate new buffer
349  * trigger bottom half, and initiate next read.
350  *
351  * fi           An instance of a channel statemachine.
352  * event        The event, just happened.
353  * arg          Generic pointer, casted from channel * upon call.
354  */
355 static void chx_rx(fsm_instance *fi, int event, void *arg)
356 {
357         struct channel *ch = arg;
358         struct net_device *dev = ch->netdev;
359         struct ctcm_priv *priv = dev->ml_priv;
360         int len = ch->max_bufsize - ch->irb->scsw.cmd.count;
361         struct sk_buff *skb = ch->trans_skb;
362         __u16 block_len = *((__u16 *)skb->data);
363         int check_len;
364         int rc;
365
366         fsm_deltimer(&ch->timer);
367         if (len < 8) {
368                 CTCM_DBF_TEXT_(TRACE, CTC_DBF_NOTICE,
369                         "%s(%s): got packet with length %d < 8\n",
370                                         CTCM_FUNTAIL, dev->name, len);
371                 priv->stats.rx_dropped++;
372                 priv->stats.rx_length_errors++;
373                                                 goto again;
374         }
375         if (len > ch->max_bufsize) {
376                 CTCM_DBF_TEXT_(TRACE, CTC_DBF_NOTICE,
377                         "%s(%s): got packet with length %d > %d\n",
378                                 CTCM_FUNTAIL, dev->name, len, ch->max_bufsize);
379                 priv->stats.rx_dropped++;
380                 priv->stats.rx_length_errors++;
381                                                 goto again;
382         }
383
384         /*
385          * VM TCP seems to have a bug sending 2 trailing bytes of garbage.
386          */
387         switch (ch->protocol) {
388         case CTCM_PROTO_S390:
389         case CTCM_PROTO_OS390:
390                 check_len = block_len + 2;
391                 break;
392         default:
393                 check_len = block_len;
394                 break;
395         }
396         if ((len < block_len) || (len > check_len)) {
397                 CTCM_DBF_TEXT_(TRACE, CTC_DBF_NOTICE,
398                         "%s(%s): got block length %d != rx length %d\n",
399                                 CTCM_FUNTAIL, dev->name, block_len, len);
400                 if (do_debug)
401                         ctcmpc_dump_skb(skb, 0);
402
403                 *((__u16 *)skb->data) = len;
404                 priv->stats.rx_dropped++;
405                 priv->stats.rx_length_errors++;
406                                                 goto again;
407         }
408         if (block_len > 2) {
409                 *((__u16 *)skb->data) = block_len - 2;
410                 ctcm_unpack_skb(ch, skb);
411         }
412  again:
413         skb->data = ch->trans_skb_data;
414         skb_reset_tail_pointer(skb);
415         skb->len = 0;
416         if (ctcm_checkalloc_buffer(ch))
417                 return;
418         ch->ccw[1].count = ch->max_bufsize;
419         rc = ccw_device_start(ch->cdev, &ch->ccw[0], 0, 0xff, 0);
420         if (rc != 0)
421                 ctcm_ccw_check_rc(ch, rc, "normal RX");
422 }
423
424 /**
425  * Initialize connection by sending a __u16 of value 0.
426  *
427  * fi           An instance of a channel statemachine.
428  * event        The event, just happened.
429  * arg          Generic pointer, casted from channel * upon call.
430  */
431 static void chx_firstio(fsm_instance *fi, int event, void *arg)
432 {
433         int rc;
434         struct channel *ch = arg;
435         int fsmstate = fsm_getstate(fi);
436
437         CTCM_DBF_TEXT_(TRACE, CTC_DBF_NOTICE,
438                 "%s(%s) : %02x",
439                 CTCM_FUNTAIL, ch->id, fsmstate);
440
441         ch->sense_rc = 0;       /* reset unit check report control */
442         if (fsmstate == CTC_STATE_TXIDLE)
443                 CTCM_DBF_TEXT_(TRACE, CTC_DBF_DEBUG,
444                         "%s(%s): remote side issued READ?, init.\n",
445                                 CTCM_FUNTAIL, ch->id);
446         fsm_deltimer(&ch->timer);
447         if (ctcm_checkalloc_buffer(ch))
448                 return;
449         if ((fsmstate == CTC_STATE_SETUPWAIT) &&
450             (ch->protocol == CTCM_PROTO_OS390)) {
451                 /* OS/390 resp. z/OS */
452                 if (CHANNEL_DIRECTION(ch->flags) == CTCM_READ) {
453                         *((__u16 *)ch->trans_skb->data) = CTCM_INITIAL_BLOCKLEN;
454                         fsm_addtimer(&ch->timer, CTCM_TIME_5_SEC,
455                                      CTC_EVENT_TIMER, ch);
456                         chx_rxidle(fi, event, arg);
457                 } else {
458                         struct net_device *dev = ch->netdev;
459                         struct ctcm_priv *priv = dev->ml_priv;
460                         fsm_newstate(fi, CTC_STATE_TXIDLE);
461                         fsm_event(priv->fsm, DEV_EVENT_TXUP, dev);
462                 }
463                 return;
464         }
465         /*
466          * Don't setup a timer for receiving the initial RX frame
467          * if in compatibility mode, since VM TCP delays the initial
468          * frame until it has some data to send.
469          */
470         if ((CHANNEL_DIRECTION(ch->flags) == CTCM_WRITE) ||
471             (ch->protocol != CTCM_PROTO_S390))
472                 fsm_addtimer(&ch->timer, CTCM_TIME_5_SEC, CTC_EVENT_TIMER, ch);
473
474         *((__u16 *)ch->trans_skb->data) = CTCM_INITIAL_BLOCKLEN;
475         ch->ccw[1].count = 2;   /* Transfer only length */
476
477         fsm_newstate(fi, (CHANNEL_DIRECTION(ch->flags) == CTCM_READ)
478                      ? CTC_STATE_RXINIT : CTC_STATE_TXINIT);
479         rc = ccw_device_start(ch->cdev, &ch->ccw[0], 0, 0xff, 0);
480         if (rc != 0) {
481                 fsm_deltimer(&ch->timer);
482                 fsm_newstate(fi, CTC_STATE_SETUPWAIT);
483                 ctcm_ccw_check_rc(ch, rc, "init IO");
484         }
485         /*
486          * If in compatibility mode since we don't setup a timer, we
487          * also signal RX channel up immediately. This enables us
488          * to send packets early which in turn usually triggers some
489          * reply from VM TCP which brings up the RX channel to it's
490          * final state.
491          */
492         if ((CHANNEL_DIRECTION(ch->flags) == CTCM_READ) &&
493             (ch->protocol == CTCM_PROTO_S390)) {
494                 struct net_device *dev = ch->netdev;
495                 struct ctcm_priv *priv = dev->ml_priv;
496                 fsm_event(priv->fsm, DEV_EVENT_RXUP, dev);
497         }
498 }
499
500 /**
501  * Got initial data, check it. If OK,
502  * notify device statemachine that we are up and
503  * running.
504  *
505  * fi           An instance of a channel statemachine.
506  * event        The event, just happened.
507  * arg          Generic pointer, casted from channel * upon call.
508  */
509 static void chx_rxidle(fsm_instance *fi, int event, void *arg)
510 {
511         struct channel *ch = arg;
512         struct net_device *dev = ch->netdev;
513         struct ctcm_priv *priv = dev->ml_priv;
514         __u16 buflen;
515         int rc;
516
517         fsm_deltimer(&ch->timer);
518         buflen = *((__u16 *)ch->trans_skb->data);
519         CTCM_PR_DEBUG("%s: %s: Initial RX count = %d\n",
520                         __func__, dev->name, buflen);
521
522         if (buflen >= CTCM_INITIAL_BLOCKLEN) {
523                 if (ctcm_checkalloc_buffer(ch))
524                         return;
525                 ch->ccw[1].count = ch->max_bufsize;
526                 fsm_newstate(fi, CTC_STATE_RXIDLE);
527                 rc = ccw_device_start(ch->cdev, &ch->ccw[0], 0, 0xff, 0);
528                 if (rc != 0) {
529                         fsm_newstate(fi, CTC_STATE_RXINIT);
530                         ctcm_ccw_check_rc(ch, rc, "initial RX");
531                 } else
532                         fsm_event(priv->fsm, DEV_EVENT_RXUP, dev);
533         } else {
534                 CTCM_PR_DEBUG("%s: %s: Initial RX count %d not %d\n",
535                                 __func__, dev->name,
536                                         buflen, CTCM_INITIAL_BLOCKLEN);
537                 chx_firstio(fi, event, arg);
538         }
539 }
540
541 /**
542  * Set channel into extended mode.
543  *
544  * fi           An instance of a channel statemachine.
545  * event        The event, just happened.
546  * arg          Generic pointer, casted from channel * upon call.
547  */
548 static void ctcm_chx_setmode(fsm_instance *fi, int event, void *arg)
549 {
550         struct channel *ch = arg;
551         int rc;
552         unsigned long saveflags = 0;
553         int timeout = CTCM_TIME_5_SEC;
554
555         fsm_deltimer(&ch->timer);
556         if (IS_MPC(ch)) {
557                 timeout = 1500;
558                 CTCM_PR_DEBUG("enter %s: cp=%i ch=0x%p id=%s\n",
559                                 __func__, smp_processor_id(), ch, ch->id);
560         }
561         fsm_addtimer(&ch->timer, timeout, CTC_EVENT_TIMER, ch);
562         fsm_newstate(fi, CTC_STATE_SETUPWAIT);
563         CTCM_CCW_DUMP((char *)&ch->ccw[6], sizeof(struct ccw1) * 2);
564
565         if (event == CTC_EVENT_TIMER)   /* only for timer not yet locked */
566                 spin_lock_irqsave(get_ccwdev_lock(ch->cdev), saveflags);
567                         /* Such conditional locking is undeterministic in
568                          * static view. => ignore sparse warnings here. */
569
570         rc = ccw_device_start(ch->cdev, &ch->ccw[6], 0, 0xff, 0);
571         if (event == CTC_EVENT_TIMER)   /* see above comments */
572                 spin_unlock_irqrestore(get_ccwdev_lock(ch->cdev), saveflags);
573         if (rc != 0) {
574                 fsm_deltimer(&ch->timer);
575                 fsm_newstate(fi, CTC_STATE_STARTWAIT);
576                 ctcm_ccw_check_rc(ch, rc, "set Mode");
577         } else
578                 ch->retry = 0;
579 }
580
581 /**
582  * Setup channel.
583  *
584  * fi           An instance of a channel statemachine.
585  * event        The event, just happened.
586  * arg          Generic pointer, casted from channel * upon call.
587  */
588 static void ctcm_chx_start(fsm_instance *fi, int event, void *arg)
589 {
590         struct channel *ch      = arg;
591         unsigned long saveflags;
592         int rc;
593
594         CTCM_DBF_TEXT_(SETUP, CTC_DBF_INFO, "%s(%s): %s",
595                 CTCM_FUNTAIL, ch->id,
596                 (CHANNEL_DIRECTION(ch->flags) == CTCM_READ) ? "RX" : "TX");
597
598         if (ch->trans_skb != NULL) {
599                 clear_normalized_cda(&ch->ccw[1]);
600                 dev_kfree_skb(ch->trans_skb);
601                 ch->trans_skb = NULL;
602         }
603         if (CHANNEL_DIRECTION(ch->flags) == CTCM_READ) {
604                 ch->ccw[1].cmd_code = CCW_CMD_READ;
605                 ch->ccw[1].flags = CCW_FLAG_SLI;
606                 ch->ccw[1].count = 0;
607         } else {
608                 ch->ccw[1].cmd_code = CCW_CMD_WRITE;
609                 ch->ccw[1].flags = CCW_FLAG_SLI | CCW_FLAG_CC;
610                 ch->ccw[1].count = 0;
611         }
612         if (ctcm_checkalloc_buffer(ch)) {
613                 CTCM_DBF_TEXT_(TRACE, CTC_DBF_DEBUG,
614                         "%s(%s): %s trans_skb alloc delayed "
615                         "until first transfer",
616                         CTCM_FUNTAIL, ch->id,
617                         (CHANNEL_DIRECTION(ch->flags) == CTCM_READ) ?
618                                 "RX" : "TX");
619         }
620         ch->ccw[0].cmd_code = CCW_CMD_PREPARE;
621         ch->ccw[0].flags = CCW_FLAG_SLI | CCW_FLAG_CC;
622         ch->ccw[0].count = 0;
623         ch->ccw[0].cda = 0;
624         ch->ccw[2].cmd_code = CCW_CMD_NOOP;     /* jointed CE + DE */
625         ch->ccw[2].flags = CCW_FLAG_SLI;
626         ch->ccw[2].count = 0;
627         ch->ccw[2].cda = 0;
628         memcpy(&ch->ccw[3], &ch->ccw[0], sizeof(struct ccw1) * 3);
629         ch->ccw[4].cda = 0;
630         ch->ccw[4].flags &= ~CCW_FLAG_IDA;
631
632         fsm_newstate(fi, CTC_STATE_STARTWAIT);
633         fsm_addtimer(&ch->timer, 1000, CTC_EVENT_TIMER, ch);
634         spin_lock_irqsave(get_ccwdev_lock(ch->cdev), saveflags);
635         rc = ccw_device_halt(ch->cdev, 0);
636         spin_unlock_irqrestore(get_ccwdev_lock(ch->cdev), saveflags);
637         if (rc != 0) {
638                 if (rc != -EBUSY)
639                         fsm_deltimer(&ch->timer);
640                 ctcm_ccw_check_rc(ch, rc, "initial HaltIO");
641         }
642 }
643
644 /**
645  * Shutdown a channel.
646  *
647  * fi           An instance of a channel statemachine.
648  * event        The event, just happened.
649  * arg          Generic pointer, casted from channel * upon call.
650  */
651 static void ctcm_chx_haltio(fsm_instance *fi, int event, void *arg)
652 {
653         struct channel *ch = arg;
654         unsigned long saveflags = 0;
655         int rc;
656         int oldstate;
657
658         fsm_deltimer(&ch->timer);
659         if (IS_MPC(ch))
660                 fsm_deltimer(&ch->sweep_timer);
661
662         fsm_addtimer(&ch->timer, CTCM_TIME_5_SEC, CTC_EVENT_TIMER, ch);
663
664         if (event == CTC_EVENT_STOP)    /* only for STOP not yet locked */
665                 spin_lock_irqsave(get_ccwdev_lock(ch->cdev), saveflags);
666                         /* Such conditional locking is undeterministic in
667                          * static view. => ignore sparse warnings here. */
668         oldstate = fsm_getstate(fi);
669         fsm_newstate(fi, CTC_STATE_TERM);
670         rc = ccw_device_halt(ch->cdev, 0);
671
672         if (event == CTC_EVENT_STOP)
673                 spin_unlock_irqrestore(get_ccwdev_lock(ch->cdev), saveflags);
674                         /* see remark above about conditional locking */
675
676         if (rc != 0 && rc != -EBUSY) {
677                 fsm_deltimer(&ch->timer);
678                 if (event != CTC_EVENT_STOP) {
679                         fsm_newstate(fi, oldstate);
680                         ctcm_ccw_check_rc(ch, rc, (char *)__func__);
681                 }
682         }
683 }
684
685 /**
686  * Cleanup helper for chx_fail and chx_stopped
687  * cleanup channels queue and notify interface statemachine.
688  *
689  * fi           An instance of a channel statemachine.
690  * state        The next state (depending on caller).
691  * ch           The channel to operate on.
692  */
693 static void ctcm_chx_cleanup(fsm_instance *fi, int state,
694                 struct channel *ch)
695 {
696         struct net_device *dev = ch->netdev;
697         struct ctcm_priv *priv = dev->ml_priv;
698
699         CTCM_DBF_TEXT_(SETUP, CTC_DBF_NOTICE,
700                         "%s(%s): %s[%d]\n",
701                         CTCM_FUNTAIL, dev->name, ch->id, state);
702
703         fsm_deltimer(&ch->timer);
704         if (IS_MPC(ch))
705                 fsm_deltimer(&ch->sweep_timer);
706
707         fsm_newstate(fi, state);
708         if (state == CTC_STATE_STOPPED && ch->trans_skb != NULL) {
709                 clear_normalized_cda(&ch->ccw[1]);
710                 dev_kfree_skb_any(ch->trans_skb);
711                 ch->trans_skb = NULL;
712         }
713
714         ch->th_seg = 0x00;
715         ch->th_seq_num = 0x00;
716         if (CHANNEL_DIRECTION(ch->flags) == CTCM_READ) {
717                 skb_queue_purge(&ch->io_queue);
718                 fsm_event(priv->fsm, DEV_EVENT_RXDOWN, dev);
719         } else {
720                 ctcm_purge_skb_queue(&ch->io_queue);
721                 if (IS_MPC(ch))
722                         ctcm_purge_skb_queue(&ch->sweep_queue);
723                 spin_lock(&ch->collect_lock);
724                 ctcm_purge_skb_queue(&ch->collect_queue);
725                 ch->collect_len = 0;
726                 spin_unlock(&ch->collect_lock);
727                 fsm_event(priv->fsm, DEV_EVENT_TXDOWN, dev);
728         }
729 }
730
731 /**
732  * A channel has successfully been halted.
733  * Cleanup it's queue and notify interface statemachine.
734  *
735  * fi           An instance of a channel statemachine.
736  * event        The event, just happened.
737  * arg          Generic pointer, casted from channel * upon call.
738  */
739 static void ctcm_chx_stopped(fsm_instance *fi, int event, void *arg)
740 {
741         ctcm_chx_cleanup(fi, CTC_STATE_STOPPED, arg);
742 }
743
744 /**
745  * A stop command from device statemachine arrived and we are in
746  * not operational mode. Set state to stopped.
747  *
748  * fi           An instance of a channel statemachine.
749  * event        The event, just happened.
750  * arg          Generic pointer, casted from channel * upon call.
751  */
752 static void ctcm_chx_stop(fsm_instance *fi, int event, void *arg)
753 {
754         fsm_newstate(fi, CTC_STATE_STOPPED);
755 }
756
757 /**
758  * A machine check for no path, not operational status or gone device has
759  * happened.
760  * Cleanup queue and notify interface statemachine.
761  *
762  * fi           An instance of a channel statemachine.
763  * event        The event, just happened.
764  * arg          Generic pointer, casted from channel * upon call.
765  */
766 static void ctcm_chx_fail(fsm_instance *fi, int event, void *arg)
767 {
768         ctcm_chx_cleanup(fi, CTC_STATE_NOTOP, arg);
769 }
770
771 /**
772  * Handle error during setup of channel.
773  *
774  * fi           An instance of a channel statemachine.
775  * event        The event, just happened.
776  * arg          Generic pointer, casted from channel * upon call.
777  */
778 static void ctcm_chx_setuperr(fsm_instance *fi, int event, void *arg)
779 {
780         struct channel *ch = arg;
781         struct net_device *dev = ch->netdev;
782         struct ctcm_priv *priv = dev->ml_priv;
783
784         /*
785          * Special case: Got UC_RCRESET on setmode.
786          * This means that remote side isn't setup. In this case
787          * simply retry after some 10 secs...
788          */
789         if ((fsm_getstate(fi) == CTC_STATE_SETUPWAIT) &&
790             ((event == CTC_EVENT_UC_RCRESET) ||
791              (event == CTC_EVENT_UC_RSRESET))) {
792                 fsm_newstate(fi, CTC_STATE_STARTRETRY);
793                 fsm_deltimer(&ch->timer);
794                 fsm_addtimer(&ch->timer, CTCM_TIME_5_SEC, CTC_EVENT_TIMER, ch);
795                 if (!IS_MPC(ch) &&
796                     (CHANNEL_DIRECTION(ch->flags) == CTCM_READ)) {
797                         int rc = ccw_device_halt(ch->cdev, 0);
798                         if (rc != 0)
799                                 ctcm_ccw_check_rc(ch, rc,
800                                         "HaltIO in chx_setuperr");
801                 }
802                 return;
803         }
804
805         CTCM_DBF_TEXT_(ERROR, CTC_DBF_CRIT,
806                 "%s(%s) : %s error during %s channel setup state=%s\n",
807                 CTCM_FUNTAIL, dev->name, ctc_ch_event_names[event],
808                 (CHANNEL_DIRECTION(ch->flags) == CTCM_READ) ? "RX" : "TX",
809                 fsm_getstate_str(fi));
810
811         if (CHANNEL_DIRECTION(ch->flags) == CTCM_READ) {
812                 fsm_newstate(fi, CTC_STATE_RXERR);
813                 fsm_event(priv->fsm, DEV_EVENT_RXDOWN, dev);
814         } else {
815                 fsm_newstate(fi, CTC_STATE_TXERR);
816                 fsm_event(priv->fsm, DEV_EVENT_TXDOWN, dev);
817         }
818 }
819
820 /**
821  * Restart a channel after an error.
822  *
823  * fi           An instance of a channel statemachine.
824  * event        The event, just happened.
825  * arg          Generic pointer, casted from channel * upon call.
826  */
827 static void ctcm_chx_restart(fsm_instance *fi, int event, void *arg)
828 {
829         struct channel *ch = arg;
830         struct net_device *dev = ch->netdev;
831         unsigned long saveflags = 0;
832         int oldstate;
833         int rc;
834
835         CTCM_DBF_TEXT_(TRACE, CTC_DBF_NOTICE,
836                 "%s: %s[%d] of %s\n",
837                         CTCM_FUNTAIL, ch->id, event, dev->name);
838
839         fsm_deltimer(&ch->timer);
840
841         fsm_addtimer(&ch->timer, CTCM_TIME_5_SEC, CTC_EVENT_TIMER, ch);
842         oldstate = fsm_getstate(fi);
843         fsm_newstate(fi, CTC_STATE_STARTWAIT);
844         if (event == CTC_EVENT_TIMER)   /* only for timer not yet locked */
845                 spin_lock_irqsave(get_ccwdev_lock(ch->cdev), saveflags);
846                         /* Such conditional locking is a known problem for
847                          * sparse because its undeterministic in static view.
848                          * Warnings should be ignored here. */
849         rc = ccw_device_halt(ch->cdev, 0);
850         if (event == CTC_EVENT_TIMER)
851                 spin_unlock_irqrestore(get_ccwdev_lock(ch->cdev), saveflags);
852         if (rc != 0) {
853                 if (rc != -EBUSY) {
854                     fsm_deltimer(&ch->timer);
855                     fsm_newstate(fi, oldstate);
856                 }
857                 ctcm_ccw_check_rc(ch, rc, "HaltIO in ctcm_chx_restart");
858         }
859 }
860
861 /**
862  * Handle error during RX initial handshake (exchange of
863  * 0-length block header)
864  *
865  * fi           An instance of a channel statemachine.
866  * event        The event, just happened.
867  * arg          Generic pointer, casted from channel * upon call.
868  */
869 static void ctcm_chx_rxiniterr(fsm_instance *fi, int event, void *arg)
870 {
871         struct channel *ch = arg;
872         struct net_device *dev = ch->netdev;
873         struct ctcm_priv *priv = dev->ml_priv;
874
875         if (event == CTC_EVENT_TIMER) {
876                 if (!IS_MPCDEV(dev))
877                         /* TODO : check if MPC deletes timer somewhere */
878                         fsm_deltimer(&ch->timer);
879                 if (ch->retry++ < 3)
880                         ctcm_chx_restart(fi, event, arg);
881                 else {
882                         fsm_newstate(fi, CTC_STATE_RXERR);
883                         fsm_event(priv->fsm, DEV_EVENT_RXDOWN, dev);
884                 }
885         } else {
886                 CTCM_DBF_TEXT_(ERROR, CTC_DBF_ERROR,
887                         "%s(%s): %s in %s", CTCM_FUNTAIL, ch->id,
888                         ctc_ch_event_names[event], fsm_getstate_str(fi));
889
890                 dev_warn(&dev->dev,
891                         "Initialization failed with RX/TX init handshake "
892                         "error %s\n", ctc_ch_event_names[event]);
893         }
894 }
895
896 /**
897  * Notify device statemachine if we gave up initialization
898  * of RX channel.
899  *
900  * fi           An instance of a channel statemachine.
901  * event        The event, just happened.
902  * arg          Generic pointer, casted from channel * upon call.
903  */
904 static void ctcm_chx_rxinitfail(fsm_instance *fi, int event, void *arg)
905 {
906         struct channel *ch = arg;
907         struct net_device *dev = ch->netdev;
908         struct ctcm_priv *priv = dev->ml_priv;
909
910         CTCM_DBF_TEXT_(ERROR, CTC_DBF_ERROR,
911                         "%s(%s): RX %s busy, init. fail",
912                                 CTCM_FUNTAIL, dev->name, ch->id);
913         fsm_newstate(fi, CTC_STATE_RXERR);
914         fsm_event(priv->fsm, DEV_EVENT_RXDOWN, dev);
915 }
916
917 /**
918  * Handle RX Unit check remote reset (remote disconnected)
919  *
920  * fi           An instance of a channel statemachine.
921  * event        The event, just happened.
922  * arg          Generic pointer, casted from channel * upon call.
923  */
924 static void ctcm_chx_rxdisc(fsm_instance *fi, int event, void *arg)
925 {
926         struct channel *ch = arg;
927         struct channel *ch2;
928         struct net_device *dev = ch->netdev;
929         struct ctcm_priv *priv = dev->ml_priv;
930
931         CTCM_DBF_TEXT_(TRACE, CTC_DBF_NOTICE,
932                         "%s: %s: remote disconnect - re-init ...",
933                                 CTCM_FUNTAIL, dev->name);
934         fsm_deltimer(&ch->timer);
935         /*
936          * Notify device statemachine
937          */
938         fsm_event(priv->fsm, DEV_EVENT_RXDOWN, dev);
939         fsm_event(priv->fsm, DEV_EVENT_TXDOWN, dev);
940
941         fsm_newstate(fi, CTC_STATE_DTERM);
942         ch2 = priv->channel[CTCM_WRITE];
943         fsm_newstate(ch2->fsm, CTC_STATE_DTERM);
944
945         ccw_device_halt(ch->cdev, 0);
946         ccw_device_halt(ch2->cdev, 0);
947 }
948
949 /**
950  * Handle error during TX channel initialization.
951  *
952  * fi           An instance of a channel statemachine.
953  * event        The event, just happened.
954  * arg          Generic pointer, casted from channel * upon call.
955  */
956 static void ctcm_chx_txiniterr(fsm_instance *fi, int event, void *arg)
957 {
958         struct channel *ch = arg;
959         struct net_device *dev = ch->netdev;
960         struct ctcm_priv *priv = dev->ml_priv;
961
962         if (event == CTC_EVENT_TIMER) {
963                 fsm_deltimer(&ch->timer);
964                 if (ch->retry++ < 3)
965                         ctcm_chx_restart(fi, event, arg);
966                 else {
967                         fsm_newstate(fi, CTC_STATE_TXERR);
968                         fsm_event(priv->fsm, DEV_EVENT_TXDOWN, dev);
969                 }
970         } else {
971                 CTCM_DBF_TEXT_(ERROR, CTC_DBF_ERROR,
972                         "%s(%s): %s in %s", CTCM_FUNTAIL, ch->id,
973                         ctc_ch_event_names[event], fsm_getstate_str(fi));
974
975                 dev_warn(&dev->dev,
976                         "Initialization failed with RX/TX init handshake "
977                         "error %s\n", ctc_ch_event_names[event]);
978         }
979 }
980
981 /**
982  * Handle TX timeout by retrying operation.
983  *
984  * fi           An instance of a channel statemachine.
985  * event        The event, just happened.
986  * arg          Generic pointer, casted from channel * upon call.
987  */
988 static void ctcm_chx_txretry(fsm_instance *fi, int event, void *arg)
989 {
990         struct channel *ch = arg;
991         struct net_device *dev = ch->netdev;
992         struct ctcm_priv *priv = dev->ml_priv;
993         struct sk_buff *skb;
994
995         CTCM_PR_DEBUG("Enter: %s: cp=%i ch=0x%p id=%s\n",
996                         __func__, smp_processor_id(), ch, ch->id);
997
998         fsm_deltimer(&ch->timer);
999         if (ch->retry++ > 3) {
1000                 struct mpc_group *gptr = priv->mpcg;
1001                 CTCM_DBF_TEXT_(TRACE, CTC_DBF_INFO,
1002                                 "%s: %s: retries exceeded",
1003                                         CTCM_FUNTAIL, ch->id);
1004                 fsm_event(priv->fsm, DEV_EVENT_TXDOWN, dev);
1005                 /* call restart if not MPC or if MPC and mpcg fsm is ready.
1006                         use gptr as mpc indicator */
1007                 if (!(gptr && (fsm_getstate(gptr->fsm) != MPCG_STATE_READY)))
1008                         ctcm_chx_restart(fi, event, arg);
1009                                 goto done;
1010         }
1011
1012         CTCM_DBF_TEXT_(TRACE, CTC_DBF_DEBUG,
1013                         "%s : %s: retry %d",
1014                                 CTCM_FUNTAIL, ch->id, ch->retry);
1015         skb = skb_peek(&ch->io_queue);
1016         if (skb) {
1017                 int rc = 0;
1018                 unsigned long saveflags = 0;
1019                 clear_normalized_cda(&ch->ccw[4]);
1020                 ch->ccw[4].count = skb->len;
1021                 if (set_normalized_cda(&ch->ccw[4], skb->data)) {
1022                         CTCM_DBF_TEXT_(TRACE, CTC_DBF_INFO,
1023                                 "%s: %s: IDAL alloc failed",
1024                                                 CTCM_FUNTAIL, ch->id);
1025                         fsm_event(priv->fsm, DEV_EVENT_TXDOWN, dev);
1026                         ctcm_chx_restart(fi, event, arg);
1027                                 goto done;
1028                 }
1029                 fsm_addtimer(&ch->timer, 1000, CTC_EVENT_TIMER, ch);
1030                 if (event == CTC_EVENT_TIMER) /* for TIMER not yet locked */
1031                         spin_lock_irqsave(get_ccwdev_lock(ch->cdev), saveflags);
1032                         /* Such conditional locking is a known problem for
1033                          * sparse because its undeterministic in static view.
1034                          * Warnings should be ignored here. */
1035                 if (do_debug_ccw)
1036                         ctcmpc_dumpit((char *)&ch->ccw[3],
1037                                         sizeof(struct ccw1) * 3);
1038
1039                 rc = ccw_device_start(ch->cdev, &ch->ccw[3], 0, 0xff, 0);
1040                 if (event == CTC_EVENT_TIMER)
1041                         spin_unlock_irqrestore(get_ccwdev_lock(ch->cdev),
1042                                         saveflags);
1043                 if (rc != 0) {
1044                         fsm_deltimer(&ch->timer);
1045                         ctcm_ccw_check_rc(ch, rc, "TX in chx_txretry");
1046                         ctcm_purge_skb_queue(&ch->io_queue);
1047                 }
1048         }
1049 done:
1050         return;
1051 }
1052
1053 /**
1054  * Handle fatal errors during an I/O command.
1055  *
1056  * fi           An instance of a channel statemachine.
1057  * event        The event, just happened.
1058  * arg          Generic pointer, casted from channel * upon call.
1059  */
1060 static void ctcm_chx_iofatal(fsm_instance *fi, int event, void *arg)
1061 {
1062         struct channel *ch = arg;
1063         struct net_device *dev = ch->netdev;
1064         struct ctcm_priv *priv = dev->ml_priv;
1065         int rd = CHANNEL_DIRECTION(ch->flags);
1066
1067         fsm_deltimer(&ch->timer);
1068         CTCM_DBF_TEXT_(ERROR, CTC_DBF_ERROR,
1069                 "%s: %s: %s unrecoverable channel error",
1070                         CTCM_FUNTAIL, ch->id, rd == CTCM_READ ? "RX" : "TX");
1071
1072         if (IS_MPC(ch)) {
1073                 priv->stats.tx_dropped++;
1074                 priv->stats.tx_errors++;
1075         }
1076         if (rd == CTCM_READ) {
1077                 fsm_newstate(fi, CTC_STATE_RXERR);
1078                 fsm_event(priv->fsm, DEV_EVENT_RXDOWN, dev);
1079         } else {
1080                 fsm_newstate(fi, CTC_STATE_TXERR);
1081                 fsm_event(priv->fsm, DEV_EVENT_TXDOWN, dev);
1082         }
1083 }
1084
1085 /*
1086  * The ctcm statemachine for a channel.
1087  */
1088 const fsm_node ch_fsm[] = {
1089         { CTC_STATE_STOPPED,    CTC_EVENT_STOP,         ctcm_action_nop  },
1090         { CTC_STATE_STOPPED,    CTC_EVENT_START,        ctcm_chx_start  },
1091         { CTC_STATE_STOPPED,    CTC_EVENT_FINSTAT,      ctcm_action_nop  },
1092         { CTC_STATE_STOPPED,    CTC_EVENT_MC_FAIL,      ctcm_action_nop  },
1093
1094         { CTC_STATE_NOTOP,      CTC_EVENT_STOP,         ctcm_chx_stop  },
1095         { CTC_STATE_NOTOP,      CTC_EVENT_START,        ctcm_action_nop  },
1096         { CTC_STATE_NOTOP,      CTC_EVENT_FINSTAT,      ctcm_action_nop  },
1097         { CTC_STATE_NOTOP,      CTC_EVENT_MC_FAIL,      ctcm_action_nop  },
1098         { CTC_STATE_NOTOP,      CTC_EVENT_MC_GOOD,      ctcm_chx_start  },
1099
1100         { CTC_STATE_STARTWAIT,  CTC_EVENT_STOP,         ctcm_chx_haltio  },
1101         { CTC_STATE_STARTWAIT,  CTC_EVENT_START,        ctcm_action_nop  },
1102         { CTC_STATE_STARTWAIT,  CTC_EVENT_FINSTAT,      ctcm_chx_setmode  },
1103         { CTC_STATE_STARTWAIT,  CTC_EVENT_TIMER,        ctcm_chx_setuperr  },
1104         { CTC_STATE_STARTWAIT,  CTC_EVENT_IO_ENODEV,    ctcm_chx_iofatal  },
1105         { CTC_STATE_STARTWAIT,  CTC_EVENT_MC_FAIL,      ctcm_chx_fail  },
1106
1107         { CTC_STATE_STARTRETRY, CTC_EVENT_STOP,         ctcm_chx_haltio  },
1108         { CTC_STATE_STARTRETRY, CTC_EVENT_TIMER,        ctcm_chx_setmode  },
1109         { CTC_STATE_STARTRETRY, CTC_EVENT_FINSTAT,      ctcm_action_nop  },
1110         { CTC_STATE_STARTRETRY, CTC_EVENT_MC_FAIL,      ctcm_chx_fail  },
1111
1112         { CTC_STATE_SETUPWAIT,  CTC_EVENT_STOP,         ctcm_chx_haltio  },
1113         { CTC_STATE_SETUPWAIT,  CTC_EVENT_START,        ctcm_action_nop  },
1114         { CTC_STATE_SETUPWAIT,  CTC_EVENT_FINSTAT,      chx_firstio  },
1115         { CTC_STATE_SETUPWAIT,  CTC_EVENT_UC_RCRESET,   ctcm_chx_setuperr  },
1116         { CTC_STATE_SETUPWAIT,  CTC_EVENT_UC_RSRESET,   ctcm_chx_setuperr  },
1117         { CTC_STATE_SETUPWAIT,  CTC_EVENT_TIMER,        ctcm_chx_setmode  },
1118         { CTC_STATE_SETUPWAIT,  CTC_EVENT_IO_ENODEV,    ctcm_chx_iofatal  },
1119         { CTC_STATE_SETUPWAIT,  CTC_EVENT_MC_FAIL,      ctcm_chx_fail  },
1120
1121         { CTC_STATE_RXINIT,     CTC_EVENT_STOP,         ctcm_chx_haltio  },
1122         { CTC_STATE_RXINIT,     CTC_EVENT_START,        ctcm_action_nop  },
1123         { CTC_STATE_RXINIT,     CTC_EVENT_FINSTAT,      chx_rxidle  },
1124         { CTC_STATE_RXINIT,     CTC_EVENT_UC_RCRESET,   ctcm_chx_rxiniterr  },
1125         { CTC_STATE_RXINIT,     CTC_EVENT_UC_RSRESET,   ctcm_chx_rxiniterr  },
1126         { CTC_STATE_RXINIT,     CTC_EVENT_TIMER,        ctcm_chx_rxiniterr  },
1127         { CTC_STATE_RXINIT,     CTC_EVENT_ATTNBUSY,     ctcm_chx_rxinitfail  },
1128         { CTC_STATE_RXINIT,     CTC_EVENT_IO_ENODEV,    ctcm_chx_iofatal  },
1129         { CTC_STATE_RXINIT,     CTC_EVENT_UC_ZERO,      chx_firstio  },
1130         { CTC_STATE_RXINIT,     CTC_EVENT_MC_FAIL,      ctcm_chx_fail  },
1131
1132         { CTC_STATE_RXIDLE,     CTC_EVENT_STOP,         ctcm_chx_haltio  },
1133         { CTC_STATE_RXIDLE,     CTC_EVENT_START,        ctcm_action_nop  },
1134         { CTC_STATE_RXIDLE,     CTC_EVENT_FINSTAT,      chx_rx  },
1135         { CTC_STATE_RXIDLE,     CTC_EVENT_UC_RCRESET,   ctcm_chx_rxdisc  },
1136         { CTC_STATE_RXIDLE,     CTC_EVENT_IO_ENODEV,    ctcm_chx_iofatal  },
1137         { CTC_STATE_RXIDLE,     CTC_EVENT_MC_FAIL,      ctcm_chx_fail  },
1138         { CTC_STATE_RXIDLE,     CTC_EVENT_UC_ZERO,      chx_rx  },
1139
1140         { CTC_STATE_TXINIT,     CTC_EVENT_STOP,         ctcm_chx_haltio  },
1141         { CTC_STATE_TXINIT,     CTC_EVENT_START,        ctcm_action_nop  },
1142         { CTC_STATE_TXINIT,     CTC_EVENT_FINSTAT,      ctcm_chx_txidle  },
1143         { CTC_STATE_TXINIT,     CTC_EVENT_UC_RCRESET,   ctcm_chx_txiniterr  },
1144         { CTC_STATE_TXINIT,     CTC_EVENT_UC_RSRESET,   ctcm_chx_txiniterr  },
1145         { CTC_STATE_TXINIT,     CTC_EVENT_TIMER,        ctcm_chx_txiniterr  },
1146         { CTC_STATE_TXINIT,     CTC_EVENT_IO_ENODEV,    ctcm_chx_iofatal  },
1147         { CTC_STATE_TXINIT,     CTC_EVENT_MC_FAIL,      ctcm_chx_fail  },
1148
1149         { CTC_STATE_TXIDLE,     CTC_EVENT_STOP,         ctcm_chx_haltio  },
1150         { CTC_STATE_TXIDLE,     CTC_EVENT_START,        ctcm_action_nop  },
1151         { CTC_STATE_TXIDLE,     CTC_EVENT_FINSTAT,      chx_firstio  },
1152         { CTC_STATE_TXIDLE,     CTC_EVENT_UC_RCRESET,   ctcm_action_nop  },
1153         { CTC_STATE_TXIDLE,     CTC_EVENT_UC_RSRESET,   ctcm_action_nop  },
1154         { CTC_STATE_TXIDLE,     CTC_EVENT_IO_ENODEV,    ctcm_chx_iofatal  },
1155         { CTC_STATE_TXIDLE,     CTC_EVENT_MC_FAIL,      ctcm_chx_fail  },
1156
1157         { CTC_STATE_TERM,       CTC_EVENT_STOP,         ctcm_action_nop  },
1158         { CTC_STATE_TERM,       CTC_EVENT_START,        ctcm_chx_restart  },
1159         { CTC_STATE_TERM,       CTC_EVENT_FINSTAT,      ctcm_chx_stopped  },
1160         { CTC_STATE_TERM,       CTC_EVENT_UC_RCRESET,   ctcm_action_nop  },
1161         { CTC_STATE_TERM,       CTC_EVENT_UC_RSRESET,   ctcm_action_nop  },
1162         { CTC_STATE_TERM,       CTC_EVENT_MC_FAIL,      ctcm_chx_fail  },
1163
1164         { CTC_STATE_DTERM,      CTC_EVENT_STOP,         ctcm_chx_haltio  },
1165         { CTC_STATE_DTERM,      CTC_EVENT_START,        ctcm_chx_restart  },
1166         { CTC_STATE_DTERM,      CTC_EVENT_FINSTAT,      ctcm_chx_setmode  },
1167         { CTC_STATE_DTERM,      CTC_EVENT_UC_RCRESET,   ctcm_action_nop  },
1168         { CTC_STATE_DTERM,      CTC_EVENT_UC_RSRESET,   ctcm_action_nop  },
1169         { CTC_STATE_DTERM,      CTC_EVENT_MC_FAIL,      ctcm_chx_fail  },
1170
1171         { CTC_STATE_TX,         CTC_EVENT_STOP,         ctcm_chx_haltio  },
1172         { CTC_STATE_TX,         CTC_EVENT_START,        ctcm_action_nop  },
1173         { CTC_STATE_TX,         CTC_EVENT_FINSTAT,      chx_txdone  },
1174         { CTC_STATE_TX,         CTC_EVENT_UC_RCRESET,   ctcm_chx_txretry  },
1175         { CTC_STATE_TX,         CTC_EVENT_UC_RSRESET,   ctcm_chx_txretry  },
1176         { CTC_STATE_TX,         CTC_EVENT_TIMER,        ctcm_chx_txretry  },
1177         { CTC_STATE_TX,         CTC_EVENT_IO_ENODEV,    ctcm_chx_iofatal  },
1178         { CTC_STATE_TX,         CTC_EVENT_MC_FAIL,      ctcm_chx_fail  },
1179
1180         { CTC_STATE_RXERR,      CTC_EVENT_STOP,         ctcm_chx_haltio  },
1181         { CTC_STATE_TXERR,      CTC_EVENT_STOP,         ctcm_chx_haltio  },
1182         { CTC_STATE_TXERR,      CTC_EVENT_MC_FAIL,      ctcm_chx_fail  },
1183         { CTC_STATE_RXERR,      CTC_EVENT_MC_FAIL,      ctcm_chx_fail  },
1184 };
1185
1186 int ch_fsm_len = ARRAY_SIZE(ch_fsm);
1187
1188 /*
1189  * MPC actions for mpc channel statemachine
1190  * handling of MPC protocol requires extra
1191  * statemachine and actions which are prefixed ctcmpc_ .
1192  * The ctc_ch_states and ctc_ch_state_names,
1193  * ctc_ch_events and ctc_ch_event_names share the ctcm definitions
1194  * which are expanded by some elements.
1195  */
1196
1197 /*
1198  * Actions for mpc channel statemachine.
1199  */
1200
1201 /**
1202  * Normal data has been send. Free the corresponding
1203  * skb (it's in io_queue), reset dev->tbusy and
1204  * revert to idle state.
1205  *
1206  * fi           An instance of a channel statemachine.
1207  * event        The event, just happened.
1208  * arg          Generic pointer, casted from channel * upon call.
1209  */
1210 static void ctcmpc_chx_txdone(fsm_instance *fi, int event, void *arg)
1211 {
1212         struct channel          *ch = arg;
1213         struct net_device       *dev = ch->netdev;
1214         struct ctcm_priv        *priv = dev->ml_priv;
1215         struct mpc_group        *grp = priv->mpcg;
1216         struct sk_buff          *skb;
1217         int             first = 1;
1218         int             i;
1219         __u32           data_space;
1220         unsigned long   duration;
1221         struct sk_buff  *peekskb;
1222         int             rc;
1223         struct th_header *header;
1224         struct pdu      *p_header;
1225         unsigned long done_stamp = jiffies;
1226
1227         CTCM_PR_DEBUG("Enter %s: %s cp:%i\n",
1228                         __func__, dev->name, smp_processor_id());
1229
1230         duration = done_stamp - ch->prof.send_stamp;
1231         if (duration > ch->prof.tx_time)
1232                 ch->prof.tx_time = duration;
1233
1234         if (ch->irb->scsw.cmd.count != 0)
1235                 CTCM_DBF_TEXT_(MPC_TRACE, CTC_DBF_DEBUG,
1236                         "%s(%s): TX not complete, remaining %d bytes",
1237                              CTCM_FUNTAIL, dev->name, ch->irb->scsw.cmd.count);
1238         fsm_deltimer(&ch->timer);
1239         while ((skb = skb_dequeue(&ch->io_queue))) {
1240                 priv->stats.tx_packets++;
1241                 priv->stats.tx_bytes += skb->len - TH_HEADER_LENGTH;
1242                 if (first) {
1243                         priv->stats.tx_bytes += 2;
1244                         first = 0;
1245                 }
1246                 refcount_dec(&skb->users);
1247                 dev_kfree_skb_irq(skb);
1248         }
1249         spin_lock(&ch->collect_lock);
1250         clear_normalized_cda(&ch->ccw[4]);
1251         if ((ch->collect_len <= 0) || (grp->in_sweep != 0)) {
1252                 spin_unlock(&ch->collect_lock);
1253                 fsm_newstate(fi, CTC_STATE_TXIDLE);
1254                                 goto done;
1255         }
1256
1257         if (ctcm_checkalloc_buffer(ch)) {
1258                 spin_unlock(&ch->collect_lock);
1259                                 goto done;
1260         }
1261         ch->trans_skb->data = ch->trans_skb_data;
1262         skb_reset_tail_pointer(ch->trans_skb);
1263         ch->trans_skb->len = 0;
1264         if (ch->prof.maxmulti < (ch->collect_len + TH_HEADER_LENGTH))
1265                 ch->prof.maxmulti = ch->collect_len + TH_HEADER_LENGTH;
1266         if (ch->prof.maxcqueue < skb_queue_len(&ch->collect_queue))
1267                 ch->prof.maxcqueue = skb_queue_len(&ch->collect_queue);
1268         i = 0;
1269         p_header = NULL;
1270         data_space = grp->group_max_buflen - TH_HEADER_LENGTH;
1271
1272         CTCM_PR_DBGDATA("%s: building trans_skb from collect_q"
1273                        " data_space:%04x\n",
1274                        __func__, data_space);
1275
1276         while ((skb = skb_dequeue(&ch->collect_queue))) {
1277                 skb_put_data(ch->trans_skb, skb->data, skb->len);
1278                 p_header = (struct pdu *)
1279                         (skb_tail_pointer(ch->trans_skb) - skb->len);
1280                 p_header->pdu_flag = 0x00;
1281                 if (be16_to_cpu(skb->protocol) == ETH_P_SNAP)
1282                         p_header->pdu_flag |= 0x60;
1283                 else
1284                         p_header->pdu_flag |= 0x20;
1285
1286                 CTCM_PR_DBGDATA("%s: trans_skb len:%04x \n",
1287                                 __func__, ch->trans_skb->len);
1288                 CTCM_PR_DBGDATA("%s: pdu header and data for up"
1289                                 " to 32 bytes sent to vtam\n", __func__);
1290                 CTCM_D3_DUMP((char *)p_header, min_t(int, skb->len, 32));
1291
1292                 ch->collect_len -= skb->len;
1293                 data_space -= skb->len;
1294                 priv->stats.tx_packets++;
1295                 priv->stats.tx_bytes += skb->len;
1296                 refcount_dec(&skb->users);
1297                 dev_kfree_skb_any(skb);
1298                 peekskb = skb_peek(&ch->collect_queue);
1299                 if (peekskb->len > data_space)
1300                         break;
1301                 i++;
1302         }
1303         /* p_header points to the last one we handled */
1304         if (p_header)
1305                 p_header->pdu_flag |= PDU_LAST; /*Say it's the last one*/
1306
1307         header = skb_push(ch->trans_skb, TH_HEADER_LENGTH);
1308         memset(header, 0, TH_HEADER_LENGTH);
1309
1310         header->th_ch_flag = TH_HAS_PDU;  /* Normal data */
1311         ch->th_seq_num++;
1312         header->th_seq_num = ch->th_seq_num;
1313
1314         CTCM_PR_DBGDATA("%s: ToVTAM_th_seq= %08x\n" ,
1315                                         __func__, ch->th_seq_num);
1316
1317         CTCM_PR_DBGDATA("%s: trans_skb len:%04x \n",
1318                        __func__, ch->trans_skb->len);
1319         CTCM_PR_DBGDATA("%s: up-to-50 bytes of trans_skb "
1320                         "data to vtam from collect_q\n", __func__);
1321         CTCM_D3_DUMP((char *)ch->trans_skb->data,
1322                                 min_t(int, ch->trans_skb->len, 50));
1323
1324         spin_unlock(&ch->collect_lock);
1325         clear_normalized_cda(&ch->ccw[1]);
1326
1327         CTCM_PR_DBGDATA("ccwcda=0x%p data=0x%p\n",
1328                         (void *)(unsigned long)ch->ccw[1].cda,
1329                         ch->trans_skb->data);
1330         ch->ccw[1].count = ch->max_bufsize;
1331
1332         if (set_normalized_cda(&ch->ccw[1], ch->trans_skb->data)) {
1333                 dev_kfree_skb_any(ch->trans_skb);
1334                 ch->trans_skb = NULL;
1335                 CTCM_DBF_TEXT_(MPC_TRACE, CTC_DBF_ERROR,
1336                         "%s: %s: IDAL alloc failed",
1337                                 CTCM_FUNTAIL, ch->id);
1338                 fsm_event(priv->mpcg->fsm, MPCG_EVENT_INOP, dev);
1339                 return;
1340         }
1341
1342         CTCM_PR_DBGDATA("ccwcda=0x%p data=0x%p\n",
1343                         (void *)(unsigned long)ch->ccw[1].cda,
1344                         ch->trans_skb->data);
1345
1346         ch->ccw[1].count = ch->trans_skb->len;
1347         fsm_addtimer(&ch->timer, CTCM_TIME_5_SEC, CTC_EVENT_TIMER, ch);
1348         ch->prof.send_stamp = jiffies;
1349         if (do_debug_ccw)
1350                 ctcmpc_dumpit((char *)&ch->ccw[0], sizeof(struct ccw1) * 3);
1351         rc = ccw_device_start(ch->cdev, &ch->ccw[0], 0, 0xff, 0);
1352         ch->prof.doios_multi++;
1353         if (rc != 0) {
1354                 priv->stats.tx_dropped += i;
1355                 priv->stats.tx_errors += i;
1356                 fsm_deltimer(&ch->timer);
1357                 ctcm_ccw_check_rc(ch, rc, "chained TX");
1358         }
1359 done:
1360         ctcm_clear_busy(dev);
1361         return;
1362 }
1363
1364 /**
1365  * Got normal data, check for sanity, queue it up, allocate new buffer
1366  * trigger bottom half, and initiate next read.
1367  *
1368  * fi           An instance of a channel statemachine.
1369  * event        The event, just happened.
1370  * arg          Generic pointer, casted from channel * upon call.
1371  */
1372 static void ctcmpc_chx_rx(fsm_instance *fi, int event, void *arg)
1373 {
1374         struct channel          *ch = arg;
1375         struct net_device       *dev = ch->netdev;
1376         struct ctcm_priv        *priv = dev->ml_priv;
1377         struct mpc_group        *grp = priv->mpcg;
1378         struct sk_buff          *skb = ch->trans_skb;
1379         struct sk_buff          *new_skb;
1380         unsigned long           saveflags = 0;  /* avoids compiler warning */
1381         int len = ch->max_bufsize - ch->irb->scsw.cmd.count;
1382
1383         CTCM_PR_DEBUG("%s: %s: cp:%i %s maxbuf : %04x, len: %04x\n",
1384                         CTCM_FUNTAIL, dev->name, smp_processor_id(),
1385                                 ch->id, ch->max_bufsize, len);
1386         fsm_deltimer(&ch->timer);
1387
1388         if (skb == NULL) {
1389                 CTCM_DBF_TEXT_(MPC_ERROR, CTC_DBF_ERROR,
1390                         "%s(%s): TRANS_SKB = NULL",
1391                                 CTCM_FUNTAIL, dev->name);
1392                         goto again;
1393         }
1394
1395         if (len < TH_HEADER_LENGTH) {
1396                 CTCM_DBF_TEXT_(MPC_ERROR, CTC_DBF_ERROR,
1397                                 "%s(%s): packet length %d to short",
1398                                         CTCM_FUNTAIL, dev->name, len);
1399                 priv->stats.rx_dropped++;
1400                 priv->stats.rx_length_errors++;
1401         } else {
1402                 /* must have valid th header or game over */
1403                 __u32   block_len = len;
1404                 len = TH_HEADER_LENGTH + XID2_LENGTH + 4;
1405                 new_skb = __dev_alloc_skb(ch->max_bufsize, GFP_ATOMIC);
1406
1407                 if (new_skb == NULL) {
1408                         CTCM_DBF_TEXT_(MPC_ERROR, CTC_DBF_ERROR,
1409                                 "%s(%d): skb allocation failed",
1410                                                 CTCM_FUNTAIL, dev->name);
1411                         fsm_event(priv->mpcg->fsm, MPCG_EVENT_INOP, dev);
1412                                         goto again;
1413                 }
1414                 switch (fsm_getstate(grp->fsm)) {
1415                 case MPCG_STATE_RESET:
1416                 case MPCG_STATE_INOP:
1417                         dev_kfree_skb_any(new_skb);
1418                         break;
1419                 case MPCG_STATE_FLOWC:
1420                 case MPCG_STATE_READY:
1421                         skb_put_data(new_skb, skb->data, block_len);
1422                         skb_queue_tail(&ch->io_queue, new_skb);
1423                         tasklet_schedule(&ch->ch_tasklet);
1424                         break;
1425                 default:
1426                         skb_put_data(new_skb, skb->data, len);
1427                         skb_queue_tail(&ch->io_queue, new_skb);
1428                         tasklet_hi_schedule(&ch->ch_tasklet);
1429                         break;
1430                 }
1431         }
1432
1433 again:
1434         switch (fsm_getstate(grp->fsm)) {
1435         int rc, dolock;
1436         case MPCG_STATE_FLOWC:
1437         case MPCG_STATE_READY:
1438                 if (ctcm_checkalloc_buffer(ch))
1439                         break;
1440                 ch->trans_skb->data = ch->trans_skb_data;
1441                 skb_reset_tail_pointer(ch->trans_skb);
1442                 ch->trans_skb->len = 0;
1443                 ch->ccw[1].count = ch->max_bufsize;
1444                         if (do_debug_ccw)
1445                         ctcmpc_dumpit((char *)&ch->ccw[0],
1446                                         sizeof(struct ccw1) * 3);
1447                 dolock = !in_irq();
1448                 if (dolock)
1449                         spin_lock_irqsave(
1450                                 get_ccwdev_lock(ch->cdev), saveflags);
1451                 rc = ccw_device_start(ch->cdev, &ch->ccw[0], 0, 0xff, 0);
1452                 if (dolock) /* see remark about conditional locking */
1453                         spin_unlock_irqrestore(
1454                                 get_ccwdev_lock(ch->cdev), saveflags);
1455                 if (rc != 0)
1456                         ctcm_ccw_check_rc(ch, rc, "normal RX");
1457         default:
1458                 break;
1459         }
1460
1461         CTCM_PR_DEBUG("Exit %s: %s, ch=0x%p, id=%s\n",
1462                         __func__, dev->name, ch, ch->id);
1463
1464 }
1465
1466 /**
1467  * Initialize connection by sending a __u16 of value 0.
1468  *
1469  * fi           An instance of a channel statemachine.
1470  * event        The event, just happened.
1471  * arg          Generic pointer, casted from channel * upon call.
1472  */
1473 static void ctcmpc_chx_firstio(fsm_instance *fi, int event, void *arg)
1474 {
1475         struct channel          *ch = arg;
1476         struct net_device       *dev = ch->netdev;
1477         struct ctcm_priv        *priv = dev->ml_priv;
1478         struct mpc_group        *gptr = priv->mpcg;
1479
1480         CTCM_PR_DEBUG("Enter %s: id=%s, ch=0x%p\n",
1481                                 __func__, ch->id, ch);
1482
1483         CTCM_DBF_TEXT_(MPC_TRACE, CTC_DBF_INFO,
1484                         "%s: %s: chstate:%i, grpstate:%i, prot:%i\n",
1485                         CTCM_FUNTAIL, ch->id, fsm_getstate(fi),
1486                         fsm_getstate(gptr->fsm), ch->protocol);
1487
1488         if (fsm_getstate(fi) == CTC_STATE_TXIDLE)
1489                 MPC_DBF_DEV_NAME(TRACE, dev, "remote side issued READ? ");
1490
1491         fsm_deltimer(&ch->timer);
1492         if (ctcm_checkalloc_buffer(ch))
1493                                 goto done;
1494
1495         switch (fsm_getstate(fi)) {
1496         case CTC_STATE_STARTRETRY:
1497         case CTC_STATE_SETUPWAIT:
1498                 if (CHANNEL_DIRECTION(ch->flags) == CTCM_READ) {
1499                         ctcmpc_chx_rxidle(fi, event, arg);
1500                 } else {
1501                         fsm_newstate(fi, CTC_STATE_TXIDLE);
1502                         fsm_event(priv->fsm, DEV_EVENT_TXUP, dev);
1503                 }
1504                                 goto done;
1505         default:
1506                 break;
1507         }
1508
1509         fsm_newstate(fi, (CHANNEL_DIRECTION(ch->flags) == CTCM_READ)
1510                      ? CTC_STATE_RXINIT : CTC_STATE_TXINIT);
1511
1512 done:
1513         CTCM_PR_DEBUG("Exit %s: id=%s, ch=0x%p\n",
1514                                 __func__, ch->id, ch);
1515         return;
1516 }
1517
1518 /**
1519  * Got initial data, check it. If OK,
1520  * notify device statemachine that we are up and
1521  * running.
1522  *
1523  * fi           An instance of a channel statemachine.
1524  * event        The event, just happened.
1525  * arg          Generic pointer, casted from channel * upon call.
1526  */
1527 void ctcmpc_chx_rxidle(fsm_instance *fi, int event, void *arg)
1528 {
1529         struct channel *ch = arg;
1530         struct net_device *dev = ch->netdev;
1531         struct ctcm_priv  *priv = dev->ml_priv;
1532         struct mpc_group  *grp = priv->mpcg;
1533         int rc;
1534         unsigned long saveflags = 0;    /* avoids compiler warning */
1535
1536         fsm_deltimer(&ch->timer);
1537         CTCM_PR_DEBUG("%s: %s: %s: cp:%i, chstate:%i grpstate:%i\n",
1538                         __func__, ch->id, dev->name, smp_processor_id(),
1539                                 fsm_getstate(fi), fsm_getstate(grp->fsm));
1540
1541         fsm_newstate(fi, CTC_STATE_RXIDLE);
1542         /* XID processing complete */
1543
1544         switch (fsm_getstate(grp->fsm)) {
1545         case MPCG_STATE_FLOWC:
1546         case MPCG_STATE_READY:
1547                 if (ctcm_checkalloc_buffer(ch))
1548                                 goto done;
1549                 ch->trans_skb->data = ch->trans_skb_data;
1550                 skb_reset_tail_pointer(ch->trans_skb);
1551                 ch->trans_skb->len = 0;
1552                 ch->ccw[1].count = ch->max_bufsize;
1553                 CTCM_CCW_DUMP((char *)&ch->ccw[0], sizeof(struct ccw1) * 3);
1554                 if (event == CTC_EVENT_START)
1555                         /* see remark about conditional locking */
1556                         spin_lock_irqsave(get_ccwdev_lock(ch->cdev), saveflags);
1557                 rc = ccw_device_start(ch->cdev, &ch->ccw[0], 0, 0xff, 0);
1558                 if (event == CTC_EVENT_START)
1559                         spin_unlock_irqrestore(
1560                                         get_ccwdev_lock(ch->cdev), saveflags);
1561                 if (rc != 0) {
1562                         fsm_newstate(fi, CTC_STATE_RXINIT);
1563                         ctcm_ccw_check_rc(ch, rc, "initial RX");
1564                                 goto done;
1565                 }
1566                 break;
1567         default:
1568                 break;
1569         }
1570
1571         fsm_event(priv->fsm, DEV_EVENT_RXUP, dev);
1572 done:
1573         return;
1574 }
1575
1576 /*
1577  * ctcmpc channel FSM action
1578  * called from several points in ctcmpc_ch_fsm
1579  * ctcmpc only
1580  */
1581 static void ctcmpc_chx_attn(fsm_instance *fsm, int event, void *arg)
1582 {
1583         struct channel    *ch     = arg;
1584         struct net_device *dev    = ch->netdev;
1585         struct ctcm_priv  *priv   = dev->ml_priv;
1586         struct mpc_group  *grp = priv->mpcg;
1587
1588         CTCM_PR_DEBUG("%s(%s): %s(ch=0x%p), cp=%i, ChStat:%s, GrpStat:%s\n",
1589                 __func__, dev->name, ch->id, ch, smp_processor_id(),
1590                         fsm_getstate_str(ch->fsm), fsm_getstate_str(grp->fsm));
1591
1592         switch (fsm_getstate(grp->fsm)) {
1593         case MPCG_STATE_XID2INITW:
1594                 /* ok..start yside xid exchanges */
1595                 if (!ch->in_mpcgroup)
1596                         break;
1597                 if (fsm_getstate(ch->fsm) ==  CH_XID0_PENDING) {
1598                         fsm_deltimer(&grp->timer);
1599                         fsm_addtimer(&grp->timer,
1600                                 MPC_XID_TIMEOUT_VALUE,
1601                                 MPCG_EVENT_TIMER, dev);
1602                         fsm_event(grp->fsm, MPCG_EVENT_XID0DO, ch);
1603
1604                 } else if (fsm_getstate(ch->fsm) < CH_XID7_PENDING1)
1605                         /* attn rcvd before xid0 processed via bh */
1606                         fsm_newstate(ch->fsm, CH_XID7_PENDING1);
1607                 break;
1608         case MPCG_STATE_XID2INITX:
1609         case MPCG_STATE_XID0IOWAIT:
1610         case MPCG_STATE_XID0IOWAIX:
1611                 /* attn rcvd before xid0 processed on ch
1612                 but mid-xid0 processing for group    */
1613                 if (fsm_getstate(ch->fsm) < CH_XID7_PENDING1)
1614                         fsm_newstate(ch->fsm, CH_XID7_PENDING1);
1615                 break;
1616         case MPCG_STATE_XID7INITW:
1617         case MPCG_STATE_XID7INITX:
1618         case MPCG_STATE_XID7INITI:
1619         case MPCG_STATE_XID7INITZ:
1620                 switch (fsm_getstate(ch->fsm)) {
1621                 case CH_XID7_PENDING:
1622                         fsm_newstate(ch->fsm, CH_XID7_PENDING1);
1623                         break;
1624                 case CH_XID7_PENDING2:
1625                         fsm_newstate(ch->fsm, CH_XID7_PENDING3);
1626                         break;
1627                 }
1628                 fsm_event(grp->fsm, MPCG_EVENT_XID7DONE, dev);
1629                 break;
1630         }
1631
1632         return;
1633 }
1634
1635 /*
1636  * ctcmpc channel FSM action
1637  * called from one point in ctcmpc_ch_fsm
1638  * ctcmpc only
1639  */
1640 static void ctcmpc_chx_attnbusy(fsm_instance *fsm, int event, void *arg)
1641 {
1642         struct channel    *ch     = arg;
1643         struct net_device *dev    = ch->netdev;
1644         struct ctcm_priv  *priv   = dev->ml_priv;
1645         struct mpc_group  *grp    = priv->mpcg;
1646
1647         CTCM_PR_DEBUG("%s(%s): %s\n  ChState:%s GrpState:%s\n",
1648                         __func__, dev->name, ch->id,
1649                         fsm_getstate_str(ch->fsm), fsm_getstate_str(grp->fsm));
1650
1651         fsm_deltimer(&ch->timer);
1652
1653         switch (fsm_getstate(grp->fsm)) {
1654         case MPCG_STATE_XID0IOWAIT:
1655                 /* vtam wants to be primary.start yside xid exchanges*/
1656                 /* only receive one attn-busy at a time so must not  */
1657                 /* change state each time                            */
1658                 grp->changed_side = 1;
1659                 fsm_newstate(grp->fsm, MPCG_STATE_XID2INITW);
1660                 break;
1661         case MPCG_STATE_XID2INITW:
1662                 if (grp->changed_side == 1) {
1663                         grp->changed_side = 2;
1664                         break;
1665                 }
1666                 /* process began via call to establish_conn      */
1667                 /* so must report failure instead of reverting   */
1668                 /* back to ready-for-xid passive state           */
1669                 if (grp->estconnfunc)
1670                                 goto done;
1671                 /* this attnbusy is NOT the result of xside xid  */
1672                 /* collisions so yside must have been triggered  */
1673                 /* by an ATTN that was not intended to start XID */
1674                 /* processing. Revert back to ready-for-xid and  */
1675                 /* wait for ATTN interrupt to signal xid start   */
1676                 if (fsm_getstate(ch->fsm) == CH_XID0_INPROGRESS) {
1677                         fsm_newstate(ch->fsm, CH_XID0_PENDING) ;
1678                         fsm_deltimer(&grp->timer);
1679                                 goto done;
1680                 }
1681                 fsm_event(grp->fsm, MPCG_EVENT_INOP, dev);
1682                                 goto done;
1683         case MPCG_STATE_XID2INITX:
1684                 /* XID2 was received before ATTN Busy for second
1685                    channel.Send yside xid for second channel.
1686                 */
1687                 if (grp->changed_side == 1) {
1688                         grp->changed_side = 2;
1689                         break;
1690                 }
1691                 fallthrough;
1692         case MPCG_STATE_XID0IOWAIX:
1693         case MPCG_STATE_XID7INITW:
1694         case MPCG_STATE_XID7INITX:
1695         case MPCG_STATE_XID7INITI:
1696         case MPCG_STATE_XID7INITZ:
1697         default:
1698                 /* multiple attn-busy indicates too out-of-sync      */
1699                 /* and they are certainly not being received as part */
1700                 /* of valid mpc group negotiations..                 */
1701                 fsm_event(grp->fsm, MPCG_EVENT_INOP, dev);
1702                                 goto done;
1703         }
1704
1705         if (grp->changed_side == 1) {
1706                 fsm_deltimer(&grp->timer);
1707                 fsm_addtimer(&grp->timer, MPC_XID_TIMEOUT_VALUE,
1708                              MPCG_EVENT_TIMER, dev);
1709         }
1710         if (ch->in_mpcgroup)
1711                 fsm_event(grp->fsm, MPCG_EVENT_XID0DO, ch);
1712         else
1713                 CTCM_DBF_TEXT_(MPC_ERROR, CTC_DBF_ERROR,
1714                         "%s(%s): channel %s not added to group",
1715                                 CTCM_FUNTAIL, dev->name, ch->id);
1716
1717 done:
1718         return;
1719 }
1720
1721 /*
1722  * ctcmpc channel FSM action
1723  * called from several points in ctcmpc_ch_fsm
1724  * ctcmpc only
1725  */
1726 static void ctcmpc_chx_resend(fsm_instance *fsm, int event, void *arg)
1727 {
1728         struct channel     *ch     = arg;
1729         struct net_device  *dev    = ch->netdev;
1730         struct ctcm_priv   *priv   = dev->ml_priv;
1731         struct mpc_group   *grp    = priv->mpcg;
1732
1733         fsm_event(grp->fsm, MPCG_EVENT_XID0DO, ch);
1734         return;
1735 }
1736
1737 /*
1738  * ctcmpc channel FSM action
1739  * called from several points in ctcmpc_ch_fsm
1740  * ctcmpc only
1741  */
1742 static void ctcmpc_chx_send_sweep(fsm_instance *fsm, int event, void *arg)
1743 {
1744         struct channel *ach = arg;
1745         struct net_device *dev = ach->netdev;
1746         struct ctcm_priv *priv = dev->ml_priv;
1747         struct mpc_group *grp = priv->mpcg;
1748         struct channel *wch = priv->channel[CTCM_WRITE];
1749         struct channel *rch = priv->channel[CTCM_READ];
1750         struct sk_buff *skb;
1751         struct th_sweep *header;
1752         int rc = 0;
1753         unsigned long saveflags = 0;
1754
1755         CTCM_PR_DEBUG("ctcmpc enter: %s(): cp=%i ch=0x%p id=%s\n",
1756                         __func__, smp_processor_id(), ach, ach->id);
1757
1758         if (grp->in_sweep == 0)
1759                                 goto done;
1760
1761         CTCM_PR_DBGDATA("%s: 1: ToVTAM_th_seq= %08x\n" ,
1762                                 __func__, wch->th_seq_num);
1763         CTCM_PR_DBGDATA("%s: 1: FromVTAM_th_seq= %08x\n" ,
1764                                 __func__, rch->th_seq_num);
1765
1766         if (fsm_getstate(wch->fsm) != CTC_STATE_TXIDLE) {
1767                 /* give the previous IO time to complete */
1768                 fsm_addtimer(&wch->sweep_timer,
1769                         200, CTC_EVENT_RSWEEP_TIMER, wch);
1770                                 goto done;
1771         }
1772
1773         skb = skb_dequeue(&wch->sweep_queue);
1774         if (!skb)
1775                                 goto done;
1776
1777         if (set_normalized_cda(&wch->ccw[4], skb->data)) {
1778                 grp->in_sweep = 0;
1779                 ctcm_clear_busy_do(dev);
1780                 dev_kfree_skb_any(skb);
1781                 fsm_event(grp->fsm, MPCG_EVENT_INOP, dev);
1782                                 goto done;
1783         } else {
1784                 refcount_inc(&skb->users);
1785                 skb_queue_tail(&wch->io_queue, skb);
1786         }
1787
1788         /* send out the sweep */
1789         wch->ccw[4].count = skb->len;
1790
1791         header = (struct th_sweep *)skb->data;
1792         switch (header->th.th_ch_flag) {
1793         case TH_SWEEP_REQ:
1794                 grp->sweep_req_pend_num--;
1795                 break;
1796         case TH_SWEEP_RESP:
1797                 grp->sweep_rsp_pend_num--;
1798                 break;
1799         }
1800
1801         header->sw.th_last_seq = wch->th_seq_num;
1802
1803         CTCM_CCW_DUMP((char *)&wch->ccw[3], sizeof(struct ccw1) * 3);
1804         CTCM_PR_DBGDATA("%s: sweep packet\n", __func__);
1805         CTCM_D3_DUMP((char *)header, TH_SWEEP_LENGTH);
1806
1807         fsm_addtimer(&wch->timer, CTCM_TIME_5_SEC, CTC_EVENT_TIMER, wch);
1808         fsm_newstate(wch->fsm, CTC_STATE_TX);
1809
1810         spin_lock_irqsave(get_ccwdev_lock(wch->cdev), saveflags);
1811         wch->prof.send_stamp = jiffies;
1812         rc = ccw_device_start(wch->cdev, &wch->ccw[3], 0, 0xff, 0);
1813         spin_unlock_irqrestore(get_ccwdev_lock(wch->cdev), saveflags);
1814
1815         if ((grp->sweep_req_pend_num == 0) &&
1816            (grp->sweep_rsp_pend_num == 0)) {
1817                 grp->in_sweep = 0;
1818                 rch->th_seq_num = 0x00;
1819                 wch->th_seq_num = 0x00;
1820                 ctcm_clear_busy_do(dev);
1821         }
1822
1823         CTCM_PR_DBGDATA("%s: To-/From-VTAM_th_seq = %08x/%08x\n" ,
1824                         __func__, wch->th_seq_num, rch->th_seq_num);
1825
1826         if (rc != 0)
1827                 ctcm_ccw_check_rc(wch, rc, "send sweep");
1828
1829 done:
1830         return;
1831 }
1832
1833
1834 /*
1835  * The ctcmpc statemachine for a channel.
1836  */
1837
1838 const fsm_node ctcmpc_ch_fsm[] = {
1839         { CTC_STATE_STOPPED,    CTC_EVENT_STOP,         ctcm_action_nop  },
1840         { CTC_STATE_STOPPED,    CTC_EVENT_START,        ctcm_chx_start  },
1841         { CTC_STATE_STOPPED,    CTC_EVENT_IO_ENODEV,    ctcm_chx_iofatal  },
1842         { CTC_STATE_STOPPED,    CTC_EVENT_FINSTAT,      ctcm_action_nop  },
1843         { CTC_STATE_STOPPED,    CTC_EVENT_MC_FAIL,      ctcm_action_nop  },
1844
1845         { CTC_STATE_NOTOP,      CTC_EVENT_STOP,         ctcm_chx_stop  },
1846         { CTC_STATE_NOTOP,      CTC_EVENT_START,        ctcm_action_nop  },
1847         { CTC_STATE_NOTOP,      CTC_EVENT_FINSTAT,      ctcm_action_nop  },
1848         { CTC_STATE_NOTOP,      CTC_EVENT_MC_FAIL,      ctcm_action_nop  },
1849         { CTC_STATE_NOTOP,      CTC_EVENT_MC_GOOD,      ctcm_chx_start  },
1850         { CTC_STATE_NOTOP,      CTC_EVENT_UC_RCRESET,   ctcm_chx_stop  },
1851         { CTC_STATE_NOTOP,      CTC_EVENT_UC_RSRESET,   ctcm_chx_stop  },
1852         { CTC_STATE_NOTOP,      CTC_EVENT_IO_ENODEV,    ctcm_chx_iofatal  },
1853
1854         { CTC_STATE_STARTWAIT,  CTC_EVENT_STOP,         ctcm_chx_haltio  },
1855         { CTC_STATE_STARTWAIT,  CTC_EVENT_START,        ctcm_action_nop  },
1856         { CTC_STATE_STARTWAIT,  CTC_EVENT_FINSTAT,      ctcm_chx_setmode  },
1857         { CTC_STATE_STARTWAIT,  CTC_EVENT_TIMER,        ctcm_chx_setuperr  },
1858         { CTC_STATE_STARTWAIT,  CTC_EVENT_IO_ENODEV,    ctcm_chx_iofatal  },
1859         { CTC_STATE_STARTWAIT,  CTC_EVENT_MC_FAIL,      ctcm_chx_fail  },
1860
1861         { CTC_STATE_STARTRETRY, CTC_EVENT_STOP,         ctcm_chx_haltio  },
1862         { CTC_STATE_STARTRETRY, CTC_EVENT_TIMER,        ctcm_chx_setmode  },
1863         { CTC_STATE_STARTRETRY, CTC_EVENT_FINSTAT,      ctcm_chx_setmode  },
1864         { CTC_STATE_STARTRETRY, CTC_EVENT_MC_FAIL,      ctcm_chx_fail  },
1865         { CTC_STATE_STARTRETRY, CTC_EVENT_IO_ENODEV,    ctcm_chx_iofatal  },
1866
1867         { CTC_STATE_SETUPWAIT,  CTC_EVENT_STOP,         ctcm_chx_haltio  },
1868         { CTC_STATE_SETUPWAIT,  CTC_EVENT_START,        ctcm_action_nop  },
1869         { CTC_STATE_SETUPWAIT,  CTC_EVENT_FINSTAT,      ctcmpc_chx_firstio  },
1870         { CTC_STATE_SETUPWAIT,  CTC_EVENT_UC_RCRESET,   ctcm_chx_setuperr  },
1871         { CTC_STATE_SETUPWAIT,  CTC_EVENT_UC_RSRESET,   ctcm_chx_setuperr  },
1872         { CTC_STATE_SETUPWAIT,  CTC_EVENT_TIMER,        ctcm_chx_setmode  },
1873         { CTC_STATE_SETUPWAIT,  CTC_EVENT_IO_ENODEV,    ctcm_chx_iofatal  },
1874         { CTC_STATE_SETUPWAIT,  CTC_EVENT_MC_FAIL,      ctcm_chx_fail  },
1875
1876         { CTC_STATE_RXINIT,     CTC_EVENT_STOP,         ctcm_chx_haltio  },
1877         { CTC_STATE_RXINIT,     CTC_EVENT_START,        ctcm_action_nop  },
1878         { CTC_STATE_RXINIT,     CTC_EVENT_FINSTAT,      ctcmpc_chx_rxidle  },
1879         { CTC_STATE_RXINIT,     CTC_EVENT_UC_RCRESET,   ctcm_chx_rxiniterr  },
1880         { CTC_STATE_RXINIT,     CTC_EVENT_UC_RSRESET,   ctcm_chx_rxiniterr  },
1881         { CTC_STATE_RXINIT,     CTC_EVENT_TIMER,        ctcm_chx_rxiniterr  },
1882         { CTC_STATE_RXINIT,     CTC_EVENT_ATTNBUSY,     ctcm_chx_rxinitfail  },
1883         { CTC_STATE_RXINIT,     CTC_EVENT_IO_ENODEV,    ctcm_chx_iofatal  },
1884         { CTC_STATE_RXINIT,     CTC_EVENT_UC_ZERO,      ctcmpc_chx_firstio  },
1885         { CTC_STATE_RXINIT,     CTC_EVENT_MC_FAIL,      ctcm_chx_fail  },
1886
1887         { CH_XID0_PENDING,      CTC_EVENT_FINSTAT,      ctcm_action_nop  },
1888         { CH_XID0_PENDING,      CTC_EVENT_ATTN,         ctcmpc_chx_attn  },
1889         { CH_XID0_PENDING,      CTC_EVENT_STOP,         ctcm_chx_haltio  },
1890         { CH_XID0_PENDING,      CTC_EVENT_START,        ctcm_action_nop  },
1891         { CH_XID0_PENDING,      CTC_EVENT_IO_ENODEV,    ctcm_chx_iofatal  },
1892         { CH_XID0_PENDING,      CTC_EVENT_MC_FAIL,      ctcm_chx_fail  },
1893         { CH_XID0_PENDING,      CTC_EVENT_UC_RCRESET,   ctcm_chx_setuperr  },
1894         { CH_XID0_PENDING,      CTC_EVENT_UC_RSRESET,   ctcm_chx_setuperr  },
1895         { CH_XID0_PENDING,      CTC_EVENT_UC_RSRESET,   ctcm_chx_setuperr  },
1896         { CH_XID0_PENDING,      CTC_EVENT_ATTNBUSY,     ctcm_chx_iofatal  },
1897
1898         { CH_XID0_INPROGRESS,   CTC_EVENT_FINSTAT,      ctcmpc_chx_rx  },
1899         { CH_XID0_INPROGRESS,   CTC_EVENT_ATTN,         ctcmpc_chx_attn  },
1900         { CH_XID0_INPROGRESS,   CTC_EVENT_STOP,         ctcm_chx_haltio  },
1901         { CH_XID0_INPROGRESS,   CTC_EVENT_START,        ctcm_action_nop  },
1902         { CH_XID0_INPROGRESS,   CTC_EVENT_IO_ENODEV,    ctcm_chx_iofatal  },
1903         { CH_XID0_INPROGRESS,   CTC_EVENT_MC_FAIL,      ctcm_chx_fail  },
1904         { CH_XID0_INPROGRESS,   CTC_EVENT_UC_ZERO,      ctcmpc_chx_rx  },
1905         { CH_XID0_INPROGRESS,   CTC_EVENT_UC_RCRESET,   ctcm_chx_setuperr },
1906         { CH_XID0_INPROGRESS,   CTC_EVENT_ATTNBUSY,     ctcmpc_chx_attnbusy  },
1907         { CH_XID0_INPROGRESS,   CTC_EVENT_TIMER,        ctcmpc_chx_resend  },
1908         { CH_XID0_INPROGRESS,   CTC_EVENT_IO_EBUSY,     ctcm_chx_fail  },
1909
1910         { CH_XID7_PENDING,      CTC_EVENT_FINSTAT,      ctcmpc_chx_rx  },
1911         { CH_XID7_PENDING,      CTC_EVENT_ATTN,         ctcmpc_chx_attn  },
1912         { CH_XID7_PENDING,      CTC_EVENT_STOP,         ctcm_chx_haltio  },
1913         { CH_XID7_PENDING,      CTC_EVENT_START,        ctcm_action_nop  },
1914         { CH_XID7_PENDING,      CTC_EVENT_IO_ENODEV,    ctcm_chx_iofatal  },
1915         { CH_XID7_PENDING,      CTC_EVENT_MC_FAIL,      ctcm_chx_fail  },
1916         { CH_XID7_PENDING,      CTC_EVENT_UC_ZERO,      ctcmpc_chx_rx  },
1917         { CH_XID7_PENDING,      CTC_EVENT_UC_RCRESET,   ctcm_chx_setuperr  },
1918         { CH_XID7_PENDING,      CTC_EVENT_UC_RSRESET,   ctcm_chx_setuperr  },
1919         { CH_XID7_PENDING,      CTC_EVENT_UC_RSRESET,   ctcm_chx_setuperr  },
1920         { CH_XID7_PENDING,      CTC_EVENT_ATTNBUSY,     ctcm_chx_iofatal  },
1921         { CH_XID7_PENDING,      CTC_EVENT_TIMER,        ctcmpc_chx_resend  },
1922         { CH_XID7_PENDING,      CTC_EVENT_IO_EBUSY,     ctcm_chx_fail  },
1923
1924         { CH_XID7_PENDING1,     CTC_EVENT_FINSTAT,      ctcmpc_chx_rx  },
1925         { CH_XID7_PENDING1,     CTC_EVENT_ATTN,         ctcmpc_chx_attn  },
1926         { CH_XID7_PENDING1,     CTC_EVENT_STOP,         ctcm_chx_haltio  },
1927         { CH_XID7_PENDING1,     CTC_EVENT_START,        ctcm_action_nop  },
1928         { CH_XID7_PENDING1,     CTC_EVENT_IO_ENODEV,    ctcm_chx_iofatal  },
1929         { CH_XID7_PENDING1,     CTC_EVENT_MC_FAIL,      ctcm_chx_fail  },
1930         { CH_XID7_PENDING1,     CTC_EVENT_UC_ZERO,      ctcmpc_chx_rx  },
1931         { CH_XID7_PENDING1,     CTC_EVENT_UC_RCRESET,   ctcm_chx_setuperr  },
1932         { CH_XID7_PENDING1,     CTC_EVENT_UC_RSRESET,   ctcm_chx_setuperr  },
1933         { CH_XID7_PENDING1,     CTC_EVENT_ATTNBUSY,     ctcm_chx_iofatal  },
1934         { CH_XID7_PENDING1,     CTC_EVENT_TIMER,        ctcmpc_chx_resend  },
1935         { CH_XID7_PENDING1,     CTC_EVENT_IO_EBUSY,     ctcm_chx_fail  },
1936
1937         { CH_XID7_PENDING2,     CTC_EVENT_FINSTAT,      ctcmpc_chx_rx  },
1938         { CH_XID7_PENDING2,     CTC_EVENT_ATTN,         ctcmpc_chx_attn  },
1939         { CH_XID7_PENDING2,     CTC_EVENT_STOP,         ctcm_chx_haltio  },
1940         { CH_XID7_PENDING2,     CTC_EVENT_START,        ctcm_action_nop  },
1941         { CH_XID7_PENDING2,     CTC_EVENT_IO_ENODEV,    ctcm_chx_iofatal  },
1942         { CH_XID7_PENDING2,     CTC_EVENT_MC_FAIL,      ctcm_chx_fail  },
1943         { CH_XID7_PENDING2,     CTC_EVENT_UC_ZERO,      ctcmpc_chx_rx  },
1944         { CH_XID7_PENDING2,     CTC_EVENT_UC_RCRESET,   ctcm_chx_setuperr  },
1945         { CH_XID7_PENDING2,     CTC_EVENT_UC_RSRESET,   ctcm_chx_setuperr  },
1946         { CH_XID7_PENDING2,     CTC_EVENT_ATTNBUSY,     ctcm_chx_iofatal  },
1947         { CH_XID7_PENDING2,     CTC_EVENT_TIMER,        ctcmpc_chx_resend  },
1948         { CH_XID7_PENDING2,     CTC_EVENT_IO_EBUSY,     ctcm_chx_fail  },
1949
1950         { CH_XID7_PENDING3,     CTC_EVENT_FINSTAT,      ctcmpc_chx_rx  },
1951         { CH_XID7_PENDING3,     CTC_EVENT_ATTN,         ctcmpc_chx_attn  },
1952         { CH_XID7_PENDING3,     CTC_EVENT_STOP,         ctcm_chx_haltio  },
1953         { CH_XID7_PENDING3,     CTC_EVENT_START,        ctcm_action_nop  },
1954         { CH_XID7_PENDING3,     CTC_EVENT_IO_ENODEV,    ctcm_chx_iofatal  },
1955         { CH_XID7_PENDING3,     CTC_EVENT_MC_FAIL,      ctcm_chx_fail  },
1956         { CH_XID7_PENDING3,     CTC_EVENT_UC_ZERO,      ctcmpc_chx_rx  },
1957         { CH_XID7_PENDING3,     CTC_EVENT_UC_RCRESET,   ctcm_chx_setuperr  },
1958         { CH_XID7_PENDING3,     CTC_EVENT_UC_RSRESET,   ctcm_chx_setuperr  },
1959         { CH_XID7_PENDING3,     CTC_EVENT_ATTNBUSY,     ctcm_chx_iofatal  },
1960         { CH_XID7_PENDING3,     CTC_EVENT_TIMER,        ctcmpc_chx_resend  },
1961         { CH_XID7_PENDING3,     CTC_EVENT_IO_EBUSY,     ctcm_chx_fail  },
1962
1963         { CH_XID7_PENDING4,     CTC_EVENT_FINSTAT,      ctcmpc_chx_rx  },
1964         { CH_XID7_PENDING4,     CTC_EVENT_ATTN,         ctcmpc_chx_attn  },
1965         { CH_XID7_PENDING4,     CTC_EVENT_STOP,         ctcm_chx_haltio  },
1966         { CH_XID7_PENDING4,     CTC_EVENT_START,        ctcm_action_nop  },
1967         { CH_XID7_PENDING4,     CTC_EVENT_IO_ENODEV,    ctcm_chx_iofatal  },
1968         { CH_XID7_PENDING4,     CTC_EVENT_MC_FAIL,      ctcm_chx_fail  },
1969         { CH_XID7_PENDING4,     CTC_EVENT_UC_ZERO,      ctcmpc_chx_rx  },
1970         { CH_XID7_PENDING4,     CTC_EVENT_UC_RCRESET,   ctcm_chx_setuperr  },
1971         { CH_XID7_PENDING4,     CTC_EVENT_UC_RSRESET,   ctcm_chx_setuperr  },
1972         { CH_XID7_PENDING4,     CTC_EVENT_ATTNBUSY,     ctcm_chx_iofatal  },
1973         { CH_XID7_PENDING4,     CTC_EVENT_TIMER,        ctcmpc_chx_resend  },
1974         { CH_XID7_PENDING4,     CTC_EVENT_IO_EBUSY,     ctcm_chx_fail  },
1975
1976         { CTC_STATE_RXIDLE,     CTC_EVENT_STOP,         ctcm_chx_haltio  },
1977         { CTC_STATE_RXIDLE,     CTC_EVENT_START,        ctcm_action_nop  },
1978         { CTC_STATE_RXIDLE,     CTC_EVENT_FINSTAT,      ctcmpc_chx_rx  },
1979         { CTC_STATE_RXIDLE,     CTC_EVENT_UC_RCRESET,   ctcm_chx_rxdisc  },
1980         { CTC_STATE_RXIDLE,     CTC_EVENT_UC_RSRESET,   ctcm_chx_fail  },
1981         { CTC_STATE_RXIDLE,     CTC_EVENT_IO_ENODEV,    ctcm_chx_iofatal  },
1982         { CTC_STATE_RXIDLE,     CTC_EVENT_MC_FAIL,      ctcm_chx_fail  },
1983         { CTC_STATE_RXIDLE,     CTC_EVENT_UC_ZERO,      ctcmpc_chx_rx  },
1984
1985         { CTC_STATE_TXINIT,     CTC_EVENT_STOP,         ctcm_chx_haltio  },
1986         { CTC_STATE_TXINIT,     CTC_EVENT_START,        ctcm_action_nop  },
1987         { CTC_STATE_TXINIT,     CTC_EVENT_FINSTAT,      ctcm_chx_txidle  },
1988         { CTC_STATE_TXINIT,     CTC_EVENT_UC_RCRESET,   ctcm_chx_txiniterr  },
1989         { CTC_STATE_TXINIT,     CTC_EVENT_UC_RSRESET,   ctcm_chx_txiniterr  },
1990         { CTC_STATE_TXINIT,     CTC_EVENT_TIMER,        ctcm_chx_txiniterr  },
1991         { CTC_STATE_TXINIT,     CTC_EVENT_IO_ENODEV,    ctcm_chx_iofatal  },
1992         { CTC_STATE_TXINIT,     CTC_EVENT_MC_FAIL,      ctcm_chx_fail  },
1993         { CTC_STATE_TXINIT,     CTC_EVENT_RSWEEP_TIMER, ctcmpc_chx_send_sweep },
1994
1995         { CTC_STATE_TXIDLE,     CTC_EVENT_STOP,         ctcm_chx_haltio  },
1996         { CTC_STATE_TXIDLE,     CTC_EVENT_START,        ctcm_action_nop  },
1997         { CTC_STATE_TXIDLE,     CTC_EVENT_FINSTAT,      ctcmpc_chx_firstio  },
1998         { CTC_STATE_TXIDLE,     CTC_EVENT_UC_RCRESET,   ctcm_chx_fail  },
1999         { CTC_STATE_TXIDLE,     CTC_EVENT_UC_RSRESET,   ctcm_chx_fail  },
2000         { CTC_STATE_TXIDLE,     CTC_EVENT_IO_ENODEV,    ctcm_chx_iofatal  },
2001         { CTC_STATE_TXIDLE,     CTC_EVENT_MC_FAIL,      ctcm_chx_fail  },
2002         { CTC_STATE_TXIDLE,     CTC_EVENT_RSWEEP_TIMER, ctcmpc_chx_send_sweep },
2003
2004         { CTC_STATE_TERM,       CTC_EVENT_STOP,         ctcm_action_nop  },
2005         { CTC_STATE_TERM,       CTC_EVENT_START,        ctcm_chx_restart  },
2006         { CTC_STATE_TERM,       CTC_EVENT_FINSTAT,      ctcm_chx_stopped  },
2007         { CTC_STATE_TERM,       CTC_EVENT_UC_RCRESET,   ctcm_action_nop  },
2008         { CTC_STATE_TERM,       CTC_EVENT_UC_RSRESET,   ctcm_action_nop  },
2009         { CTC_STATE_TERM,       CTC_EVENT_MC_FAIL,      ctcm_chx_fail  },
2010         { CTC_STATE_TERM,       CTC_EVENT_IO_EBUSY,     ctcm_chx_fail  },
2011         { CTC_STATE_TERM,       CTC_EVENT_IO_ENODEV,    ctcm_chx_iofatal  },
2012
2013         { CTC_STATE_DTERM,      CTC_EVENT_STOP,         ctcm_chx_haltio  },
2014         { CTC_STATE_DTERM,      CTC_EVENT_START,        ctcm_chx_restart  },
2015         { CTC_STATE_DTERM,      CTC_EVENT_FINSTAT,      ctcm_chx_setmode  },
2016         { CTC_STATE_DTERM,      CTC_EVENT_UC_RCRESET,   ctcm_action_nop  },
2017         { CTC_STATE_DTERM,      CTC_EVENT_UC_RSRESET,   ctcm_action_nop  },
2018         { CTC_STATE_DTERM,      CTC_EVENT_MC_FAIL,      ctcm_chx_fail  },
2019         { CTC_STATE_DTERM,      CTC_EVENT_IO_ENODEV,    ctcm_chx_iofatal  },
2020
2021         { CTC_STATE_TX,         CTC_EVENT_STOP,         ctcm_chx_haltio  },
2022         { CTC_STATE_TX,         CTC_EVENT_START,        ctcm_action_nop  },
2023         { CTC_STATE_TX,         CTC_EVENT_FINSTAT,      ctcmpc_chx_txdone  },
2024         { CTC_STATE_TX,         CTC_EVENT_UC_RCRESET,   ctcm_chx_fail  },
2025         { CTC_STATE_TX,         CTC_EVENT_UC_RSRESET,   ctcm_chx_fail  },
2026         { CTC_STATE_TX,         CTC_EVENT_TIMER,        ctcm_chx_txretry  },
2027         { CTC_STATE_TX,         CTC_EVENT_IO_ENODEV,    ctcm_chx_iofatal  },
2028         { CTC_STATE_TX,         CTC_EVENT_MC_FAIL,      ctcm_chx_fail  },
2029         { CTC_STATE_TX,         CTC_EVENT_RSWEEP_TIMER, ctcmpc_chx_send_sweep },
2030         { CTC_STATE_TX,         CTC_EVENT_IO_EBUSY,     ctcm_chx_fail  },
2031
2032         { CTC_STATE_RXERR,      CTC_EVENT_STOP,         ctcm_chx_haltio  },
2033         { CTC_STATE_TXERR,      CTC_EVENT_STOP,         ctcm_chx_haltio  },
2034         { CTC_STATE_TXERR,      CTC_EVENT_IO_ENODEV,    ctcm_chx_iofatal  },
2035         { CTC_STATE_TXERR,      CTC_EVENT_MC_FAIL,      ctcm_chx_fail  },
2036         { CTC_STATE_RXERR,      CTC_EVENT_MC_FAIL,      ctcm_chx_fail  },
2037 };
2038
2039 int mpc_ch_fsm_len = ARRAY_SIZE(ctcmpc_ch_fsm);
2040
2041 /*
2042  * Actions for interface - statemachine.
2043  */
2044
2045 /**
2046  * Startup channels by sending CTC_EVENT_START to each channel.
2047  *
2048  * fi           An instance of an interface statemachine.
2049  * event        The event, just happened.
2050  * arg          Generic pointer, casted from struct net_device * upon call.
2051  */
2052 static void dev_action_start(fsm_instance *fi, int event, void *arg)
2053 {
2054         struct net_device *dev = arg;
2055         struct ctcm_priv *priv = dev->ml_priv;
2056         int direction;
2057
2058         CTCMY_DBF_DEV_NAME(SETUP, dev, "");
2059
2060         fsm_deltimer(&priv->restart_timer);
2061         fsm_newstate(fi, DEV_STATE_STARTWAIT_RXTX);
2062         if (IS_MPC(priv))
2063                 priv->mpcg->channels_terminating = 0;
2064         for (direction = CTCM_READ; direction <= CTCM_WRITE; direction++) {
2065                 struct channel *ch = priv->channel[direction];
2066                 fsm_event(ch->fsm, CTC_EVENT_START, ch);
2067         }
2068 }
2069
2070 /**
2071  * Shutdown channels by sending CTC_EVENT_STOP to each channel.
2072  *
2073  * fi           An instance of an interface statemachine.
2074  * event        The event, just happened.
2075  * arg          Generic pointer, casted from struct net_device * upon call.
2076  */
2077 static void dev_action_stop(fsm_instance *fi, int event, void *arg)
2078 {
2079         int direction;
2080         struct net_device *dev = arg;
2081         struct ctcm_priv *priv = dev->ml_priv;
2082
2083         CTCMY_DBF_DEV_NAME(SETUP, dev, "");
2084
2085         fsm_newstate(fi, DEV_STATE_STOPWAIT_RXTX);
2086         for (direction = CTCM_READ; direction <= CTCM_WRITE; direction++) {
2087                 struct channel *ch = priv->channel[direction];
2088                 fsm_event(ch->fsm, CTC_EVENT_STOP, ch);
2089                 ch->th_seq_num = 0x00;
2090                 CTCM_PR_DEBUG("%s: CH_th_seq= %08x\n",
2091                                 __func__, ch->th_seq_num);
2092         }
2093         if (IS_MPC(priv))
2094                 fsm_newstate(priv->mpcg->fsm, MPCG_STATE_RESET);
2095 }
2096
2097 static void dev_action_restart(fsm_instance *fi, int event, void *arg)
2098 {
2099         int restart_timer;
2100         struct net_device *dev = arg;
2101         struct ctcm_priv *priv = dev->ml_priv;
2102
2103         CTCMY_DBF_DEV_NAME(TRACE, dev, "");
2104
2105         if (IS_MPC(priv)) {
2106                 restart_timer = CTCM_TIME_1_SEC;
2107         } else {
2108                 restart_timer = CTCM_TIME_5_SEC;
2109         }
2110         dev_info(&dev->dev, "Restarting device\n");
2111
2112         dev_action_stop(fi, event, arg);
2113         fsm_event(priv->fsm, DEV_EVENT_STOP, dev);
2114         if (IS_MPC(priv))
2115                 fsm_newstate(priv->mpcg->fsm, MPCG_STATE_RESET);
2116
2117         /* going back into start sequence too quickly can         */
2118         /* result in the other side becoming unreachable   due    */
2119         /* to sense reported when IO is aborted                   */
2120         fsm_addtimer(&priv->restart_timer, restart_timer,
2121                         DEV_EVENT_START, dev);
2122 }
2123
2124 /**
2125  * Called from channel statemachine
2126  * when a channel is up and running.
2127  *
2128  * fi           An instance of an interface statemachine.
2129  * event        The event, just happened.
2130  * arg          Generic pointer, casted from struct net_device * upon call.
2131  */
2132 static void dev_action_chup(fsm_instance *fi, int event, void *arg)
2133 {
2134         struct net_device *dev = arg;
2135         struct ctcm_priv *priv = dev->ml_priv;
2136         int dev_stat = fsm_getstate(fi);
2137
2138         CTCM_DBF_TEXT_(SETUP, CTC_DBF_NOTICE,
2139                         "%s(%s): priv = %p [%d,%d]\n ", CTCM_FUNTAIL,
2140                                 dev->name, dev->ml_priv, dev_stat, event);
2141
2142         switch (fsm_getstate(fi)) {
2143         case DEV_STATE_STARTWAIT_RXTX:
2144                 if (event == DEV_EVENT_RXUP)
2145                         fsm_newstate(fi, DEV_STATE_STARTWAIT_TX);
2146                 else
2147                         fsm_newstate(fi, DEV_STATE_STARTWAIT_RX);
2148                 break;
2149         case DEV_STATE_STARTWAIT_RX:
2150                 if (event == DEV_EVENT_RXUP) {
2151                         fsm_newstate(fi, DEV_STATE_RUNNING);
2152                         dev_info(&dev->dev,
2153                                 "Connected with remote side\n");
2154                         ctcm_clear_busy(dev);
2155                 }
2156                 break;
2157         case DEV_STATE_STARTWAIT_TX:
2158                 if (event == DEV_EVENT_TXUP) {
2159                         fsm_newstate(fi, DEV_STATE_RUNNING);
2160                         dev_info(&dev->dev,
2161                                 "Connected with remote side\n");
2162                         ctcm_clear_busy(dev);
2163                 }
2164                 break;
2165         case DEV_STATE_STOPWAIT_TX:
2166                 if (event == DEV_EVENT_RXUP)
2167                         fsm_newstate(fi, DEV_STATE_STOPWAIT_RXTX);
2168                 break;
2169         case DEV_STATE_STOPWAIT_RX:
2170                 if (event == DEV_EVENT_TXUP)
2171                         fsm_newstate(fi, DEV_STATE_STOPWAIT_RXTX);
2172                 break;
2173         }
2174
2175         if (IS_MPC(priv)) {
2176                 if (event == DEV_EVENT_RXUP)
2177                         mpc_channel_action(priv->channel[CTCM_READ],
2178                                 CTCM_READ, MPC_CHANNEL_ADD);
2179                 else
2180                         mpc_channel_action(priv->channel[CTCM_WRITE],
2181                                 CTCM_WRITE, MPC_CHANNEL_ADD);
2182         }
2183 }
2184
2185 /**
2186  * Called from device statemachine
2187  * when a channel has been shutdown.
2188  *
2189  * fi           An instance of an interface statemachine.
2190  * event        The event, just happened.
2191  * arg          Generic pointer, casted from struct net_device * upon call.
2192  */
2193 static void dev_action_chdown(fsm_instance *fi, int event, void *arg)
2194 {
2195
2196         struct net_device *dev = arg;
2197         struct ctcm_priv *priv = dev->ml_priv;
2198
2199         CTCMY_DBF_DEV_NAME(SETUP, dev, "");
2200
2201         switch (fsm_getstate(fi)) {
2202         case DEV_STATE_RUNNING:
2203                 if (event == DEV_EVENT_TXDOWN)
2204                         fsm_newstate(fi, DEV_STATE_STARTWAIT_TX);
2205                 else
2206                         fsm_newstate(fi, DEV_STATE_STARTWAIT_RX);
2207                 break;
2208         case DEV_STATE_STARTWAIT_RX:
2209                 if (event == DEV_EVENT_TXDOWN)
2210                         fsm_newstate(fi, DEV_STATE_STARTWAIT_RXTX);
2211                 break;
2212         case DEV_STATE_STARTWAIT_TX:
2213                 if (event == DEV_EVENT_RXDOWN)
2214                         fsm_newstate(fi, DEV_STATE_STARTWAIT_RXTX);
2215                 break;
2216         case DEV_STATE_STOPWAIT_RXTX:
2217                 if (event == DEV_EVENT_TXDOWN)
2218                         fsm_newstate(fi, DEV_STATE_STOPWAIT_RX);
2219                 else
2220                         fsm_newstate(fi, DEV_STATE_STOPWAIT_TX);
2221                 break;
2222         case DEV_STATE_STOPWAIT_RX:
2223                 if (event == DEV_EVENT_RXDOWN)
2224                         fsm_newstate(fi, DEV_STATE_STOPPED);
2225                 break;
2226         case DEV_STATE_STOPWAIT_TX:
2227                 if (event == DEV_EVENT_TXDOWN)
2228                         fsm_newstate(fi, DEV_STATE_STOPPED);
2229                 break;
2230         }
2231         if (IS_MPC(priv)) {
2232                 if (event == DEV_EVENT_RXDOWN)
2233                         mpc_channel_action(priv->channel[CTCM_READ],
2234                                 CTCM_READ, MPC_CHANNEL_REMOVE);
2235                 else
2236                         mpc_channel_action(priv->channel[CTCM_WRITE],
2237                                 CTCM_WRITE, MPC_CHANNEL_REMOVE);
2238         }
2239 }
2240
2241 const fsm_node dev_fsm[] = {
2242         { DEV_STATE_STOPPED,        DEV_EVENT_START,   dev_action_start   },
2243         { DEV_STATE_STOPWAIT_RXTX,  DEV_EVENT_START,   dev_action_start   },
2244         { DEV_STATE_STOPWAIT_RXTX,  DEV_EVENT_RXDOWN,  dev_action_chdown  },
2245         { DEV_STATE_STOPWAIT_RXTX,  DEV_EVENT_TXDOWN,  dev_action_chdown  },
2246         { DEV_STATE_STOPWAIT_RXTX,  DEV_EVENT_RESTART, dev_action_restart },
2247         { DEV_STATE_STOPWAIT_RX,    DEV_EVENT_START,   dev_action_start   },
2248         { DEV_STATE_STOPWAIT_RX,    DEV_EVENT_RXUP,    dev_action_chup    },
2249         { DEV_STATE_STOPWAIT_RX,    DEV_EVENT_TXUP,    dev_action_chup    },
2250         { DEV_STATE_STOPWAIT_RX,    DEV_EVENT_RXDOWN,  dev_action_chdown  },
2251         { DEV_STATE_STOPWAIT_RX,    DEV_EVENT_RESTART, dev_action_restart },
2252         { DEV_STATE_STOPWAIT_TX,    DEV_EVENT_START,   dev_action_start   },
2253         { DEV_STATE_STOPWAIT_TX,    DEV_EVENT_RXUP,    dev_action_chup    },
2254         { DEV_STATE_STOPWAIT_TX,    DEV_EVENT_TXUP,    dev_action_chup    },
2255         { DEV_STATE_STOPWAIT_TX,    DEV_EVENT_TXDOWN,  dev_action_chdown  },
2256         { DEV_STATE_STOPWAIT_TX,    DEV_EVENT_RESTART, dev_action_restart },
2257         { DEV_STATE_STARTWAIT_RXTX, DEV_EVENT_STOP,    dev_action_stop    },
2258         { DEV_STATE_STARTWAIT_RXTX, DEV_EVENT_RXUP,    dev_action_chup    },
2259         { DEV_STATE_STARTWAIT_RXTX, DEV_EVENT_TXUP,    dev_action_chup    },
2260         { DEV_STATE_STARTWAIT_RXTX, DEV_EVENT_RXDOWN,  dev_action_chdown  },
2261         { DEV_STATE_STARTWAIT_RXTX, DEV_EVENT_TXDOWN,  dev_action_chdown  },
2262         { DEV_STATE_STARTWAIT_RXTX, DEV_EVENT_RESTART, dev_action_restart },
2263         { DEV_STATE_STARTWAIT_TX,   DEV_EVENT_STOP,    dev_action_stop    },
2264         { DEV_STATE_STARTWAIT_TX,   DEV_EVENT_RXUP,    dev_action_chup    },
2265         { DEV_STATE_STARTWAIT_TX,   DEV_EVENT_TXUP,    dev_action_chup    },
2266         { DEV_STATE_STARTWAIT_TX,   DEV_EVENT_RXDOWN,  dev_action_chdown  },
2267         { DEV_STATE_STARTWAIT_TX,   DEV_EVENT_RESTART, dev_action_restart },
2268         { DEV_STATE_STARTWAIT_RX,   DEV_EVENT_STOP,    dev_action_stop    },
2269         { DEV_STATE_STARTWAIT_RX,   DEV_EVENT_RXUP,    dev_action_chup    },
2270         { DEV_STATE_STARTWAIT_RX,   DEV_EVENT_TXUP,    dev_action_chup    },
2271         { DEV_STATE_STARTWAIT_RX,   DEV_EVENT_TXDOWN,  dev_action_chdown  },
2272         { DEV_STATE_STARTWAIT_RX,   DEV_EVENT_RESTART, dev_action_restart },
2273         { DEV_STATE_RUNNING,        DEV_EVENT_STOP,    dev_action_stop    },
2274         { DEV_STATE_RUNNING,        DEV_EVENT_RXDOWN,  dev_action_chdown  },
2275         { DEV_STATE_RUNNING,        DEV_EVENT_TXDOWN,  dev_action_chdown  },
2276         { DEV_STATE_RUNNING,        DEV_EVENT_TXUP,    ctcm_action_nop    },
2277         { DEV_STATE_RUNNING,        DEV_EVENT_RXUP,    ctcm_action_nop    },
2278         { DEV_STATE_RUNNING,        DEV_EVENT_RESTART, dev_action_restart },
2279 };
2280
2281 int dev_fsm_len = ARRAY_SIZE(dev_fsm);
2282
2283 /* --- This is the END my friend --- */
2284