dmake: do not set MAKEFLAGS=k
[unleashed/tickless.git] / usr / src / lib / librstp / common / vector.c
bloba268b9231985a867aa99ff6f27b17aff0f98a2fb
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
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.
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 **********************************************************************/
23 /* STP priority vectors API : 17.4.2 */
25 #include "base.h"
26 #include "stp_bpdu.h"
27 #include "vector.h"
28 #include "stp_vectors.h"
30 int
31 STP_VECT_compare_bridge_id (BRIDGE_ID* b1, BRIDGE_ID* b2)
33 if (b1->prio < b2->prio)
34 return -1;
36 if (b1->prio > b2->prio)
37 return 1;
38 return memcmp (b1->addr, b2->addr, 6);
41 void
42 STP_VECT_copy (OUT PRIO_VECTOR_T* t, IN PRIO_VECTOR_T* f)
44 (void) memcpy (t, f, sizeof (PRIO_VECTOR_T));
47 void
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)
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;
62 int
63 STP_VECT_compare_vector (PRIO_VECTOR_T* v1, PRIO_VECTOR_T* v2)
65 int bridcmp;
67 bridcmp = STP_VECT_compare_bridge_id (&v1->root_bridge, &v2->root_bridge);
68 if (bridcmp < 0) return bridcmp;
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;
85 return bridcmp;
88 static unsigned short
89 stp_vect_get_short (IN unsigned char* f)
91 /* LINTED: alignment */
92 return ntohs (*(unsigned short *)f);
95 static void
96 stp_vect_set_short (IN unsigned short f, OUT unsigned char* t)
98 /* LINTED: alignment */
99 *(unsigned short *)t = htons (f);
102 static void
103 stp_vect_get_bridge_id (IN unsigned char* c_br, OUT BRIDGE_ID* bridge_id)
105 bridge_id->prio = stp_vect_get_short (c_br);
106 (void) memcpy (bridge_id->addr, c_br + 2, 6);
109 static void
110 stp_vect_set_bridge_id (IN BRIDGE_ID* bridge_id, OUT unsigned char* c_br)
112 stp_vect_set_short (bridge_id->prio, c_br);
113 (void) memcpy (c_br + 2, bridge_id->addr, 6);
116 void
117 STP_VECT_get_vector (IN BPDU_BODY_T* b, OUT PRIO_VECTOR_T* v)
119 stp_vect_get_bridge_id (b->root_id, &v->root_bridge);
121 /* LINTED: alignment */
122 v->root_path_cost = ntohl (*((long*) b->root_path_cost));
124 stp_vect_get_bridge_id (b->bridge_id, &v->design_bridge);
126 v->design_port = stp_vect_get_short (b->port_id);
129 void
130 STP_VECT_set_vector (IN PRIO_VECTOR_T* v, OUT BPDU_BODY_T* b)
132 unsigned long root_path_cost;
134 stp_vect_set_bridge_id (&v->root_bridge, b->root_id);
136 root_path_cost = htonl (v->root_path_cost);
137 (void) memcpy (b->root_path_cost, &root_path_cost, 4);
139 stp_vect_set_bridge_id (&v->design_bridge, b->bridge_id);
141 stp_vect_set_short (v->design_port, b->port_id);
144 #ifdef STP_DBG
146 /*ARGSUSED*/
147 void
148 STP_VECT_br_id_print (IN char *title, IN BRIDGE_ID* br_id, IN Bool cr)
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
164 void
165 STP_VECT_print (IN char *title, IN PRIO_VECTOR_T *v)
167 stp_trace ("%s:", title);
168 STP_VECT_br_id_print ("rootBr", &v->root_bridge, False);
170 /****
171 stp_trace (" rpc=%ld ", (long) v->root_path_cost);
172 ****/
174 STP_VECT_br_id_print ("designBr", &v->design_bridge, False);
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");
183 #endif