2 * utils - misc libubox utility functions
4 * Copyright (C) 2012 Felix Fietkau <nbd@openwrt.org>
6 * Permission to use, copy, modify, and/or distribute this software for any
7 * purpose with or without fee is hereby granted, provided that the above
8 * copyright notice and this permission notice appear in all copies.
10 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
11 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
12 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
13 * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
14 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
15 * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
16 * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
27 #define foreach_arg(_arg, _addr, _len, _first_addr, _first_len) \
28 for (_addr = (_first_addr), _len = (_first_len); \
30 _addr = va_arg(_arg, void **), _len = _addr ? va_arg(_arg, size_t) : 0)
32 #define C_PTR_ALIGN (sizeof(size_t))
33 #define C_PTR_MASK (-C_PTR_ALIGN)
35 void *__calloc_a(size_t len
, ...)
47 foreach_arg(ap1
, cur_addr
, cur_len
, &ret
, len
)
48 alloc_len
+= (cur_len
+ C_PTR_ALIGN
- 1 ) & C_PTR_MASK
;
51 ptr
= calloc(1, alloc_len
);
58 foreach_arg(ap
, cur_addr
, cur_len
, &ret
, len
) {
59 *cur_addr
= &ptr
[alloc_len
];
60 alloc_len
+= (cur_len
+ C_PTR_ALIGN
- 1) & C_PTR_MASK
;
67 #ifdef LIBUBOX_COMPAT_CLOCK_GETTIME
68 #include <mach/mach_host.h> /* host_get_clock_service() */
69 #include <mach/mach_port.h> /* mach_port_deallocate() */
70 #include <mach/mach_init.h> /* mach_host_self(), mach_task_self() */
71 #include <mach/clock.h> /* clock_get_time() */
73 static clock_serv_t clock_realtime
;
74 static clock_serv_t clock_monotonic
;
76 static void __constructor
clock_name_init(void)
78 mach_port_t host_self
= mach_host_self();
80 host_get_clock_service(host_self
, CLOCK_REALTIME
, &clock_realtime
);
81 host_get_clock_service(host_self
, CLOCK_MONOTONIC
, &clock_monotonic
);
84 static void __destructor
clock_name_dealloc(void)
86 mach_port_t self
= mach_task_self();
88 mach_port_deallocate(self
, clock_realtime
);
89 mach_port_deallocate(self
, clock_monotonic
);
92 int clock_gettime(int type
, struct timespec
*tv
)
99 retval
= clock_get_time(clock_realtime
, &mts
);
101 case CLOCK_MONOTONIC
:
102 retval
= clock_get_time(clock_monotonic
, &mts
);
108 tv
->tv_sec
= mts
.tv_sec
;
109 tv
->tv_nsec
= mts
.tv_nsec
;
116 void *cbuf_alloc(unsigned int order
)
118 char path
[] = "/tmp/cbuf-XXXXXX";
119 unsigned long size
= cbuf_size(order
);
130 if (ftruncate(fd
, cbuf_size(order
)))
133 #ifndef MAP_ANONYMOUS
134 #define MAP_ANONYMOUS MAP_ANON
137 ret
= mmap(NULL
, size
* 2, PROT_NONE
, MAP_ANON
| MAP_PRIVATE
, -1, 0);
138 if (ret
== MAP_FAILED
) {
143 if (mmap(ret
, size
, PROT_READ
| PROT_WRITE
, MAP_FIXED
| MAP_SHARED
,
145 mmap(ret
+ size
, size
, PROT_READ
| PROT_WRITE
,
146 MAP_FIXED
| MAP_SHARED
, fd
, 0) != ret
+ size
) {
147 munmap(ret
, size
* 2);
156 void cbuf_free(void *ptr
, unsigned int order
)
158 munmap(ptr
, cbuf_size(order
) * 2);
161 int mkdir_p(char *dir
, mode_t mask
)
166 ret
= mkdir(dir
, mask
);
167 if (!ret
|| errno
== EEXIST
)
170 if (ret
&& (errno
!= ENOENT
))
173 l
= strrchr(dir
, '/');
179 if (mkdir_p(dir
, mask
))
184 ret
= mkdir(dir
, mask
);
185 if (!ret
|| errno
== EEXIST
)