led_display: split led display support into generic and hw-dependent parts

[u-boot] / common / hwconfig.c

diff --git a/common/hwconfig.c b/common/hwconfig.c
index e5c60ba7a40a415d5bf10447f697336affd24058..1f9f4a09b4b5a2293c995a9ef4a714b7a60099d0 100644 (file)
--- a/common/hwconfig.c
+++ b/common/hwconfig.c
@@ -11,15 +11,23 @@
  * the License, or (at your option) any later version.
  */
 
+#ifndef HWCONFIG_TEST
 #include <config.h>
 #include <common.h>
 #include <exports.h>
 #include <hwconfig.h>
 #include <linux/types.h>
 #include <linux/string.h>
+#else
+#include <stdio.h>
+#include <stdlib.h>
+#include <string.h>
+#include <assert.h>
+#define min(a, b) (((a) < (b)) ? (a) : (b))
+#endif /* HWCONFIG_TEST */
 
 static const char *hwconfig_parse(const char *opts, size_t maxlen,
-                                 const char *opt, char stopch, char eqch,
+                                 const char *opt, char *stopchs, char eqch,
                                  size_t *arglen)
 {
        size_t optlen = strlen(opt);
@@ -33,8 +41,9 @@ next:
        if (end - start > maxlen)
                return NULL;
 
-       if (str && (str == opts || str[-1] == stopch) &&
-                       (*end == stopch || *end == eqch || *end == '\0')) {
+       if (str && (str == opts || strpbrk(str - 1, stopchs) == str - 1) &&
+                       (strpbrk(end, stopchs) == end || *end == eqch ||
+                        *end == '\0')) {
                const char *arg_end;
 
                if (!arglen)
@@ -43,7 +52,7 @@ next:
                if (*end != eqch)
                        return NULL;
 
-               arg_end = strchr(str, stopch);
+               arg_end = strpbrk(str, stopchs);
                if (!arg_end)
                        *arglen = min(maxlen, strlen(str)) - optlen - 1;
                else
@@ -66,15 +75,15 @@ static const char *__hwconfig(const char *opt, size_t *arglen)
 
        if (env_hwconfig)
                return hwconfig_parse(env_hwconfig, strlen(env_hwconfig),
-                                     opt, ';', ':', arglen);
+                                     opt, ";", ':', arglen);
 
        if (board_hwconfig)
                return hwconfig_parse(board_hwconfig, strlen(board_hwconfig),
-                                     opt, ';', ':', arglen);
+                                     opt, ";", ':', arglen);
 
        if (cpu_hwconfig)
                return hwconfig_parse(cpu_hwconfig, strlen(cpu_hwconfig),
-                                     opt, ';', ':', arglen);
+                                     opt, ";", ':', arglen);
 
        return NULL;
 }
@@ -164,7 +173,7 @@ int hwconfig_sub(const char *opt, const char *subopt)
        arg = __hwconfig(opt, &arglen);
        if (!arg)
                return 0;
-       return !!hwconfig_parse(arg, arglen, subopt, ',', '=', NULL);
+       return !!hwconfig_parse(arg, arglen, subopt, ",;", '=', NULL);
 }
 
 /*
@@ -185,7 +194,7 @@ const char *hwconfig_subarg(const char *opt, const char *subopt,
        arg = __hwconfig(opt, &arglen);
        if (!arg)
                return NULL;
-       return hwconfig_parse(arg, arglen, subopt, ',', '=', subarglen);
+       return hwconfig_parse(arg, arglen, subopt, ",;", '=', subarglen);
 }
 
 /*
@@ -208,3 +217,50 @@ int hwconfig_subarg_cmp(const char *opt, const char *subopt, const char *subarg)
 
        return !strncmp(argstr, subarg, arglen);
 }
+
+#ifdef HWCONFIG_TEST
+int main()
+{
+       const char *ret;
+       size_t len;
+
+       setenv("hwconfig", "key1:subkey1=value1,subkey2=value2;key2:value3;;;;"
+                          "key3;:,:=;key4", 1);
+
+       ret = hwconfig_arg("key1", &len);
+       printf("%zd %.*s\n", len, (int)len, ret);
+       assert(len == 29);
+       assert(hwconfig_arg_cmp("key1", "subkey1=value1,subkey2=value2"));
+       assert(!strncmp(ret, "subkey1=value1,subkey2=value2", len));
+
+       ret = hwconfig_subarg("key1", "subkey1", &len);
+       printf("%zd %.*s\n", len, (int)len, ret);
+       assert(len == 6);
+       assert(hwconfig_subarg_cmp("key1", "subkey1", "value1"));
+       assert(!strncmp(ret, "value1", len));
+
+       ret = hwconfig_subarg("key1", "subkey2", &len);
+       printf("%zd %.*s\n", len, (int)len, ret);
+       assert(len == 6);
+       assert(hwconfig_subarg_cmp("key1", "subkey2", "value2"));
+       assert(!strncmp(ret, "value2", len));
+
+       ret = hwconfig_arg("key2", &len);
+       printf("%zd %.*s\n", len, (int)len, ret);
+       assert(len == 6);
+       assert(hwconfig_arg_cmp("key2", "value3"));
+       assert(!strncmp(ret, "value3", len));
+
+       assert(hwconfig("key3"));
+       assert(hwconfig_arg("key4", &len) == NULL);
+       assert(hwconfig_arg("bogus", &len) == NULL);
+
+       unsetenv("hwconfig");
+
+       assert(hwconfig(NULL) == 0);
+       assert(hwconfig("") == 0);
+       assert(hwconfig("key3") == 0);
+
+       return 0;
+}
+#endif /* HWCONFIG_TEST */