17c478bd9Sstevel@tonic-gate /*
27c478bd9Sstevel@tonic-gate * CDDL HEADER START
37c478bd9Sstevel@tonic-gate *
47c478bd9Sstevel@tonic-gate * The contents of this file are subject to the terms of the
5*39b361b2SRichard Bean * Common Development and Distribution License (the "License").
6*39b361b2SRichard Bean * You may not use this file except in compliance with the License.
77c478bd9Sstevel@tonic-gate *
87c478bd9Sstevel@tonic-gate * You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE
97c478bd9Sstevel@tonic-gate * or http://www.opensolaris.org/os/licensing.
107c478bd9Sstevel@tonic-gate * See the License for the specific language governing permissions
117c478bd9Sstevel@tonic-gate * and limitations under the License.
127c478bd9Sstevel@tonic-gate *
137c478bd9Sstevel@tonic-gate * When distributing Covered Code, include this CDDL HEADER in each
147c478bd9Sstevel@tonic-gate * file and include the License file at usr/src/OPENSOLARIS.LICENSE.
157c478bd9Sstevel@tonic-gate * If applicable, add the following below this CDDL HEADER, with the
167c478bd9Sstevel@tonic-gate * fields enclosed by brackets "[]" replaced with your own identifying
177c478bd9Sstevel@tonic-gate * information: Portions Copyright [yyyy] [name of copyright owner]
187c478bd9Sstevel@tonic-gate *
197c478bd9Sstevel@tonic-gate * CDDL HEADER END
207c478bd9Sstevel@tonic-gate */
217c478bd9Sstevel@tonic-gate /*
22*39b361b2SRichard Bean * Copyright 2008 Sun Microsystems, Inc. All rights reserved.
237c478bd9Sstevel@tonic-gate * Use is subject to license terms.
247c478bd9Sstevel@tonic-gate */
257c478bd9Sstevel@tonic-gate
267c478bd9Sstevel@tonic-gate #include <sys/types.h>
277c478bd9Sstevel@tonic-gate #include <sys/atomic.h>
287c478bd9Sstevel@tonic-gate #include <sys/systm.h>
297c478bd9Sstevel@tonic-gate #include <sys/socket.h>
307c478bd9Sstevel@tonic-gate #include <netinet/in.h>
317c478bd9Sstevel@tonic-gate #include <sys/modctl.h>
327c478bd9Sstevel@tonic-gate #include <sys/sunddi.h>
337c478bd9Sstevel@tonic-gate #include <ipp/ipp.h>
347c478bd9Sstevel@tonic-gate #include <ipp/ipp_config.h>
357c478bd9Sstevel@tonic-gate #include <inet/common.h>
367c478bd9Sstevel@tonic-gate #include <ipp/meters/meter_impl.h>
377c478bd9Sstevel@tonic-gate
387c478bd9Sstevel@tonic-gate #define D_SM_COMMENT "IPP Single-Two Rate Token Meter"
397c478bd9Sstevel@tonic-gate
407c478bd9Sstevel@tonic-gate /* DDI file for tokenmt ipp module */
417c478bd9Sstevel@tonic-gate
427c478bd9Sstevel@tonic-gate /* Default DSCP to colour mapping for colour-aware meter */
437c478bd9Sstevel@tonic-gate enum meter_colour default_dscp_to_colour[64] = {
447c478bd9Sstevel@tonic-gate TOKENMT_GREEN, TOKENMT_GREEN, TOKENMT_GREEN, TOKENMT_GREEN,
457c478bd9Sstevel@tonic-gate TOKENMT_GREEN, TOKENMT_GREEN, TOKENMT_GREEN, TOKENMT_GREEN,
467c478bd9Sstevel@tonic-gate TOKENMT_GREEN, TOKENMT_GREEN, TOKENMT_GREEN, TOKENMT_GREEN,
477c478bd9Sstevel@tonic-gate TOKENMT_YELLOW, TOKENMT_GREEN, TOKENMT_RED, TOKENMT_GREEN,
487c478bd9Sstevel@tonic-gate TOKENMT_GREEN, TOKENMT_GREEN, TOKENMT_GREEN, TOKENMT_GREEN,
497c478bd9Sstevel@tonic-gate TOKENMT_YELLOW, TOKENMT_GREEN, TOKENMT_RED, TOKENMT_GREEN,
507c478bd9Sstevel@tonic-gate TOKENMT_GREEN, TOKENMT_GREEN, TOKENMT_GREEN, TOKENMT_GREEN,
517c478bd9Sstevel@tonic-gate TOKENMT_YELLOW, TOKENMT_GREEN, TOKENMT_RED, TOKENMT_GREEN,
527c478bd9Sstevel@tonic-gate TOKENMT_GREEN, TOKENMT_GREEN, TOKENMT_GREEN, TOKENMT_GREEN,
537c478bd9Sstevel@tonic-gate TOKENMT_YELLOW, TOKENMT_GREEN, TOKENMT_RED, TOKENMT_GREEN,
547c478bd9Sstevel@tonic-gate TOKENMT_GREEN, TOKENMT_GREEN, TOKENMT_GREEN, TOKENMT_GREEN,
557c478bd9Sstevel@tonic-gate TOKENMT_GREEN, TOKENMT_GREEN, TOKENMT_GREEN, TOKENMT_GREEN,
567c478bd9Sstevel@tonic-gate TOKENMT_GREEN, TOKENMT_GREEN, TOKENMT_GREEN, TOKENMT_GREEN,
577c478bd9Sstevel@tonic-gate TOKENMT_GREEN, TOKENMT_GREEN, TOKENMT_GREEN, TOKENMT_GREEN,
587c478bd9Sstevel@tonic-gate TOKENMT_GREEN, TOKENMT_GREEN, TOKENMT_GREEN, TOKENMT_GREEN,
597c478bd9Sstevel@tonic-gate TOKENMT_GREEN, TOKENMT_GREEN, TOKENMT_GREEN, TOKENMT_GREEN
607c478bd9Sstevel@tonic-gate };
617c478bd9Sstevel@tonic-gate
627c478bd9Sstevel@tonic-gate static int tokenmt_create_action(ipp_action_id_t, nvlist_t **, ipp_flags_t);
637c478bd9Sstevel@tonic-gate static int tokenmt_modify_action(ipp_action_id_t, nvlist_t **, ipp_flags_t);
647c478bd9Sstevel@tonic-gate static int tokenmt_destroy_action(ipp_action_id_t, ipp_flags_t);
657c478bd9Sstevel@tonic-gate static int tokenmt_info(ipp_action_id_t, int (*)(nvlist_t *, void *), void *,
667c478bd9Sstevel@tonic-gate ipp_flags_t);
677c478bd9Sstevel@tonic-gate static int tokenmt_invoke_action(ipp_action_id_t, ipp_packet_t *);
687c478bd9Sstevel@tonic-gate
697c478bd9Sstevel@tonic-gate /* Initialize stats */
707c478bd9Sstevel@tonic-gate static int tokenmt_statinit(ipp_action_id_t, tokenmt_data_t *);
717c478bd9Sstevel@tonic-gate
727c478bd9Sstevel@tonic-gate /* Stats callback function */
737c478bd9Sstevel@tonic-gate static int tokenmt_update_stats(ipp_stat_t *, void *, int);
747c478bd9Sstevel@tonic-gate
757c478bd9Sstevel@tonic-gate ipp_ops_t tokenmt_ops = {
767c478bd9Sstevel@tonic-gate IPPO_REV,
777c478bd9Sstevel@tonic-gate tokenmt_create_action, /* ippo_action_create */
787c478bd9Sstevel@tonic-gate tokenmt_modify_action, /* ippo_action_modify */
797c478bd9Sstevel@tonic-gate tokenmt_destroy_action, /* ippo_action_destroy */
807c478bd9Sstevel@tonic-gate tokenmt_info, /* ippo_action_info */
817c478bd9Sstevel@tonic-gate tokenmt_invoke_action /* ippo_action_invoke */
827c478bd9Sstevel@tonic-gate };
837c478bd9Sstevel@tonic-gate
847c478bd9Sstevel@tonic-gate extern struct mod_ops mod_ippops;
857c478bd9Sstevel@tonic-gate
867c478bd9Sstevel@tonic-gate /*
877c478bd9Sstevel@tonic-gate * Module linkage information for the kernel.
887c478bd9Sstevel@tonic-gate */
897c478bd9Sstevel@tonic-gate static struct modlipp modlipp = {
907c478bd9Sstevel@tonic-gate &mod_ippops,
91*39b361b2SRichard Bean D_SM_COMMENT,
927c478bd9Sstevel@tonic-gate &tokenmt_ops
937c478bd9Sstevel@tonic-gate };
947c478bd9Sstevel@tonic-gate
957c478bd9Sstevel@tonic-gate static struct modlinkage modlinkage = {
967c478bd9Sstevel@tonic-gate MODREV_1,
977c478bd9Sstevel@tonic-gate (void *)&modlipp,
987c478bd9Sstevel@tonic-gate NULL
997c478bd9Sstevel@tonic-gate };
1007c478bd9Sstevel@tonic-gate
1017c478bd9Sstevel@tonic-gate
1027c478bd9Sstevel@tonic-gate int
_init(void)1037c478bd9Sstevel@tonic-gate _init(void)
1047c478bd9Sstevel@tonic-gate {
1057c478bd9Sstevel@tonic-gate return (mod_install(&modlinkage));
1067c478bd9Sstevel@tonic-gate }
1077c478bd9Sstevel@tonic-gate
1087c478bd9Sstevel@tonic-gate int
_fini(void)1097c478bd9Sstevel@tonic-gate _fini(void)
1107c478bd9Sstevel@tonic-gate {
1117c478bd9Sstevel@tonic-gate return (mod_remove(&modlinkage));
1127c478bd9Sstevel@tonic-gate }
1137c478bd9Sstevel@tonic-gate
1147c478bd9Sstevel@tonic-gate int
_info(struct modinfo * modinfop)1157c478bd9Sstevel@tonic-gate _info(struct modinfo *modinfop)
1167c478bd9Sstevel@tonic-gate {
1177c478bd9Sstevel@tonic-gate return (mod_info(&modlinkage, modinfop));
1187c478bd9Sstevel@tonic-gate }
1197c478bd9Sstevel@tonic-gate
1207c478bd9Sstevel@tonic-gate /* ARGSUSED */
1217c478bd9Sstevel@tonic-gate static int
tokenmt_create_action(ipp_action_id_t aid,nvlist_t ** nvlpp,ipp_flags_t flags)1227c478bd9Sstevel@tonic-gate tokenmt_create_action(ipp_action_id_t aid, nvlist_t **nvlpp, ipp_flags_t flags)
1237c478bd9Sstevel@tonic-gate {
1247c478bd9Sstevel@tonic-gate nvlist_t *nvlp;
1257c478bd9Sstevel@tonic-gate tokenmt_data_t *tokenmt_data;
1267c478bd9Sstevel@tonic-gate char *next_action;
1277c478bd9Sstevel@tonic-gate tokenmt_cfg_t *cfg_parms;
1287c478bd9Sstevel@tonic-gate uint32_t mode;
1297c478bd9Sstevel@tonic-gate uint32_t bstats;
1307c478bd9Sstevel@tonic-gate int rc, rc2;
1317c478bd9Sstevel@tonic-gate int32_t *colour_tbl;
1327c478bd9Sstevel@tonic-gate uint_t nelem = 64;
1337c478bd9Sstevel@tonic-gate
1347c478bd9Sstevel@tonic-gate nvlp = *nvlpp;
1357c478bd9Sstevel@tonic-gate *nvlpp = NULL; /* nvlist should be NULL on return */
1367c478bd9Sstevel@tonic-gate
1377c478bd9Sstevel@tonic-gate if ((cfg_parms = kmem_zalloc(TOKENMT_CFG_SZ, KM_NOSLEEP)) == NULL) {
1387c478bd9Sstevel@tonic-gate nvlist_free(nvlp);
1397c478bd9Sstevel@tonic-gate return (ENOMEM);
1407c478bd9Sstevel@tonic-gate }
1417c478bd9Sstevel@tonic-gate
1427c478bd9Sstevel@tonic-gate /* parse red next action name */
1437c478bd9Sstevel@tonic-gate if ((rc = nvlist_lookup_string(nvlp, TOKENMT_RED_ACTION_NAME,
1447c478bd9Sstevel@tonic-gate &next_action)) != 0) {
1457c478bd9Sstevel@tonic-gate nvlist_free(nvlp);
1467c478bd9Sstevel@tonic-gate tokenmt0dbg(("tokenmt_create_action:invalid config, red "\
1477c478bd9Sstevel@tonic-gate "action name missing\n"));
1487c478bd9Sstevel@tonic-gate kmem_free(cfg_parms, TOKENMT_CFG_SZ);
1497c478bd9Sstevel@tonic-gate return (rc);
1507c478bd9Sstevel@tonic-gate }
1517c478bd9Sstevel@tonic-gate if ((cfg_parms->red_action = ipp_action_lookup(next_action))
1527c478bd9Sstevel@tonic-gate == IPP_ACTION_INVAL) {
1537c478bd9Sstevel@tonic-gate nvlist_free(nvlp);
1547c478bd9Sstevel@tonic-gate tokenmt0dbg(("tokenmt_create_action: red action invalid\n"));
1557c478bd9Sstevel@tonic-gate kmem_free(cfg_parms, TOKENMT_CFG_SZ);
1567c478bd9Sstevel@tonic-gate return (EINVAL);
1577c478bd9Sstevel@tonic-gate }
1587c478bd9Sstevel@tonic-gate
1597c478bd9Sstevel@tonic-gate /* parse yellow next action name, if present this is Two Rate meter */
1607c478bd9Sstevel@tonic-gate if ((rc = nvlist_lookup_string(nvlp, TOKENMT_YELLOW_ACTION_NAME,
1617c478bd9Sstevel@tonic-gate &next_action)) == 0) {
1627c478bd9Sstevel@tonic-gate if ((cfg_parms->yellow_action = ipp_action_lookup(next_action))
1637c478bd9Sstevel@tonic-gate == IPP_ACTION_INVAL) {
1647c478bd9Sstevel@tonic-gate nvlist_free(nvlp);
1657c478bd9Sstevel@tonic-gate tokenmt0dbg(("tokenmt_create_action: yellow action "\
1667c478bd9Sstevel@tonic-gate "invalid\n"));
1677c478bd9Sstevel@tonic-gate kmem_free(cfg_parms, TOKENMT_CFG_SZ);
1687c478bd9Sstevel@tonic-gate return (EINVAL);
1697c478bd9Sstevel@tonic-gate }
1707c478bd9Sstevel@tonic-gate } else {
1717c478bd9Sstevel@tonic-gate cfg_parms->yellow_action = TOKENMT_NO_ACTION;
1727c478bd9Sstevel@tonic-gate }
1737c478bd9Sstevel@tonic-gate
1747c478bd9Sstevel@tonic-gate /* parse green next action name */
1757c478bd9Sstevel@tonic-gate if ((rc = nvlist_lookup_string(nvlp, TOKENMT_GREEN_ACTION_NAME,
1767c478bd9Sstevel@tonic-gate &next_action)) != 0) {
1777c478bd9Sstevel@tonic-gate nvlist_free(nvlp);
1787c478bd9Sstevel@tonic-gate tokenmt0dbg(("tokenmt_create_action:invalid config, green " \
1797c478bd9Sstevel@tonic-gate "action name missing\n"));
1807c478bd9Sstevel@tonic-gate kmem_free(cfg_parms, TOKENMT_CFG_SZ);
1817c478bd9Sstevel@tonic-gate return (rc);
1827c478bd9Sstevel@tonic-gate }
1837c478bd9Sstevel@tonic-gate if ((cfg_parms->green_action = ipp_action_lookup(next_action))
1847c478bd9Sstevel@tonic-gate == IPP_ACTION_INVAL) {
1857c478bd9Sstevel@tonic-gate nvlist_free(nvlp);
1867c478bd9Sstevel@tonic-gate tokenmt0dbg(("tokenmt_create_action: green action invalid\n"));
1877c478bd9Sstevel@tonic-gate kmem_free(cfg_parms, TOKENMT_CFG_SZ);
1887c478bd9Sstevel@tonic-gate return (EINVAL);
1897c478bd9Sstevel@tonic-gate }
1907c478bd9Sstevel@tonic-gate
1917c478bd9Sstevel@tonic-gate /* parse committed rate - in kilo bits / sec */
1927c478bd9Sstevel@tonic-gate if ((rc = nvlist_lookup_uint32(nvlp, TOKENMT_COMMITTED_RATE,
1937c478bd9Sstevel@tonic-gate &cfg_parms->committed_rate)) != 0) {
1947c478bd9Sstevel@tonic-gate nvlist_free(nvlp);
1957c478bd9Sstevel@tonic-gate tokenmt0dbg(("tokenmt_create_action: invalid config, "\
1967c478bd9Sstevel@tonic-gate " committed rate missing\n"));
1977c478bd9Sstevel@tonic-gate kmem_free(cfg_parms, TOKENMT_CFG_SZ);
1987c478bd9Sstevel@tonic-gate return (rc);
1997c478bd9Sstevel@tonic-gate }
2007c478bd9Sstevel@tonic-gate if (cfg_parms->committed_rate == 0) {
2017c478bd9Sstevel@tonic-gate nvlist_free(nvlp);
2027c478bd9Sstevel@tonic-gate tokenmt0dbg(("tokenmt_create_action: invalid committed rate, "\
2037c478bd9Sstevel@tonic-gate "%u\n", cfg_parms->committed_rate));
2047c478bd9Sstevel@tonic-gate kmem_free(cfg_parms, TOKENMT_CFG_SZ);
2057c478bd9Sstevel@tonic-gate return (EINVAL);
2067c478bd9Sstevel@tonic-gate }
2077c478bd9Sstevel@tonic-gate
2087c478bd9Sstevel@tonic-gate /* parse committed burst in bits */
2097c478bd9Sstevel@tonic-gate if ((rc = nvlist_lookup_uint32(nvlp, TOKENMT_COMMITTED_BURST,
2107c478bd9Sstevel@tonic-gate &cfg_parms->committed_burst)) != 0) {
2117c478bd9Sstevel@tonic-gate nvlist_free(nvlp);
2127c478bd9Sstevel@tonic-gate tokenmt0dbg(("tokenmt_create_action: invalid config, "\
2137c478bd9Sstevel@tonic-gate " committed burst missing\n"));
2147c478bd9Sstevel@tonic-gate kmem_free(cfg_parms, TOKENMT_CFG_SZ);
2157c478bd9Sstevel@tonic-gate return (rc);
2167c478bd9Sstevel@tonic-gate }
2177c478bd9Sstevel@tonic-gate
2187c478bd9Sstevel@tonic-gate
2197c478bd9Sstevel@tonic-gate /*
2207c478bd9Sstevel@tonic-gate * If the peak burst size is specified, make sure we have the
2217c478bd9Sstevel@tonic-gate * yellow action.
2227c478bd9Sstevel@tonic-gate */
2237c478bd9Sstevel@tonic-gate if ((rc = nvlist_lookup_uint32(nvlp, TOKENMT_PEAK_BURST,
2247c478bd9Sstevel@tonic-gate &cfg_parms->peak_burst)) == 0) {
2257c478bd9Sstevel@tonic-gate if (cfg_parms->yellow_action == TOKENMT_NO_ACTION) {
2267c478bd9Sstevel@tonic-gate nvlist_free(nvlp);
2277c478bd9Sstevel@tonic-gate tokenmt0dbg(("tokenmt_create_action: peak burst "\
2287c478bd9Sstevel@tonic-gate "specified without yellow action\n"));
2297c478bd9Sstevel@tonic-gate kmem_free(cfg_parms, TOKENMT_CFG_SZ);
2307c478bd9Sstevel@tonic-gate return (EINVAL);
2317c478bd9Sstevel@tonic-gate }
2327c478bd9Sstevel@tonic-gate } else if (cfg_parms->yellow_action != TOKENMT_NO_ACTION) {
2337c478bd9Sstevel@tonic-gate nvlist_free(nvlp);
2347c478bd9Sstevel@tonic-gate tokenmt0dbg(("tokenmt_create_action: peak burst must be "\
2357c478bd9Sstevel@tonic-gate "provided with yellow action\n"));
2367c478bd9Sstevel@tonic-gate kmem_free(cfg_parms, TOKENMT_CFG_SZ);
2377c478bd9Sstevel@tonic-gate return (EINVAL);
2387c478bd9Sstevel@tonic-gate }
2397c478bd9Sstevel@tonic-gate
2407c478bd9Sstevel@tonic-gate /* Check if we have a peak_rate */
2417c478bd9Sstevel@tonic-gate if ((rc = nvlist_lookup_uint32(nvlp, TOKENMT_PEAK_RATE,
2427c478bd9Sstevel@tonic-gate &cfg_parms->peak_rate)) == 0) {
2437c478bd9Sstevel@tonic-gate if (cfg_parms->yellow_action == TOKENMT_NO_ACTION) {
2447c478bd9Sstevel@tonic-gate nvlist_free(nvlp);
2457c478bd9Sstevel@tonic-gate tokenmt0dbg(("tokenmt_create_action: peak rate "\
2467c478bd9Sstevel@tonic-gate "specified without yellow action\n"));
2477c478bd9Sstevel@tonic-gate kmem_free(cfg_parms, TOKENMT_CFG_SZ);
2487c478bd9Sstevel@tonic-gate return (EINVAL);
2497c478bd9Sstevel@tonic-gate } else if ((cfg_parms->peak_rate == 0) ||
2507c478bd9Sstevel@tonic-gate (cfg_parms->peak_rate < cfg_parms->committed_rate)) {
2517c478bd9Sstevel@tonic-gate nvlist_free(nvlp);
2527c478bd9Sstevel@tonic-gate tokenmt0dbg(("tokenmt_create_action: invalid "\
2537c478bd9Sstevel@tonic-gate "peak rate, %u\n", cfg_parms->peak_rate));
2547c478bd9Sstevel@tonic-gate kmem_free(cfg_parms, TOKENMT_CFG_SZ);
2557c478bd9Sstevel@tonic-gate return (EINVAL);
2567c478bd9Sstevel@tonic-gate }
2577c478bd9Sstevel@tonic-gate cfg_parms->tokenmt_type = TRTCL_TOKENMT;
2587c478bd9Sstevel@tonic-gate } else {
2597c478bd9Sstevel@tonic-gate cfg_parms->tokenmt_type = SRTCL_TOKENMT;
2607c478bd9Sstevel@tonic-gate }
2617c478bd9Sstevel@tonic-gate
2627c478bd9Sstevel@tonic-gate /* Validate the committed and peak burst size */
2637c478bd9Sstevel@tonic-gate if (cfg_parms->tokenmt_type == SRTCL_TOKENMT) {
2647c478bd9Sstevel@tonic-gate if ((cfg_parms->committed_burst == 0) &&
2657c478bd9Sstevel@tonic-gate (cfg_parms->peak_burst == 0)) {
2667c478bd9Sstevel@tonic-gate nvlist_free(nvlp);
2677c478bd9Sstevel@tonic-gate tokenmt0dbg(("tokenmt_create_action: at least one "\
2687c478bd9Sstevel@tonic-gate "burst size must be non-zero\n"));
2697c478bd9Sstevel@tonic-gate kmem_free(cfg_parms, TOKENMT_CFG_SZ);
2707c478bd9Sstevel@tonic-gate return (EINVAL);
2717c478bd9Sstevel@tonic-gate }
2727c478bd9Sstevel@tonic-gate } else { /* TRTCL_TOKENMT */
2737c478bd9Sstevel@tonic-gate if ((cfg_parms->committed_burst == 0) ||
2747c478bd9Sstevel@tonic-gate (cfg_parms->peak_burst == 0)) {
2757c478bd9Sstevel@tonic-gate nvlist_free(nvlp);
2767c478bd9Sstevel@tonic-gate tokenmt0dbg(("tokenmt_create_action: both the "\
2777c478bd9Sstevel@tonic-gate "burst sizes must be non-zero\n"));
2787c478bd9Sstevel@tonic-gate kmem_free(cfg_parms, TOKENMT_CFG_SZ);
2797c478bd9Sstevel@tonic-gate return (EINVAL);
2807c478bd9Sstevel@tonic-gate }
2817c478bd9Sstevel@tonic-gate }
2827c478bd9Sstevel@tonic-gate
2837c478bd9Sstevel@tonic-gate /* just copy default colour mapping */
2847c478bd9Sstevel@tonic-gate bcopy(default_dscp_to_colour, cfg_parms->dscp_to_colour,
2857c478bd9Sstevel@tonic-gate sizeof (default_dscp_to_colour));
2867c478bd9Sstevel@tonic-gate
2877c478bd9Sstevel@tonic-gate /* parse mode, if present */
2887c478bd9Sstevel@tonic-gate if ((rc = nvlist_lookup_uint32(nvlp, TOKENMT_COLOUR_AWARE,
2897c478bd9Sstevel@tonic-gate &mode)) != 0) {
2907c478bd9Sstevel@tonic-gate cfg_parms->colour_aware = B_FALSE;
2917c478bd9Sstevel@tonic-gate } else {
2927c478bd9Sstevel@tonic-gate cfg_parms->colour_aware = (mode == 0) ? B_FALSE : B_TRUE;
2937c478bd9Sstevel@tonic-gate }
2947c478bd9Sstevel@tonic-gate
2957c478bd9Sstevel@tonic-gate /* Get the dscp to colour mapping array */
2967c478bd9Sstevel@tonic-gate if (cfg_parms->colour_aware) {
2977c478bd9Sstevel@tonic-gate if ((rc = nvlist_lookup_int32_array(nvlp,
2987c478bd9Sstevel@tonic-gate TOKENMT_COLOUR_MAP, &colour_tbl, &nelem)) == 0) {
2997c478bd9Sstevel@tonic-gate int count;
3007c478bd9Sstevel@tonic-gate for (count = 0; count < 64; count++) {
3017c478bd9Sstevel@tonic-gate if (colour_tbl[count] == -1)
3027c478bd9Sstevel@tonic-gate continue;
3037c478bd9Sstevel@tonic-gate cfg_parms->dscp_to_colour[count] =
3047c478bd9Sstevel@tonic-gate colour_tbl[count];
3057c478bd9Sstevel@tonic-gate }
3067c478bd9Sstevel@tonic-gate }
3077c478bd9Sstevel@tonic-gate }
3087c478bd9Sstevel@tonic-gate
3097c478bd9Sstevel@tonic-gate /* parse stats */
3107c478bd9Sstevel@tonic-gate if ((rc = nvlist_lookup_uint32(nvlp, IPP_ACTION_STATS_ENABLE, &bstats))
3117c478bd9Sstevel@tonic-gate != 0) {
3127c478bd9Sstevel@tonic-gate cfg_parms->stats = B_FALSE;
3137c478bd9Sstevel@tonic-gate } else {
3147c478bd9Sstevel@tonic-gate cfg_parms->stats = (bstats == 0) ? B_FALSE : B_TRUE;
3157c478bd9Sstevel@tonic-gate }
3167c478bd9Sstevel@tonic-gate
3177c478bd9Sstevel@tonic-gate nvlist_free(nvlp);
3187c478bd9Sstevel@tonic-gate
3197c478bd9Sstevel@tonic-gate /* Initialize other stuff */
3207c478bd9Sstevel@tonic-gate tokenmt_data = kmem_zalloc(TOKENMT_DATA_SZ, KM_NOSLEEP);
3217c478bd9Sstevel@tonic-gate if (tokenmt_data == NULL) {
3227c478bd9Sstevel@tonic-gate kmem_free(cfg_parms, TOKENMT_CFG_SZ);
3237c478bd9Sstevel@tonic-gate return (ENOMEM);
3247c478bd9Sstevel@tonic-gate }
3257c478bd9Sstevel@tonic-gate
3267c478bd9Sstevel@tonic-gate /* Initialize stats, if required */
3277c478bd9Sstevel@tonic-gate if (cfg_parms->stats) {
3287c478bd9Sstevel@tonic-gate if ((rc = tokenmt_statinit(aid, tokenmt_data)) != 0) {
3297c478bd9Sstevel@tonic-gate kmem_free(cfg_parms, TOKENMT_CFG_SZ);
3307c478bd9Sstevel@tonic-gate kmem_free(tokenmt_data, TOKENMT_DATA_SZ);
3317c478bd9Sstevel@tonic-gate return (rc);
3327c478bd9Sstevel@tonic-gate }
3337c478bd9Sstevel@tonic-gate }
3347c478bd9Sstevel@tonic-gate
3357c478bd9Sstevel@tonic-gate /* set action chain reference */
3367c478bd9Sstevel@tonic-gate if ((rc = ipp_action_ref(aid, cfg_parms->red_action, flags)) != 0) {
3377c478bd9Sstevel@tonic-gate tokenmt0dbg(("tokenmt_create_action: ipp_action_ref " \
3387c478bd9Sstevel@tonic-gate "returned with error %d", rc));
3397c478bd9Sstevel@tonic-gate goto cleanup;
3407c478bd9Sstevel@tonic-gate }
3417c478bd9Sstevel@tonic-gate if ((rc = ipp_action_ref(aid, cfg_parms->green_action, flags)) != 0) {
3427c478bd9Sstevel@tonic-gate tokenmt0dbg(("tokenmt_create_action: ipp_action_ref " \
3437c478bd9Sstevel@tonic-gate "returned with error %d", rc));
3447c478bd9Sstevel@tonic-gate rc2 = ipp_action_unref(aid, cfg_parms->red_action, flags);
3457c478bd9Sstevel@tonic-gate ASSERT(rc2 == 0);
3467c478bd9Sstevel@tonic-gate goto cleanup;
3477c478bd9Sstevel@tonic-gate }
3487c478bd9Sstevel@tonic-gate
3497c478bd9Sstevel@tonic-gate if (cfg_parms->yellow_action != TOKENMT_NO_ACTION) {
3507c478bd9Sstevel@tonic-gate if ((rc = ipp_action_ref(aid, cfg_parms->yellow_action,
3517c478bd9Sstevel@tonic-gate flags)) != 0) {
3527c478bd9Sstevel@tonic-gate tokenmt0dbg(("tokenmt_create_action: ipp_action_ref "\
3537c478bd9Sstevel@tonic-gate "returned with error %d", rc));
3547c478bd9Sstevel@tonic-gate rc2 = ipp_action_unref(aid, cfg_parms->red_action,
3557c478bd9Sstevel@tonic-gate flags);
3567c478bd9Sstevel@tonic-gate ASSERT(rc2 == 0);
3577c478bd9Sstevel@tonic-gate rc2 = ipp_action_unref(aid, cfg_parms->green_action,
3587c478bd9Sstevel@tonic-gate flags);
3597c478bd9Sstevel@tonic-gate ASSERT(rc2 == 0);
3607c478bd9Sstevel@tonic-gate goto cleanup;
3617c478bd9Sstevel@tonic-gate }
3627c478bd9Sstevel@tonic-gate }
3637c478bd9Sstevel@tonic-gate
3647c478bd9Sstevel@tonic-gate
3657c478bd9Sstevel@tonic-gate tokenmt_data->cfg_parms = cfg_parms;
3667c478bd9Sstevel@tonic-gate
3677c478bd9Sstevel@tonic-gate tokenmt_data->committed_tokens = cfg_parms->committed_burst;
3687c478bd9Sstevel@tonic-gate tokenmt_data->peak_tokens = cfg_parms->peak_burst;
3697c478bd9Sstevel@tonic-gate tokenmt_data->last_seen = gethrtime();
3707c478bd9Sstevel@tonic-gate
3717c478bd9Sstevel@tonic-gate mutex_init(&tokenmt_data->tokenmt_lock, NULL, MUTEX_DEFAULT, 0);
3727c478bd9Sstevel@tonic-gate ipp_action_set_ptr(aid, (void *)tokenmt_data);
3737c478bd9Sstevel@tonic-gate return (0);
3747c478bd9Sstevel@tonic-gate
3757c478bd9Sstevel@tonic-gate cleanup:
3767c478bd9Sstevel@tonic-gate if (cfg_parms->stats) {
3777c478bd9Sstevel@tonic-gate ipp_stat_destroy(tokenmt_data->stats);
3787c478bd9Sstevel@tonic-gate }
3797c478bd9Sstevel@tonic-gate kmem_free(cfg_parms, TOKENMT_CFG_SZ);
3807c478bd9Sstevel@tonic-gate kmem_free(tokenmt_data, TOKENMT_DATA_SZ);
3817c478bd9Sstevel@tonic-gate return (rc);
3827c478bd9Sstevel@tonic-gate }
3837c478bd9Sstevel@tonic-gate
3847c478bd9Sstevel@tonic-gate static int
tokenmt_modify_action(ipp_action_id_t aid,nvlist_t ** nvlpp,ipp_flags_t flags)3857c478bd9Sstevel@tonic-gate tokenmt_modify_action(ipp_action_id_t aid, nvlist_t **nvlpp, ipp_flags_t flags)
3867c478bd9Sstevel@tonic-gate {
3877c478bd9Sstevel@tonic-gate nvlist_t *nvlp;
3887c478bd9Sstevel@tonic-gate int err = 0, err2;
3897c478bd9Sstevel@tonic-gate uint8_t config_type;
3907c478bd9Sstevel@tonic-gate char *next_action_name;
3917c478bd9Sstevel@tonic-gate ipp_action_id_t next_action;
3927c478bd9Sstevel@tonic-gate uint32_t rate, cbs, pbs;
3937c478bd9Sstevel@tonic-gate tokenmt_cfg_t *cfg_parms, *old_cfg;
3947c478bd9Sstevel@tonic-gate tokenmt_data_t *tokenmt_data;
3957c478bd9Sstevel@tonic-gate uint32_t bstats, mode;
3967c478bd9Sstevel@tonic-gate int32_t *colour_tbl;
3977c478bd9Sstevel@tonic-gate uint_t nelem = 64;
3987c478bd9Sstevel@tonic-gate
3997c478bd9Sstevel@tonic-gate nvlp = *nvlpp;
4007c478bd9Sstevel@tonic-gate *nvlpp = NULL; /* nvlist should be NULL when this returns */
4017c478bd9Sstevel@tonic-gate
4027c478bd9Sstevel@tonic-gate if ((err = nvlist_lookup_byte(nvlp, IPP_CONFIG_TYPE, &config_type))
4037c478bd9Sstevel@tonic-gate != 0) {
4047c478bd9Sstevel@tonic-gate nvlist_free(nvlp);
4057c478bd9Sstevel@tonic-gate tokenmt0dbg(("tokenmt_modify_action: invalid configuration "\
4067c478bd9Sstevel@tonic-gate "type"));
4077c478bd9Sstevel@tonic-gate return (err);
4087c478bd9Sstevel@tonic-gate }
4097c478bd9Sstevel@tonic-gate
4107c478bd9Sstevel@tonic-gate if (config_type != IPP_SET) {
4117c478bd9Sstevel@tonic-gate nvlist_free(nvlp);
4127c478bd9Sstevel@tonic-gate tokenmt0dbg(("tokenmt_modify_action: invalid configuration "\
4137c478bd9Sstevel@tonic-gate "type %d", config_type));
4147c478bd9Sstevel@tonic-gate return (EINVAL);
4157c478bd9Sstevel@tonic-gate }
4167c478bd9Sstevel@tonic-gate
4177c478bd9Sstevel@tonic-gate tokenmt_data = (tokenmt_data_t *)ipp_action_get_ptr(aid);
4187c478bd9Sstevel@tonic-gate old_cfg = tokenmt_data->cfg_parms;
4197c478bd9Sstevel@tonic-gate
4207c478bd9Sstevel@tonic-gate cfg_parms = kmem_zalloc(TOKENMT_CFG_SZ, KM_NOSLEEP);
4217c478bd9Sstevel@tonic-gate if (cfg_parms == NULL) {
4227c478bd9Sstevel@tonic-gate nvlist_free(nvlp);
4237c478bd9Sstevel@tonic-gate tokenmt0dbg(("tokenmt_modify_action: memory allocation "\
4247c478bd9Sstevel@tonic-gate "failure\n"));
4257c478bd9Sstevel@tonic-gate return (ENOMEM);
4267c478bd9Sstevel@tonic-gate }
4277c478bd9Sstevel@tonic-gate
4287c478bd9Sstevel@tonic-gate /* Just copy all and change as needed */
4297c478bd9Sstevel@tonic-gate bcopy(old_cfg, cfg_parms, TOKENMT_CFG_SZ);
4307c478bd9Sstevel@tonic-gate
4317c478bd9Sstevel@tonic-gate /* parse red action name, if present */
4327c478bd9Sstevel@tonic-gate if ((err = nvlist_lookup_string(nvlp, TOKENMT_RED_ACTION_NAME,
4337c478bd9Sstevel@tonic-gate &next_action_name)) == 0) {
4347c478bd9Sstevel@tonic-gate /* Get action id */
4357c478bd9Sstevel@tonic-gate if ((next_action = ipp_action_lookup(next_action_name))
4367c478bd9Sstevel@tonic-gate == IPP_ACTION_INVAL) {
4377c478bd9Sstevel@tonic-gate nvlist_free(nvlp);
4387c478bd9Sstevel@tonic-gate tokenmt0dbg(("tokenmt_modify_action: next_action "\
4397c478bd9Sstevel@tonic-gate "invalid"));
4407c478bd9Sstevel@tonic-gate kmem_free(cfg_parms, TOKENMT_CFG_SZ);
4417c478bd9Sstevel@tonic-gate return (EINVAL);
4427c478bd9Sstevel@tonic-gate }
4437c478bd9Sstevel@tonic-gate cfg_parms->red_action = next_action;
4447c478bd9Sstevel@tonic-gate }
4457c478bd9Sstevel@tonic-gate
4467c478bd9Sstevel@tonic-gate /* parse yellow action name, if present */
4477c478bd9Sstevel@tonic-gate if ((err = nvlist_lookup_string(nvlp, TOKENMT_YELLOW_ACTION_NAME,
4487c478bd9Sstevel@tonic-gate &next_action_name)) == 0) {
4497c478bd9Sstevel@tonic-gate /* Get action id */
4507c478bd9Sstevel@tonic-gate if ((next_action = ipp_action_lookup(next_action_name))
4517c478bd9Sstevel@tonic-gate == IPP_ACTION_INVAL) {
4527c478bd9Sstevel@tonic-gate nvlist_free(nvlp);
4537c478bd9Sstevel@tonic-gate tokenmt0dbg(("tokenmt_modify_action: next_action "\
4547c478bd9Sstevel@tonic-gate "invalid"));
4557c478bd9Sstevel@tonic-gate kmem_free(cfg_parms, TOKENMT_CFG_SZ);
4567c478bd9Sstevel@tonic-gate return (EINVAL);
4577c478bd9Sstevel@tonic-gate }
4587c478bd9Sstevel@tonic-gate cfg_parms->yellow_action = next_action;
4597c478bd9Sstevel@tonic-gate } else {
4607c478bd9Sstevel@tonic-gate cfg_parms->yellow_action = TOKENMT_NO_ACTION;
4617c478bd9Sstevel@tonic-gate }
4627c478bd9Sstevel@tonic-gate
4637c478bd9Sstevel@tonic-gate /* parse green action name, if present */
4647c478bd9Sstevel@tonic-gate if ((err = nvlist_lookup_string(nvlp, TOKENMT_GREEN_ACTION_NAME,
4657c478bd9Sstevel@tonic-gate &next_action_name)) == 0) {
4667c478bd9Sstevel@tonic-gate /* Get action id */
4677c478bd9Sstevel@tonic-gate if ((next_action = ipp_action_lookup(next_action_name))
4687c478bd9Sstevel@tonic-gate == IPP_ACTION_INVAL) {
4697c478bd9Sstevel@tonic-gate nvlist_free(nvlp);
4707c478bd9Sstevel@tonic-gate tokenmt0dbg(("tokenmt_modify_action: next_action "\
4717c478bd9Sstevel@tonic-gate "invalid"));
4727c478bd9Sstevel@tonic-gate kmem_free(cfg_parms, TOKENMT_CFG_SZ);
4737c478bd9Sstevel@tonic-gate return (EINVAL);
4747c478bd9Sstevel@tonic-gate }
4757c478bd9Sstevel@tonic-gate cfg_parms->green_action = next_action;
4767c478bd9Sstevel@tonic-gate }
4777c478bd9Sstevel@tonic-gate
4787c478bd9Sstevel@tonic-gate /* parse committed rate, if present */
4797c478bd9Sstevel@tonic-gate if ((err = nvlist_lookup_uint32(nvlp, TOKENMT_COMMITTED_RATE, &rate))
4807c478bd9Sstevel@tonic-gate == 0) {
4817c478bd9Sstevel@tonic-gate if (rate == 0) {
4827c478bd9Sstevel@tonic-gate nvlist_free(nvlp);
4837c478bd9Sstevel@tonic-gate tokenmt0dbg(("tokenmt_modify_action: invalid "\
4847c478bd9Sstevel@tonic-gate "committed rate %u\n", cfg_parms->committed_rate));
4857c478bd9Sstevel@tonic-gate kmem_free(cfg_parms, TOKENMT_CFG_SZ);
4867c478bd9Sstevel@tonic-gate return (EINVAL);
4877c478bd9Sstevel@tonic-gate }
4887c478bd9Sstevel@tonic-gate cfg_parms->committed_rate = rate;
4897c478bd9Sstevel@tonic-gate }
4907c478bd9Sstevel@tonic-gate
4917c478bd9Sstevel@tonic-gate /* parse committed burst, if present */
4927c478bd9Sstevel@tonic-gate if (nvlist_lookup_uint32(nvlp, TOKENMT_COMMITTED_BURST, &cbs) == 0) {
4937c478bd9Sstevel@tonic-gate cfg_parms->committed_burst = cbs;
4947c478bd9Sstevel@tonic-gate }
4957c478bd9Sstevel@tonic-gate
4967c478bd9Sstevel@tonic-gate
4977c478bd9Sstevel@tonic-gate if (nvlist_lookup_uint32(nvlp, TOKENMT_PEAK_BURST, &pbs) == 0) {
4987c478bd9Sstevel@tonic-gate cfg_parms->peak_burst = pbs;
4997c478bd9Sstevel@tonic-gate } else {
5007c478bd9Sstevel@tonic-gate cfg_parms->peak_burst = 0;
5017c478bd9Sstevel@tonic-gate }
5027c478bd9Sstevel@tonic-gate
5037c478bd9Sstevel@tonic-gate /* If the peak rate is not specified, then it means single rate meter */
5047c478bd9Sstevel@tonic-gate if (nvlist_lookup_uint32(nvlp, TOKENMT_PEAK_RATE, &rate) == 0) {
5057c478bd9Sstevel@tonic-gate cfg_parms->peak_rate = rate;
5067c478bd9Sstevel@tonic-gate if ((rate == 0) || (rate < cfg_parms->committed_rate)) {
5077c478bd9Sstevel@tonic-gate nvlist_free(nvlp);
5087c478bd9Sstevel@tonic-gate tokenmt0dbg(("tokenmt_modify_action: invalid "\
5097c478bd9Sstevel@tonic-gate "committed rate %u\n", cfg_parms->committed_rate));
5107c478bd9Sstevel@tonic-gate kmem_free(cfg_parms, TOKENMT_CFG_SZ);
5117c478bd9Sstevel@tonic-gate return (EINVAL);
5127c478bd9Sstevel@tonic-gate }
5137c478bd9Sstevel@tonic-gate cfg_parms->tokenmt_type = TRTCL_TOKENMT;
5147c478bd9Sstevel@tonic-gate } else {
5157c478bd9Sstevel@tonic-gate cfg_parms->peak_rate = 0;
5167c478bd9Sstevel@tonic-gate cfg_parms->tokenmt_type = SRTCL_TOKENMT;
5177c478bd9Sstevel@tonic-gate }
5187c478bd9Sstevel@tonic-gate
5197c478bd9Sstevel@tonic-gate if (cfg_parms->yellow_action == TOKENMT_NO_ACTION) {
5207c478bd9Sstevel@tonic-gate if ((cfg_parms->peak_burst != 0) ||
5217c478bd9Sstevel@tonic-gate (cfg_parms->tokenmt_type == TRTCL_TOKENMT)) {
5227c478bd9Sstevel@tonic-gate nvlist_free(nvlp);
5237c478bd9Sstevel@tonic-gate tokenmt0dbg(("tokenmt_modify_action: yellow action "\
5247c478bd9Sstevel@tonic-gate "missing\n"));
5257c478bd9Sstevel@tonic-gate kmem_free(cfg_parms, TOKENMT_CFG_SZ);
5267c478bd9Sstevel@tonic-gate return (EINVAL);
5277c478bd9Sstevel@tonic-gate }
5287c478bd9Sstevel@tonic-gate } else {
5297c478bd9Sstevel@tonic-gate if ((cfg_parms->tokenmt_type != TRTCL_TOKENMT) &&
5307c478bd9Sstevel@tonic-gate (cfg_parms->peak_burst == 0)) {
5317c478bd9Sstevel@tonic-gate nvlist_free(nvlp);
5327c478bd9Sstevel@tonic-gate tokenmt0dbg(("tokenmt_modify_action: peak "\
5337c478bd9Sstevel@tonic-gate "burst/rate missing\n"));
5347c478bd9Sstevel@tonic-gate kmem_free(cfg_parms, TOKENMT_CFG_SZ);
5357c478bd9Sstevel@tonic-gate return (EINVAL);
5367c478bd9Sstevel@tonic-gate }
5377c478bd9Sstevel@tonic-gate }
5387c478bd9Sstevel@tonic-gate
5397c478bd9Sstevel@tonic-gate /* Validate the committed and peak burst size */
5407c478bd9Sstevel@tonic-gate if (cfg_parms->tokenmt_type == SRTCL_TOKENMT) {
5417c478bd9Sstevel@tonic-gate if ((cfg_parms->committed_burst == 0) &&
5427c478bd9Sstevel@tonic-gate (cfg_parms->peak_burst == 0)) {
5437c478bd9Sstevel@tonic-gate nvlist_free(nvlp);
5447c478bd9Sstevel@tonic-gate tokenmt0dbg(("tokenmt_modify_action: at least one "\
5457c478bd9Sstevel@tonic-gate "burst size must be non-zero\n"));
5467c478bd9Sstevel@tonic-gate kmem_free(cfg_parms, TOKENMT_CFG_SZ);
5477c478bd9Sstevel@tonic-gate return (EINVAL);
5487c478bd9Sstevel@tonic-gate }
5497c478bd9Sstevel@tonic-gate } else { /* TRTCL_TOKENMT */
5507c478bd9Sstevel@tonic-gate if ((cfg_parms->committed_burst == 0) ||
5517c478bd9Sstevel@tonic-gate (cfg_parms->peak_burst == 0)) {
5527c478bd9Sstevel@tonic-gate nvlist_free(nvlp);
5537c478bd9Sstevel@tonic-gate tokenmt0dbg(("tokenmt_modify_action: both the "\
5547c478bd9Sstevel@tonic-gate "burst sizes must be non-zero\n"));
5557c478bd9Sstevel@tonic-gate kmem_free(cfg_parms, TOKENMT_CFG_SZ);
5567c478bd9Sstevel@tonic-gate return (EINVAL);
5577c478bd9Sstevel@tonic-gate }
5587c478bd9Sstevel@tonic-gate }
5597c478bd9Sstevel@tonic-gate
5607c478bd9Sstevel@tonic-gate /* parse mode */
5617c478bd9Sstevel@tonic-gate if (nvlist_lookup_uint32(nvlp, TOKENMT_COLOUR_AWARE, &mode) == 0) {
5627c478bd9Sstevel@tonic-gate cfg_parms->colour_aware = (mode == 0) ? B_FALSE : B_TRUE;
5637c478bd9Sstevel@tonic-gate } else {
5647c478bd9Sstevel@tonic-gate cfg_parms->colour_aware = B_FALSE;
5657c478bd9Sstevel@tonic-gate }
5667c478bd9Sstevel@tonic-gate
5677c478bd9Sstevel@tonic-gate if (cfg_parms->colour_aware) {
5687c478bd9Sstevel@tonic-gate if (nvlist_lookup_int32_array(nvlp, TOKENMT_COLOUR_MAP,
5697c478bd9Sstevel@tonic-gate &colour_tbl, &nelem) == 0) {
5707c478bd9Sstevel@tonic-gate int count;
5717c478bd9Sstevel@tonic-gate for (count = 0; count < 64; count++) {
5727c478bd9Sstevel@tonic-gate if (colour_tbl[count] == -1)
5737c478bd9Sstevel@tonic-gate continue;
5747c478bd9Sstevel@tonic-gate cfg_parms->dscp_to_colour[count] =
5757c478bd9Sstevel@tonic-gate colour_tbl[count];
5767c478bd9Sstevel@tonic-gate }
5777c478bd9Sstevel@tonic-gate } else {
5787c478bd9Sstevel@tonic-gate bcopy(default_dscp_to_colour, cfg_parms->dscp_to_colour,
5797c478bd9Sstevel@tonic-gate sizeof (default_dscp_to_colour));
5807c478bd9Sstevel@tonic-gate }
5817c478bd9Sstevel@tonic-gate }
5827c478bd9Sstevel@tonic-gate
5837c478bd9Sstevel@tonic-gate /* parse stats, if present */
5847c478bd9Sstevel@tonic-gate if (nvlist_lookup_uint32(nvlp, IPP_ACTION_STATS_ENABLE, &bstats) == 0) {
5857c478bd9Sstevel@tonic-gate cfg_parms->stats = (bstats == 0) ? B_FALSE : B_TRUE;
5867c478bd9Sstevel@tonic-gate if (cfg_parms->stats && !old_cfg->stats) {
5877c478bd9Sstevel@tonic-gate if ((err = tokenmt_statinit(aid, tokenmt_data)) != 0) {
5887c478bd9Sstevel@tonic-gate nvlist_free(nvlp);
5897c478bd9Sstevel@tonic-gate kmem_free(cfg_parms, TOKENMT_CFG_SZ);
5907c478bd9Sstevel@tonic-gate return (err);
5917c478bd9Sstevel@tonic-gate }
5927c478bd9Sstevel@tonic-gate } else if (!cfg_parms->stats && old_cfg->stats) {
5937c478bd9Sstevel@tonic-gate ipp_stat_destroy(tokenmt_data->stats);
5947c478bd9Sstevel@tonic-gate }
5957c478bd9Sstevel@tonic-gate }
5967c478bd9Sstevel@tonic-gate
5977c478bd9Sstevel@tonic-gate /* Can we ref all the new actions? */
5987c478bd9Sstevel@tonic-gate if ((err = ipp_action_ref(aid, cfg_parms->red_action, flags)) != 0) {
5997c478bd9Sstevel@tonic-gate tokenmt0dbg(("tokenmt_modify_data: can't ref. red action\n"));
6007c478bd9Sstevel@tonic-gate kmem_free(cfg_parms, TOKENMT_CFG_SZ);
6017c478bd9Sstevel@tonic-gate return (err);
6027c478bd9Sstevel@tonic-gate }
6037c478bd9Sstevel@tonic-gate if ((err = ipp_action_ref(aid, cfg_parms->green_action, flags)) != 0) {
6047c478bd9Sstevel@tonic-gate tokenmt0dbg(("tokenmt_modify_data:can't ref. green action\n"));
6057c478bd9Sstevel@tonic-gate err2 = ipp_action_unref(aid, cfg_parms->red_action, flags);
6067c478bd9Sstevel@tonic-gate ASSERT(err2 == 0);
6077c478bd9Sstevel@tonic-gate kmem_free(cfg_parms, TOKENMT_CFG_SZ);
6087c478bd9Sstevel@tonic-gate return (err);
6097c478bd9Sstevel@tonic-gate }
6107c478bd9Sstevel@tonic-gate
6117c478bd9Sstevel@tonic-gate if (cfg_parms->yellow_action != TOKENMT_NO_ACTION) {
6127c478bd9Sstevel@tonic-gate if ((err = ipp_action_ref(aid, cfg_parms->yellow_action,
6137c478bd9Sstevel@tonic-gate flags)) != 0) {
6147c478bd9Sstevel@tonic-gate tokenmt0dbg(("tokenmt_modify_data:can't ref. yellow "\
6157c478bd9Sstevel@tonic-gate "action\n"));
6167c478bd9Sstevel@tonic-gate err2 = ipp_action_unref(aid, cfg_parms->red_action,
6177c478bd9Sstevel@tonic-gate flags);
6187c478bd9Sstevel@tonic-gate ASSERT(err2 == 0);
6197c478bd9Sstevel@tonic-gate err2 = ipp_action_unref(aid, cfg_parms->green_action,
6207c478bd9Sstevel@tonic-gate flags);
6217c478bd9Sstevel@tonic-gate ASSERT(err2 == 0);
6227c478bd9Sstevel@tonic-gate kmem_free(cfg_parms, TOKENMT_CFG_SZ);
6237c478bd9Sstevel@tonic-gate return (err);
6247c478bd9Sstevel@tonic-gate }
6257c478bd9Sstevel@tonic-gate }
6267c478bd9Sstevel@tonic-gate
6277c478bd9Sstevel@tonic-gate
6287c478bd9Sstevel@tonic-gate /* Actually modify the configuration */
6297c478bd9Sstevel@tonic-gate mutex_enter(&tokenmt_data->tokenmt_lock);
6307c478bd9Sstevel@tonic-gate tokenmt_data->cfg_parms = cfg_parms;
6317c478bd9Sstevel@tonic-gate mutex_exit(&tokenmt_data->tokenmt_lock);
6327c478bd9Sstevel@tonic-gate
6337c478bd9Sstevel@tonic-gate /* Un-ref the old actions */
6347c478bd9Sstevel@tonic-gate err = ipp_action_unref(aid, old_cfg->red_action, flags);
6357c478bd9Sstevel@tonic-gate ASSERT(err == 0);
6367c478bd9Sstevel@tonic-gate if (old_cfg->yellow_action != TOKENMT_NO_ACTION) {
6377c478bd9Sstevel@tonic-gate err = ipp_action_unref(aid, old_cfg->yellow_action, flags);
6387c478bd9Sstevel@tonic-gate ASSERT(err == 0);
6397c478bd9Sstevel@tonic-gate }
6407c478bd9Sstevel@tonic-gate err = ipp_action_unref(aid, old_cfg->green_action, flags);
6417c478bd9Sstevel@tonic-gate ASSERT(err == 0);
6427c478bd9Sstevel@tonic-gate
6437c478bd9Sstevel@tonic-gate /* Free the old configuration */
6447c478bd9Sstevel@tonic-gate kmem_free(old_cfg, TOKENMT_CFG_SZ);
6457c478bd9Sstevel@tonic-gate return (0);
6467c478bd9Sstevel@tonic-gate }
6477c478bd9Sstevel@tonic-gate
6487c478bd9Sstevel@tonic-gate static int
tokenmt_destroy_action(ipp_action_id_t aid,ipp_flags_t flags)6497c478bd9Sstevel@tonic-gate tokenmt_destroy_action(ipp_action_id_t aid, ipp_flags_t flags)
6507c478bd9Sstevel@tonic-gate {
6517c478bd9Sstevel@tonic-gate tokenmt_data_t *tokenmt_data;
6527c478bd9Sstevel@tonic-gate tokenmt_cfg_t *cfg_parms;
6537c478bd9Sstevel@tonic-gate int rc;
6547c478bd9Sstevel@tonic-gate
6557c478bd9Sstevel@tonic-gate tokenmt_data = (tokenmt_data_t *)ipp_action_get_ptr(aid);
6567c478bd9Sstevel@tonic-gate ASSERT(tokenmt_data != NULL);
6577c478bd9Sstevel@tonic-gate
6587c478bd9Sstevel@tonic-gate cfg_parms = tokenmt_data->cfg_parms;
6597c478bd9Sstevel@tonic-gate
6607c478bd9Sstevel@tonic-gate if (cfg_parms->stats) {
6617c478bd9Sstevel@tonic-gate ipp_stat_destroy(tokenmt_data->stats);
6627c478bd9Sstevel@tonic-gate }
6637c478bd9Sstevel@tonic-gate
6647c478bd9Sstevel@tonic-gate /* unreference the action */
6657c478bd9Sstevel@tonic-gate rc = ipp_action_unref(aid, cfg_parms->red_action, flags);
6667c478bd9Sstevel@tonic-gate ASSERT(rc == 0);
6677c478bd9Sstevel@tonic-gate if (cfg_parms->yellow_action != TOKENMT_NO_ACTION) {
6687c478bd9Sstevel@tonic-gate rc = ipp_action_unref(aid, cfg_parms->yellow_action, flags);
6697c478bd9Sstevel@tonic-gate ASSERT(rc == 0);
6707c478bd9Sstevel@tonic-gate }
6717c478bd9Sstevel@tonic-gate rc = ipp_action_unref(aid, cfg_parms->green_action, flags);
6727c478bd9Sstevel@tonic-gate ASSERT(rc == 0);
6737c478bd9Sstevel@tonic-gate
6747c478bd9Sstevel@tonic-gate mutex_destroy(&tokenmt_data->tokenmt_lock);
6757c478bd9Sstevel@tonic-gate kmem_free(cfg_parms, TOKENMT_CFG_SZ);
6767c478bd9Sstevel@tonic-gate kmem_free(tokenmt_data, TOKENMT_DATA_SZ);
6777c478bd9Sstevel@tonic-gate return (0);
6787c478bd9Sstevel@tonic-gate }
6797c478bd9Sstevel@tonic-gate
6807c478bd9Sstevel@tonic-gate static int
tokenmt_invoke_action(ipp_action_id_t aid,ipp_packet_t * packet)6817c478bd9Sstevel@tonic-gate tokenmt_invoke_action(ipp_action_id_t aid, ipp_packet_t *packet)
6827c478bd9Sstevel@tonic-gate {
6837c478bd9Sstevel@tonic-gate tokenmt_data_t *tokenmt_data;
6847c478bd9Sstevel@tonic-gate ipp_action_id_t next_action;
6857c478bd9Sstevel@tonic-gate mblk_t *mp = NULL;
6867c478bd9Sstevel@tonic-gate int rc;
6877c478bd9Sstevel@tonic-gate
6887c478bd9Sstevel@tonic-gate /* get mblk from ipp_packet structure */
6897c478bd9Sstevel@tonic-gate mp = ipp_packet_get_data(packet);
6907c478bd9Sstevel@tonic-gate tokenmt_data = (tokenmt_data_t *)ipp_action_get_ptr(aid);
6917c478bd9Sstevel@tonic-gate ASSERT(tokenmt_data != NULL);
6927c478bd9Sstevel@tonic-gate
6937c478bd9Sstevel@tonic-gate /* meter packet as configured */
6947c478bd9Sstevel@tonic-gate if ((rc = tokenmt_process(&mp, tokenmt_data, &next_action)) != 0) {
6957c478bd9Sstevel@tonic-gate return (rc);
6967c478bd9Sstevel@tonic-gate } else {
6977c478bd9Sstevel@tonic-gate return (ipp_packet_next(packet, next_action));
6987c478bd9Sstevel@tonic-gate }
6997c478bd9Sstevel@tonic-gate }
7007c478bd9Sstevel@tonic-gate
7017c478bd9Sstevel@tonic-gate static int
tokenmt_statinit(ipp_action_id_t aid,tokenmt_data_t * tokenmt_data)7027c478bd9Sstevel@tonic-gate tokenmt_statinit(ipp_action_id_t aid, tokenmt_data_t *tokenmt_data) {
7037c478bd9Sstevel@tonic-gate
7047c478bd9Sstevel@tonic-gate int rc = 0;
7057c478bd9Sstevel@tonic-gate meter_stat_t *statsp;
7067c478bd9Sstevel@tonic-gate
7077c478bd9Sstevel@tonic-gate /* install stats entry */
7087c478bd9Sstevel@tonic-gate if ((rc = ipp_stat_create(aid, TOKENMT_STATS_STRING, METER_STATS_COUNT,
7097c478bd9Sstevel@tonic-gate tokenmt_update_stats, tokenmt_data, &tokenmt_data->stats)) != 0) {
7107c478bd9Sstevel@tonic-gate tokenmt0dbg(("tokenmt_statinit: ipp_stat_create failed "\
7117c478bd9Sstevel@tonic-gate " with %d\n", rc));
7127c478bd9Sstevel@tonic-gate return (rc);
7137c478bd9Sstevel@tonic-gate }
7147c478bd9Sstevel@tonic-gate
7157c478bd9Sstevel@tonic-gate statsp = (meter_stat_t *)(tokenmt_data->stats)->ipps_data;
7167c478bd9Sstevel@tonic-gate ASSERT(statsp != NULL);
7177c478bd9Sstevel@tonic-gate
7187c478bd9Sstevel@tonic-gate if ((rc = ipp_stat_named_init(tokenmt_data->stats, "red_packets",
7197c478bd9Sstevel@tonic-gate IPP_STAT_UINT64, &statsp->red_packets)) != 0) {
7207c478bd9Sstevel@tonic-gate tokenmt0dbg(("tokenmt_statinit:ipp_stat_named_init failed "\
7217c478bd9Sstevel@tonic-gate " with %d\n", rc));
7227c478bd9Sstevel@tonic-gate return (rc);
7237c478bd9Sstevel@tonic-gate }
7247c478bd9Sstevel@tonic-gate if ((rc = ipp_stat_named_init(tokenmt_data->stats, "yellow_packets",
7257c478bd9Sstevel@tonic-gate IPP_STAT_UINT64, &statsp->yellow_packets)) != 0) {
7267c478bd9Sstevel@tonic-gate tokenmt0dbg(("tokenmt_statinit:ipp_stat_named_init failed "\
7277c478bd9Sstevel@tonic-gate " with %d\n", rc));
7287c478bd9Sstevel@tonic-gate return (rc);
7297c478bd9Sstevel@tonic-gate }
7307c478bd9Sstevel@tonic-gate if ((rc = ipp_stat_named_init(tokenmt_data->stats, "green_packets",
7317c478bd9Sstevel@tonic-gate IPP_STAT_UINT64, &statsp->green_packets)) != 0) {
7327c478bd9Sstevel@tonic-gate tokenmt0dbg(("tokenmt_statinit:ipp_stat_named_init failed "\
7337c478bd9Sstevel@tonic-gate " with %d\n", rc));
7347c478bd9Sstevel@tonic-gate return (rc);
7357c478bd9Sstevel@tonic-gate }
7367c478bd9Sstevel@tonic-gate if ((rc = ipp_stat_named_init(tokenmt_data->stats, "red_bits",
7377c478bd9Sstevel@tonic-gate IPP_STAT_UINT64, &statsp->red_bits)) != 0) {
7387c478bd9Sstevel@tonic-gate tokenmt0dbg(("tokenmt_statinit:ipp_stat_named_init failed "\
7397c478bd9Sstevel@tonic-gate " with %d\n", rc));
7407c478bd9Sstevel@tonic-gate return (rc);
7417c478bd9Sstevel@tonic-gate }
7427c478bd9Sstevel@tonic-gate if ((rc = ipp_stat_named_init(tokenmt_data->stats, "yellow_bits",
7437c478bd9Sstevel@tonic-gate IPP_STAT_UINT64, &statsp->yellow_bits)) != 0) {
7447c478bd9Sstevel@tonic-gate tokenmt0dbg(("tokenmt_statinit:ipp_stat_named_init failed "\
7457c478bd9Sstevel@tonic-gate " with %d\n", rc));
7467c478bd9Sstevel@tonic-gate return (rc);
7477c478bd9Sstevel@tonic-gate }
7487c478bd9Sstevel@tonic-gate if ((rc = ipp_stat_named_init(tokenmt_data->stats, "green_bits",
7497c478bd9Sstevel@tonic-gate IPP_STAT_UINT64, &statsp->green_bits)) != 0) {
7507c478bd9Sstevel@tonic-gate tokenmt0dbg(("tokenmt_statinit:ipp_stat_named_init failed "\
7517c478bd9Sstevel@tonic-gate " with %d\n", rc));
7527c478bd9Sstevel@tonic-gate return (rc);
7537c478bd9Sstevel@tonic-gate }
7547c478bd9Sstevel@tonic-gate if ((rc = ipp_stat_named_init(tokenmt_data->stats, "epackets",
7557c478bd9Sstevel@tonic-gate IPP_STAT_UINT64, &statsp->epackets)) != 0) {
7567c478bd9Sstevel@tonic-gate tokenmt0dbg(("tokenmt_statinit:ipp_stat_named_init failed "\
7577c478bd9Sstevel@tonic-gate " with %d\n", rc));
7587c478bd9Sstevel@tonic-gate return (rc);
7597c478bd9Sstevel@tonic-gate }
7607c478bd9Sstevel@tonic-gate
7617c478bd9Sstevel@tonic-gate ipp_stat_install(tokenmt_data->stats);
7627c478bd9Sstevel@tonic-gate
7637c478bd9Sstevel@tonic-gate return (rc);
7647c478bd9Sstevel@tonic-gate }
7657c478bd9Sstevel@tonic-gate
7667c478bd9Sstevel@tonic-gate static int
tokenmt_update_stats(ipp_stat_t * sp,void * args,int rw)7677c478bd9Sstevel@tonic-gate tokenmt_update_stats(ipp_stat_t *sp, void *args, int rw)
7687c478bd9Sstevel@tonic-gate {
7697c478bd9Sstevel@tonic-gate tokenmt_data_t *tokenmt_data = (tokenmt_data_t *)args;
7707c478bd9Sstevel@tonic-gate meter_stat_t *stats = (meter_stat_t *)sp->ipps_data;
7717c478bd9Sstevel@tonic-gate
7727c478bd9Sstevel@tonic-gate ASSERT((tokenmt_data != NULL) && (stats != NULL));
7737c478bd9Sstevel@tonic-gate
7747c478bd9Sstevel@tonic-gate (void) ipp_stat_named_op(&stats->red_packets,
7757c478bd9Sstevel@tonic-gate &tokenmt_data->red_packets, rw);
7767c478bd9Sstevel@tonic-gate (void) ipp_stat_named_op(&stats->yellow_packets,
7777c478bd9Sstevel@tonic-gate &tokenmt_data->yellow_packets, rw);
7787c478bd9Sstevel@tonic-gate (void) ipp_stat_named_op(&stats->green_packets,
7797c478bd9Sstevel@tonic-gate &tokenmt_data->green_packets, rw);
7807c478bd9Sstevel@tonic-gate (void) ipp_stat_named_op(&stats->red_bits,
7817c478bd9Sstevel@tonic-gate &tokenmt_data->red_bits, rw);
7827c478bd9Sstevel@tonic-gate (void) ipp_stat_named_op(&stats->yellow_bits,
7837c478bd9Sstevel@tonic-gate &tokenmt_data->yellow_bits, rw);
7847c478bd9Sstevel@tonic-gate (void) ipp_stat_named_op(&stats->green_bits,
7857c478bd9Sstevel@tonic-gate &tokenmt_data->green_bits, rw);
7867c478bd9Sstevel@tonic-gate (void) ipp_stat_named_op(&stats->epackets, &tokenmt_data->epackets,
7877c478bd9Sstevel@tonic-gate rw);
7887c478bd9Sstevel@tonic-gate
7897c478bd9Sstevel@tonic-gate return (0);
7907c478bd9Sstevel@tonic-gate }
7917c478bd9Sstevel@tonic-gate
7927c478bd9Sstevel@tonic-gate /* ARGSUSED */
7937c478bd9Sstevel@tonic-gate static int
tokenmt_info(ipp_action_id_t aid,int (* fn)(nvlist_t *,void *),void * arg,ipp_flags_t flags)7947c478bd9Sstevel@tonic-gate tokenmt_info(ipp_action_id_t aid, int (*fn)(nvlist_t *, void *), void *arg,
7957c478bd9Sstevel@tonic-gate ipp_flags_t flags)
7967c478bd9Sstevel@tonic-gate {
7977c478bd9Sstevel@tonic-gate nvlist_t *nvlp;
7987c478bd9Sstevel@tonic-gate tokenmt_data_t *tokenmt_data;
7997c478bd9Sstevel@tonic-gate tokenmt_cfg_t *cfg_parms;
8007c478bd9Sstevel@tonic-gate char *next_action;
8017c478bd9Sstevel@tonic-gate int32_t dscp_to_colour[64];
8027c478bd9Sstevel@tonic-gate int rc;
8037c478bd9Sstevel@tonic-gate
8047c478bd9Sstevel@tonic-gate tokenmt_data = (tokenmt_data_t *)ipp_action_get_ptr(aid);
8057c478bd9Sstevel@tonic-gate ASSERT(tokenmt_data != NULL);
8067c478bd9Sstevel@tonic-gate
8077c478bd9Sstevel@tonic-gate cfg_parms = tokenmt_data->cfg_parms;
8087c478bd9Sstevel@tonic-gate
8097c478bd9Sstevel@tonic-gate /* allocate nvlist to be passed back */
8107c478bd9Sstevel@tonic-gate if ((rc = nvlist_alloc(&nvlp, NV_UNIQUE_NAME, KM_NOSLEEP)) != 0) {
8117c478bd9Sstevel@tonic-gate tokenmt0dbg(("tokenmt_info: memory allocation failure\n"));
8127c478bd9Sstevel@tonic-gate return (rc);
8137c478bd9Sstevel@tonic-gate }
8147c478bd9Sstevel@tonic-gate
8157c478bd9Sstevel@tonic-gate /* look up red next action with the next action id */
8167c478bd9Sstevel@tonic-gate if ((rc = ipp_action_name(cfg_parms->red_action, &next_action)) != 0) {
8177c478bd9Sstevel@tonic-gate tokenmt0dbg(("tokenmt_info: red_action not available\n"));
8187c478bd9Sstevel@tonic-gate nvlist_free(nvlp);
8197c478bd9Sstevel@tonic-gate return (rc);
8207c478bd9Sstevel@tonic-gate }
8217c478bd9Sstevel@tonic-gate
8227c478bd9Sstevel@tonic-gate /* add next action name */
8237c478bd9Sstevel@tonic-gate if ((rc = nvlist_add_string(nvlp, TOKENMT_RED_ACTION_NAME,
8247c478bd9Sstevel@tonic-gate next_action)) != 0) {
8257c478bd9Sstevel@tonic-gate nvlist_free(nvlp);
8267c478bd9Sstevel@tonic-gate tokenmt0dbg(("tokenmt_info: error adding red_action\n"));
8277c478bd9Sstevel@tonic-gate kmem_free(next_action, (strlen(next_action) + 1));
8287c478bd9Sstevel@tonic-gate return (rc);
8297c478bd9Sstevel@tonic-gate }
8307c478bd9Sstevel@tonic-gate
8317c478bd9Sstevel@tonic-gate /* free action name */
8327c478bd9Sstevel@tonic-gate kmem_free(next_action, (strlen(next_action) + 1));
8337c478bd9Sstevel@tonic-gate
8347c478bd9Sstevel@tonic-gate
8357c478bd9Sstevel@tonic-gate /* look up yellow next action with the next action id */
8367c478bd9Sstevel@tonic-gate if (cfg_parms->yellow_action != TOKENMT_NO_ACTION) {
8377c478bd9Sstevel@tonic-gate if ((rc = ipp_action_name(cfg_parms->yellow_action,
8387c478bd9Sstevel@tonic-gate &next_action)) != 0) {
8397c478bd9Sstevel@tonic-gate tokenmt0dbg(("tokenmt_info: yellow_action not "\
8407c478bd9Sstevel@tonic-gate "available\n"));
8417c478bd9Sstevel@tonic-gate nvlist_free(nvlp);
8427c478bd9Sstevel@tonic-gate return (rc);
8437c478bd9Sstevel@tonic-gate }
8447c478bd9Sstevel@tonic-gate /* add next action name */
8457c478bd9Sstevel@tonic-gate if ((rc = nvlist_add_string(nvlp, TOKENMT_YELLOW_ACTION_NAME,
8467c478bd9Sstevel@tonic-gate next_action)) != 0) {
8477c478bd9Sstevel@tonic-gate nvlist_free(nvlp);
8487c478bd9Sstevel@tonic-gate tokenmt0dbg(("tokenmt_info: error adding "\
8497c478bd9Sstevel@tonic-gate "yellow_action\n"));
8507c478bd9Sstevel@tonic-gate kmem_free(next_action, (strlen(next_action) + 1));
8517c478bd9Sstevel@tonic-gate return (rc);
8527c478bd9Sstevel@tonic-gate }
8537c478bd9Sstevel@tonic-gate /* free action name */
8547c478bd9Sstevel@tonic-gate kmem_free(next_action, (strlen(next_action) + 1));
8557c478bd9Sstevel@tonic-gate }
8567c478bd9Sstevel@tonic-gate
8577c478bd9Sstevel@tonic-gate /* look up green next action with the next action id */
8587c478bd9Sstevel@tonic-gate if ((rc = ipp_action_name(cfg_parms->green_action,
8597c478bd9Sstevel@tonic-gate &next_action)) != 0) {
8607c478bd9Sstevel@tonic-gate tokenmt0dbg(("tokenmt_info: green_action not available\n"));
8617c478bd9Sstevel@tonic-gate nvlist_free(nvlp);
8627c478bd9Sstevel@tonic-gate return (rc);
8637c478bd9Sstevel@tonic-gate }
8647c478bd9Sstevel@tonic-gate
8657c478bd9Sstevel@tonic-gate /* add next action name */
8667c478bd9Sstevel@tonic-gate if ((rc = nvlist_add_string(nvlp, TOKENMT_GREEN_ACTION_NAME,
8677c478bd9Sstevel@tonic-gate next_action)) != 0) {
8687c478bd9Sstevel@tonic-gate nvlist_free(nvlp);
8697c478bd9Sstevel@tonic-gate tokenmt0dbg(("tokenmt_info: error adding green_action\n"));
8707c478bd9Sstevel@tonic-gate kmem_free(next_action, (strlen(next_action) + 1));
8717c478bd9Sstevel@tonic-gate return (rc);
8727c478bd9Sstevel@tonic-gate }
8737c478bd9Sstevel@tonic-gate
8747c478bd9Sstevel@tonic-gate /* free action name */
8757c478bd9Sstevel@tonic-gate kmem_free(next_action, (strlen(next_action) + 1));
8767c478bd9Sstevel@tonic-gate
8777c478bd9Sstevel@tonic-gate /* add config type */
8787c478bd9Sstevel@tonic-gate if ((rc = nvlist_add_byte(nvlp, IPP_CONFIG_TYPE, IPP_SET)) != 0) {
8797c478bd9Sstevel@tonic-gate tokenmt0dbg(("tokenmt_info: error adding config_type\n"));
8807c478bd9Sstevel@tonic-gate nvlist_free(nvlp);
8817c478bd9Sstevel@tonic-gate return (rc);
8827c478bd9Sstevel@tonic-gate }
8837c478bd9Sstevel@tonic-gate
8847c478bd9Sstevel@tonic-gate /* add committed_rate */
8857c478bd9Sstevel@tonic-gate if ((rc = nvlist_add_uint32(nvlp, TOKENMT_COMMITTED_RATE,
8867c478bd9Sstevel@tonic-gate cfg_parms->committed_rate)) != 0) {
8877c478bd9Sstevel@tonic-gate tokenmt0dbg(("tokenmt_info: error adding committed_rate\n"));
8887c478bd9Sstevel@tonic-gate nvlist_free(nvlp);
8897c478bd9Sstevel@tonic-gate return (rc);
8907c478bd9Sstevel@tonic-gate }
8917c478bd9Sstevel@tonic-gate
8927c478bd9Sstevel@tonic-gate if (cfg_parms->tokenmt_type == TRTCL_TOKENMT) {
8937c478bd9Sstevel@tonic-gate /* add peak rate */
8947c478bd9Sstevel@tonic-gate if ((rc = nvlist_add_uint32(nvlp, TOKENMT_PEAK_RATE,
8957c478bd9Sstevel@tonic-gate cfg_parms->peak_rate)) != 0) {
8967c478bd9Sstevel@tonic-gate tokenmt0dbg(("tokenmt_info: error adding peak_rate\n"));
8977c478bd9Sstevel@tonic-gate nvlist_free(nvlp);
8987c478bd9Sstevel@tonic-gate return (rc);
8997c478bd9Sstevel@tonic-gate }
9007c478bd9Sstevel@tonic-gate }
9017c478bd9Sstevel@tonic-gate
9027c478bd9Sstevel@tonic-gate /* add committed_burst */
9037c478bd9Sstevel@tonic-gate if ((rc = nvlist_add_uint32(nvlp, TOKENMT_COMMITTED_BURST,
9047c478bd9Sstevel@tonic-gate cfg_parms->committed_burst)) != 0) {
9057c478bd9Sstevel@tonic-gate tokenmt0dbg(("tokenmt_info: error adding committed_burst\n"));
9067c478bd9Sstevel@tonic-gate nvlist_free(nvlp);
9077c478bd9Sstevel@tonic-gate return (rc);
9087c478bd9Sstevel@tonic-gate }
9097c478bd9Sstevel@tonic-gate
9107c478bd9Sstevel@tonic-gate /* add peak_burst */
9117c478bd9Sstevel@tonic-gate if (cfg_parms->peak_burst != 0) {
9127c478bd9Sstevel@tonic-gate if ((rc = nvlist_add_uint32(nvlp, TOKENMT_PEAK_BURST,
9137c478bd9Sstevel@tonic-gate cfg_parms->peak_burst)) != 0) {
9147c478bd9Sstevel@tonic-gate tokenmt0dbg(("tokenmt_info: error adding peak "\
9157c478bd9Sstevel@tonic-gate "burst\n"));
9167c478bd9Sstevel@tonic-gate nvlist_free(nvlp);
9177c478bd9Sstevel@tonic-gate return (rc);
9187c478bd9Sstevel@tonic-gate }
9197c478bd9Sstevel@tonic-gate }
9207c478bd9Sstevel@tonic-gate
9217c478bd9Sstevel@tonic-gate /* add colour aware */
9227c478bd9Sstevel@tonic-gate if ((rc = nvlist_add_uint32(nvlp, TOKENMT_COLOUR_AWARE,
9237c478bd9Sstevel@tonic-gate cfg_parms->colour_aware)) != 0) {
9247c478bd9Sstevel@tonic-gate tokenmt0dbg(("tokenmt_info: error adding mode\n"));
9257c478bd9Sstevel@tonic-gate nvlist_free(nvlp);
9267c478bd9Sstevel@tonic-gate return (rc);
9277c478bd9Sstevel@tonic-gate }
9287c478bd9Sstevel@tonic-gate
9297c478bd9Sstevel@tonic-gate if (cfg_parms->colour_aware) {
9307c478bd9Sstevel@tonic-gate bcopy(cfg_parms->dscp_to_colour, dscp_to_colour,
9317c478bd9Sstevel@tonic-gate sizeof (cfg_parms->dscp_to_colour));
9327c478bd9Sstevel@tonic-gate if ((rc = nvlist_add_int32_array(nvlp, TOKENMT_COLOUR_MAP,
9337c478bd9Sstevel@tonic-gate dscp_to_colour, 64)) != 0) {
9347c478bd9Sstevel@tonic-gate tokenmt0dbg(("tokenmt_info: error adding colour "\
9357c478bd9Sstevel@tonic-gate "array\n"));
9367c478bd9Sstevel@tonic-gate nvlist_free(nvlp);
9377c478bd9Sstevel@tonic-gate return (rc);
9387c478bd9Sstevel@tonic-gate }
9397c478bd9Sstevel@tonic-gate }
9407c478bd9Sstevel@tonic-gate
9417c478bd9Sstevel@tonic-gate if ((rc = nvlist_add_uint32(nvlp, IPP_ACTION_STATS_ENABLE,
9427c478bd9Sstevel@tonic-gate (uint32_t)cfg_parms->stats)) != 0) {
9437c478bd9Sstevel@tonic-gate tokenmt0dbg(("tokenmt_info: error adding stats status\n"));
9447c478bd9Sstevel@tonic-gate nvlist_free(nvlp);
9457c478bd9Sstevel@tonic-gate return (rc);
9467c478bd9Sstevel@tonic-gate }
9477c478bd9Sstevel@tonic-gate
9487c478bd9Sstevel@tonic-gate /* call back with nvlist */
9497c478bd9Sstevel@tonic-gate rc = fn(nvlp, arg);
9507c478bd9Sstevel@tonic-gate
9517c478bd9Sstevel@tonic-gate nvlist_free(nvlp);
9527c478bd9Sstevel@tonic-gate return (rc);
9537c478bd9Sstevel@tonic-gate }
954