^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) // SPDX-License-Identifier: GPL-2.0-only
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) * Author Karsten Keil <kkeil@novell.com>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) * Copyright 2008 by Karsten Keil <kkeil@novell.com>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) #include <linux/slab.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) #include <linux/mISDNhw.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) #include "core.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) #include "layer1.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) #include "fsm.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) static u_int *debug;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) struct layer1 {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) u_long Flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) struct FsmInst l1m;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) struct FsmTimer timer3;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) struct FsmTimer timerX;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) int delay;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) int t3_value;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) struct dchannel *dch;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) dchannel_l1callback *dcb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) #define TIMER3_DEFAULT_VALUE 7000
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) static
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) struct Fsm l1fsm_s = {NULL, 0, 0, NULL, NULL};
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) enum {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) ST_L1_F2,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) ST_L1_F3,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) ST_L1_F4,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) ST_L1_F5,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) ST_L1_F6,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) ST_L1_F7,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) ST_L1_F8,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) #define L1S_STATE_COUNT (ST_L1_F8 + 1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) static char *strL1SState[] =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) "ST_L1_F2",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) "ST_L1_F3",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) "ST_L1_F4",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) "ST_L1_F5",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) "ST_L1_F6",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) "ST_L1_F7",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) "ST_L1_F8",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) enum {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) EV_PH_ACTIVATE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) EV_PH_DEACTIVATE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) EV_RESET_IND,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) EV_DEACT_CNF,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) EV_DEACT_IND,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) EV_POWER_UP,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) EV_ANYSIG_IND,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) EV_INFO2_IND,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) EV_INFO4_IND,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) EV_TIMER_DEACT,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) EV_TIMER_ACT,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) EV_TIMER3,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) #define L1_EVENT_COUNT (EV_TIMER3 + 1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) static char *strL1Event[] =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) "EV_PH_ACTIVATE",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) "EV_PH_DEACTIVATE",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) "EV_RESET_IND",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) "EV_DEACT_CNF",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) "EV_DEACT_IND",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) "EV_POWER_UP",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) "EV_ANYSIG_IND",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) "EV_INFO2_IND",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) "EV_INFO4_IND",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) "EV_TIMER_DEACT",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) "EV_TIMER_ACT",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) "EV_TIMER3",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) static void
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92) l1m_debug(struct FsmInst *fi, char *fmt, ...)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) struct layer1 *l1 = fi->userdata;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) struct va_format vaf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96) va_list va;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98) va_start(va, fmt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) vaf.fmt = fmt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) vaf.va = &va;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) printk(KERN_DEBUG "%s: %pV\n", dev_name(&l1->dch->dev.dev), &vaf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) va_end(va);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) static void
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) l1_reset(struct FsmInst *fi, int event, void *arg)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) mISDN_FsmChangeState(fi, ST_L1_F3);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) static void
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) l1_deact_cnf(struct FsmInst *fi, int event, void *arg)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) struct layer1 *l1 = fi->userdata;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) mISDN_FsmChangeState(fi, ST_L1_F3);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) if (test_bit(FLG_L1_ACTIVATING, &l1->Flags))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) l1->dcb(l1->dch, HW_POWERUP_REQ);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) static void
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) l1_deact_req_s(struct FsmInst *fi, int event, void *arg)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) struct layer1 *l1 = fi->userdata;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) mISDN_FsmChangeState(fi, ST_L1_F3);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) mISDN_FsmRestartTimer(&l1->timerX, 550, EV_TIMER_DEACT, NULL, 2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) test_and_set_bit(FLG_L1_DEACTTIMER, &l1->Flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) static void
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) l1_power_up_s(struct FsmInst *fi, int event, void *arg)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) struct layer1 *l1 = fi->userdata;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) if (test_bit(FLG_L1_ACTIVATING, &l1->Flags)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) mISDN_FsmChangeState(fi, ST_L1_F4);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) l1->dcb(l1->dch, INFO3_P8);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) } else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) mISDN_FsmChangeState(fi, ST_L1_F3);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) static void
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) l1_go_F5(struct FsmInst *fi, int event, void *arg)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) mISDN_FsmChangeState(fi, ST_L1_F5);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) static void
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) l1_go_F8(struct FsmInst *fi, int event, void *arg)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) mISDN_FsmChangeState(fi, ST_L1_F8);
^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 void
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) l1_info2_ind(struct FsmInst *fi, int event, void *arg)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) struct layer1 *l1 = fi->userdata;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) mISDN_FsmChangeState(fi, ST_L1_F6);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) l1->dcb(l1->dch, INFO3_P8);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) static void
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) l1_info4_ind(struct FsmInst *fi, int event, void *arg)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) struct layer1 *l1 = fi->userdata;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) mISDN_FsmChangeState(fi, ST_L1_F7);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) l1->dcb(l1->dch, INFO3_P8);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) if (test_and_clear_bit(FLG_L1_DEACTTIMER, &l1->Flags))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) mISDN_FsmDelTimer(&l1->timerX, 4);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) if (!test_bit(FLG_L1_ACTIVATED, &l1->Flags)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) if (test_and_clear_bit(FLG_L1_T3RUN, &l1->Flags))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) mISDN_FsmDelTimer(&l1->timer3, 3);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) mISDN_FsmRestartTimer(&l1->timerX, 110, EV_TIMER_ACT, NULL, 2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) test_and_set_bit(FLG_L1_ACTTIMER, &l1->Flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) static void
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) l1_timer3(struct FsmInst *fi, int event, void *arg)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) struct layer1 *l1 = fi->userdata;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) test_and_clear_bit(FLG_L1_T3RUN, &l1->Flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) if (test_and_clear_bit(FLG_L1_ACTIVATING, &l1->Flags)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) if (test_and_clear_bit(FLG_L1_DBLOCKED, &l1->Flags))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) l1->dcb(l1->dch, HW_D_NOBLOCKED);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) l1->dcb(l1->dch, PH_DEACTIVATE_IND);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) if (l1->l1m.state != ST_L1_F6) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) mISDN_FsmChangeState(fi, ST_L1_F3);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) /* do not force anything here, we need send INFO 0 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) static void
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) l1_timer_act(struct FsmInst *fi, int event, void *arg)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) struct layer1 *l1 = fi->userdata;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) test_and_clear_bit(FLG_L1_ACTTIMER, &l1->Flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) test_and_set_bit(FLG_L1_ACTIVATED, &l1->Flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) l1->dcb(l1->dch, PH_ACTIVATE_IND);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) static void
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) l1_timer_deact(struct FsmInst *fi, int event, void *arg)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) struct layer1 *l1 = fi->userdata;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) test_and_clear_bit(FLG_L1_DEACTTIMER, &l1->Flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) test_and_clear_bit(FLG_L1_ACTIVATED, &l1->Flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) if (test_and_clear_bit(FLG_L1_DBLOCKED, &l1->Flags))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) l1->dcb(l1->dch, HW_D_NOBLOCKED);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) l1->dcb(l1->dch, PH_DEACTIVATE_IND);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) l1->dcb(l1->dch, HW_DEACT_REQ);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224) static void
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) l1_activate_s(struct FsmInst *fi, int event, void *arg)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) struct layer1 *l1 = fi->userdata;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) mISDN_FsmRestartTimer(&l1->timer3, l1->t3_value, EV_TIMER3, NULL, 2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) test_and_set_bit(FLG_L1_T3RUN, &l1->Flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) /* Tell HW to send INFO 1 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) l1->dcb(l1->dch, HW_RESET_REQ);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) static void
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236) l1_activate_no(struct FsmInst *fi, int event, void *arg)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) struct layer1 *l1 = fi->userdata;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) if ((!test_bit(FLG_L1_DEACTTIMER, &l1->Flags)) &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) (!test_bit(FLG_L1_T3RUN, &l1->Flags))) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) test_and_clear_bit(FLG_L1_ACTIVATING, &l1->Flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) if (test_and_clear_bit(FLG_L1_DBLOCKED, &l1->Flags))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) l1->dcb(l1->dch, HW_D_NOBLOCKED);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) l1->dcb(l1->dch, PH_DEACTIVATE_IND);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) static struct FsmNode L1SFnList[] =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) {ST_L1_F3, EV_PH_ACTIVATE, l1_activate_s},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) {ST_L1_F6, EV_PH_ACTIVATE, l1_activate_no},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) {ST_L1_F8, EV_PH_ACTIVATE, l1_activate_no},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) {ST_L1_F3, EV_RESET_IND, l1_reset},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255) {ST_L1_F4, EV_RESET_IND, l1_reset},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) {ST_L1_F5, EV_RESET_IND, l1_reset},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) {ST_L1_F6, EV_RESET_IND, l1_reset},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) {ST_L1_F7, EV_RESET_IND, l1_reset},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) {ST_L1_F8, EV_RESET_IND, l1_reset},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) {ST_L1_F3, EV_DEACT_CNF, l1_deact_cnf},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261) {ST_L1_F4, EV_DEACT_CNF, l1_deact_cnf},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) {ST_L1_F5, EV_DEACT_CNF, l1_deact_cnf},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) {ST_L1_F6, EV_DEACT_CNF, l1_deact_cnf},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) {ST_L1_F7, EV_DEACT_CNF, l1_deact_cnf},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) {ST_L1_F8, EV_DEACT_CNF, l1_deact_cnf},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) {ST_L1_F6, EV_DEACT_IND, l1_deact_req_s},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) {ST_L1_F7, EV_DEACT_IND, l1_deact_req_s},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) {ST_L1_F8, EV_DEACT_IND, l1_deact_req_s},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) {ST_L1_F3, EV_POWER_UP, l1_power_up_s},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) {ST_L1_F4, EV_ANYSIG_IND, l1_go_F5},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) {ST_L1_F6, EV_ANYSIG_IND, l1_go_F8},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) {ST_L1_F7, EV_ANYSIG_IND, l1_go_F8},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) {ST_L1_F3, EV_INFO2_IND, l1_info2_ind},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) {ST_L1_F4, EV_INFO2_IND, l1_info2_ind},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) {ST_L1_F5, EV_INFO2_IND, l1_info2_ind},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) {ST_L1_F7, EV_INFO2_IND, l1_info2_ind},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) {ST_L1_F8, EV_INFO2_IND, l1_info2_ind},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) {ST_L1_F3, EV_INFO4_IND, l1_info4_ind},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279) {ST_L1_F4, EV_INFO4_IND, l1_info4_ind},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) {ST_L1_F5, EV_INFO4_IND, l1_info4_ind},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) {ST_L1_F6, EV_INFO4_IND, l1_info4_ind},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) {ST_L1_F8, EV_INFO4_IND, l1_info4_ind},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283) {ST_L1_F3, EV_TIMER3, l1_timer3},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) {ST_L1_F4, EV_TIMER3, l1_timer3},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) {ST_L1_F5, EV_TIMER3, l1_timer3},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) {ST_L1_F6, EV_TIMER3, l1_timer3},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287) {ST_L1_F8, EV_TIMER3, l1_timer3},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288) {ST_L1_F7, EV_TIMER_ACT, l1_timer_act},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289) {ST_L1_F3, EV_TIMER_DEACT, l1_timer_deact},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290) {ST_L1_F4, EV_TIMER_DEACT, l1_timer_deact},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291) {ST_L1_F5, EV_TIMER_DEACT, l1_timer_deact},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292) {ST_L1_F6, EV_TIMER_DEACT, l1_timer_deact},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293) {ST_L1_F7, EV_TIMER_DEACT, l1_timer_deact},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) {ST_L1_F8, EV_TIMER_DEACT, l1_timer_deact},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297) static void
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298) release_l1(struct layer1 *l1) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299) mISDN_FsmDelTimer(&l1->timerX, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300) mISDN_FsmDelTimer(&l1->timer3, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301) if (l1->dch)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302) l1->dch->l1 = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303) module_put(THIS_MODULE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304) kfree(l1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307) int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308) l1_event(struct layer1 *l1, u_int event)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310) int err = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312) if (!l1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314) switch (event) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315) case HW_RESET_IND:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316) mISDN_FsmEvent(&l1->l1m, EV_RESET_IND, NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318) case HW_DEACT_IND:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319) mISDN_FsmEvent(&l1->l1m, EV_DEACT_IND, NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321) case HW_POWERUP_IND:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322) mISDN_FsmEvent(&l1->l1m, EV_POWER_UP, NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324) case HW_DEACT_CNF:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325) mISDN_FsmEvent(&l1->l1m, EV_DEACT_CNF, NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327) case ANYSIGNAL:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328) mISDN_FsmEvent(&l1->l1m, EV_ANYSIG_IND, NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330) case LOSTFRAMING:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331) mISDN_FsmEvent(&l1->l1m, EV_ANYSIG_IND, NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333) case INFO2:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334) mISDN_FsmEvent(&l1->l1m, EV_INFO2_IND, NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336) case INFO4_P8:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337) mISDN_FsmEvent(&l1->l1m, EV_INFO4_IND, NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339) case INFO4_P10:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340) mISDN_FsmEvent(&l1->l1m, EV_INFO4_IND, NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342) case PH_ACTIVATE_REQ:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343) if (test_bit(FLG_L1_ACTIVATED, &l1->Flags))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344) l1->dcb(l1->dch, PH_ACTIVATE_IND);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345) else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346) test_and_set_bit(FLG_L1_ACTIVATING, &l1->Flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347) mISDN_FsmEvent(&l1->l1m, EV_PH_ACTIVATE, NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350) case CLOSE_CHANNEL:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351) release_l1(l1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354) if ((event & ~HW_TIMER3_VMASK) == HW_TIMER3_VALUE) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355) int val = event & HW_TIMER3_VMASK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357) if (val < 5)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358) val = 5;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 359) if (val > 30)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 360) val = 30;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 361) l1->t3_value = val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 362) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 363) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 364) if (*debug & DEBUG_L1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 365) printk(KERN_DEBUG "%s %x unhandled\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 366) __func__, event);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 367) err = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 368) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 369) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 370) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 371) EXPORT_SYMBOL(l1_event);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 372)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 373) int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 374) create_l1(struct dchannel *dch, dchannel_l1callback *dcb) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 375) struct layer1 *nl1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 376)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 377) nl1 = kzalloc(sizeof(struct layer1), GFP_ATOMIC);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 378) if (!nl1) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 379) printk(KERN_ERR "kmalloc struct layer1 failed\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 380) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 381) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 382) nl1->l1m.fsm = &l1fsm_s;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 383) nl1->l1m.state = ST_L1_F3;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 384) nl1->Flags = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 385) nl1->t3_value = TIMER3_DEFAULT_VALUE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 386) nl1->l1m.debug = *debug & DEBUG_L1_FSM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 387) nl1->l1m.userdata = nl1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 388) nl1->l1m.userint = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 389) nl1->l1m.printdebug = l1m_debug;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 390) nl1->dch = dch;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 391) nl1->dcb = dcb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 392) mISDN_FsmInitTimer(&nl1->l1m, &nl1->timer3);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 393) mISDN_FsmInitTimer(&nl1->l1m, &nl1->timerX);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 394) __module_get(THIS_MODULE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 395) dch->l1 = nl1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 396) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 397) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 398) EXPORT_SYMBOL(create_l1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 399)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 400) int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 401) Isdnl1_Init(u_int *deb)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 402) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 403) debug = deb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 404) l1fsm_s.state_count = L1S_STATE_COUNT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 405) l1fsm_s.event_count = L1_EVENT_COUNT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 406) l1fsm_s.strEvent = strL1Event;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 407) l1fsm_s.strState = strL1SState;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 408) return mISDN_FsmNew(&l1fsm_s, L1SFnList, ARRAY_SIZE(L1SFnList));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 409) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 410)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 411) void
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 412) Isdnl1_cleanup(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 413) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 414) mISDN_FsmFree(&l1fsm_s);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 415) }
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags