^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) // SPDX-License-Identifier: GPL-2.0-or-later
^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) * (C)Copyright 1998,1999 SysKonnect,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) * a business unit of Schneider & Koch & Co. Datensysteme GmbH.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) * See the file "skfddi.c" for further information.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9) * The information in this file is provided "AS IS" without warranty.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) ******************************************************************************/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) SMT Event Queue Management
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) #include "h/types.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) #include "h/fddi.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) #include "h/smc.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) #ifndef lint
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) static const char ID_sccs[] = "@(#)queue.c 2.9 97/08/04 (C) SK " ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) #define PRINTF(a,b,c)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) * init event queue management
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) void ev_init(struct s_smc *smc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) smc->q.ev_put = smc->q.ev_get = smc->q.ev_queue ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) * add event to queue
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) void queue_event(struct s_smc *smc, int class, int event)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) PRINTF("queue class %d event %d\n",class,event) ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) smc->q.ev_put->class = class ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) smc->q.ev_put->event = event ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) if (++smc->q.ev_put == &smc->q.ev_queue[MAX_EVENT])
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) smc->q.ev_put = smc->q.ev_queue ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) if (smc->q.ev_put == smc->q.ev_get) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) SMT_ERR_LOG(smc,SMT_E0137, SMT_E0137_MSG) ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) * timer_event is called from HW timer package.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) void timer_event(struct s_smc *smc, u_long token)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) PRINTF("timer event class %d token %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) EV_T_CLASS(token),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) EV_T_EVENT(token)) ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) queue_event(smc,EV_T_CLASS(token),EV_T_EVENT(token));
^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) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) * event dispatcher
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) * while event queue is not empty
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) * get event from queue
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) * send command to state machine
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) * end
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) void ev_dispatcher(struct s_smc *smc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) struct event_queue *ev ; /* pointer into queue */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) int class ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) ev = smc->q.ev_get ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) PRINTF("dispatch get %x put %x\n",ev,smc->q.ev_put) ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) while (ev != smc->q.ev_put) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) PRINTF("dispatch class %d event %d\n",ev->class,ev->event) ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) switch(class = ev->class) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) case EVENT_ECM : /* Entity Corordination Man. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) ecm(smc,(int)ev->event) ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) break ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) case EVENT_CFM : /* Configuration Man. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) cfm(smc,(int)ev->event) ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) break ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) case EVENT_RMT : /* Ring Man. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) rmt(smc,(int)ev->event) ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) break ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) case EVENT_SMT :
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) smt_event(smc,(int)ev->event) ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) break ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) #ifdef CONCENTRATOR
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92) case 99 :
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) timer_test_event(smc,(int)ev->event) ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) break ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96) case EVENT_PCMA : /* PHY A */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97) case EVENT_PCMB : /* PHY B */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98) default :
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99) if (class >= EVENT_PCMA &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) class < EVENT_PCMA + NUMPHYS) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) pcm(smc,class - EVENT_PCMA,(int)ev->event) ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) break ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) SMT_PANIC(smc,SMT_E0121, SMT_E0121_MSG) ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) return ;
^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) if (++ev == &smc->q.ev_queue[MAX_EVENT])
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) ev = smc->q.ev_queue ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) /* Renew get: it is used in queue_events to detect overruns */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) smc->q.ev_get = ev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) * smt_online connects to or disconnects from the ring
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) * MUST be called to initiate connection establishment
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) * on 0 disconnect
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) * on 1 connect
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) u_short smt_online(struct s_smc *smc, int on)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) queue_event(smc,EVENT_ECM,on ? EC_CONNECT : EC_DISCONNECT) ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) ev_dispatcher(smc) ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) return smc->mib.fddiSMTCF_State;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) * set SMT flag to value
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) * flag flag name
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) * value flag value
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) * dump current flag setting
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) #ifdef CONCENTRATOR
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) void do_smt_flag(struct s_smc *smc, char *flag, int value)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) #ifdef DEBUG
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) struct smt_debug *deb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) SK_UNUSED(smc) ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) #ifdef DEBUG_BRD
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) deb = &smc->debug;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) #else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) deb = &debug;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) if (!strcmp(flag,"smt"))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) deb->d_smt = value ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) else if (!strcmp(flag,"smtf"))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) deb->d_smtf = value ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) else if (!strcmp(flag,"pcm"))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) deb->d_pcm = value ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) else if (!strcmp(flag,"rmt"))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) deb->d_rmt = value ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) else if (!strcmp(flag,"cfm"))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) deb->d_cfm = value ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) else if (!strcmp(flag,"ecm"))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) deb->d_ecm = value ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) printf("smt %d\n",deb->d_smt) ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) printf("smtf %d\n",deb->d_smtf) ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) printf("pcm %d\n",deb->d_pcm) ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) printf("rmt %d\n",deb->d_rmt) ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) printf("cfm %d\n",deb->d_cfm) ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) printf("ecm %d\n",deb->d_ecm) ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) #endif /* DEBUG */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) #endif
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags