xref: /illumos-gate/usr/src/lib/librstp/common/vector.c (revision 55fea89dcaa64928bed4327112404dcb3e07b79f)
1 /************************************************************************
2  * RSTP library - Rapid Spanning Tree (802.1t, 802.1w)
3  * Copyright (C) 2001-2003 Optical Access
4  * Author: Alex Rozin
5  *
6  * This file is part of RSTP library.
7  *
8  * RSTP library is free software; you can redistribute it and/or modify it
9  * under the terms of the GNU Lesser General Public License as published by the
10  * Free Software Foundation; version 2.1
11  *
12  * RSTP library is distributed in the hope that it will be useful, but
13  * WITHOUT ANY WARRANTY; without even the implied warranty of
14  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU Lesser
15  * General Public License for more details.
16  *
17  * You should have received a copy of the GNU Lesser General Public License
18  * along with RSTP library; see the file COPYING.  If not, write to the Free
19  * Software Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA
20  * 02111-1307, USA.
21  **********************************************************************/
22 
23 /* STP priority vectors API : 17.4.2 */
24 
25 #include "base.h"
26 #include "stp_bpdu.h"
27 #include "vector.h"
28 #include "stp_vectors.h"
29 
30 int
STP_VECT_compare_bridge_id(BRIDGE_ID * b1,BRIDGE_ID * b2)31 STP_VECT_compare_bridge_id (BRIDGE_ID* b1, BRIDGE_ID* b2)
32 {
33   if (b1->prio < b2->prio)
34     return -1;
35 
36   if (b1->prio > b2->prio)
37     return 1;
38   return memcmp (b1->addr, b2->addr, 6);
39 }
40 
41 void
STP_VECT_copy(OUT PRIO_VECTOR_T * t,IN PRIO_VECTOR_T * f)42 STP_VECT_copy (OUT PRIO_VECTOR_T* t, IN PRIO_VECTOR_T* f)
43 {
44   (void) memcpy (t, f, sizeof (PRIO_VECTOR_T));
45 }
46 
47 void
STP_VECT_create(OUT PRIO_VECTOR_T * t,IN BRIDGE_ID * root_br,IN unsigned long root_path_cost,IN BRIDGE_ID * design_bridge,IN PORT_ID design_port,IN PORT_ID bridge_port)48 STP_VECT_create (OUT PRIO_VECTOR_T* t,
49                  IN BRIDGE_ID* root_br,
50                  IN unsigned long root_path_cost,
51                  IN BRIDGE_ID* design_bridge,
52                  IN PORT_ID design_port,
53                  IN PORT_ID bridge_port)
54 {
55   (void) memcpy (&t->root_bridge, root_br, sizeof (BRIDGE_ID));
56   t->root_path_cost = root_path_cost;
57   (void) memcpy (&t->design_bridge, design_bridge, sizeof (BRIDGE_ID));
58   t->design_port = design_port;
59   t->bridge_port = bridge_port;
60 }
61 
62 int
STP_VECT_compare_vector(PRIO_VECTOR_T * v1,PRIO_VECTOR_T * v2)63 STP_VECT_compare_vector (PRIO_VECTOR_T* v1, PRIO_VECTOR_T* v2)
64 {
65   int bridcmp;
66 
67   bridcmp = STP_VECT_compare_bridge_id (&v1->root_bridge, &v2->root_bridge);
68   if (bridcmp < 0) return bridcmp;
69 
70   if (! bridcmp) {
71     bridcmp = v1->root_path_cost - v2->root_path_cost;
72     if (bridcmp < 0) return bridcmp;
73     if (! bridcmp) {
74       bridcmp = STP_VECT_compare_bridge_id (&v1->design_bridge, &v2->design_bridge);
75       if (bridcmp < 0) return bridcmp;
76       if (! bridcmp) {
77         bridcmp = v1->design_port - v2->design_port;
78         if (bridcmp < 0) return bridcmp;
79         if (! bridcmp)
80           return v1->bridge_port - v2->bridge_port;
81       }
82     }
83   }
84 
85   return bridcmp;
86 }
87 
88 static unsigned short
stp_vect_get_short(IN unsigned char * f)89 stp_vect_get_short (IN unsigned char* f)
90 {
91   /* LINTED: alignment */
92   return ntohs (*(unsigned short *)f);
93 }
94 
95 static void
stp_vect_set_short(IN unsigned short f,OUT unsigned char * t)96 stp_vect_set_short (IN unsigned short f, OUT unsigned char* t)
97 {
98   /* LINTED: alignment */
99   *(unsigned short *)t = htons (f);
100 }
101 
102 static void
stp_vect_get_bridge_id(IN unsigned char * c_br,OUT BRIDGE_ID * bridge_id)103 stp_vect_get_bridge_id (IN unsigned char* c_br, OUT BRIDGE_ID* bridge_id)
104 {
105   bridge_id->prio = stp_vect_get_short (c_br);
106   (void) memcpy (bridge_id->addr, c_br + 2, 6);
107 }
108 
109 static void
stp_vect_set_bridge_id(IN BRIDGE_ID * bridge_id,OUT unsigned char * c_br)110 stp_vect_set_bridge_id (IN BRIDGE_ID* bridge_id, OUT unsigned char* c_br)
111 {
112   stp_vect_set_short (bridge_id->prio, c_br);
113   (void) memcpy (c_br + 2, bridge_id->addr, 6);
114 }
115 
116 void
STP_VECT_get_vector(IN BPDU_BODY_T * b,OUT PRIO_VECTOR_T * v)117 STP_VECT_get_vector (IN BPDU_BODY_T* b, OUT PRIO_VECTOR_T* v)
118 {
119   stp_vect_get_bridge_id (b->root_id, &v->root_bridge);
120 
121   /* LINTED: alignment */
122   v->root_path_cost = ntohl (*((long*) b->root_path_cost));
123 
124   stp_vect_get_bridge_id (b->bridge_id, &v->design_bridge);
125 
126   v->design_port = stp_vect_get_short (b->port_id);
127 }
128 
129 void
STP_VECT_set_vector(IN PRIO_VECTOR_T * v,OUT BPDU_BODY_T * b)130 STP_VECT_set_vector (IN PRIO_VECTOR_T* v, OUT BPDU_BODY_T* b)
131 {
132   unsigned long root_path_cost;
133 
134   stp_vect_set_bridge_id (&v->root_bridge, b->root_id);
135 
136   root_path_cost = htonl (v->root_path_cost);
137   (void) memcpy (b->root_path_cost, &root_path_cost, 4);
138 
139   stp_vect_set_bridge_id (&v->design_bridge, b->bridge_id);
140 
141   stp_vect_set_short (v->design_port, b->port_id);
142 }
143 
144 #ifdef STP_DBG
145 
146 /*ARGSUSED*/
147 void
STP_VECT_br_id_print(IN char * title,IN BRIDGE_ID * br_id,IN Bool cr)148 STP_VECT_br_id_print (IN char *title, IN BRIDGE_ID* br_id, IN Bool cr)
149 {
150   stp_trace ("%s=%04lX-%02x%02x%02x%02x%02x%02x",
151             title,
152           (unsigned long) br_id->prio,
153           (unsigned char) br_id->addr[0],
154           (unsigned char) br_id->addr[1],
155           (unsigned char) br_id->addr[2],
156           (unsigned char) br_id->addr[3],
157           (unsigned char) br_id->addr[4],
158           (unsigned char) br_id->addr[5]);
159 #ifndef __SUN__
160   stp_trace (cr ? "\n" : " ");
161 #endif
162 }
163 
164 void
STP_VECT_print(IN char * title,IN PRIO_VECTOR_T * v)165 STP_VECT_print (IN char *title, IN PRIO_VECTOR_T *v)
166 {
167   stp_trace ("%s:", title);
168   STP_VECT_br_id_print ("rootBr", &v->root_bridge, False);
169 
170 /****
171   stp_trace (" rpc=%ld ", (long) v->root_path_cost);
172 ****/
173 
174   STP_VECT_br_id_print ("designBr", &v->design_bridge, False);
175 
176 /****/
177   stp_trace (" dp=%lx bp=%lx ",
178           (unsigned long) v->design_port,
179           (unsigned long) v->bridge_port);
180 /***********/
181   stp_trace ("\n");
182 }
183 #endif
184