1d62bc4baSyz /*
2d62bc4baSyz * CDDL HEADER START
3d62bc4baSyz *
4d62bc4baSyz * The contents of this file are subject to the terms of the
5d62bc4baSyz * Common Development and Distribution License (the "License").
6d62bc4baSyz * You may not use this file except in compliance with the License.
7d62bc4baSyz *
8d62bc4baSyz * You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE
9d62bc4baSyz * or http://www.opensolaris.org/os/licensing.
10d62bc4baSyz * See the License for the specific language governing permissions
11d62bc4baSyz * and limitations under the License.
12d62bc4baSyz *
13d62bc4baSyz * When distributing Covered Code, include this CDDL HEADER in each
14d62bc4baSyz * file and include the License file at usr/src/OPENSOLARIS.LICENSE.
15d62bc4baSyz * If applicable, add the following below this CDDL HEADER, with the
16d62bc4baSyz * fields enclosed by brackets "[]" replaced with your own identifying
17d62bc4baSyz * information: Portions Copyright [yyyy] [name of copyright owner]
18d62bc4baSyz *
19d62bc4baSyz * CDDL HEADER END
20d62bc4baSyz */
21d62bc4baSyz /*
22d62bc4baSyz * Copyright 2008 Sun Microsystems, Inc. All rights reserved.
23d62bc4baSyz * Use is subject to license terms.
24*9b664393SGarrett D'Amore *
25*9b664393SGarrett D'Amore * Copyright 2022 Garrett D'Amore
26d62bc4baSyz */
27d62bc4baSyz
28d62bc4baSyz #include <sys/types.h>
29d62bc4baSyz #include <sys/mac.h>
30d62bc4baSyz #include <sys/softmac_impl.h>
31d62bc4baSyz
32d62bc4baSyz typedef struct softmac_capab_ops {
33d62bc4baSyz int (*sc_hcksum_ack)(void *, t_uscalar_t);
34d62bc4baSyz int (*sc_zcopy_ack)(void *, t_uscalar_t);
35d62bc4baSyz } softmac_capab_ops_t;
36d62bc4baSyz
37d62bc4baSyz static int dl_capab(ldi_handle_t, mblk_t **);
38d62bc4baSyz static int softmac_fill_hcksum_ack(void *, t_uscalar_t);
39d62bc4baSyz static int softmac_fill_zcopy_ack(void *, t_uscalar_t);
40d62bc4baSyz static int softmac_adv_hcksum_ack(void *, t_uscalar_t);
41d62bc4baSyz static int softmac_adv_zcopy_ack(void *, t_uscalar_t);
42d62bc4baSyz static int softmac_enable_hcksum_ack(void *, t_uscalar_t);
43d62bc4baSyz static int softmac_capab_send(softmac_lower_t *, boolean_t);
44d62bc4baSyz static int i_capab_ack(mblk_t *, queue_t *, softmac_capab_ops_t *, void *);
45d62bc4baSyz static int i_capab_id_ack(mblk_t *, dl_capability_sub_t *, queue_t *,
46d62bc4baSyz softmac_capab_ops_t *, void *);
47d62bc4baSyz static int i_capab_sub_ack(mblk_t *, dl_capability_sub_t *, queue_t *,
48d62bc4baSyz softmac_capab_ops_t *, void *);
49d62bc4baSyz static int i_capab_hcksum_ack(dl_capab_hcksum_t *, queue_t *,
50d62bc4baSyz softmac_capab_ops_t *, void *);
51d62bc4baSyz static int i_capab_zcopy_ack(dl_capab_zerocopy_t *, queue_t *,
52d62bc4baSyz softmac_capab_ops_t *, void *);
53d62bc4baSyz static int i_capab_hcksum_verify(dl_capab_hcksum_t *, queue_t *);
54d62bc4baSyz static int i_capab_zcopy_verify(dl_capab_zerocopy_t *, queue_t *);
55d62bc4baSyz
56d62bc4baSyz static softmac_capab_ops_t softmac_fill_capab_ops =
57d62bc4baSyz {
58d62bc4baSyz softmac_fill_hcksum_ack,
59d62bc4baSyz softmac_fill_zcopy_ack,
60d62bc4baSyz };
61d62bc4baSyz
62d62bc4baSyz static softmac_capab_ops_t softmac_adv_capab_ops =
63d62bc4baSyz {
64d62bc4baSyz softmac_adv_hcksum_ack,
65d62bc4baSyz softmac_adv_zcopy_ack,
66d62bc4baSyz };
67d62bc4baSyz
68d62bc4baSyz static softmac_capab_ops_t softmac_enable_capab_ops =
69d62bc4baSyz {
70d62bc4baSyz softmac_enable_hcksum_ack,
71d62bc4baSyz NULL,
72d62bc4baSyz };
73d62bc4baSyz
74d62bc4baSyz int
softmac_fill_capab(ldi_handle_t lh,softmac_t * softmac)75d62bc4baSyz softmac_fill_capab(ldi_handle_t lh, softmac_t *softmac)
76d62bc4baSyz {
77d62bc4baSyz mblk_t *mp = NULL;
78d62bc4baSyz union DL_primitives *prim;
79d62bc4baSyz int err = 0;
80d62bc4baSyz
81d62bc4baSyz if ((err = dl_capab(lh, &mp)) != 0)
82d62bc4baSyz goto exit;
83d62bc4baSyz
84d62bc4baSyz prim = (union DL_primitives *)mp->b_rptr;
85d62bc4baSyz if (prim->dl_primitive == DL_ERROR_ACK) {
86d62bc4baSyz err = -1;
87d62bc4baSyz goto exit;
88d62bc4baSyz }
89d62bc4baSyz
90d62bc4baSyz err = i_capab_ack(mp, NULL, &softmac_fill_capab_ops, softmac);
91d62bc4baSyz
92d62bc4baSyz exit:
93d62bc4baSyz freemsg(mp);
94d62bc4baSyz return (err);
95d62bc4baSyz }
96d62bc4baSyz
97d62bc4baSyz static int
dl_capab(ldi_handle_t lh,mblk_t ** mpp)98d62bc4baSyz dl_capab(ldi_handle_t lh, mblk_t **mpp)
99d62bc4baSyz {
100d62bc4baSyz dl_capability_req_t *capb;
101d62bc4baSyz union DL_primitives *dl_prim;
102d62bc4baSyz mblk_t *mp;
103d62bc4baSyz int err;
104d62bc4baSyz
105d62bc4baSyz if ((mp = allocb(sizeof (dl_capability_req_t), BPRI_MED)) == NULL)
106d62bc4baSyz return (ENOMEM);
107d62bc4baSyz mp->b_datap->db_type = M_PROTO;
108d62bc4baSyz
109d62bc4baSyz capb = (dl_capability_req_t *)mp->b_wptr;
110d62bc4baSyz mp->b_wptr += sizeof (dl_capability_req_t);
111d62bc4baSyz bzero(mp->b_rptr, sizeof (dl_capability_req_t));
112d62bc4baSyz capb->dl_primitive = DL_CAPABILITY_REQ;
113d62bc4baSyz
114d62bc4baSyz (void) ldi_putmsg(lh, mp);
115d62bc4baSyz if ((err = ldi_getmsg(lh, &mp, (timestruc_t *)NULL)) != 0)
116d62bc4baSyz return (err);
117d62bc4baSyz
118d62bc4baSyz dl_prim = (union DL_primitives *)mp->b_rptr;
119d62bc4baSyz switch (dl_prim->dl_primitive) {
120d62bc4baSyz case DL_CAPABILITY_ACK:
121d62bc4baSyz if (MBLKL(mp) < DL_CAPABILITY_ACK_SIZE) {
122d62bc4baSyz printf("dl_capability: DL_CAPABILITY_ACK "
123d62bc4baSyz "protocol err\n");
124d62bc4baSyz break;
125d62bc4baSyz }
126d62bc4baSyz *mpp = mp;
127d62bc4baSyz return (0);
128d62bc4baSyz
129d62bc4baSyz case DL_ERROR_ACK:
130d62bc4baSyz if (MBLKL(mp) < DL_ERROR_ACK_SIZE) {
131d62bc4baSyz printf("dl_capability: DL_ERROR_ACK protocol err\n");
132d62bc4baSyz break;
133d62bc4baSyz }
134d62bc4baSyz if (((dl_error_ack_t *)dl_prim)->dl_error_primitive !=
135d62bc4baSyz DL_CAPABILITY_REQ) {
136d62bc4baSyz printf("dl_capability: DL_ERROR_ACK rtnd prim %u\n",
137d62bc4baSyz ((dl_error_ack_t *)dl_prim)->dl_error_primitive);
138d62bc4baSyz break;
139d62bc4baSyz }
140d62bc4baSyz
141d62bc4baSyz *mpp = mp;
142d62bc4baSyz return (0);
143d62bc4baSyz
144d62bc4baSyz default:
145d62bc4baSyz printf("dl_capability: bad ACK header %u\n",
146d62bc4baSyz dl_prim->dl_primitive);
147d62bc4baSyz break;
148d62bc4baSyz }
149d62bc4baSyz
150d62bc4baSyz freemsg(mp);
151d62bc4baSyz return (-1);
152d62bc4baSyz }
153d62bc4baSyz
154d62bc4baSyz static int
softmac_fill_hcksum_ack(void * arg,t_uscalar_t flags)155d62bc4baSyz softmac_fill_hcksum_ack(void *arg, t_uscalar_t flags)
156d62bc4baSyz {
157d62bc4baSyz softmac_t *softmac = (softmac_t *)arg;
158d62bc4baSyz
159d62bc4baSyz /*
160d62bc4baSyz * There are two types of acks we process here:
161d62bc4baSyz * 1. acks in reply to a (first form) generic capability req
162d62bc4baSyz * (no ENABLE flag set)
163d62bc4baSyz * 2. acks in reply to a ENABLE capability req.
164d62bc4baSyz * (ENABLE flag set)
165d62bc4baSyz * Only the first type should be expected here.
166d62bc4baSyz */
167d62bc4baSyz
168d62bc4baSyz if (flags & HCKSUM_ENABLE) {
169d62bc4baSyz cmn_err(CE_WARN, "softmac_fill_hcksum_ack: unexpected "
170d62bc4baSyz "HCKSUM_ENABLE flag in hardware checksum capability");
171d62bc4baSyz } else if (flags & (HCKSUM_INET_PARTIAL | HCKSUM_INET_FULL_V4 |
172d62bc4baSyz HCKSUM_INET_FULL_V6 | HCKSUM_IPHDRCKSUM)) {
173d62bc4baSyz softmac->smac_capab_flags |= MAC_CAPAB_HCKSUM;
174d62bc4baSyz softmac->smac_hcksum_txflags = flags;
175d62bc4baSyz }
176d62bc4baSyz return (0);
177d62bc4baSyz }
178d62bc4baSyz
179d62bc4baSyz static int
softmac_fill_zcopy_ack(void * arg,t_uscalar_t flags)180d62bc4baSyz softmac_fill_zcopy_ack(void *arg, t_uscalar_t flags)
181d62bc4baSyz {
182d62bc4baSyz softmac_t *softmac = (softmac_t *)arg;
183d62bc4baSyz
184d62bc4baSyz ASSERT(flags == DL_CAPAB_VMSAFE_MEM);
185d62bc4baSyz softmac->smac_capab_flags &= (~MAC_CAPAB_NO_ZCOPY);
186d62bc4baSyz return (0);
187d62bc4baSyz }
188d62bc4baSyz
189d62bc4baSyz int
softmac_capab_enable(softmac_lower_t * slp)190d62bc4baSyz softmac_capab_enable(softmac_lower_t *slp)
191d62bc4baSyz {
192d62bc4baSyz softmac_t *softmac = slp->sl_softmac;
193d62bc4baSyz int err;
194d62bc4baSyz
195d62bc4baSyz if (softmac->smac_no_capability_req)
196d62bc4baSyz return (0);
197d62bc4baSyz
198d62bc4baSyz /*
199d62bc4baSyz * Send DL_CAPABILITY_REQ to get capability advertisement.
200d62bc4baSyz */
201d62bc4baSyz if ((err = softmac_capab_send(slp, B_FALSE)) != 0)
202d62bc4baSyz return (err);
203d62bc4baSyz
204d62bc4baSyz /*
205d62bc4baSyz * Send DL_CAPABILITY_REQ to enable specific capabilities.
206d62bc4baSyz */
207d62bc4baSyz if ((err = softmac_capab_send(slp, B_TRUE)) != 0)
208d62bc4baSyz return (err);
209d62bc4baSyz
210d62bc4baSyz return (0);
211d62bc4baSyz }
212d62bc4baSyz
213d62bc4baSyz static int
softmac_capab_send(softmac_lower_t * slp,boolean_t enable)214d62bc4baSyz softmac_capab_send(softmac_lower_t *slp, boolean_t enable)
215d62bc4baSyz {
216d62bc4baSyz softmac_t *softmac;
217d62bc4baSyz dl_capability_req_t *capb;
218d62bc4baSyz dl_capability_sub_t *subcapb;
219d62bc4baSyz mblk_t *reqmp, *ackmp;
220d62bc4baSyz int err;
221d62bc4baSyz size_t size = 0;
222d62bc4baSyz
223d62bc4baSyz softmac = slp->sl_softmac;
224d62bc4baSyz
225d62bc4baSyz if (enable) {
226d62bc4baSyz /* No need to enable DL_CAPAB_ZEROCOPY */
227d62bc4baSyz if (softmac->smac_capab_flags & MAC_CAPAB_HCKSUM)
228d62bc4baSyz size += sizeof (dl_capability_sub_t) +
229d62bc4baSyz sizeof (dl_capab_hcksum_t);
230d62bc4baSyz
231d62bc4baSyz if (size == 0)
232d62bc4baSyz return (0);
233d62bc4baSyz }
234d62bc4baSyz
235d62bc4baSyz /*
236d62bc4baSyz * Create DL_CAPABILITY_REQ message and send it down
237d62bc4baSyz */
238d62bc4baSyz reqmp = allocb(sizeof (dl_capability_req_t) + size, BPRI_MED);
239d62bc4baSyz if (reqmp == NULL)
240d62bc4baSyz return (ENOMEM);
241d62bc4baSyz
242d62bc4baSyz bzero(reqmp->b_rptr, sizeof (dl_capability_req_t) + size);
243d62bc4baSyz
244d62bc4baSyz DB_TYPE(reqmp) = M_PROTO;
245d62bc4baSyz reqmp->b_wptr = reqmp->b_rptr + sizeof (dl_capability_req_t) + size;
246d62bc4baSyz
247d62bc4baSyz capb = (dl_capability_req_t *)reqmp->b_rptr;
248d62bc4baSyz capb->dl_primitive = DL_CAPABILITY_REQ;
249d62bc4baSyz
250d62bc4baSyz if (!enable)
251d62bc4baSyz goto output;
252d62bc4baSyz
253d62bc4baSyz capb->dl_sub_offset = sizeof (dl_capability_req_t);
254d62bc4baSyz
255d62bc4baSyz if (softmac->smac_capab_flags & MAC_CAPAB_HCKSUM) {
256d62bc4baSyz dl_capab_hcksum_t *hck_subcapp;
257d62bc4baSyz
258d62bc4baSyz size = sizeof (dl_capability_sub_t) +
259d62bc4baSyz sizeof (dl_capab_hcksum_t);
260d62bc4baSyz capb->dl_sub_length += size;
261d62bc4baSyz
262d62bc4baSyz subcapb = (dl_capability_sub_t *)(capb + 1);
263d62bc4baSyz subcapb->dl_cap = DL_CAPAB_HCKSUM;
264d62bc4baSyz subcapb->dl_length = sizeof (dl_capab_hcksum_t);
265d62bc4baSyz hck_subcapp = (dl_capab_hcksum_t *)(subcapb + 1);
266d62bc4baSyz hck_subcapp->hcksum_version = HCKSUM_VERSION_1;
267d62bc4baSyz hck_subcapp->hcksum_txflags =
268d62bc4baSyz softmac->smac_hcksum_txflags | HCKSUM_ENABLE;
269d62bc4baSyz }
270d62bc4baSyz
271d62bc4baSyz output:
272d62bc4baSyz err = softmac_proto_tx(slp, reqmp, &ackmp);
273d62bc4baSyz if (err == 0) {
274d62bc4baSyz if (enable) {
275d62bc4baSyz err = i_capab_ack(ackmp, NULL,
276d62bc4baSyz &softmac_enable_capab_ops, softmac);
277d62bc4baSyz } else {
278d62bc4baSyz err = i_capab_ack(ackmp, NULL,
279d62bc4baSyz &softmac_adv_capab_ops, softmac);
280d62bc4baSyz }
281d62bc4baSyz }
282d62bc4baSyz freemsg(ackmp);
283d62bc4baSyz
284d62bc4baSyz return (err);
285d62bc4baSyz }
286d62bc4baSyz
287d62bc4baSyz static int
softmac_adv_hcksum_ack(void * arg,t_uscalar_t flags)288d62bc4baSyz softmac_adv_hcksum_ack(void *arg, t_uscalar_t flags)
289d62bc4baSyz {
290d62bc4baSyz softmac_t *softmac = (softmac_t *)arg;
291d62bc4baSyz
292d62bc4baSyz /*
293d62bc4baSyz * There are two types of acks we process here:
294d62bc4baSyz * 1. acks in reply to a (first form) generic capability req
295d62bc4baSyz * (no ENABLE flag set)
296d62bc4baSyz * 2. acks in reply to a ENABLE capability req.
297d62bc4baSyz * (ENABLE flag set)
298d62bc4baSyz * Only the first type should be expected here.
299d62bc4baSyz */
300d62bc4baSyz
301d62bc4baSyz if (flags & HCKSUM_ENABLE) {
302d62bc4baSyz cmn_err(CE_WARN, "softmac_adv_hcksum_ack: unexpected "
303d62bc4baSyz "HCKSUM_ENABLE flag in hardware checksum capability");
304d62bc4baSyz return (-1);
305d62bc4baSyz } else if (flags & (HCKSUM_INET_PARTIAL | HCKSUM_INET_FULL_V4 |
306d62bc4baSyz HCKSUM_INET_FULL_V6 | HCKSUM_IPHDRCKSUM)) {
307d62bc4baSyz /*
308d62bc4baSyz * The acknowledgement should be the same as we got when
309d62bc4baSyz * the softmac is created.
310d62bc4baSyz */
311d62bc4baSyz if (!(softmac->smac_capab_flags & MAC_CAPAB_HCKSUM)) {
312d62bc4baSyz ASSERT(B_FALSE);
313d62bc4baSyz return (-1);
314d62bc4baSyz }
315d62bc4baSyz if (softmac->smac_hcksum_txflags != flags) {
316d62bc4baSyz ASSERT(B_FALSE);
317d62bc4baSyz return (-1);
318d62bc4baSyz }
319d62bc4baSyz }
320d62bc4baSyz
321d62bc4baSyz return (0);
322d62bc4baSyz }
323d62bc4baSyz
324d62bc4baSyz static int
softmac_adv_zcopy_ack(void * arg,t_uscalar_t flags)325d62bc4baSyz softmac_adv_zcopy_ack(void *arg, t_uscalar_t flags)
326d62bc4baSyz {
327d62bc4baSyz softmac_t *softmac = (softmac_t *)arg;
328d62bc4baSyz
329d62bc4baSyz /*
330d62bc4baSyz * The acknowledgement should be the same as we got when
331d62bc4baSyz * the softmac is created.
332d62bc4baSyz */
333d62bc4baSyz ASSERT(flags == DL_CAPAB_VMSAFE_MEM);
334d62bc4baSyz if (softmac->smac_capab_flags & MAC_CAPAB_NO_ZCOPY) {
335d62bc4baSyz ASSERT(B_FALSE);
336d62bc4baSyz return (-1);
337d62bc4baSyz }
338d62bc4baSyz
339d62bc4baSyz return (0);
340d62bc4baSyz }
341d62bc4baSyz
342d62bc4baSyz static int
softmac_enable_hcksum_ack(void * arg,t_uscalar_t flags)343d62bc4baSyz softmac_enable_hcksum_ack(void *arg, t_uscalar_t flags)
344d62bc4baSyz {
345d62bc4baSyz softmac_t *softmac = (softmac_t *)arg;
346d62bc4baSyz
347d62bc4baSyz /*
348d62bc4baSyz * There are two types of acks we process here:
349d62bc4baSyz * 1. acks in reply to a (first form) generic capability req
350d62bc4baSyz * (no ENABLE flag set)
351d62bc4baSyz * 2. acks in reply to a ENABLE capability req.
352d62bc4baSyz * (ENABLE flag set)
353d62bc4baSyz * Only the second type should be expected here.
354d62bc4baSyz */
355d62bc4baSyz
356d62bc4baSyz if (flags & HCKSUM_ENABLE) {
357d62bc4baSyz if ((flags & ~HCKSUM_ENABLE) != softmac->smac_hcksum_txflags) {
358d62bc4baSyz cmn_err(CE_WARN, "softmac_enable_hcksum_ack: unexpected"
359d62bc4baSyz " hardware capability flag value 0x%x", flags);
360d62bc4baSyz return (-1);
361d62bc4baSyz }
362d62bc4baSyz } else {
363d62bc4baSyz cmn_err(CE_WARN, "softmac_enable_hcksum_ack: "
364d62bc4baSyz "hardware checksum flag HCKSUM_ENABLE is not set");
365d62bc4baSyz return (-1);
366d62bc4baSyz }
367d62bc4baSyz
368d62bc4baSyz return (0);
369d62bc4baSyz }
370d62bc4baSyz
371d62bc4baSyz static int
i_capab_ack(mblk_t * mp,queue_t * q,softmac_capab_ops_t * op,void * arg)372d62bc4baSyz i_capab_ack(mblk_t *mp, queue_t *q, softmac_capab_ops_t *op, void *arg)
373d62bc4baSyz {
374d62bc4baSyz union DL_primitives *prim;
375d62bc4baSyz dl_capability_ack_t *cap;
376d62bc4baSyz dl_capability_sub_t *sub, *end;
377d62bc4baSyz int err = 0;
378d62bc4baSyz
379d62bc4baSyz prim = (union DL_primitives *)mp->b_rptr;
380d62bc4baSyz ASSERT(prim->dl_primitive == DL_CAPABILITY_ACK);
381d62bc4baSyz
382d62bc4baSyz cap = (dl_capability_ack_t *)prim;
383d62bc4baSyz if (cap->dl_sub_length == 0)
384d62bc4baSyz goto exit;
385d62bc4baSyz
386d62bc4baSyz /* Is dl_sub_length correct? */
387d62bc4baSyz if ((sizeof (*cap) + cap->dl_sub_length) > MBLKL(mp)) {
388d62bc4baSyz err = EINVAL;
389d62bc4baSyz goto exit;
390d62bc4baSyz }
391d62bc4baSyz
392d62bc4baSyz sub = (dl_capability_sub_t *)((caddr_t)cap + cap->dl_sub_offset);
393d62bc4baSyz end = (dl_capability_sub_t *)((caddr_t)cap + cap->dl_sub_length
394d62bc4baSyz - sizeof (*sub));
395d62bc4baSyz for (; (sub <= end) && (err == 0); ) {
396d62bc4baSyz switch (sub->dl_cap) {
397d62bc4baSyz case DL_CAPAB_ID_WRAPPER:
398d62bc4baSyz err = i_capab_id_ack(mp, sub, q, op, arg);
399d62bc4baSyz break;
400d62bc4baSyz default:
401d62bc4baSyz err = i_capab_sub_ack(mp, sub, q, op, arg);
402d62bc4baSyz break;
403d62bc4baSyz }
404d62bc4baSyz sub = (dl_capability_sub_t *)((caddr_t)sub + sizeof (*sub)
405d62bc4baSyz + sub->dl_length);
406d62bc4baSyz }
407d62bc4baSyz
408d62bc4baSyz exit:
409d62bc4baSyz return (err);
410d62bc4baSyz }
411d62bc4baSyz
412d62bc4baSyz static int
i_capab_id_ack(mblk_t * mp,dl_capability_sub_t * outers,queue_t * q,softmac_capab_ops_t * op,void * arg)413d62bc4baSyz i_capab_id_ack(mblk_t *mp, dl_capability_sub_t *outers,
414d62bc4baSyz queue_t *q, softmac_capab_ops_t *op, void *arg)
415d62bc4baSyz {
416d62bc4baSyz dl_capab_id_t *capab_id;
417d62bc4baSyz dl_capability_sub_t *inners;
418d62bc4baSyz caddr_t capend;
419d62bc4baSyz int err = EINVAL;
420d62bc4baSyz
421d62bc4baSyz ASSERT(outers->dl_cap == DL_CAPAB_ID_WRAPPER);
422d62bc4baSyz
423d62bc4baSyz capend = (caddr_t)(outers + 1) + outers->dl_length;
424d62bc4baSyz if (capend > (caddr_t)mp->b_wptr) {
425d62bc4baSyz cmn_err(CE_WARN, "i_capab_id_ack: malformed "
426d62bc4baSyz "sub-capability too long");
427d62bc4baSyz return (err);
428d62bc4baSyz }
429d62bc4baSyz
430d62bc4baSyz capab_id = (dl_capab_id_t *)(outers + 1);
431d62bc4baSyz
432d62bc4baSyz if (outers->dl_length < sizeof (*capab_id) ||
433d62bc4baSyz (inners = &capab_id->id_subcap,
434d62bc4baSyz inners->dl_length > (outers->dl_length - sizeof (*inners)))) {
435d62bc4baSyz cmn_err(CE_WARN, "i_capab_id_ack: malformed "
436d62bc4baSyz "encapsulated capab type %d too long",
437d62bc4baSyz inners->dl_cap);
438d62bc4baSyz return (err);
439d62bc4baSyz }
440d62bc4baSyz
441d62bc4baSyz if ((q != NULL) && (!dlcapabcheckqid(&capab_id->id_mid, q))) {
442d62bc4baSyz cmn_err(CE_WARN, "i_capab_id_ack: pass-thru module(s) "
443d62bc4baSyz "detected, discarding capab type %d", inners->dl_cap);
444d62bc4baSyz return (err);
445d62bc4baSyz }
446d62bc4baSyz
447d62bc4baSyz /* Process the encapsulated sub-capability */
448d62bc4baSyz return (i_capab_sub_ack(mp, inners, q, op, arg));
449d62bc4baSyz }
450d62bc4baSyz
451d62bc4baSyz static int
i_capab_sub_ack(mblk_t * mp,dl_capability_sub_t * sub,queue_t * q,softmac_capab_ops_t * op,void * arg)452d62bc4baSyz i_capab_sub_ack(mblk_t *mp, dl_capability_sub_t *sub, queue_t *q,
453d62bc4baSyz softmac_capab_ops_t *op, void *arg)
454d62bc4baSyz {
455d62bc4baSyz caddr_t capend;
456d62bc4baSyz dl_capab_hcksum_t *hcksum;
457d62bc4baSyz dl_capab_zerocopy_t *zcopy;
458d62bc4baSyz int err = 0;
459d62bc4baSyz
460d62bc4baSyz capend = (caddr_t)(sub + 1) + sub->dl_length;
461d62bc4baSyz if (capend > (caddr_t)mp->b_wptr) {
462d62bc4baSyz cmn_err(CE_WARN, "i_capab_sub_ack: "
463d62bc4baSyz "malformed sub-capability too long");
464d62bc4baSyz return (EINVAL);
465d62bc4baSyz }
466d62bc4baSyz
467d62bc4baSyz switch (sub->dl_cap) {
468d62bc4baSyz case DL_CAPAB_HCKSUM:
469d62bc4baSyz hcksum = (dl_capab_hcksum_t *)(sub + 1);
470d62bc4baSyz err = i_capab_hcksum_ack(hcksum, q, op, arg);
471d62bc4baSyz break;
472d62bc4baSyz
473d62bc4baSyz case DL_CAPAB_ZEROCOPY:
474d62bc4baSyz zcopy = (dl_capab_zerocopy_t *)(sub + 1);
475d62bc4baSyz err = i_capab_zcopy_ack(zcopy, q, op, arg);
476d62bc4baSyz break;
477d62bc4baSyz
478d62bc4baSyz default:
479d62bc4baSyz cmn_err(CE_WARN, "i_capab_sub_ack: unknown capab type %d",
480d62bc4baSyz sub->dl_cap);
481d62bc4baSyz err = EINVAL;
482d62bc4baSyz }
483d62bc4baSyz
484d62bc4baSyz return (err);
485d62bc4baSyz }
486d62bc4baSyz
487d62bc4baSyz static int
i_capab_hcksum_ack(dl_capab_hcksum_t * hcksum,queue_t * q,softmac_capab_ops_t * op,void * arg)488d62bc4baSyz i_capab_hcksum_ack(dl_capab_hcksum_t *hcksum, queue_t *q,
489d62bc4baSyz softmac_capab_ops_t *op, void *arg)
490d62bc4baSyz {
491d62bc4baSyz t_uscalar_t flags;
492d62bc4baSyz int err = 0;
493d62bc4baSyz
494d62bc4baSyz if ((err = i_capab_hcksum_verify(hcksum, q)) != 0)
495d62bc4baSyz return (err);
496d62bc4baSyz
497d62bc4baSyz flags = hcksum->hcksum_txflags;
498d62bc4baSyz
499d62bc4baSyz if (!(flags & (HCKSUM_INET_PARTIAL | HCKSUM_INET_FULL_V4 |
500d62bc4baSyz HCKSUM_INET_FULL_V6 | HCKSUM_IPHDRCKSUM | HCKSUM_ENABLE))) {
501d62bc4baSyz cmn_err(CE_WARN, "i_capab_hcksum_ack: invalid "
502d62bc4baSyz "hardware checksum capability flags 0x%x", flags);
503d62bc4baSyz return (EINVAL);
504d62bc4baSyz }
505d62bc4baSyz
506d62bc4baSyz if (op->sc_hcksum_ack)
507d62bc4baSyz return (op->sc_hcksum_ack(arg, flags));
508d62bc4baSyz else {
509d62bc4baSyz cmn_err(CE_WARN, "i_capab_hcksum_ack: unexpected hardware "
510d62bc4baSyz "checksum acknowledgement");
511d62bc4baSyz return (EINVAL);
512d62bc4baSyz }
513d62bc4baSyz }
514d62bc4baSyz
515d62bc4baSyz static int
i_capab_zcopy_ack(dl_capab_zerocopy_t * zcopy,queue_t * q,softmac_capab_ops_t * op,void * arg)516d62bc4baSyz i_capab_zcopy_ack(dl_capab_zerocopy_t *zcopy, queue_t *q,
517d62bc4baSyz softmac_capab_ops_t *op, void *arg)
518d62bc4baSyz {
519d62bc4baSyz t_uscalar_t flags;
520d62bc4baSyz int err = 0;
521d62bc4baSyz
522d62bc4baSyz if ((err = i_capab_zcopy_verify(zcopy, q)) != 0)
523d62bc4baSyz return (err);
524d62bc4baSyz
525d62bc4baSyz flags = zcopy->zerocopy_flags;
526d62bc4baSyz if (!(flags & DL_CAPAB_VMSAFE_MEM)) {
527d62bc4baSyz cmn_err(CE_WARN, "i_capab_zcopy_ack: invalid zcopy capability "
528d62bc4baSyz "flags 0x%x", flags);
529d62bc4baSyz return (EINVAL);
530d62bc4baSyz }
531d62bc4baSyz if (op->sc_zcopy_ack)
532d62bc4baSyz return (op->sc_zcopy_ack(arg, flags));
533d62bc4baSyz else {
534d62bc4baSyz cmn_err(CE_WARN, "i_capab_zcopy_ack: unexpected zcopy "
535d62bc4baSyz "acknowledgement");
536d62bc4baSyz return (EINVAL);
537d62bc4baSyz }
538d62bc4baSyz }
539d62bc4baSyz
540d62bc4baSyz static int
i_capab_hcksum_verify(dl_capab_hcksum_t * hcksum,queue_t * q)541d62bc4baSyz i_capab_hcksum_verify(dl_capab_hcksum_t *hcksum, queue_t *q)
542d62bc4baSyz {
543d62bc4baSyz if (hcksum->hcksum_version != HCKSUM_VERSION_1) {
544d62bc4baSyz cmn_err(CE_WARN, "i_capab_hcksum_verify: "
545d62bc4baSyz "unsupported hardware checksum capability (version %d, "
546d62bc4baSyz "expected %d)", hcksum->hcksum_version, HCKSUM_VERSION_1);
547d62bc4baSyz return (-1);
548d62bc4baSyz }
549d62bc4baSyz
550d62bc4baSyz if ((q != NULL) && !dlcapabcheckqid(&hcksum->hcksum_mid, q)) {
551d62bc4baSyz cmn_err(CE_WARN, "i_capab_hcksum_verify: unexpected pass-thru "
552d62bc4baSyz "module detected; hardware checksum capability discarded");
553d62bc4baSyz return (-1);
554d62bc4baSyz }
555d62bc4baSyz return (0);
556d62bc4baSyz }
557d62bc4baSyz
558d62bc4baSyz static int
i_capab_zcopy_verify(dl_capab_zerocopy_t * zcopy,queue_t * q)559d62bc4baSyz i_capab_zcopy_verify(dl_capab_zerocopy_t *zcopy, queue_t *q)
560d62bc4baSyz {
561d62bc4baSyz if (zcopy->zerocopy_version != ZEROCOPY_VERSION_1) {
562d62bc4baSyz cmn_err(CE_WARN, "i_capab_zcopy_verify: unsupported zcopy "
563d62bc4baSyz "capability (version %d, expected %d)",
564d62bc4baSyz zcopy->zerocopy_version, ZEROCOPY_VERSION_1);
565d62bc4baSyz return (-1);
566d62bc4baSyz }
567d62bc4baSyz
568d62bc4baSyz if ((q != NULL) && !dlcapabcheckqid(&zcopy->zerocopy_mid, q)) {
569d62bc4baSyz cmn_err(CE_WARN, "i_capab_zcopy_verify: unexpected pass-thru "
570d62bc4baSyz "module detected; zcopy checksum capability discarded");
571d62bc4baSyz return (-1);
572d62bc4baSyz }
573d62bc4baSyz return (0);
574d62bc4baSyz }
575