1 files changed, 132 insertions, 0 deletions
diff --git a/usr/src/lib/librstp/common/pcost.c b/usr/src/lib/librstp/common/pcost.c
new file mode 100644
index 0000000000..72dd144043
--- /dev/null
+++ b/usr/src/lib/librstp/common/pcost.c
@@ -0,0 +1,132 @@
+/************************************************************************ 
+ * RSTP library - Rapid Spanning Tree (802.1t, 802.1w) 
+ * Copyright (C) 2001-2003 Optical Access 
+ * Author: Alex Rozin 
+ * 
+ * This file is part of RSTP library. 
+ * 
+ * RSTP library is free software; you can redistribute it and/or modify it 
+ * under the terms of the GNU Lesser General Public License as published by the 
+ * Free Software Foundation; version 2.1 
+ * 
+ * RSTP library is distributed in the hope that it will be useful, but 
+ * WITHOUT ANY WARRANTY; without even the implied warranty of 
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU Lesser 
+ * General Public License for more details. 
+ * 
+ * You should have received a copy of the GNU Lesser General Public License 
+ * along with RSTP library; see the file COPYING.  If not, write to the Free 
+ * Software Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 
+ * 02111-1307, USA. 
+ **********************************************************************/
+
+/* Path Cost monitoring state machine */
+ 
+#include "base.h"
+#include "stpm.h"
+#include "stp_to.h" /* for STP_OUT_get_port_oper_speed */
+
+#define STATES {        \
+  CHOOSE(AUTO),         \
+  CHOOSE(FORSE),        \
+  CHOOSE(STABLE)       \
+}
+
+#define GET_STATE_NAME STP_pcost_get_state_name
+#include "choose.h"
+
+static long
+computeAutoPCost (STATE_MACH_T *this)
+{
+    long lret;
+    register PORT_T*  port = this->owner.port;
+
+    if (port->usedSpeed        < 10L) {         /* < 10Mb/s */
+        lret = 20000000;
+    } else if (port->usedSpeed <= 10L) {        /* 10 Mb/s  */
+        lret = 2000000;        
+    } else if (port->usedSpeed <= 100L) {       /* 100 Mb/s */
+        lret = 200000;     
+    } else if (port->usedSpeed <= 1000L) {      /* 1 Gb/s */
+        lret = 20000;      
+    } else if (port->usedSpeed <= 10000L) {     /* 10 Gb/s */
+        lret = 2000;       
+    } else if (port->usedSpeed <= 100000L) {    /* 100 Gb/s */
+        lret = 200;        
+    } else if (port->usedSpeed <= 1000000L) {   /* 1 GTb/s */
+        lret = 20;     
+    } else if (port->usedSpeed <= 10000000L) {  /* 10 Tb/s */
+        lret = 2;      
+    } else   /* ??? */                        { /* > Tb/s */
+        lret = 1;       
+    }
+#ifdef STP_DBG
+    if (port->pcost->debug) {
+      stp_trace ("usedSpeed=%lu lret=%ld", port->usedSpeed, lret);
+    }
+#endif
+
+    return lret;
+}
+
+/* ARGSUSED */
+static void
+updPortPathCost (STATE_MACH_T *this)
+{
+}
+
+void
+STP_pcost_enter_state (STATE_MACH_T *this)
+{
+  register PORT_T*  port = this->owner.port;
+
+  switch (this->State) {
+    case BEGIN:
+      break;
+    case AUTO:
+      port->operSpeed = STP_OUT_get_port_oper_speed (port->port_index);
+#ifdef STP_DBG
+      if (port->pcost->debug) {
+        stp_trace ("AUTO:operSpeed=%lu", port->operSpeed);
+      }
+#endif
+      port->usedSpeed = port->operSpeed;
+      port->operPCost = computeAutoPCost (this);
+      break;
+    case FORSE:
+      port->operPCost = port->adminPCost;
+      port->usedSpeed = (unsigned long)-1;
+      break;
+    case STABLE:
+      updPortPathCost (this);
+      break;
+  }
+}
+
+Bool
+STP_pcost_check_conditions (STATE_MACH_T* this)
+{
+  register PORT_T*  port = this->owner.port;
+
+  switch (this->State) {
+    case BEGIN:
+      return STP_hop_2_state (this, AUTO);
+    case AUTO:
+      return STP_hop_2_state (this, STABLE);
+    case FORSE:
+      return STP_hop_2_state (this, STABLE);
+    case STABLE:
+      if (ADMIN_PORT_PATH_COST_AUTO == port->adminPCost && 
+          port->operSpeed != port->usedSpeed) {
+          return STP_hop_2_state (this, AUTO);
+      }
+
+      if (ADMIN_PORT_PATH_COST_AUTO != port->adminPCost &&
+          port->operPCost != port->adminPCost) {
+          return STP_hop_2_state (this, FORSE);
+      }
+      break;
+  }
+  return False;
+}
+