1/*
2 * CDDL HEADER START
3 *
4 * The contents of this file are subject to the terms of the
5 * Common Development and Distribution License (the "License").
6 * You may not use this file except in compliance with the License.
7 *
8 * You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE
9 * or http://www.opensolaris.org/os/licensing.
10 * See the License for the specific language governing permissions
11 * and limitations under the License.
12 *
13 * When distributing Covered Code, include this CDDL HEADER in each
14 * file and include the License file at usr/src/OPENSOLARIS.LICENSE.
15 * If applicable, add the following below this CDDL HEADER, with the
16 * fields enclosed by brackets "[]" replaced with your own identifying
17 * information: Portions Copyright [yyyy] [name of copyright owner]
18 *
19 * CDDL HEADER END
20 */
21/*
22 * Copyright 2009 Sun Microsystems, Inc.  All rights reserved.
23 * Use is subject to license terms.
24 */
25
26#include <sys/types.h>
27#include <sys/stream.h>
28#include <sys/dlpi.h>
29#include <sys/strsun.h>
30#include <netinet/in.h>
31#include <netinet/ip6.h>
32#include <inet/common.h>
33#include <inet/ip.h>
34#include <inet/ip6.h>
35#include <inet/ip_if.h>
36#include <ipp/dlcosmk/dlcosmk_impl.h>
37
38/* Module to mark the 802.1d user priority field for a given packet */
39
40/* Debug level */
41int dlcosmk_debug = 0;
42
43/*
44 * Given a packet, this module marks the mblk with the appropriate b_band or
45 * dl_max value so that the VLAN driver marks the outgoing frame with the
46 * configured 802.1D user_priority value. For non-VLAN devices or for inbound
47 * packets, this module does not do anything (i.e. the packet is processed by
48 * the next action in the list, if present).
49 * This module does not free any mblks or packets in case or errors.
50 */
51
52int
53dlcosmk_process(mblk_t **mpp, dlcosmk_data_t *dlcosmk_data, uint32_t ill_index,
54    ip_proc_t proc)
55{
56	ill_t *ill = NULL;
57	mblk_t *mp;
58
59	ASSERT((mpp != NULL) && (*mpp != NULL));
60	mp = *mpp;
61
62	/*
63	 * The action module will receive an M_DATA or an M_CTL followed
64	 * by an M_DATA. In the latter case skip the M_CTL.
65	 */
66	if (mp->b_datap->db_type != M_DATA) {
67		if ((mp->b_cont == NULL) ||
68		    (mp->b_cont->b_datap->db_type != M_DATA)) {
69			atomic_add_64(&dlcosmk_data->epackets, 1);
70			dlcosmk0dbg(("dlcosmk_process: no data\n"));
71			return (EINVAL);
72		}
73	}
74
75	/* Update global stats */
76	atomic_add_64(&dlcosmk_data->npackets, 1);
77
78	/*
79	 * This should only be called for outgoing packets. For inbound, just
80	 * send it along.
81	 */
82	if ((proc == IPP_LOCAL_IN) || (proc == IPP_FWD_IN)) {
83		dlcosmk2dbg(("dlcosmk_process:cannot mark incoming packets\n"));
84		atomic_add_64(&dlcosmk_data->ipackets, 1);
85		return (0);
86	}
87
88	if ((ill_index == 0) ||
89	    ((ill = ill_lookup_on_ifindex_global_instance(ill_index,
90	    B_FALSE)) == NULL)) {
91		dlcosmk2dbg(("dlcosmk_process:invalid ill index %u\n",
92		    ill_index));
93		atomic_add_64(&dlcosmk_data->ipackets, 1);
94		return (0);
95	}
96
97	/*
98	 * Check if the interface supports CoS marking. If not send it to the
99	 * next action in the chain
100	 */
101	if (!(ill->ill_flags & ILLF_COS_ENABLED)) {
102		dlcosmk2dbg(("dlcosmk_process:ill %u does not support CoS\n",
103		    ill_index));
104		atomic_add_64(&dlcosmk_data->ipackets, 1);
105		ill_refrele(ill);
106		return (0);
107	}
108	ill_refrele(ill);
109
110
111	/*
112	 * Mark the b_band for fastpath messages or dl_priority.dl_max for
113	 * DL_UNITDATA_REQ messages. For, others just pass it along.
114	 */
115	switch (DB_TYPE(mp)) {
116		case M_PROTO:
117		case M_PCPROTO:
118			{ 	/* DL_UNITDATA */
119				dl_unitdata_req_t *dlur;
120				dlur = (dl_unitdata_req_t *)mp->b_rptr;
121
122				/* DL_UNITDATA message?? */
123				if (dlur->dl_primitive == DL_UNITDATA_REQ) {
124					dlur->dl_priority.dl_max =
125					    dlcosmk_data->dl_max;
126				} else {
127					atomic_add_64(&dlcosmk_data->ipackets,
128					    1);
129				}
130				break;
131			}
132		case M_DATA:
133			/* fastpath message */
134			mp->b_band = dlcosmk_data->b_band;
135			break;
136		default:
137			atomic_add_64(&dlcosmk_data->ipackets, 1);
138			break;
139	}
140
141	return (0);
142}
143