mirror of
https://github.com/edk2-porting/linux-next.git
synced 2024-12-25 13:43:55 +08:00
ff8ac60948
Signed-off-by: Denis Cheng <crquan@gmail.com> Signed-off-by: Jeff Garzik <jeff@garzik.org>
430 lines
10 KiB
C
430 lines
10 KiB
C
/******************************************************************************
|
|
*
|
|
* (C)Copyright 1998,1999 SysKonnect,
|
|
* a business unit of Schneider & Koch & Co. Datensysteme GmbH.
|
|
*
|
|
* See the file "skfddi.c" for further information.
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License as published by
|
|
* the Free Software Foundation; either version 2 of the License, or
|
|
* (at your option) any later version.
|
|
*
|
|
* The information in this file is provided "AS IS" without warranty.
|
|
*
|
|
******************************************************************************/
|
|
|
|
/*
|
|
SMT 7.2 Status Response Frame Implementation
|
|
SRF state machine and frame generation
|
|
*/
|
|
|
|
#include "h/types.h"
|
|
#include "h/fddi.h"
|
|
#include "h/smc.h"
|
|
#include "h/smt_p.h"
|
|
|
|
#define KERNEL
|
|
#include "h/smtstate.h"
|
|
|
|
#ifndef SLIM_SMT
|
|
#ifndef BOOT
|
|
|
|
#ifndef lint
|
|
static const char ID_sccs[] = "@(#)srf.c 1.18 97/08/04 (C) SK " ;
|
|
#endif
|
|
|
|
|
|
/*
|
|
* function declarations
|
|
*/
|
|
static void clear_all_rep(struct s_smc *smc);
|
|
static void clear_reported(struct s_smc *smc);
|
|
static void smt_send_srf(struct s_smc *smc);
|
|
static struct s_srf_evc *smt_get_evc(struct s_smc *smc, int code, int index);
|
|
|
|
#define MAX_EVCS ARRAY_SIZE(smc->evcs)
|
|
|
|
struct evc_init {
|
|
u_char code ;
|
|
u_char index ;
|
|
u_char n ;
|
|
u_short para ;
|
|
} ;
|
|
|
|
static const struct evc_init evc_inits[] = {
|
|
{ SMT_COND_SMT_PEER_WRAP, 0,1,SMT_P1048 } ,
|
|
|
|
{ SMT_COND_MAC_DUP_ADDR, INDEX_MAC, NUMMACS,SMT_P208C } ,
|
|
{ SMT_COND_MAC_FRAME_ERROR, INDEX_MAC, NUMMACS,SMT_P208D } ,
|
|
{ SMT_COND_MAC_NOT_COPIED, INDEX_MAC, NUMMACS,SMT_P208E } ,
|
|
{ SMT_EVENT_MAC_NEIGHBOR_CHANGE, INDEX_MAC, NUMMACS,SMT_P208F } ,
|
|
{ SMT_EVENT_MAC_PATH_CHANGE, INDEX_MAC, NUMMACS,SMT_P2090 } ,
|
|
|
|
{ SMT_COND_PORT_LER, INDEX_PORT,NUMPHYS,SMT_P4050 } ,
|
|
{ SMT_COND_PORT_EB_ERROR, INDEX_PORT,NUMPHYS,SMT_P4052 } ,
|
|
{ SMT_EVENT_PORT_CONNECTION, INDEX_PORT,NUMPHYS,SMT_P4051 } ,
|
|
{ SMT_EVENT_PORT_PATH_CHANGE, INDEX_PORT,NUMPHYS,SMT_P4053 } ,
|
|
} ;
|
|
|
|
#define MAX_INIT_EVC ARRAY_SIZE(evc_inits)
|
|
|
|
void smt_init_evc(struct s_smc *smc)
|
|
{
|
|
struct s_srf_evc *evc ;
|
|
const struct evc_init *init ;
|
|
int i ;
|
|
int index ;
|
|
int offset ;
|
|
|
|
static u_char fail_safe = FALSE ;
|
|
|
|
memset((char *)smc->evcs,0,sizeof(smc->evcs)) ;
|
|
|
|
evc = smc->evcs ;
|
|
init = evc_inits ;
|
|
|
|
for (i = 0 ; (unsigned) i < MAX_INIT_EVC ; i++) {
|
|
for (index = 0 ; index < init->n ; index++) {
|
|
evc->evc_code = init->code ;
|
|
evc->evc_para = init->para ;
|
|
evc->evc_index = init->index + index ;
|
|
#ifndef DEBUG
|
|
evc->evc_multiple = &fail_safe ;
|
|
evc->evc_cond_state = &fail_safe ;
|
|
#endif
|
|
evc++ ;
|
|
}
|
|
init++ ;
|
|
}
|
|
|
|
if ((unsigned) (evc - smc->evcs) > MAX_EVCS) {
|
|
SMT_PANIC(smc,SMT_E0127, SMT_E0127_MSG) ;
|
|
}
|
|
|
|
/*
|
|
* conditions
|
|
*/
|
|
smc->evcs[0].evc_cond_state = &smc->mib.fddiSMTPeerWrapFlag ;
|
|
smc->evcs[1].evc_cond_state =
|
|
&smc->mib.m[MAC0].fddiMACDuplicateAddressCond ;
|
|
smc->evcs[2].evc_cond_state =
|
|
&smc->mib.m[MAC0].fddiMACFrameErrorFlag ;
|
|
smc->evcs[3].evc_cond_state =
|
|
&smc->mib.m[MAC0].fddiMACNotCopiedFlag ;
|
|
|
|
/*
|
|
* events
|
|
*/
|
|
smc->evcs[4].evc_multiple = &smc->mib.m[MAC0].fddiMACMultiple_N ;
|
|
smc->evcs[5].evc_multiple = &smc->mib.m[MAC0].fddiMACMultiple_P ;
|
|
|
|
offset = 6 ;
|
|
for (i = 0 ; i < NUMPHYS ; i++) {
|
|
/*
|
|
* conditions
|
|
*/
|
|
smc->evcs[offset + 0*NUMPHYS].evc_cond_state =
|
|
&smc->mib.p[i].fddiPORTLerFlag ;
|
|
smc->evcs[offset + 1*NUMPHYS].evc_cond_state =
|
|
&smc->mib.p[i].fddiPORTEB_Condition ;
|
|
|
|
/*
|
|
* events
|
|
*/
|
|
smc->evcs[offset + 2*NUMPHYS].evc_multiple =
|
|
&smc->mib.p[i].fddiPORTMultiple_U ;
|
|
smc->evcs[offset + 3*NUMPHYS].evc_multiple =
|
|
&smc->mib.p[i].fddiPORTMultiple_P ;
|
|
offset++ ;
|
|
}
|
|
#ifdef DEBUG
|
|
for (i = 0, evc = smc->evcs ; (unsigned) i < MAX_EVCS ; i++, evc++) {
|
|
if (SMT_IS_CONDITION(evc->evc_code)) {
|
|
if (!evc->evc_cond_state) {
|
|
SMT_PANIC(smc,SMT_E0128, SMT_E0128_MSG) ;
|
|
}
|
|
evc->evc_multiple = &fail_safe ;
|
|
}
|
|
else {
|
|
if (!evc->evc_multiple) {
|
|
SMT_PANIC(smc,SMT_E0129, SMT_E0129_MSG) ;
|
|
}
|
|
evc->evc_cond_state = &fail_safe ;
|
|
}
|
|
}
|
|
#endif
|
|
smc->srf.TSR = smt_get_time() ;
|
|
smc->srf.sr_state = SR0_WAIT ;
|
|
}
|
|
|
|
static struct s_srf_evc *smt_get_evc(struct s_smc *smc, int code, int index)
|
|
{
|
|
int i ;
|
|
struct s_srf_evc *evc ;
|
|
|
|
for (i = 0, evc = smc->evcs ; (unsigned) i < MAX_EVCS ; i++, evc++) {
|
|
if (evc->evc_code == code && evc->evc_index == index)
|
|
return(evc) ;
|
|
}
|
|
return NULL;
|
|
}
|
|
|
|
#define THRESHOLD_2 (2*TICKS_PER_SECOND)
|
|
#define THRESHOLD_32 (32*TICKS_PER_SECOND)
|
|
|
|
#ifdef DEBUG
|
|
static const char * const srf_names[] = {
|
|
"None","MACPathChangeEvent", "MACNeighborChangeEvent",
|
|
"PORTPathChangeEvent", "PORTUndesiredConnectionAttemptEvent",
|
|
"SMTPeerWrapCondition", "SMTHoldCondition",
|
|
"MACFrameErrorCondition", "MACDuplicateAddressCondition",
|
|
"MACNotCopiedCondition", "PORTEBErrorCondition",
|
|
"PORTLerCondition"
|
|
} ;
|
|
#endif
|
|
|
|
void smt_srf_event(struct s_smc *smc, int code, int index, int cond)
|
|
{
|
|
struct s_srf_evc *evc ;
|
|
int cond_asserted = 0 ;
|
|
int cond_deasserted = 0 ;
|
|
int event_occurred = 0 ;
|
|
int tsr ;
|
|
int T_Limit = 2*TICKS_PER_SECOND ;
|
|
|
|
if (code == SMT_COND_MAC_DUP_ADDR && cond) {
|
|
RS_SET(smc,RS_DUPADDR) ;
|
|
}
|
|
|
|
if (code) {
|
|
DB_SMT("SRF: %s index %d\n",srf_names[code],index) ;
|
|
|
|
if (!(evc = smt_get_evc(smc,code,index))) {
|
|
DB_SMT("SRF : smt_get_evc() failed\n",0,0) ;
|
|
return ;
|
|
}
|
|
/*
|
|
* ignore condition if no change
|
|
*/
|
|
if (SMT_IS_CONDITION(code)) {
|
|
if (*evc->evc_cond_state == cond)
|
|
return ;
|
|
}
|
|
|
|
/*
|
|
* set transition time stamp
|
|
*/
|
|
smt_set_timestamp(smc,smc->mib.fddiSMTTransitionTimeStamp) ;
|
|
if (SMT_IS_CONDITION(code)) {
|
|
DB_SMT("SRF: condition is %s\n",cond ? "ON":"OFF",0) ;
|
|
if (cond) {
|
|
*evc->evc_cond_state = TRUE ;
|
|
evc->evc_rep_required = TRUE ;
|
|
smc->srf.any_report = TRUE ;
|
|
cond_asserted = TRUE ;
|
|
}
|
|
else {
|
|
*evc->evc_cond_state = FALSE ;
|
|
cond_deasserted = TRUE ;
|
|
}
|
|
}
|
|
else {
|
|
if (evc->evc_rep_required) {
|
|
*evc->evc_multiple = TRUE ;
|
|
}
|
|
else {
|
|
evc->evc_rep_required = TRUE ;
|
|
*evc->evc_multiple = FALSE ;
|
|
}
|
|
smc->srf.any_report = TRUE ;
|
|
event_occurred = TRUE ;
|
|
}
|
|
#ifdef FDDI_MIB
|
|
snmp_srf_event(smc,evc) ;
|
|
#endif /* FDDI_MIB */
|
|
}
|
|
tsr = smt_get_time() - smc->srf.TSR ;
|
|
|
|
switch (smc->srf.sr_state) {
|
|
case SR0_WAIT :
|
|
/* SR01a */
|
|
if (cond_asserted && tsr < T_Limit) {
|
|
smc->srf.SRThreshold = THRESHOLD_2 ;
|
|
smc->srf.sr_state = SR1_HOLDOFF ;
|
|
break ;
|
|
}
|
|
/* SR01b */
|
|
if (cond_deasserted && tsr < T_Limit) {
|
|
smc->srf.sr_state = SR1_HOLDOFF ;
|
|
break ;
|
|
}
|
|
/* SR01c */
|
|
if (event_occurred && tsr < T_Limit) {
|
|
smc->srf.sr_state = SR1_HOLDOFF ;
|
|
break ;
|
|
}
|
|
/* SR00b */
|
|
if (cond_asserted && tsr >= T_Limit) {
|
|
smc->srf.SRThreshold = THRESHOLD_2 ;
|
|
smc->srf.TSR = smt_get_time() ;
|
|
smt_send_srf(smc) ;
|
|
break ;
|
|
}
|
|
/* SR00c */
|
|
if (cond_deasserted && tsr >= T_Limit) {
|
|
smc->srf.TSR = smt_get_time() ;
|
|
smt_send_srf(smc) ;
|
|
break ;
|
|
}
|
|
/* SR00d */
|
|
if (event_occurred && tsr >= T_Limit) {
|
|
smc->srf.TSR = smt_get_time() ;
|
|
smt_send_srf(smc) ;
|
|
break ;
|
|
}
|
|
/* SR00e */
|
|
if (smc->srf.any_report && (u_long) tsr >=
|
|
smc->srf.SRThreshold) {
|
|
smc->srf.SRThreshold *= 2 ;
|
|
if (smc->srf.SRThreshold > THRESHOLD_32)
|
|
smc->srf.SRThreshold = THRESHOLD_32 ;
|
|
smc->srf.TSR = smt_get_time() ;
|
|
smt_send_srf(smc) ;
|
|
break ;
|
|
}
|
|
/* SR02 */
|
|
if (!smc->mib.fddiSMTStatRptPolicy) {
|
|
smc->srf.sr_state = SR2_DISABLED ;
|
|
break ;
|
|
}
|
|
break ;
|
|
case SR1_HOLDOFF :
|
|
/* SR10b */
|
|
if (tsr >= T_Limit) {
|
|
smc->srf.sr_state = SR0_WAIT ;
|
|
smc->srf.TSR = smt_get_time() ;
|
|
smt_send_srf(smc) ;
|
|
break ;
|
|
}
|
|
/* SR11a */
|
|
if (cond_asserted) {
|
|
smc->srf.SRThreshold = THRESHOLD_2 ;
|
|
}
|
|
/* SR11b */
|
|
/* SR11c */
|
|
/* handled above */
|
|
/* SR12 */
|
|
if (!smc->mib.fddiSMTStatRptPolicy) {
|
|
smc->srf.sr_state = SR2_DISABLED ;
|
|
break ;
|
|
}
|
|
break ;
|
|
case SR2_DISABLED :
|
|
if (smc->mib.fddiSMTStatRptPolicy) {
|
|
smc->srf.sr_state = SR0_WAIT ;
|
|
smc->srf.TSR = smt_get_time() ;
|
|
smc->srf.SRThreshold = THRESHOLD_2 ;
|
|
clear_all_rep(smc) ;
|
|
break ;
|
|
}
|
|
break ;
|
|
}
|
|
}
|
|
|
|
static void clear_all_rep(struct s_smc *smc)
|
|
{
|
|
struct s_srf_evc *evc ;
|
|
int i ;
|
|
|
|
for (i = 0, evc = smc->evcs ; (unsigned) i < MAX_EVCS ; i++, evc++) {
|
|
evc->evc_rep_required = FALSE ;
|
|
if (SMT_IS_CONDITION(evc->evc_code))
|
|
*evc->evc_cond_state = FALSE ;
|
|
}
|
|
smc->srf.any_report = FALSE ;
|
|
}
|
|
|
|
static void clear_reported(struct s_smc *smc)
|
|
{
|
|
struct s_srf_evc *evc ;
|
|
int i ;
|
|
|
|
smc->srf.any_report = FALSE ;
|
|
for (i = 0, evc = smc->evcs ; (unsigned) i < MAX_EVCS ; i++, evc++) {
|
|
if (SMT_IS_CONDITION(evc->evc_code)) {
|
|
if (*evc->evc_cond_state == FALSE)
|
|
evc->evc_rep_required = FALSE ;
|
|
else
|
|
smc->srf.any_report = TRUE ;
|
|
}
|
|
else {
|
|
evc->evc_rep_required = FALSE ;
|
|
*evc->evc_multiple = FALSE ;
|
|
}
|
|
}
|
|
}
|
|
|
|
/*
|
|
* build and send SMT SRF frame
|
|
*/
|
|
static void smt_send_srf(struct s_smc *smc)
|
|
{
|
|
|
|
struct smt_header *smt ;
|
|
struct s_srf_evc *evc ;
|
|
SK_LOC_DECL(struct s_pcon,pcon) ;
|
|
SMbuf *mb ;
|
|
int i ;
|
|
|
|
static const struct fddi_addr SMT_SRF_DA = {
|
|
{ 0x80, 0x01, 0x43, 0x00, 0x80, 0x08 }
|
|
} ;
|
|
|
|
/*
|
|
* build SMT header
|
|
*/
|
|
if (!smc->r.sm_ma_avail)
|
|
return ;
|
|
if (!(mb = smt_build_frame(smc,SMT_SRF,SMT_ANNOUNCE,0)))
|
|
return ;
|
|
|
|
RS_SET(smc,RS_SOFTERROR) ;
|
|
|
|
smt = smtod(mb, struct smt_header *) ;
|
|
smt->smt_dest = SMT_SRF_DA ; /* DA == SRF multicast */
|
|
|
|
/*
|
|
* setup parameter status
|
|
*/
|
|
pcon.pc_len = SMT_MAX_INFO_LEN ; /* max para length */
|
|
pcon.pc_err = 0 ; /* no error */
|
|
pcon.pc_badset = 0 ; /* no bad set count */
|
|
pcon.pc_p = (void *) (smt + 1) ; /* paras start here */
|
|
|
|
smt_add_para(smc,&pcon,(u_short) SMT_P1033,0,0) ;
|
|
smt_add_para(smc,&pcon,(u_short) SMT_P1034,0,0) ;
|
|
|
|
for (i = 0, evc = smc->evcs ; (unsigned) i < MAX_EVCS ; i++, evc++) {
|
|
if (evc->evc_rep_required) {
|
|
smt_add_para(smc,&pcon,evc->evc_para,
|
|
(int)evc->evc_index,0) ;
|
|
}
|
|
}
|
|
smt->smt_len = SMT_MAX_INFO_LEN - pcon.pc_len ;
|
|
mb->sm_len = smt->smt_len + sizeof(struct smt_header) ;
|
|
|
|
DB_SMT("SRF: sending SRF at %x, len %d \n",smt,mb->sm_len) ;
|
|
DB_SMT("SRF: state SR%d Threshold %d\n",
|
|
smc->srf.sr_state,smc->srf.SRThreshold/TICKS_PER_SECOND) ;
|
|
#ifdef DEBUG
|
|
dump_smt(smc,smt,"SRF Send") ;
|
|
#endif
|
|
smt_send_frame(smc,mb,FC_SMT_INFO,0) ;
|
|
clear_reported(smc) ;
|
|
}
|
|
|
|
#endif /* no BOOT */
|
|
#endif /* no SLIM_SMT */
|
|
|