Commit | Line | Data |
---|---|---|
f9e59051 | 1 | /* |
f0e54a99 | 2 | * General utility functions for udp tunnel |
3 | */ | |
4 | /* | |
9028e234 IJ |
5 | * Copyright 1996-2013 Ian Jackson <ijackson@chiark.greenend.org.uk> |
6 | * Copyright 1998 David Damerell <damerell@chiark.greenend.org.uk> | |
7 | * Copyright 1999,2003 | |
8 | * Chancellor Masters and Scholars of the University of Cambridge | |
9 | * Copyright 2010 Tony Finch <fanf@dotat.at> | |
f0e54a99 | 10 | * |
11 | * This is free software; you can redistribute it and/or modify it | |
12 | * under the terms of the GNU General Public License as published by | |
9028e234 | 13 | * the Free Software Foundation; either version 3 of the License, or |
f0e54a99 | 14 | * (at your option) any later version. |
15 | * | |
16 | * This program is distributed in the hope that it will be useful, but | |
17 | * WITHOUT ANY WARRANTY; without even the implied warranty of | |
18 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU | |
19 | * General Public License for more details. | |
20 | * | |
21 | * You should have received a copy of the GNU General Public License | |
9028e234 | 22 | * along with userv-utils; if not, see http://www.gnu.org/licenses/. |
f9e59051 | 23 | */ |
24 | ||
25 | #include <string.h> | |
26 | #include <errno.h> | |
27 | #include <unistd.h> | |
28 | #include <stdlib.h> | |
29 | #include <assert.h> | |
30 | ||
31 | #include "forwarder.h" | |
32 | ||
33 | const char *const *argv; | |
34 | char programid[SYS_NMLN+sizeof(PROGRAM)+3]; | |
35 | ||
36 | void arg_assert_fail(const char *msg) { | |
37 | fprintf(stderr, PROGRAM ": argument error (!`%s')\n",msg); | |
38 | exit(12); | |
39 | } | |
40 | ||
41 | void sysfail(const char *msg) { | |
42 | fprintf(stderr, "%s: fatal system error: %s: %s\n", programid, msg, strerror(errno)); | |
43 | exit(8); | |
44 | } | |
45 | ||
46 | void fail(const char *msg) { | |
47 | fprintf(stderr, "%s: fatal error: %s\n", programid, msg); | |
48 | exit(4); | |
49 | } | |
50 | ||
51 | void sysdiag(const char *msg) { | |
52 | fprintf(stderr, "%s: system/network error: %s: %s\n", programid, msg, strerror(errno)); | |
53 | } | |
54 | ||
55 | void diag(const char *msg) { | |
56 | fprintf(stderr, "%s: %s\n", programid, msg); | |
57 | } | |
58 | ||
59 | time_t now(void) { | |
60 | time_t r; | |
61 | if (time(&r) == (time_t)-1) sysfail("get time of day"); | |
62 | return r; | |
63 | } | |
64 | ||
65 | void *xmalloc(size_t sz) { | |
66 | void *r; | |
67 | r= malloc(sz); | |
68 | if (!r) sysfail("allocate memory"); | |
69 | return r; | |
70 | } | |
71 | ||
72 | void write_must(int fd, const void *p_in, int sz, const char *what) { | |
73 | const unsigned char *p= p_in; | |
74 | int r; | |
75 | ||
76 | while (sz) { | |
77 | r= write(fd,p,sz); | |
78 | if (r<0) { | |
79 | if (errno == EINTR) continue; | |
80 | else sysfail(what); | |
81 | } | |
82 | assert(r && r <= sz); | |
83 | p += r; | |
84 | sz -= r; | |
85 | } | |
86 | } | |
87 | ||
88 | void read_must(int fd, void *p_in, int sz, const char *what) { | |
89 | unsigned char *p= p_in; | |
90 | int r; | |
91 | ||
92 | while (sz) { | |
93 | r= read(fd,p,sz); | |
94 | if (r<0) { | |
95 | if (errno == EINTR) continue; | |
96 | else sysfail(what); | |
97 | } | |
98 | if (r==0) fail(what); | |
99 | assert(r <= sz); | |
100 | p += r; | |
101 | sz -= r; | |
102 | } | |
103 | } | |
104 | ||
f9e59051 | 105 | const char *getarg_string(void) { |
106 | const char *arg; | |
107 | ||
108 | arg= *++argv; | |
109 | arg_assert(arg); | |
110 | return arg; | |
111 | } | |
112 | ||
113 | unsigned long getarg_ulong(void) { | |
114 | char *ep; | |
115 | unsigned long ul; | |
116 | ||
117 | ul= strtoul(getarg_string(),&ep,0); | |
118 | arg_assert(!*ep); | |
119 | return ul; | |
120 | } | |
121 | ||
122 | void *buf_append(struct buffer *buf, size_t amount) { | |
123 | void *p; | |
124 | ||
125 | p= buf->start + buf->size; | |
126 | buf->size += amount; | |
127 | return p; | |
128 | } | |
129 | ||
130 | void *buf_prepend(struct buffer *buf, size_t amount) { | |
131 | buf->size += amount; | |
132 | return buf->start -= amount; | |
133 | } | |
134 | ||
135 | void *buf_unappend(struct buffer *buf, size_t amount) { | |
136 | if (buf->size < amount) return 0; | |
137 | return buf->start + (buf->size -= amount); | |
138 | } | |
139 | ||
140 | void *buf_unprepend(struct buffer *buf, size_t amount) { | |
141 | void *p; | |
142 | ||
143 | p= buf->start; | |
144 | buf->start += amount; | |
145 | buf->size -= amount; | |
146 | return p; | |
147 | } |