2009-07-08 13:19:16 -07:00
|
|
|
/*
|
2012-05-02 15:21:36 -07:00
|
|
|
* Copyright (c) 2008, 2009, 2010, 2011, 2012 Nicira, Inc.
|
2009-07-08 13:19:16 -07:00
|
|
|
*
|
2009-06-15 15:11:30 -07:00
|
|
|
* Licensed under the Apache License, Version 2.0 (the "License");
|
|
|
|
* you may not use this file except in compliance with the License.
|
|
|
|
* You may obtain a copy of the License at:
|
2009-07-08 13:19:16 -07:00
|
|
|
*
|
2009-06-15 15:11:30 -07:00
|
|
|
* http://www.apache.org/licenses/LICENSE-2.0
|
|
|
|
*
|
|
|
|
* Unless required by applicable law or agreed to in writing, software
|
|
|
|
* distributed under the License is distributed on an "AS IS" BASIS,
|
|
|
|
* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
|
|
|
* See the License for the specific language governing permissions and
|
|
|
|
* limitations under the License.
|
2009-07-08 13:19:16 -07:00
|
|
|
*/
|
|
|
|
|
|
|
|
#include <config.h>
|
|
|
|
#include "util.h"
|
2011-07-22 10:20:52 -07:00
|
|
|
#include <assert.h>
|
2009-07-08 13:19:16 -07:00
|
|
|
#include <errno.h>
|
2011-07-22 10:20:52 -07:00
|
|
|
#include <limits.h>
|
2009-07-08 13:19:16 -07:00
|
|
|
#include <stdarg.h>
|
2011-07-22 10:20:52 -07:00
|
|
|
#include <stdint.h>
|
2009-07-08 13:19:16 -07:00
|
|
|
#include <stdio.h>
|
|
|
|
#include <stdlib.h>
|
|
|
|
#include <string.h>
|
2012-07-30 11:36:06 -07:00
|
|
|
#include <sys/stat.h>
|
2010-03-16 15:06:11 -07:00
|
|
|
#include <unistd.h>
|
2012-01-17 16:38:23 -08:00
|
|
|
#include "byte-order.h"
|
2009-07-08 13:19:16 -07:00
|
|
|
#include "coverage.h"
|
2012-01-17 16:38:23 -08:00
|
|
|
#include "openvswitch/types.h"
|
2010-03-16 15:06:11 -07:00
|
|
|
#include "vlog.h"
|
|
|
|
|
2010-10-19 14:47:01 -07:00
|
|
|
VLOG_DEFINE_THIS_MODULE(util);
|
2010-07-16 11:02:49 -07:00
|
|
|
|
coverage: Make the coverage counters catalog program-specific.
Until now, the collection of coverage counters supported by a given OVS
program was not specific to that program. That means that, for example,
even though ovs-dpctl does not have anything to do with mac_learning, it
still has a coverage counter for it. This is confusing, at best.
This commit fixes the problem on some systems, in particular on ones that
use GCC and the GNU linker. It uses the feature of the GNU linker
described in its manual as:
If an orphaned section's name is representable as a C identifier then
the linker will automatically see PROVIDE two symbols: __start_SECNAME
and __end_SECNAME, where SECNAME is the name of the section. These
indicate the start address and end address of the orphaned section
respectively.
Systems that don't support these features retain the earlier behavior.
This commit also fixes the annoyance that files that include coverage
counters must be listed on COVERAGE_FILES in lib/automake.mk.
This commit also fixes the annoyance that modifying any source file that
includes a coverage counter caused all programs that link against
libopenvswitch.a to relink, even programs that the source file was not
linked into. For example, modifying ofproto/ofproto.c (which includes
coverage counters) caused tests/test-aes128 to relink, even though
test-aes128 does not link again ofproto.o.
2010-11-01 14:14:27 -07:00
|
|
|
COVERAGE_DEFINE(util_xalloc);
|
|
|
|
|
2012-07-18 10:30:47 -07:00
|
|
|
/* argv[0] without directory names. */
|
2009-07-08 13:19:16 -07:00
|
|
|
const char *program_name;
|
2012-07-18 10:30:47 -07:00
|
|
|
|
|
|
|
/* Ordinarily "" but set to "monitor" for a monitor process or "worker" for a
|
|
|
|
* worker process. */
|
|
|
|
const char *subprogram_name = "";
|
|
|
|
|
|
|
|
/* --version option output. */
|
2011-08-02 12:16:44 -07:00
|
|
|
static char *program_version;
|
2009-07-08 13:19:16 -07:00
|
|
|
|
|
|
|
void
|
2010-08-30 00:24:53 -07:00
|
|
|
out_of_memory(void)
|
2009-07-08 13:19:16 -07:00
|
|
|
{
|
2011-02-23 15:43:34 -08:00
|
|
|
ovs_abort(0, "virtual memory exhausted");
|
2009-07-08 13:19:16 -07:00
|
|
|
}
|
|
|
|
|
|
|
|
void *
|
2010-08-30 00:24:53 -07:00
|
|
|
xcalloc(size_t count, size_t size)
|
2009-07-08 13:19:16 -07:00
|
|
|
{
|
|
|
|
void *p = count && size ? calloc(count, size) : malloc(1);
|
|
|
|
COVERAGE_INC(util_xalloc);
|
|
|
|
if (p == NULL) {
|
|
|
|
out_of_memory();
|
|
|
|
}
|
|
|
|
return p;
|
|
|
|
}
|
|
|
|
|
2009-09-28 13:56:42 -07:00
|
|
|
void *
|
|
|
|
xzalloc(size_t size)
|
|
|
|
{
|
|
|
|
return xcalloc(1, size);
|
|
|
|
}
|
|
|
|
|
2009-07-08 13:19:16 -07:00
|
|
|
void *
|
2010-08-30 00:24:53 -07:00
|
|
|
xmalloc(size_t size)
|
2009-07-08 13:19:16 -07:00
|
|
|
{
|
|
|
|
void *p = malloc(size ? size : 1);
|
|
|
|
COVERAGE_INC(util_xalloc);
|
|
|
|
if (p == NULL) {
|
|
|
|
out_of_memory();
|
|
|
|
}
|
|
|
|
return p;
|
|
|
|
}
|
|
|
|
|
|
|
|
void *
|
2010-08-30 00:24:53 -07:00
|
|
|
xrealloc(void *p, size_t size)
|
2009-07-08 13:19:16 -07:00
|
|
|
{
|
|
|
|
p = realloc(p, size ? size : 1);
|
|
|
|
COVERAGE_INC(util_xalloc);
|
|
|
|
if (p == NULL) {
|
|
|
|
out_of_memory();
|
|
|
|
}
|
|
|
|
return p;
|
|
|
|
}
|
|
|
|
|
|
|
|
void *
|
|
|
|
xmemdup(const void *p_, size_t size)
|
|
|
|
{
|
|
|
|
void *p = xmalloc(size);
|
|
|
|
memcpy(p, p_, size);
|
|
|
|
return p;
|
|
|
|
}
|
|
|
|
|
|
|
|
char *
|
|
|
|
xmemdup0(const char *p_, size_t length)
|
|
|
|
{
|
|
|
|
char *p = xmalloc(length + 1);
|
|
|
|
memcpy(p, p_, length);
|
|
|
|
p[length] = '\0';
|
|
|
|
return p;
|
|
|
|
}
|
|
|
|
|
|
|
|
char *
|
2010-08-30 00:24:53 -07:00
|
|
|
xstrdup(const char *s)
|
2009-07-08 13:19:16 -07:00
|
|
|
{
|
|
|
|
return xmemdup0(s, strlen(s));
|
|
|
|
}
|
|
|
|
|
|
|
|
char *
|
|
|
|
xvasprintf(const char *format, va_list args)
|
|
|
|
{
|
|
|
|
va_list args2;
|
|
|
|
size_t needed;
|
|
|
|
char *s;
|
|
|
|
|
|
|
|
va_copy(args2, args);
|
|
|
|
needed = vsnprintf(NULL, 0, format, args);
|
|
|
|
|
|
|
|
s = xmalloc(needed + 1);
|
|
|
|
|
|
|
|
vsnprintf(s, needed + 1, format, args2);
|
|
|
|
va_end(args2);
|
|
|
|
|
|
|
|
return s;
|
|
|
|
}
|
|
|
|
|
|
|
|
void *
|
|
|
|
x2nrealloc(void *p, size_t *n, size_t s)
|
|
|
|
{
|
|
|
|
*n = *n == 0 ? 1 : 2 * *n;
|
|
|
|
return xrealloc(p, *n * s);
|
|
|
|
}
|
|
|
|
|
|
|
|
char *
|
|
|
|
xasprintf(const char *format, ...)
|
|
|
|
{
|
|
|
|
va_list args;
|
|
|
|
char *s;
|
|
|
|
|
|
|
|
va_start(args, format);
|
|
|
|
s = xvasprintf(format, args);
|
|
|
|
va_end(args);
|
|
|
|
|
|
|
|
return s;
|
|
|
|
}
|
|
|
|
|
util: Don't read over 'size - 1' bytes of source string in ovs_strlcpy().
The blind replacement of strncpy() by ovs_strlcpy() is risky because
strncpy() never reads more bytes from its source string than necessary to
write its destination string, but ovs_strlcpy() and the OpenBSD function
that inspired it both read the entire source string. This avoids that
problem.
Given that change, we can use ovs_strlcpy() in a few more places, and
this commit does that too.
Coverity #10697,10696,10695,10694,10693,10692,10691,10690.
2011-02-22 10:41:15 -08:00
|
|
|
/* Similar to strlcpy() from OpenBSD, but it never reads more than 'size - 1'
|
|
|
|
* bytes from 'src' and doesn't return anything. */
|
2009-07-08 13:19:16 -07:00
|
|
|
void
|
|
|
|
ovs_strlcpy(char *dst, const char *src, size_t size)
|
|
|
|
{
|
|
|
|
if (size > 0) {
|
util: Don't read over 'size - 1' bytes of source string in ovs_strlcpy().
The blind replacement of strncpy() by ovs_strlcpy() is risky because
strncpy() never reads more bytes from its source string than necessary to
write its destination string, but ovs_strlcpy() and the OpenBSD function
that inspired it both read the entire source string. This avoids that
problem.
Given that change, we can use ovs_strlcpy() in a few more places, and
this commit does that too.
Coverity #10697,10696,10695,10694,10693,10692,10691,10690.
2011-02-22 10:41:15 -08:00
|
|
|
size_t len = strnlen(src, size - 1);
|
|
|
|
memcpy(dst, src, len);
|
|
|
|
dst[len] = '\0';
|
2009-07-08 13:19:16 -07:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2011-02-22 10:58:36 -08:00
|
|
|
/* Copies 'src' to 'dst'. Reads no more than 'size - 1' bytes from 'src'.
|
|
|
|
* Always null-terminates 'dst' (if 'size' is nonzero), and writes a zero byte
|
|
|
|
* to every otherwise unused byte in 'dst'.
|
|
|
|
*
|
|
|
|
* Except for performance, the following call:
|
|
|
|
* ovs_strzcpy(dst, src, size);
|
|
|
|
* is equivalent to these two calls:
|
|
|
|
* memset(dst, '\0', size);
|
|
|
|
* ovs_strlcpy(dst, src, size);
|
|
|
|
*
|
|
|
|
* (Thus, ovs_strzcpy() is similar to strncpy() without some of the pitfalls.)
|
|
|
|
*/
|
|
|
|
void
|
|
|
|
ovs_strzcpy(char *dst, const char *src, size_t size)
|
|
|
|
{
|
|
|
|
if (size > 0) {
|
|
|
|
size_t len = strnlen(src, size - 1);
|
|
|
|
memcpy(dst, src, len);
|
|
|
|
memset(dst + len, '\0', size - len);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2011-02-23 15:43:34 -08:00
|
|
|
/* Prints 'format' on stderr, formatting it like printf() does. If 'err_no' is
|
|
|
|
* nonzero, then it is formatted with ovs_retval_to_string() and appended to
|
|
|
|
* the message inside parentheses. Then, terminates with abort().
|
|
|
|
*
|
|
|
|
* This function is preferred to ovs_fatal() in a situation where it would make
|
|
|
|
* sense for a monitoring process to restart the daemon.
|
|
|
|
*
|
|
|
|
* 'format' should not end with a new-line, because this function will add one
|
|
|
|
* itself. */
|
|
|
|
void
|
|
|
|
ovs_abort(int err_no, const char *format, ...)
|
|
|
|
{
|
|
|
|
va_list args;
|
|
|
|
|
|
|
|
va_start(args, format);
|
2012-05-22 11:36:50 -07:00
|
|
|
ovs_abort_valist(err_no, format, args);
|
|
|
|
}
|
2011-02-23 15:43:34 -08:00
|
|
|
|
2012-05-22 11:36:50 -07:00
|
|
|
/* Same as ovs_abort() except that the arguments are supplied as a va_list. */
|
|
|
|
void
|
|
|
|
ovs_abort_valist(int err_no, const char *format, va_list args)
|
|
|
|
{
|
|
|
|
ovs_error_valist(err_no, format, args);
|
2011-02-23 15:43:34 -08:00
|
|
|
abort();
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Prints 'format' on stderr, formatting it like printf() does. If 'err_no' is
|
|
|
|
* nonzero, then it is formatted with ovs_retval_to_string() and appended to
|
|
|
|
* the message inside parentheses. Then, terminates with EXIT_FAILURE.
|
|
|
|
*
|
|
|
|
* 'format' should not end with a new-line, because this function will add one
|
|
|
|
* itself. */
|
2009-07-08 13:19:16 -07:00
|
|
|
void
|
|
|
|
ovs_fatal(int err_no, const char *format, ...)
|
|
|
|
{
|
|
|
|
va_list args;
|
|
|
|
|
|
|
|
va_start(args, format);
|
2011-03-31 14:50:58 -07:00
|
|
|
ovs_fatal_valist(err_no, format, args);
|
|
|
|
}
|
2009-07-08 13:19:16 -07:00
|
|
|
|
2011-03-31 14:50:58 -07:00
|
|
|
/* Same as ovs_fatal() except that the arguments are supplied as a va_list. */
|
|
|
|
void
|
|
|
|
ovs_fatal_valist(int err_no, const char *format, va_list args)
|
|
|
|
{
|
|
|
|
ovs_error_valist(err_no, format, args);
|
2009-07-08 13:19:16 -07:00
|
|
|
exit(EXIT_FAILURE);
|
|
|
|
}
|
|
|
|
|
2011-02-23 15:43:34 -08:00
|
|
|
/* Prints 'format' on stderr, formatting it like printf() does. If 'err_no' is
|
|
|
|
* nonzero, then it is formatted with ovs_retval_to_string() and appended to
|
|
|
|
* the message inside parentheses.
|
|
|
|
*
|
|
|
|
* 'format' should not end with a new-line, because this function will add one
|
|
|
|
* itself. */
|
2009-07-08 13:19:16 -07:00
|
|
|
void
|
|
|
|
ovs_error(int err_no, const char *format, ...)
|
|
|
|
{
|
|
|
|
va_list args;
|
|
|
|
|
|
|
|
va_start(args, format);
|
2011-02-23 15:43:34 -08:00
|
|
|
ovs_error_valist(err_no, format, args);
|
2009-07-08 13:19:16 -07:00
|
|
|
va_end(args);
|
2011-02-23 15:43:34 -08:00
|
|
|
}
|
|
|
|
|
|
|
|
/* Same as ovs_error() except that the arguments are supplied as a va_list. */
|
|
|
|
void
|
|
|
|
ovs_error_valist(int err_no, const char *format, va_list args)
|
|
|
|
{
|
|
|
|
int save_errno = errno;
|
|
|
|
|
2012-07-18 10:30:47 -07:00
|
|
|
if (subprogram_name[0]) {
|
|
|
|
fprintf(stderr, "%s(%s): ", program_name, subprogram_name);
|
|
|
|
} else {
|
|
|
|
fprintf(stderr, "%s: ", program_name);
|
|
|
|
}
|
|
|
|
|
2011-02-23 15:43:34 -08:00
|
|
|
vfprintf(stderr, format, args);
|
2009-10-28 11:11:18 -07:00
|
|
|
if (err_no != 0) {
|
2011-01-30 11:29:14 -08:00
|
|
|
fprintf(stderr, " (%s)", ovs_retval_to_string(err_no));
|
2009-10-28 11:11:18 -07:00
|
|
|
}
|
2009-07-08 13:19:16 -07:00
|
|
|
putc('\n', stderr);
|
|
|
|
|
|
|
|
errno = save_errno;
|
|
|
|
}
|
|
|
|
|
2011-01-30 11:29:14 -08:00
|
|
|
/* Many OVS functions return an int which is one of:
|
|
|
|
* - 0: no error yet
|
|
|
|
* - >0: errno value
|
|
|
|
* - EOF: end of file (not necessarily an error; depends on the function called)
|
|
|
|
*
|
|
|
|
* Returns the appropriate human-readable string. The caller must copy the
|
|
|
|
* string if it wants to hold onto it, as the storage may be overwritten on
|
|
|
|
* subsequent function calls.
|
|
|
|
*/
|
|
|
|
const char *
|
|
|
|
ovs_retval_to_string(int retval)
|
|
|
|
{
|
|
|
|
static char unknown[48];
|
|
|
|
|
|
|
|
if (!retval) {
|
|
|
|
return "";
|
|
|
|
}
|
|
|
|
if (retval > 0) {
|
|
|
|
return strerror(retval);
|
|
|
|
}
|
|
|
|
if (retval == EOF) {
|
|
|
|
return "End of file";
|
|
|
|
}
|
|
|
|
snprintf(unknown, sizeof unknown, "***unknown return value: %d***", retval);
|
|
|
|
return unknown;
|
|
|
|
}
|
|
|
|
|
2011-08-02 12:16:44 -07:00
|
|
|
/* Sets global "program_name" and "program_version" variables. Should
|
|
|
|
* be called at the beginning of main() with "argv[0]" as the argument
|
|
|
|
* to 'argv0'.
|
|
|
|
*
|
2012-04-06 11:47:51 -07:00
|
|
|
* 'version' should contain the version of the caller's program. If 'version'
|
|
|
|
* is the same as the VERSION #define, the caller is assumed to be part of Open
|
|
|
|
* vSwitch. Otherwise, it is assumed to be an external program linking against
|
|
|
|
* the Open vSwitch libraries.
|
|
|
|
*
|
2011-08-02 12:16:44 -07:00
|
|
|
* The 'date' and 'time' arguments should likely be called with
|
|
|
|
* "__DATE__" and "__TIME__" to use the time the binary was built.
|
|
|
|
* Alternatively, the "set_program_name" macro may be called to do this
|
|
|
|
* automatically.
|
|
|
|
*/
|
|
|
|
void
|
2012-04-06 11:47:51 -07:00
|
|
|
set_program_name__(const char *argv0, const char *version, const char *date,
|
|
|
|
const char *time)
|
2009-07-08 13:19:16 -07:00
|
|
|
{
|
|
|
|
const char *slash = strrchr(argv0, '/');
|
|
|
|
program_name = slash ? slash + 1 : argv0;
|
2011-08-02 12:16:44 -07:00
|
|
|
|
|
|
|
free(program_version);
|
2012-04-06 11:47:51 -07:00
|
|
|
|
|
|
|
if (!strcmp(version, VERSION)) {
|
|
|
|
program_version = xasprintf("%s (Open vSwitch) "VERSION"\n"
|
|
|
|
"Compiled %s %s\n",
|
|
|
|
program_name, date, time);
|
|
|
|
} else {
|
|
|
|
program_version = xasprintf("%s %s\n"
|
|
|
|
"Open vSwitch Library "VERSION"\n"
|
|
|
|
"Compiled %s %s\n",
|
|
|
|
program_name, version, date, time);
|
|
|
|
}
|
2011-08-02 12:16:44 -07:00
|
|
|
}
|
|
|
|
|
|
|
|
/* Returns a pointer to a string describing the program version. The
|
|
|
|
* caller must not modify or free the returned string.
|
2011-08-04 16:50:25 -07:00
|
|
|
*/
|
2011-08-02 12:16:44 -07:00
|
|
|
const char *
|
2011-08-04 13:20:30 -07:00
|
|
|
get_program_version(void)
|
2011-08-02 12:16:44 -07:00
|
|
|
{
|
|
|
|
return program_version;
|
2009-07-08 13:19:16 -07:00
|
|
|
}
|
|
|
|
|
|
|
|
/* Print the version information for the program. */
|
|
|
|
void
|
2011-08-02 12:16:44 -07:00
|
|
|
ovs_print_version(uint8_t min_ofp, uint8_t max_ofp)
|
2009-07-08 13:19:16 -07:00
|
|
|
{
|
2011-08-02 12:16:44 -07:00
|
|
|
printf("%s", program_version);
|
2009-07-08 13:19:16 -07:00
|
|
|
if (min_ofp || max_ofp) {
|
|
|
|
printf("OpenFlow versions %#x:%#x\n", min_ofp, max_ofp);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Writes the 'size' bytes in 'buf' to 'stream' as hex bytes arranged 16 per
|
|
|
|
* line. Numeric offsets are also included, starting at 'ofs' for the first
|
|
|
|
* byte in 'buf'. If 'ascii' is true then the corresponding ASCII characters
|
|
|
|
* are also rendered alongside. */
|
|
|
|
void
|
|
|
|
ovs_hex_dump(FILE *stream, const void *buf_, size_t size,
|
|
|
|
uintptr_t ofs, bool ascii)
|
|
|
|
{
|
|
|
|
const uint8_t *buf = buf_;
|
|
|
|
const size_t per_line = 16; /* Maximum bytes per line. */
|
|
|
|
|
|
|
|
while (size > 0)
|
|
|
|
{
|
|
|
|
size_t start, end, n;
|
|
|
|
size_t i;
|
|
|
|
|
|
|
|
/* Number of bytes on this line. */
|
|
|
|
start = ofs % per_line;
|
|
|
|
end = per_line;
|
|
|
|
if (end - start > size)
|
|
|
|
end = start + size;
|
|
|
|
n = end - start;
|
|
|
|
|
|
|
|
/* Print line. */
|
|
|
|
fprintf(stream, "%08jx ", (uintmax_t) ROUND_DOWN(ofs, per_line));
|
|
|
|
for (i = 0; i < start; i++)
|
|
|
|
fprintf(stream, " ");
|
|
|
|
for (; i < end; i++)
|
|
|
|
fprintf(stream, "%02hhx%c",
|
|
|
|
buf[i - start], i == per_line / 2 - 1? '-' : ' ');
|
|
|
|
if (ascii)
|
|
|
|
{
|
|
|
|
for (; i < per_line; i++)
|
|
|
|
fprintf(stream, " ");
|
|
|
|
fprintf(stream, "|");
|
|
|
|
for (i = 0; i < start; i++)
|
|
|
|
fprintf(stream, " ");
|
|
|
|
for (; i < end; i++) {
|
|
|
|
int c = buf[i - start];
|
|
|
|
putc(c >= 32 && c < 127 ? c : '.', stream);
|
|
|
|
}
|
|
|
|
for (; i < per_line; i++)
|
|
|
|
fprintf(stream, " ");
|
|
|
|
fprintf(stream, "|");
|
|
|
|
}
|
|
|
|
fprintf(stream, "\n");
|
|
|
|
|
|
|
|
ofs += n;
|
|
|
|
buf += n;
|
|
|
|
size -= n;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
bool
|
|
|
|
str_to_int(const char *s, int base, int *i)
|
|
|
|
{
|
|
|
|
long long ll;
|
|
|
|
bool ok = str_to_llong(s, base, &ll);
|
|
|
|
*i = ll;
|
|
|
|
return ok;
|
|
|
|
}
|
|
|
|
|
|
|
|
bool
|
|
|
|
str_to_long(const char *s, int base, long *li)
|
|
|
|
{
|
|
|
|
long long ll;
|
|
|
|
bool ok = str_to_llong(s, base, &ll);
|
|
|
|
*li = ll;
|
|
|
|
return ok;
|
|
|
|
}
|
|
|
|
|
|
|
|
bool
|
|
|
|
str_to_llong(const char *s, int base, long long *x)
|
|
|
|
{
|
|
|
|
int save_errno = errno;
|
|
|
|
char *tail;
|
|
|
|
errno = 0;
|
|
|
|
*x = strtoll(s, &tail, base);
|
|
|
|
if (errno == EINVAL || errno == ERANGE || tail == s || *tail != '\0') {
|
|
|
|
errno = save_errno;
|
|
|
|
*x = 0;
|
|
|
|
return false;
|
|
|
|
} else {
|
|
|
|
errno = save_errno;
|
|
|
|
return true;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
bool
|
|
|
|
str_to_uint(const char *s, int base, unsigned int *u)
|
|
|
|
{
|
|
|
|
return str_to_int(s, base, (int *) u);
|
|
|
|
}
|
|
|
|
|
|
|
|
bool
|
|
|
|
str_to_ulong(const char *s, int base, unsigned long *ul)
|
|
|
|
{
|
|
|
|
return str_to_long(s, base, (long *) ul);
|
|
|
|
}
|
|
|
|
|
|
|
|
bool
|
|
|
|
str_to_ullong(const char *s, int base, unsigned long long *ull)
|
|
|
|
{
|
|
|
|
return str_to_llong(s, base, (long long *) ull);
|
|
|
|
}
|
2009-11-04 14:55:53 -08:00
|
|
|
|
|
|
|
/* Converts floating-point string 's' into a double. If successful, stores
|
|
|
|
* the double in '*d' and returns true; on failure, stores 0 in '*d' and
|
|
|
|
* returns false.
|
|
|
|
*
|
|
|
|
* Underflow (e.g. "1e-9999") is not considered an error, but overflow
|
|
|
|
* (e.g. "1e9999)" is. */
|
|
|
|
bool
|
|
|
|
str_to_double(const char *s, double *d)
|
|
|
|
{
|
|
|
|
int save_errno = errno;
|
|
|
|
char *tail;
|
|
|
|
errno = 0;
|
|
|
|
*d = strtod(s, &tail);
|
|
|
|
if (errno == EINVAL || (errno == ERANGE && *d != 0)
|
|
|
|
|| tail == s || *tail != '\0') {
|
|
|
|
errno = save_errno;
|
|
|
|
*d = 0;
|
|
|
|
return false;
|
|
|
|
} else {
|
|
|
|
errno = save_errno;
|
|
|
|
return true;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Returns the value of 'c' as a hexadecimal digit. */
|
|
|
|
int
|
|
|
|
hexit_value(int c)
|
|
|
|
{
|
|
|
|
switch (c) {
|
|
|
|
case '0': case '1': case '2': case '3': case '4':
|
|
|
|
case '5': case '6': case '7': case '8': case '9':
|
|
|
|
return c - '0';
|
|
|
|
|
|
|
|
case 'a': case 'A':
|
|
|
|
return 0xa;
|
|
|
|
|
|
|
|
case 'b': case 'B':
|
|
|
|
return 0xb;
|
|
|
|
|
|
|
|
case 'c': case 'C':
|
|
|
|
return 0xc;
|
|
|
|
|
|
|
|
case 'd': case 'D':
|
|
|
|
return 0xd;
|
|
|
|
|
|
|
|
case 'e': case 'E':
|
|
|
|
return 0xe;
|
|
|
|
|
|
|
|
case 'f': case 'F':
|
|
|
|
return 0xf;
|
|
|
|
|
2010-11-09 17:00:59 -08:00
|
|
|
default:
|
|
|
|
return -1;
|
|
|
|
}
|
2009-11-04 14:55:53 -08:00
|
|
|
}
|
2009-10-19 14:04:14 -07:00
|
|
|
|
2010-11-15 10:18:10 -08:00
|
|
|
/* Returns the integer value of the 'n' hexadecimal digits starting at 's', or
|
|
|
|
* UINT_MAX if one of those "digits" is not really a hex digit. If 'ok' is
|
|
|
|
* nonnull, '*ok' is set to true if the conversion succeeds or to false if a
|
|
|
|
* non-hex digit is detected. */
|
|
|
|
unsigned int
|
|
|
|
hexits_value(const char *s, size_t n, bool *ok)
|
|
|
|
{
|
|
|
|
unsigned int value;
|
|
|
|
size_t i;
|
|
|
|
|
|
|
|
value = 0;
|
|
|
|
for (i = 0; i < n; i++) {
|
|
|
|
int hexit = hexit_value(s[i]);
|
|
|
|
if (hexit < 0) {
|
|
|
|
if (ok) {
|
|
|
|
*ok = false;
|
|
|
|
}
|
|
|
|
return UINT_MAX;
|
|
|
|
}
|
|
|
|
value = (value << 4) + hexit;
|
|
|
|
}
|
|
|
|
if (ok) {
|
|
|
|
*ok = true;
|
|
|
|
}
|
|
|
|
return value;
|
|
|
|
}
|
|
|
|
|
2010-03-16 15:06:11 -07:00
|
|
|
/* Returns the current working directory as a malloc()'d string, or a null
|
|
|
|
* pointer if the current working directory cannot be determined. */
|
|
|
|
char *
|
|
|
|
get_cwd(void)
|
|
|
|
{
|
|
|
|
long int path_max;
|
|
|
|
size_t size;
|
|
|
|
|
|
|
|
/* Get maximum path length or at least a reasonable estimate. */
|
|
|
|
path_max = pathconf(".", _PC_PATH_MAX);
|
|
|
|
size = (path_max < 0 ? 1024
|
|
|
|
: path_max > 10240 ? 10240
|
|
|
|
: path_max);
|
|
|
|
|
|
|
|
/* Get current working directory. */
|
|
|
|
for (;;) {
|
|
|
|
char *buf = xmalloc(size);
|
|
|
|
if (getcwd(buf, size)) {
|
|
|
|
return xrealloc(buf, strlen(buf) + 1);
|
|
|
|
} else {
|
|
|
|
int error = errno;
|
|
|
|
free(buf);
|
|
|
|
if (error != ERANGE) {
|
|
|
|
VLOG_WARN("getcwd failed (%s)", strerror(error));
|
|
|
|
return NULL;
|
|
|
|
}
|
|
|
|
size *= 2;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2010-11-09 14:38:28 -08:00
|
|
|
static char *
|
|
|
|
all_slashes_name(const char *s)
|
|
|
|
{
|
|
|
|
return xstrdup(s[0] == '/' && s[1] == '/' && s[2] != '/' ? "//"
|
|
|
|
: s[0] == '/' ? "/"
|
|
|
|
: ".");
|
|
|
|
}
|
|
|
|
|
2009-10-19 14:04:14 -07:00
|
|
|
/* Returns the directory name portion of 'file_name' as a malloc()'d string,
|
|
|
|
* similar to the POSIX dirname() function but thread-safe. */
|
|
|
|
char *
|
|
|
|
dir_name(const char *file_name)
|
|
|
|
{
|
|
|
|
size_t len = strlen(file_name);
|
|
|
|
while (len > 0 && file_name[len - 1] == '/') {
|
|
|
|
len--;
|
|
|
|
}
|
|
|
|
while (len > 0 && file_name[len - 1] != '/') {
|
|
|
|
len--;
|
|
|
|
}
|
|
|
|
while (len > 0 && file_name[len - 1] == '/') {
|
|
|
|
len--;
|
|
|
|
}
|
2010-11-09 14:38:28 -08:00
|
|
|
return len ? xmemdup0(file_name, len) : all_slashes_name(file_name);
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Returns the file name portion of 'file_name' as a malloc()'d string,
|
|
|
|
* similar to the POSIX basename() function but thread-safe. */
|
|
|
|
char *
|
|
|
|
base_name(const char *file_name)
|
|
|
|
{
|
|
|
|
size_t end, start;
|
|
|
|
|
|
|
|
end = strlen(file_name);
|
|
|
|
while (end > 0 && file_name[end - 1] == '/') {
|
|
|
|
end--;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (!end) {
|
|
|
|
return all_slashes_name(file_name);
|
2009-10-19 14:04:14 -07:00
|
|
|
}
|
2010-11-09 14:38:28 -08:00
|
|
|
|
|
|
|
start = end;
|
|
|
|
while (start > 0 && file_name[start - 1] != '/') {
|
|
|
|
start--;
|
|
|
|
}
|
|
|
|
|
|
|
|
return xmemdup0(file_name + start, end - start);
|
2009-10-19 14:04:14 -07:00
|
|
|
}
|
2009-12-14 23:08:10 -08:00
|
|
|
|
2010-03-16 15:06:11 -07:00
|
|
|
/* If 'file_name' starts with '/', returns a copy of 'file_name'. Otherwise,
|
|
|
|
* returns an absolute path to 'file_name' considering it relative to 'dir',
|
|
|
|
* which itself must be absolute. 'dir' may be null or the empty string, in
|
|
|
|
* which case the current working directory is used.
|
|
|
|
*
|
|
|
|
* Returns a null pointer if 'dir' is null and getcwd() fails. */
|
|
|
|
char *
|
|
|
|
abs_file_name(const char *dir, const char *file_name)
|
|
|
|
{
|
|
|
|
if (file_name[0] == '/') {
|
|
|
|
return xstrdup(file_name);
|
|
|
|
} else if (dir && dir[0]) {
|
|
|
|
char *separator = dir[strlen(dir) - 1] == '/' ? "" : "/";
|
|
|
|
return xasprintf("%s%s%s", dir, separator, file_name);
|
|
|
|
} else {
|
|
|
|
char *cwd = get_cwd();
|
|
|
|
if (cwd) {
|
|
|
|
char *abs_name = xasprintf("%s/%s", cwd, file_name);
|
|
|
|
free(cwd);
|
|
|
|
return abs_name;
|
|
|
|
} else {
|
|
|
|
return NULL;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2012-07-30 11:36:06 -07:00
|
|
|
/* Like readlink(), but returns the link name as a null-terminated string in
|
|
|
|
* allocated memory that the caller must eventually free (with free()).
|
|
|
|
* Returns NULL on error, in which case errno is set appropriately. */
|
|
|
|
char *
|
|
|
|
xreadlink(const char *filename)
|
|
|
|
{
|
|
|
|
size_t size;
|
|
|
|
|
|
|
|
for (size = 64; ; size *= 2) {
|
|
|
|
char *buf = xmalloc(size);
|
|
|
|
ssize_t retval = readlink(filename, buf, size);
|
|
|
|
int error = errno;
|
|
|
|
|
|
|
|
if (retval >= 0 && retval < size) {
|
|
|
|
buf[retval] = '\0';
|
|
|
|
return buf;
|
|
|
|
}
|
|
|
|
|
|
|
|
free(buf);
|
|
|
|
if (retval < 0) {
|
|
|
|
errno = error;
|
|
|
|
return NULL;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Returns a version of 'filename' with symlinks in the final component
|
|
|
|
* dereferenced. This differs from realpath() in that:
|
|
|
|
*
|
|
|
|
* - 'filename' need not exist.
|
|
|
|
*
|
|
|
|
* - If 'filename' does exist as a symlink, its referent need not exist.
|
|
|
|
*
|
|
|
|
* - Only symlinks in the final component of 'filename' are dereferenced.
|
|
|
|
*
|
|
|
|
* The caller must eventually free the returned string (with free()). */
|
|
|
|
char *
|
|
|
|
follow_symlinks(const char *filename)
|
|
|
|
{
|
|
|
|
struct stat s;
|
|
|
|
char *fn;
|
|
|
|
int i;
|
|
|
|
|
|
|
|
fn = xstrdup(filename);
|
|
|
|
for (i = 0; i < 10; i++) {
|
|
|
|
char *linkname;
|
|
|
|
char *next_fn;
|
|
|
|
|
|
|
|
if (lstat(fn, &s) != 0 || !S_ISLNK(s.st_mode)) {
|
|
|
|
return fn;
|
|
|
|
}
|
|
|
|
|
|
|
|
linkname = xreadlink(fn);
|
|
|
|
if (!linkname) {
|
|
|
|
VLOG_WARN("%s: readlink failed (%s)", filename, strerror(errno));
|
|
|
|
return fn;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (linkname[0] == '/') {
|
|
|
|
/* Target of symlink is absolute so use it raw. */
|
|
|
|
next_fn = linkname;
|
|
|
|
} else {
|
|
|
|
/* Target of symlink is relative so add to 'fn''s directory. */
|
|
|
|
char *dir = dir_name(fn);
|
|
|
|
|
|
|
|
if (!strcmp(dir, ".")) {
|
|
|
|
next_fn = linkname;
|
|
|
|
} else {
|
|
|
|
char *separator = dir[strlen(dir) - 1] == '/' ? "" : "/";
|
|
|
|
next_fn = xasprintf("%s%s%s", dir, separator, linkname);
|
|
|
|
free(linkname);
|
|
|
|
}
|
|
|
|
|
|
|
|
free(dir);
|
|
|
|
}
|
|
|
|
|
|
|
|
free(fn);
|
|
|
|
fn = next_fn;
|
|
|
|
}
|
|
|
|
|
|
|
|
VLOG_WARN("%s: too many levels of symlinks", filename);
|
|
|
|
free(fn);
|
|
|
|
return xstrdup(filename);
|
|
|
|
}
|
2010-03-16 15:06:11 -07:00
|
|
|
|
2009-12-14 23:08:10 -08:00
|
|
|
/* Pass a value to this function if it is marked with
|
2010-08-30 00:24:53 -07:00
|
|
|
* __attribute__((warn_unused_result)) and you genuinely want to ignore
|
|
|
|
* its return value. (Note that every scalar type can be implicitly
|
2009-12-14 23:08:10 -08:00
|
|
|
* converted to bool.) */
|
2010-02-11 11:11:23 -08:00
|
|
|
void ignore(bool x OVS_UNUSED) { }
|
2011-06-02 10:47:18 -07:00
|
|
|
|
|
|
|
/* Returns an appropriate delimiter for inserting just before the 0-based item
|
|
|
|
* 'index' in a list that has 'total' items in it. */
|
|
|
|
const char *
|
|
|
|
english_list_delimiter(size_t index, size_t total)
|
|
|
|
{
|
|
|
|
return (index == 0 ? ""
|
|
|
|
: index < total - 1 ? ", "
|
|
|
|
: total > 2 ? ", and "
|
|
|
|
: " and ");
|
|
|
|
}
|
2011-07-22 10:20:52 -07:00
|
|
|
|
|
|
|
/* Given a 32 bit word 'n', calculates floor(log_2('n')). This is equivalent
|
|
|
|
* to finding the bit position of the most significant one bit in 'n'. It is
|
|
|
|
* an error to call this function with 'n' == 0. */
|
|
|
|
int
|
|
|
|
log_2_floor(uint32_t n)
|
|
|
|
{
|
|
|
|
assert(n);
|
|
|
|
|
|
|
|
#if !defined(UINT_MAX) || !defined(UINT32_MAX)
|
|
|
|
#error "Someone screwed up the #includes."
|
|
|
|
#elif __GNUC__ >= 4 && UINT_MAX == UINT32_MAX
|
|
|
|
return 31 - __builtin_clz(n);
|
|
|
|
#else
|
|
|
|
{
|
|
|
|
int log = 0;
|
|
|
|
|
|
|
|
#define BIN_SEARCH_STEP(BITS) \
|
|
|
|
if (n >= (1 << BITS)) { \
|
|
|
|
log += BITS; \
|
|
|
|
n >>= BITS; \
|
|
|
|
}
|
|
|
|
BIN_SEARCH_STEP(16);
|
|
|
|
BIN_SEARCH_STEP(8);
|
|
|
|
BIN_SEARCH_STEP(4);
|
|
|
|
BIN_SEARCH_STEP(2);
|
|
|
|
BIN_SEARCH_STEP(1);
|
|
|
|
#undef BIN_SEARCH_STEP
|
|
|
|
return log;
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
}
|
2011-08-17 10:55:15 -07:00
|
|
|
|
2011-12-27 13:37:43 -08:00
|
|
|
/* Given a 32 bit word 'n', calculates ceil(log_2('n')). It is an error to
|
|
|
|
* call this function with 'n' == 0. */
|
|
|
|
int
|
|
|
|
log_2_ceil(uint32_t n)
|
|
|
|
{
|
|
|
|
return log_2_floor(n) + !IS_POW2(n);
|
|
|
|
}
|
|
|
|
|
2012-08-21 10:47:22 -07:00
|
|
|
/* Returns the number of trailing 0-bits in 'n'. Undefined if 'n' == 0. */
|
2011-08-17 10:55:15 -07:00
|
|
|
#if !defined(UINT_MAX) || !defined(UINT32_MAX)
|
|
|
|
#error "Someone screwed up the #includes."
|
|
|
|
#elif __GNUC__ >= 4 && UINT_MAX == UINT32_MAX
|
2012-08-21 10:47:22 -07:00
|
|
|
/* Defined inline in util.h. */
|
2011-08-17 10:55:15 -07:00
|
|
|
#else
|
2012-08-21 10:47:22 -07:00
|
|
|
static int
|
|
|
|
raw_ctz(uint32_t n)
|
|
|
|
{
|
|
|
|
unsigned int k;
|
|
|
|
int count = 31;
|
2011-08-17 10:55:15 -07:00
|
|
|
|
|
|
|
#define CTZ_STEP(X) \
|
2012-08-21 10:47:22 -07:00
|
|
|
k = n << (X); \
|
|
|
|
if (k) { \
|
|
|
|
count -= X; \
|
|
|
|
n = k; \
|
|
|
|
}
|
|
|
|
CTZ_STEP(16);
|
|
|
|
CTZ_STEP(8);
|
|
|
|
CTZ_STEP(4);
|
|
|
|
CTZ_STEP(2);
|
|
|
|
CTZ_STEP(1);
|
2011-08-17 10:55:15 -07:00
|
|
|
#undef CTZ_STEP
|
|
|
|
|
2012-08-21 10:47:22 -07:00
|
|
|
return count;
|
2011-08-17 10:55:15 -07:00
|
|
|
}
|
2012-08-21 10:47:22 -07:00
|
|
|
#endif
|
2011-09-12 16:19:57 -07:00
|
|
|
|
util: New function popcount().
This is the fastest portable implementation among the ones below, as
measured with GCC 4.4 on a Xeon X3430. The measeured times were, in
seconds:
popcount1 25.6
popcount2 6.9 (but is not portable)
popcount3 31.4
popcount4 25.6
popcount5 61.6 (and is buggy)
popcount6 64.6
popcount7 32.3
popcount8 11.2
int
popcount1(unsigned int x)
{
return __builtin_popcount(x);
}
int
popcount2(unsigned int x)
{
unsigned int y;
asm("popcnt %1, %0" : "=r" (y) : "g" (x));
return y;
}
int
popcount3(unsigned int x)
{
unsigned int n;
n = (x >> 1) & 033333333333;
x -= n;
n = (n >> 1) & 033333333333;
x -= n;
x = (x + (x >> 3)) & 030707070707;
return x % 63;
}
int
popcount4(unsigned int x)
{
x -= (x >> 1) & 0x55555555;
x = (x & 0x33333333) + ((x >> 2) & 0x33333333);
x = (x + (x >> 4)) & 0x0f0f0f0f;
x += x >> 8;
x += x >> 16;
return x & 0x3f;
}
int
popcount5(unsigned int x)
{
int n;
n = 0;
while (x) {
if (x & 0xf) {
n += ((0xe9949440 >> (x & 0xf)) & 3) + 1;
}
x >>= 4;
}
return n;
}
int
popcount6(unsigned int x)
{
int n;
n = 0;
while (x) {
n += (0xe994 >> (x & 7)) & 3;
x >>= 3;
}
return n;
}
int
popcount7(unsigned int x)
{
static const int table[16] = {
0, 1, 1, 2, 1, 2, 2, 3, 1, 2, 2, 3, 2, 3, 3, 4
};
return (table[x & 0xf]
+ table[(x >> 4) & 0xf]
+ table[(x >> 8) & 0xf]
+ table[(x >> 12) & 0xf]
+ table[(x >> 16) & 0xf]
+ table[(x >> 20) & 0xf]
+ table[(x >> 24) & 0xf]
+ table[x >> 28]);
}
static int
popcount8(unsigned int x)
{
((((X) & (1 << 0)) != 0) + \
(((X) & (1 << 1)) != 0) + \
(((X) & (1 << 2)) != 0) + \
(((X) & (1 << 3)) != 0) + \
(((X) & (1 << 4)) != 0) + \
(((X) & (1 << 5)) != 0) + \
(((X) & (1 << 6)) != 0) + \
(((X) & (1 << 7)) != 0))
static const uint8_t popcount8[256] = {
INIT64(0), INIT64(64), INIT64(128), INIT64(192)
};
return (popcount8[x & 0xff] +
popcount8[(x >> 8) & 0xff] +
popcount8[(x >> 16) & 0xff] +
popcount8[x >> 24]);
}
int
main(void)
{
unsigned long long int x;
int n;
n = 0;
for (x = 0; x <= UINT32_MAX; x++) {
n += popcount8(x);
}
printf("%d\n", n);
return 0;
}
Signed-off-by: Ben Pfaff <blp@nicira.com>
2012-07-20 12:38:59 -07:00
|
|
|
/* Returns the number of 1-bits in 'x', between 0 and 32 inclusive. */
|
|
|
|
int
|
|
|
|
popcount(uint32_t x)
|
|
|
|
{
|
|
|
|
/* In my testing, this implementation is over twice as fast as any other
|
|
|
|
* portable implementation that I tried, including GCC 4.4
|
|
|
|
* __builtin_popcount(), although nonportable asm("popcnt") was over 50%
|
|
|
|
* faster. */
|
|
|
|
#define INIT1(X) \
|
|
|
|
((((X) & (1 << 0)) != 0) + \
|
|
|
|
(((X) & (1 << 1)) != 0) + \
|
|
|
|
(((X) & (1 << 2)) != 0) + \
|
|
|
|
(((X) & (1 << 3)) != 0) + \
|
|
|
|
(((X) & (1 << 4)) != 0) + \
|
|
|
|
(((X) & (1 << 5)) != 0) + \
|
|
|
|
(((X) & (1 << 6)) != 0) + \
|
|
|
|
(((X) & (1 << 7)) != 0))
|
|
|
|
#define INIT2(X) INIT1(X), INIT1((X) + 1)
|
|
|
|
#define INIT4(X) INIT2(X), INIT2((X) + 2)
|
|
|
|
#define INIT8(X) INIT4(X), INIT4((X) + 4)
|
|
|
|
#define INIT16(X) INIT8(X), INIT8((X) + 8)
|
|
|
|
#define INIT32(X) INIT16(X), INIT16((X) + 16)
|
|
|
|
#define INIT64(X) INIT32(X), INIT32((X) + 32)
|
|
|
|
|
|
|
|
static const uint8_t popcount8[256] = {
|
|
|
|
INIT64(0), INIT64(64), INIT64(128), INIT64(192)
|
|
|
|
};
|
|
|
|
|
|
|
|
return (popcount8[x & 0xff] +
|
|
|
|
popcount8[(x >> 8) & 0xff] +
|
|
|
|
popcount8[(x >> 16) & 0xff] +
|
|
|
|
popcount8[x >> 24]);
|
|
|
|
}
|
|
|
|
|
2011-09-12 16:19:57 -07:00
|
|
|
/* Returns true if the 'n' bytes starting at 'p' are zeros. */
|
|
|
|
bool
|
|
|
|
is_all_zeros(const uint8_t *p, size_t n)
|
|
|
|
{
|
|
|
|
size_t i;
|
|
|
|
|
|
|
|
for (i = 0; i < n; i++) {
|
|
|
|
if (p[i] != 0x00) {
|
|
|
|
return false;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
return true;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Returns true if the 'n' bytes starting at 'p' are 0xff. */
|
|
|
|
bool
|
|
|
|
is_all_ones(const uint8_t *p, size_t n)
|
|
|
|
{
|
|
|
|
size_t i;
|
|
|
|
|
|
|
|
for (i = 0; i < n; i++) {
|
|
|
|
if (p[i] != 0xff) {
|
|
|
|
return false;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
return true;
|
|
|
|
}
|
|
|
|
|
2012-01-17 16:38:23 -08:00
|
|
|
/* Copies 'n_bits' bits starting from bit 'src_ofs' in 'src' to the 'n_bits'
|
|
|
|
* starting from bit 'dst_ofs' in 'dst'. 'src' is 'src_len' bytes long and
|
|
|
|
* 'dst' is 'dst_len' bytes long.
|
|
|
|
*
|
|
|
|
* If you consider all of 'src' to be a single unsigned integer in network byte
|
|
|
|
* order, then bit N is the bit with value 2**N. That is, bit 0 is the bit
|
|
|
|
* with value 1 in src[src_len - 1], bit 1 is the bit with value 2, bit 2 is
|
|
|
|
* the bit with value 4, ..., bit 8 is the bit with value 1 in src[src_len -
|
|
|
|
* 2], and so on. Similarly for 'dst'.
|
|
|
|
*
|
|
|
|
* Required invariants:
|
|
|
|
* src_ofs + n_bits <= src_len * 8
|
|
|
|
* dst_ofs + n_bits <= dst_len * 8
|
|
|
|
* 'src' and 'dst' must not overlap.
|
|
|
|
*/
|
|
|
|
void
|
|
|
|
bitwise_copy(const void *src_, unsigned int src_len, unsigned int src_ofs,
|
|
|
|
void *dst_, unsigned int dst_len, unsigned int dst_ofs,
|
|
|
|
unsigned int n_bits)
|
|
|
|
{
|
|
|
|
const uint8_t *src = src_;
|
|
|
|
uint8_t *dst = dst_;
|
|
|
|
|
|
|
|
src += src_len - (src_ofs / 8 + 1);
|
|
|
|
src_ofs %= 8;
|
|
|
|
|
|
|
|
dst += dst_len - (dst_ofs / 8 + 1);
|
|
|
|
dst_ofs %= 8;
|
|
|
|
|
|
|
|
if (src_ofs == 0 && dst_ofs == 0) {
|
|
|
|
unsigned int n_bytes = n_bits / 8;
|
|
|
|
if (n_bytes) {
|
|
|
|
dst -= n_bytes - 1;
|
|
|
|
src -= n_bytes - 1;
|
|
|
|
memcpy(dst, src, n_bytes);
|
|
|
|
|
|
|
|
n_bits %= 8;
|
|
|
|
src--;
|
|
|
|
dst--;
|
|
|
|
}
|
|
|
|
if (n_bits) {
|
|
|
|
uint8_t mask = (1 << n_bits) - 1;
|
|
|
|
*dst = (*dst & ~mask) | (*src & mask);
|
|
|
|
}
|
|
|
|
} else {
|
|
|
|
while (n_bits > 0) {
|
|
|
|
unsigned int max_copy = 8 - MAX(src_ofs, dst_ofs);
|
|
|
|
unsigned int chunk = MIN(n_bits, max_copy);
|
|
|
|
uint8_t mask = ((1 << chunk) - 1) << dst_ofs;
|
|
|
|
|
|
|
|
*dst &= ~mask;
|
|
|
|
*dst |= ((*src >> src_ofs) << dst_ofs) & mask;
|
|
|
|
|
|
|
|
src_ofs += chunk;
|
|
|
|
if (src_ofs == 8) {
|
|
|
|
src--;
|
|
|
|
src_ofs = 0;
|
|
|
|
}
|
|
|
|
dst_ofs += chunk;
|
|
|
|
if (dst_ofs == 8) {
|
|
|
|
dst--;
|
|
|
|
dst_ofs = 0;
|
|
|
|
}
|
|
|
|
n_bits -= chunk;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2012-01-17 16:53:29 -08:00
|
|
|
/* Zeros the 'n_bits' bits starting from bit 'dst_ofs' in 'dst'. 'dst' is
|
|
|
|
* 'dst_len' bytes long.
|
|
|
|
*
|
|
|
|
* If you consider all of 'dst' to be a single unsigned integer in network byte
|
|
|
|
* order, then bit N is the bit with value 2**N. That is, bit 0 is the bit
|
|
|
|
* with value 1 in dst[dst_len - 1], bit 1 is the bit with value 2, bit 2 is
|
|
|
|
* the bit with value 4, ..., bit 8 is the bit with value 1 in dst[dst_len -
|
|
|
|
* 2], and so on.
|
|
|
|
*
|
|
|
|
* Required invariant:
|
|
|
|
* dst_ofs + n_bits <= dst_len * 8
|
|
|
|
*/
|
|
|
|
void
|
|
|
|
bitwise_zero(void *dst_, unsigned int dst_len, unsigned dst_ofs,
|
|
|
|
unsigned int n_bits)
|
|
|
|
{
|
|
|
|
uint8_t *dst = dst_;
|
|
|
|
|
|
|
|
if (!n_bits) {
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
|
|
|
dst += dst_len - (dst_ofs / 8 + 1);
|
|
|
|
dst_ofs %= 8;
|
|
|
|
|
|
|
|
if (dst_ofs) {
|
|
|
|
unsigned int chunk = MIN(n_bits, 8 - dst_ofs);
|
|
|
|
|
|
|
|
*dst &= ~(((1 << chunk) - 1) << dst_ofs);
|
|
|
|
|
|
|
|
n_bits -= chunk;
|
|
|
|
if (!n_bits) {
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
|
|
|
dst--;
|
|
|
|
}
|
|
|
|
|
|
|
|
while (n_bits >= 8) {
|
|
|
|
*dst-- = 0;
|
|
|
|
n_bits -= 8;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (n_bits) {
|
|
|
|
*dst &= ~((1 << n_bits) - 1);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2012-04-11 12:07:51 -07:00
|
|
|
/* Sets to 1 all of the 'n_bits' bits starting from bit 'dst_ofs' in 'dst'.
|
|
|
|
* 'dst' is 'dst_len' bytes long.
|
|
|
|
*
|
|
|
|
* If you consider all of 'dst' to be a single unsigned integer in network byte
|
|
|
|
* order, then bit N is the bit with value 2**N. That is, bit 0 is the bit
|
|
|
|
* with value 1 in dst[dst_len - 1], bit 1 is the bit with value 2, bit 2 is
|
|
|
|
* the bit with value 4, ..., bit 8 is the bit with value 1 in dst[dst_len -
|
|
|
|
* 2], and so on.
|
|
|
|
*
|
|
|
|
* Required invariant:
|
|
|
|
* dst_ofs + n_bits <= dst_len * 8
|
|
|
|
*/
|
|
|
|
void
|
|
|
|
bitwise_one(void *dst_, unsigned int dst_len, unsigned dst_ofs,
|
|
|
|
unsigned int n_bits)
|
|
|
|
{
|
|
|
|
uint8_t *dst = dst_;
|
|
|
|
|
|
|
|
if (!n_bits) {
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
|
|
|
dst += dst_len - (dst_ofs / 8 + 1);
|
|
|
|
dst_ofs %= 8;
|
|
|
|
|
|
|
|
if (dst_ofs) {
|
|
|
|
unsigned int chunk = MIN(n_bits, 8 - dst_ofs);
|
|
|
|
|
|
|
|
*dst |= ((1 << chunk) - 1) << dst_ofs;
|
|
|
|
|
|
|
|
n_bits -= chunk;
|
|
|
|
if (!n_bits) {
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
|
|
|
dst--;
|
|
|
|
}
|
|
|
|
|
|
|
|
while (n_bits >= 8) {
|
|
|
|
*dst-- = 0xff;
|
|
|
|
n_bits -= 8;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (n_bits) {
|
|
|
|
*dst |= (1 << n_bits) - 1;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2012-04-13 21:12:37 -07:00
|
|
|
/* Scans the 'n_bits' bits starting from bit 'dst_ofs' in 'dst' for 1-bits.
|
|
|
|
* Returns false if any 1-bits are found, otherwise true. 'dst' is 'dst_len'
|
|
|
|
* bytes long.
|
|
|
|
*
|
|
|
|
* If you consider all of 'dst' to be a single unsigned integer in network byte
|
|
|
|
* order, then bit N is the bit with value 2**N. That is, bit 0 is the bit
|
|
|
|
* with value 1 in dst[dst_len - 1], bit 1 is the bit with value 2, bit 2 is
|
|
|
|
* the bit with value 4, ..., bit 8 is the bit with value 1 in dst[dst_len -
|
|
|
|
* 2], and so on.
|
|
|
|
*
|
|
|
|
* Required invariant:
|
|
|
|
* dst_ofs + n_bits <= dst_len * 8
|
|
|
|
*/
|
|
|
|
bool
|
|
|
|
bitwise_is_all_zeros(const void *p_, unsigned int len, unsigned int ofs,
|
|
|
|
unsigned int n_bits)
|
|
|
|
{
|
|
|
|
const uint8_t *p = p_;
|
|
|
|
|
|
|
|
if (!n_bits) {
|
|
|
|
return true;
|
|
|
|
}
|
|
|
|
|
|
|
|
p += len - (ofs / 8 + 1);
|
|
|
|
ofs %= 8;
|
|
|
|
|
|
|
|
if (ofs) {
|
|
|
|
unsigned int chunk = MIN(n_bits, 8 - ofs);
|
|
|
|
|
|
|
|
if (*p & (((1 << chunk) - 1) << ofs)) {
|
|
|
|
return false;
|
|
|
|
}
|
|
|
|
|
|
|
|
n_bits -= chunk;
|
|
|
|
if (!n_bits) {
|
|
|
|
return true;
|
|
|
|
}
|
|
|
|
|
|
|
|
p--;
|
|
|
|
}
|
|
|
|
|
|
|
|
while (n_bits >= 8) {
|
|
|
|
if (*p) {
|
|
|
|
return false;
|
|
|
|
}
|
|
|
|
n_bits -= 8;
|
|
|
|
p--;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (n_bits && *p & ((1 << n_bits) - 1)) {
|
|
|
|
return false;
|
|
|
|
}
|
|
|
|
|
|
|
|
return true;
|
|
|
|
}
|
|
|
|
|
2012-01-17 16:38:23 -08:00
|
|
|
/* Copies the 'n_bits' low-order bits of 'value' into the 'n_bits' bits
|
|
|
|
* starting at bit 'dst_ofs' in 'dst', which is 'dst_len' bytes long.
|
|
|
|
*
|
|
|
|
* If you consider all of 'dst' to be a single unsigned integer in network byte
|
|
|
|
* order, then bit N is the bit with value 2**N. That is, bit 0 is the bit
|
|
|
|
* with value 1 in dst[dst_len - 1], bit 1 is the bit with value 2, bit 2 is
|
|
|
|
* the bit with value 4, ..., bit 8 is the bit with value 1 in dst[dst_len -
|
|
|
|
* 2], and so on.
|
|
|
|
*
|
|
|
|
* Required invariants:
|
|
|
|
* dst_ofs + n_bits <= dst_len * 8
|
|
|
|
* n_bits <= 64
|
|
|
|
*/
|
|
|
|
void
|
|
|
|
bitwise_put(uint64_t value,
|
|
|
|
void *dst, unsigned int dst_len, unsigned int dst_ofs,
|
|
|
|
unsigned int n_bits)
|
|
|
|
{
|
|
|
|
ovs_be64 n_value = htonll(value);
|
|
|
|
bitwise_copy(&n_value, sizeof n_value, 0,
|
|
|
|
dst, dst_len, dst_ofs,
|
|
|
|
n_bits);
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Returns the value of the 'n_bits' bits starting at bit 'src_ofs' in 'src',
|
|
|
|
* which is 'src_len' bytes long.
|
|
|
|
*
|
|
|
|
* If you consider all of 'src' to be a single unsigned integer in network byte
|
|
|
|
* order, then bit N is the bit with value 2**N. That is, bit 0 is the bit
|
|
|
|
* with value 1 in src[src_len - 1], bit 1 is the bit with value 2, bit 2 is
|
|
|
|
* the bit with value 4, ..., bit 8 is the bit with value 1 in src[src_len -
|
|
|
|
* 2], and so on.
|
|
|
|
*
|
|
|
|
* Required invariants:
|
|
|
|
* src_ofs + n_bits <= src_len * 8
|
|
|
|
* n_bits <= 64
|
|
|
|
*/
|
|
|
|
uint64_t
|
|
|
|
bitwise_get(const void *src, unsigned int src_len,
|
|
|
|
unsigned int src_ofs, unsigned int n_bits)
|
|
|
|
{
|
|
|
|
ovs_be64 value = htonll(0);
|
|
|
|
|
|
|
|
bitwise_copy(src, src_len, src_ofs,
|
|
|
|
&value, sizeof value, 0,
|
|
|
|
n_bits);
|
|
|
|
return ntohll(value);
|
|
|
|
}
|