]> CyberLeo.Net >> Repos - FreeBSD/FreeBSD.git/blob - usr.sbin/atm/scspd/scsp_socket.c
merge fix for boot-time hang on centos' xen
[FreeBSD/FreeBSD.git] / usr.sbin / atm / scspd / scsp_socket.c
1 /*
2  *
3  * ===================================
4  * HARP  |  Host ATM Research Platform
5  * ===================================
6  *
7  *
8  * This Host ATM Research Platform ("HARP") file (the "Software") is
9  * made available by Network Computing Services, Inc. ("NetworkCS")
10  * "AS IS".  NetworkCS does not provide maintenance, improvements or
11  * support of any kind.
12  *
13  * NETWORKCS MAKES NO WARRANTIES OR REPRESENTATIONS, EXPRESS OR IMPLIED,
14  * INCLUDING, BUT NOT LIMITED TO, IMPLIED WARRANTIES OF MERCHANTABILITY
15  * AND FITNESS FOR A PARTICULAR PURPOSE, AS TO ANY ELEMENT OF THE
16  * SOFTWARE OR ANY SUPPORT PROVIDED IN CONNECTION WITH THIS SOFTWARE.
17  * In no event shall NetworkCS be responsible for any damages, including
18  * but not limited to consequential damages, arising from or relating to
19  * any use of the Software or related support.
20  *
21  * Copyright 1994-1998 Network Computing Services, Inc.
22  *
23  * Copies of this Software may be made, however, the above copyright
24  * notice must be reproduced on all copies.
25  *
26  *      @(#) $FreeBSD$
27  *
28  */
29
30
31 /*
32  * Server Cache Synchronization Protocol (SCSP) Support
33  * ----------------------------------------------------
34  *
35  * SCSP socket management routines
36  *
37  */
38
39 #include <sys/types.h>
40 #include <sys/param.h>
41 #include <sys/socket.h>
42 #include <net/if.h>
43 #include <netinet/in.h>
44 #include <netatm/port.h> 
45 #include <netatm/queue.h> 
46 #include <netatm/atm.h>
47 #include <netatm/atm_if.h>
48 #include <netatm/atm_sap.h>
49 #include <netatm/atm_sys.h>
50 #include <netatm/atm_ioctl.h>
51   
52 #include <errno.h>
53 #include <fcntl.h>
54 #include <libatm.h>
55 #include <stdio.h>
56 #include <stdlib.h>
57 #include <string.h>
58 #include <syslog.h>
59 #include <unistd.h>
60
61 #include "scsp_msg.h"
62 #include "scsp_if.h"
63 #include "scsp_var.h"
64
65 #ifndef lint
66 __RCSID("@(#) $FreeBSD$");
67 #endif
68
69
70 /*
71  * Local variables
72  */
73 static struct t_atm_llc llc_scsp = {
74         T_ATM_LLC_SHARING,
75         8,
76         {0xaa, 0xaa, 0x03, 0x00, 0x00, 0x5e, 0x00, 0x05}
77 };
78
79 static struct t_atm_aal5        aal5 = {
80         0,                      /* forward_max_SDU_size */
81         0,                      /* backward_max_SDU_size */
82         0                       /* SSCS_type */
83 };
84
85 static struct t_atm_traffic     traffic = {
86         {                       /* forward */
87                 T_ATM_ABSENT,   /* PCR_high_priority */
88                 0,              /* PCR_all_traffic */
89                 T_ATM_ABSENT,   /* SCR_high_priority */
90                 T_ATM_ABSENT,   /* SCR_all_traffic */
91                 T_ATM_ABSENT,   /* MBS_high_priority */
92                 T_ATM_ABSENT,   /* MBS_all_traffic */
93                 T_NO            /* tagging */
94         },
95         {                       /* backward */
96                 T_ATM_ABSENT,   /* PCR_high_priority */
97                 0,              /* PCR_all_traffic */
98                 T_ATM_ABSENT,   /* SCR_high_priority */
99                 T_ATM_ABSENT,   /* SCR_all_traffic */
100                 T_ATM_ABSENT,   /* MBS_high_priority */
101                 T_ATM_ABSENT,   /* MBS_all_traffic */
102                 T_NO            /* tagging */
103         },
104         T_YES                   /* best_effort */
105 };
106
107 static struct t_atm_bearer      bearer = {
108         T_ATM_CLASS_X,          /* bearer_class */
109         T_ATM_NULL,             /* traffic_type */
110         T_ATM_NULL,             /* timing_requirements */
111         T_NO,                   /* clipping_susceptibility */
112         T_ATM_1_TO_1            /* connection_configuration */
113 };
114
115 static struct t_atm_qos qos = {
116         T_ATM_NETWORK_CODING,           /* coding_standard */
117         {                               /* forward */
118                 T_ATM_QOS_CLASS_0       /* qos_class */
119         },
120         {                               /* backward */
121                 T_ATM_QOS_CLASS_0       /* qos_class */
122         }
123 };
124
125 static struct t_atm_app_name    appname = {
126         "SCSP"
127 };
128
129
130 /*
131  * Find a DCS, given its socket
132  *
133  * Arguments:
134  *      sd      socket descriptor
135  *
136  * Returns:
137  *      0       not found
138  *      address of DCS block corresponding to socket
139  *
140  */
141 Scsp_dcs *
142 scsp_find_dcs(sd)
143         int     sd;
144 {
145         Scsp_server     *ssp;
146         Scsp_dcs        *dcsp = NULL;
147
148         /*
149          * Loop through the list of servers
150          */
151         for (ssp = scsp_server_head; ssp; ssp = ssp->ss_next) {
152                 /*
153                  * Check all the DCSs chained from each server
154                  */
155                 for (dcsp = ssp->ss_dcs; dcsp; dcsp = dcsp->sd_next) {
156                         if (dcsp->sd_sock == sd)
157                                 break;
158                 }
159         }
160
161         return(dcsp);
162 }
163
164
165 /*
166  * Find a server, given its socket
167  *
168  * Arguments:
169  *      sd      socket descriptor
170  *
171  * Returns:
172  *      0       not found
173  *      address of server block corresponding to socket
174  *
175  */
176 Scsp_server *
177 scsp_find_server(sd)
178         int     sd;
179 {
180         Scsp_server     *ssp;
181
182         /*
183          * Loop through the list of servers
184          */
185         for (ssp = scsp_server_head; ssp; ssp = ssp->ss_next) {
186                 if (ssp->ss_sock == sd)
187                         break;
188         }
189
190         return(ssp);
191 }
192
193
194 /*
195  * Connect to a directly connected server
196  *
197  * Arguments:
198  *      dcsp    pointer to DCS block for server
199  *
200  * Returns:
201  *      0       success (dcsp->sd_sock is set)
202  *      else    errno indicating reason for failure
203  *
204  */
205 int
206 scsp_dcs_connect(dcsp)
207         Scsp_dcs        *dcsp;
208
209 {
210         int                     rc, sd;
211         struct sockaddr_atm     DCS_addr;
212
213         /*
214          * If the DCS already has an open connection, just return
215          */
216         if (dcsp->sd_sock != -1) {
217                 return(0);
218         }
219
220         /*
221          * Open an ATM socket
222          */
223         sd = socket(PF_ATM, SOCK_SEQPACKET, ATM_PROTO_AAL5);
224         if (sd == -1) {
225                 return(ESOCKTNOSUPPORT);
226         }
227         if (sd > scsp_max_socket) {
228                 scsp_max_socket = sd;
229         }
230
231         /*
232          * Set up connection parameters for SCSP connection
233          */
234         bzero(&DCS_addr, sizeof(DCS_addr));
235 #if (defined(BSD) && (BSD >= 199103))
236         DCS_addr.satm_len = sizeof(DCS_addr);
237 #endif
238         DCS_addr.satm_family = AF_ATM;
239         DCS_addr.satm_addr.t_atm_sap_addr.SVE_tag_addr =
240                         T_ATM_PRESENT;
241         DCS_addr.satm_addr.t_atm_sap_addr.SVE_tag_selector =
242                         T_ATM_PRESENT;
243         DCS_addr.satm_addr.t_atm_sap_addr.address_format =
244                         dcsp->sd_addr.address_format;
245         DCS_addr.satm_addr.t_atm_sap_addr.address_length =
246                         dcsp->sd_addr.address_length;
247         bcopy(dcsp->sd_addr.address,
248                         DCS_addr.satm_addr.t_atm_sap_addr.address,
249                         dcsp->sd_addr.address_length);
250
251         DCS_addr.satm_addr.t_atm_sap_layer2.SVE_tag =
252                         T_ATM_PRESENT;
253         DCS_addr.satm_addr.t_atm_sap_layer2.ID_type =
254                         T_ATM_SIMPLE_ID;
255         DCS_addr.satm_addr.t_atm_sap_layer2.ID.simple_ID =
256                         T_ATM_BLLI2_I8802;
257
258         DCS_addr.satm_addr.t_atm_sap_layer3.SVE_tag =
259                         T_ATM_ABSENT;
260         DCS_addr.satm_addr.t_atm_sap_appl.SVE_tag =
261                         T_ATM_ABSENT;
262
263         /*
264          * Bind the socket to our address
265          */
266         if (bind(sd, (struct sockaddr *)&DCS_addr,
267                         sizeof(DCS_addr))) {
268                 rc = errno;
269                 goto connect_fail;
270         }
271
272         /*
273          * Set non-blocking operation
274          */
275 #ifdef sun
276         rc = fcntl(sd, F_SETFL, FNBIO + FNDELAY);
277 #else
278         rc = fcntl(sd, F_SETFL, O_NONBLOCK);
279 #endif
280         if (rc == -1) {
281                 scsp_log(LOG_ERR, "scsp_dcs_connect: fcntl failed");
282                 rc = errno;
283                 goto connect_fail;
284         }
285
286         /*
287          * Set AAL 5 options
288          */
289         aal5.forward_max_SDU_size = dcsp->sd_server->ss_mtu;
290         aal5.backward_max_SDU_size = dcsp->sd_server->ss_mtu;
291         if (setsockopt(sd, T_ATM_SIGNALING, T_ATM_AAL5, (caddr_t)&aal5,
292                         sizeof(aal5)) < 0) {
293                 rc = EOPNOTSUPP;
294                 goto connect_fail;
295         }
296
297         /*
298          * Set traffic options
299          */
300         switch(dcsp->sd_server->ss_media) {
301         case MEDIA_TAXI_100:
302                 traffic.forward.PCR_all_traffic = ATM_PCR_TAXI100;
303                 traffic.backward.PCR_all_traffic = ATM_PCR_TAXI100;
304                 break;
305         case MEDIA_TAXI_140:
306                 traffic.forward.PCR_all_traffic = ATM_PCR_TAXI140;
307                 traffic.backward.PCR_all_traffic = ATM_PCR_TAXI140;
308                 break;
309         case MEDIA_OC3C:
310         case MEDIA_UTP155:
311                 traffic.forward.PCR_all_traffic = ATM_PCR_OC3C;
312                 traffic.backward.PCR_all_traffic = ATM_PCR_OC3C;
313                 break;
314         case MEDIA_OC12C:
315                 traffic.forward.PCR_all_traffic = ATM_PCR_OC12C;
316                 traffic.backward.PCR_all_traffic = ATM_PCR_OC12C;
317                 break;
318         case MEDIA_UNKNOWN:
319                 break;
320         }
321
322         if (setsockopt(sd, T_ATM_SIGNALING, T_ATM_TRAFFIC,
323                         (caddr_t)&traffic, sizeof(traffic)) < 0) {
324                 rc = EOPNOTSUPP;
325                 goto connect_fail;
326         }
327
328         /*
329          * Set bearer capability options
330          */
331         if (setsockopt(sd, T_ATM_SIGNALING, T_ATM_BEARER_CAP,
332                         (caddr_t)&bearer, sizeof(bearer)) < 0) {
333                 rc = EOPNOTSUPP;
334                 goto connect_fail;
335         }
336
337         /*
338          * Set QOS options
339          */
340         if (setsockopt(sd, T_ATM_SIGNALING, T_ATM_QOS,
341                         (caddr_t)&qos, sizeof(qos)) < 0) {
342                 rc = EOPNOTSUPP;
343                 goto connect_fail;
344         }
345
346         /*
347          * Set LLC identifier
348          */
349         if (setsockopt(sd, T_ATM_SIGNALING, T_ATM_LLC,
350                         (caddr_t)&llc_scsp, sizeof(llc_scsp)) < 0) {
351                 rc = EOPNOTSUPP;
352                 goto connect_fail;
353         }
354
355         /*
356          * Set application name
357          */
358         if (setsockopt(sd, T_ATM_SIGNALING, T_ATM_APP_NAME,
359                         (caddr_t)&appname, sizeof(appname)) < 0) {
360                 rc = EOPNOTSUPP;
361                 goto connect_fail;
362         }
363
364         /*
365          * Connect to DCS
366          */
367         if (connect(sd, (struct sockaddr *)&DCS_addr,
368                         sizeof(DCS_addr)) < 0 &&
369                         errno != EINPROGRESS) {
370                 rc = errno;
371                 goto connect_fail;
372         }
373
374         /*
375          * Set return values
376          */
377         dcsp->sd_sock = sd;
378         return(0);
379
380 connect_fail:
381         /*
382          * Close the socket if something didn't work
383          */
384         (void)close(sd);
385         dcsp->sd_sock = -1;
386         if (rc == 0)
387                 rc = EFAULT;
388         return(rc);
389 }
390
391
392 /*
393  * Listen for ATM connections from DCSs
394  *
395  * Arguments:
396  *      None
397  *
398  * Returns:
399  *      sock    socket which is listening (also set in
400                 ssp->ss_dcs_lsock)
401  *      -1      error encountered (reason in errno)
402  *
403  */
404 int
405 scsp_dcs_listen(ssp)
406         Scsp_server     *ssp;
407 {
408         int                     rc, sd;
409         struct sockaddr_atm     ls_addr;
410
411         /*
412          * Open a socket
413          */
414         sd = socket(PF_ATM, SOCK_SEQPACKET, ATM_PROTO_AAL5);
415         if (sd == -1) {
416                 rc = errno;
417                 goto listen_fail;
418         }
419         if (sd > scsp_max_socket) {
420                 scsp_max_socket = sd;
421         }
422
423         /*
424          * Set up our address
425          */
426         bzero(&ls_addr, sizeof(ls_addr));
427 #if (defined(BSD) && (BSD >= 199103))
428         ls_addr.satm_len = sizeof(ls_addr);
429 #endif
430         ls_addr.satm_family = AF_ATM;
431         ls_addr.satm_addr.t_atm_sap_addr.SVE_tag_addr = T_ATM_PRESENT;
432         ls_addr.satm_addr.t_atm_sap_addr.SVE_tag_selector =
433                         T_ATM_PRESENT;
434         ls_addr.satm_addr.t_atm_sap_addr.address_format =
435                         ssp->ss_addr.address_format;
436         ls_addr.satm_addr.t_atm_sap_addr.address_length =
437                         ssp->ss_addr.address_length;
438         bcopy(ssp->ss_addr.address,
439                         ls_addr.satm_addr.t_atm_sap_addr.address,
440                         ssp->ss_addr.address_length);
441
442         ls_addr.satm_addr.t_atm_sap_layer2.SVE_tag = T_ATM_PRESENT;
443         ls_addr.satm_addr.t_atm_sap_layer2.ID_type = T_ATM_SIMPLE_ID;
444         ls_addr.satm_addr.t_atm_sap_layer2.ID.simple_ID =
445                         T_ATM_BLLI2_I8802;
446
447         ls_addr.satm_addr.t_atm_sap_layer3.SVE_tag = T_ATM_ABSENT;
448         ls_addr.satm_addr.t_atm_sap_appl.SVE_tag = T_ATM_ABSENT;
449
450         /*
451          * Bind the socket to our address
452          */
453         rc = bind(sd, (struct sockaddr *)&ls_addr, sizeof(ls_addr));
454         if (rc == -1) {
455                 rc = errno;
456                 goto listen_fail;
457         }
458
459         /*
460          * Set non-blocking I/O
461          */
462 #ifdef sun
463         rc = fcntl(sd, F_SETFL, FNBIO + FNDELAY);
464 #else
465         rc = fcntl(sd, F_SETFL, O_NONBLOCK);
466 #endif
467         if (rc == -1) {
468                 scsp_log(LOG_ERR, "scsp_dcs_listen: fcntl failed");
469                 rc = errno;
470                 goto listen_fail;
471         }
472
473         /*
474          * Set AAL 5 options
475          */
476         aal5.forward_max_SDU_size = ssp->ss_mtu;
477         aal5.backward_max_SDU_size = ssp->ss_mtu;
478         if (setsockopt(sd, T_ATM_SIGNALING, T_ATM_AAL5, (caddr_t)&aal5,
479                         sizeof(aal5)) < 0) {
480                 rc = EOPNOTSUPP;
481                 goto listen_fail;
482         }
483
484         /*
485          * Set traffic options
486          */
487         switch(ssp->ss_media) {
488         case MEDIA_TAXI_100:
489                 traffic.forward.PCR_all_traffic = ATM_PCR_TAXI100;
490                 traffic.backward.PCR_all_traffic = ATM_PCR_TAXI100;
491                 break;
492         case MEDIA_TAXI_140:
493                 traffic.forward.PCR_all_traffic = ATM_PCR_TAXI140;
494                 traffic.backward.PCR_all_traffic = ATM_PCR_TAXI140;
495                 break;
496         case MEDIA_OC3C:
497         case MEDIA_UTP155:
498                 traffic.forward.PCR_all_traffic = ATM_PCR_OC3C;
499                 traffic.backward.PCR_all_traffic = ATM_PCR_OC3C;
500                 break;
501         case MEDIA_OC12C:
502                 traffic.forward.PCR_all_traffic = ATM_PCR_OC12C;
503                 traffic.backward.PCR_all_traffic = ATM_PCR_OC12C;
504                 break;
505         case MEDIA_UNKNOWN:
506                 break;
507         }
508
509         if (setsockopt(sd, T_ATM_SIGNALING, T_ATM_TRAFFIC,
510                         (caddr_t)&traffic, sizeof(traffic)) < 0) {
511                 rc = EOPNOTSUPP;
512                 goto listen_fail;
513         }
514
515         /*
516          * Set bearer capability options
517          */
518         if (setsockopt(sd, T_ATM_SIGNALING, T_ATM_BEARER_CAP,
519                         (caddr_t)&bearer, sizeof(bearer)) < 0) {
520                 rc = EOPNOTSUPP;
521                 goto listen_fail;
522         }
523
524         /*
525          * Set QOS options
526          */
527         if (setsockopt(sd, T_ATM_SIGNALING, T_ATM_QOS,
528                         (caddr_t)&qos, sizeof(qos)) < 0) {
529                 rc = EOPNOTSUPP;
530                 goto listen_fail;
531         }
532
533         /*
534          * Set LLC identifier
535          */
536         if (setsockopt(sd, T_ATM_SIGNALING, T_ATM_LLC,
537                         (caddr_t)&llc_scsp, sizeof(llc_scsp)) < 0) {
538                 rc = EOPNOTSUPP;
539                 goto listen_fail;
540         }
541
542         /*
543          * Set application name
544          */
545         if (setsockopt(sd, T_ATM_SIGNALING, T_ATM_APP_NAME,
546                         (caddr_t)&appname, sizeof(appname)) < 0) {
547                 rc = EOPNOTSUPP;
548                 goto listen_fail;
549         }
550
551         /*
552          * Listen for new connections
553          */
554         if (listen(sd, 5) < 0) {
555                 rc = errno;
556                 goto listen_fail;
557         }
558
559         ssp->ss_dcs_lsock = sd;
560         return(sd);
561
562 listen_fail:
563         /*
564          * Close the socket if anything didn't work
565          */
566         (void)close(sd);
567         if (rc == 0)
568                 errno = EFAULT;
569         else
570                 errno = rc;
571         ssp->ss_dcs_lsock = -1;
572         return(-1);
573 }
574
575
576 /*
577  * Accept a connection from a DCS
578  *
579  * Arguments:
580  *      ssp     pointer to server block
581  *
582  * Returns:
583  *      address of DCS with new connection
584  *      0       failure (errno has reason)
585  *
586  */
587 Scsp_dcs *
588 scsp_dcs_accept(ssp)
589         Scsp_server     *ssp;
590 {
591         int                     len, rc, sd;
592         struct sockaddr_atm     dcs_sockaddr;
593         struct t_atm_sap_addr   *dcs_addr = &dcs_sockaddr.satm_addr.t_atm_sap_addr;
594         Atm_addr                dcs_atmaddr;
595         Scsp_dcs                *dcsp;
596
597         /*
598          * Accept the new connection
599          */
600         len = sizeof(dcs_sockaddr);
601         sd = accept(ssp->ss_dcs_lsock,
602                         (struct sockaddr *)&dcs_sockaddr, &len);
603         if (sd < 0) {
604                 return((Scsp_dcs *)0);
605         }
606         if (sd > scsp_max_socket) {
607                 scsp_max_socket = sd;
608         }
609
610         /*
611          * Copy the DCS's address from the sockaddr to an Atm_addr
612          */
613         if (dcs_addr->SVE_tag_addr != T_ATM_PRESENT) {
614                 dcs_atmaddr.address_format = T_ATM_ABSENT;
615                 dcs_atmaddr.address_length = 0;
616         } else {
617                 dcs_atmaddr.address_format = dcs_addr->address_format;
618                 dcs_atmaddr.address_length = dcs_addr->address_length;
619                 bcopy(dcs_addr->address, dcs_atmaddr.address,
620                                 dcs_addr->address_length);
621         }
622
623         /*
624          * Find out which DCS this connection is for
625          */
626         for (dcsp = ssp->ss_dcs; dcsp; dcsp = dcsp->sd_next) {
627                 /*
628                  * Compare DCS's address to address
629                  * configured by user
630                  */
631                 if (ATM_ADDR_EQUAL(&dcsp->sd_addr,
632                                 &dcs_atmaddr))
633                         break;
634         }
635
636         /*
637          * Make sure we have this DCS configured
638          */
639         if (!dcsp) {
640                 errno = EINVAL;
641                 goto dcs_accept_fail;
642         }
643
644         /*
645          * Make sure we are in a state to accept the connection
646          */
647         if (ssp->ss_state != SCSP_SS_ACTIVE) {
648                 errno = EACCES;
649                 goto dcs_accept_fail;
650         }
651
652         /*
653          * Make sure we don't already have a connection to this DCS
654          */
655         if (dcsp->sd_sock != -1) {
656                 errno = EALREADY;
657                 goto dcs_accept_fail;
658         }
659
660         /*
661          * Set application name
662          */
663         if (setsockopt(sd, T_ATM_SIGNALING, T_ATM_APP_NAME,
664                         (caddr_t)&appname, sizeof(appname)) < 0) {
665                 rc = EOPNOTSUPP;
666                 goto dcs_accept_fail;
667         }
668
669         /*
670          * Set non-blocking I/O
671          */
672 #ifdef sun
673                 rc = fcntl(sd, F_SETFL, FNBIO + FNDELAY);
674 #else
675                 rc = fcntl(sd, F_SETFL, O_NONBLOCK);
676 #endif
677         if (rc == -1) {
678                 goto dcs_accept_fail;
679         }
680
681         /*
682          * Cancel the open retry timer
683          */
684         HARP_CANCEL(&dcsp->sd_open_t);
685
686         /*
687          * Save the socket address and return the
688          * address of the DCS
689          */
690         dcsp->sd_sock = sd;
691         return(dcsp);
692
693 dcs_accept_fail:
694         /*
695          * An error has occured--clean up and return
696          */
697         (void)close(sd);
698         return((Scsp_dcs *)0);
699 }
700
701
702 /*
703  * Read an SCSP message from a directly connected server
704  *
705  * Arguments:
706  *      dcsp    pointer to DCS block that has data
707  *
708  * Returns:
709  *      0       success
710  *      else    errno indicating reason for failure
711  *
712  */
713 int
714 scsp_dcs_read(dcsp)
715         Scsp_dcs        *dcsp;
716
717 {
718         int                     len, rc;
719         char                    *buff = (char *)0;
720         Scsp_server             *ssp = dcsp->sd_server;
721         Scsp_msg                *msg;
722
723         /*
724          * Get a buffer to hold the entire message
725          */
726         len = ssp->ss_mtu;
727         buff = calloc(1, len);
728         if (buff == NULL)
729                 scsp_mem_err("scsp_dcs_read: ssp->ss_mtu");
730
731         /*
732          * Read the message
733          */
734         len = read(dcsp->sd_sock, buff, len);
735         if (len < 0) {
736                 goto dcs_read_fail;
737         }
738
739         /*
740          * Parse the input message and pass it to the Hello FSM
741          */
742         msg = scsp_parse_msg(buff, len);
743         if (msg) {
744                 /*
745                  * Write the message to the trace file if
746                  * it's of a type we're tracing
747                  */
748                 if (((scsp_trace_mode & SCSP_TRACE_HELLO_MSG) &&
749                                 msg->sc_msg_type == SCSP_HELLO_MSG) ||
750                                 ((scsp_trace_mode & SCSP_TRACE_CA_MSG) &&
751                                 msg->sc_msg_type != SCSP_HELLO_MSG)) {
752                         scsp_trace_msg(dcsp, msg, 1);
753                         scsp_trace("\n");
754                 }
755
756                 /*
757                  * Pass the message to the Hello FSM
758                  */
759                 rc = scsp_hfsm(dcsp, SCSP_HFSM_RCVD, msg);
760                 scsp_free_msg(msg);
761         } else {
762                 /*
763                  * Message was invalid.  Write it to the trace file
764                  * if we're tracing messages.
765                  */
766                 if (scsp_trace_mode & (SCSP_TRACE_HELLO_MSG &
767                                 SCSP_TRACE_CA_MSG)) {
768                         int     i;
769                         scsp_trace("Invalid message received:\n");
770                         scsp_trace("0x");
771                         for (i = 0; i < len; i++) {
772                                 scsp_trace("%02x ", (u_char)buff[i]);
773                         }
774                         scsp_trace("\n");
775                 }
776         }
777         free(buff);
778
779         return(0);
780
781 dcs_read_fail:
782         /*
783          * Error on read--check for special conditions
784          */
785         rc = errno;
786         if (errno == ECONNRESET) {
787                 /*
788                  * VCC has been closed--pass the event to
789                  * the Hello FSM
790                  */
791                 rc = scsp_hfsm(dcsp, SCSP_HFSM_VC_CLOSED,
792                                 (Scsp_msg *)0);
793         }
794         if (errno == ECONNREFUSED) {
795                 /*
796                  * VCC open failed--set a timer and try
797                  * again when it fires
798                  */
799                 HARP_TIMER(&dcsp->sd_open_t,
800                                 SCSP_Open_Interval,
801                                 scsp_open_timeout);
802                 rc = 0;
803         }
804
805         if (buff)
806                 free(buff);
807         return(rc);
808 }
809
810
811 /*
812  * Listen for Unix connections from SCSP client servers
813  *
814  * Arguments:
815  *      None
816  *
817  * Returns:
818  *      sock    socket which is listening
819  *      -1      error (reason in errno)
820  *
821  */
822 int
823 scsp_server_listen()
824 {
825         int     rc, sd;
826
827         static struct sockaddr  scsp_addr = {
828 #if (defined(BSD) && (BSD >= 199103))
829                 sizeof(struct sockaddr),        /* sa_len */
830 #endif
831                 AF_UNIX,                        /* sa_family */
832                 SCSPD_SOCK_NAME                 /* sa_data */
833         };
834
835         /*
836          * Unlink any old socket
837          */
838         rc = unlink(SCSPD_SOCK_NAME);
839         if (rc < 0 && errno != ENOENT)
840                 return(-1);
841
842         /*
843          * Open a socket
844          */
845         sd = socket(PF_UNIX, SOCK_STREAM, 0);
846         if (sd == -1) {
847                 return(-1);
848         }
849         if (sd > scsp_max_socket) {
850                 scsp_max_socket = sd;
851         }
852
853         /*
854          * Bind the socket's address
855          */
856         rc = bind(sd, &scsp_addr, sizeof(scsp_addr));
857         if (rc == -1) {
858                 (void)close(sd);
859                 return(-1);
860         }
861
862         /*
863          * Set non-blocking I/O
864          */
865 #ifdef sun
866                 rc = fcntl(sd, F_SETFL, FNBIO + FNDELAY);
867 #else
868                 rc = fcntl(sd, F_SETFL, O_NONBLOCK);
869 #endif
870         if (rc == -1) {
871                 (void)close(sd);
872                 return(-1);
873         }
874
875         /*
876          * Listen for new connections
877          */
878         if (listen(sd, 5) < 0) {
879                 (void)close(sd);
880                 return(-1);
881         }
882
883         return(sd);
884 }
885
886
887 /*
888  * Accept a connection from a server
889  *
890  * We accept a connection, but we won't know which server it is
891  * from until we get the configuration data from the server.  We
892  * put the connection on a 'pending' queue and will assign it to
893  * a server when the config data arrives.
894  *
895  * Arguments:
896  *      ls      listening socket to accept from
897  *
898  * Returns:
899  *      0       success
900  *      errno   reason for failure
901  *
902  */
903 int
904 scsp_server_accept(ls)
905         int     ls;
906
907 {
908         int             len, rc, sd;
909         struct sockaddr server_addr;
910         Scsp_pending    *psp;
911
912         /*
913          * Accept the new connection
914          */
915         len = sizeof(server_addr);
916         sd = accept(ls, (struct sockaddr *)&server_addr, &len);
917         if (sd < 0) {
918                 return(errno);
919         }
920         if (sd > scsp_max_socket) {
921                 scsp_max_socket = sd;
922         }
923
924         /*
925          * Set non-blocking operation
926          */
927 #ifdef sun
928         rc = fcntl(sd, F_SETFL, FNBIO + FNDELAY);
929 #else
930         rc = fcntl(sd, F_SETFL, O_NONBLOCK);
931 #endif
932         if (rc == -1) {
933                 (void)close(sd);
934                 rc = errno;
935         }
936
937         /*
938          * Put the new socket on the 'pending' queue
939          */
940         psp = calloc(1, sizeof(Scsp_pending));
941         if (!psp)
942                 scsp_mem_err("scsp_server_accept: sizeof(Scsp_pending)");
943         psp->sp_sock = sd;
944         LINK2TAIL(psp, Scsp_pending, scsp_pending_head, sp_next);
945
946         return(0);
947 }
948
949
950 /*
951  * Read a server interface message from a socket
952  *
953  * Arguments:
954  *      sd      socket to read from
955  *
956  * Returns:
957  *      msg     pointer to message read
958  *      0       failure (errno has reason)
959  *
960  */
961 Scsp_if_msg *
962 scsp_if_sock_read(sd)
963         int     sd;
964
965 {
966         int             len;
967         char            *buff = (char *)0;
968         Scsp_if_msg     *msg;
969         Scsp_if_msg_hdr msg_hdr;
970
971         /*
972          * Read the message header from the socket
973          */
974         len = read(sd, (char *)&msg_hdr, sizeof(msg_hdr));
975         if (len != sizeof(msg_hdr)) {
976                 if (len >= 0)
977                         errno = EINVAL;
978                 goto socket_read_fail;
979         }
980
981         /*
982          * Get a buffer and read the rest of the message into it
983          */
984         buff = malloc(msg_hdr.sh_len);
985         if (buff == NULL)
986                 scsp_mem_err("scsp_if_sock_read: msg_hdr.sh_len");
987         msg = (Scsp_if_msg *)buff;
988         msg->si_hdr = msg_hdr;
989         len = read(sd, &buff[sizeof(Scsp_if_msg_hdr)],
990                         msg->si_len - sizeof(Scsp_if_msg_hdr));
991         if (len != msg->si_len - sizeof(Scsp_if_msg_hdr)) {
992                 if (len >= 0) {
993                         errno = EINVAL;
994                 }
995                 goto socket_read_fail;
996         }
997
998         /*
999          * Trace the message
1000          */
1001         if (scsp_trace_mode & SCSP_TRACE_IF_MSG) {
1002                 scsp_trace("Received server I/F message:\n");
1003                 print_scsp_if_msg(scsp_trace_file, msg);
1004                 scsp_trace("\n");
1005         }
1006
1007         return(msg);
1008
1009 socket_read_fail:
1010         if (buff)
1011                 free(buff);
1012         return((Scsp_if_msg *)0);
1013 }
1014
1015
1016 /*
1017  * Write a server interface message to a socket
1018  *
1019  * Arguments:
1020  *      sd      socket to write to
1021  *      msg     pointer to message to write
1022  *
1023  * Returns:
1024  *      0       success
1025  *      errno   reason for failure
1026  *
1027  */
1028 int
1029 scsp_if_sock_write(sd, msg)
1030         int             sd;
1031         Scsp_if_msg     *msg;
1032 {
1033         int     len, rc;
1034
1035         /*
1036          * Trace the message
1037          */
1038         if (scsp_trace_mode & SCSP_TRACE_IF_MSG) {
1039                 scsp_trace("Writing server I/F message:\n");
1040                 print_scsp_if_msg(scsp_trace_file, msg);
1041                 scsp_trace("\n");
1042         }
1043
1044         /*
1045          * Write the message to the indicated socket
1046          */
1047         len = write(sd, (char *)msg, msg->si_len);
1048         if (len != msg->si_len) {
1049                 if (len < 0)
1050                         rc = errno;
1051                 else
1052                         rc = EINVAL;
1053         } else {
1054                 rc = 0;
1055         }
1056
1057         return(rc);
1058 }
1059
1060
1061 /*
1062  * Read data from a local server
1063  *
1064  * Arguments:
1065  *      ssp     pointer to server block that has data
1066  *
1067  * Returns:
1068  *      0       success
1069  *      else    errno indicating reason for failure
1070  *
1071  */
1072 int
1073 scsp_server_read(ssp)
1074         Scsp_server     *ssp;
1075 {
1076         int             rc;
1077         Scsp_dcs        *dcsp;
1078         Scsp_if_msg     *msg;
1079
1080         /*
1081          * Read the message
1082          */
1083         msg = scsp_if_sock_read(ssp->ss_sock);
1084         if (!msg) {
1085                 if (errno == EWOULDBLOCK) {
1086                         /*
1087                          * Nothing to read--just return
1088                          */
1089                         return(0);
1090                 } else {
1091                         /*
1092                          * Error--shut down the server entry
1093                          */
1094                         scsp_server_shutdown(ssp);
1095                 }
1096                 return(errno);
1097         }
1098
1099         /*
1100          * Process the received message
1101          */
1102         switch(msg->si_type) {
1103         case SCSP_NOP_REQ:
1104                 /*
1105                  * Ignore a NOP
1106                  */
1107                 break;
1108         case SCSP_CACHE_RSP:
1109                 /*
1110                  * Summarize the server's cache and try to open
1111                  * connections to all of its DCSs
1112                  */
1113                 scsp_process_cache_rsp(ssp, msg);
1114                 ssp->ss_state = SCSP_SS_ACTIVE;
1115                 for (dcsp = ssp->ss_dcs; dcsp; dcsp = dcsp->sd_next) {
1116                         if (scsp_dcs_connect(dcsp)) {
1117                                 /*
1118                                  * Connect failed -- the DCS may not
1119                                  * be up yet, so we'll try again later
1120                                  */
1121                                 HARP_TIMER(&dcsp->sd_open_t,
1122                                                 SCSP_Open_Interval,
1123                                                 scsp_open_timeout);
1124                         }
1125                 }
1126                 ssp->ss_state = SCSP_SS_ACTIVE;
1127                 break;
1128         case SCSP_SOLICIT_RSP:
1129                 /*
1130                  * The server has answered our request for a particular
1131                  * entry from its cache
1132                  */
1133                 dcsp = (Scsp_dcs *)msg->si_tok;
1134                 rc = scsp_cfsm(dcsp, SCSP_CIFSM_SOL_RSP, (Scsp_msg *)0,
1135                                 msg);
1136                 break;
1137         case SCSP_UPDATE_REQ:
1138                 /*
1139                  * Pass the update request to the FSMs for all
1140                  * DCSs associated with the server
1141                  */
1142                 if (ssp->ss_state == SCSP_SS_ACTIVE) {
1143                         for (dcsp = ssp->ss_dcs; dcsp;
1144                                         dcsp = dcsp->sd_next) {
1145                                 rc = scsp_cfsm(dcsp, SCSP_CIFSM_UPD_REQ,
1146                                                 (Scsp_msg *)0, msg);
1147                         }
1148                 }
1149                 break;
1150         case SCSP_UPDATE_RSP:
1151                 /*
1152                  * Pass the update response to the FSM for the
1153                  * DCS associated with the request
1154                  */
1155                 dcsp = (Scsp_dcs *)msg->si_tok;
1156                 rc = scsp_cfsm(dcsp, SCSP_CIFSM_UPD_RSP,
1157                                 (Scsp_msg *)0, msg);
1158                 break;
1159         default:
1160                 scsp_log(LOG_ERR, "invalid message type %d from server",
1161                                 msg->si_type);
1162                 return(EINVAL);
1163         }
1164
1165         free(msg);
1166         return(0);
1167 }
1168
1169
1170 /*
1171  * Send a Cache Indication to a server
1172  *
1173  * Arguments:
1174  *      ssp     pointer to server block block
1175  *
1176  * Returns:
1177  *      0       success
1178  *      else    errno indicating reason for failure
1179  *
1180  */
1181 int
1182 scsp_send_cache_ind(ssp)
1183         Scsp_server     *ssp;
1184 {
1185         int             rc;
1186         Scsp_if_msg     *msg;
1187
1188         /*
1189          * Get storage for a server interface message
1190          */
1191         msg = calloc(1, sizeof(Scsp_if_msg));
1192         if (msg == NULL)
1193                 scsp_mem_err("scsp_send_cache_ind: sizeof(Scsp_if_msg)");
1194         /*
1195          * Fill out the message
1196          */
1197         msg->si_type = SCSP_CACHE_IND;
1198         msg->si_proto = ssp->ss_pid;
1199         msg->si_len = sizeof(Scsp_if_msg_hdr);
1200         msg->si_tok = (u_long)ssp;
1201
1202         /*
1203          * Send the message
1204          */
1205         rc = scsp_if_sock_write(ssp->ss_sock, msg);
1206         free(msg);
1207         return(rc);
1208 }
1209
1210
1211 /*
1212  * Read data from a pending server connection
1213  *
1214  * Arguments:
1215  *      psp     pointer to pending block that has data
1216  *
1217  * Returns:
1218  *      0       success
1219  *      else    errno indicating reason for failure
1220  *
1221  */
1222 int
1223 scsp_pending_read(psp)
1224         Scsp_pending    *psp;
1225
1226 {
1227         int             rc;
1228         Scsp_server     *ssp;
1229         Scsp_if_msg     *msg;
1230
1231         /*
1232          * Read the message from the pending socket
1233          */
1234         msg = scsp_if_sock_read(psp->sp_sock);
1235         if (!msg) {
1236                 rc = errno;
1237                 goto pending_read_fail;
1238         }
1239
1240         /*
1241          * Make sure this is configuration data
1242          */
1243         if (msg->si_type != SCSP_CFG_REQ) {
1244                 scsp_log(LOG_ERR, "invalid message type %d from pending server",
1245                                 msg->si_type);
1246                 rc = EINVAL;
1247                 goto pending_read_fail;
1248         }
1249
1250         /*
1251          * Find the server this message is for
1252          */
1253         for (ssp = scsp_server_head; ssp; ssp = ssp->ss_next) {
1254                 if (strcmp(ssp->ss_intf, msg->si_cfg.atmarp_netif) == 0)
1255                         break;
1256         }
1257         if (!ssp) {
1258                 scsp_log(LOG_ERR, "refused connection from server for %s",
1259                                 msg->si_cfg.atmarp_netif);
1260                 rc = EINVAL;
1261                 goto config_reject;
1262         }
1263
1264         /*
1265          * Make sure the server is ready to go
1266          */
1267         rc = scsp_get_server_info(ssp);
1268         if (rc) {
1269                 goto config_reject;
1270         }
1271
1272         /*
1273          * Save the socket
1274          */
1275         ssp->ss_sock = psp->sp_sock;
1276         ssp->ss_state = SCSP_SS_CFG;
1277         UNLINK(psp, Scsp_pending, scsp_pending_head, sp_next);
1278         free(psp);
1279
1280         /*
1281          * Listen for connections from the server's DCSs
1282          */
1283         rc = scsp_dcs_listen(ssp);
1284         if (rc < 0) {
1285                 rc = errno;
1286                 goto config_reject;
1287         }
1288
1289         /*
1290          * Respond to the configuration message
1291          */
1292         msg->si_type = SCSP_CFG_RSP;
1293         msg->si_rc = SCSP_RSP_OK;
1294         msg->si_len = sizeof(Scsp_if_msg_hdr);
1295         rc = scsp_if_sock_write(ssp->ss_sock, msg);
1296         if (rc) {
1297                 goto config_error;;
1298         }
1299
1300         /*
1301          * Ask the server to send us its cache
1302          */
1303         rc = scsp_send_cache_ind(ssp);
1304         if (rc) {
1305                 goto config_error;
1306         }
1307
1308         free(msg);
1309         return(0);
1310
1311 config_reject:
1312         /*
1313          * Respond to the configuration message
1314          */
1315         msg->si_type = SCSP_CFG_RSP;
1316         msg->si_rc = SCSP_RSP_REJ;
1317         msg->si_len = sizeof(Scsp_if_msg_hdr);
1318         (void)scsp_if_sock_write(ssp->ss_sock, msg);
1319
1320 config_error:
1321         if (ssp->ss_sock != -1) {
1322                 (void)close(ssp->ss_sock);
1323                 ssp->ss_sock = -1;
1324         }
1325         if (ssp->ss_dcs_lsock != -1) {
1326                 (void)close(ssp->ss_dcs_lsock);
1327                 ssp->ss_sock = -1;
1328         }
1329         ssp->ss_state = SCSP_SS_NULL;
1330         free(msg);
1331
1332         return(rc);
1333
1334 pending_read_fail:
1335         /*
1336          * Close the socket and free the pending read block
1337          */
1338         (void)close(psp->sp_sock);
1339         UNLINK(psp, Scsp_pending, scsp_pending_head, sp_next);
1340         free(psp);
1341         if (msg)
1342                 free(msg);
1343         return(rc);
1344 }