aaa9ab3a |
1 | /* |
2 | */ |
3 | |
4 | #include <string.h> |
5 | #include <errno.h> |
6 | #include <unistd.h> |
7 | #include <stdlib.h> |
8 | #include <assert.h> |
9 | |
10 | #include "forwarder.h" |
11 | |
12 | const char *const *argv; |
13 | char programid[SYS_NMLN+sizeof(PROGRAM)+3]; |
14 | |
15 | void arg_assert_fail(const char *msg) { |
16 | fprintf(stderr, PROGRAM ": argument error (!`%s')\n",msg); |
17 | exit(12); |
18 | } |
19 | |
20 | void sysfail(const char *msg) { |
21 | fprintf(stderr, "%s: fatal system error: %s: %s\n", programid, msg, strerror(errno)); |
22 | exit(8); |
23 | } |
24 | |
25 | void fail(const char *msg) { |
26 | fprintf(stderr, "%s: fatal error: %s\n", programid, msg); |
27 | exit(4); |
28 | } |
29 | |
30 | void sysdiag(const char *msg) { |
31 | fprintf(stderr, "%s: system/network error: %s: %s\n", programid, msg, strerror(errno)); |
32 | } |
33 | |
34 | void diag(const char *msg) { |
35 | fprintf(stderr, "%s: %s\n", programid, msg); |
36 | } |
37 | |
38 | time_t now(void) { |
39 | time_t r; |
40 | if (time(&r) == (time_t)-1) sysfail("get time of day"); |
41 | return r; |
42 | } |
43 | |
44 | void *xmalloc(size_t sz) { |
45 | void *r; |
46 | r= malloc(sz); |
47 | if (!r) sysfail("allocate memory"); |
48 | return r; |
49 | } |
50 | |
51 | void write_must(int fd, const void *p_in, int sz, const char *what) { |
52 | const unsigned char *p= p_in; |
53 | int r; |
54 | |
55 | while (sz) { |
56 | r= write(fd,p,sz); |
57 | if (r<0) { |
58 | if (errno == EINTR) continue; |
59 | else sysfail(what); |
60 | } |
61 | assert(r && r <= sz); |
62 | p += r; |
63 | sz -= r; |
64 | } |
65 | } |
66 | |
67 | void read_must(int fd, void *p_in, int sz, const char *what) { |
68 | unsigned char *p= p_in; |
69 | int r; |
70 | |
71 | while (sz) { |
72 | r= read(fd,p,sz); |
73 | if (r<0) { |
74 | if (errno == EINTR) continue; |
75 | else sysfail(what); |
76 | } |
77 | if (r==0) fail(what); |
78 | assert(r <= sz); |
79 | p += r; |
80 | sz -= r; |
81 | } |
82 | } |
83 | |
aaa9ab3a |
84 | const char *getarg_string(void) { |
85 | const char *arg; |
86 | |
87 | arg= *++argv; |
88 | arg_assert(arg); |
89 | return arg; |
90 | } |
91 | |
92 | unsigned long getarg_ulong(void) { |
93 | char *ep; |
94 | unsigned long ul; |
95 | |
96 | ul= strtoul(getarg_string(),&ep,0); |
97 | arg_assert(!*ep); |
98 | return ul; |
99 | } |
100 | |
101 | void *buf_append(struct buffer *buf, size_t amount) { |
102 | void *p; |
103 | |
104 | p= buf->start + buf->size; |
105 | buf->size += amount; |
106 | return p; |
107 | } |
108 | |
109 | void *buf_prepend(struct buffer *buf, size_t amount) { |
110 | buf->size += amount; |
111 | return buf->start -= amount; |
112 | } |
113 | |
114 | void *buf_unappend(struct buffer *buf, size_t amount) { |
115 | if (buf->size < amount) return 0; |
116 | return buf->start + (buf->size -= amount); |
117 | } |
118 | |
119 | void *buf_unprepend(struct buffer *buf, size_t amount) { |
120 | void *p; |
121 | |
122 | p= buf->start; |
123 | buf->start += amount; |
124 | buf->size -= amount; |
125 | return p; |
126 | } |