Home | History | Annotate | Line # | Download | only in dev 
      1 /*	$NetBSD: dev_verbose.c,v 1.4 2021/06/29 21:03:36 pgoyette Exp $	*/
      2 
      3 /*
      4  * Redistribution and use in source and binary forms, with or without
      5  * modification, are permitted provided that the following conditions
      6  * are met:
      7  * 1. Redistributions of source code must retain the above copyright
      8  *    notice, this list of conditions and the following disclaimer.
      9  * 2. Redistributions in binary form must reproduce the above copyright
     10  *    notice, this list of conditions and the following disclaimer in the
     11  *    documentation and/or other materials provided with the distribution.
     12  *
     13  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     14  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     15  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     16  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     17  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     18  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     19  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     20  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     21  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
     22  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     23  */
     24 
     25 #include <sys/cdefs.h>
     26 __KERNEL_RCSID(0, "$NetBSD: dev_verbose.c,v 1.4 2021/06/29 21:03:36 pgoyette Exp $");
     27 
     28 #include <sys/param.h>
     29 
     30 #ifdef _KERNEL
     31 #include <sys/systm.h>
     32 #else
     33 #include <stdio.h>
     34 #include <string.h>
     35 #endif
     36 
     37 #include <dev/dev_verbose.h>
     38 
     39 static const char *
     40 dev_untokenstring(const char *words, const uint32_t *token, char *buf,
     41     size_t len)
     42 {
     43 	char *cp = buf;
     44 	size_t newlen;
     45 
     46 	buf[0] = '\0';
     47 	for (; *token != 0; token++) {
     48 		newlen = strlcat(buf, words + *token, len - 2);
     49 		if (newlen > len - 2)
     50 			newlen = len - 2;
     51 		cp = buf + newlen;
     52 		cp[0] = ' ';
     53 		cp[1] = '\0';
     54 	}
     55 	*cp = '\0';
     56 	return cp != buf ? buf : NULL;
     57 }
     58 
     59 const char *
     60 dev_findvendor(char *buf, size_t len, const char *words, size_t nwords,
     61     const uint32_t *vendors, size_t nvendors, uint32_t vendor,
     62     const char *fmt)
     63 {
     64 	size_t n;
     65 
     66 	for (n = 0; n < nvendors; n++) {
     67 		if (vendors[n] == vendor)
     68 			return dev_untokenstring(words, &vendors[n + 1],
     69 			    buf, len);
     70 
     71 		/* Skip Tokens */
     72 		n++;
     73 		while (n < nvendors && vendors[n] != 0)
     74 			n++;
     75 	}
     76 	snprintf(buf, len, fmt, vendor);
     77 	return NULL;
     78 }
     79 
     80 const char *
     81 dev_findproduct(char *buf, size_t len, const char *words, size_t nwords,
     82     const uint32_t *products, size_t nproducts, uint32_t vendor,
     83     uint32_t product, const char *fmt)
     84 {
     85 	size_t n;
     86 
     87 	for (n = 0; n < nproducts; n++) {
     88 		if (products[n] == vendor && products[n + 1] == product)
     89 			return dev_untokenstring(words, &products[n + 2],
     90 			    buf, len);
     91 
     92 		/* Skip Tokens */
     93 		n += 2;
     94 		while (n < nproducts && products[n] != 0)
     95 			n++;
     96 	}
     97 	snprintf(buf, len, fmt, product);
     98 	return NULL;
     99 }
    100