1 /******************************************************************************
3 * (C)Copyright 1998,1999 SysKonnect,
4 * a business unit of Schneider & Koch & Co. Datensysteme GmbH.
6 * See the file "skfddi.c" for further information.
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License as published by
10 * the Free Software Foundation; either version 2 of the License, or
11 * (at your option) any later version.
13 * The information in this file is provided "AS IS" without warranty.
15 ******************************************************************************/
21 #include <linux/bitrev.h>
22 #include <linux/kernel.h>
25 #include "h/smtstate.h"
28 static const char ID_sccs
[] = "@(#)smt.c 2.43 98/11/23 (C) SK " ;
34 #define m_fc(mb) ((mb)->sm_data[0])
36 #define SMT_TID_MAGIC 0x1f0a7b3c
39 static const char *const smt_type_name
[] = {
40 "SMT_00??", "SMT_INFO", "SMT_02??", "SMT_03??",
41 "SMT_04??", "SMT_05??", "SMT_06??", "SMT_07??",
42 "SMT_08??", "SMT_09??", "SMT_0A??", "SMT_0B??",
43 "SMT_0C??", "SMT_0D??", "SMT_0E??", "SMT_NSA"
46 static const char *const smt_class_name
[] = {
47 "UNKNOWN","NIF","SIF_CONFIG","SIF_OPER","ECF","RAF","RDF",
48 "SRF","PMF_GET","PMF_SET","ESF"
51 #define LAST_CLASS (SMT_PMF_SET)
53 static const struct fddi_addr SMT_Unknown
= {
61 static int smt_swap_short(u_short s
);
63 static int mac_index(struct s_smc
*smc
, int mac
);
64 static int phy_index(struct s_smc
*smc
, int phy
);
65 static int mac_con_resource_index(struct s_smc
*smc
, int mac
);
66 static int phy_con_resource_index(struct s_smc
*smc
, int phy
);
67 static void smt_send_rdf(struct s_smc
*smc
, SMbuf
*rej
, int fc
, int reason
,
69 static void smt_send_nif(struct s_smc
*smc
, const struct fddi_addr
*dest
,
70 int fc
, u_long tid
, int type
, int local
);
71 static void smt_send_ecf(struct s_smc
*smc
, struct fddi_addr
*dest
, int fc
,
72 u_long tid
, int type
, int len
);
73 static void smt_echo_test(struct s_smc
*smc
, int dna
);
74 static void smt_send_sif_config(struct s_smc
*smc
, struct fddi_addr
*dest
,
75 u_long tid
, int local
);
76 static void smt_send_sif_operation(struct s_smc
*smc
, struct fddi_addr
*dest
,
77 u_long tid
, int local
);
79 static void smt_string_swap(char *data
, const char *format
, int len
);
81 static void smt_add_frame_len(SMbuf
*mb
, int len
);
82 static void smt_fill_una(struct s_smc
*smc
, struct smt_p_una
*una
);
83 static void smt_fill_sde(struct s_smc
*smc
, struct smt_p_sde
*sde
);
84 static void smt_fill_state(struct s_smc
*smc
, struct smt_p_state
*state
);
85 static void smt_fill_timestamp(struct s_smc
*smc
, struct smt_p_timestamp
*ts
);
86 static void smt_fill_policy(struct s_smc
*smc
, struct smt_p_policy
*policy
);
87 static void smt_fill_latency(struct s_smc
*smc
, struct smt_p_latency
*latency
);
88 static void smt_fill_neighbor(struct s_smc
*smc
, struct smt_p_neighbor
*neighbor
);
89 static int smt_fill_path(struct s_smc
*smc
, struct smt_p_path
*path
);
90 static void smt_fill_mac_status(struct s_smc
*smc
, struct smt_p_mac_status
*st
);
91 static void smt_fill_lem(struct s_smc
*smc
, struct smt_p_lem
*lem
, int phy
);
92 static void smt_fill_version(struct s_smc
*smc
, struct smt_p_version
*vers
);
93 static void smt_fill_fsc(struct s_smc
*smc
, struct smt_p_fsc
*fsc
);
94 static void smt_fill_mac_counter(struct s_smc
*smc
, struct smt_p_mac_counter
*mc
);
95 static void smt_fill_mac_fnc(struct s_smc
*smc
, struct smt_p_mac_fnc
*fnc
);
96 static void smt_fill_manufacturer(struct s_smc
*smc
,
97 struct smp_p_manufacturer
*man
);
98 static void smt_fill_user(struct s_smc
*smc
, struct smp_p_user
*user
);
99 static void smt_fill_setcount(struct s_smc
*smc
, struct smt_p_setcount
*setcount
);
100 static void smt_fill_echo(struct s_smc
*smc
, struct smt_p_echo
*echo
, u_long seed
,
103 static void smt_clear_una_dna(struct s_smc
*smc
);
104 static void smt_clear_old_una_dna(struct s_smc
*smc
);
106 static int entity_to_index(void);
108 static void update_dac(struct s_smc
*smc
, int report
);
109 static int div_ratio(u_long upper
, u_long lower
);
111 static void hwm_conv_can(struct s_smc
*smc
, char *data
, int len
);
113 #define hwm_conv_can(smc,data,len)
117 static inline int is_my_addr(const struct s_smc
*smc
,
118 const struct fddi_addr
*addr
)
120 return(*(short *)(&addr
->a
[0]) ==
121 *(short *)(&smc
->mib
.m
[MAC0
].fddiMACSMTAddress
.a
[0])
122 && *(short *)(&addr
->a
[2]) ==
123 *(short *)(&smc
->mib
.m
[MAC0
].fddiMACSMTAddress
.a
[2])
124 && *(short *)(&addr
->a
[4]) ==
125 *(short *)(&smc
->mib
.m
[MAC0
].fddiMACSMTAddress
.a
[4])) ;
128 static inline int is_broadcast(const struct fddi_addr
*addr
)
130 return(*(u_short
*)(&addr
->a
[0]) == 0xffff &&
131 *(u_short
*)(&addr
->a
[2]) == 0xffff &&
132 *(u_short
*)(&addr
->a
[4]) == 0xffff ) ;
135 static inline int is_individual(const struct fddi_addr
*addr
)
137 return(!(addr
->a
[0] & GROUP_ADDR
)) ;
140 static inline int is_equal(const struct fddi_addr
*addr1
,
141 const struct fddi_addr
*addr2
)
143 return(*(u_short
*)(&addr1
->a
[0]) == *(u_short
*)(&addr2
->a
[0]) &&
144 *(u_short
*)(&addr1
->a
[2]) == *(u_short
*)(&addr2
->a
[2]) &&
145 *(u_short
*)(&addr1
->a
[4]) == *(u_short
*)(&addr2
->a
[4]) ) ;
149 * list of mandatory paras in frames
151 static const u_short plist_nif
[] = { SMT_P_UNA
,SMT_P_SDE
,SMT_P_STATE
,0 } ;
156 void smt_agent_init(struct s_smc
*smc
)
163 smc
->mib
.m
[MAC0
].fddiMACSMTAddress
= smc
->hw
.fddi_home_addr
;
166 * get OUI address from driver (bia == built-in-address)
168 smc
->mib
.fddiSMTStationId
.sid_oem
[0] = 0 ;
169 smc
->mib
.fddiSMTStationId
.sid_oem
[1] = 0 ;
170 driver_get_bia(smc
,&smc
->mib
.fddiSMTStationId
.sid_node
) ;
171 for (i
= 0 ; i
< 6 ; i
++) {
172 smc
->mib
.fddiSMTStationId
.sid_node
.a
[i
] =
173 bitrev8(smc
->mib
.fddiSMTStationId
.sid_node
.a
[i
]);
175 smc
->mib
.fddiSMTManufacturerData
[0] =
176 smc
->mib
.fddiSMTStationId
.sid_node
.a
[0] ;
177 smc
->mib
.fddiSMTManufacturerData
[1] =
178 smc
->mib
.fddiSMTStationId
.sid_node
.a
[1] ;
179 smc
->mib
.fddiSMTManufacturerData
[2] =
180 smc
->mib
.fddiSMTStationId
.sid_node
.a
[2] ;
181 smc
->sm
.smt_tid
= 0 ;
182 smc
->mib
.m
[MAC0
].fddiMACDupAddressTest
= DA_NONE
;
183 smc
->mib
.m
[MAC0
].fddiMACUNDA_Flag
= FALSE
;
185 smt_clear_una_dna(smc
) ;
186 smt_clear_old_una_dna(smc
) ;
188 for (i
= 0 ; i
< SMT_MAX_TEST
; i
++)
189 smc
->sm
.pend
[i
] = 0 ;
190 smc
->sm
.please_reconnect
= 0 ;
191 smc
->sm
.uniq_ticks
= 0 ;
202 void smt_agent_task(struct s_smc
*smc
)
204 smt_timer_start(smc
,&smc
->sm
.smt_timer
, (u_long
)1000000L,
205 EV_TOKEN(EVENT_SMT
,SM_TIMER
)) ;
206 DB_SMT("SMT agent task\n",0,0) ;
209 #ifndef SMT_REAL_TOKEN_CT
210 void smt_emulate_token_ct(struct s_smc
*smc
, int mac_index
)
216 time
= smt_get_time();
217 count
= ((time
- smc
->sm
.last_tok_time
[mac_index
]) *
218 100)/TICKS_PER_SECOND
;
221 * Only when ring is up we will have a token count. The
222 * flag is unfortunatly a single instance value. This
223 * doesn't matter now, because we currently have only
226 if (smc
->hw
.mac_ring_is_up
){
227 smc
->mib
.m
[mac_index
].fddiMACToken_Ct
+= count
;
230 /* Remember current time */
231 smc
->sm
.last_tok_time
[mac_index
] = time
;
237 void smt_event(struct s_smc
*smc
, int event
)
240 #ifndef SMT_REAL_TOKEN_CT
245 if (smc
->sm
.please_reconnect
) {
246 smc
->sm
.please_reconnect
-- ;
247 if (smc
->sm
.please_reconnect
== 0) {
249 queue_event(smc
,EVENT_ECM
,EC_CONNECT
) ;
253 if (event
== SM_FAST
)
257 * timer for periodic cleanup in driver
258 * reset and start the watchdog (FM2)
262 smt_timer_poll(smc
) ;
263 smt_start_watchdog(smc
) ;
267 ess_timer_poll(smc
) ;
271 sba_timer_poll(smc
) ;
274 smt_srf_event(smc
,0,0,0) ;
276 #endif /* no SLIM_SMT */
278 time
= smt_get_time() ;
280 if (time
- smc
->sm
.smt_last_lem
>= TICKS_PER_SECOND
*8) {
282 * Use 8 sec. for the time intervall, it simplifies the
285 struct fddi_mib_m
*mib
;
292 * calculate LEM bit error rate
294 sm_lem_evaluate(smc
) ;
295 smc
->sm
.smt_last_lem
= time
;
301 mac_update_counter(smc
) ;
304 (mib
->fddiMACLost_Ct
- mib
->fddiMACOld_Lost_Ct
) +
305 (mib
->fddiMACError_Ct
- mib
->fddiMACOld_Error_Ct
) ;
307 (mib
->fddiMACFrame_Ct
- mib
->fddiMACOld_Frame_Ct
) +
308 (mib
->fddiMACLost_Ct
- mib
->fddiMACOld_Lost_Ct
) ;
309 mib
->fddiMACFrameErrorRatio
= div_ratio(upper
,lower
) ;
312 ((!mib
->fddiMACFrameErrorThreshold
&&
313 mib
->fddiMACError_Ct
!= mib
->fddiMACOld_Error_Ct
) ||
314 (mib
->fddiMACFrameErrorRatio
>
315 mib
->fddiMACFrameErrorThreshold
)) ;
317 if (cond
!= mib
->fddiMACFrameErrorFlag
)
318 smt_srf_event(smc
,SMT_COND_MAC_FRAME_ERROR
,
322 (mib
->fddiMACNotCopied_Ct
- mib
->fddiMACOld_NotCopied_Ct
) ;
325 (mib
->fddiMACCopied_Ct
- mib
->fddiMACOld_Copied_Ct
) ;
326 mib
->fddiMACNotCopiedRatio
= div_ratio(upper
,lower
) ;
329 ((!mib
->fddiMACNotCopiedThreshold
&&
330 mib
->fddiMACNotCopied_Ct
!=
331 mib
->fddiMACOld_NotCopied_Ct
)||
332 (mib
->fddiMACNotCopiedRatio
>
333 mib
->fddiMACNotCopiedThreshold
)) ;
335 if (cond
!= mib
->fddiMACNotCopiedFlag
)
336 smt_srf_event(smc
,SMT_COND_MAC_NOT_COPIED
,
342 mib
->fddiMACOld_Frame_Ct
= mib
->fddiMACFrame_Ct
;
343 mib
->fddiMACOld_Copied_Ct
= mib
->fddiMACCopied_Ct
;
344 mib
->fddiMACOld_Error_Ct
= mib
->fddiMACError_Ct
;
345 mib
->fddiMACOld_Lost_Ct
= mib
->fddiMACLost_Ct
;
346 mib
->fddiMACOld_NotCopied_Ct
= mib
->fddiMACNotCopied_Ct
;
349 * Check port EBError Condition
351 for (port
= 0; port
< NUMPHYS
; port
++) {
352 phy
= &smc
->y
[port
] ;
354 if (!phy
->mib
->fddiPORTHardwarePresent
) {
358 cond
= (phy
->mib
->fddiPORTEBError_Ct
-
359 phy
->mib
->fddiPORTOldEBError_Ct
> 5) ;
361 /* If ratio is more than 5 in 8 seconds
364 smt_srf_event(smc
,SMT_COND_PORT_EB_ERROR
,
365 (int) (INDEX_PORT
+ phy
->np
) ,cond
) ;
370 phy
->mib
->fddiPORTOldEBError_Ct
=
371 phy
->mib
->fddiPORTEBError_Ct
;
374 #endif /* no SLIM_SMT */
379 if (time
- smc
->sm
.smt_last_notify
>= (u_long
)
380 (smc
->mib
.fddiSMTTT_Notify
* TICKS_PER_SECOND
) ) {
382 * we can either send an announcement or a request
383 * a request will trigger a reply so that we can update
385 * note: same tid must be used until reply is received
387 if (!smc
->sm
.pend
[SMT_TID_NIF
])
388 smc
->sm
.pend
[SMT_TID_NIF
] = smt_get_tid(smc
) ;
389 smt_send_nif(smc
,&fddi_broadcast
, FC_SMT_NSA
,
390 smc
->sm
.pend
[SMT_TID_NIF
], SMT_REQUEST
,0) ;
391 smc
->sm
.smt_last_notify
= time
;
397 if (smc
->sm
.smt_tvu
&&
398 time
- smc
->sm
.smt_tvu
> 228*TICKS_PER_SECOND
) {
399 DB_SMT("SMT : UNA expired\n",0,0) ;
400 smc
->sm
.smt_tvu
= 0 ;
402 if (!is_equal(&smc
->mib
.m
[MAC0
].fddiMACUpstreamNbr
,
404 /* Do not update unknown address */
405 smc
->mib
.m
[MAC0
].fddiMACOldUpstreamNbr
=
406 smc
->mib
.m
[MAC0
].fddiMACUpstreamNbr
;
408 smc
->mib
.m
[MAC0
].fddiMACUpstreamNbr
= SMT_Unknown
;
409 smc
->mib
.m
[MAC0
].fddiMACUNDA_Flag
= FALSE
;
411 * Make sure the fddiMACUNDA_Flag = FALSE is
412 * included in the SRF so we don't generate
413 * a separate SRF for the deassertion of this
417 smt_srf_event(smc
, SMT_EVENT_MAC_NEIGHBOR_CHANGE
,
420 if (smc
->sm
.smt_tvd
&&
421 time
- smc
->sm
.smt_tvd
> 228*TICKS_PER_SECOND
) {
422 DB_SMT("SMT : DNA expired\n",0,0) ;
423 smc
->sm
.smt_tvd
= 0 ;
424 if (!is_equal(&smc
->mib
.m
[MAC0
].fddiMACDownstreamNbr
,
426 /* Do not update unknown address */
427 smc
->mib
.m
[MAC0
].fddiMACOldDownstreamNbr
=
428 smc
->mib
.m
[MAC0
].fddiMACDownstreamNbr
;
430 smc
->mib
.m
[MAC0
].fddiMACDownstreamNbr
= SMT_Unknown
;
431 smt_srf_event(smc
, SMT_EVENT_MAC_NEIGHBOR_CHANGE
,
435 #endif /* no SLIM_SMT */
437 #ifndef SMT_REAL_TOKEN_CT
439 * Token counter emulation section. If hardware supports the token
440 * count, the token counter will be updated in mac_update_counter.
442 for (i
= MAC0
; i
< NUMMACS
; i
++ ){
443 if (time
- smc
->sm
.last_tok_time
[i
] > 2*TICKS_PER_SECOND
){
444 smt_emulate_token_ct( smc
, i
);
449 smt_timer_start(smc
,&smc
->sm
.smt_timer
, (u_long
)1000000L,
450 EV_TOKEN(EVENT_SMT
,SM_TIMER
)) ;
453 static int div_ratio(u_long upper
, u_long lower
)
455 if ((upper
<<16L) < upper
)
456 upper
= 0xffff0000L
;
461 return((int)(upper
/lower
)) ;
467 * receive packet handler
469 void smt_received_pack(struct s_smc
*smc
, SMbuf
*mb
, int fs
)
470 /* int fs; frame status */
472 struct smt_header
*sm
;
479 case FC_SMT_LAN_LOC
:
484 smt_free_mbuf(smc
,mb
) ;
488 smc
->mib
.m
[MAC0
].fddiMACSMTCopied_Ct
++ ;
489 sm
= smtod(mb
,struct smt_header
*) ;
490 local
= ((fs
& L_INDICATOR
) != 0) ;
491 hwm_conv_can(smc
,(char *)sm
,12) ;
493 /* check destination address */
494 if (is_individual(&sm
->smt_dest
) && !is_my_addr(smc
,&sm
->smt_dest
)) {
495 smt_free_mbuf(smc
,mb
) ;
499 smt_swap_para(sm
,(int) mb
->sm_len
,1) ;
500 DB_SMT("SMT : received packet [%s] at 0x%x\n",
501 smt_type_name
[m_fc(mb
) & 0xf],sm
) ;
502 DB_SMT("SMT : version %d, class %s\n",sm
->smt_version
,
503 smt_class_name
[(sm
->smt_class
>LAST_CLASS
)?0 : sm
->smt_class
]) ;
509 if (m_fc(mb
) == FC_SMT_NSA
&& sm
->smt_class
== SMT_NIF
&&
510 (sm
->smt_type
== SMT_ANNOUNCE
|| sm
->smt_type
== SMT_REQUEST
)) {
517 * ignore any packet with NSA and A-indicator set
519 if ( (fs
& A_INDICATOR
) && m_fc(mb
) == FC_SMT_NSA
) {
520 DB_SMT("SMT : ignoring NSA with A-indicator set from %s\n",
521 addr_to_string(&sm
->smt_source
),0) ;
522 smt_free_mbuf(smc
,mb
) ;
527 * ignore frames with illegal length
529 if (((sm
->smt_class
== SMT_ECF
) && (sm
->smt_len
> SMT_MAX_ECHO_LEN
)) ||
530 ((sm
->smt_class
!= SMT_ECF
) && (sm
->smt_len
> SMT_MAX_INFO_LEN
))) {
531 smt_free_mbuf(smc
,mb
) ;
538 switch (sm
->smt_class
) {
540 case SMT_SIF_CONFIG
:
543 if (sm
->smt_version
!= SMT_VID
)
547 if (sm
->smt_version
!= SMT_VID_2
)
552 DB_SMT("SMT : version = %d, dest = %s\n",
553 sm
->smt_version
,addr_to_string(&sm
->smt_source
)) ;
554 smt_send_rdf(smc
,mb
,m_fc(mb
),SMT_RDF_VERSION
,local
) ;
555 smt_free_mbuf(smc
,mb
) ;
558 if ((sm
->smt_len
> mb
->sm_len
- sizeof(struct smt_header
)) ||
559 ((sm
->smt_len
& 3) && (sm
->smt_class
!= SMT_ECF
))) {
560 DB_SMT("SMT: info length error, len = %d\n",sm
->smt_len
,0) ;
561 smt_send_rdf(smc
,mb
,m_fc(mb
),SMT_RDF_LENGTH
,local
) ;
562 smt_free_mbuf(smc
,mb
) ;
565 switch (sm
->smt_class
) {
567 if (smt_check_para(smc
,sm
,plist_nif
)) {
568 DB_SMT("SMT: NIF with para problem, ignoring\n",0,0) ;
571 switch (sm
->smt_type
) {
574 if (!(fs
& C_INDICATOR
) && m_fc(mb
) == FC_SMT_NSA
575 && is_broadcast(&sm
->smt_dest
)) {
576 struct smt_p_state
*st
;
580 &smc
->mib
.m
[MAC0
].fddiMACUpstreamNbr
,
582 DB_SMT("SMT : updated my UNA = %s\n",
583 addr_to_string(&sm
->smt_source
),0) ;
584 if (!is_equal(&smc
->mib
.m
[MAC0
].
585 fddiMACUpstreamNbr
,&SMT_Unknown
)){
586 /* Do not update unknown address */
587 smc
->mib
.m
[MAC0
].fddiMACOldUpstreamNbr
=
588 smc
->mib
.m
[MAC0
].fddiMACUpstreamNbr
;
591 smc
->mib
.m
[MAC0
].fddiMACUpstreamNbr
=
594 SMT_EVENT_MAC_NEIGHBOR_CHANGE
,
596 smt_echo_test(smc
,0) ;
598 smc
->sm
.smt_tvu
= smt_get_time() ;
599 st
= (struct smt_p_state
*)
600 sm_to_para(smc
,sm
,SMT_P_STATE
) ;
602 smc
->mib
.m
[MAC0
].fddiMACUNDA_Flag
=
603 (st
->st_dupl_addr
& SMT_ST_MY_DUPA
) ?
608 if ((sm
->smt_type
== SMT_REQUEST
) &&
609 is_individual(&sm
->smt_source
) &&
610 ((!(fs
& A_INDICATOR
) && m_fc(mb
) == FC_SMT_NSA
) ||
611 (m_fc(mb
) != FC_SMT_NSA
))) {
612 DB_SMT("SMT : replying to NIF request %s\n",
613 addr_to_string(&sm
->smt_source
),0) ;
614 smt_send_nif(smc
,&sm
->smt_source
,
621 DB_SMT("SMT : received NIF response from %s\n",
622 addr_to_string(&sm
->smt_source
),0) ;
623 if (fs
& A_INDICATOR
) {
624 smc
->sm
.pend
[SMT_TID_NIF
] = 0 ;
625 DB_SMT("SMT : duplicate address\n",0,0) ;
626 smc
->mib
.m
[MAC0
].fddiMACDupAddressTest
=
628 smc
->r
.dup_addr_test
= DA_FAILED
;
629 queue_event(smc
,EVENT_RMT
,RM_DUP_ADDR
) ;
630 smc
->mib
.m
[MAC0
].fddiMACDA_Flag
= TRUE
;
634 if (sm
->smt_tid
== smc
->sm
.pend
[SMT_TID_NIF
]) {
635 smc
->sm
.pend
[SMT_TID_NIF
] = 0 ;
638 &smc
->mib
.m
[MAC0
].fddiMACDownstreamNbr
,
640 DB_SMT("SMT : updated my DNA\n",0,0) ;
641 if (!is_equal(&smc
->mib
.m
[MAC0
].
642 fddiMACDownstreamNbr
, &SMT_Unknown
)){
643 /* Do not update unknown address */
644 smc
->mib
.m
[MAC0
].fddiMACOldDownstreamNbr
=
645 smc
->mib
.m
[MAC0
].fddiMACDownstreamNbr
;
648 smc
->mib
.m
[MAC0
].fddiMACDownstreamNbr
=
651 SMT_EVENT_MAC_NEIGHBOR_CHANGE
,
653 smt_echo_test(smc
,1) ;
655 smc
->mib
.m
[MAC0
].fddiMACDA_Flag
= FALSE
;
657 smc
->sm
.smt_tvd
= smt_get_time() ;
658 smc
->mib
.m
[MAC0
].fddiMACDupAddressTest
=
660 if (smc
->r
.dup_addr_test
!= DA_PASSED
) {
661 smc
->r
.dup_addr_test
= DA_PASSED
;
662 queue_event(smc
,EVENT_RMT
,RM_DUP_ADDR
) ;
665 else if (sm
->smt_tid
==
666 smc
->sm
.pend
[SMT_TID_NIF_TEST
]) {
667 DB_SMT("SMT : NIF test TID ok\n",0,0) ;
670 DB_SMT("SMT : expected TID %lx, got %lx\n",
671 smc
->sm
.pend
[SMT_TID_NIF
],sm
->smt_tid
) ;
679 case SMT_SIF_CONFIG
: /* station information */
680 if (sm
->smt_type
!= SMT_REQUEST
)
682 DB_SMT("SMT : replying to SIF Config request from %s\n",
683 addr_to_string(&sm
->smt_source
),0) ;
684 smt_send_sif_config(smc
,&sm
->smt_source
,sm
->smt_tid
,local
) ;
686 case SMT_SIF_OPER
: /* station information */
687 if (sm
->smt_type
!= SMT_REQUEST
)
689 DB_SMT("SMT : replying to SIF Operation request from %s\n",
690 addr_to_string(&sm
->smt_source
),0) ;
691 smt_send_sif_operation(smc
,&sm
->smt_source
,sm
->smt_tid
,local
) ;
693 case SMT_ECF
: /* echo frame */
694 switch (sm
->smt_type
) {
696 smc
->mib
.priv
.fddiPRIVECF_Reply_Rx
++ ;
697 DB_SMT("SMT: received ECF reply from %s\n",
698 addr_to_string(&sm
->smt_source
),0) ;
699 if (sm_to_para(smc
,sm
,SMT_P_ECHODATA
) == NULL
) {
700 DB_SMT("SMT: ECHODATA missing\n",0,0) ;
703 if (sm
->smt_tid
== smc
->sm
.pend
[SMT_TID_ECF
]) {
704 DB_SMT("SMT : ECF test TID ok\n",0,0) ;
706 else if (sm
->smt_tid
== smc
->sm
.pend
[SMT_TID_ECF_UNA
]) {
707 DB_SMT("SMT : ECF test UNA ok\n",0,0) ;
709 else if (sm
->smt_tid
== smc
->sm
.pend
[SMT_TID_ECF_DNA
]) {
710 DB_SMT("SMT : ECF test DNA ok\n",0,0) ;
713 DB_SMT("SMT : expected TID %lx, got %lx\n",
714 smc
->sm
.pend
[SMT_TID_ECF
],
719 smc
->mib
.priv
.fddiPRIVECF_Req_Rx
++ ;
721 if (sm
->smt_len
&& !sm_to_para(smc
,sm
,SMT_P_ECHODATA
)) {
722 DB_SMT("SMT: ECF with para problem,sending RDF\n",0,0) ;
723 smt_send_rdf(smc
,mb
,m_fc(mb
),SMT_RDF_LENGTH
,
727 DB_SMT("SMT - sending ECF reply to %s\n",
728 addr_to_string(&sm
->smt_source
),0) ;
730 /* set destination addr. & reply */
731 sm
->smt_dest
= sm
->smt_source
;
732 sm
->smt_type
= SMT_REPLY
;
733 dump_smt(smc
,sm
,"ECF REPLY") ;
734 smc
->mib
.priv
.fddiPRIVECF_Reply_Tx
++ ;
735 smt_send_frame(smc
,mb
,FC_SMT_INFO
,local
) ;
736 return ; /* DON'T free mbuf */
744 case SMT_RAF
: /* resource allocation */
746 DB_ESSN(2,"ESS: RAF frame received\n",0,0) ;
747 fs
= ess_raf_received_pack(smc
,mb
,sm
,fs
) ;
751 DB_SBAN(2,"SBA: RAF frame received\n",0,0) ;
752 sba_raf_received_pack(smc
,sm
,fs
) ;
755 case SMT_RDF
: /* request denied */
756 smc
->mib
.priv
.fddiPRIVRDF_Rx
++ ;
758 case SMT_ESF
: /* extended service - not supported */
759 if (sm
->smt_type
== SMT_REQUEST
) {
760 DB_SMT("SMT - received ESF, sending RDF\n",0,0) ;
761 smt_send_rdf(smc
,mb
,m_fc(mb
),SMT_RDF_CLASS
,local
) ;
766 if (sm
->smt_type
!= SMT_REQUEST
)
768 /* update statistics */
769 if (sm
->smt_class
== SMT_PMF_GET
)
770 smc
->mib
.priv
.fddiPRIVPMF_Get_Rx
++ ;
772 smc
->mib
.priv
.fddiPRIVPMF_Set_Rx
++ ;
774 * ignore PMF SET with I/G set
776 if ((sm
->smt_class
== SMT_PMF_SET
) &&
777 !is_individual(&sm
->smt_dest
)) {
778 DB_SMT("SMT: ignoring PMF-SET with I/G set\n",0,0) ;
781 smt_pmf_received_pack(smc
,mb
, local
) ;
784 dump_smt(smc
,sm
,"SRF received") ;
787 if (sm
->smt_type
!= SMT_REQUEST
)
790 * For frames with unknown class:
791 * we need to send a RDF frame according to 8.1.3.1.1,
792 * only if it is a REQUEST.
794 DB_SMT("SMT : class = %d, send RDF to %s\n",
795 sm
->smt_class
, addr_to_string(&sm
->smt_source
)) ;
797 smt_send_rdf(smc
,mb
,m_fc(mb
),SMT_RDF_CLASS
,local
) ;
802 DB_SMT("SMT: discarding invalid frame, reason = %d\n",
805 smt_free_mbuf(smc
,mb
) ;
808 static void update_dac(struct s_smc
*smc
, int report
)
812 cond
= ( smc
->mib
.m
[MAC0
].fddiMACUNDA_Flag
|
813 smc
->mib
.m
[MAC0
].fddiMACDA_Flag
) != 0 ;
814 if (report
&& (cond
!= smc
->mib
.m
[MAC0
].fddiMACDuplicateAddressCond
))
815 smt_srf_event(smc
, SMT_COND_MAC_DUP_ADDR
,INDEX_MAC
,cond
) ;
817 smc
->mib
.m
[MAC0
].fddiMACDuplicateAddressCond
= cond
;
826 void smt_send_frame(struct s_smc
*smc
, SMbuf
*mb
, int fc
, int local
)
827 /* SMbuf *mb; buffer to send */
828 /* int fc; FC value */
830 struct smt_header
*sm
;
832 if (!smc
->r
.sm_ma_avail
&& !local
) {
833 smt_free_mbuf(smc
,mb
) ;
836 sm
= smtod(mb
,struct smt_header
*) ;
837 sm
->smt_source
= smc
->mib
.m
[MAC0
].fddiMACSMTAddress
;
838 sm
->smt_sid
= smc
->mib
.fddiSMTStationId
;
840 smt_swap_para(sm
,(int) mb
->sm_len
,0) ; /* swap para & header */
841 hwm_conv_can(smc
,(char *)sm
,12) ; /* convert SA and DA */
842 smc
->mib
.m
[MAC0
].fddiMACSMTTransmit_Ct
++ ;
843 smt_send_mbuf(smc
,mb
,local
? FC_SMT_LOC
: fc
) ;
847 * generate and send RDF
849 static void smt_send_rdf(struct s_smc
*smc
, SMbuf
*rej
, int fc
, int reason
,
851 /* SMbuf *rej; mbuf of offending frame */
852 /* int fc; FC of denied frame */
853 /* int reason; reason code */
856 struct smt_header
*sm
; /* header of offending frame */
857 struct smt_rdf
*rdf
;
861 sm
= smtod(rej
,struct smt_header
*) ;
862 if (sm
->smt_type
!= SMT_REQUEST
)
865 DB_SMT("SMT: sending RDF to %s,reason = 0x%x\n",
866 addr_to_string(&sm
->smt_source
),reason
) ;
870 * note: get framelength from MAC length, NOT from SMT header
871 * smt header length is included in sm_len
873 frame_len
= rej
->sm_len
;
875 if (!(mb
=smt_build_frame(smc
,SMT_RDF
,SMT_REPLY
,sizeof(struct smt_rdf
))))
877 rdf
= smtod(mb
,struct smt_rdf
*) ;
878 rdf
->smt
.smt_tid
= sm
->smt_tid
; /* use TID from sm */
879 rdf
->smt
.smt_dest
= sm
->smt_source
; /* set dest = source */
882 rdf
->reason
.para
.p_type
= SMT_P_REASON
;
883 rdf
->reason
.para
.p_len
= sizeof(struct smt_p_reason
) - PARA_LEN
;
884 rdf
->reason
.rdf_reason
= reason
;
887 rdf
->version
.para
.p_type
= SMT_P_VERSION
;
888 rdf
->version
.para
.p_len
= sizeof(struct smt_p_version
) - PARA_LEN
;
889 rdf
->version
.v_pad
= 0 ;
890 rdf
->version
.v_n
= 1 ;
891 rdf
->version
.v_index
= 1 ;
892 rdf
->version
.v_version
[0] = SMT_VID_2
;
893 rdf
->version
.v_pad2
= 0 ;
896 if ((unsigned) frame_len
<= SMT_MAX_INFO_LEN
- sizeof(*rdf
) +
897 2*sizeof(struct smt_header
))
900 len
= SMT_MAX_INFO_LEN
- sizeof(*rdf
) +
901 2*sizeof(struct smt_header
) ;
902 /* make length multiple of 4 */
904 rdf
->refused
.para
.p_type
= SMT_P_REFUSED
;
905 /* length of para is smt_frame + ref_fc */
906 rdf
->refused
.para
.p_len
= len
+ 4 ;
907 rdf
->refused
.ref_fc
= fc
;
910 smt_swap_para(sm
,frame_len
,0) ;
912 memcpy((char *) &rdf
->refused
.ref_header
,(char *) sm
,len
) ;
914 len
-= sizeof(struct smt_header
) ;
916 rdf
->smt
.smt_len
+= len
;
918 dump_smt(smc
,(struct smt_header
*)rdf
,"RDF") ;
919 smc
->mib
.priv
.fddiPRIVRDF_Tx
++ ;
920 smt_send_frame(smc
,mb
,FC_SMT_INFO
,local
) ;
924 * generate and send NIF
926 static void smt_send_nif(struct s_smc
*smc
, const struct fddi_addr
*dest
,
927 int fc
, u_long tid
, int type
, int local
)
928 /* struct fddi_addr *dest; dest address */
929 /* int fc; frame control */
930 /* u_long tid; transaction id */
931 /* int type; frame type */
933 struct smt_nif
*nif
;
936 if (!(mb
= smt_build_frame(smc
,SMT_NIF
,type
,sizeof(struct smt_nif
))))
938 nif
= smtod(mb
, struct smt_nif
*) ;
939 smt_fill_una(smc
,&nif
->una
) ; /* set UNA */
940 smt_fill_sde(smc
,&nif
->sde
) ; /* set station descriptor */
941 smt_fill_state(smc
,&nif
->state
) ; /* set state information */
943 smt_fill_fsc(smc
,&nif
->fsc
) ; /* set frame status cap. */
945 nif
->smt
.smt_dest
= *dest
; /* destination address */
946 nif
->smt
.smt_tid
= tid
; /* transaction ID */
947 dump_smt(smc
,(struct smt_header
*)nif
,"NIF") ;
948 smt_send_frame(smc
,mb
,fc
,local
) ;
953 * send NIF request (test purpose)
955 static void smt_send_nif_request(struct s_smc
*smc
, struct fddi_addr
*dest
)
957 smc
->sm
.pend
[SMT_TID_NIF_TEST
] = smt_get_tid(smc
) ;
958 smt_send_nif(smc
,dest
, FC_SMT_INFO
, smc
->sm
.pend
[SMT_TID_NIF_TEST
],
963 * send ECF request (test purpose)
965 static void smt_send_ecf_request(struct s_smc
*smc
, struct fddi_addr
*dest
,
968 smc
->sm
.pend
[SMT_TID_ECF
] = smt_get_tid(smc
) ;
969 smt_send_ecf(smc
,dest
, FC_SMT_INFO
, smc
->sm
.pend
[SMT_TID_ECF
],
977 static void smt_echo_test(struct s_smc
*smc
, int dna
)
981 smc
->sm
.pend
[dna
? SMT_TID_ECF_DNA
: SMT_TID_ECF_UNA
] =
982 tid
= smt_get_tid(smc
) ;
983 smt_send_ecf(smc
, dna
?
984 &smc
->mib
.m
[MAC0
].fddiMACDownstreamNbr
:
985 &smc
->mib
.m
[MAC0
].fddiMACUpstreamNbr
,
986 FC_SMT_INFO
,tid
, SMT_REQUEST
, (SMT_TEST_ECHO_LEN
& ~3)-8) ;
990 * generate and send ECF
992 static void smt_send_ecf(struct s_smc
*smc
, struct fddi_addr
*dest
, int fc
,
993 u_long tid
, int type
, int len
)
994 /* struct fddi_addr *dest; dest address */
995 /* int fc; frame control */
996 /* u_long tid; transaction id */
997 /* int type; frame type */
998 /* int len; frame length */
1000 struct smt_ecf
*ecf
;
1003 if (!(mb
= smt_build_frame(smc
,SMT_ECF
,type
,SMT_ECF_LEN
+ len
)))
1005 ecf
= smtod(mb
, struct smt_ecf
*) ;
1007 smt_fill_echo(smc
,&ecf
->ec_echo
,tid
,len
) ; /* set ECHO */
1008 ecf
->smt
.smt_dest
= *dest
; /* destination address */
1009 ecf
->smt
.smt_tid
= tid
; /* transaction ID */
1010 smc
->mib
.priv
.fddiPRIVECF_Req_Tx
++ ;
1011 smt_send_frame(smc
,mb
,fc
,0) ;
1015 * generate and send SIF config response
1018 static void smt_send_sif_config(struct s_smc
*smc
, struct fddi_addr
*dest
,
1019 u_long tid
, int local
)
1020 /* struct fddi_addr *dest; dest address */
1021 /* u_long tid; transaction id */
1023 struct smt_sif_config
*sif
;
1026 if (!(mb
= smt_build_frame(smc
,SMT_SIF_CONFIG
,SMT_REPLY
,
1027 SIZEOF_SMT_SIF_CONFIG
)))
1030 sif
= smtod(mb
, struct smt_sif_config
*) ;
1031 smt_fill_timestamp(smc
,&sif
->ts
) ; /* set time stamp */
1032 smt_fill_sde(smc
,&sif
->sde
) ; /* set station descriptor */
1033 smt_fill_version(smc
,&sif
->version
) ; /* set version information */
1034 smt_fill_state(smc
,&sif
->state
) ; /* set state information */
1035 smt_fill_policy(smc
,&sif
->policy
) ; /* set station policy */
1036 smt_fill_latency(smc
,&sif
->latency
); /* set station latency */
1037 smt_fill_neighbor(smc
,&sif
->neighbor
); /* set station neighbor */
1038 smt_fill_setcount(smc
,&sif
->setcount
) ; /* set count */
1039 len
= smt_fill_path(smc
,&sif
->path
); /* set station path descriptor*/
1040 sif
->smt
.smt_dest
= *dest
; /* destination address */
1041 sif
->smt
.smt_tid
= tid
; /* transaction ID */
1042 smt_add_frame_len(mb
,len
) ; /* adjust length fields */
1043 dump_smt(smc
,(struct smt_header
*)sif
,"SIF Configuration Reply") ;
1044 smt_send_frame(smc
,mb
,FC_SMT_INFO
,local
) ;
1048 * generate and send SIF operation response
1051 static void smt_send_sif_operation(struct s_smc
*smc
, struct fddi_addr
*dest
,
1052 u_long tid
, int local
)
1053 /* struct fddi_addr *dest; dest address */
1054 /* u_long tid; transaction id */
1056 struct smt_sif_operation
*sif
;
1062 #ifndef CONCENTRATOR
1063 if (smc
->s
.sas
== SMT_SAS
)
1067 if (!(mb
= smt_build_frame(smc
,SMT_SIF_OPER
,SMT_REPLY
,
1068 SIZEOF_SMT_SIF_OPERATION
+ports
*sizeof(struct smt_p_lem
))))
1070 sif
= smtod(mb
, struct smt_sif_operation
*) ;
1071 smt_fill_timestamp(smc
,&sif
->ts
) ; /* set time stamp */
1072 smt_fill_mac_status(smc
,&sif
->status
) ; /* set mac status */
1073 smt_fill_mac_counter(smc
,&sif
->mc
) ; /* set mac counter field */
1074 smt_fill_mac_fnc(smc
,&sif
->fnc
) ; /* set frame not copied counter */
1075 smt_fill_manufacturer(smc
,&sif
->man
) ; /* set manufacturer field */
1076 smt_fill_user(smc
,&sif
->user
) ; /* set user field */
1077 smt_fill_setcount(smc
,&sif
->setcount
) ; /* set count */
1079 * set link error mon information
1082 smt_fill_lem(smc
,sif
->lem
,PS
) ;
1085 for (i
= 0 ; i
< ports
; i
++) {
1086 smt_fill_lem(smc
,&sif
->lem
[i
],i
) ;
1090 sif
->smt
.smt_dest
= *dest
; /* destination address */
1091 sif
->smt
.smt_tid
= tid
; /* transaction ID */
1092 dump_smt(smc
,(struct smt_header
*)sif
,"SIF Operation Reply") ;
1093 smt_send_frame(smc
,mb
,FC_SMT_INFO
,local
) ;
1097 * get and initialize SMT frame
1099 SMbuf
*smt_build_frame(struct s_smc
*smc
, int class, int type
,
1103 struct smt_header
*smt
;
1105 if (!(mb
= smt_get_mbuf(smc
)))
1108 mb
->sm_len
= length
;
1109 smt
= smtod(mb
, struct smt_header
*) ;
1110 smt
->smt_dest
= fddi_broadcast
; /* set dest = broadcast */
1111 smt
->smt_class
= class ;
1112 smt
->smt_type
= type
;
1115 case SMT_SIF_CONFIG
:
1118 smt
->smt_version
= SMT_VID
;
1121 smt
->smt_version
= SMT_VID_2
;
1124 smt
->smt_tid
= smt_get_tid(smc
) ; /* set transaction ID */
1126 smt
->smt_len
= length
- sizeof(struct smt_header
) ;
1130 static void smt_add_frame_len(SMbuf
*mb
, int len
)
1132 struct smt_header
*smt
;
1134 smt
= smtod(mb
, struct smt_header
*) ;
1135 smt
->smt_len
+= len
;
1142 * fill values in UNA parameter
1144 static void smt_fill_una(struct s_smc
*smc
, struct smt_p_una
*una
)
1146 SMTSETPARA(una
,SMT_P_UNA
) ;
1148 una
->una_node
= smc
->mib
.m
[MAC0
].fddiMACUpstreamNbr
;
1152 * fill values in SDE parameter
1154 static void smt_fill_sde(struct s_smc
*smc
, struct smt_p_sde
*sde
)
1156 SMTSETPARA(sde
,SMT_P_SDE
) ;
1157 sde
->sde_non_master
= smc
->mib
.fddiSMTNonMaster_Ct
;
1158 sde
->sde_master
= smc
->mib
.fddiSMTMaster_Ct
;
1159 sde
->sde_mac_count
= NUMMACS
; /* only 1 MAC */
1161 sde
->sde_type
= SMT_SDE_CONCENTRATOR
;
1163 sde
->sde_type
= SMT_SDE_STATION
;
1168 * fill in values in station state parameter
1170 static void smt_fill_state(struct s_smc
*smc
, struct smt_p_state
*state
)
1175 SMTSETPARA(state
,SMT_P_STATE
) ;
1178 /* determine topology */
1180 if (smc
->mib
.fddiSMTPeerWrapFlag
) {
1181 top
|= SMT_ST_WRAPPED
; /* state wrapped */
1184 if (cfm_status_unattached(smc
)) {
1185 top
|= SMT_ST_UNATTACHED
; /* unattached concentrator */
1188 if ((twist
= pcm_status_twisted(smc
)) & 1) {
1189 top
|= SMT_ST_TWISTED_A
; /* twisted cable */
1192 top
|= SMT_ST_TWISTED_B
; /* twisted cable */
1197 if (pcm_rooted_station(smc
))
1198 top
|= SMT_ST_ROOTED_S
;
1199 if (smc
->mib
.a
[0].fddiPATHSbaPayload
!= 0)
1200 top
|= SMT_ST_SYNC_SERVICE
;
1201 state
->st_topology
= top
;
1202 state
->st_dupl_addr
=
1203 ((smc
->mib
.m
[MAC0
].fddiMACDA_Flag
? SMT_ST_MY_DUPA
: 0 ) |
1204 (smc
->mib
.m
[MAC0
].fddiMACUNDA_Flag
? SMT_ST_UNA_DUPA
: 0)) ;
1208 * fill values in timestamp parameter
1210 static void smt_fill_timestamp(struct s_smc
*smc
, struct smt_p_timestamp
*ts
)
1213 SMTSETPARA(ts
,SMT_P_TIMESTAMP
) ;
1214 smt_set_timestamp(smc
,ts
->ts_time
) ;
1217 void smt_set_timestamp(struct s_smc
*smc
, u_char
*p
)
1223 * timestamp is 64 bits long ; resolution is 80 nS
1224 * our clock resolution is 10mS
1225 * 10mS/80ns = 125000 ~ 2^17 = 131072
1227 utime
= smt_get_time() ;
1228 time
= utime
* 100 ;
1229 time
/= TICKS_PER_SECOND
;
1231 p
[1] = (u_char
)((time
>>(8+8+8+8-1)) & 1) ;
1232 p
[2] = (u_char
)(time
>>(8+8+8-1)) ;
1233 p
[3] = (u_char
)(time
>>(8+8-1)) ;
1234 p
[4] = (u_char
)(time
>>(8-1)) ;
1235 p
[5] = (u_char
)(time
<<1) ;
1236 p
[6] = (u_char
)(smc
->sm
.uniq_ticks
>>8) ;
1237 p
[7] = (u_char
)smc
->sm
.uniq_ticks
;
1239 * make sure we don't wrap: restart whenever the upper digits change
1241 if (utime
!= smc
->sm
.uniq_time
) {
1242 smc
->sm
.uniq_ticks
= 0 ;
1244 smc
->sm
.uniq_ticks
++ ;
1245 smc
->sm
.uniq_time
= utime
;
1249 * fill values in station policy parameter
1251 static void smt_fill_policy(struct s_smc
*smc
, struct smt_p_policy
*policy
)
1259 * MIB para 101b (fddiSMTConnectionPolicy) coding
1260 * is different from 0005 coding
1262 static u_char ansi_weirdness
[16] = {
1263 0,7,5,3,8,1,6,4,9,10,2,11,12,13,14,15
1265 SMTSETPARA(policy
,SMT_P_POLICY
) ;
1268 in
= smc
->mib
.fddiSMTConnectionPolicy
;
1269 for (i
= 0, map
= ansi_weirdness
; i
< 16 ; i
++) {
1275 policy
->pl_config
= smc
->mib
.fddiSMTConfigPolicy
;
1276 policy
->pl_connect
= out
;
1280 * fill values in latency equivalent parameter
1282 static void smt_fill_latency(struct s_smc
*smc
, struct smt_p_latency
*latency
)
1284 SMTSETPARA(latency
,SMT_P_LATENCY
) ;
1286 latency
->lt_phyout_idx1
= phy_index(smc
,0) ;
1287 latency
->lt_latency1
= 10 ; /* in octets (byte clock) */
1289 * note: latency has two phy entries by definition
1290 * for a SAS, the 2nd one is null
1292 if (smc
->s
.sas
== SMT_DAS
) {
1293 latency
->lt_phyout_idx2
= phy_index(smc
,1) ;
1294 latency
->lt_latency2
= 10 ; /* in octets (byte clock) */
1297 latency
->lt_phyout_idx2
= 0 ;
1298 latency
->lt_latency2
= 0 ;
1303 * fill values in MAC neighbors parameter
1305 static void smt_fill_neighbor(struct s_smc
*smc
, struct smt_p_neighbor
*neighbor
)
1307 SMTSETPARA(neighbor
,SMT_P_NEIGHBORS
) ;
1309 neighbor
->nb_mib_index
= INDEX_MAC
;
1310 neighbor
->nb_mac_index
= mac_index(smc
,1) ;
1311 neighbor
->nb_una
= smc
->mib
.m
[MAC0
].fddiMACUpstreamNbr
;
1312 neighbor
->nb_dna
= smc
->mib
.m
[MAC0
].fddiMACDownstreamNbr
;
1316 * fill values in path descriptor
1319 #define ALLPHYS NUMPHYS
1321 #define ALLPHYS ((smc->s.sas == SMT_SAS) ? 1 : 2)
1324 static int smt_fill_path(struct s_smc
*smc
, struct smt_p_path
*path
)
1326 SK_LOC_DECL(int,type
) ;
1327 SK_LOC_DECL(int,state
) ;
1328 SK_LOC_DECL(int,remote
) ;
1329 SK_LOC_DECL(int,mac
) ;
1333 struct smt_phy_rec
*phy
;
1334 struct smt_mac_rec
*pd_mac
;
1337 sizeof(struct smt_mac_rec
) * NUMMACS
+
1338 sizeof(struct smt_phy_rec
) * ALLPHYS
;
1339 path
->para
.p_type
= SMT_P_PATH
;
1340 path
->para
.p_len
= len
- PARA_LEN
;
1343 for (p
= 0,phy
= path
->pd_phy
; p
< ALLPHYS
; p
++, phy
++) {
1345 #ifndef CONCENTRATOR
1346 if (smc
->s
.sas
== SMT_SAS
)
1349 pcm_status_state(smc
,physp
,&type
,&state
,&remote
,&mac
) ;
1350 #ifdef LITTLE_ENDIAN
1351 phy
->phy_mib_index
= smt_swap_short((u_short
)p
+INDEX_PORT
) ;
1353 phy
->phy_mib_index
= p
+INDEX_PORT
;
1355 phy
->phy_type
= type
;
1356 phy
->phy_connect_state
= state
;
1357 phy
->phy_remote_type
= remote
;
1358 phy
->phy_remote_mac
= mac
;
1359 phy
->phy_resource_idx
= phy_con_resource_index(smc
,p
) ;
1363 pd_mac
= (struct smt_mac_rec
*) phy
;
1364 pd_mac
->mac_addr
= smc
->mib
.m
[MAC0
].fddiMACSMTAddress
;
1365 pd_mac
->mac_resource_idx
= mac_con_resource_index(smc
,1) ;
1370 * fill values in mac status
1372 static void smt_fill_mac_status(struct s_smc
*smc
, struct smt_p_mac_status
*st
)
1374 SMTSETPARA(st
,SMT_P_MAC_STATUS
) ;
1376 st
->st_mib_index
= INDEX_MAC
;
1377 st
->st_mac_index
= mac_index(smc
,1) ;
1379 mac_update_counter(smc
) ;
1381 * timer values are represented in SMT as 2's complement numbers
1382 * units : internal : 2's complement BCLK
1384 st
->st_t_req
= smc
->mib
.m
[MAC0
].fddiMACT_Req
;
1385 st
->st_t_neg
= smc
->mib
.m
[MAC0
].fddiMACT_Neg
;
1386 st
->st_t_max
= smc
->mib
.m
[MAC0
].fddiMACT_Max
;
1387 st
->st_tvx_value
= smc
->mib
.m
[MAC0
].fddiMACTvxValue
;
1388 st
->st_t_min
= smc
->mib
.m
[MAC0
].fddiMACT_Min
;
1390 st
->st_sba
= smc
->mib
.a
[PATH0
].fddiPATHSbaPayload
;
1391 st
->st_frame_ct
= smc
->mib
.m
[MAC0
].fddiMACFrame_Ct
;
1392 st
->st_error_ct
= smc
->mib
.m
[MAC0
].fddiMACError_Ct
;
1393 st
->st_lost_ct
= smc
->mib
.m
[MAC0
].fddiMACLost_Ct
;
1397 * fill values in LEM status
1399 static void smt_fill_lem(struct s_smc
*smc
, struct smt_p_lem
*lem
, int phy
)
1401 struct fddi_mib_p
*mib
;
1403 mib
= smc
->y
[phy
].mib
;
1405 SMTSETPARA(lem
,SMT_P_LEM
) ;
1406 lem
->lem_mib_index
= phy
+INDEX_PORT
;
1407 lem
->lem_phy_index
= phy_index(smc
,phy
) ;
1409 lem
->lem_cutoff
= mib
->fddiPORTLer_Cutoff
;
1410 lem
->lem_alarm
= mib
->fddiPORTLer_Alarm
;
1411 /* long term bit error rate */
1412 lem
->lem_estimate
= mib
->fddiPORTLer_Estimate
;
1413 /* # of rejected connections */
1414 lem
->lem_reject_ct
= mib
->fddiPORTLem_Reject_Ct
;
1415 lem
->lem_ct
= mib
->fddiPORTLem_Ct
; /* total number of errors */
1419 * fill version parameter
1421 static void smt_fill_version(struct s_smc
*smc
, struct smt_p_version
*vers
)
1424 SMTSETPARA(vers
,SMT_P_VERSION
) ;
1426 vers
->v_n
= 1 ; /* one version is enough .. */
1428 vers
->v_version
[0] = SMT_VID_2
;
1434 * fill frame status capabilities
1437 * note: this para 200B is NOT in swap table, because it's also set in
1440 static void smt_fill_fsc(struct s_smc
*smc
, struct smt_p_fsc
*fsc
)
1443 SMTSETPARA(fsc
,SMT_P_FSC
) ;
1445 fsc
->fsc_mac_index
= INDEX_MAC
; /* this is MIB ; MIB is NOT
1449 fsc
->fsc_value
= FSC_TYPE0
; /* "normal" node */
1450 #ifdef LITTLE_ENDIAN
1451 fsc
->fsc_mac_index
= smt_swap_short(INDEX_MAC
) ;
1452 fsc
->fsc_value
= smt_swap_short(FSC_TYPE0
) ;
1458 * fill mac counter field
1460 static void smt_fill_mac_counter(struct s_smc
*smc
, struct smt_p_mac_counter
*mc
)
1462 SMTSETPARA(mc
,SMT_P_MAC_COUNTER
) ;
1463 mc
->mc_mib_index
= INDEX_MAC
;
1464 mc
->mc_index
= mac_index(smc
,1) ;
1465 mc
->mc_receive_ct
= smc
->mib
.m
[MAC0
].fddiMACCopied_Ct
;
1466 mc
->mc_transmit_ct
= smc
->mib
.m
[MAC0
].fddiMACTransmit_Ct
;
1470 * fill mac frame not copied counter
1472 static void smt_fill_mac_fnc(struct s_smc
*smc
, struct smt_p_mac_fnc
*fnc
)
1474 SMTSETPARA(fnc
,SMT_P_MAC_FNC
) ;
1475 fnc
->nc_mib_index
= INDEX_MAC
;
1476 fnc
->nc_index
= mac_index(smc
,1) ;
1477 fnc
->nc_counter
= smc
->mib
.m
[MAC0
].fddiMACNotCopied_Ct
;
1482 * fill manufacturer field
1484 static void smt_fill_manufacturer(struct s_smc
*smc
,
1485 struct smp_p_manufacturer
*man
)
1487 SMTSETPARA(man
,SMT_P_MANUFACTURER
) ;
1488 memcpy((char *) man
->mf_data
,
1489 (char *) smc
->mib
.fddiSMTManufacturerData
,
1490 sizeof(man
->mf_data
)) ;
1496 static void smt_fill_user(struct s_smc
*smc
, struct smp_p_user
*user
)
1498 SMTSETPARA(user
,SMT_P_USER
) ;
1499 memcpy((char *) user
->us_data
,
1500 (char *) smc
->mib
.fddiSMTUserData
,
1501 sizeof(user
->us_data
)) ;
1507 static void smt_fill_setcount(struct s_smc
*smc
, struct smt_p_setcount
*setcount
)
1510 SMTSETPARA(setcount
,SMT_P_SETCOUNT
) ;
1511 setcount
->count
= smc
->mib
.fddiSMTSetCount
.count
;
1512 memcpy((char *)setcount
->timestamp
,
1513 (char *)smc
->mib
.fddiSMTSetCount
.timestamp
,8) ;
1519 static void smt_fill_echo(struct s_smc
*smc
, struct smt_p_echo
*echo
, u_long seed
,
1525 SMTSETPARA(echo
,SMT_P_ECHODATA
) ;
1526 echo
->para
.p_len
= len
;
1527 for (p
= echo
->ec_data
; len
; len
--) {
1528 *p
++ = (u_char
) seed
;
1535 * called from CFM if configuration changes
1537 static void smt_clear_una_dna(struct s_smc
*smc
)
1539 smc
->mib
.m
[MAC0
].fddiMACUpstreamNbr
= SMT_Unknown
;
1540 smc
->mib
.m
[MAC0
].fddiMACDownstreamNbr
= SMT_Unknown
;
1543 static void smt_clear_old_una_dna(struct s_smc
*smc
)
1545 smc
->mib
.m
[MAC0
].fddiMACOldUpstreamNbr
= SMT_Unknown
;
1546 smc
->mib
.m
[MAC0
].fddiMACOldDownstreamNbr
= SMT_Unknown
;
1549 u_long
smt_get_tid(struct s_smc
*smc
)
1552 while ((tid
= ++(smc
->sm
.smt_tid
) ^ SMT_TID_MAGIC
) == 0)
1554 return(tid
& 0x3fffffffL
) ;
1559 * table of parameter lengths
1561 static const struct smt_pdef
{
1566 { SMT_P_UNA
, sizeof(struct smt_p_una
) ,
1568 { SMT_P_SDE
, sizeof(struct smt_p_sde
) ,
1570 { SMT_P_STATE
, sizeof(struct smt_p_state
) ,
1571 SWAP_SMT_P_STATE
} ,
1572 { SMT_P_TIMESTAMP
,sizeof(struct smt_p_timestamp
) ,
1573 SWAP_SMT_P_TIMESTAMP
} ,
1574 { SMT_P_POLICY
, sizeof(struct smt_p_policy
) ,
1575 SWAP_SMT_P_POLICY
} ,
1576 { SMT_P_LATENCY
, sizeof(struct smt_p_latency
) ,
1577 SWAP_SMT_P_LATENCY
} ,
1578 { SMT_P_NEIGHBORS
,sizeof(struct smt_p_neighbor
) ,
1579 SWAP_SMT_P_NEIGHBORS
} ,
1580 { SMT_P_PATH
, sizeof(struct smt_p_path
) ,
1582 { SMT_P_MAC_STATUS
,sizeof(struct smt_p_mac_status
) ,
1583 SWAP_SMT_P_MAC_STATUS
} ,
1584 { SMT_P_LEM
, sizeof(struct smt_p_lem
) ,
1586 { SMT_P_MAC_COUNTER
,sizeof(struct smt_p_mac_counter
) ,
1587 SWAP_SMT_P_MAC_COUNTER
} ,
1588 { SMT_P_MAC_FNC
,sizeof(struct smt_p_mac_fnc
) ,
1589 SWAP_SMT_P_MAC_FNC
} ,
1590 { SMT_P_PRIORITY
,sizeof(struct smt_p_priority
) ,
1591 SWAP_SMT_P_PRIORITY
} ,
1592 { SMT_P_EB
,sizeof(struct smt_p_eb
) ,
1594 { SMT_P_MANUFACTURER
,sizeof(struct smp_p_manufacturer
) ,
1595 SWAP_SMT_P_MANUFACTURER
} ,
1596 { SMT_P_REASON
, sizeof(struct smt_p_reason
) ,
1597 SWAP_SMT_P_REASON
} ,
1598 { SMT_P_REFUSED
, sizeof(struct smt_p_refused
) ,
1599 SWAP_SMT_P_REFUSED
} ,
1600 { SMT_P_VERSION
, sizeof(struct smt_p_version
) ,
1601 SWAP_SMT_P_VERSION
} ,
1603 { SMT_P0015
, sizeof(struct smt_p_0015
) , SWAP_SMT_P0015
} ,
1604 { SMT_P0016
, sizeof(struct smt_p_0016
) , SWAP_SMT_P0016
} ,
1605 { SMT_P0017
, sizeof(struct smt_p_0017
) , SWAP_SMT_P0017
} ,
1606 { SMT_P0018
, sizeof(struct smt_p_0018
) , SWAP_SMT_P0018
} ,
1607 { SMT_P0019
, sizeof(struct smt_p_0019
) , SWAP_SMT_P0019
} ,
1608 { SMT_P001A
, sizeof(struct smt_p_001a
) , SWAP_SMT_P001A
} ,
1609 { SMT_P001B
, sizeof(struct smt_p_001b
) , SWAP_SMT_P001B
} ,
1610 { SMT_P001C
, sizeof(struct smt_p_001c
) , SWAP_SMT_P001C
} ,
1611 { SMT_P001D
, sizeof(struct smt_p_001d
) , SWAP_SMT_P001D
} ,
1614 { SMT_P_SETCOUNT
,0, SWAP_SMT_P_SETCOUNT
} ,
1615 { SMT_P1048
, 0, SWAP_SMT_P1048
} ,
1616 { SMT_P208C
, 0, SWAP_SMT_P208C
} ,
1617 { SMT_P208D
, 0, SWAP_SMT_P208D
} ,
1618 { SMT_P208E
, 0, SWAP_SMT_P208E
} ,
1619 { SMT_P208F
, 0, SWAP_SMT_P208F
} ,
1620 { SMT_P2090
, 0, SWAP_SMT_P2090
} ,
1622 { SMT_P320B
, sizeof(struct smt_p_320b
) , SWAP_SMT_P320B
} ,
1623 { SMT_P320F
, sizeof(struct smt_p_320f
) , SWAP_SMT_P320F
} ,
1624 { SMT_P3210
, sizeof(struct smt_p_3210
) , SWAP_SMT_P3210
} ,
1626 { SMT_P4050
, 0, SWAP_SMT_P4050
} ,
1627 { SMT_P4051
, 0, SWAP_SMT_P4051
} ,
1628 { SMT_P4052
, 0, SWAP_SMT_P4052
} ,
1629 { SMT_P4053
, 0, SWAP_SMT_P4053
} ,
1632 #define N_SMT_PLEN ARRAY_SIZE(smt_pdef)
1634 int smt_check_para(struct s_smc
*smc
, struct smt_header
*sm
,
1635 const u_short list
[])
1637 const u_short
*p
= list
;
1639 if (!sm_to_para(smc
,sm
,(int) *p
)) {
1640 DB_SMT("SMT: smt_check_para - missing para %x\n",*p
,0);
1648 void *sm_to_para(struct s_smc
*smc
, struct smt_header
*sm
, int para
)
1658 p
= (char *)(sm
+1) ; /* pointer to info */
1660 if (((struct smt_para
*)p
)->p_type
== para
)
1661 found
= (void *) p
;
1662 plen
= ((struct smt_para
*)p
)->p_len
+ PARA_LEN
;
1666 DB_SMT("SMT : sm_to_para - length error %d\n",plen
,0) ;
1669 if ((plen
& 3) && (para
!= SMT_P_ECHODATA
)) {
1670 DB_SMT("SMT : sm_to_para - odd length %d\n",plen
,0) ;
1681 char *addr_to_string(struct fddi_addr
*addr
)
1684 static char string
[6*3] = "****" ;
1686 for (i
= 0 ; i
< 6 ; i
++) {
1687 string
[i
* 3] = hex_asc_hi(addr
->a
[i
]);
1688 string
[i
* 3 + 1] = hex_asc_lo(addr
->a
[i
]);
1689 string
[i
* 3 + 2] = ':';
1691 string
[5 * 3 + 2] = 0;
1697 int smt_ifconfig(int argc
, char *argv
[])
1699 if (argc
>= 2 && !strcmp(argv
[0],"opt_bypass") &&
1700 !strcmp(argv
[1],"yes")) {
1701 smc
->mib
.fddiSMTBypassPresent
= 1 ;
1704 return(amdfddi_config(0,argc
,argv
)) ;
1709 * return static mac index
1711 static int mac_index(struct s_smc
*smc
, int mac
)
1718 return((smc
->s
.sas
== SMT_SAS
) ? 2 : 3) ;
1723 * return static phy index
1725 static int phy_index(struct s_smc
*smc
, int phy
)
1732 * return dynamic mac connection resource index
1734 static int mac_con_resource_index(struct s_smc
*smc
, int mac
)
1739 return(entity_to_index(smc
,cem_get_downstream(smc
,ENTITY_MAC
))) ;
1742 switch (smc
->mib
.fddiSMTCF_State
) {
1745 case SC11_C_WRAP_S
:
1747 case SC10_C_WRAP_B
:
1751 return(smc
->s
.sas
== SMT_SAS
? 2 : 3) ;
1756 * return dynamic phy connection resource index
1758 static int phy_con_resource_index(struct s_smc
*smc
, int phy
)
1761 return(entity_to_index(smc
,cem_get_downstream(smc
,ENTITY_PHY(phy
)))) ;
1763 switch (smc
->mib
.fddiSMTCF_State
) {
1765 return(phy
== PA
? 3 : 2) ;
1766 case SC10_C_WRAP_B
:
1767 return(phy
== PA
? 1 : 3) ;
1769 return(phy
== PA
? 3 : 1) ;
1771 return(phy
== PA
? 2 : 3) ;
1772 case SC11_C_WRAP_S
:
1780 static int entity_to_index(struct s_smc
*smc
, int e
)
1782 if (e
== ENTITY_MAC
)
1783 return(mac_index(smc
,1)) ;
1785 return(phy_index(smc
,e
- ENTITY_PHY(0))) ;
1789 #ifdef LITTLE_ENDIAN
1790 static int smt_swap_short(u_short s
)
1792 return(((s
>>8)&0xff)|((s
&0xff)<<8)) ;
1795 void smt_swap_para(struct smt_header
*sm
, int len
, int direction
)
1796 /* int direction; 0 encode 1 decode */
1798 struct smt_para
*pa
;
1799 const struct smt_pdef
*pd
;
1805 /* printf("smt_swap_para sm %x len %d dir %d\n",
1808 smt_string_swap((char *)sm
,SWAP_SMTHEADER
,len
) ;
1811 len
-= sizeof(struct smt_header
) ;
1813 p
= (char *) (sm
+ 1) ;
1815 pa
= (struct smt_para
*) p
;
1818 pa
->p_type
= smt_swap_short(pa
->p_type
) ;
1819 pa
->p_len
= smt_swap_short(pa
->p_len
) ;
1825 * note: paras can have 0 length !
1830 for (i
= N_SMT_PLEN
, pd
= smt_pdef
; i
; i
--,pd
++) {
1831 if (pd
->ptype
== type
)
1834 if (i
&& pd
->pswap
) {
1835 smt_string_swap(p
+PARA_LEN
,pd
->pswap
,len
) ;
1842 static void smt_string_swap(char *data
, const char *format
, int len
)
1844 const char *open_paren
= NULL
;
1847 while (len
> 0 && *format
) {
1850 open_paren
= format
;
1853 format
= open_paren
;
1864 data
+= *format
- '0' ;
1865 len
-= *format
- '0' ;
1893 void smt_swap_para(struct smt_header
*sm
, int len
, int direction
)
1894 /* int direction; 0 encode 1 decode */
1898 SK_UNUSED(direction
) ;
1905 int smt_action(struct s_smc
*smc
, int class, int code
, int index
)
1909 DB_SMT("SMT: action %d code %d\n",class,code
) ;
1911 case SMT_STATION_ACTION
:
1913 case SMT_STATION_ACTION_CONNECT
:
1914 smc
->mib
.fddiSMTRemoteDisconnectFlag
= FALSE
;
1915 queue_event(smc
,EVENT_ECM
,EC_CONNECT
) ;
1917 case SMT_STATION_ACTION_DISCONNECT
:
1918 queue_event(smc
,EVENT_ECM
,EC_DISCONNECT
) ;
1919 smc
->mib
.fddiSMTRemoteDisconnectFlag
= TRUE
;
1920 RS_SET(smc
,RS_DISCONNECT
) ;
1921 AIX_EVENT(smc
, (u_long
) FDDI_RING_STATUS
, (u_long
)
1922 FDDI_SMT_EVENT
, (u_long
) FDDI_REMOTE_DISCONNECT
,
1923 smt_get_event_word(smc
));
1925 case SMT_STATION_ACTION_PATHTEST
:
1926 AIX_EVENT(smc
, (u_long
) FDDI_RING_STATUS
, (u_long
)
1927 FDDI_SMT_EVENT
, (u_long
) FDDI_PATH_TEST
,
1928 smt_get_event_word(smc
));
1930 case SMT_STATION_ACTION_SELFTEST
:
1931 AIX_EVENT(smc
, (u_long
) FDDI_RING_STATUS
, (u_long
)
1932 FDDI_SMT_EVENT
, (u_long
) FDDI_REMOTE_SELF_TEST
,
1933 smt_get_event_word(smc
));
1935 case SMT_STATION_ACTION_DISABLE_A
:
1936 if (smc
->y
[PA
].pc_mode
== PM_PEER
) {
1937 RS_SET(smc
,RS_EVENT
) ;
1938 queue_event(smc
,EVENT_PCM
+PA
,PC_DISABLE
) ;
1941 case SMT_STATION_ACTION_DISABLE_B
:
1942 if (smc
->y
[PB
].pc_mode
== PM_PEER
) {
1943 RS_SET(smc
,RS_EVENT
) ;
1944 queue_event(smc
,EVENT_PCM
+PB
,PC_DISABLE
) ;
1947 case SMT_STATION_ACTION_DISABLE_M
:
1948 for (port
= 0 ; port
< NUMPHYS
; port
++) {
1949 if (smc
->mib
.p
[port
].fddiPORTMy_Type
!= TM
)
1951 RS_SET(smc
,RS_EVENT
) ;
1952 queue_event(smc
,EVENT_PCM
+port
,PC_DISABLE
) ;
1959 case SMT_PORT_ACTION
:
1961 case SMT_PORT_ACTION_ENABLE
:
1964 case SMT_PORT_ACTION_DISABLE
:
1965 event
= PC_DISABLE
;
1967 case SMT_PORT_ACTION_MAINT
:
1970 case SMT_PORT_ACTION_START
:
1973 case SMT_PORT_ACTION_STOP
:
1979 queue_event(smc
,EVENT_PCM
+index
,event
) ;
1988 * canonical conversion of <len> bytes beginning form *data
1991 static void hwm_conv_can(struct s_smc
*smc
, char *data
, int len
)
1997 for (i
= len
; i
; i
--, data
++)
1998 *data
= bitrev8(*data
);
2002 #endif /* no SLIM_SMT */