18d59ecb2SHans Petter Selasky /*-
28d59ecb2SHans Petter Selasky * Copyright (c) 2010 Isilon Systems, Inc.
38d59ecb2SHans Petter Selasky * Copyright (c) 2010 iX Systems, Inc.
48d59ecb2SHans Petter Selasky * Copyright (c) 2010 Panasas, Inc.
5fe68f570SHans Petter Selasky * Copyright (c) 2013-2016 Mellanox Technologies, Ltd.
68d59ecb2SHans Petter Selasky * Copyright (c) 2014-2015 François Tigeot
78d59ecb2SHans Petter Selasky * All rights reserved.
88d59ecb2SHans Petter Selasky *
98d59ecb2SHans Petter Selasky * Redistribution and use in source and binary forms, with or without
108d59ecb2SHans Petter Selasky * modification, are permitted provided that the following conditions
118d59ecb2SHans Petter Selasky * are met:
128d59ecb2SHans Petter Selasky * 1. Redistributions of source code must retain the above copyright
138d59ecb2SHans Petter Selasky * notice unmodified, this list of conditions, and the following
148d59ecb2SHans Petter Selasky * disclaimer.
158d59ecb2SHans Petter Selasky * 2. Redistributions in binary form must reproduce the above copyright
168d59ecb2SHans Petter Selasky * notice, this list of conditions and the following disclaimer in the
178d59ecb2SHans Petter Selasky * documentation and/or other materials provided with the distribution.
188d59ecb2SHans Petter Selasky *
198d59ecb2SHans Petter Selasky * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
208d59ecb2SHans Petter Selasky * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
218d59ecb2SHans Petter Selasky * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
228d59ecb2SHans Petter Selasky * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
238d59ecb2SHans Petter Selasky * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
248d59ecb2SHans Petter Selasky * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
258d59ecb2SHans Petter Selasky * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
268d59ecb2SHans Petter Selasky * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
278d59ecb2SHans Petter Selasky * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
288d59ecb2SHans Petter Selasky * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
298d59ecb2SHans Petter Selasky */
30307f78f3SVladimir Kondratyev #ifndef _LINUXKPI_LINUX_KERNEL_H_
31307f78f3SVladimir Kondratyev #define _LINUXKPI_LINUX_KERNEL_H_
328d59ecb2SHans Petter Selasky
338d59ecb2SHans Petter Selasky #include <sys/cdefs.h>
348d59ecb2SHans Petter Selasky #include <sys/types.h>
358d59ecb2SHans Petter Selasky #include <sys/systm.h>
368d59ecb2SHans Petter Selasky #include <sys/param.h>
378d59ecb2SHans Petter Selasky #include <sys/libkern.h>
388d59ecb2SHans Petter Selasky #include <sys/stat.h>
398d59ecb2SHans Petter Selasky #include <sys/smp.h>
408d59ecb2SHans Petter Selasky #include <sys/stddef.h>
418d59ecb2SHans Petter Selasky #include <sys/syslog.h>
428f7eee5aSHans Petter Selasky #include <sys/time.h>
438d59ecb2SHans Petter Selasky
448d59ecb2SHans Petter Selasky #include <linux/bitops.h>
45c3a10c23SVladimir Kondratyev #include <linux/build_bug.h>
468d59ecb2SHans Petter Selasky #include <linux/compiler.h>
4721d85c41SVladimir Kondratyev #include <linux/container_of.h>
48fb884c72SVladimir Kondratyev #include <linux/kstrtox.h>
49265b5c16SVladimir Kondratyev #include <linux/limits.h>
509cc3f82dSVladimir Kondratyev #include <linux/math.h>
5118a9913fSVladimir Kondratyev #include <linux/minmax.h>
5243b4c006SBjoern A. Zeeb #include <linux/stringify.h>
538d59ecb2SHans Petter Selasky #include <linux/errno.h>
548d59ecb2SHans Petter Selasky #include <linux/types.h>
554b2cb13eSEmmanuel Vadot #include <linux/typecheck.h>
568d59ecb2SHans Petter Selasky #include <linux/jiffies.h>
578d59ecb2SHans Petter Selasky #include <linux/log2.h>
584b0552d5SJean-Sébastien Pédron #include <linux/kconfig.h>
5935555d47SHans Petter Selasky
608d59ecb2SHans Petter Selasky #include <asm/byteorder.h>
614b2cb13eSEmmanuel Vadot #include <asm/cpufeature.h>
624b2cb13eSEmmanuel Vadot #include <asm/processor.h>
6335555d47SHans Petter Selasky #include <asm/uaccess.h>
648d59ecb2SHans Petter Selasky
65d91cf060SJean-Sébastien Pédron #include <linux/stdarg.h>
66aef2a67bSHans Petter Selasky
678d59ecb2SHans Petter Selasky #define KERN_CONT ""
688d59ecb2SHans Petter Selasky #define KERN_EMERG "<0>"
698d59ecb2SHans Petter Selasky #define KERN_ALERT "<1>"
708d59ecb2SHans Petter Selasky #define KERN_CRIT "<2>"
718d59ecb2SHans Petter Selasky #define KERN_ERR "<3>"
728d59ecb2SHans Petter Selasky #define KERN_WARNING "<4>"
738d59ecb2SHans Petter Selasky #define KERN_NOTICE "<5>"
748d59ecb2SHans Petter Selasky #define KERN_INFO "<6>"
758d59ecb2SHans Petter Selasky #define KERN_DEBUG "<7>"
768d59ecb2SHans Petter Selasky
77abb14a54SHans Petter Selasky #define S8_C(x) x
78abb14a54SHans Petter Selasky #define U8_C(x) x ## U
79abb14a54SHans Petter Selasky #define S16_C(x) x
80abb14a54SHans Petter Selasky #define U16_C(x) x ## U
81abb14a54SHans Petter Selasky #define S32_C(x) x
82abb14a54SHans Petter Selasky #define U32_C(x) x ## U
83abb14a54SHans Petter Selasky #define S64_C(x) x ## LL
84abb14a54SHans Petter Selasky #define U64_C(x) x ## ULL
85abb14a54SHans Petter Selasky
86abb14a54SHans Petter Selasky #define BUG() panic("BUG at %s:%d", __FILE__, __LINE__)
87abb14a54SHans Petter Selasky #define BUG_ON(cond) do { \
88abb14a54SHans Petter Selasky if (cond) { \
89abb14a54SHans Petter Selasky panic("BUG ON %s failed at %s:%d", \
90abb14a54SHans Petter Selasky __stringify(cond), __FILE__, __LINE__); \
91abb14a54SHans Petter Selasky } \
92abb14a54SHans Petter Selasky } while (0)
93abb14a54SHans Petter Selasky
942390a144SHans Petter Selasky extern int linuxkpi_warn_dump_stack;
95abb14a54SHans Petter Selasky #define WARN_ON(cond) ({ \
96abb14a54SHans Petter Selasky bool __ret = (cond); \
97abb14a54SHans Petter Selasky if (__ret) { \
98abb14a54SHans Petter Selasky printf("WARNING %s failed at %s:%d\n", \
99abb14a54SHans Petter Selasky __stringify(cond), __FILE__, __LINE__); \
1002390a144SHans Petter Selasky if (linuxkpi_warn_dump_stack) \
101a164a32bSAndriy Gapon linux_dump_stack(); \
102abb14a54SHans Petter Selasky } \
103abb14a54SHans Petter Selasky unlikely(__ret); \
104abb14a54SHans Petter Selasky })
105abb14a54SHans Petter Selasky
106abb14a54SHans Petter Selasky #define WARN_ON_SMP(cond) WARN_ON(cond)
107abb14a54SHans Petter Selasky
108abb14a54SHans Petter Selasky #define WARN_ON_ONCE(cond) ({ \
109abb14a54SHans Petter Selasky static bool __warn_on_once; \
110abb14a54SHans Petter Selasky bool __ret = (cond); \
111abb14a54SHans Petter Selasky if (__ret && !__warn_on_once) { \
112abb14a54SHans Petter Selasky __warn_on_once = 1; \
113abb14a54SHans Petter Selasky printf("WARNING %s failed at %s:%d\n", \
114abb14a54SHans Petter Selasky __stringify(cond), __FILE__, __LINE__); \
1152390a144SHans Petter Selasky if (linuxkpi_warn_dump_stack) \
116a164a32bSAndriy Gapon linux_dump_stack(); \
117abb14a54SHans Petter Selasky } \
118abb14a54SHans Petter Selasky unlikely(__ret); \
119abb14a54SHans Petter Selasky })
1208d59ecb2SHans Petter Selasky
121cb564d24SMark Johnston #define oops_in_progress SCHEDULER_STOPPED()
122cb564d24SMark Johnston
1238d59ecb2SHans Petter Selasky #undef ALIGN
1248d59ecb2SHans Petter Selasky #define ALIGN(x, y) roundup2((x), (y))
12597f2e93aSBjoern A. Zeeb #define ALIGN_DOWN(x, y) rounddown2(x, y)
1268d59ecb2SHans Petter Selasky #undef PTR_ALIGN
1278d59ecb2SHans Petter Selasky #define PTR_ALIGN(p, a) ((__typeof(p))ALIGN((uintptr_t)(p), (a)))
128c4e0746eSJohannes Lundberg #define IS_ALIGNED(x, a) (((x) & ((__typeof(x))(a) - 1)) == 0)
129bf05cd05SHans Petter Selasky #define __KERNEL_DIV_ROUND_UP(x, n) howmany(x, n)
1308d59ecb2SHans Petter Selasky #define FIELD_SIZEOF(t, f) sizeof(((t *)0)->f)
1318d59ecb2SHans Petter Selasky
132aef2a67bSHans Petter Selasky #define printk(...) printf(__VA_ARGS__)
133aef2a67bSHans Petter Selasky #define vprintk(f, a) vprintf(f, a)
134aef2a67bSHans Petter Selasky
135fbb9ca96SVladimir Kondratyev #define PTR_IF(x, p) ((x) ? (p) : NULL)
136fbb9ca96SVladimir Kondratyev
1370df8bab6SHans Petter Selasky #define asm __asm
1380df8bab6SHans Petter Selasky
139e35079dbSHans Petter Selasky extern void linux_dump_stack(void);
140e35079dbSHans Petter Selasky #define dump_stack() linux_dump_stack()
141e35079dbSHans Petter Selasky
142aef2a67bSHans Petter Selasky struct va_format {
143aef2a67bSHans Petter Selasky const char *fmt;
144aef2a67bSHans Petter Selasky va_list *va;
145aef2a67bSHans Petter Selasky };
146aef2a67bSHans Petter Selasky
147aef2a67bSHans Petter Selasky static inline int
vscnprintf(char * buf,size_t size,const char * fmt,va_list args)148aef2a67bSHans Petter Selasky vscnprintf(char *buf, size_t size, const char *fmt, va_list args)
149aef2a67bSHans Petter Selasky {
150aef2a67bSHans Petter Selasky ssize_t ssize = size;
151aef2a67bSHans Petter Selasky int i;
152aef2a67bSHans Petter Selasky
153aef2a67bSHans Petter Selasky i = vsnprintf(buf, size, fmt, args);
154aef2a67bSHans Petter Selasky
155aef2a67bSHans Petter Selasky return ((i >= ssize) ? (ssize - 1) : i);
156aef2a67bSHans Petter Selasky }
157aef2a67bSHans Petter Selasky
158aef2a67bSHans Petter Selasky static inline int
scnprintf(char * buf,size_t size,const char * fmt,...)159aef2a67bSHans Petter Selasky scnprintf(char *buf, size_t size, const char *fmt, ...)
160aef2a67bSHans Petter Selasky {
161aef2a67bSHans Petter Selasky va_list args;
162aef2a67bSHans Petter Selasky int i;
163aef2a67bSHans Petter Selasky
164aef2a67bSHans Petter Selasky va_start(args, fmt);
165aef2a67bSHans Petter Selasky i = vscnprintf(buf, size, fmt, args);
166aef2a67bSHans Petter Selasky va_end(args);
167aef2a67bSHans Petter Selasky
168aef2a67bSHans Petter Selasky return (i);
169aef2a67bSHans Petter Selasky }
1708d59ecb2SHans Petter Selasky
1718d59ecb2SHans Petter Selasky /*
1728d59ecb2SHans Petter Selasky * The "pr_debug()" and "pr_devel()" macros should produce zero code
1738d59ecb2SHans Petter Selasky * unless DEBUG is defined:
1748d59ecb2SHans Petter Selasky */
1758d59ecb2SHans Petter Selasky #ifdef DEBUG
1764580f5eaSHans Petter Selasky extern int linuxkpi_debug;
1778d59ecb2SHans Petter Selasky #define pr_debug(fmt, ...) \
1784580f5eaSHans Petter Selasky do { \
1794580f5eaSHans Petter Selasky if (linuxkpi_debug) \
1804580f5eaSHans Petter Selasky log(LOG_DEBUG, fmt, ##__VA_ARGS__); \
1814580f5eaSHans Petter Selasky } while (0)
1828d59ecb2SHans Petter Selasky #define pr_devel(fmt, ...) \
1838d59ecb2SHans Petter Selasky log(LOG_DEBUG, pr_fmt(fmt), ##__VA_ARGS__)
1848d59ecb2SHans Petter Selasky #else
1858d59ecb2SHans Petter Selasky #define pr_debug(fmt, ...) \
1868d59ecb2SHans Petter Selasky ({ if (0) log(LOG_DEBUG, fmt, ##__VA_ARGS__); 0; })
1878d59ecb2SHans Petter Selasky #define pr_devel(fmt, ...) \
1888d59ecb2SHans Petter Selasky ({ if (0) log(LOG_DEBUG, pr_fmt(fmt), ##__VA_ARGS__); 0; })
1898d59ecb2SHans Petter Selasky #endif
1908d59ecb2SHans Petter Selasky
1918d59ecb2SHans Petter Selasky #ifndef pr_fmt
1928d59ecb2SHans Petter Selasky #define pr_fmt(fmt) fmt
1938d59ecb2SHans Petter Selasky #endif
1948d59ecb2SHans Petter Selasky
1958d59ecb2SHans Petter Selasky /*
1968d59ecb2SHans Petter Selasky * Print a one-time message (analogous to WARN_ONCE() et al):
1978d59ecb2SHans Petter Selasky */
1988d59ecb2SHans Petter Selasky #define printk_once(...) do { \
1998d59ecb2SHans Petter Selasky static bool __print_once; \
2008d59ecb2SHans Petter Selasky \
2018d59ecb2SHans Petter Selasky if (!__print_once) { \
2028d59ecb2SHans Petter Selasky __print_once = true; \
2038d59ecb2SHans Petter Selasky printk(__VA_ARGS__); \
2048d59ecb2SHans Petter Selasky } \
2058d59ecb2SHans Petter Selasky } while (0)
2068d59ecb2SHans Petter Selasky
2078d59ecb2SHans Petter Selasky /*
2088d59ecb2SHans Petter Selasky * Log a one-time message (analogous to WARN_ONCE() et al):
2098d59ecb2SHans Petter Selasky */
2108d59ecb2SHans Petter Selasky #define log_once(level,...) do { \
2118d59ecb2SHans Petter Selasky static bool __log_once; \
2128d59ecb2SHans Petter Selasky \
213abb14a54SHans Petter Selasky if (unlikely(!__log_once)) { \
2148d59ecb2SHans Petter Selasky __log_once = true; \
2158d59ecb2SHans Petter Selasky log(level, __VA_ARGS__); \
2168d59ecb2SHans Petter Selasky } \
2178d59ecb2SHans Petter Selasky } while (0)
2188d59ecb2SHans Petter Selasky
2198d59ecb2SHans Petter Selasky #define pr_emerg(fmt, ...) \
2208d59ecb2SHans Petter Selasky log(LOG_EMERG, pr_fmt(fmt), ##__VA_ARGS__)
2218d59ecb2SHans Petter Selasky #define pr_alert(fmt, ...) \
2228d59ecb2SHans Petter Selasky log(LOG_ALERT, pr_fmt(fmt), ##__VA_ARGS__)
2238d59ecb2SHans Petter Selasky #define pr_crit(fmt, ...) \
2248d59ecb2SHans Petter Selasky log(LOG_CRIT, pr_fmt(fmt), ##__VA_ARGS__)
2258d59ecb2SHans Petter Selasky #define pr_err(fmt, ...) \
2268d59ecb2SHans Petter Selasky log(LOG_ERR, pr_fmt(fmt), ##__VA_ARGS__)
22705c2d94aSGreg V #define pr_err_once(fmt, ...) \
22805c2d94aSGreg V log_once(LOG_ERR, pr_fmt(fmt), ##__VA_ARGS__)
2298d59ecb2SHans Petter Selasky #define pr_warning(fmt, ...) \
2308d59ecb2SHans Petter Selasky log(LOG_WARNING, pr_fmt(fmt), ##__VA_ARGS__)
231abb14a54SHans Petter Selasky #define pr_warn(...) \
232abb14a54SHans Petter Selasky pr_warning(__VA_ARGS__)
233abb14a54SHans Petter Selasky #define pr_warn_once(fmt, ...) \
234abb14a54SHans Petter Selasky log_once(LOG_WARNING, pr_fmt(fmt), ##__VA_ARGS__)
2358d59ecb2SHans Petter Selasky #define pr_notice(fmt, ...) \
2368d59ecb2SHans Petter Selasky log(LOG_NOTICE, pr_fmt(fmt), ##__VA_ARGS__)
2378d59ecb2SHans Petter Selasky #define pr_info(fmt, ...) \
2388d59ecb2SHans Petter Selasky log(LOG_INFO, pr_fmt(fmt), ##__VA_ARGS__)
2398d59ecb2SHans Petter Selasky #define pr_info_once(fmt, ...) \
2408d59ecb2SHans Petter Selasky log_once(LOG_INFO, pr_fmt(fmt), ##__VA_ARGS__)
2418d59ecb2SHans Petter Selasky #define pr_cont(fmt, ...) \
2428d59ecb2SHans Petter Selasky printk(KERN_CONT fmt, ##__VA_ARGS__)
243e9db3df2SHans Petter Selasky #define pr_warn_ratelimited(...) do { \
2448f7eee5aSHans Petter Selasky static linux_ratelimit_t __ratelimited; \
245e9db3df2SHans Petter Selasky if (linux_ratelimited(&__ratelimited)) \
246e9db3df2SHans Petter Selasky pr_warning(__VA_ARGS__); \
247e9db3df2SHans Petter Selasky } while (0)
2488d59ecb2SHans Petter Selasky
2498d59ecb2SHans Petter Selasky #ifndef WARN
250abb14a54SHans Petter Selasky #define WARN(condition, ...) ({ \
251abb14a54SHans Petter Selasky bool __ret_warn_on = (condition); \
2528d59ecb2SHans Petter Selasky if (unlikely(__ret_warn_on)) \
253abb14a54SHans Petter Selasky pr_warning(__VA_ARGS__); \
254abb14a54SHans Petter Selasky unlikely(__ret_warn_on); \
255abb14a54SHans Petter Selasky })
256abb14a54SHans Petter Selasky #endif
257abb14a54SHans Petter Selasky
258abb14a54SHans Petter Selasky #ifndef WARN_ONCE
259abb14a54SHans Petter Selasky #define WARN_ONCE(condition, ...) ({ \
260abb14a54SHans Petter Selasky bool __ret_warn_on = (condition); \
261abb14a54SHans Petter Selasky if (unlikely(__ret_warn_on)) \
262abb14a54SHans Petter Selasky pr_warn_once(__VA_ARGS__); \
2638d59ecb2SHans Petter Selasky unlikely(__ret_warn_on); \
2648d59ecb2SHans Petter Selasky })
2658d59ecb2SHans Petter Selasky #endif
2668d59ecb2SHans Petter Selasky
2678d59ecb2SHans Petter Selasky #define ARRAY_SIZE(x) (sizeof(x) / sizeof((x)[0]))
2688d59ecb2SHans Petter Selasky
269ee7c3198SMark Johnston #define u64_to_user_ptr(val) ((void *)(uintptr_t)(val))
270ee7c3198SMark Johnston
271fee0d486SNeel Chauhan #define _RET_IP_ __builtin_return_address(0)
272fee0d486SNeel Chauhan
273355711eaSEmmanuel Vadot #define offsetofend(t, m) \
274355711eaSEmmanuel Vadot (offsetof(t, m) + sizeof((((t *)0)->m)))
275355711eaSEmmanuel Vadot
276fe68f570SHans Petter Selasky #define smp_processor_id() PCPU_GET(cpuid)
2778d59ecb2SHans Petter Selasky #define num_possible_cpus() mp_ncpus
2788d59ecb2SHans Petter Selasky #define num_online_cpus() mp_ncpus
27903219fbaSHans Petter Selasky
28003219fbaSHans Petter Selasky #if defined(__i386__) || defined(__amd64__)
28103219fbaSHans Petter Selasky extern bool linux_cpu_has_clflush;
28203219fbaSHans Petter Selasky #define cpu_has_clflush linux_cpu_has_clflush
28303219fbaSHans Petter Selasky #endif
2848d59ecb2SHans Petter Selasky
2858f7eee5aSHans Petter Selasky typedef struct linux_ratelimit {
2868f7eee5aSHans Petter Selasky struct timeval lasttime;
2878f7eee5aSHans Petter Selasky int counter;
2888f7eee5aSHans Petter Selasky } linux_ratelimit_t;
2898f7eee5aSHans Petter Selasky
2908f7eee5aSHans Petter Selasky static inline bool
linux_ratelimited(linux_ratelimit_t * rl)2918f7eee5aSHans Petter Selasky linux_ratelimited(linux_ratelimit_t *rl)
2928f7eee5aSHans Petter Selasky {
2938f7eee5aSHans Petter Selasky return (ppsratecheck(&rl->lasttime, &rl->counter, 1));
2948f7eee5aSHans Petter Selasky }
295e9db3df2SHans Petter Selasky
296d053391cSHans Petter Selasky #define __is_constexpr(x) \
297d053391cSHans Petter Selasky __builtin_constant_p(x)
298d053391cSHans Petter Selasky
299d326a6c7SHans Petter Selasky /*
300d326a6c7SHans Petter Selasky * The is_signed() macro below returns true if the passed data type is
301d326a6c7SHans Petter Selasky * signed. Else false is returned.
302d326a6c7SHans Petter Selasky */
303d326a6c7SHans Petter Selasky #define is_signed(datatype) (((datatype)-1 / (datatype)2) == (datatype)0)
304d0eed838SHans Petter Selasky
3050e4e9e8fSEmmanuel Vadot #define TAINT_WARN 0
3060e4e9e8fSEmmanuel Vadot #define test_taint(x) (0)
307bf27839aSEmmanuel Vadot #define add_taint(x,y) do { \
308bf27839aSEmmanuel Vadot } while (0)
3090e4e9e8fSEmmanuel Vadot
310deb9bfbdSBjoern A. Zeeb static inline int
_h2b(const char c)311deb9bfbdSBjoern A. Zeeb _h2b(const char c)
312deb9bfbdSBjoern A. Zeeb {
313deb9bfbdSBjoern A. Zeeb
314deb9bfbdSBjoern A. Zeeb if (c >= '0' && c <= '9')
315deb9bfbdSBjoern A. Zeeb return (c - '0');
316deb9bfbdSBjoern A. Zeeb if (c >= 'a' && c <= 'f')
317deb9bfbdSBjoern A. Zeeb return (10 + c - 'a');
318deb9bfbdSBjoern A. Zeeb if (c >= 'A' && c <= 'F')
319deb9bfbdSBjoern A. Zeeb return (10 + c - 'A');
320deb9bfbdSBjoern A. Zeeb return (-EINVAL);
321deb9bfbdSBjoern A. Zeeb }
322deb9bfbdSBjoern A. Zeeb
323deb9bfbdSBjoern A. Zeeb static inline int
hex2bin(uint8_t * bindst,const char * hexsrc,size_t binlen)324deb9bfbdSBjoern A. Zeeb hex2bin(uint8_t *bindst, const char *hexsrc, size_t binlen)
325deb9bfbdSBjoern A. Zeeb {
326deb9bfbdSBjoern A. Zeeb int hi4, lo4;
327deb9bfbdSBjoern A. Zeeb
328deb9bfbdSBjoern A. Zeeb while (binlen > 0) {
329deb9bfbdSBjoern A. Zeeb hi4 = _h2b(*hexsrc++);
330deb9bfbdSBjoern A. Zeeb lo4 = _h2b(*hexsrc++);
331deb9bfbdSBjoern A. Zeeb if (hi4 < 0 || lo4 < 0)
332deb9bfbdSBjoern A. Zeeb return (-EINVAL);
333deb9bfbdSBjoern A. Zeeb
334deb9bfbdSBjoern A. Zeeb *bindst++ = (hi4 << 4) | lo4;
335deb9bfbdSBjoern A. Zeeb binlen--;
336deb9bfbdSBjoern A. Zeeb }
337deb9bfbdSBjoern A. Zeeb
338deb9bfbdSBjoern A. Zeeb return (0);
339deb9bfbdSBjoern A. Zeeb }
340deb9bfbdSBjoern A. Zeeb
341f82cf28bSBjoern A. Zeeb static inline bool
mac_pton(const char * macin,uint8_t * macout)342f82cf28bSBjoern A. Zeeb mac_pton(const char *macin, uint8_t *macout)
343f82cf28bSBjoern A. Zeeb {
344f82cf28bSBjoern A. Zeeb const char *s, *d;
345*5942658cSZhenlei Huang uint8_t mac[6], hx, lx;
346f82cf28bSBjoern A. Zeeb int i;
347f82cf28bSBjoern A. Zeeb
348f82cf28bSBjoern A. Zeeb if (strlen(macin) < (3 * 6 - 1))
349f82cf28bSBjoern A. Zeeb return (false);
350f82cf28bSBjoern A. Zeeb
351f82cf28bSBjoern A. Zeeb i = 0;
352f82cf28bSBjoern A. Zeeb s = macin;
353f82cf28bSBjoern A. Zeeb do {
354f82cf28bSBjoern A. Zeeb /* Should we also support '-'-delimiters? */
355f82cf28bSBjoern A. Zeeb d = strchrnul(s, ':');
356f82cf28bSBjoern A. Zeeb hx = lx = 0;
357f82cf28bSBjoern A. Zeeb while (s < d) {
358f82cf28bSBjoern A. Zeeb /* Fail on abc:123:xxx:... */
359f82cf28bSBjoern A. Zeeb if ((d - s) > 2)
360f82cf28bSBjoern A. Zeeb return (false);
361f82cf28bSBjoern A. Zeeb /* We do support non-well-formed strings: 3:45:6:... */
362f82cf28bSBjoern A. Zeeb if ((d - s) > 1) {
363f82cf28bSBjoern A. Zeeb hx = _h2b(*s);
364f82cf28bSBjoern A. Zeeb if (hx < 0)
365f82cf28bSBjoern A. Zeeb return (false);
366f82cf28bSBjoern A. Zeeb s++;
367f82cf28bSBjoern A. Zeeb }
368f82cf28bSBjoern A. Zeeb lx = _h2b(*s);
369f82cf28bSBjoern A. Zeeb if (lx < 0)
370f82cf28bSBjoern A. Zeeb return (false);
371f82cf28bSBjoern A. Zeeb s++;
372f82cf28bSBjoern A. Zeeb }
373f82cf28bSBjoern A. Zeeb mac[i] = (hx << 4) | lx;
374f82cf28bSBjoern A. Zeeb i++;
375f82cf28bSBjoern A. Zeeb if (i >= 6)
376f82cf28bSBjoern A. Zeeb return (false);
377f82cf28bSBjoern A. Zeeb } while (d != NULL && *d != '\0');
378f82cf28bSBjoern A. Zeeb
379f82cf28bSBjoern A. Zeeb memcpy(macout, mac, 6);
380f82cf28bSBjoern A. Zeeb return (true);
381f82cf28bSBjoern A. Zeeb }
382f82cf28bSBjoern A. Zeeb
383c840d5ceSBjoern A. Zeeb #define DECLARE_FLEX_ARRAY(_t, _n) \
384fab601c5SBjoern A. Zeeb struct { struct { } __dummy_ ## _n; _t _n[0]; }
385c840d5ceSBjoern A. Zeeb
386307f78f3SVladimir Kondratyev #endif /* _LINUXKPI_LINUX_KERNEL_H_ */
387