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