xref: /netbsd-src/external/cddl/osnet/dist/lib/libdtrace/common/dt_buf.c (revision a864dc36a152ff257761882aea174a236eb36c81)
1*a864dc36Sdarran /*
2*a864dc36Sdarran  * CDDL HEADER START
3*a864dc36Sdarran  *
4*a864dc36Sdarran  * The contents of this file are subject to the terms of the
5*a864dc36Sdarran  * Common Development and Distribution License, Version 1.0 only
6*a864dc36Sdarran  * (the "License").  You may not use this file except in compliance
7*a864dc36Sdarran  * with the License.
8*a864dc36Sdarran  *
9*a864dc36Sdarran  * You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE
10*a864dc36Sdarran  * or http://www.opensolaris.org/os/licensing.
11*a864dc36Sdarran  * See the License for the specific language governing permissions
12*a864dc36Sdarran  * and limitations under the License.
13*a864dc36Sdarran  *
14*a864dc36Sdarran  * When distributing Covered Code, include this CDDL HEADER in each
15*a864dc36Sdarran  * file and include the License file at usr/src/OPENSOLARIS.LICENSE.
16*a864dc36Sdarran  * If applicable, add the following below this CDDL HEADER, with the
17*a864dc36Sdarran  * fields enclosed by brackets "[]" replaced with your own identifying
18*a864dc36Sdarran  * information: Portions Copyright [yyyy] [name of copyright owner]
19*a864dc36Sdarran  *
20*a864dc36Sdarran  * CDDL HEADER END
21*a864dc36Sdarran  */
22*a864dc36Sdarran /*
23*a864dc36Sdarran  * Copyright 2005 Sun Microsystems, Inc.  All rights reserved.
24*a864dc36Sdarran  * Use is subject to license terms.
25*a864dc36Sdarran  */
26*a864dc36Sdarran 
27*a864dc36Sdarran #pragma ident	"%Z%%M%	%I%	%E% SMI"
28*a864dc36Sdarran 
29*a864dc36Sdarran /*
30*a864dc36Sdarran  * DTrace Memory Buffer Routines
31*a864dc36Sdarran  *
32*a864dc36Sdarran  * The routines in this file are used to create an automatically resizing
33*a864dc36Sdarran  * memory buffer that can be written to like a file.  Memory buffers are
34*a864dc36Sdarran  * used to construct DOF to ioctl() to dtrace(7D), and provide semantics that
35*a864dc36Sdarran  * simplify caller code.  Specifically, any allocation errors result in an
36*a864dc36Sdarran  * error code being set inside the buffer which is maintained persistently and
37*a864dc36Sdarran  * propagates to another buffer if the buffer in error is concatenated.  These
38*a864dc36Sdarran  * semantics permit callers to execute a large series of writes without needing
39*a864dc36Sdarran  * to check for errors and then perform a single check before using the buffer.
40*a864dc36Sdarran  */
41*a864dc36Sdarran 
42*a864dc36Sdarran #include <sys/sysmacros.h>
43*a864dc36Sdarran #include <strings.h>
44*a864dc36Sdarran 
45*a864dc36Sdarran #include <dt_impl.h>
46*a864dc36Sdarran #include <dt_buf.h>
47*a864dc36Sdarran 
48*a864dc36Sdarran void
dt_buf_create(dtrace_hdl_t * dtp,dt_buf_t * bp,const char * name,size_t len)49*a864dc36Sdarran dt_buf_create(dtrace_hdl_t *dtp, dt_buf_t *bp, const char *name, size_t len)
50*a864dc36Sdarran {
51*a864dc36Sdarran 	if (len == 0)
52*a864dc36Sdarran 		len = _dtrace_bufsize;
53*a864dc36Sdarran 
54*a864dc36Sdarran 	bp->dbu_buf = bp->dbu_ptr = dt_zalloc(dtp, len);
55*a864dc36Sdarran 	bp->dbu_len = len;
56*a864dc36Sdarran 
57*a864dc36Sdarran 	if (bp->dbu_buf == NULL)
58*a864dc36Sdarran 		bp->dbu_err = dtrace_errno(dtp);
59*a864dc36Sdarran 	else
60*a864dc36Sdarran 		bp->dbu_err = 0;
61*a864dc36Sdarran 
62*a864dc36Sdarran 	bp->dbu_resizes = 0;
63*a864dc36Sdarran 	bp->dbu_name = name;
64*a864dc36Sdarran }
65*a864dc36Sdarran 
66*a864dc36Sdarran void
dt_buf_destroy(dtrace_hdl_t * dtp,dt_buf_t * bp)67*a864dc36Sdarran dt_buf_destroy(dtrace_hdl_t *dtp, dt_buf_t *bp)
68*a864dc36Sdarran {
69*a864dc36Sdarran 	dt_dprintf("dt_buf_destroy(%s): size=%lu resizes=%u\n",
70*a864dc36Sdarran 	    bp->dbu_name, (ulong_t)bp->dbu_len, bp->dbu_resizes);
71*a864dc36Sdarran 
72*a864dc36Sdarran 	dt_free(dtp, bp->dbu_buf);
73*a864dc36Sdarran }
74*a864dc36Sdarran 
75*a864dc36Sdarran void
dt_buf_reset(dtrace_hdl_t * dtp,dt_buf_t * bp)76*a864dc36Sdarran dt_buf_reset(dtrace_hdl_t *dtp, dt_buf_t *bp)
77*a864dc36Sdarran {
78*a864dc36Sdarran 	if ((bp->dbu_ptr = bp->dbu_buf) != NULL)
79*a864dc36Sdarran 		bp->dbu_err = 0;
80*a864dc36Sdarran 	else
81*a864dc36Sdarran 		dt_buf_create(dtp, bp, bp->dbu_name, bp->dbu_len);
82*a864dc36Sdarran }
83*a864dc36Sdarran 
84*a864dc36Sdarran void
dt_buf_write(dtrace_hdl_t * dtp,dt_buf_t * bp,const void * buf,size_t len,size_t align)85*a864dc36Sdarran dt_buf_write(dtrace_hdl_t *dtp, dt_buf_t *bp,
86*a864dc36Sdarran     const void *buf, size_t len, size_t align)
87*a864dc36Sdarran {
88*a864dc36Sdarran 	size_t off = (size_t)(bp->dbu_ptr - bp->dbu_buf);
89*a864dc36Sdarran 	size_t adj = roundup(off, align) - off;
90*a864dc36Sdarran 
91*a864dc36Sdarran 	if (bp->dbu_err != 0) {
92*a864dc36Sdarran 		(void) dt_set_errno(dtp, bp->dbu_err);
93*a864dc36Sdarran 		return; /* write silently fails */
94*a864dc36Sdarran 	}
95*a864dc36Sdarran 
96*a864dc36Sdarran 	if (bp->dbu_ptr + adj + len > bp->dbu_buf + bp->dbu_len) {
97*a864dc36Sdarran 		size_t new_len = bp->dbu_len * 2;
98*a864dc36Sdarran 		uchar_t *new_buf;
99*a864dc36Sdarran 		uint_t r = 1;
100*a864dc36Sdarran 
101*a864dc36Sdarran 		while (bp->dbu_ptr + adj + len > bp->dbu_buf + new_len) {
102*a864dc36Sdarran 			new_len *= 2;
103*a864dc36Sdarran 			r++;
104*a864dc36Sdarran 		}
105*a864dc36Sdarran 
106*a864dc36Sdarran 		if ((new_buf = dt_zalloc(dtp, new_len)) == NULL) {
107*a864dc36Sdarran 			bp->dbu_err = dtrace_errno(dtp);
108*a864dc36Sdarran 			return;
109*a864dc36Sdarran 		}
110*a864dc36Sdarran 
111*a864dc36Sdarran 		bcopy(bp->dbu_buf, new_buf, off);
112*a864dc36Sdarran 		dt_free(dtp, bp->dbu_buf);
113*a864dc36Sdarran 
114*a864dc36Sdarran 		bp->dbu_buf = new_buf;
115*a864dc36Sdarran 		bp->dbu_ptr = new_buf + off;
116*a864dc36Sdarran 		bp->dbu_len = new_len;
117*a864dc36Sdarran 		bp->dbu_resizes += r;
118*a864dc36Sdarran 	}
119*a864dc36Sdarran 
120*a864dc36Sdarran 	bp->dbu_ptr += adj;
121*a864dc36Sdarran 	bcopy(buf, bp->dbu_ptr, len);
122*a864dc36Sdarran 	bp->dbu_ptr += len;
123*a864dc36Sdarran }
124*a864dc36Sdarran 
125*a864dc36Sdarran void
dt_buf_concat(dtrace_hdl_t * dtp,dt_buf_t * dst,const dt_buf_t * src,size_t align)126*a864dc36Sdarran dt_buf_concat(dtrace_hdl_t *dtp, dt_buf_t *dst,
127*a864dc36Sdarran     const dt_buf_t *src, size_t align)
128*a864dc36Sdarran {
129*a864dc36Sdarran 	if (dst->dbu_err == 0 && src->dbu_err != 0) {
130*a864dc36Sdarran 		(void) dt_set_errno(dtp, src->dbu_err);
131*a864dc36Sdarran 		dst->dbu_err = src->dbu_err;
132*a864dc36Sdarran 	} else {
133*a864dc36Sdarran 		dt_buf_write(dtp, dst, src->dbu_buf,
134*a864dc36Sdarran 		    (size_t)(src->dbu_ptr - src->dbu_buf), align);
135*a864dc36Sdarran 	}
136*a864dc36Sdarran }
137*a864dc36Sdarran 
138*a864dc36Sdarran size_t
dt_buf_offset(const dt_buf_t * bp,size_t align)139*a864dc36Sdarran dt_buf_offset(const dt_buf_t *bp, size_t align)
140*a864dc36Sdarran {
141*a864dc36Sdarran 	size_t off = (size_t)(bp->dbu_ptr - bp->dbu_buf);
142*a864dc36Sdarran 	return (roundup(off, align));
143*a864dc36Sdarran }
144*a864dc36Sdarran 
145*a864dc36Sdarran size_t
dt_buf_len(const dt_buf_t * bp)146*a864dc36Sdarran dt_buf_len(const dt_buf_t *bp)
147*a864dc36Sdarran {
148*a864dc36Sdarran 	return (bp->dbu_ptr - bp->dbu_buf);
149*a864dc36Sdarran }
150*a864dc36Sdarran 
151*a864dc36Sdarran int
dt_buf_error(const dt_buf_t * bp)152*a864dc36Sdarran dt_buf_error(const dt_buf_t *bp)
153*a864dc36Sdarran {
154*a864dc36Sdarran 	return (bp->dbu_err);
155*a864dc36Sdarran }
156*a864dc36Sdarran 
157*a864dc36Sdarran void *
dt_buf_ptr(const dt_buf_t * bp)158*a864dc36Sdarran dt_buf_ptr(const dt_buf_t *bp)
159*a864dc36Sdarran {
160*a864dc36Sdarran 	return (bp->dbu_buf);
161*a864dc36Sdarran }
162*a864dc36Sdarran 
163*a864dc36Sdarran void *
dt_buf_claim(dtrace_hdl_t * dtp,dt_buf_t * bp)164*a864dc36Sdarran dt_buf_claim(dtrace_hdl_t *dtp, dt_buf_t *bp)
165*a864dc36Sdarran {
166*a864dc36Sdarran 	void *buf = bp->dbu_buf;
167*a864dc36Sdarran 
168*a864dc36Sdarran 	if (bp->dbu_err != 0) {
169*a864dc36Sdarran 		dt_free(dtp, buf);
170*a864dc36Sdarran 		buf = NULL;
171*a864dc36Sdarran 	}
172*a864dc36Sdarran 
173*a864dc36Sdarran 	bp->dbu_buf = bp->dbu_ptr = NULL;
174*a864dc36Sdarran 	bp->dbu_len = 0;
175*a864dc36Sdarran 
176*a864dc36Sdarran 	return (buf);
177*a864dc36Sdarran }
178