Home | History | Annotate | Line # | Download | only in dev
lockstat.c revision 1.2.2.1
      1 /*	$NetBSD: lockstat.c,v 1.2.2.1 2006/11/17 16:34:35 ad Exp $	*/
      2 
      3 /*-
      4  * Copyright (c) 2006 The NetBSD Foundation, Inc.
      5  * All rights reserved.
      6  *
      7  * This code is derived from software contributed to The NetBSD Foundation
      8  * by Andrew Doran.
      9  *
     10  * Redistribution and use in source and binary forms, with or without
     11  * modification, are permitted provided that the following conditions
     12  * are met:
     13  * 1. Redistributions of source code must retain the above copyright
     14  *    notice, this list of conditions and the following disclaimer.
     15  * 2. Redistributions in binary form must reproduce the above copyright
     16  *    notice, this list of conditions and the following disclaimer in the
     17  *    documentation and/or other materials provided with the distribution.
     18  * 3. All advertising materials mentioning features or use of this software
     19  *    must display the following acknowledgement:
     20  *	This product includes software developed by the NetBSD
     21  *	Foundation, Inc. and its contributors.
     22  * 4. Neither the name of The NetBSD Foundation nor the names of its
     23  *    contributors may be used to endorse or promote products derived
     24  *    from this software without specific prior written permission.
     25  *
     26  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     27  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     28  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     29  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     30  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     31  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     32  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     33  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     34  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     35  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     36  * POSSIBILITY OF SUCH DAMAGE.
     37  */
     38 
     39 /*
     40  * Lock statistics driver, providing kernel support for the lockstat(8)
     41  * command.
     42  */
     43 
     44 #include <sys/cdefs.h>
     45 __KERNEL_RCSID(0, "$NetBSD: lockstat.c,v 1.2.2.1 2006/11/17 16:34:35 ad Exp $");
     46 
     47 #include <sys/types.h>
     48 #include <sys/param.h>
     49 #include <sys/lock.h>
     50 #include <sys/proc.h>
     51 #include <sys/resourcevar.h>
     52 #include <sys/systm.h>
     53 #include <sys/kernel.h>
     54 #include <sys/malloc.h>
     55 #include <sys/conf.h>
     56 #include <sys/syslog.h>
     57 
     58 #include <dev/lockstat.h>
     59 
     60 #ifndef __HAVE_CPU_COUNTER
     61 #error CPU counters not available
     62 #endif
     63 
     64 #if LONG_BIT == 64
     65 #define	LOCKSTAT_HASH_SHIFT	3
     66 #elif LONG_BIT == 32
     67 #define	LOCKSTAT_HASH_SHIFT	2
     68 #endif
     69 
     70 #define	LOCKSTAT_MINBUFS	100
     71 #define	LOCKSTAT_DEFBUFS	1000
     72 #define	LOCKSTAT_MAXBUFS	10000
     73 
     74 #define	LOCKSTAT_HASH_SIZE	64
     75 #define	LOCKSTAT_HASH_MASK	(LOCKSTAT_HASH_SIZE - 1)
     76 #define	LOCKSTAT_HASH(key)	\
     77 	((key >> LOCKSTAT_HASH_SHIFT) & LOCKSTAT_HASH_MASK)
     78 
     79 typedef struct lscpu {
     80 	SLIST_HEAD(, lsbuf)	lc_free;
     81 	u_int			lc_overflow;
     82 	LIST_HEAD(lslist, lsbuf) lc_hash[LOCKSTAT_HASH_SIZE];
     83 } lscpu_t;
     84 
     85 typedef struct lslist lslist_t;
     86 
     87 void	lockstatattach(int);
     88 void	lockstat_start(lsenable_t *);
     89 int	lockstat_alloc(lsenable_t *);
     90 void	lockstat_init_tables(lsenable_t *);
     91 int	lockstat_stop(lsdisable_t *);
     92 void	lockstat_free(void);
     93 
     94 dev_type_open(lockstat_open);
     95 dev_type_close(lockstat_close);
     96 dev_type_read(lockstat_read);
     97 dev_type_ioctl(lockstat_ioctl);
     98 
     99 /* Protected against write by lockstat_lock().  Used by lockstat_event(). */
    100 volatile u_int	lockstat_enabled;
    101 uintptr_t	lockstat_csstart;
    102 uintptr_t	lockstat_csend;
    103 uintptr_t	lockstat_csmask;
    104 uintptr_t	lockstat_lockaddr;
    105 
    106 /* Protected by lockstat_lock(). */
    107 struct simplelock lockstat_slock;
    108 lsbuf_t		*lockstat_baseb;
    109 size_t		lockstat_sizeb;
    110 int		lockstat_busy;
    111 int		lockstat_devopen;
    112 struct timespec	lockstat_stime;
    113 
    114 const struct cdevsw lockstat_cdevsw = {
    115 	lockstat_open, lockstat_close, lockstat_read, nowrite, lockstat_ioctl,
    116 	nostop, notty, nopoll, nommap, nokqfilter, 0
    117 };
    118 
    119 MALLOC_DEFINE(M_LOCKSTAT, "lockstat", "lockstat event buffers");
    120 
    121 /*
    122  * Called when the pseudo-driver is attached.
    123  */
    124 void
    125 lockstatattach(int nunits)
    126 {
    127 
    128 	(void)nunits;
    129 
    130 	__cpu_simple_lock_init(&lockstat_slock.lock_data);
    131 }
    132 
    133 /*
    134  * Grab the global lock.  If busy is set, we want to block out operations on
    135  * the control device.
    136  */
    137 static inline int
    138 lockstat_lock(int busy)
    139 {
    140 
    141 	if (!__cpu_simple_lock_try(&lockstat_slock.lock_data))
    142 		return (EBUSY);
    143 	if (busy) {
    144 		if (lockstat_busy) {
    145 			__cpu_simple_unlock(&lockstat_slock.lock_data);
    146 			return (EBUSY);
    147 		}
    148 		lockstat_busy = 1;
    149 	}
    150 	KASSERT(lockstat_busy);
    151 
    152 	return 0;
    153 }
    154 
    155 /*
    156  * Release the global lock.  If unbusy is set, we want to allow new
    157  * operations on the control device.
    158  */
    159 static inline void
    160 lockstat_unlock(int unbusy)
    161 {
    162 
    163 	KASSERT(lockstat_busy);
    164 	if (unbusy)
    165 		lockstat_busy = 0;
    166 	__cpu_simple_unlock(&lockstat_slock.lock_data);
    167 }
    168 
    169 /*
    170  * Prepare the per-CPU tables for use, or clear down tables when tracing is
    171  * stopped.
    172  */
    173 void
    174 lockstat_init_tables(lsenable_t *le)
    175 {
    176 	int i, ncpu, per, slop, cpuno;
    177 	CPU_INFO_ITERATOR cii;
    178 	struct cpu_info *ci;
    179 	lscpu_t *lc;
    180 	lsbuf_t *lb;
    181 
    182 	KASSERT(!lockstat_enabled);
    183 
    184 	ncpu = 0;
    185 	for (CPU_INFO_FOREACH(cii, ci)) {
    186 		if (ci->ci_lockstat != NULL) {
    187 			free(ci->ci_lockstat, M_LOCKSTAT);
    188 			ci->ci_lockstat = NULL;
    189 		}
    190 		ncpu++;
    191 	}
    192 
    193 	if (le == NULL)
    194 		return;
    195 
    196 	lb = lockstat_baseb;
    197 	per = le->le_nbufs / ncpu;
    198 	slop = le->le_nbufs - (per * ncpu);
    199 	cpuno = 0;
    200 	for (CPU_INFO_FOREACH(cii, ci)) {
    201 		lc = malloc(sizeof(*lc), M_LOCKSTAT, M_WAITOK);
    202 		lc->lc_overflow = 0;
    203 		ci->ci_lockstat = lc;
    204 
    205 		SLIST_INIT(&lc->lc_free);
    206 		for (i = 0; i < LOCKSTAT_HASH_SIZE; i++)
    207 			LIST_INIT(&lc->lc_hash[i]);
    208 
    209 		for (i = per; i != 0; i--, lb++) {
    210 			lb->lb_cpu = (uint16_t)cpuno;
    211 			SLIST_INSERT_HEAD(&lc->lc_free, lb, lb_chain.slist);
    212 		}
    213 		if (--slop > 0) {
    214 			lb->lb_cpu = (uint16_t)cpuno;
    215 			SLIST_INSERT_HEAD(&lc->lc_free, lb, lb_chain.slist);
    216 			lb++;
    217 		}
    218 		cpuno++;
    219 	}
    220 }
    221 
    222 /*
    223  * Start collecting lock statistics.
    224  */
    225 void
    226 lockstat_start(lsenable_t *le)
    227 {
    228 
    229 	KASSERT(!lockstat_enabled);
    230 
    231 	lockstat_init_tables(le);
    232 
    233 	if ((le->le_flags & LE_CALLSITE) != 0)
    234 		lockstat_csmask = (uintptr_t)-1LL;
    235 	else
    236 		lockstat_csmask = 0;
    237 
    238 	lockstat_csstart = le->le_csstart;
    239 	lockstat_csend = le->le_csend;
    240 	lockstat_lockaddr = le->le_lock;
    241 	mb_write();
    242 
    243 	getnanotime(&lockstat_stime);
    244 	lockstat_enabled = le->le_mask;
    245 	mb_write();
    246 }
    247 
    248 /*
    249  * Stop collecting lock statistics.
    250  */
    251 int
    252 lockstat_stop(lsdisable_t *ld)
    253 {
    254 	CPU_INFO_ITERATOR cii;
    255 	struct cpu_info *ci;
    256 	u_int cpuno, overflow;
    257 	struct timespec ts;
    258 	int error;
    259 
    260 	KASSERT(lockstat_enabled);
    261 
    262 	/*
    263 	 * Set enabled false, force a write barrier, and wait for other CPUs
    264 	 * to exit lockstat_event().
    265 	 */
    266 	lockstat_enabled = 0;
    267 	lockstat_unlock(0);
    268 	getnanotime(&ts);
    269 	tsleep(&lockstat_stop, PPAUSE, "lockstat", mstohz(10));
    270  	(void)lockstat_lock(0);
    271 
    272 	/*
    273 	 * Did we run out of buffers while tracing?
    274 	 */
    275 	overflow = 0;
    276 	for (CPU_INFO_FOREACH(cii, ci))
    277 		overflow += ((lscpu_t *)ci->ci_lockstat)->lc_overflow;
    278 
    279 	if (overflow != 0) {
    280 		error = EOVERFLOW;
    281 		log(LOG_NOTICE, "lockstat: %d buffer allocations failed\n",
    282 		    overflow);
    283 	} else
    284 		error = 0;
    285 
    286 	lockstat_init_tables(NULL);
    287 
    288 	if (ld == NULL)
    289 		return (error);
    290 
    291 	/*
    292 	 * Fill out the disable struct for the caller.
    293 	 */
    294 	timespecsub(&ts, &lockstat_stime, &ld->ld_time);
    295 	ld->ld_size = lockstat_sizeb;
    296 
    297 	cpuno = 0;
    298 	for (CPU_INFO_FOREACH(cii, ci)) {
    299 		if (cpuno > sizeof(ld->ld_freq) / sizeof(ld->ld_freq[0])) {
    300 			log(LOG_WARNING, "lockstat: too many CPUs\n");
    301 			break;
    302 		}
    303 		ld->ld_freq[cpuno++] = cpu_frequency(ci);
    304 	}
    305 
    306 	return (error);
    307 }
    308 
    309 /*
    310  * Allocate buffers for lockstat_start().
    311  */
    312 int
    313 lockstat_alloc(lsenable_t *le)
    314 {
    315 	lsbuf_t *lb;
    316 	size_t sz;
    317 
    318 	KASSERT(!lockstat_enabled);
    319 	lockstat_free();
    320 
    321 	sz = sizeof(*lb) * le->le_nbufs;
    322 
    323 	lockstat_unlock(0);
    324 	lb = malloc(sz, M_LOCKSTAT, M_WAITOK | M_ZERO);
    325 	(void)lockstat_lock(0);
    326 
    327 	if (lb == NULL)
    328 		return (ENOMEM);
    329 
    330 	KASSERT(!lockstat_enabled);
    331 	KASSERT(lockstat_baseb == NULL);
    332 	lockstat_sizeb = sz;
    333 	lockstat_baseb = lb;
    334 
    335 	return (0);
    336 }
    337 
    338 /*
    339  * Free allocated buffers after tracing has stopped.
    340  */
    341 void
    342 lockstat_free(void)
    343 {
    344 
    345 	KASSERT(!lockstat_enabled);
    346 
    347 	if (lockstat_baseb != NULL) {
    348 		free(lockstat_baseb, M_LOCKSTAT);
    349 		lockstat_baseb = NULL;
    350 	}
    351 }
    352 
    353 /*
    354  * Main entry point from lock primatives.
    355  */
    356 void
    357 lockstat_event(uintptr_t lock, uintptr_t callsite, u_int flags, u_int count,
    358 	       uint64_t time)
    359 {
    360 	lslist_t *ll;
    361 	lscpu_t *lc;
    362 	lsbuf_t *lb;
    363 	u_int event;
    364 	int s;
    365 
    366 	if ((flags & lockstat_enabled) != flags || count == 0)
    367 		return;
    368 	if (lockstat_lockaddr != 0 && lock != lockstat_lockaddr)
    369 		return;
    370 	if (callsite < lockstat_csstart || callsite > lockstat_csend)
    371 		return;
    372 
    373 	callsite &= lockstat_csmask;
    374 
    375 	/*
    376 	 * Find the table for this lock+callsite pair, and try to locate a
    377 	 * buffer with the same key.
    378 	 */
    379 	lc = curcpu()->ci_lockstat;
    380 	ll = &lc->lc_hash[LOCKSTAT_HASH(lock ^ callsite)];
    381 	event = (flags & LB_EVENT_MASK) - 1;
    382 	s = spllock();
    383 
    384 	LIST_FOREACH(lb, ll, lb_chain.list) {
    385 		if (lb->lb_lock == lock && lb->lb_callsite == callsite)
    386 			break;
    387 	}
    388 
    389 	if (lb != NULL) {
    390 		/*
    391 		 * We found a record.  Move it to the front of the list, as
    392 		 * we're likely to hit it again soon.
    393 		 */
    394 		if (lb != LIST_FIRST(ll)) {
    395 			LIST_REMOVE(lb, lb_chain.list);
    396 			LIST_INSERT_HEAD(ll, lb, lb_chain.list);
    397 		}
    398 		lb->lb_counts[event] += count;
    399 		lb->lb_times[event] += time;
    400 	} else if ((lb = SLIST_FIRST(&lc->lc_free)) != NULL) {
    401 		/*
    402 		 * Pinch a new buffer and fill it out.
    403 		 */
    404 		SLIST_REMOVE_HEAD(&lc->lc_free, lb_chain.slist);
    405 		LIST_INSERT_HEAD(ll, lb, lb_chain.list);
    406 		lb->lb_flags = (uint16_t)flags;
    407 		lb->lb_lock = lock;
    408 		lb->lb_callsite = callsite;
    409 		lb->lb_counts[event] = count;
    410 		lb->lb_times[event] = time;
    411 	} else {
    412 		/*
    413 		 * We didn't find a buffer and there were none free.
    414 		 * lockstat_stop() will notice later on and report the
    415 		 * error.
    416 		 */
    417 		 lc->lc_overflow++;
    418 	}
    419 
    420 	splx(s);
    421 }
    422 
    423 /*
    424  * Accept an open() on /dev/lockstat.
    425  */
    426 int
    427 lockstat_open(dev_t dev, int flag, int mode, struct lwp *l)
    428 {
    429 	int error;
    430 
    431 	if ((error = lockstat_lock(1)) != 0)
    432 		return error;
    433 
    434 	if (lockstat_devopen)
    435 		error = EBUSY;
    436 	else {
    437 		lockstat_devopen = 1;
    438 		error = 0;
    439 	}
    440 
    441 	lockstat_unlock(1);
    442 
    443 	return error;
    444 }
    445 
    446 /*
    447  * Accept the last close() on /dev/lockstat.
    448  */
    449 int
    450 lockstat_close(dev_t dev, int flag, int mode, struct lwp *l)
    451 {
    452 	int error;
    453 
    454 	if ((error = lockstat_lock(1)) == 0) {
    455 		if (lockstat_enabled)
    456 			(void)lockstat_stop(NULL);
    457 		lockstat_free();
    458 		lockstat_devopen = 0;
    459 		lockstat_unlock(1);
    460 	}
    461 
    462 	return error;
    463 }
    464 
    465 /*
    466  * Handle control operations.
    467  */
    468 int
    469 lockstat_ioctl(dev_t dev, u_long cmd, caddr_t data, int flag, struct lwp *l)
    470 {
    471 	lsenable_t *le;
    472 	int error;
    473 
    474 	if ((error = lockstat_lock(1)) != 0)
    475 		return error;
    476 
    477 	switch (cmd) {
    478 	case IOC_LOCKSTAT_GVERSION:
    479 		*(int *)data = LS_VERSION;
    480 		error = 0;
    481 		break;
    482 
    483 	case IOC_LOCKSTAT_ENABLE:
    484 		le = (lsenable_t *)data;
    485 
    486 		if (!cpu_hascounter()) {
    487 			error = ENODEV;
    488 			break;
    489 		}
    490 		if (lockstat_enabled) {
    491 			error = EBUSY;
    492 			break;
    493 		}
    494 
    495 		/*
    496 		 * Sanitize the arguments passed in and set up filtering.
    497 		 */
    498 		if (le->le_nbufs == 0)
    499 			le->le_nbufs = LOCKSTAT_DEFBUFS;
    500 		else if (le->le_nbufs > LOCKSTAT_MAXBUFS ||
    501 		    le->le_nbufs < LOCKSTAT_MINBUFS) {
    502 			error = EINVAL;
    503 			break;
    504 		}
    505 		if ((le->le_flags & LE_ONE_CALLSITE) == 0) {
    506 			le->le_csstart = 0;
    507 			le->le_csend = le->le_csstart - 1;
    508 		}
    509 		if ((le->le_flags & LE_ONE_LOCK) == 0)
    510 			le->le_lock = 0;
    511 		if ((le->le_mask & LB_EVENT_MASK) == 0)
    512 			return (EINVAL);
    513 		if ((le->le_mask & LB_LOCK_MASK) == 0)
    514 			return (EINVAL);
    515 
    516 		/*
    517 		 * Start tracing.
    518 		 */
    519 		if ((error = lockstat_alloc(le)) == 0)
    520 			lockstat_start(le);
    521 		break;
    522 
    523 	case IOC_LOCKSTAT_DISABLE:
    524 		if (!lockstat_enabled)
    525 			error = EINVAL;
    526 		else
    527 			error = lockstat_stop((lsdisable_t *)data);
    528 		break;
    529 
    530 	default:
    531 		error = ENOTTY;
    532 		break;
    533 	}
    534 
    535 	lockstat_unlock(1);
    536 	return error;
    537 }
    538 
    539 /*
    540  * Copy buffers out to user-space.
    541  */
    542 int
    543 lockstat_read(dev_t dev, struct uio *uio, int flag)
    544 {
    545 	int error;
    546 
    547 	if ((error = lockstat_lock(1)) != 0)
    548 		return (error);
    549 
    550 	if (lockstat_enabled) {
    551 		lockstat_unlock(1);
    552 		return (EBUSY);
    553 	}
    554 
    555 	lockstat_unlock(0);
    556 	error = uiomove(lockstat_baseb, lockstat_sizeb, uio);
    557 	lockstat_lock(0);
    558 
    559 	lockstat_unlock(1);
    560 
    561 	return (error);
    562 }
    563