cachepc-linux

Fork of AMDESE/linux with modifications for CachePC side-channel attack
git clone https://git.sinitax.com/sinitax/cachepc-linux
Log | Files | Refs | README | LICENSE | sfeed.txt

pmf.c (40119B)


      1// SPDX-License-Identifier: GPL-2.0-or-later
      2/******************************************************************************
      3 *
      4 *	(C)Copyright 1998,1999 SysKonnect,
      5 *	a business unit of Schneider & Koch & Co. Datensysteme GmbH.
      6 *
      7 *	See the file "skfddi.c" for further information.
      8 *
      9 *	The information in this file is provided "AS IS" without warranty.
     10 *
     11 ******************************************************************************/
     12
     13/*
     14	Parameter Management Frame processing for SMT 7.2
     15*/
     16
     17#include "h/types.h"
     18#include "h/fddi.h"
     19#include "h/smc.h"
     20#include "h/smt_p.h"
     21
     22#define KERNEL
     23#include "h/smtstate.h"
     24
     25#ifndef	SLIM_SMT
     26
     27static int smt_authorize(struct s_smc *smc, struct smt_header *sm);
     28static int smt_check_set_count(struct s_smc *smc, struct smt_header *sm);
     29static const struct s_p_tab* smt_get_ptab(u_short para);
     30static int smt_mib_phys(struct s_smc *smc);
     31static int smt_set_para(struct s_smc *smc, struct smt_para *pa, int index,
     32			int local, int set);
     33void smt_add_para(struct s_smc *smc, struct s_pcon *pcon, u_short para,
     34		  int index, int local);
     35static SMbuf *smt_build_pmf_response(struct s_smc *smc, struct smt_header *req,
     36				     int set, int local);
     37static int port_to_mib(struct s_smc *smc, int p);
     38
     39#define MOFFSS(e)	offsetof(struct fddi_mib, e)
     40#define MOFFMS(e)	offsetof(struct fddi_mib_m, e)
     41#define MOFFAS(e)	offsetof(struct fddi_mib_a, e)
     42#define MOFFPS(e)	offsetof(struct fddi_mib_p, e)
     43
     44
     45#define AC_G	0x01		/* Get */
     46#define AC_GR	0x02		/* Get/Set */
     47#define AC_S	0x04		/* Set */
     48#define AC_NA	0x08
     49#define AC_GROUP	0x10		/* Group */
     50#define MS2BCLK(x)	((x)*12500L)
     51/*
     52	F	LFag (byte)
     53	B	byte
     54	S	u_short	16 bit
     55	C	Counter 32 bit
     56	L	Long 32 bit
     57	T	Timer_2	32 bit
     58	P	TimeStamp ;
     59	A	LongAddress (6 byte)
     60	E	Enum 16 bit
     61	R	ResId 16 Bit
     62*/
     63static const struct s_p_tab {
     64	u_short	p_num ;		/* parameter code */
     65	u_char	p_access ;	/* access rights */
     66	u_short	p_offset ;	/* offset in mib */
     67	char	p_swap[3] ;	/* format string */
     68} p_tab[] = {
     69	/* StationIdGrp */
     70	{ SMT_P100A,AC_GROUP	} ,
     71	{ SMT_P100B,AC_G,	MOFFSS(fddiSMTStationId),	"8"	} ,
     72	{ SMT_P100D,AC_G,	MOFFSS(fddiSMTOpVersionId),	"S"	} ,
     73	{ SMT_P100E,AC_G,	MOFFSS(fddiSMTHiVersionId),	"S"	} ,
     74	{ SMT_P100F,AC_G,	MOFFSS(fddiSMTLoVersionId),	"S"	} ,
     75	{ SMT_P1010,AC_G,	MOFFSS(fddiSMTManufacturerData), "D" } ,
     76	{ SMT_P1011,AC_GR,	MOFFSS(fddiSMTUserData),	"D"	} ,
     77	{ SMT_P1012,AC_G,	MOFFSS(fddiSMTMIBVersionId),	"S"	} ,
     78
     79	/* StationConfigGrp */
     80	{ SMT_P1014,AC_GROUP	} ,
     81	{ SMT_P1015,AC_G,	MOFFSS(fddiSMTMac_Ct),		"B"	} ,
     82	{ SMT_P1016,AC_G,	MOFFSS(fddiSMTNonMaster_Ct),	"B"	} ,
     83	{ SMT_P1017,AC_G,	MOFFSS(fddiSMTMaster_Ct),	"B"	} ,
     84	{ SMT_P1018,AC_G,	MOFFSS(fddiSMTAvailablePaths),	"B"	} ,
     85	{ SMT_P1019,AC_G,	MOFFSS(fddiSMTConfigCapabilities),"S"	} ,
     86	{ SMT_P101A,AC_GR,	MOFFSS(fddiSMTConfigPolicy),	"wS"	} ,
     87	{ SMT_P101B,AC_GR,	MOFFSS(fddiSMTConnectionPolicy),"wS"	} ,
     88	{ SMT_P101D,AC_GR,	MOFFSS(fddiSMTTT_Notify),	"wS"	} ,
     89	{ SMT_P101E,AC_GR,	MOFFSS(fddiSMTStatRptPolicy),	"bB"	} ,
     90	{ SMT_P101F,AC_GR,	MOFFSS(fddiSMTTrace_MaxExpiration),"lL"	} ,
     91	{ SMT_P1020,AC_G,	MOFFSS(fddiSMTPORTIndexes),	"II"	} ,
     92	{ SMT_P1021,AC_G,	MOFFSS(fddiSMTMACIndexes),	"I"	} ,
     93	{ SMT_P1022,AC_G,	MOFFSS(fddiSMTBypassPresent),	"F"	} ,
     94
     95	/* StatusGrp */
     96	{ SMT_P1028,AC_GROUP	} ,
     97	{ SMT_P1029,AC_G,	MOFFSS(fddiSMTECMState),	"E"	} ,
     98	{ SMT_P102A,AC_G,	MOFFSS(fddiSMTCF_State),	"E"	} ,
     99	{ SMT_P102C,AC_G,	MOFFSS(fddiSMTRemoteDisconnectFlag),"F"	} ,
    100	{ SMT_P102D,AC_G,	MOFFSS(fddiSMTStationStatus),	"E"	} ,
    101	{ SMT_P102E,AC_G,	MOFFSS(fddiSMTPeerWrapFlag),	"F"	} ,
    102
    103	/* MIBOperationGrp */
    104	{ SMT_P1032,AC_GROUP	} ,
    105	{ SMT_P1033,AC_G,	MOFFSS(fddiSMTTimeStamp),"P"		} ,
    106	{ SMT_P1034,AC_G,	MOFFSS(fddiSMTTransitionTimeStamp),"P"	} ,
    107	/* NOTE : SMT_P1035 is already swapped ! SMT_P_SETCOUNT */
    108	{ SMT_P1035,AC_G,	MOFFSS(fddiSMTSetCount),"4P"		} ,
    109	{ SMT_P1036,AC_G,	MOFFSS(fddiSMTLastSetStationId),"8"	} ,
    110
    111	{ SMT_P103C,AC_S,	0,				"wS"	} ,
    112
    113	/*
    114	 * PRIVATE EXTENSIONS
    115	 * only accessible locally to get/set passwd
    116	 */
    117	{ SMT_P10F0,AC_GR,	MOFFSS(fddiPRPMFPasswd),	"8"	} ,
    118	{ SMT_P10F1,AC_GR,	MOFFSS(fddiPRPMFStation),	"8"	} ,
    119#ifdef	ESS
    120	{ SMT_P10F2,AC_GR,	MOFFSS(fddiESSPayload),		"lL"	} ,
    121	{ SMT_P10F3,AC_GR,	MOFFSS(fddiESSOverhead),	"lL"	} ,
    122	{ SMT_P10F4,AC_GR,	MOFFSS(fddiESSMaxTNeg),		"lL"	} ,
    123	{ SMT_P10F5,AC_GR,	MOFFSS(fddiESSMinSegmentSize),	"lL"	} ,
    124	{ SMT_P10F6,AC_GR,	MOFFSS(fddiESSCategory),	"lL"	} ,
    125	{ SMT_P10F7,AC_GR,	MOFFSS(fddiESSSynchTxMode),	"wS"	} ,
    126#endif
    127#ifdef	SBA
    128	{ SMT_P10F8,AC_GR,	MOFFSS(fddiSBACommand),		"bF"	} ,
    129	{ SMT_P10F9,AC_GR,	MOFFSS(fddiSBAAvailable),	"bF"	} ,
    130#endif
    131	/* MAC Attributes */
    132	{ SMT_P200A,AC_GROUP	} ,
    133	{ SMT_P200B,AC_G,	MOFFMS(fddiMACFrameStatusFunctions),"S"	} ,
    134	{ SMT_P200D,AC_G,	MOFFMS(fddiMACT_MaxCapabilitiy),"T"	} ,
    135	{ SMT_P200E,AC_G,	MOFFMS(fddiMACTVXCapabilitiy),"T"	} ,
    136
    137	/* ConfigGrp */
    138	{ SMT_P2014,AC_GROUP	} ,
    139	{ SMT_P2016,AC_G,	MOFFMS(fddiMACAvailablePaths),	"B"	} ,
    140	{ SMT_P2017,AC_G,	MOFFMS(fddiMACCurrentPath),	"S"	} ,
    141	{ SMT_P2018,AC_G,	MOFFMS(fddiMACUpstreamNbr),	"A"	} ,
    142	{ SMT_P2019,AC_G,	MOFFMS(fddiMACDownstreamNbr),	"A"	} ,
    143	{ SMT_P201A,AC_G,	MOFFMS(fddiMACOldUpstreamNbr),	"A"	} ,
    144	{ SMT_P201B,AC_G,	MOFFMS(fddiMACOldDownstreamNbr),"A"	} ,
    145	{ SMT_P201D,AC_G,	MOFFMS(fddiMACDupAddressTest),	"E"	} ,
    146	{ SMT_P2020,AC_GR,	MOFFMS(fddiMACRequestedPaths),	"wS"	} ,
    147	{ SMT_P2021,AC_G,	MOFFMS(fddiMACDownstreamPORTType),"E"	} ,
    148	{ SMT_P2022,AC_G,	MOFFMS(fddiMACIndex),		"S"	} ,
    149
    150	/* AddressGrp */
    151	{ SMT_P2028,AC_GROUP	} ,
    152	{ SMT_P2029,AC_G,	MOFFMS(fddiMACSMTAddress),	"A"	} ,
    153
    154	/* OperationGrp */
    155	{ SMT_P2032,AC_GROUP	} ,
    156	{ SMT_P2033,AC_G,	MOFFMS(fddiMACT_Req),		"T"	} ,
    157	{ SMT_P2034,AC_G,	MOFFMS(fddiMACT_Neg),		"T"	} ,
    158	{ SMT_P2035,AC_G,	MOFFMS(fddiMACT_Max),		"T"	} ,
    159	{ SMT_P2036,AC_G,	MOFFMS(fddiMACTvxValue),	"T"	} ,
    160	{ SMT_P2038,AC_G,	MOFFMS(fddiMACT_Pri0),		"T"	} ,
    161	{ SMT_P2039,AC_G,	MOFFMS(fddiMACT_Pri1),		"T"	} ,
    162	{ SMT_P203A,AC_G,	MOFFMS(fddiMACT_Pri2),		"T"	} ,
    163	{ SMT_P203B,AC_G,	MOFFMS(fddiMACT_Pri3),		"T"	} ,
    164	{ SMT_P203C,AC_G,	MOFFMS(fddiMACT_Pri4),		"T"	} ,
    165	{ SMT_P203D,AC_G,	MOFFMS(fddiMACT_Pri5),		"T"	} ,
    166	{ SMT_P203E,AC_G,	MOFFMS(fddiMACT_Pri6),		"T"	} ,
    167
    168
    169	/* CountersGrp */
    170	{ SMT_P2046,AC_GROUP	} ,
    171	{ SMT_P2047,AC_G,	MOFFMS(fddiMACFrame_Ct),	"C"	} ,
    172	{ SMT_P2048,AC_G,	MOFFMS(fddiMACCopied_Ct),	"C"	} ,
    173	{ SMT_P2049,AC_G,	MOFFMS(fddiMACTransmit_Ct),	"C"	} ,
    174	{ SMT_P204A,AC_G,	MOFFMS(fddiMACToken_Ct),	"C"	} ,
    175	{ SMT_P2051,AC_G,	MOFFMS(fddiMACError_Ct),	"C"	} ,
    176	{ SMT_P2052,AC_G,	MOFFMS(fddiMACLost_Ct),		"C"	} ,
    177	{ SMT_P2053,AC_G,	MOFFMS(fddiMACTvxExpired_Ct),	"C"	} ,
    178	{ SMT_P2054,AC_G,	MOFFMS(fddiMACNotCopied_Ct),	"C"	} ,
    179	{ SMT_P2056,AC_G,	MOFFMS(fddiMACRingOp_Ct),	"C"	} ,
    180
    181	/* FrameErrorConditionGrp */
    182	{ SMT_P205A,AC_GROUP	} ,
    183	{ SMT_P205F,AC_GR,	MOFFMS(fddiMACFrameErrorThreshold),"wS"	} ,
    184	{ SMT_P2060,AC_G,	MOFFMS(fddiMACFrameErrorRatio),	"S"	} ,
    185
    186	/* NotCopiedConditionGrp */
    187	{ SMT_P2064,AC_GROUP	} ,
    188	{ SMT_P2067,AC_GR,	MOFFMS(fddiMACNotCopiedThreshold),"wS"	} ,
    189	{ SMT_P2069,AC_G,	MOFFMS(fddiMACNotCopiedRatio),	"S"	} ,
    190
    191	/* StatusGrp */
    192	{ SMT_P206E,AC_GROUP	} ,
    193	{ SMT_P206F,AC_G,	MOFFMS(fddiMACRMTState),	"S"	} ,
    194	{ SMT_P2070,AC_G,	MOFFMS(fddiMACDA_Flag),	"F"	} ,
    195	{ SMT_P2071,AC_G,	MOFFMS(fddiMACUNDA_Flag),	"F"	} ,
    196	{ SMT_P2072,AC_G,	MOFFMS(fddiMACFrameErrorFlag),	"F"	} ,
    197	{ SMT_P2073,AC_G,	MOFFMS(fddiMACNotCopiedFlag),	"F"	} ,
    198	{ SMT_P2074,AC_G,	MOFFMS(fddiMACMA_UnitdataAvailable),"F"	} ,
    199	{ SMT_P2075,AC_G,	MOFFMS(fddiMACHardwarePresent),	"F"	} ,
    200	{ SMT_P2076,AC_GR,	MOFFMS(fddiMACMA_UnitdataEnable),"bF"	} ,
    201
    202	/*
    203	 * PRIVATE EXTENSIONS
    204	 * only accessible locally to get/set TMIN
    205	 */
    206	{ SMT_P20F0,AC_NA						} ,
    207	{ SMT_P20F1,AC_GR,	MOFFMS(fddiMACT_Min),		"lT"	} ,
    208
    209	/* Path Attributes */
    210	/*
    211	 * DON't swap 320B,320F,3210: they are already swapped in swap_para()
    212	 */
    213	{ SMT_P320A,AC_GROUP	} ,
    214	{ SMT_P320B,AC_G,	MOFFAS(fddiPATHIndex),		"r"	} ,
    215	{ SMT_P320F,AC_GR,	MOFFAS(fddiPATHSbaPayload),	"l4"	} ,
    216	{ SMT_P3210,AC_GR,	MOFFAS(fddiPATHSbaOverhead),	"l4"	} ,
    217	/* fddiPATHConfiguration */
    218	{ SMT_P3212,AC_G,	0,				""	} ,
    219	{ SMT_P3213,AC_GR,	MOFFAS(fddiPATHT_Rmode),	"lT"	} ,
    220	{ SMT_P3214,AC_GR,	MOFFAS(fddiPATHSbaAvailable),	"lL"	} ,
    221	{ SMT_P3215,AC_GR,	MOFFAS(fddiPATHTVXLowerBound),	"lT"	} ,
    222	{ SMT_P3216,AC_GR,	MOFFAS(fddiPATHT_MaxLowerBound),"lT"	} ,
    223	{ SMT_P3217,AC_GR,	MOFFAS(fddiPATHMaxT_Req),	"lT"	} ,
    224
    225	/* Port Attributes */
    226	/* ConfigGrp */
    227	{ SMT_P400A,AC_GROUP	} ,
    228	{ SMT_P400C,AC_G,	MOFFPS(fddiPORTMy_Type),	"E"	} ,
    229	{ SMT_P400D,AC_G,	MOFFPS(fddiPORTNeighborType),	"E"	} ,
    230	{ SMT_P400E,AC_GR,	MOFFPS(fddiPORTConnectionPolicies),"bB"	} ,
    231	{ SMT_P400F,AC_G,	MOFFPS(fddiPORTMacIndicated),	"2"	} ,
    232	{ SMT_P4010,AC_G,	MOFFPS(fddiPORTCurrentPath),	"E"	} ,
    233	{ SMT_P4011,AC_GR,	MOFFPS(fddiPORTRequestedPaths),	"l4"	} ,
    234	{ SMT_P4012,AC_G,	MOFFPS(fddiPORTMACPlacement),	"S"	} ,
    235	{ SMT_P4013,AC_G,	MOFFPS(fddiPORTAvailablePaths),	"B"	} ,
    236	{ SMT_P4016,AC_G,	MOFFPS(fddiPORTPMDClass),	"E"	} ,
    237	{ SMT_P4017,AC_G,	MOFFPS(fddiPORTConnectionCapabilities),	"B"} ,
    238	{ SMT_P401D,AC_G,	MOFFPS(fddiPORTIndex),		"R"	} ,
    239
    240	/* OperationGrp */
    241	{ SMT_P401E,AC_GROUP	} ,
    242	{ SMT_P401F,AC_GR,	MOFFPS(fddiPORTMaint_LS),	"wE"	} ,
    243	{ SMT_P4021,AC_G,	MOFFPS(fddiPORTBS_Flag),	"F"	} ,
    244	{ SMT_P4022,AC_G,	MOFFPS(fddiPORTPC_LS),		"E"	} ,
    245
    246	/* ErrorCtrsGrp */
    247	{ SMT_P4028,AC_GROUP	} ,
    248	{ SMT_P4029,AC_G,	MOFFPS(fddiPORTEBError_Ct),	"C"	} ,
    249	{ SMT_P402A,AC_G,	MOFFPS(fddiPORTLCTFail_Ct),	"C"	} ,
    250
    251	/* LerGrp */
    252	{ SMT_P4032,AC_GROUP	} ,
    253	{ SMT_P4033,AC_G,	MOFFPS(fddiPORTLer_Estimate),	"F"	} ,
    254	{ SMT_P4034,AC_G,	MOFFPS(fddiPORTLem_Reject_Ct),	"C"	} ,
    255	{ SMT_P4035,AC_G,	MOFFPS(fddiPORTLem_Ct),		"C"	} ,
    256	{ SMT_P403A,AC_GR,	MOFFPS(fddiPORTLer_Cutoff),	"bB"	} ,
    257	{ SMT_P403B,AC_GR,	MOFFPS(fddiPORTLer_Alarm),	"bB"	} ,
    258
    259	/* StatusGrp */
    260	{ SMT_P403C,AC_GROUP	} ,
    261	{ SMT_P403D,AC_G,	MOFFPS(fddiPORTConnectState),	"E"	} ,
    262	{ SMT_P403E,AC_G,	MOFFPS(fddiPORTPCMStateX),	"E"	} ,
    263	{ SMT_P403F,AC_G,	MOFFPS(fddiPORTPC_Withhold),	"E"	} ,
    264	{ SMT_P4040,AC_G,	MOFFPS(fddiPORTLerFlag),	"F"	} ,
    265	{ SMT_P4041,AC_G,	MOFFPS(fddiPORTHardwarePresent),"F"	} ,
    266
    267	{ SMT_P4046,AC_S,	0,				"wS"	} ,
    268
    269	{ 0,	AC_GROUP	} ,
    270	{ 0 }
    271} ;
    272
    273void smt_pmf_received_pack(struct s_smc *smc, SMbuf *mb, int local)
    274{
    275	struct smt_header	*sm ;
    276	SMbuf		*reply ;
    277
    278	sm = smtod(mb,struct smt_header *) ;
    279	DB_SMT("SMT: processing PMF frame at %p len %d", sm, mb->sm_len);
    280#ifdef	DEBUG
    281	dump_smt(smc,sm,"PMF Received") ;
    282#endif
    283	/*
    284	 * Start the watchdog: It may be a long, long packet and
    285	 * maybe the watchdog occurs ...
    286	 */
    287	smt_start_watchdog(smc) ;
    288
    289	if (sm->smt_class == SMT_PMF_GET ||
    290	    sm->smt_class == SMT_PMF_SET) {
    291		reply = smt_build_pmf_response(smc,sm,
    292			sm->smt_class == SMT_PMF_SET,local) ;
    293		if (reply) {
    294			sm = smtod(reply,struct smt_header *) ;
    295#ifdef	DEBUG
    296			dump_smt(smc,sm,"PMF Reply") ;
    297#endif
    298			smt_send_frame(smc,reply,FC_SMT_INFO,local) ;
    299		}
    300	}
    301}
    302
    303static SMbuf *smt_build_pmf_response(struct s_smc *smc, struct smt_header *req,
    304				     int set, int local)
    305{
    306	SMbuf			*mb ;
    307	struct smt_header	*smt ;
    308	struct smt_para		*pa ;
    309	struct smt_p_reason	*res ;
    310	const struct s_p_tab	*pt ;
    311	int			len ;
    312	int			index ;
    313	int			idx_end ;
    314	int			error ;
    315	int			range ;
    316	SK_LOC_DECL(struct s_pcon,pcon) ;
    317	SK_LOC_DECL(struct s_pcon,set_pcon) ;
    318
    319	/*
    320	 * build SMT header
    321	 */
    322	if (!(mb = smt_get_mbuf(smc)))
    323		return mb;
    324
    325	smt = smtod(mb, struct smt_header *) ;
    326	smt->smt_dest = req->smt_source ;	/* DA == source of request */
    327	smt->smt_class = req->smt_class ;	/* same class (GET/SET) */
    328	smt->smt_type = SMT_REPLY ;
    329	smt->smt_version = SMT_VID_2 ;
    330	smt->smt_tid = req->smt_tid ;		/* same TID */
    331	smt->smt_pad = 0 ;
    332	smt->smt_len = 0 ;
    333
    334	/*
    335	 * setup parameter status
    336	 */
    337	pcon.pc_len = SMT_MAX_INFO_LEN ;	/* max para length */
    338	pcon.pc_err = 0 ;			/* no error */
    339	pcon.pc_badset = 0 ;			/* no bad set count */
    340	pcon.pc_p = (void *) (smt + 1) ;	/* paras start here */
    341
    342	/*
    343	 * check authoriziation and set count
    344	 */
    345	error = 0 ;
    346	if (set) {
    347		if (!local && smt_authorize(smc,req))
    348			error = SMT_RDF_AUTHOR ;
    349		else if (smt_check_set_count(smc,req))
    350			pcon.pc_badset = SMT_RDF_BADSET ;
    351	}
    352	/*
    353	 * add reason code and all mandatory parameters
    354	 */
    355	res = (struct smt_p_reason *) pcon.pc_p ;
    356	smt_add_para(smc,&pcon,(u_short) SMT_P_REASON,0,0) ;
    357	smt_add_para(smc,&pcon,(u_short) SMT_P1033,0,0) ;
    358	/* update 1035 and 1036 later if set */
    359	set_pcon = pcon ;
    360	smt_add_para(smc,&pcon,(u_short) SMT_P1035,0,0) ;
    361	smt_add_para(smc,&pcon,(u_short) SMT_P1036,0,0) ;
    362
    363	pcon.pc_err = error ;
    364	len = req->smt_len ;
    365	pa = (struct smt_para *) (req + 1) ;
    366	/*
    367	 * process list of paras
    368	 */
    369	while (!pcon.pc_err && len > 0 ) {
    370		if (((u_short)len < pa->p_len + PARA_LEN) || (pa->p_len & 3)) {
    371			pcon.pc_err = SMT_RDF_LENGTH ;
    372			break ;
    373		}
    374
    375		if (((range = (pa->p_type & 0xf000)) == 0x2000) ||
    376			range == 0x3000 || range == 0x4000) {
    377			/*
    378			 * get index for PART,MAC ad PATH group
    379			 */
    380			index = *((u_char *)pa + PARA_LEN + 3) ;/* index */
    381			idx_end = index ;
    382			if (!set && (pa->p_len != 4)) {
    383				pcon.pc_err = SMT_RDF_LENGTH ;
    384				break ;
    385			}
    386			if (!index && !set) {
    387				switch (range) {
    388				case 0x2000 :
    389					index = INDEX_MAC ;
    390					idx_end = index - 1 + NUMMACS ;
    391					break ;
    392				case 0x3000 :
    393					index = INDEX_PATH ;
    394					idx_end = index - 1 + NUMPATHS ;
    395					break ;
    396				case 0x4000 :
    397					index = INDEX_PORT ;
    398					idx_end = index - 1 + NUMPHYS ;
    399#ifndef	CONCENTRATOR
    400					if (smc->s.sas == SMT_SAS)
    401						idx_end = INDEX_PORT ;
    402#endif
    403					break ;
    404				}
    405			}
    406		}
    407		else {
    408			/*
    409			 * smt group has no index
    410			 */
    411			if (!set && (pa->p_len != 0)) {
    412				pcon.pc_err = SMT_RDF_LENGTH ;
    413				break ;
    414			}
    415			index = 0 ;
    416			idx_end = 0 ;
    417		}
    418		while (index <= idx_end) {
    419			/*
    420			 * if group
    421			 *	add all paras of group
    422			 */
    423			pt = smt_get_ptab(pa->p_type) ;
    424			if (pt && pt->p_access == AC_GROUP && !set) {
    425				pt++ ;
    426				while (pt->p_access == AC_G ||
    427					pt->p_access == AC_GR) {
    428					smt_add_para(smc,&pcon,pt->p_num,
    429						index,local);
    430					pt++ ;
    431				}
    432			}
    433			/*
    434			 * ignore
    435			 *	AUTHORIZATION in get/set
    436			 *	SET COUNT in set
    437			 */
    438			else if (pa->p_type != SMT_P_AUTHOR &&
    439				 (!set || (pa->p_type != SMT_P1035))) {
    440				int	st ;
    441				if (pcon.pc_badset) {
    442					smt_add_para(smc,&pcon,pa->p_type,
    443						index,local) ;
    444				}
    445				else if (set) {
    446					st = smt_set_para(smc,pa,index,local,1);
    447					/*
    448					 * return para even if error
    449					 */
    450					smt_add_para(smc,&pcon,pa->p_type,
    451						index,local) ;
    452					pcon.pc_err = st ;
    453				}
    454				else {
    455					if (pt && pt->p_access == AC_S) {
    456						pcon.pc_err =
    457							SMT_RDF_ILLEGAL ;
    458					}
    459					smt_add_para(smc,&pcon,pa->p_type,
    460						index,local) ;
    461				}
    462			}
    463			if (pcon.pc_err)
    464				break ;
    465			index++ ;
    466		}
    467		len -= pa->p_len + PARA_LEN ;
    468		pa = (struct smt_para *) ((char *)pa + pa->p_len + PARA_LEN) ;
    469	}
    470	smt->smt_len = SMT_MAX_INFO_LEN - pcon.pc_len ;
    471	mb->sm_len = smt->smt_len + sizeof(struct smt_header) ;
    472
    473	/* update reason code */
    474	res->rdf_reason = pcon.pc_badset ? pcon.pc_badset :
    475			pcon.pc_err ? pcon.pc_err : SMT_RDF_SUCCESS ;
    476	if (set && (res->rdf_reason == SMT_RDF_SUCCESS)) {
    477		/*
    478		 * increment set count
    479		 * set time stamp
    480		 * store station id of last set
    481		 */
    482		smc->mib.fddiSMTSetCount.count++ ;
    483		smt_set_timestamp(smc,smc->mib.fddiSMTSetCount.timestamp) ;
    484		smc->mib.fddiSMTLastSetStationId = req->smt_sid ;
    485		smt_add_para(smc,&set_pcon,(u_short) SMT_P1035,0,0) ;
    486		smt_add_para(smc,&set_pcon,(u_short) SMT_P1036,0,0) ;
    487	}
    488	return mb;
    489}
    490
    491static int smt_authorize(struct s_smc *smc, struct smt_header *sm)
    492{
    493	struct smt_para	*pa ;
    494	int		i ;
    495	char		*p ;
    496
    497	/*
    498	 * check source station id if not zero
    499	 */
    500	p = (char *) &smc->mib.fddiPRPMFStation ;
    501	for (i = 0 ; i < 8 && !p[i] ; i++)
    502		;
    503	if (i != 8) {
    504		if (memcmp((char *) &sm->smt_sid,
    505			(char *) &smc->mib.fddiPRPMFStation,8))
    506			return 1;
    507	}
    508	/*
    509	 * check authoriziation parameter if passwd not zero
    510	 */
    511	p = (char *) smc->mib.fddiPRPMFPasswd ;
    512	for (i = 0 ; i < 8 && !p[i] ; i++)
    513		;
    514	if (i != 8) {
    515		pa = (struct smt_para *) sm_to_para(smc,sm,SMT_P_AUTHOR) ;
    516		if (!pa)
    517			return 1;
    518		if (pa->p_len != 8)
    519			return 1;
    520		if (memcmp((char *)(pa+1),(char *)smc->mib.fddiPRPMFPasswd,8))
    521			return 1;
    522	}
    523	return 0;
    524}
    525
    526static int smt_check_set_count(struct s_smc *smc, struct smt_header *sm)
    527{
    528	struct smt_para	*pa ;
    529	struct smt_p_setcount	*sc ;
    530
    531	pa = (struct smt_para *) sm_to_para(smc,sm,SMT_P1035) ;
    532	if (pa) {
    533		sc = (struct smt_p_setcount *) pa ;
    534		if ((smc->mib.fddiSMTSetCount.count != sc->count) ||
    535			memcmp((char *) smc->mib.fddiSMTSetCount.timestamp,
    536			(char *)sc->timestamp,8))
    537			return 1;
    538	}
    539	return 0;
    540}
    541
    542void smt_add_para(struct s_smc *smc, struct s_pcon *pcon, u_short para,
    543		  int index, int local)
    544{
    545	struct smt_para	*pa ;
    546	const struct s_p_tab	*pt ;
    547	struct fddi_mib_m *mib_m = NULL;
    548	struct fddi_mib_p *mib_p = NULL;
    549	int		len ;
    550	int		plen ;
    551	char		*from ;
    552	char		*to ;
    553	const char	*swap ;
    554	char		c ;
    555	int		range ;
    556	char		*mib_addr ;
    557	int		mac ;
    558	int		path ;
    559	int		port ;
    560	int		sp_len ;
    561
    562	/*
    563	 * skip if error
    564	 */
    565	if (pcon->pc_err)
    566		return ;
    567
    568	/*
    569	 * actions don't have a value
    570	 */
    571	pt = smt_get_ptab(para) ;
    572	if (pt && pt->p_access == AC_S)
    573		return ;
    574
    575	to = (char *) (pcon->pc_p) ;	/* destination pointer */
    576	len = pcon->pc_len ;		/* free space */
    577	plen = len ;			/* remember start length */
    578	pa = (struct smt_para *) to ;	/* type/length pointer */
    579	to += PARA_LEN ;		/* skip smt_para */
    580	len -= PARA_LEN ;
    581	/*
    582	 * set index if required
    583	 */
    584	if (((range = (para & 0xf000)) == 0x2000) ||
    585		range == 0x3000 || range == 0x4000) {
    586		if (len < 4)
    587			goto wrong_error ;
    588		to[0] = 0 ;
    589		to[1] = 0 ;
    590		to[2] = 0 ;
    591		to[3] = index ;
    592		len -= 4 ;
    593		to += 4 ;
    594	}
    595	mac = index - INDEX_MAC ;
    596	path = index - INDEX_PATH ;
    597	port = index - INDEX_PORT ;
    598	/*
    599	 * get pointer to mib
    600	 */
    601	switch (range) {
    602	case 0x1000 :
    603	default :
    604		mib_addr = (char *) (&smc->mib) ;
    605		break ;
    606	case 0x2000 :
    607		if (mac < 0 || mac >= NUMMACS) {
    608			pcon->pc_err = SMT_RDF_NOPARAM ;
    609			return ;
    610		}
    611		mib_addr = (char *) (&smc->mib.m[mac]) ;
    612		mib_m = (struct fddi_mib_m *) mib_addr ;
    613		break ;
    614	case 0x3000 :
    615		if (path < 0 || path >= NUMPATHS) {
    616			pcon->pc_err = SMT_RDF_NOPARAM ;
    617			return ;
    618		}
    619		mib_addr = (char *) (&smc->mib.a[path]) ;
    620		break ;
    621	case 0x4000 :
    622		if (port < 0 || port >= smt_mib_phys(smc)) {
    623			pcon->pc_err = SMT_RDF_NOPARAM ;
    624			return ;
    625		}
    626		mib_addr = (char *) (&smc->mib.p[port_to_mib(smc,port)]) ;
    627		mib_p = (struct fddi_mib_p *) mib_addr ;
    628		break ;
    629	}
    630	/*
    631	 * check special paras
    632	 */
    633	swap = NULL;
    634	switch (para) {
    635	case SMT_P10F0 :
    636	case SMT_P10F1 :
    637#ifdef	ESS
    638	case SMT_P10F2 :
    639	case SMT_P10F3 :
    640	case SMT_P10F4 :
    641	case SMT_P10F5 :
    642	case SMT_P10F6 :
    643	case SMT_P10F7 :
    644#endif
    645#ifdef	SBA
    646	case SMT_P10F8 :
    647	case SMT_P10F9 :
    648#endif
    649	case SMT_P20F1 :
    650		if (!local) {
    651			pcon->pc_err = SMT_RDF_NOPARAM ;
    652			return ;
    653		}
    654		break ;
    655	case SMT_P2034 :
    656	case SMT_P2046 :
    657	case SMT_P2047 :
    658	case SMT_P204A :
    659	case SMT_P2051 :
    660	case SMT_P2052 :
    661		mac_update_counter(smc) ;
    662		break ;
    663	case SMT_P4022:
    664		mib_p->fddiPORTPC_LS = LS2MIB(
    665			sm_pm_get_ls(smc,port_to_mib(smc,port))) ;
    666		break ;
    667	case SMT_P_REASON :
    668		*(u32 *)to = 0 ;
    669		sp_len = 4 ;
    670		goto sp_done ;
    671	case SMT_P1033 :			/* time stamp */
    672		smt_set_timestamp(smc,smc->mib.fddiSMTTimeStamp) ;
    673		break ;
    674
    675	case SMT_P1020:				/* port indexes */
    676#if	NUMPHYS == 12
    677		swap = "IIIIIIIIIIII" ;
    678#else
    679#if	NUMPHYS == 2
    680		if (smc->s.sas == SMT_SAS)
    681			swap = "I" ;
    682		else
    683			swap = "II" ;
    684#else
    685#if	NUMPHYS == 24
    686		swap = "IIIIIIIIIIIIIIIIIIIIIIII" ;
    687#else
    688	????
    689#endif
    690#endif
    691#endif
    692		break ;
    693	case SMT_P3212 :
    694		{
    695			sp_len = cem_build_path(smc,to,path) ;
    696			goto sp_done ;
    697		}
    698	case SMT_P1048 :		/* peer wrap condition */
    699		{
    700			struct smt_p_1048	*sp ;
    701			sp = (struct smt_p_1048 *) to ;
    702			sp->p1048_flag = smc->mib.fddiSMTPeerWrapFlag ;
    703			sp->p1048_cf_state = smc->mib.fddiSMTCF_State ;
    704			sp_len = sizeof(struct smt_p_1048) ;
    705			goto sp_done ;
    706		}
    707	case SMT_P208C :
    708		{
    709			struct smt_p_208c	*sp ;
    710			sp = (struct smt_p_208c *) to ;
    711			sp->p208c_flag =
    712				smc->mib.m[MAC0].fddiMACDuplicateAddressCond ;
    713			sp->p208c_dupcondition =
    714				(mib_m->fddiMACDA_Flag ? SMT_ST_MY_DUPA : 0) |
    715				(mib_m->fddiMACUNDA_Flag ? SMT_ST_UNA_DUPA : 0);
    716			sp->p208c_fddilong =
    717				mib_m->fddiMACSMTAddress ;
    718			sp->p208c_fddiunalong =
    719				mib_m->fddiMACUpstreamNbr ;
    720			sp->p208c_pad = 0 ;
    721			sp_len = sizeof(struct smt_p_208c) ;
    722			goto sp_done ;
    723		}
    724	case SMT_P208D :		/* frame error condition */
    725		{
    726			struct smt_p_208d	*sp ;
    727			sp = (struct smt_p_208d *) to ;
    728			sp->p208d_flag =
    729				mib_m->fddiMACFrameErrorFlag ;
    730			sp->p208d_frame_ct =
    731				mib_m->fddiMACFrame_Ct ;
    732			sp->p208d_error_ct =
    733				mib_m->fddiMACError_Ct ;
    734			sp->p208d_lost_ct =
    735				mib_m->fddiMACLost_Ct ;
    736			sp->p208d_ratio =
    737				mib_m->fddiMACFrameErrorRatio ;
    738			sp_len = sizeof(struct smt_p_208d) ;
    739			goto sp_done ;
    740		}
    741	case SMT_P208E :		/* not copied condition */
    742		{
    743			struct smt_p_208e	*sp ;
    744			sp = (struct smt_p_208e *) to ;
    745			sp->p208e_flag =
    746				mib_m->fddiMACNotCopiedFlag ;
    747			sp->p208e_not_copied =
    748				mib_m->fddiMACNotCopied_Ct ;
    749			sp->p208e_copied =
    750				mib_m->fddiMACCopied_Ct ;
    751			sp->p208e_not_copied_ratio =
    752				mib_m->fddiMACNotCopiedRatio ;
    753			sp_len = sizeof(struct smt_p_208e) ;
    754			goto sp_done ;
    755		}
    756	case SMT_P208F :	/* neighbor change event */
    757		{
    758			struct smt_p_208f	*sp ;
    759			sp = (struct smt_p_208f *) to ;
    760			sp->p208f_multiple =
    761				mib_m->fddiMACMultiple_N ;
    762			sp->p208f_nacondition =
    763				mib_m->fddiMACDuplicateAddressCond ;
    764			sp->p208f_old_una =
    765				mib_m->fddiMACOldUpstreamNbr ;
    766			sp->p208f_new_una =
    767				mib_m->fddiMACUpstreamNbr ;
    768			sp->p208f_old_dna =
    769				mib_m->fddiMACOldDownstreamNbr ;
    770			sp->p208f_new_dna =
    771				mib_m->fddiMACDownstreamNbr ;
    772			sp->p208f_curren_path =
    773				mib_m->fddiMACCurrentPath ;
    774			sp->p208f_smt_address =
    775				mib_m->fddiMACSMTAddress ;
    776			sp_len = sizeof(struct smt_p_208f) ;
    777			goto sp_done ;
    778		}
    779	case SMT_P2090 :
    780		{
    781			struct smt_p_2090	*sp ;
    782			sp = (struct smt_p_2090 *) to ;
    783			sp->p2090_multiple =
    784				mib_m->fddiMACMultiple_P ;
    785			sp->p2090_availablepaths =
    786				mib_m->fddiMACAvailablePaths ;
    787			sp->p2090_currentpath =
    788				mib_m->fddiMACCurrentPath ;
    789			sp->p2090_requestedpaths =
    790				mib_m->fddiMACRequestedPaths ;
    791			sp_len = sizeof(struct smt_p_2090) ;
    792			goto sp_done ;
    793		}
    794	case SMT_P4050 :
    795		{
    796			struct smt_p_4050	*sp ;
    797			sp = (struct smt_p_4050 *) to ;
    798			sp->p4050_flag =
    799				mib_p->fddiPORTLerFlag ;
    800			sp->p4050_pad = 0 ;
    801			sp->p4050_cutoff =
    802				mib_p->fddiPORTLer_Cutoff ;
    803			sp->p4050_alarm =
    804				mib_p->fddiPORTLer_Alarm ;
    805			sp->p4050_estimate =
    806				mib_p->fddiPORTLer_Estimate ;
    807			sp->p4050_reject_ct =
    808				mib_p->fddiPORTLem_Reject_Ct ;
    809			sp->p4050_ct =
    810				mib_p->fddiPORTLem_Ct ;
    811			sp_len = sizeof(struct smt_p_4050) ;
    812			goto sp_done ;
    813		}
    814
    815	case SMT_P4051 :
    816		{
    817			struct smt_p_4051	*sp ;
    818			sp = (struct smt_p_4051 *) to ;
    819			sp->p4051_multiple =
    820				mib_p->fddiPORTMultiple_U ;
    821			sp->p4051_porttype =
    822				mib_p->fddiPORTMy_Type ;
    823			sp->p4051_connectstate =
    824				mib_p->fddiPORTConnectState ;
    825			sp->p4051_pc_neighbor =
    826				mib_p->fddiPORTNeighborType ;
    827			sp->p4051_pc_withhold =
    828				mib_p->fddiPORTPC_Withhold ;
    829			sp_len = sizeof(struct smt_p_4051) ;
    830			goto sp_done ;
    831		}
    832	case SMT_P4052 :
    833		{
    834			struct smt_p_4052	*sp ;
    835			sp = (struct smt_p_4052 *) to ;
    836			sp->p4052_flag =
    837				mib_p->fddiPORTEB_Condition ;
    838			sp->p4052_eberrorcount =
    839				mib_p->fddiPORTEBError_Ct ;
    840			sp_len = sizeof(struct smt_p_4052) ;
    841			goto sp_done ;
    842		}
    843	case SMT_P4053 :
    844		{
    845			struct smt_p_4053	*sp ;
    846			sp = (struct smt_p_4053 *) to ;
    847			sp->p4053_multiple =
    848				mib_p->fddiPORTMultiple_P ;
    849			sp->p4053_availablepaths =
    850				mib_p->fddiPORTAvailablePaths ;
    851			sp->p4053_currentpath =
    852				mib_p->fddiPORTCurrentPath ;
    853			memcpy(	(char *) &sp->p4053_requestedpaths,
    854				(char *) mib_p->fddiPORTRequestedPaths,4) ;
    855			sp->p4053_mytype =
    856				mib_p->fddiPORTMy_Type ;
    857			sp->p4053_neighbortype =
    858				mib_p->fddiPORTNeighborType ;
    859			sp_len = sizeof(struct smt_p_4053) ;
    860			goto sp_done ;
    861		}
    862	default :
    863		break ;
    864	}
    865	/*
    866	 * in table ?
    867	 */
    868	if (!pt) {
    869		pcon->pc_err = (para & 0xff00) ? SMT_RDF_NOPARAM :
    870						SMT_RDF_ILLEGAL ;
    871		return ;
    872	}
    873	/*
    874	 * check access rights
    875	 */
    876	switch (pt->p_access) {
    877	case AC_G :
    878	case AC_GR :
    879		break ;
    880	default :
    881		pcon->pc_err = SMT_RDF_ILLEGAL ;
    882		return ;
    883	}
    884	from = mib_addr + pt->p_offset ;
    885	if (!swap)
    886		swap = pt->p_swap ;		/* pointer to swap string */
    887
    888	/*
    889	 * copy values
    890	 */
    891	while ((c = *swap++)) {
    892		switch(c) {
    893		case 'b' :
    894		case 'w' :
    895		case 'l' :
    896			break ;
    897		case 'S' :
    898		case 'E' :
    899		case 'R' :
    900		case 'r' :
    901			if (len < 4)
    902				goto len_error ;
    903			to[0] = 0 ;
    904			to[1] = 0 ;
    905#ifdef	LITTLE_ENDIAN
    906			if (c == 'r') {
    907				to[2] = *from++ ;
    908				to[3] = *from++ ;
    909			}
    910			else {
    911				to[3] = *from++ ;
    912				to[2] = *from++ ;
    913			}
    914#else
    915			to[2] = *from++ ;
    916			to[3] = *from++ ;
    917#endif
    918			to += 4 ;
    919			len -= 4 ;
    920			break ;
    921		case 'I' :		/* for SET of port indexes */
    922			if (len < 2)
    923				goto len_error ;
    924#ifdef	LITTLE_ENDIAN
    925			to[1] = *from++ ;
    926			to[0] = *from++ ;
    927#else
    928			to[0] = *from++ ;
    929			to[1] = *from++ ;
    930#endif
    931			to += 2 ;
    932			len -= 2 ;
    933			break ;
    934		case 'F' :
    935		case 'B' :
    936			if (len < 4)
    937				goto len_error ;
    938			len -= 4 ;
    939			to[0] = 0 ;
    940			to[1] = 0 ;
    941			to[2] = 0 ;
    942			to[3] = *from++ ;
    943			to += 4 ;
    944			break ;
    945		case 'C' :
    946		case 'T' :
    947		case 'L' :
    948			if (len < 4)
    949				goto len_error ;
    950#ifdef	LITTLE_ENDIAN
    951			to[3] = *from++ ;
    952			to[2] = *from++ ;
    953			to[1] = *from++ ;
    954			to[0] = *from++ ;
    955#else
    956			to[0] = *from++ ;
    957			to[1] = *from++ ;
    958			to[2] = *from++ ;
    959			to[3] = *from++ ;
    960#endif
    961			len -= 4 ;
    962			to += 4 ;
    963			break ;
    964		case '2' :		/* PortMacIndicated */
    965			if (len < 4)
    966				goto len_error ;
    967			to[0] = 0 ;
    968			to[1] = 0 ;
    969			to[2] = *from++ ;
    970			to[3] = *from++ ;
    971			len -= 4 ;
    972			to += 4 ;
    973			break ;
    974		case '4' :
    975			if (len < 4)
    976				goto len_error ;
    977			to[0] = *from++ ;
    978			to[1] = *from++ ;
    979			to[2] = *from++ ;
    980			to[3] = *from++ ;
    981			len -= 4 ;
    982			to += 4 ;
    983			break ;
    984		case 'A' :
    985			if (len < 8)
    986				goto len_error ;
    987			to[0] = 0 ;
    988			to[1] = 0 ;
    989			memcpy((char *) to+2,(char *) from,6) ;
    990			to += 8 ;
    991			from += 8 ;
    992			len -= 8 ;
    993			break ;
    994		case '8' :
    995			if (len < 8)
    996				goto len_error ;
    997			memcpy((char *) to,(char *) from,8) ;
    998			to += 8 ;
    999			from += 8 ;
   1000			len -= 8 ;
   1001			break ;
   1002		case 'D' :
   1003			if (len < 32)
   1004				goto len_error ;
   1005			memcpy((char *) to,(char *) from,32) ;
   1006			to += 32 ;
   1007			from += 32 ;
   1008			len -= 32 ;
   1009			break ;
   1010		case 'P' :		/* timestamp is NOT swapped */
   1011			if (len < 8)
   1012				goto len_error ;
   1013			to[0] = *from++ ;
   1014			to[1] = *from++ ;
   1015			to[2] = *from++ ;
   1016			to[3] = *from++ ;
   1017			to[4] = *from++ ;
   1018			to[5] = *from++ ;
   1019			to[6] = *from++ ;
   1020			to[7] = *from++ ;
   1021			to += 8 ;
   1022			len -= 8 ;
   1023			break ;
   1024		default :
   1025			SMT_PANIC(smc,SMT_E0119, SMT_E0119_MSG) ;
   1026			break ;
   1027		}
   1028	}
   1029
   1030done:
   1031	/*
   1032	 * make it even (in case of 'I' encoding)
   1033	 * note: len is DECREMENTED
   1034	 */
   1035	if (len & 3) {
   1036		to[0] = 0 ;
   1037		to[1] = 0 ;
   1038		to += 4 - (len & 3 ) ;
   1039		len = len & ~ 3 ;
   1040	}
   1041
   1042	/* set type and length */
   1043	pa->p_type = para ;
   1044	pa->p_len = plen - len - PARA_LEN ;
   1045	/* return values */
   1046	pcon->pc_p = (void *) to ;
   1047	pcon->pc_len = len ;
   1048	return ;
   1049
   1050sp_done:
   1051	len -= sp_len ;
   1052	to += sp_len ;
   1053	goto done ;
   1054
   1055len_error:
   1056	/* parameter does not fit in frame */
   1057	pcon->pc_err = SMT_RDF_TOOLONG ;
   1058	return ;
   1059
   1060wrong_error:
   1061	pcon->pc_err = SMT_RDF_LENGTH ;
   1062}
   1063
   1064/*
   1065 * set parameter
   1066 */
   1067static int smt_set_para(struct s_smc *smc, struct smt_para *pa, int index,
   1068			int local, int set)
   1069{
   1070#define IFSET(x)	if (set) (x)
   1071
   1072	const struct s_p_tab	*pt ;
   1073	int		len ;
   1074	char		*from ;
   1075	char		*to ;
   1076	const char	*swap ;
   1077	char		c ;
   1078	char		*mib_addr ;
   1079	struct fddi_mib	*mib ;
   1080	struct fddi_mib_m	*mib_m = NULL;
   1081	struct fddi_mib_a	*mib_a = NULL;
   1082	struct fddi_mib_p	*mib_p = NULL;
   1083	int		mac ;
   1084	int		path ;
   1085	int		port ;
   1086	SK_LOC_DECL(u_char,byte_val) ;
   1087	SK_LOC_DECL(u_short,word_val) ;
   1088	SK_LOC_DECL(u_long,long_val) ;
   1089
   1090	mac = index - INDEX_MAC ;
   1091	path = index - INDEX_PATH ;
   1092	port = index - INDEX_PORT ;
   1093	len = pa->p_len ;
   1094	from = (char *) (pa + 1 ) ;
   1095
   1096	mib = &smc->mib ;
   1097	switch (pa->p_type & 0xf000) {
   1098	case 0x1000 :
   1099	default :
   1100		mib_addr = (char *) mib ;
   1101		break ;
   1102	case 0x2000 :
   1103		if (mac < 0 || mac >= NUMMACS) {
   1104			return SMT_RDF_NOPARAM;
   1105		}
   1106		mib_m = &smc->mib.m[mac] ;
   1107		mib_addr = (char *) mib_m ;
   1108		from += 4 ;		/* skip index */
   1109		len -= 4 ;
   1110		break ;
   1111	case 0x3000 :
   1112		if (path < 0 || path >= NUMPATHS) {
   1113			return SMT_RDF_NOPARAM;
   1114		}
   1115		mib_a = &smc->mib.a[path] ;
   1116		mib_addr = (char *) mib_a ;
   1117		from += 4 ;		/* skip index */
   1118		len -= 4 ;
   1119		break ;
   1120	case 0x4000 :
   1121		if (port < 0 || port >= smt_mib_phys(smc)) {
   1122			return SMT_RDF_NOPARAM;
   1123		}
   1124		mib_p = &smc->mib.p[port_to_mib(smc,port)] ;
   1125		mib_addr = (char *) mib_p ;
   1126		from += 4 ;		/* skip index */
   1127		len -= 4 ;
   1128		break ;
   1129	}
   1130	switch (pa->p_type) {
   1131	case SMT_P10F0 :
   1132	case SMT_P10F1 :
   1133#ifdef	ESS
   1134	case SMT_P10F2 :
   1135	case SMT_P10F3 :
   1136	case SMT_P10F4 :
   1137	case SMT_P10F5 :
   1138	case SMT_P10F6 :
   1139	case SMT_P10F7 :
   1140#endif
   1141#ifdef	SBA
   1142	case SMT_P10F8 :
   1143	case SMT_P10F9 :
   1144#endif
   1145	case SMT_P20F1 :
   1146		if (!local)
   1147			return SMT_RDF_NOPARAM;
   1148		break ;
   1149	}
   1150	pt = smt_get_ptab(pa->p_type) ;
   1151	if (!pt)
   1152		return (pa->p_type & 0xff00) ? SMT_RDF_NOPARAM :
   1153					       SMT_RDF_ILLEGAL;
   1154	switch (pt->p_access) {
   1155	case AC_GR :
   1156	case AC_S :
   1157		break ;
   1158	default :
   1159		return SMT_RDF_ILLEGAL;
   1160	}
   1161	to = mib_addr + pt->p_offset ;
   1162	swap = pt->p_swap ;		/* pointer to swap string */
   1163
   1164	while (swap && (c = *swap++)) {
   1165		switch(c) {
   1166		case 'b' :
   1167			to = (char *) &byte_val ;
   1168			break ;
   1169		case 'w' :
   1170			to = (char *) &word_val ;
   1171			break ;
   1172		case 'l' :
   1173			to = (char *) &long_val ;
   1174			break ;
   1175		case 'S' :
   1176		case 'E' :
   1177		case 'R' :
   1178		case 'r' :
   1179			if (len < 4) {
   1180				goto len_error ;
   1181			}
   1182			if (from[0] | from[1])
   1183				goto val_error ;
   1184#ifdef	LITTLE_ENDIAN
   1185			if (c == 'r') {
   1186				to[0] = from[2] ;
   1187				to[1] = from[3] ;
   1188			}
   1189			else {
   1190				to[1] = from[2] ;
   1191				to[0] = from[3] ;
   1192			}
   1193#else
   1194			to[0] = from[2] ;
   1195			to[1] = from[3] ;
   1196#endif
   1197			from += 4 ;
   1198			to += 2 ;
   1199			len -= 4 ;
   1200			break ;
   1201		case 'F' :
   1202		case 'B' :
   1203			if (len < 4) {
   1204				goto len_error ;
   1205			}
   1206			if (from[0] | from[1] | from[2])
   1207				goto val_error ;
   1208			to[0] = from[3] ;
   1209			len -= 4 ;
   1210			from += 4 ;
   1211			to += 4 ;
   1212			break ;
   1213		case 'C' :
   1214		case 'T' :
   1215		case 'L' :
   1216			if (len < 4) {
   1217				goto len_error ;
   1218			}
   1219#ifdef	LITTLE_ENDIAN
   1220			to[3] = *from++ ;
   1221			to[2] = *from++ ;
   1222			to[1] = *from++ ;
   1223			to[0] = *from++ ;
   1224#else
   1225			to[0] = *from++ ;
   1226			to[1] = *from++ ;
   1227			to[2] = *from++ ;
   1228			to[3] = *from++ ;
   1229#endif
   1230			len -= 4 ;
   1231			to += 4 ;
   1232			break ;
   1233		case 'A' :
   1234			if (len < 8)
   1235				goto len_error ;
   1236			if (set)
   1237				memcpy(to,from+2,6) ;
   1238			to += 8 ;
   1239			from += 8 ;
   1240			len -= 8 ;
   1241			break ;
   1242		case '4' :
   1243			if (len < 4)
   1244				goto len_error ;
   1245			if (set)
   1246				memcpy(to,from,4) ;
   1247			to += 4 ;
   1248			from += 4 ;
   1249			len -= 4 ;
   1250			break ;
   1251		case '8' :
   1252			if (len < 8)
   1253				goto len_error ;
   1254			if (set)
   1255				memcpy(to,from,8) ;
   1256			to += 8 ;
   1257			from += 8 ;
   1258			len -= 8 ;
   1259			break ;
   1260		case 'D' :
   1261			if (len < 32)
   1262				goto len_error ;
   1263			if (set)
   1264				memcpy(to,from,32) ;
   1265			to += 32 ;
   1266			from += 32 ;
   1267			len -= 32 ;
   1268			break ;
   1269		case 'P' :		/* timestamp is NOT swapped */
   1270			if (set) {
   1271				to[0] = *from++ ;
   1272				to[1] = *from++ ;
   1273				to[2] = *from++ ;
   1274				to[3] = *from++ ;
   1275				to[4] = *from++ ;
   1276				to[5] = *from++ ;
   1277				to[6] = *from++ ;
   1278				to[7] = *from++ ;
   1279			}
   1280			to += 8 ;
   1281			len -= 8 ;
   1282			break ;
   1283		default :
   1284			SMT_PANIC(smc,SMT_E0120, SMT_E0120_MSG) ;
   1285			return SMT_RDF_ILLEGAL;
   1286		}
   1287	}
   1288	/*
   1289	 * actions and internal updates
   1290	 */
   1291	switch (pa->p_type) {
   1292	case SMT_P101A:			/* fddiSMTConfigPolicy */
   1293		if (word_val & ~1)
   1294			goto val_error ;
   1295		IFSET(mib->fddiSMTConfigPolicy = word_val) ;
   1296		break ;
   1297	case SMT_P101B :		/* fddiSMTConnectionPolicy */
   1298		if (!(word_val & POLICY_MM))
   1299			goto val_error ;
   1300		IFSET(mib->fddiSMTConnectionPolicy = word_val) ;
   1301		break ;
   1302	case SMT_P101D : 		/* fddiSMTTT_Notify */
   1303		if (word_val < 2 || word_val > 30)
   1304			goto val_error ;
   1305		IFSET(mib->fddiSMTTT_Notify = word_val) ;
   1306		break ;
   1307	case SMT_P101E :		/* fddiSMTStatRptPolicy */
   1308		if (byte_val & ~1)
   1309			goto val_error ;
   1310		IFSET(mib->fddiSMTStatRptPolicy = byte_val) ;
   1311		break ;
   1312	case SMT_P101F :		/* fddiSMTTrace_MaxExpiration */
   1313		/*
   1314		 * note: lower limit trace_max = 6.001773... s
   1315		 * NO upper limit
   1316		 */
   1317		if (long_val < (long)0x478bf51L)
   1318			goto val_error ;
   1319		IFSET(mib->fddiSMTTrace_MaxExpiration = long_val) ;
   1320		break ;
   1321#ifdef	ESS
   1322	case SMT_P10F2 :		/* fddiESSPayload */
   1323		if (long_val > 1562)
   1324			goto val_error ;
   1325		if (set && smc->mib.fddiESSPayload != long_val) {
   1326			smc->ess.raf_act_timer_poll = TRUE ;
   1327			smc->mib.fddiESSPayload = long_val ;
   1328		}
   1329		break ;
   1330	case SMT_P10F3 :		/* fddiESSOverhead */
   1331		if (long_val < 50 || long_val > 5000)
   1332			goto val_error ;
   1333		if (set && smc->mib.fddiESSPayload &&
   1334			smc->mib.fddiESSOverhead != long_val) {
   1335			smc->ess.raf_act_timer_poll = TRUE ;
   1336			smc->mib.fddiESSOverhead = long_val ;
   1337		}
   1338		break ;
   1339	case SMT_P10F4 :		/* fddiESSMaxTNeg */
   1340		if (long_val > -MS2BCLK(5) || long_val < -MS2BCLK(165))
   1341			goto val_error ;
   1342		IFSET(mib->fddiESSMaxTNeg = long_val) ;
   1343		break ;
   1344	case SMT_P10F5 :		/* fddiESSMinSegmentSize */
   1345		if (long_val < 1 || long_val > 4478)
   1346			goto val_error ;
   1347		IFSET(mib->fddiESSMinSegmentSize = long_val) ;
   1348		break ;
   1349	case SMT_P10F6 :		/* fddiESSCategory */
   1350		if ((long_val & 0xffff) != 1)
   1351			goto val_error ;
   1352		IFSET(mib->fddiESSCategory = long_val) ;
   1353		break ;
   1354	case SMT_P10F7 :		/* fddiESSSyncTxMode */
   1355		if (word_val > 1)
   1356			goto val_error ;
   1357		IFSET(mib->fddiESSSynchTxMode = word_val) ;
   1358		break ;
   1359#endif
   1360#ifdef	SBA
   1361	case SMT_P10F8 :		/* fddiSBACommand */
   1362		if (byte_val != SB_STOP && byte_val != SB_START)
   1363			goto val_error ;
   1364		IFSET(mib->fddiSBACommand = byte_val) ;
   1365		break ;
   1366	case SMT_P10F9 :		/* fddiSBAAvailable */
   1367		if (byte_val > 100)
   1368			goto val_error ;
   1369		IFSET(mib->fddiSBAAvailable = byte_val) ;
   1370		break ;
   1371#endif
   1372	case SMT_P2020 :		/* fddiMACRequestedPaths */
   1373		if ((word_val & (MIB_P_PATH_PRIM_PREFER |
   1374			MIB_P_PATH_PRIM_ALTER)) == 0 )
   1375			goto val_error ;
   1376		IFSET(mib_m->fddiMACRequestedPaths = word_val) ;
   1377		break ;
   1378	case SMT_P205F :		/* fddiMACFrameErrorThreshold */
   1379		/* 0 .. ffff acceptable */
   1380		IFSET(mib_m->fddiMACFrameErrorThreshold = word_val) ;
   1381		break ;
   1382	case SMT_P2067 :		/* fddiMACNotCopiedThreshold */
   1383		/* 0 .. ffff acceptable */
   1384		IFSET(mib_m->fddiMACNotCopiedThreshold = word_val) ;
   1385		break ;
   1386	case SMT_P2076:			/* fddiMACMA_UnitdataEnable */
   1387		if (byte_val & ~1)
   1388			goto val_error ;
   1389		if (set) {
   1390			mib_m->fddiMACMA_UnitdataEnable = byte_val ;
   1391			queue_event(smc,EVENT_RMT,RM_ENABLE_FLAG) ;
   1392		}
   1393		break ;
   1394	case SMT_P20F1 :		/* fddiMACT_Min */
   1395		IFSET(mib_m->fddiMACT_Min = long_val) ;
   1396		break ;
   1397	case SMT_P320F :
   1398		if (long_val > 1562)
   1399			goto val_error ;
   1400		IFSET(mib_a->fddiPATHSbaPayload = long_val) ;
   1401#ifdef	ESS
   1402		if (set)
   1403			ess_para_change(smc) ;
   1404#endif
   1405		break ;
   1406	case SMT_P3210 :
   1407		if (long_val > 5000)
   1408			goto val_error ;
   1409		
   1410		if (long_val != 0 && mib_a->fddiPATHSbaPayload == 0)
   1411			goto val_error ;
   1412
   1413		IFSET(mib_a->fddiPATHSbaOverhead = long_val) ;
   1414#ifdef	ESS
   1415		if (set)
   1416			ess_para_change(smc) ;
   1417#endif
   1418		break ;
   1419	case SMT_P3213:			/* fddiPATHT_Rmode */
   1420		/* no limit :
   1421		 * 0 .. 343.597 => 0 .. 2e32 * 80nS
   1422		 */
   1423		if (set) {
   1424			mib_a->fddiPATHT_Rmode = long_val ;
   1425			rtm_set_timer(smc) ;
   1426		}
   1427		break ;
   1428	case SMT_P3214 :		/* fddiPATHSbaAvailable */
   1429		if (long_val > 0x00BEBC20L)
   1430			goto val_error ;
   1431#ifdef SBA 
   1432		if (set && mib->fddiSBACommand == SB_STOP)
   1433			goto val_error ;
   1434#endif
   1435		IFSET(mib_a->fddiPATHSbaAvailable = long_val) ;
   1436		break ;
   1437	case SMT_P3215 :		/* fddiPATHTVXLowerBound */
   1438		IFSET(mib_a->fddiPATHTVXLowerBound = long_val) ;
   1439		goto change_mac_para ;
   1440	case SMT_P3216 :		/* fddiPATHT_MaxLowerBound */
   1441		IFSET(mib_a->fddiPATHT_MaxLowerBound = long_val) ;
   1442		goto change_mac_para ;
   1443	case SMT_P3217 :		/* fddiPATHMaxT_Req */
   1444		IFSET(mib_a->fddiPATHMaxT_Req = long_val) ;
   1445
   1446change_mac_para:
   1447		if (set && smt_set_mac_opvalues(smc)) {
   1448			RS_SET(smc,RS_EVENT) ;
   1449			smc->sm.please_reconnect = 1 ;
   1450			queue_event(smc,EVENT_ECM,EC_DISCONNECT) ;
   1451		}
   1452		break ;
   1453	case SMT_P400E :		/* fddiPORTConnectionPolicies */
   1454		if (byte_val > 1)
   1455			goto val_error ;
   1456		IFSET(mib_p->fddiPORTConnectionPolicies = byte_val) ;
   1457		break ;
   1458	case SMT_P4011 :		/* fddiPORTRequestedPaths */
   1459		/* all 3*8 bits allowed */
   1460		IFSET(memcpy((char *)mib_p->fddiPORTRequestedPaths,
   1461			(char *)&long_val,4)) ;
   1462		break ;
   1463	case SMT_P401F:			/* fddiPORTMaint_LS */
   1464		if (word_val > 4)
   1465			goto val_error ;
   1466		IFSET(mib_p->fddiPORTMaint_LS = word_val) ;
   1467		break ;
   1468	case SMT_P403A :		/* fddiPORTLer_Cutoff */
   1469		if (byte_val < 4 || byte_val > 15)
   1470			goto val_error ;
   1471		IFSET(mib_p->fddiPORTLer_Cutoff = byte_val) ;
   1472		break ;
   1473	case SMT_P403B :		/* fddiPORTLer_Alarm */
   1474		if (byte_val < 4 || byte_val > 15)
   1475			goto val_error ;
   1476		IFSET(mib_p->fddiPORTLer_Alarm = byte_val) ;
   1477		break ;
   1478
   1479	/*
   1480	 * Actions
   1481	 */
   1482	case SMT_P103C :		/* fddiSMTStationAction */
   1483		if (smt_action(smc,SMT_STATION_ACTION, (int) word_val, 0))
   1484			goto val_error ;
   1485		break ;
   1486	case SMT_P4046:			/* fddiPORTAction */
   1487		if (smt_action(smc,SMT_PORT_ACTION, (int) word_val,
   1488			port_to_mib(smc,port)))
   1489			goto val_error ;
   1490		break ;
   1491	default :
   1492		break ;
   1493	}
   1494	return 0;
   1495
   1496val_error:
   1497	/* parameter value in frame is out of range */
   1498	return SMT_RDF_RANGE;
   1499
   1500len_error:
   1501	/* parameter value in frame is too short */
   1502	return SMT_RDF_LENGTH;
   1503
   1504#if	0
   1505no_author_error:
   1506	/* parameter not setable, because the SBA is not active
   1507	 * Please note: we give the return code 'not authorizeed
   1508	 *  because SBA denied is not a valid return code in the
   1509	 * PMF protocol.
   1510	 */
   1511	return SMT_RDF_AUTHOR;
   1512#endif
   1513}
   1514
   1515static const struct s_p_tab *smt_get_ptab(u_short para)
   1516{
   1517	const struct s_p_tab	*pt ;
   1518	for (pt = p_tab ; pt->p_num && pt->p_num != para ; pt++)
   1519		;
   1520	return pt->p_num ? pt : NULL;
   1521}
   1522
   1523static int smt_mib_phys(struct s_smc *smc)
   1524{
   1525#ifdef	CONCENTRATOR
   1526	SK_UNUSED(smc) ;
   1527
   1528	return NUMPHYS;
   1529#else
   1530	if (smc->s.sas == SMT_SAS)
   1531		return 1;
   1532	return NUMPHYS;
   1533#endif
   1534}
   1535
   1536static int port_to_mib(struct s_smc *smc, int p)
   1537{
   1538#ifdef	CONCENTRATOR
   1539	SK_UNUSED(smc) ;
   1540
   1541	return p;
   1542#else
   1543	if (smc->s.sas == SMT_SAS)
   1544		return PS;
   1545	return p;
   1546#endif
   1547}
   1548
   1549
   1550#ifdef	DEBUG
   1551#ifndef	BOOT
   1552void dump_smt(struct s_smc *smc, struct smt_header *sm, char *text)
   1553{
   1554	int	len ;
   1555	struct smt_para	*pa ;
   1556	char	*c ;
   1557	int	n ;
   1558	int	nn ;
   1559#ifdef	LITTLE_ENDIAN
   1560	int	smtlen ;
   1561#endif
   1562
   1563	SK_UNUSED(smc) ;
   1564
   1565#ifdef	DEBUG_BRD
   1566	if (smc->debug.d_smtf < 2)
   1567#else
   1568	if (debug.d_smtf < 2)
   1569#endif
   1570		return ;
   1571#ifdef	LITTLE_ENDIAN
   1572	smtlen = sm->smt_len + sizeof(struct smt_header) ;
   1573#endif
   1574	printf("SMT Frame [%s]:\nDA  ",text) ;
   1575	dump_hex((char *) &sm->smt_dest,6) ;
   1576	printf("\tSA ") ;
   1577	dump_hex((char *) &sm->smt_source,6) ;
   1578	printf(" Class %x Type %x Version %x\n",
   1579		sm->smt_class,sm->smt_type,sm->smt_version)  ;
   1580	printf("TID %x\t\tSID ", sm->smt_tid);
   1581	dump_hex((char *) &sm->smt_sid,8) ;
   1582	printf(" LEN %x\n",sm->smt_len) ;
   1583
   1584	len = sm->smt_len ;
   1585	pa = (struct smt_para *) (sm + 1) ;
   1586	while (len > 0 ) {
   1587		int	plen ;
   1588#ifdef UNIX
   1589		printf("TYPE %x LEN %x VALUE\t",pa->p_type,pa->p_len) ;
   1590#else
   1591		printf("TYPE %04x LEN %2x VALUE\t",pa->p_type,pa->p_len) ;
   1592#endif
   1593		n = pa->p_len ;
   1594		if ( (n < 0 ) || (n > (int)(len - PARA_LEN))) {
   1595			n = len - PARA_LEN ;
   1596			printf(" BAD LENGTH\n") ;
   1597			break ;
   1598		}
   1599#ifdef	LITTLE_ENDIAN
   1600		smt_swap_para(sm,smtlen,0) ;
   1601#endif
   1602		if (n < 24) {
   1603			dump_hex((char *)(pa+1),(int) n) ;
   1604			printf("\n") ;
   1605		}
   1606		else {
   1607			int	first = 0 ;
   1608			c = (char *)(pa+1) ;
   1609			dump_hex(c,16) ;
   1610			printf("\n") ;
   1611			n -= 16 ;
   1612			c += 16 ;
   1613			while (n > 0) {
   1614				nn = (n > 16) ? 16 : n ;
   1615				if (n > 64) {
   1616					if (first == 0)
   1617						printf("\t\t\t...\n") ;
   1618					first = 1 ;
   1619				}
   1620				else {
   1621					printf("\t\t\t") ;
   1622					dump_hex(c,nn) ;
   1623					printf("\n") ;
   1624				}
   1625				n -= nn ;
   1626				c += 16 ;
   1627			}
   1628		}
   1629#ifdef	LITTLE_ENDIAN
   1630		smt_swap_para(sm,smtlen,1) ;
   1631#endif
   1632		plen = (pa->p_len + PARA_LEN + 3) & ~3 ;
   1633		len -= plen ;
   1634		pa = (struct smt_para *)((char *)pa + plen) ;
   1635	}
   1636	printf("-------------------------------------------------\n\n") ;
   1637}
   1638
   1639void dump_hex(char *p, int len)
   1640{
   1641	int	n = 0 ;
   1642	while (len--) {
   1643		n++ ;
   1644#ifdef UNIX
   1645		printf("%x%s",*p++ & 0xff,len ? ( (n & 7) ? " " : "-") : "") ;
   1646#else
   1647		printf("%02x%s",*p++ & 0xff,len ? ( (n & 7) ? " " : "-") : "") ;
   1648#endif
   1649	}
   1650}
   1651#endif	/* no BOOT */
   1652#endif	/* DEBUG */
   1653
   1654
   1655#endif	/* no SLIM_SMT */