1 /* $NetBSD: dev_verbose.c,v 1.1 2014/09/21 14:30:22 christos 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.1 2014/09/21 14:30:22 christos 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 uint16_t *token, char *buf, 41 size_t len) 42 { 43 char *cp = buf; 44 45 buf[0] = '\0'; 46 for (; *token != 0; token++) { 47 cp = buf + strlcat(buf, words + *token, len - 2); 48 cp[0] = ' '; 49 cp[1] = '\0'; 50 } 51 *cp = '\0'; 52 return cp != buf ? buf : NULL; 53 } 54 55 const char * 56 dev_findvendor(char *buf, size_t len, const char *words, size_t nwords, 57 const uint16_t *vendors, size_t nvendors, uint16_t vendor) 58 { 59 size_t n; 60 61 for (n = 0; n < nvendors; n++) { 62 if (vendors[n] == vendor) 63 return dev_untokenstring(words, &vendors[n + 1], 64 buf, len); 65 66 /* Skip Tokens */ 67 n++; 68 while (vendors[n] != 0 && n < nvendors) 69 n++; 70 } 71 snprintf(buf, len, "vendor %4.4x", vendor); 72 return NULL; 73 } 74 75 const char * 76 dev_findproduct(char *buf, size_t len, const char *words, size_t nwords, 77 const uint16_t *products, size_t nproducts, uint16_t vendor, 78 uint16_t product) 79 { 80 size_t n; 81 82 for (n = 0; n < nproducts; n++) { 83 if (products[n] == vendor && products[n + 1] == product) 84 return dev_untokenstring(words, &products[n + 2], 85 buf, len); 86 87 /* Skip Tokens */ 88 n += 2; 89 while (products[n] != 0 && n < nproducts) 90 n++; 91 } 92 snprintf(buf, len, "product %4.4x", product); 93 return NULL; 94 } 95