sys/dev/dev_verbose.c

   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 }