Home | History | Annotate | Line # | Download | only in mlxctl
dklist.c revision 1.7.18.1
      1 /*	$NetBSD: dklist.c,v 1.7.18.1 2008/05/18 12:36:20 yamt Exp $	*/
      2 
      3 /*-
      4  * Copyright (c) 2001 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  *
     19  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     20  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     21  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     22  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     23  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     24  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     25  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     26  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     27  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     28  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     29  * POSSIBILITY OF SUCH DAMAGE.
     30  */
     31 
     32 /*
     33  * Copyright (c) 1996 John M. Vinopal
     34  * All rights reserved.
     35  *
     36  * Redistribution and use in source and binary forms, with or without
     37  * modification, are permitted provided that the following conditions
     38  * are met:
     39  * 1. Redistributions of source code must retain the above copyright
     40  *    notice, this list of conditions and the following disclaimer.
     41  * 2. Redistributions in binary form must reproduce the above copyright
     42  *    notice, this list of conditions and the following disclaimer in the
     43  *    documentation and/or other materials provided with the distribution.
     44  * 3. All advertising materials mentioning features or use of this software
     45  *    must display the following acknowledgement:
     46  *      This product includes software developed for the NetBSD Project
     47  *      by John M. Vinopal.
     48  * 4. The name of the author may not be used to endorse or promote products
     49  *    derived from this software without specific prior written permission.
     50  *
     51  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     52  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     53  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     54  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     55  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
     56  * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
     57  * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
     58  * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
     59  * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     60  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     61  * SUCH DAMAGE.
     62  */
     63 
     64 #ifndef lint
     65 #include <sys/cdefs.h>
     66 __RCSID("$NetBSD: dklist.c,v 1.7.18.1 2008/05/18 12:36:20 yamt Exp $");
     67 #endif /* not lint */
     68 
     69 #include <sys/types.h>
     70 #include <sys/disk.h>
     71 #include <sys/ioctl.h>
     72 
     73 #include <dev/ic/mlxreg.h>
     74 #include <dev/ic/mlxio.h>
     75 
     76 #include <err.h>
     77 #include <fcntl.h>
     78 #include <kvm.h>
     79 #include <limits.h>
     80 #include <nlist.h>
     81 #include <stdio.h>
     82 #include <stdlib.h>
     83 #include <string.h>
     84 #include <ctype.h>
     85 #include <unistd.h>
     86 
     87 #include "extern.h"
     88 
     89 static SIMPLEQ_HEAD(, mlx_disk) mlx_disks;
     90 
     91 static struct nlist namelist[] = {
     92 #define X_DISK_COUNT	0
     93 	{ "_iostat_count" },	/* number of disks */
     94 #define X_DISKLIST	1
     95 	{ "_iostatlist" },	/* TAILQ of disks */
     96 	{ NULL },
     97 };
     98 
     99 #define	KVM_ERROR(_string) {						\
    100 	warnx("%s", (_string));						\
    101 	errx(1, "%s", kvm_geterr(kd));					\
    102 }
    103 
    104 /*
    105  * Dereference the namelist pointer `v' and fill in the local copy
    106  * 'p' which is of size 's'.
    107  */
    108 #define deref_nl(kd, v, p, s)	\
    109     deref_kptr(kd, (void *)namelist[(v)].n_value, (p), (s));
    110 
    111 static void	deref_kptr(kvm_t *, void *, void *, size_t);
    112 
    113 void
    114 mlx_disk_init(void)
    115 {
    116 
    117 	SIMPLEQ_INIT(&mlx_disks);
    118 }
    119 
    120 int
    121 mlx_disk_empty(void)
    122 {
    123 
    124 	return (SIMPLEQ_EMPTY(&mlx_disks));
    125 }
    126 
    127 void
    128 mlx_disk_iterate(void (*func)(struct mlx_disk *))
    129 {
    130 	struct mlx_disk *md;
    131 
    132 	SIMPLEQ_FOREACH(md, &mlx_disks, chain)
    133 		(*func)(md);
    134 }
    135 
    136 static int
    137 mlx_disk_add0(const char *name)
    138 {
    139 	struct mlx_disk *md;
    140 	int unit;
    141 
    142 	if (name[0] != 'l' || name[1] != 'd' || !isdigit((unsigned char)name[2]))
    143 		return (-1);
    144 
    145 	SIMPLEQ_FOREACH(md, &mlx_disks, chain)
    146 		if (strcmp(md->name, name) == 0)
    147 			return (0);
    148 
    149 	unit = atoi(name + 2);
    150 	if (ioctl(mlxfd, MLX_GET_SYSDRIVE, &unit) < 0)
    151 		return (-1);
    152 
    153 	if ((md = malloc(sizeof(*md))) == NULL)
    154 		err(EXIT_FAILURE, "mlx_disk_add()");
    155 
    156 	strlcpy(md->name, name, sizeof(md->name));
    157 	md->hwunit = unit;
    158 	SIMPLEQ_INSERT_TAIL(&mlx_disks, md, chain);
    159 	return (0);
    160 }
    161 
    162 void
    163 mlx_disk_add(const char *name)
    164 {
    165 
    166 	if (mlx_disk_add0(name) != 0)
    167 		errx(EXIT_FAILURE, "%s is not attached to %s", name, mlxname);
    168 }
    169 
    170 void
    171 mlx_disk_add_all(void)
    172 {
    173 	struct iostatlist_head iostat_head;
    174 	struct io_stats cur_drive, *drv;
    175         char errbuf[_POSIX2_LINE_MAX];
    176 	char buf[12];
    177 	int i, ndrives;
    178 	kvm_t *kd;
    179 
    180 	/* Open the kernel. */
    181         if ((kd = kvm_openfiles(nlistf, memf, NULL, O_RDONLY, errbuf)) == NULL)
    182 		errx(1, "kvm_openfiles: %s", errbuf);
    183 
    184 	/* Obtain the namelist symbols from the kernel. */
    185 	if (kvm_nlist(kd, namelist))
    186 		KVM_ERROR("kvm_nlist failed to read symbols.");
    187 
    188 	/* Get the number of attached drives. */
    189 	deref_nl(kd, X_DISK_COUNT, &ndrives, sizeof(ndrives));
    190 
    191 	if (ndrives < 0)
    192 		errx(EXIT_FAILURE, "invalid _disk_count %d.", ndrives);
    193 	if (ndrives == 0)
    194 		errx(EXIT_FAILURE, "no drives attached.");
    195 
    196 	/* Get a pointer to the first disk. */
    197 	deref_nl(kd, X_DISKLIST, &iostat_head, sizeof(iostat_head));
    198 	drv = TAILQ_FIRST(&iostat_head);
    199 
    200 	/* Try to add each disk to the list. */
    201 	for (i = 0; i < ndrives; i++) {
    202 		deref_kptr(kd, drv, &cur_drive, sizeof(cur_drive));
    203 		deref_kptr(kd, cur_drive.io_name, buf, sizeof(buf));
    204 		if (cur_drive.io_type == IOSTAT_DISK)
    205 			mlx_disk_add0(buf);
    206 		drv = TAILQ_NEXT(&cur_drive, io_link);
    207 	}
    208 
    209 	kvm_close(kd);
    210 }
    211 
    212 /*
    213  * Dereference the kernel pointer `kptr' and fill in the local copy pointed
    214  * to by `ptr'.  The storage space must be pre-allocated, and the size of
    215  * the copy passed in `len'.
    216  */
    217 static void
    218 deref_kptr(kvm_t *kd, void *kptr, void *ptr, size_t len)
    219 {
    220 	char buf[128];
    221 
    222 	if (kvm_read(kd, (u_long)kptr, (char *)ptr, len) != len) {
    223 		memset(buf, 0, sizeof(buf));
    224 		snprintf(buf, sizeof buf, "can't dereference kptr 0x%lx",
    225 		    (u_long)kptr);
    226 		KVM_ERROR(buf);
    227 	}
    228 }
    229