?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
WIP FPC-III support
[linux/fpc-iii.git] / drivers / net / fddi / skfp / pmf.c
blob563fb7f0b327e05a1a5108c72620491f7a0614a2
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
27 static int smt_authorize(struct s_smc *smc, struct smt_header *sm);
28 static int smt_check_set_count(struct s_smc *smc, struct smt_header *sm);
29 static const struct s_p_tab* smt_get_ptab(u_short para);
30 static int smt_mib_phys(struct s_smc *smc);
31 static int smt_set_para(struct s_smc *smc, struct smt_para *pa, int index,
32 int local, int set);
33 void smt_add_para(struct s_smc *smc, struct s_pcon *pcon, u_short para,
34 int index, int local);
35 static SMbuf *smt_build_pmf_response(struct s_smc *smc, struct smt_header *req,
36 int set, int local);
37 static 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 */
63 static 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
273 void 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
303 static 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
491 static 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
526 static 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
542 void 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
1030 done:
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
1050 sp_done:
1051 len -= sp_len ;
1052 to += sp_len ;
1053 goto done ;
1054
1055 len_error:
1056 /* parameter does not fit in frame */
1057 pcon->pc_err = SMT_RDF_TOOLONG ;
1058 return ;
1059
1060 wrong_error:
1061 pcon->pc_err = SMT_RDF_LENGTH ;
1062 }
1063
1064 /*
1065 * set parameter
1066 */
1067 static 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
1446 change_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
1496 val_error:
1497 /* parameter value in frame is out of range */
1498 return SMT_RDF_RANGE;
1499
1500 len_error:
1501 /* parameter value in frame is too short */
1502 return SMT_RDF_LENGTH;
1503
1504 #if 0
1505 no_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
1515 static 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
1523 static 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
1536 static 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
1552 void 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
1639 void 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 */
Linux with added FPC-III support