1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /******************************************************************************
4 * (C)Copyright 1998,1999 SysKonnect,
5 * a business unit of Schneider & Koch & Co. Datensysteme GmbH.
7 * See the file "skfddi.c" for further information.
9 * The information in this file is provided "AS IS" without warranty.
11 ******************************************************************************/
14 * *******************************************************************
15 * This SBA code implements the Synchronous Bandwidth Allocation
16 * functions described in the "FDDI Synchronous Forum Implementer's
17 * Agreement" dated December 1th, 1993.
18 * *******************************************************************
20 * PURPOSE: The purpose of this function is to control
21 * synchronous allocations on a single FDDI segment.
22 * Allocations are limited to the primary FDDI ring.
23 * The SBM provides recovery mechanisms to recover
24 * unused bandwidth also resolves T_Neg and
25 * reconfiguration changes. Many of the SBM state
26 * machine inputs are sourced by the underlying
27 * FDDI sub-system supporting the SBA application.
29 * *******************************************************************
45 #define LINT_USE(x) (x)=(x)
47 #define MS2BCLK(x) ((x)*12500L)
50 -------------------------------------------------------------
52 -------------------------------------------------------------
55 static const u_short plist_raf_alc_res
[] = { SMT_P0012
, SMT_P320B
, SMT_P320F
,
56 SMT_P3210
, SMT_P0019
, SMT_P001A
,
59 static const u_short plist_raf_chg_req
[] = { SMT_P320B
, SMT_P320F
, SMT_P3210
,
62 static const struct fddi_addr smt_sba_da
= {{0x80,0x01,0x43,0x00,0x80,0x0C}} ;
63 static const struct fddi_addr null_addr
= {{0,0,0,0,0,0}} ;
66 -------------------------------------------------------------
68 -------------------------------------------------------------
73 -------------------------------------------------------------
75 -------------------------------------------------------------
78 static void ess_send_response(struct s_smc
*smc
, struct smt_header
*sm
,
80 static void ess_config_fifo(struct s_smc
*smc
);
81 static void ess_send_alc_req(struct s_smc
*smc
);
82 static void ess_send_frame(struct s_smc
*smc
, SMbuf
*mb
);
85 -------------------------------------------------------------
87 -------------------------------------------------------------
91 -------------------------------------------------------------
93 -------------------------------------------------------------
96 void ess_timer_poll(struct s_smc
*smc
);
97 void ess_para_change(struct s_smc
*smc
);
98 int ess_raf_received_pack(struct s_smc
*smc
, SMbuf
*mb
, struct smt_header
*sm
,
100 static int process_bw_alloc(struct s_smc
*smc
, long int payload
, long int overhead
);
104 * --------------------------------------------------------------------------
105 * End Station Support (ESS)
106 * --------------------------------------------------------------------------
110 * evaluate the RAF frame
112 int ess_raf_received_pack(struct s_smc
*smc
, SMbuf
*mb
, struct smt_header
*sm
,
115 void *p
; /* universal pointer */
116 struct smt_p_0016
*cmd
; /* para: command for the ESS */
118 u_long msg_res_type
; /* recource type */
119 u_long payload
, overhead
;
124 * Message Processing Code
126 local
= ((fs
& L_INDICATOR
) != 0) ;
129 * get the resource type
131 if (!(p
= (void *) sm_to_para(smc
,sm
,SMT_P0015
))) {
132 DB_ESS("ESS: RAF frame error, parameter type not found");
135 msg_res_type
= ((struct smt_p_0015
*)p
)->res_type
;
138 * get the pointer to the ESS command
140 if (!(cmd
= (struct smt_p_0016
*) sm_to_para(smc
,sm
,SMT_P0016
))) {
142 * error in frame: para ESS command was not found
144 DB_ESS("ESS: RAF frame error, parameter command not found");
148 DB_ESSN(2, "fc %x ft %x", sm
->smt_class
, sm
->smt_type
);
149 DB_ESSN(2, "ver %x tran %x", sm
->smt_version
, sm
->smt_tid
);
150 DB_ESSN(2, "stn_id %pM", &sm
->smt_source
);
152 DB_ESSN(2, "infolen %x res %lx", sm
->smt_len
, msg_res_type
);
153 DB_ESSN(2, "sbacmd %x", cmd
->sba_cmd
);
156 * evaluate the ESS command
158 switch (cmd
->sba_cmd
) {
161 * Process an ESS Allocation Request
163 case REQUEST_ALLOCATION
:
165 * check for an RAF Request (Allocation Request)
167 if (sm
->smt_type
== SMT_REQUEST
) {
169 * process the Allocation request only if the frame is
170 * local and no static allocation is used
172 if (!local
|| smc
->mib
.fddiESSPayload
)
175 p
= (void *) sm_to_para(smc
,sm
,SMT_P0019
) ;
176 for (i
= 0; i
< 5; i
++) {
177 if (((struct smt_p_0019
*)p
)->alloc_addr
.a
[i
]) {
183 * Note: The Application should send a LAN_LOC_FRAME.
184 * The ESS do not send the Frame to the network!
186 smc
->ess
.alloc_trans_id
= sm
->smt_tid
;
187 DB_ESS("ESS: save Alloc Req Trans ID %x", sm
->smt_tid
);
188 p
= (void *) sm_to_para(smc
,sm
,SMT_P320F
) ;
189 ((struct smt_p_320f
*)p
)->mib_payload
=
190 smc
->mib
.a
[PATH0
].fddiPATHSbaPayload
;
191 p
= (void *) sm_to_para(smc
,sm
,SMT_P3210
) ;
192 ((struct smt_p_3210
*)p
)->mib_overhead
=
193 smc
->mib
.a
[PATH0
].fddiPATHSbaOverhead
;
194 sm
->smt_dest
= smt_sba_da
;
196 if (smc
->ess
.local_sba_active
)
197 return fs
| I_INDICATOR
;
199 if (!(db
= smt_get_mbuf(smc
)))
202 db
->sm_len
= mb
->sm_len
;
203 db
->sm_off
= mb
->sm_off
;
204 memcpy(((char *)(db
->sm_data
+db
->sm_off
)),(char *)sm
,
207 (struct smt_header
*)(db
->sm_data
+db
->sm_off
),
209 smt_send_frame(smc
,db
,FC_SMT_INFO
,0) ;
214 * The RAF frame is an Allocation Response !
215 * check the parameters
217 if (smt_check_para(smc
,sm
,plist_raf_alc_res
)) {
218 DB_ESS("ESS: RAF with para problem, ignoring");
223 * VERIFY THE FRAME IS WELL BUILT:
225 * 1. path index = primary ring only
226 * 2. resource type = sync bw only
227 * 3. trans action id = alloc_trans_id
228 * 4. reason code = success
230 * If any are violated, discard the RAF frame
232 if ((((struct smt_p_320b
*)sm_to_para(smc
,sm
,SMT_P320B
))->path_index
234 (msg_res_type
!= SYNC_BW
) ||
235 (((struct smt_p_reason
*)sm_to_para(smc
,sm
,SMT_P0012
))->rdf_reason
236 != SMT_RDF_SUCCESS
) ||
237 (sm
->smt_tid
!= smc
->ess
.alloc_trans_id
)) {
239 DB_ESS("ESS: Allocation Response not accepted");
244 * Extract message parameters
246 p
= (void *) sm_to_para(smc
,sm
,SMT_P320F
) ;
248 printk(KERN_ERR
"ESS: sm_to_para failed");
251 payload
= ((struct smt_p_320f
*)p
)->mib_payload
;
252 p
= (void *) sm_to_para(smc
,sm
,SMT_P3210
) ;
254 printk(KERN_ERR
"ESS: sm_to_para failed");
257 overhead
= ((struct smt_p_3210
*)p
)->mib_overhead
;
259 DB_ESSN(2, "payload= %lx overhead= %lx",
263 * process the bandwidth allocation
265 (void)process_bw_alloc(smc
,(long)payload
,(long)overhead
) ;
268 /* end of Process Allocation Request */
271 * Process an ESS Change Request
273 case CHANGE_ALLOCATION
:
275 * except only replies
277 if (sm
->smt_type
!= SMT_REQUEST
) {
278 DB_ESS("ESS: Do not process Change Responses");
283 * check the para for the Change Request
285 if (smt_check_para(smc
,sm
,plist_raf_chg_req
)) {
286 DB_ESS("ESS: RAF with para problem, ignoring");
291 * Verify the path index and resource
292 * type are correct. If any of
293 * these are false, don't process this
294 * change request frame.
296 if ((((struct smt_p_320b
*)sm_to_para(smc
,sm
,SMT_P320B
))->path_index
297 != PRIMARY_RING
) || (msg_res_type
!= SYNC_BW
)) {
298 DB_ESS("ESS: RAF frame with para problem, ignoring");
303 * Extract message queue parameters
305 p
= (void *) sm_to_para(smc
,sm
,SMT_P320F
) ;
306 payload
= ((struct smt_p_320f
*)p
)->mib_payload
;
307 p
= (void *) sm_to_para(smc
,sm
,SMT_P3210
) ;
308 overhead
= ((struct smt_p_3210
*)p
)->mib_overhead
;
310 DB_ESSN(2, "ESS: Change Request from %pM",
312 DB_ESSN(2, "payload= %lx overhead= %lx",
316 * process the bandwidth allocation
318 if(!process_bw_alloc(smc
,(long)payload
,(long)overhead
))
322 * send an RAF Change Reply
324 ess_send_response(smc
,sm
,CHANGE_ALLOCATION
) ;
327 /* end of Process Change Request */
330 * Process Report Response
332 case REPORT_ALLOCATION
:
334 * except only requests
336 if (sm
->smt_type
!= SMT_REQUEST
) {
337 DB_ESS("ESS: Do not process a Report Reply");
341 DB_ESSN(2, "ESS: Report Request from %pM",
345 * verify that the resource type is sync bw only
347 if (msg_res_type
!= SYNC_BW
) {
348 DB_ESS("ESS: ignoring RAF with para problem");
353 * send an RAF Change Reply
355 ess_send_response(smc
,sm
,REPORT_ALLOCATION
) ;
358 /* end of Process Report Request */
364 DB_ESS("ESS: ignoring RAF with bad sba_cmd");
372 * determines the synchronous bandwidth, set the TSYNC register and the
373 * mib variables SBAPayload, SBAOverhead and fddiMACT-NEG.
375 static int process_bw_alloc(struct s_smc
*smc
, long int payload
, long int overhead
)
378 * determine the synchronous bandwidth (sync_bw) in bytes per T-NEG,
379 * if the payload is greater than zero.
380 * For the SBAPayload and the SBAOverhead we have the following
384 * SBAPayload = | 8000 ------ |
389 * SBAOverhead = | ------ |
393 * T-NEG is described by the equation:
396 * T-NEG = -------------------
399 * The number of bytes we are able to send is the payload
402 * bytes T-NEG SBAPayload 8000 bytes/s
403 * sync_bw = SBAOverhead ------ + -----------------------------
408 * sync_bw = SBAOverhead + ---- (-)fddiMACT-NEG * SBAPayload
414 * set the mib attributes fddiPATHSbaOverhead, fddiPATHSbaPayload
416 /* if (smt_set_obj(smc,SMT_P320F,payload,S_SET)) {
417 DB_ESS("ESS: SMT does not accept the payload value");
420 if (smt_set_obj(smc,SMT_P3210,overhead,S_SET)) {
421 DB_ESS("ESS: SMT does not accept the overhead value");
426 if (payload
> MAX_PAYLOAD
|| overhead
> 5000) {
427 DB_ESS("ESS: payload / overhead not accepted");
432 * start the iterative allocation process if the payload or the overhead
433 * are smaller than the parsed values
435 if (smc
->mib
.fddiESSPayload
&&
436 ((u_long
)payload
!= smc
->mib
.fddiESSPayload
||
437 (u_long
)overhead
!= smc
->mib
.fddiESSOverhead
)) {
438 smc
->ess
.raf_act_timer_poll
= TRUE
;
439 smc
->ess
.timer_count
= 0 ;
443 * evulate the Payload
446 DB_ESSN(2, "ESS: turn SMT_ST_SYNC_SERVICE bit on");
447 smc
->ess
.sync_bw_available
= TRUE
;
449 smc
->ess
.sync_bw
= overhead
-
450 (long)smc
->mib
.m
[MAC0
].fddiMACT_Neg
*
454 DB_ESSN(2, "ESS: turn SMT_ST_SYNC_SERVICE bit off");
455 smc
->ess
.sync_bw_available
= FALSE
;
456 smc
->ess
.sync_bw
= 0 ;
460 smc
->mib
.a
[PATH0
].fddiPATHSbaPayload
= payload
;
461 smc
->mib
.a
[PATH0
].fddiPATHSbaOverhead
= overhead
;
464 DB_ESSN(2, "tsync = %lx", smc
->ess
.sync_bw
);
466 ess_config_fifo(smc
) ;
467 set_formac_tsync(smc
,smc
->ess
.sync_bw
) ;
471 static void ess_send_response(struct s_smc
*smc
, struct smt_header
*sm
,
474 struct smt_sba_chg
*chg
;
479 * get and initialize the response frame
481 if (sba_cmd
== CHANGE_ALLOCATION
) {
482 if (!(mb
=smt_build_frame(smc
,SMT_RAF
,SMT_REPLY
,
483 sizeof(struct smt_sba_chg
))))
487 if (!(mb
=smt_build_frame(smc
,SMT_RAF
,SMT_REPLY
,
488 sizeof(struct smt_sba_rep_res
))))
492 chg
= smtod(mb
,struct smt_sba_chg
*) ;
493 chg
->smt
.smt_tid
= sm
->smt_tid
;
494 chg
->smt
.smt_dest
= sm
->smt_source
;
497 chg
->s_type
.para
.p_type
= SMT_P0015
;
498 chg
->s_type
.para
.p_len
= sizeof(struct smt_p_0015
) - PARA_LEN
;
499 chg
->s_type
.res_type
= SYNC_BW
;
502 chg
->cmd
.para
.p_type
= SMT_P0016
;
503 chg
->cmd
.para
.p_len
= sizeof(struct smt_p_0016
) - PARA_LEN
;
504 chg
->cmd
.sba_cmd
= sba_cmd
;
507 chg
->path
.para
.p_type
= SMT_P320B
;
508 chg
->path
.para
.p_len
= sizeof(struct smt_p_320b
) - PARA_LEN
;
509 chg
->path
.mib_index
= SBAPATHINDEX
;
510 chg
->path
.path_pad
= 0;
511 chg
->path
.path_index
= PRIMARY_RING
;
514 chg
->payload
.para
.p_type
= SMT_P320F
;
515 chg
->payload
.para
.p_len
= sizeof(struct smt_p_320f
) - PARA_LEN
;
516 chg
->payload
.mib_index
= SBAPATHINDEX
;
517 chg
->payload
.mib_payload
= smc
->mib
.a
[PATH0
].fddiPATHSbaPayload
;
520 chg
->overhead
.para
.p_type
= SMT_P3210
;
521 chg
->overhead
.para
.p_len
= sizeof(struct smt_p_3210
) - PARA_LEN
;
522 chg
->overhead
.mib_index
= SBAPATHINDEX
;
523 chg
->overhead
.mib_overhead
= smc
->mib
.a
[PATH0
].fddiPATHSbaOverhead
;
525 if (sba_cmd
== CHANGE_ALLOCATION
) {
527 chg
->cat
.para
.p_type
= SMT_P001A
;
528 chg
->cat
.para
.p_len
= sizeof(struct smt_p_001a
) - PARA_LEN
;
529 p
= (void *) sm_to_para(smc
,sm
,SMT_P001A
) ;
530 chg
->cat
.category
= ((struct smt_p_001a
*)p
)->category
;
532 dump_smt(smc
,(struct smt_header
*)chg
,"RAF") ;
533 ess_send_frame(smc
,mb
) ;
536 void ess_timer_poll(struct s_smc
*smc
)
538 if (!smc
->ess
.raf_act_timer_poll
)
541 DB_ESSN(2, "ESS: timer_poll");
543 smc
->ess
.timer_count
++ ;
544 if (smc
->ess
.timer_count
== 10) {
545 smc
->ess
.timer_count
= 0 ;
546 ess_send_alc_req(smc
) ;
550 static void ess_send_alc_req(struct s_smc
*smc
)
552 struct smt_sba_alc_req
*req
;
556 * send never allocation request where the requested payload and
557 * overhead is zero or deallocate bandwidth when no bandwidth is
560 if (!smc
->mib
.fddiESSPayload
) {
561 smc
->mib
.fddiESSOverhead
= 0 ;
564 if (!smc
->mib
.fddiESSOverhead
)
565 smc
->mib
.fddiESSOverhead
= DEFAULT_OV
;
568 if (smc
->mib
.fddiESSOverhead
==
569 smc
->mib
.a
[PATH0
].fddiPATHSbaOverhead
&&
570 smc
->mib
.fddiESSPayload
==
571 smc
->mib
.a
[PATH0
].fddiPATHSbaPayload
){
572 smc
->ess
.raf_act_timer_poll
= FALSE
;
573 smc
->ess
.timer_count
= 7 ; /* next RAF alc req after 3 s */
578 * get and initialize the response frame
580 if (!(mb
=smt_build_frame(smc
,SMT_RAF
,SMT_REQUEST
,
581 sizeof(struct smt_sba_alc_req
))))
583 req
= smtod(mb
,struct smt_sba_alc_req
*) ;
584 req
->smt
.smt_tid
= smc
->ess
.alloc_trans_id
= smt_get_tid(smc
) ;
585 req
->smt
.smt_dest
= smt_sba_da
;
588 req
->s_type
.para
.p_type
= SMT_P0015
;
589 req
->s_type
.para
.p_len
= sizeof(struct smt_p_0015
) - PARA_LEN
;
590 req
->s_type
.res_type
= SYNC_BW
;
593 req
->cmd
.para
.p_type
= SMT_P0016
;
594 req
->cmd
.para
.p_len
= sizeof(struct smt_p_0016
) - PARA_LEN
;
595 req
->cmd
.sba_cmd
= REQUEST_ALLOCATION
;
598 * set the parameter type and parameter length of all used
603 req
->path
.para
.p_type
= SMT_P320B
;
604 req
->path
.para
.p_len
= sizeof(struct smt_p_320b
) - PARA_LEN
;
605 req
->path
.mib_index
= SBAPATHINDEX
;
606 req
->path
.path_pad
= 0;
607 req
->path
.path_index
= PRIMARY_RING
;
610 req
->pl_req
.para
.p_type
= SMT_P0017
;
611 req
->pl_req
.para
.p_len
= sizeof(struct smt_p_0017
) - PARA_LEN
;
612 req
->pl_req
.sba_pl_req
= smc
->mib
.fddiESSPayload
-
613 smc
->mib
.a
[PATH0
].fddiPATHSbaPayload
;
616 req
->ov_req
.para
.p_type
= SMT_P0018
;
617 req
->ov_req
.para
.p_len
= sizeof(struct smt_p_0018
) - PARA_LEN
;
618 req
->ov_req
.sba_ov_req
= smc
->mib
.fddiESSOverhead
-
619 smc
->mib
.a
[PATH0
].fddiPATHSbaOverhead
;
622 req
->payload
.para
.p_type
= SMT_P320F
;
623 req
->payload
.para
.p_len
= sizeof(struct smt_p_320f
) - PARA_LEN
;
624 req
->payload
.mib_index
= SBAPATHINDEX
;
625 req
->payload
.mib_payload
= smc
->mib
.a
[PATH0
].fddiPATHSbaPayload
;
628 req
->overhead
.para
.p_type
= SMT_P3210
;
629 req
->overhead
.para
.p_len
= sizeof(struct smt_p_3210
) - PARA_LEN
;
630 req
->overhead
.mib_index
= SBAPATHINDEX
;
631 req
->overhead
.mib_overhead
= smc
->mib
.a
[PATH0
].fddiPATHSbaOverhead
;
634 req
->a_addr
.para
.p_type
= SMT_P0019
;
635 req
->a_addr
.para
.p_len
= sizeof(struct smt_p_0019
) - PARA_LEN
;
636 req
->a_addr
.sba_pad
= 0;
637 req
->a_addr
.alloc_addr
= null_addr
;
640 req
->cat
.para
.p_type
= SMT_P001A
;
641 req
->cat
.para
.p_len
= sizeof(struct smt_p_001a
) - PARA_LEN
;
642 req
->cat
.category
= smc
->mib
.fddiESSCategory
;
645 req
->tneg
.para
.p_type
= SMT_P001B
;
646 req
->tneg
.para
.p_len
= sizeof(struct smt_p_001b
) - PARA_LEN
;
647 req
->tneg
.max_t_neg
= smc
->mib
.fddiESSMaxTNeg
;
650 req
->segm
.para
.p_type
= SMT_P001C
;
651 req
->segm
.para
.p_len
= sizeof(struct smt_p_001c
) - PARA_LEN
;
652 req
->segm
.min_seg_siz
= smc
->mib
.fddiESSMinSegmentSize
;
654 dump_smt(smc
,(struct smt_header
*)req
,"RAF") ;
655 ess_send_frame(smc
,mb
) ;
658 static void ess_send_frame(struct s_smc
*smc
, SMbuf
*mb
)
661 * check if the frame must be send to the own ESS
663 if (smc
->ess
.local_sba_active
) {
665 * Send the Change Reply to the local SBA
667 DB_ESS("ESS:Send to the local SBA");
668 if (!smc
->ess
.sba_reply_pend
)
669 smc
->ess
.sba_reply_pend
= mb
;
671 DB_ESS("Frame is lost - another frame was pending");
672 smt_free_mbuf(smc
,mb
) ;
677 * Send the SBA RAF Change Reply to the network
679 DB_ESS("ESS:Send to the network");
680 smt_send_frame(smc
,mb
,FC_SMT_INFO
,0) ;
684 void ess_para_change(struct s_smc
*smc
)
686 (void)process_bw_alloc(smc
,(long)smc
->mib
.a
[PATH0
].fddiPATHSbaPayload
,
687 (long)smc
->mib
.a
[PATH0
].fddiPATHSbaOverhead
) ;
690 static void ess_config_fifo(struct s_smc
*smc
)
693 * if nothing to do exit
695 if (smc
->mib
.a
[PATH0
].fddiPATHSbaPayload
) {
696 if (smc
->hw
.fp
.fifo
.fifo_config_mode
& SYNC_TRAFFIC_ON
&&
697 (smc
->hw
.fp
.fifo
.fifo_config_mode
&SEND_ASYNC_AS_SYNC
) ==
698 smc
->mib
.fddiESSSynchTxMode
) {
703 if (!(smc
->hw
.fp
.fifo
.fifo_config_mode
& SYNC_TRAFFIC_ON
)) {
709 * split up the FIFO and reinitialize the queues
711 formac_reinit_tx(smc
) ;
716 #endif /* no SLIM_SMT */