40d5cf1b7c5b9bb65f53133ce396403dd89f6aa1
[platform/upstream/busybox.git] / networking / fakeidentd.c
1 /* vi: set sw=4 ts=4: */
2 /*
3  * A fake identd server
4  *
5  * Adapted to busybox by Thomas Lundquist <thomasez@zelow.no>
6  * Original Author: Tomi Ollila <too@iki.fi>
7  *                  http://www.guru-group.fi/~too/sw/
8  *
9  * This program is free software; you can redistribute it and/or modify
10  * it under the terms of the GNU General Public License as published by
11  * the Free Software Foundation; either version 2 of the License, or
12  * (at your option) any later version.
13  *
14  * This program is distributed in the hope that it will be useful,
15  * but WITHOUT ANY WARRANTY; without even the implied warranty of
16  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
17  * General Public License for more details.
18  *
19  * You should have received a copy of the GNU General Public License
20  * along with this program; if not, write to the Free Software
21  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
22  *
23  */
24
25 #include <unistd.h>
26 #include <stdio.h>
27 #include <stdlib.h>
28 #include <stdarg.h>
29 #include <string.h>
30 #include <fcntl.h>
31 #include <signal.h>
32 #include <sys/syslog.h>
33
34 #include <pwd.h>
35 #include <netdb.h>
36
37 #include <sys/syslog.h>
38 #include <sys/types.h>
39 #include <sys/time.h>
40 #include <time.h>
41 #include <sys/socket.h>
42 #include <netinet/in.h>
43 #include <errno.h>
44 #include <arpa/inet.h>
45 #include <sys/uio.h>
46
47 #include "busybox.h"
48
49 #define IDENT_PORT  113
50 #define MAXCONNS    20
51 #define MAXIDLETIME 45
52
53 static const char ident_substr[] = " : USERID : UNIX : ";
54 static const int ident_substr_len = sizeof(ident_substr) - 1;
55 #define PIDFILE "/var/run/identd.pid"
56
57 /*
58  * We have to track the 'first connection socket' so that we 
59  * don't go around closing file descriptors for non-clients.
60  *
61  * descriptor setup normally
62  *  0 = server socket
63  *  1 = syslog fd (hopefully -- otherwise this won't work)
64  *  2 = connection socket after detached from tty. standard error before that
65  *  3 - 2 + MAXCONNS = rest connection sockets
66  *
67  * To try to make sure that syslog fd is what is "requested", the that fd
68  * is closed before openlog() call.  It can only severely fail if fd 0
69  * is initially closed.
70  */
71 #define FCS 2
72
73 /*
74  * FD of the connection is always the index of the connection structure
75  * in `conns' array + FCS
76  */
77 static struct {
78         char buf[20];
79         int len;
80         time_t lasttime;
81 } conns[MAXCONNS];
82
83 /* When using global variables, bind those at least to a structure. */
84 static struct {
85         const char *identuser;
86         fd_set readfds;
87         int conncnt;
88 } G;
89
90 /*
91  * Prototypes
92  */
93 static void reply(int s, char *buf);
94 static void replyError(int s, char *buf);
95
96 static const char *nobodystr = "nobody"; /* this needs to be declared like this */
97 static char *bind_ip_address = "0.0.0.0";
98
99 static inline void movefd(int from, int to)
100 {
101         if (from != to) {
102                 dup2(from, to);
103                 close(from);
104         }
105 }
106
107 static void inetbind(void)
108 {
109         int s, port;
110         struct sockaddr_in addr;
111         int len = sizeof(addr);
112         int one = 1;
113         struct servent *se;
114
115         if ((se = getservbyname("identd", "tcp")) == NULL)
116                 port = IDENT_PORT;
117         else
118                 port = se->s_port;
119
120         if ((s = socket(AF_INET, SOCK_STREAM, 0)) < 0)
121                 bb_perror_msg_and_die("Cannot create server socket");
122
123         setsockopt(s, SOL_SOCKET, SO_REUSEADDR, &one, sizeof(one));
124
125         memset(&addr, 0, sizeof(addr));
126         addr.sin_addr.s_addr = inet_addr(bind_ip_address);
127         addr.sin_family = AF_INET;
128         addr.sin_port = htons(port);
129
130         if (bind(s, (struct sockaddr *)&addr, len) < 0)
131                 bb_perror_msg_and_die("Cannot bind() port %i", IDENT_PORT);
132
133         if (listen(s, 5) < 0)
134                 bb_perror_msg_and_die("Cannot listen() on port %i", IDENT_PORT);
135
136         movefd(s, 0);
137 }
138
139 static void handlexitsigs(int signum)
140 {
141         if (unlink(PIDFILE) < 0)
142                 close(open(PIDFILE, O_WRONLY|O_CREAT|O_TRUNC, 0644));
143         exit(0);
144 }
145
146 /* May succeed. If not, won't care. */
147 static inline void writepid(uid_t nobody, uid_t nogrp)
148 {
149         char buf[24];
150         int fd = open(PIDFILE, O_WRONLY|O_CREAT|O_TRUNC, 0664);
151
152         if (fd < 0)
153                 return;
154
155         snprintf(buf, 23, "%d\n", getpid());
156         write(fd, buf, strlen(buf));
157         fchown(fd, nobody, nogrp);
158         close(fd);
159
160         /* should this handle ILL, ... (see signal(7)) */
161         signal(SIGTERM, handlexitsigs);
162         signal(SIGINT,  handlexitsigs);
163         signal(SIGQUIT, handlexitsigs);
164 }
165
166 /* return 0 as parent, 1 as child */
167 static int godaemon(void)
168 {
169         uid_t nobody, nogrp;
170         struct passwd *pw;
171
172         switch (fork()) {
173         case -1:
174                 bb_perror_msg_and_die("Could not fork");
175
176         case 0:
177                 pw = getpwnam(nobodystr);
178                 if (pw == NULL)
179                         bb_error_msg_and_die("Cannot find uid/gid of user '%s'", nobodystr);
180                 nobody = pw->pw_uid;
181                 nogrp = pw->pw_gid;
182                 writepid(nobody, nogrp);
183
184                 close(0);
185                 inetbind();
186                 if (setgid(nogrp))   bb_error_msg_and_die("Could not setgid()");
187                 if (setuid(nobody))  bb_error_msg_and_die("Could not setuid()");
188                 close(1);
189                 close(2);
190
191                 signal(SIGHUP, SIG_IGN);
192                 signal(SIGPIPE, SIG_IGN); /* connection closed when writing (raises ???) */
193
194                 setsid();
195
196                 openlog(bb_applet_name, 0, LOG_DAEMON);
197                 return 1;
198         }
199
200         return 0;
201 }
202
203 static void deleteConn(int s)
204 {
205         int i = s - FCS;
206
207         close(s);
208
209         G.conncnt--;
210
211         /*
212          * Most of the time there is 0 connections. Most often that there
213          * is connections, there is just one connection. When this one connection
214          * closes, i == G.conncnt = 0 -> no copying.
215          * When there is more than one connection, the oldest connections closes
216          * earlier on average. When this happens, the code below starts copying
217          * the connection structure w/ highest index to the place which which is
218          * just deleted. This means that the connection structures are no longer
219          * in chronological order. I'd quess this means that when there is more
220          * than 1 connection, on average every other connection structure needs
221          * to be copied over the time all these connections are deleted.
222          */
223         if (i != G.conncnt) {
224                 memcpy(&conns[i], &conns[G.conncnt], sizeof(conns[0]));
225                 movefd(G.conncnt + FCS, s);
226         }
227
228         FD_CLR(G.conncnt + FCS, &G.readfds);
229 }
230
231 static int closeOldest(void)
232 {
233         time_t min = conns[0].lasttime;
234         int idx = 0;
235         int i;
236
237         for (i = 1; i < MAXCONNS; i++)
238                 if (conns[i].lasttime < min)
239                         idx = i;
240
241         replyError(idx + FCS, "X-SERVER-TOO-BUSY");
242         close(idx + FCS);
243
244         return idx;
245 }
246
247 static int checkInput(char *buf, int len, int l)
248 {
249         int i;
250         for (i = len; i < len + l; ++i)
251                 if (buf[i] == '\n')
252                         return 1;
253         return 0;
254 }
255
256 int fakeidentd_main(int argc, char **argv)
257 {
258         memset(conns, 0, sizeof(conns));
259         memset(&G, 0, sizeof(G));
260         FD_ZERO(&G.readfds);
261         FD_SET(0, &G.readfds);
262
263         /* handle -b <ip> parameter */
264         bb_getopt_ulflags(argc, argv, "b:", &bind_ip_address);
265         /* handle optional REPLY STRING */
266         if (optind < argc)
267                 G.identuser = argv[optind];
268         else
269                 G.identuser = nobodystr;
270
271         /* daemonize and have the parent return */
272         if (godaemon() == 0)
273                 return 0;
274
275         /* main loop where we process all events and never exit */
276         while (1) {
277         fd_set rfds = G.readfds;
278         struct timeval tv = { 15, 0 };
279         int i;
280         int tim = time(NULL);
281
282         select(G.conncnt + FCS, &rfds, NULL, NULL, G.conncnt? &tv: NULL);
283
284         for (i = G.conncnt - 1; i >= 0; i--) {
285                 int s = i + FCS;
286
287                 if (FD_ISSET(s, &rfds)) {
288                         char *buf = conns[i].buf;
289                         unsigned int len = conns[i].len;
290                         unsigned int l;
291
292                         if ((l = read(s, buf + len, sizeof(conns[0].buf) - len)) > 0) {
293                                 if (checkInput(buf, len, l)) {
294                                         reply(s, buf);
295                                         goto deleteconn;
296                                 } else if (len + l >= sizeof(conns[0].buf)) {
297                                         replyError(s, "X-INVALID-REQUEST");
298                                         goto deleteconn;
299                                 } else {
300                                         conns[i].len += l;
301                                 }
302                         } else {
303                                 goto deleteconn;
304                         }
305
306                         conns[i].lasttime = tim;
307                         continue;
308
309 deleteconn:
310                         deleteConn(s);
311                 } else {
312                         /* implement as time_after() in linux kernel sources ... */
313                         if (conns[i].lasttime + MAXIDLETIME <= tim) {
314                                 replyError(s, "X-TIMEOUT");
315                                 deleteConn(s);
316                         }
317                 }
318         }
319
320         if (FD_ISSET(0, &rfds)) {
321                 int s = accept(0, NULL, 0);
322
323                 if (s < 0) {
324                         if (errno != EINTR) /* EINTR */
325                                 syslog(LOG_ERR, "accept: %s", strerror(errno));
326                 } else {
327                         if (G.conncnt == MAXCONNS)
328                                 i = closeOldest();
329                         else
330                                 i = G.conncnt++;
331
332                         movefd(s, i + FCS); /* move if not already there */
333                         FD_SET(i + FCS, &G.readfds);
334
335                         conns[i].len = 0;
336                         conns[i].lasttime = time(NULL);
337                 }
338         }
339         } /* end of while(1) */
340
341         return 0;
342 }
343
344 static int parseAddrs(char *ptr, char **myaddr, char **heraddr);
345 static void reply(int s, char *buf)
346 {
347         char *myaddr, *heraddr;
348
349         myaddr = heraddr = NULL;
350
351         if (parseAddrs(buf, &myaddr, &heraddr))
352                 replyError(s, "X-INVALID-REQUEST");
353         else {
354                 struct iovec iv[6];
355                 iv[0].iov_base = myaddr;               iv[0].iov_len = strlen(myaddr);
356                 iv[1].iov_base = ", ";                 iv[1].iov_len = 2;
357                 iv[2].iov_base = heraddr;              iv[2].iov_len = strlen(heraddr);
358                 iv[3].iov_base = (void *)ident_substr; iv[3].iov_len = ident_substr_len;
359                 iv[4].iov_base = (void *)G.identuser;  iv[4].iov_len = strlen(G.identuser);
360                 iv[5].iov_base = "\r\n";               iv[5].iov_len = 2;
361                 writev(s, iv, 6);
362         }
363 }
364
365 static void replyError(int s, char *buf)
366 {
367         struct iovec iv[3];
368         iv[0].iov_base = "0, 0 : ERROR : ";   iv[0].iov_len = 15;
369         iv[1].iov_base = buf;                 iv[1].iov_len = strlen(buf);
370         iv[2].iov_base = "\r\n";              iv[2].iov_len = 2;
371         writev(s, iv, 3);
372 }
373
374 static int chmatch(char c, char *chars)
375 {
376         for (; *chars; chars++)
377                 if (c == *chars)
378                         return 1;
379         return 0;
380 }
381
382 static int skipchars(char **p, char *chars)
383 {
384         while (chmatch(**p, chars))
385                 (*p)++;
386         if (**p == '\r' || **p == '\n')
387                 return 0;
388         return 1;
389 }
390
391 static int parseAddrs(char *ptr, char **myaddr, char **heraddr)
392 {
393         /* parse <port-on-server> , <port-on-client> */
394
395         if (!skipchars(&ptr, " \t"))
396                 return -1;
397
398         *myaddr = ptr;
399
400         if (!skipchars(&ptr, "1234567890"))
401                 return -1;
402
403         if (!chmatch(*ptr, " \t,"))
404                 return -1;
405
406         *ptr++ = '\0';
407
408         if (!skipchars(&ptr, " \t,") )
409                 return -1;
410
411         *heraddr = ptr;
412
413         skipchars(&ptr, "1234567890");
414
415         if (!chmatch(*ptr, " \n\r"))
416                 return -1;
417
418         *ptr = '\0';
419
420         return 0;
421 }