xref: /kernel/linux/linux-6.6/drivers/net/fddi/skfp/pmf.c (revision 62306a36)
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 */
1656