Home | History | Annotate | Line # | Download | only in envstat
envstat.c revision 1.1
      1  1.1  groo /*	$NetBSD: envstat.c,v 1.1 2000/03/10 05:51:58 groo Exp $ */
      2  1.1  groo 
      3  1.1  groo /*-
      4  1.1  groo  * Copyright (c) 2000 The NetBSD Foundation, Inc.
      5  1.1  groo  * All rights reserved.
      6  1.1  groo  *
      7  1.1  groo  * This code is derived from software contributed to The NetBSD Foundation
      8  1.1  groo  * by Bill Squier.
      9  1.1  groo  *
     10  1.1  groo  * Redistribution and use in source and binary forms, with or without
     11  1.1  groo  * modification, are permitted provided that the following conditions
     12  1.1  groo  * are met:
     13  1.1  groo  * 1. Redistributions of source code must retain the above copyright
     14  1.1  groo  *    notice, this list of conditions and the following disclaimer.
     15  1.1  groo  * 2. Redistributions in binary form must reproduce the above copyright
     16  1.1  groo  *    notice, this list of conditions and the following disclaimer in the
     17  1.1  groo  *    documentation and/or other materials provided with the distribution.
     18  1.1  groo  * 3. All advertising materials mentioning features or use of this software
     19  1.1  groo  *    must display the following acknowledgement:
     20  1.1  groo  *        This product includes software developed by the NetBSD
     21  1.1  groo  *        Foundation, Inc. and its contributors.
     22  1.1  groo  * 4. Neither the name of The NetBSD Foundation nor the names of its
     23  1.1  groo  *    contributors may be used to endorse or promote products derived
     24  1.1  groo  *    from this software without specific prior written permission.
     25  1.1  groo  *
     26  1.1  groo  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     27  1.1  groo  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     28  1.1  groo  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     29  1.1  groo  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     30  1.1  groo  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     31  1.1  groo  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     32  1.1  groo  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     33  1.1  groo  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     34  1.1  groo  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     35  1.1  groo  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     36  1.1  groo  * POSSIBILITY OF SUCH DAMAGE.
     37  1.1  groo  */
     38  1.1  groo 
     39  1.1  groo #include <sys/cdefs.h>
     40  1.1  groo #ifndef lint
     41  1.1  groo __RCSID("$NetBSD: envstat.c,v 1.1 2000/03/10 05:51:58 groo Exp $");
     42  1.1  groo #endif
     43  1.1  groo 
     44  1.1  groo #include <fcntl.h>
     45  1.1  groo #include <stdio.h>
     46  1.1  groo #include <stdlib.h>
     47  1.1  groo #include <string.h>
     48  1.1  groo #include <unistd.h>
     49  1.1  groo 
     50  1.1  groo #include <sys/envsys.h>
     51  1.1  groo #include <sys/ioctl.h>
     52  1.1  groo 
     53  1.1  groo extern char *__progname;
     54  1.1  groo const char E_CANTENUM[] = "envsys: cannot enumerate sensors\n";
     55  1.1  groo 
     56  1.1  groo int main __P((int, char **));
     57  1.1  groo void listsensors __P((envsys_basic_info_t *, int));
     58  1.1  groo int numsensors __P((int));
     59  1.1  groo int fillsensors __P((int, envsys_tre_data_t *, envsys_basic_info_t *, int));
     60  1.1  groo int longestname __P((envsys_basic_info_t *, int));
     61  1.1  groo int marksensors __P((envsys_basic_info_t *, int *, char *, int));
     62  1.1  groo int strtosnum __P((envsys_basic_info_t *, const char *, int));
     63  1.1  groo void header __P((unsigned, int, envsys_basic_info_t *, const int * const,
     64  1.1  groo 		 int));
     65  1.1  groo void values __P((unsigned, int, envsys_tre_data_t *, const int * const, int));
     66  1.1  groo void usage __P((void));
     67  1.1  groo 
     68  1.1  groo 
     69  1.1  groo int
     70  1.1  groo main(argc, argv)
     71  1.1  groo 	int argc;
     72  1.1  groo 	char **argv;
     73  1.1  groo {
     74  1.1  groo 	extern int optind;
     75  1.1  groo 	extern char *optarg;
     76  1.1  groo 	int c, fd, ns, ls, celsius;
     77  1.1  groo 	unsigned int interval, width, headrep, headcnt;
     78  1.1  groo 	envsys_tre_data_t *etds;
     79  1.1  groo 	envsys_basic_info_t *ebis;
     80  1.1  groo 	int *cetds;
     81  1.1  groo 	char *sensors;
     82  1.1  groo 
     83  1.1  groo 	fd = -1;
     84  1.1  groo 	ls = 0;
     85  1.1  groo 	celsius = 1;
     86  1.1  groo 	interval = 0;
     87  1.1  groo 	width = 0;
     88  1.1  groo 	sensors = NULL;
     89  1.1  groo 	headrep = 22;
     90  1.1  groo 
     91  1.1  groo 	while ((c = getopt(argc, argv, "cfi:ln:s:w:")) != -1) {
     92  1.1  groo 		switch(c) {
     93  1.1  groo 		case 'i':	/* wait time between displays */
     94  1.1  groo 			interval = atoi(optarg);
     95  1.1  groo 			break;
     96  1.1  groo 		case 'w':	/* minimum column width */
     97  1.1  groo 			width = atoi(optarg);
     98  1.1  groo 			break;
     99  1.1  groo 		case 'l':	/* list sensor names */
    100  1.1  groo 			ls = 1;
    101  1.1  groo 			break;
    102  1.1  groo 		case 'n':	/* repeat header every headrep lines */
    103  1.1  groo 			headrep = atoi(optarg);
    104  1.1  groo 			break;
    105  1.1  groo 		case 's':	/* restrict display to named sensors */
    106  1.1  groo 			sensors = (char *)malloc(strlen(optarg) + 1);
    107  1.1  groo 			if (sensors == NULL)
    108  1.1  groo 				exit(1);
    109  1.1  groo 			strcpy(sensors, optarg);
    110  1.1  groo 			break;
    111  1.1  groo 		case 'f':	/* display temp in degF */
    112  1.1  groo 			celsius = 0;
    113  1.1  groo 			break;
    114  1.1  groo 		case '?':
    115  1.1  groo 		default:
    116  1.1  groo 			usage();
    117  1.1  groo 			/* NOTREACHED */
    118  1.1  groo 		}
    119  1.1  groo 	}
    120  1.1  groo 
    121  1.1  groo 	if (optind < argc) {
    122  1.1  groo 		if ((fd = open(argv[optind], O_RDONLY)) == -1) {
    123  1.1  groo 			perror("envstat");
    124  1.1  groo 			exit(1);
    125  1.1  groo 		}
    126  1.1  groo 	} else {
    127  1.1  groo 		fprintf(stderr, "envstat: no device specified\n");
    128  1.1  groo 		usage();
    129  1.1  groo 	}
    130  1.1  groo 
    131  1.1  groo 
    132  1.1  groo 	/*
    133  1.1  groo 	 * Determine number of sensors, allocate and fill arrays with
    134  1.1  groo 	 * initial information.  Determine column width
    135  1.1  groo 	 */
    136  1.1  groo 	if ((ns = numsensors(fd)) <= 0) {
    137  1.1  groo 		fprintf(stderr, E_CANTENUM);
    138  1.1  groo 		exit(1);
    139  1.1  groo 	}
    140  1.1  groo 
    141  1.1  groo 	cetds = (int *)malloc(ns * sizeof(int));
    142  1.1  groo 	etds = (envsys_tre_data_t *)malloc(ns * sizeof(envsys_tre_data_t));
    143  1.1  groo 	ebis = (envsys_basic_info_t *)malloc(ns * sizeof(envsys_basic_info_t));
    144  1.1  groo 
    145  1.1  groo 	if ((cetds == NULL) || (etds == NULL) || (ebis == NULL)) {
    146  1.1  groo 		fprintf(stderr, "envstat: cannot allocate memory\n");
    147  1.1  groo 		exit(1);
    148  1.1  groo 	}
    149  1.1  groo 
    150  1.1  groo 	if (fillsensors(fd, etds, ebis, ns) == -1) {
    151  1.1  groo 		fprintf(stderr, E_CANTENUM);
    152  1.1  groo 		exit(1);
    153  1.1  groo 	}
    154  1.1  groo 
    155  1.1  groo 
    156  1.1  groo 	if (ls) {
    157  1.1  groo 		listsensors(ebis, ns);
    158  1.1  groo 		exit(0);
    159  1.1  groo 	}
    160  1.1  groo 
    161  1.1  groo 
    162  1.1  groo #define MAX(x, y)  (((x) > (y)) ? (x) : (y))
    163  1.1  groo 	if (!width) {
    164  1.1  groo 		width = longestname(ebis, ns);
    165  1.1  groo 		width = MAX(((79 - ns) / ns), width);
    166  1.1  groo 	}
    167  1.1  groo 
    168  1.1  groo 	/* Mark which sensor numbers are to be displayed */
    169  1.1  groo 	if (marksensors(ebis, cetds, sensors, ns) == -1)
    170  1.1  groo 		exit(1);
    171  1.1  groo 
    172  1.1  groo 	/* If we didn't specify an interval value, print the sensors once */
    173  1.1  groo 	if (!interval) {
    174  1.1  groo 		if (headrep)
    175  1.1  groo 			header(width, celsius, ebis, cetds, ns);
    176  1.1  groo 		values(width, celsius, etds, cetds, ns);
    177  1.1  groo 
    178  1.1  groo 		exit (0);
    179  1.1  groo 	}
    180  1.1  groo 
    181  1.1  groo 	headcnt = 0;
    182  1.1  groo 	if (headrep)
    183  1.1  groo 		header(width, celsius, ebis, cetds, ns);
    184  1.1  groo 
    185  1.1  groo         for (;;) {
    186  1.1  groo 		values(width, celsius, etds, cetds, ns);
    187  1.1  groo 		if (headrep && (++headcnt == headrep)) {
    188  1.1  groo 			headcnt = 0;
    189  1.1  groo 			header(width, celsius, ebis, cetds, ns);
    190  1.1  groo 		}
    191  1.1  groo 
    192  1.1  groo 		sleep(interval);
    193  1.1  groo 
    194  1.1  groo 		if (fillsensors(fd, etds, ebis, ns) == -1) {
    195  1.1  groo 			fprintf(stderr, E_CANTENUM);
    196  1.1  groo 			exit(1);
    197  1.1  groo 		}
    198  1.1  groo 	}
    199  1.1  groo 
    200  1.1  groo 	/* NOTREACHED */
    201  1.1  groo 	return (0);
    202  1.1  groo }
    203  1.1  groo 
    204  1.1  groo 
    205  1.1  groo static const char *unit_str[] = {"degC", "RPM", "VAC", "Vcc", "Ohms", "Watts",
    206  1.1  groo 				 "Amps", "Ukn"};
    207  1.1  groo 
    208  1.1  groo /*
    209  1.1  groo  * pre:  cetds[i] != 0 iff sensor i should appear in the output
    210  1.1  groo  * post: a column header line is displayed on stdout
    211  1.1  groo  */
    212  1.1  groo void
    213  1.1  groo header(width, celsius, ebis, cetds, ns)
    214  1.1  groo 	unsigned width;
    215  1.1  groo 	int celsius;
    216  1.1  groo 	envsys_basic_info_t *ebis;
    217  1.1  groo 	const int * const cetds;
    218  1.1  groo 	int ns;
    219  1.1  groo {
    220  1.1  groo 	int i;
    221  1.1  groo 	const char *s;
    222  1.1  groo 
    223  1.1  groo 	/* sensor names */
    224  1.1  groo 	for (i = 0; i < ns; ++i)
    225  1.1  groo 		if (cetds[i])
    226  1.1  groo 			printf(" %*.*s", (int)width, (int)width, ebis[i].desc);
    227  1.1  groo 
    228  1.1  groo 	printf("\n");
    229  1.1  groo 
    230  1.1  groo 	/* units */
    231  1.1  groo 	for (i = 0; i < ns; ++i)
    232  1.1  groo 		if (cetds[i]) {
    233  1.1  groo 			if ((ebis[i].units == ENVSYS_STEMP) &&
    234  1.1  groo 			    !celsius)
    235  1.1  groo 				s = "degF";
    236  1.1  groo 			else if (ebis[i].units > 6)
    237  1.1  groo 				s = unit_str[7];
    238  1.1  groo 			else
    239  1.1  groo 				s = unit_str[ebis[i].units];
    240  1.1  groo 
    241  1.1  groo 			printf(" %*.*s", (int)width, (int)width, s);
    242  1.1  groo 		}
    243  1.1  groo 	printf("\n");
    244  1.1  groo }
    245  1.1  groo 
    246  1.1  groo void
    247  1.1  groo values(width, celsius, etds, cetds, ns)
    248  1.1  groo 	unsigned width;
    249  1.1  groo 	int celsius;
    250  1.1  groo 	envsys_tre_data_t *etds;
    251  1.1  groo 	const int * const cetds;
    252  1.1  groo 	int ns;
    253  1.1  groo {
    254  1.1  groo 	int i;
    255  1.1  groo 	double temp;
    256  1.1  groo 
    257  1.1  groo 	for (i = 0; i < ns; ++i)
    258  1.1  groo 		if (cetds[i]) {
    259  1.1  groo 
    260  1.1  groo 			/* * sensors without valid data */
    261  1.1  groo 			if ((etds[i].validflags & ENVSYS_FCURVALID) == 0) {
    262  1.1  groo 				printf(" %*.*s", (int)width, (int)width, "*");
    263  1.1  groo 				continue;
    264  1.1  groo 			}
    265  1.1  groo 
    266  1.1  groo 			switch(etds[i].units) {
    267  1.1  groo 			case ENVSYS_STEMP:
    268  1.1  groo 				temp = (etds[i].cur.data_us / 1000000.0) -
    269  1.1  groo 				    273.15;
    270  1.1  groo 				if (!celsius)
    271  1.1  groo 					temp = (9.0 / 5.0) * temp + 32.0;
    272  1.1  groo 				printf(" %*.2f", width, temp);
    273  1.1  groo 				break;
    274  1.1  groo 			case ENVSYS_SFANRPM:
    275  1.1  groo 				printf(" %*u", width, etds[i].cur.data_us);
    276  1.1  groo 				break;
    277  1.1  groo 			default:
    278  1.1  groo 				printf(" %*.2f", width, etds[i].cur.data_s /
    279  1.1  groo 				       1000000.0);
    280  1.1  groo 				break;
    281  1.1  groo 			}
    282  1.1  groo 		}
    283  1.1  groo 	printf("\n");
    284  1.1  groo }
    285  1.1  groo 
    286  1.1  groo 
    287  1.1  groo /*
    288  1.1  groo  * post: displays usage on stderr
    289  1.1  groo  */
    290  1.1  groo void
    291  1.1  groo usage()
    292  1.1  groo {
    293  1.1  groo 	fprintf(stderr, "usage: %s [-c] [-s s1,s2,...]", __progname);
    294  1.1  groo 	fprintf(stderr, " [-i interval] [-n headrep] [-w width] device\n");
    295  1.1  groo 	fprintf(stderr, "       envstat -l device\n");
    296  1.1  groo 	exit(1);
    297  1.1  groo }
    298  1.1  groo 
    299  1.1  groo 
    300  1.1  groo /*
    301  1.1  groo  * post: a list of sensor names supported by the device is displayed on stdout
    302  1.1  groo  */
    303  1.1  groo void
    304  1.1  groo listsensors(ebis, ns)
    305  1.1  groo 	envsys_basic_info_t *ebis;
    306  1.1  groo 	int ns;
    307  1.1  groo {
    308  1.1  groo 	int i;
    309  1.1  groo 
    310  1.1  groo 	for (i = 0; i < ns; ++i)
    311  1.1  groo 		if (ebis[i].validflags & ENVSYS_FVALID)
    312  1.1  groo 			printf("%s\n", ebis[i].desc);
    313  1.1  groo }
    314  1.1  groo 
    315  1.1  groo 
    316  1.1  groo /*
    317  1.1  groo  * pre:  fd contains a valid file descriptor of an envsys(4) supporting device
    318  1.1  groo  * post: returns the number of valid sensors provided by the device
    319  1.1  groo  *       or -1 on error
    320  1.1  groo  */
    321  1.1  groo int
    322  1.1  groo numsensors(fd)
    323  1.1  groo 	int fd;
    324  1.1  groo {
    325  1.1  groo 	int count = 0, valid = 1;
    326  1.1  groo 	envsys_tre_data_t etd;
    327  1.1  groo 	etd.sensor = 0;
    328  1.1  groo 
    329  1.1  groo 	while (valid) {
    330  1.1  groo 		if (ioctl(fd, ENVSYS_GTREDATA, &etd) == -1) {
    331  1.1  groo 			fprintf(stderr, E_CANTENUM);
    332  1.1  groo 			exit(1);
    333  1.1  groo 		}
    334  1.1  groo 
    335  1.1  groo 		valid = etd.validflags & ENVSYS_FVALID;
    336  1.1  groo 		if (valid)
    337  1.1  groo 			++count;
    338  1.1  groo 
    339  1.1  groo 		++etd.sensor;
    340  1.1  groo 	}
    341  1.1  groo 
    342  1.1  groo 	return count;
    343  1.1  groo }
    344  1.1  groo 
    345  1.1  groo /*
    346  1.1  groo  * pre:  fd contains a valid file descriptor of an envsys(4) supporting device
    347  1.1  groo  *       && ns is the number of sensors
    348  1.1  groo  *       && etds and ebis are arrays of sufficient size
    349  1.1  groo  * post: returns 0 and etds and ebis arrays are filled with sensor info
    350  1.1  groo  *       or returns -1 on failure
    351  1.1  groo  */
    352  1.1  groo int
    353  1.1  groo fillsensors(fd, etds, ebis, ns)
    354  1.1  groo 	int fd;
    355  1.1  groo 	envsys_tre_data_t *etds;
    356  1.1  groo 	envsys_basic_info_t *ebis;
    357  1.1  groo 	int ns;
    358  1.1  groo {
    359  1.1  groo 	int i;
    360  1.1  groo 
    361  1.1  groo 	for (i = 0; i < ns; ++i) {
    362  1.1  groo 		ebis[i].sensor = i;
    363  1.1  groo 		if (ioctl(fd, ENVSYS_GTREINFO, &ebis[i]) == -1)
    364  1.1  groo 			return -1;
    365  1.1  groo 
    366  1.1  groo 		etds[i].sensor = i;
    367  1.1  groo 		if (ioctl(fd, ENVSYS_GTREDATA, &etds[i]) == -1)
    368  1.1  groo 			return -1;
    369  1.1  groo 	}
    370  1.1  groo 
    371  1.1  groo 	return 0;
    372  1.1  groo }
    373  1.1  groo 
    374  1.1  groo 
    375  1.1  groo /*
    376  1.1  groo  * post: returns the strlen() of the longest sensor name
    377  1.1  groo  */
    378  1.1  groo int
    379  1.1  groo longestname(ebis, ns)
    380  1.1  groo 	envsys_basic_info_t *ebis;
    381  1.1  groo 	int ns;
    382  1.1  groo {
    383  1.1  groo 	int i, maxlen, cur;
    384  1.1  groo 
    385  1.1  groo 	maxlen = 0;
    386  1.1  groo 
    387  1.1  groo 	for (i = 0; i < ns; ++i) {
    388  1.1  groo 		cur = strlen(ebis[i].desc);
    389  1.1  groo 		if (cur > maxlen)
    390  1.1  groo 			maxlen = cur;
    391  1.1  groo 	}
    392  1.1  groo 
    393  1.1  groo 	return maxlen;
    394  1.1  groo }
    395  1.1  groo 
    396  1.1  groo /*
    397  1.1  groo  * post: returns 0 and cetds[i] != 0 iff sensor i should appear in the output
    398  1.1  groo  *       or returns -1
    399  1.1  groo  */
    400  1.1  groo int
    401  1.1  groo marksensors(ebis, cetds, sensors, ns)
    402  1.1  groo 	envsys_basic_info_t *ebis;
    403  1.1  groo 	int *cetds;
    404  1.1  groo 	char *sensors;
    405  1.1  groo 	int ns;
    406  1.1  groo {
    407  1.1  groo 	int i;
    408  1.1  groo 	char *s;
    409  1.1  groo 
    410  1.1  groo 	if (sensors == NULL) {
    411  1.1  groo 		/* No sensors specified, include them all */
    412  1.1  groo 		for (i = 0; i < ns; ++i)
    413  1.1  groo 			cetds[i] = 1;
    414  1.1  groo 
    415  1.1  groo 		return 0;
    416  1.1  groo 	}
    417  1.1  groo 
    418  1.1  groo 	/* Assume no sensors in display */
    419  1.1  groo 	memset(cetds, 0, ns * sizeof(int));
    420  1.1  groo 
    421  1.1  groo 	s = strtok(sensors, ",");
    422  1.1  groo 	while (s != NULL) {
    423  1.1  groo 		if ((i = strtosnum(ebis, s, ns)) != -1)
    424  1.1  groo 			cetds[i] = 1;
    425  1.1  groo 		else {
    426  1.1  groo 			fprintf(stderr, "envstat: unknown sensor %s\n", s);
    427  1.1  groo 			return (-1);
    428  1.1  groo 		}
    429  1.1  groo 
    430  1.1  groo 		s = strtok(NULL, ",");
    431  1.1  groo 	}
    432  1.1  groo 
    433  1.1  groo 	/* Check if we have at least one sensor selected for output */
    434  1.1  groo 	for (i = 0; i < ns; ++i)
    435  1.1  groo 		if (cetds[i] == 1)
    436  1.1  groo 			return (0);
    437  1.1  groo 
    438  1.1  groo 	fprintf(stderr, "envstat: no sensors selected for display\n");
    439  1.1  groo 	return (-1);
    440  1.1  groo }
    441  1.1  groo 
    442  1.1  groo 
    443  1.1  groo /*
    444  1.1  groo  * returns -1 if s is not a valid sensor name for the device
    445  1.1  groo  *       or the sensor number of a sensor which has that name
    446  1.1  groo  */
    447  1.1  groo int
    448  1.1  groo strtosnum(ebis, s, ns)
    449  1.1  groo 	envsys_basic_info_t *ebis;
    450  1.1  groo 	const char *s;
    451  1.1  groo 	int ns;
    452  1.1  groo {
    453  1.1  groo 	int i;
    454  1.1  groo 
    455  1.1  groo 	for (i = 0; i < ns; ++i) {
    456  1.1  groo 		if((ebis[i].validflags & ENVSYS_FVALID) &&
    457  1.1  groo 		   !strcmp(s, ebis[i].desc))
    458  1.1  groo 			return ebis[i].sensor;
    459  1.1  groo 	}
    460  1.1  groo 
    461  1.1  groo 	return -1;
    462  1.1  groo }
    463