Intercept.c 26 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956
  1. /*
  2. * ZeroTier One - Network Virtualization Everywhere
  3. * Copyright (C) 2011-2015 ZeroTier, Inc.
  4. *
  5. * This program is free software: you can redistribute it and/or modify
  6. * it under the terms of the GNU General Public License as published by
  7. * the Free Software Foundation, either version 3 of the License, or
  8. * (at your option) any later version.
  9. *
  10. * This program is distributed in the hope that it will be useful,
  11. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  12. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  13. * GNU General Public License for more details.
  14. *
  15. * You should have received a copy of the GNU General Public License
  16. * along with this program. If not, see <http://www.gnu.org/licenses/>.
  17. *
  18. * --
  19. *
  20. * ZeroTier may be used and distributed under the terms of the GPLv3, which
  21. * are available at: http://www.gnu.org/licenses/gpl-3.0.html
  22. *
  23. * If you would like to embed ZeroTier into a commercial application or
  24. * redistribute it in a modified binary form, please contact ZeroTier Networks
  25. * LLC. Start here: http://www.zerotier.com/
  26. */
  27. #ifdef USE_GNU_SOURCE
  28. #define _GNU_SOURCE
  29. #endif
  30. /* Name used in err msgs */
  31. char *progname = "";
  32. #include <stdio.h>
  33. #include <dlfcn.h>
  34. #include <strings.h>
  35. #include <netinet/in.h>
  36. #include <sys/time.h>
  37. #include <pwd.h>
  38. #include <errno.h>
  39. #include <stdarg.h>
  40. #include <netdb.h>
  41. #include <string.h>
  42. #include <stdlib.h>
  43. #include <netinet/in.h>
  44. #include <net/if.h>
  45. #include <sys/syscall.h>
  46. #include <sys/types.h>
  47. #include <sys/socket.h>
  48. #include <sys/un.h>
  49. #include <arpa/inet.h>
  50. #include <poll.h>
  51. #include <pthread.h>
  52. #include <unistd.h>
  53. /* For NPs */
  54. #include <sys/stat.h>
  55. #include <sys/ipc.h>
  56. #include <sys/shm.h>
  57. /* for mmap */
  58. #include <sys/mman.h>
  59. #ifdef USE_SOCKS_DNS
  60. #include <resolv.h>
  61. #endif
  62. #include "Intercept.h"
  63. #include "Common.h"
  64. #ifdef CHECKS
  65. //#include <sys/time.h>
  66. #include <sys/resource.h>
  67. #include <linux/net.h> /* for NPROTO */
  68. #define SOCK_MAX (SOCK_PACKET + 1)
  69. #define SOCK_TYPE_MASK 0xf
  70. #endif
  71. /* Global Declarations */
  72. #ifdef USE_SOCKS_DNS
  73. static int (*realresinit)(void);
  74. #endif
  75. static int (*realconnect)(CONNECT_SIG);
  76. static int (*realselect)(SELECT_SIG);
  77. static int (*realpoll)(POLL_SIG);
  78. static int (*realbind)(BIND_SIG);
  79. static int (*realaccept)(ACCEPT_SIG);
  80. static int (*reallisten)(LISTEN_SIG);
  81. static int (*realsocket)(SOCKET_SIG);
  82. static int (*realsetsockopt)(SETSOCKOPT_SIG);
  83. static int (*realgetsockopt)(GETSOCKOPT_SIG);
  84. static int (*realaccept4)(ACCEPT4_SIG);
  85. /* Exported Function Prototypes */
  86. void my_init(void);
  87. int connect(CONNECT_SIG);
  88. int select(SELECT_SIG);
  89. int poll(POLL_SIG);
  90. int close(CLOSE_SIG);
  91. int bind(BIND_SIG);
  92. int accept(ACCEPT_SIG);
  93. int listen(LISTEN_SIG);
  94. int socket(SOCKET_SIG);
  95. int setsockopt(SETSOCKOPT_SIG);
  96. int getsockopt(GETSOCKOPT_SIG);
  97. int accept4(ACCEPT4_SIG);
  98. #ifdef USE_SOCKS_DNS
  99. int res_init(void);
  100. #endif
  101. int connect_to_service(void);
  102. int init_service_connection();
  103. void dwr(const char *fmt, ...);
  104. void load_symbols(void);
  105. void set_up_intercept();
  106. int checkpid();
  107. #define BUF_SZ 1024
  108. #define SERVICE_CONNECT_ATTEMPTS 30
  109. #define ERR_OK 0
  110. ssize_t sock_fd_read(int sock, void *buf, ssize_t bufsize, int *fd);
  111. /* threading */
  112. pthread_mutex_t lock;
  113. pthread_mutex_t loglock;
  114. /*------------------------------------------------------------------------------
  115. ------------------- Intercept<--->Service Comm mechanisms-----------------------
  116. ------------------------------------------------------------------------------*/
  117. // TODO: Find minimum BUF_SZ for RPC
  118. // TODO: Refactor RPC send logic
  119. static int is_initialized = 0;
  120. static int fdret_sock; // used for fd-transfers
  121. static int newfd; // used for "this_end" socket
  122. static int thispid;
  123. static char* af_sock_name = "/tmp/.ztnc_e5cd7a9e1c5311ab";
  124. /*
  125. * Check for forking
  126. */
  127. int checkpid() {
  128. if(thispid != getpid()) {
  129. printf("clone/fork detected. re-initializing this instance.\n");
  130. set_up_intercept();
  131. fdret_sock = init_service_connection();
  132. thispid = getpid();
  133. }
  134. return 0;
  135. }
  136. /*
  137. * Sends an RPC command to the service
  138. */
  139. void send_command(int rpc_fd, char *cmd)
  140. {
  141. int n_write = write(rpc_fd, cmd, BUF_SZ);
  142. if(n_write < 0){
  143. dwr("Error writing command to service (CMD = %d)\n", cmd[0]);
  144. errno = 0;
  145. //return -1;
  146. }
  147. }
  148. /*
  149. * Reads a return value from the service and sets errno (if applicable)
  150. */
  151. int get_retval()
  152. {
  153. if(fdret_sock >= 0) {
  154. int retval;
  155. int sz = sizeof(char) + sizeof(retval) + sizeof(errno);
  156. char retbuf[BUF_SZ];
  157. memset(&retbuf, '\0', sz);
  158. int n_read = read(fdret_sock, &retbuf, sz);
  159. if(n_read > 0) {
  160. memcpy(&retval, &retbuf[1], sizeof(retval));
  161. memcpy(&errno, &retbuf[1+sizeof(retval)], sizeof(errno));
  162. return retval;
  163. }
  164. }
  165. dwr("unable to read connect: return value\n");
  166. return -1;
  167. }
  168. /*------------------------------------------------------------------------------
  169. ---------- Unix-domain socket lazy initializer (for fd-transfers)--------------
  170. ------------------------------------------------------------------------------*/
  171. /* Sets up the connection pipes and sockets to the service */
  172. int init_service_connection()
  173. {
  174. if(!is_initialized)
  175. {
  176. struct sockaddr_un addr;
  177. int tfd = -1;
  178. memset(&addr, 0, sizeof(addr));
  179. addr.sun_family = AF_UNIX;
  180. strncpy(addr.sun_path, af_sock_name, sizeof(addr.sun_path)-1);
  181. int attempts = 0;
  182. int conn_err = -1;
  183. if ( (tfd = realsocket(AF_UNIX, SOCK_STREAM, 0)) == -1) {
  184. perror("socket error");
  185. exit(-1);
  186. }
  187. while(conn_err < 0 && attempts < SERVICE_CONNECT_ATTEMPTS)
  188. {
  189. dwr("trying connection (%d): %s\n", tfd, af_sock_name);
  190. conn_err = realconnect(tfd, (struct sockaddr*)&addr, sizeof(addr));
  191. if(conn_err < 0) {
  192. dwr("re-attempting connection in %ds\n", 1+attempts);
  193. sleep(1);
  194. }
  195. else {
  196. dwr("AF_UNIX connection established: %d\n", tfd);
  197. is_initialized = 1;
  198. return tfd;
  199. }
  200. attempts++;
  201. }
  202. }
  203. return -1;
  204. }
  205. /*------------------------------------------------------------------------------
  206. ------------------------ ctors and dtors (and friends)-------------------------
  207. ------------------------------------------------------------------------------*/
  208. void my_dest(void) __attribute__ ((destructor));
  209. void my_dest(void) {
  210. dwr("closing connections to service...\n");
  211. close(fdret_sock);
  212. pthread_mutex_destroy(&lock);
  213. }
  214. void load_symbols(void)
  215. {
  216. #ifdef USE_OLD_DLSYM
  217. void *lib;
  218. #endif
  219. /* possibly add check to beginning of each method to avoid needing to cll the constructor */
  220. if(thispid == getpid()) {
  221. dwr("detected duplicate call to global ctor (pid=%d).\n", thispid);
  222. }
  223. dwr(" -- pid = %d\n", getpid());
  224. dwr(" -- uid = %d\n", getuid());
  225. thispid = getpid();
  226. #ifndef USE_OLD_DLSYM
  227. realconnect = dlsym(RTLD_NEXT, "connect");
  228. realbind = dlsym(RTLD_NEXT, "bind");
  229. realaccept = dlsym(RTLD_NEXT, "accept");
  230. reallisten = dlsym(RTLD_NEXT, "listen");
  231. realsocket = dlsym(RTLD_NEXT, "socket");
  232. realbind = dlsym(RTLD_NEXT, "bind");
  233. realpoll = dlsym(RTLD_NEXT, "poll");
  234. realselect = dlsym(RTLD_NEXT, "select");
  235. realsetsockopt = dlsym(RTLD_NEXT, "setsockopt");
  236. realgetsockopt = dlsym(RTLD_NEXT, "getsockopt");
  237. realaccept4 = dlsym(RTLD_NEXT, "accept4");
  238. #ifdef USE_SOCKS_DNS
  239. realresinit = dlsym(RTLD_NEXT, "res_init");
  240. #endif
  241. #else
  242. lib = dlopen(LIBCONNECT, RTLD_LAZY);
  243. realconnect = dlsym(lib, "connect");
  244. realbind = dlsym(lib, "bind");
  245. realaccept = dlsym(lib, "accept");
  246. reallisten = dlsym(lib, "listen");
  247. realsocket = dlsym(lib, "socket");
  248. realpoll = dlsym(lib, "poll");
  249. realselect = dlsym(lib, "select");
  250. realsetsockopt = dlsym(lib, "setsockopt");
  251. realgetsockopt = dlsym(lib, "getsockopt");
  252. realaccept4 = dlsym(lib), "accept4");
  253. #ifdef USE_SOCKS_DNS
  254. realresinit = dlsym(lib, "res_init");
  255. #endif
  256. dlclose(lib);
  257. lib = dlopen(LIBC, RTLD_LAZY);
  258. dlclose(lib);
  259. #endif
  260. }
  261. /* Private Function Prototypes */
  262. void _init(void) __attribute__ ((constructor));
  263. void _init(void) {
  264. set_up_intercept();
  265. }
  266. /* get symbols and initialize mutexes */
  267. void set_up_intercept()
  268. {
  269. load_symbols();
  270. if(pthread_mutex_init(&lock, NULL) != 0) {
  271. printf("error while initializing service call mutex\n");
  272. }
  273. if(pthread_mutex_init(&loglock, NULL) != 0) {
  274. printf("error while initializing log mutex mutex\n");
  275. }
  276. }
  277. /*------------------------------------------------------------------------------
  278. ------------------------- ioctl(), fcntl(), setsockopt()------------------------
  279. ------------------------------------------------------------------------------*/
  280. /*
  281. char *cmd_to_str(int cmd)
  282. {
  283. switch(cmd)
  284. {
  285. case F_DUPFD:
  286. return "F_DUPFD";
  287. case F_GETFD:
  288. return "F_GETFD";
  289. case F_SETFD:
  290. return "F_SETFD";
  291. case F_GETFL:
  292. return "F_GETFL";
  293. case F_SETFL:
  294. return "F_SETFL";
  295. case F_GETLK:
  296. return "F_GETLK";
  297. case F_SETLK:
  298. return "F_SETLK";
  299. case F_SETLKW:
  300. return "F_SETLKW";
  301. default:
  302. return "?";
  303. }
  304. return "?";
  305. }
  306. */
  307. /*
  308. void arg_to_str(int arg)
  309. {
  310. if(arg & O_RDONLY) dwr("O_RDONLY ");
  311. if(arg & O_WRONLY) dwr("O_WRONLY ");
  312. if(arg & O_RDWR) dwr("O_RDWR ");
  313. if(arg & O_CREAT) dwr("O_CREAT ");
  314. if(arg & O_EXCL) dwr("O_EXCL ");
  315. if(arg & O_NOCTTY) dwr("O_NOCTTY ");
  316. if(arg & O_TRUNC) dwr("O_TRUNC ");
  317. if(arg & O_APPEND) dwr("O_APPEND ");
  318. if(arg & O_ASYNC) dwr("O_ASYNC ");
  319. if(arg & O_DIRECT) dwr("O_DIRECT ");
  320. if(arg & O_NOATIME) dwr("O_NOATIME ");
  321. if(arg & O_NONBLOCK) dwr("O_NONBLOCK ");
  322. if(arg & O_DSYNC) dwr("O_DSYNC ");
  323. if(arg & O_SYNC) dwr("O_SYNC ");
  324. }
  325. */
  326. /*
  327. char* level_to_str(int level)
  328. {
  329. switch(level)
  330. {
  331. case SOL_SOCKET:
  332. return "SOL_SOCKET";
  333. case IPPROTO_TCP:
  334. return "IPPROTO_TCP";
  335. default:
  336. return "?";
  337. }
  338. return "?";
  339. }
  340. */
  341. /*
  342. char* option_name_to_str(int opt)
  343. {
  344. if(opt == SO_DEBUG) return "SO_DEBUG";
  345. if(opt == SO_BROADCAST) return "SO_BROADCAST";
  346. if(opt == SO_BINDTODEVICE) return "SO_BINDTODEVICE";
  347. if(opt == SO_REUSEADDR) return "SO_REUSEADDR";
  348. if(opt == SO_KEEPALIVE) return "SO_KEEPALIVE";
  349. if(opt == SO_LINGER) return "SO_LINGER";
  350. if(opt == SO_OOBINLINE) return "SO_OOBINLINE";
  351. if(opt == SO_SNDBUF) return "SO_SNDBUF";
  352. if(opt == SO_RCVBUF) return "SO_RCVBUF";
  353. if(opt == SO_DONTROUTE) return "SO_DONTROUTEO_ASYNC";
  354. if(opt == SO_RCVLOWAT) return "SO_RCVLOWAT";
  355. if(opt == SO_RCVTIMEO) return "SO_RCVTIMEO";
  356. if(opt == SO_SNDLOWAT) return "SO_SNDLOWAT";
  357. if(opt == SO_SNDTIMEO)return "SO_SNDTIMEO";
  358. return "?";
  359. }
  360. */
  361. /*------------------------------------------------------------------------------
  362. ---------------------------------- shutdown() ----------------------------------
  363. ------------------------------------------------------------------------------*/
  364. /*
  365. void shutdown_arg_to_str(int arg)
  366. {
  367. if(arg & O_RDONLY) dwr("O_RDONLY ");
  368. if(arg & O_WRONLY) dwr("O_WRONLY ");
  369. if(arg & O_RDWR) dwr("O_RDWR ");
  370. if(arg & O_CREAT) dwr("O_CREAT ");
  371. if(arg & O_EXCL) dwr("O_EXCL ");
  372. if(arg & O_NOCTTY) dwr("O_NOCTTY ");
  373. if(arg & O_TRUNC) dwr("O_TRUNC ");
  374. if(arg & O_APPEND) dwr("O_APPEND ");
  375. if(arg & O_ASYNC) dwr("O_ASYNC ");
  376. if(arg & O_DIRECT) dwr("O_DIRECT ");
  377. if(arg & O_NOATIME) dwr("O_NOATIME ");
  378. if(arg & O_NONBLOCK) dwr("O_NONBLOCK ");
  379. if(arg & O_DSYNC) dwr("O_DSYNC ");
  380. if(arg & O_SYNC) dwr("O_SYNC ");
  381. }
  382. */
  383. /*
  384. void sock_type_to_str(int arg)
  385. {
  386. if(arg == SOCK_STREAM) printf("SOCK_STREAM ");
  387. if(arg == SOCK_DGRAM) printf("SOCK_DGRAM ");
  388. if(arg == SOCK_SEQPACKET) printf("SOCK_SEQPACKET ");
  389. if(arg == SOCK_RAW) printf("SOCK_RAW ");
  390. if(arg == SOCK_RDM) printf("SOCK_RDM ");
  391. if(arg == SOCK_PACKET) printf("SOCK_PACKET ");
  392. if(arg & SOCK_NONBLOCK) printf("| SOCK_NONBLOCK ");
  393. if(arg & SOCK_CLOEXEC) printf("| SOCK_CLOEXEC ");
  394. }
  395. */
  396. /*
  397. void sock_domain_to_str(int domain)
  398. {
  399. if(domain == AF_UNIX) printf("AF_UNIX ");
  400. if(domain == AF_LOCAL) printf("AF_LOCAL ");
  401. if(domain == AF_INET) printf("AF_INET ");
  402. if(domain == AF_INET6) printf("AF_INET6 ");
  403. if(domain == AF_IPX) printf("AF_IPX ");
  404. if(domain == AF_NETLINK) printf("AF_NETLINK ");
  405. if(domain == AF_X25) printf("AF_X25 ");
  406. if(domain == AF_AX25) printf("AF_AX25 ");
  407. if(domain == AF_ATMPVC) printf("AF_ATMPVC ");
  408. if(domain == AF_APPLETALK) printf("AF_APPLETALK ");
  409. if(domain == AF_PACKET) printf("AF_PACKET ");
  410. }
  411. */
  412. /*------------------------------------------------------------------------------
  413. --------------------------------- setsockopt() ---------------------------------
  414. ------------------------------------------------------------------------------*/
  415. /* int socket, int level, int option_name, const void *option_value, socklen_t option_len */
  416. int setsockopt(SETSOCKOPT_SIG)
  417. {
  418. #ifdef DUMMY
  419. dwr("setsockopt(%d)\n", socket);
  420. return realsetsockopt(socket, level, option_name, option_value, option_len);
  421. #else
  422. /* make sure we don't touch any standard outputs */
  423. if(socket == STDIN_FILENO || socket == STDOUT_FILENO || socket == STDERR_FILENO)
  424. return(realsetsockopt(socket, level, option_name, option_value, option_len));
  425. int err = realsetsockopt(socket, level, option_name, option_value, option_len);
  426. if(err < 0){
  427. //perror("setsockopt():\n");
  428. }
  429. return 0;
  430. #endif
  431. }
  432. /*------------------------------------------------------------------------------
  433. --------------------------------- getsockopt() ---------------------------------
  434. ------------------------------------------------------------------------------*/
  435. /* int sockfd, int level, int optname, void *optval, socklen_t *optlen */
  436. int getsockopt(GETSOCKOPT_SIG)
  437. {
  438. #ifdef DUMMY
  439. dwr("getsockopt(%d)\n", sockfd);
  440. return realgetsockopt(sockfd, level, optname, optval, optlen);
  441. #else
  442. // make sure we don't touch any standard outputs
  443. int err = realgetsockopt(sockfd, level, optname, optval, optlen);
  444. // FIXME: this condition will need a little more intelligence later on
  445. // -- we will need to know if this fd is a local we are spoofing, or a true local
  446. if(optname == SO_TYPE)
  447. {
  448. int* val = (int*)optval;
  449. *val = 2;
  450. optval = (void*)val;
  451. }
  452. if(err < 0){
  453. //perror("setsockopt():\n");
  454. }
  455. return 0;
  456. #endif
  457. }
  458. /*------------------------------------------------------------------------------
  459. ----------------------------------- socket() -----------------------------------
  460. ------------------------------------------------------------------------------*/
  461. /* int socket_family, int socket_type, int protocol
  462. socket() intercept function */
  463. int socket(SOCKET_SIG)
  464. {
  465. int err;
  466. #ifdef CHECKS
  467. /* Check that type makes sense */
  468. int flags = socket_type & ~SOCK_TYPE_MASK;
  469. if (flags & ~(SOCK_CLOEXEC | SOCK_NONBLOCK)) {
  470. errno = EINVAL;
  471. return -1;
  472. }
  473. socket_type &= SOCK_TYPE_MASK;
  474. /* Check protocol is in range */
  475. if (socket_family < 0 || socket_family >= NPROTO){
  476. errno = EAFNOSUPPORT;
  477. return -1;
  478. }
  479. if (socket_type < 0 || socket_type >= SOCK_MAX) {
  480. errno = EINVAL;
  481. return -1;
  482. }
  483. /* Check that we haven't hit the soft-limit file descriptors allowed */
  484. /* FIXME: Find number of open fds
  485. struct rlimit rl;
  486. getrlimit(RLIMIT_NOFILE, &rl);
  487. if(sockfd >= rl.rlim_cur){
  488. errno = EMFILE;
  489. return -1;
  490. }
  491. */
  492. /* FIXME: detect ENFILE condition */
  493. #endif
  494. #ifdef DUMMY
  495. dwr("socket(fam=%d, type=%d, prot=%d)\n", socket_family, socket_type, protocol);
  496. return realsocket(socket_family, socket_type, protocol);
  497. #else
  498. char cmd[BUF_SZ];
  499. fdret_sock = !is_initialized ? init_service_connection() : fdret_sock;
  500. if(socket_family == AF_LOCAL
  501. || socket_family == AF_NETLINK
  502. || socket_family == AF_UNIX) {
  503. return realsocket(socket_family, socket_type, protocol);
  504. }
  505. /* Assemble and route command */
  506. struct socket_st rpc_st;
  507. rpc_st.socket_family = socket_family;
  508. rpc_st.socket_type = socket_type;
  509. rpc_st.protocol = protocol;
  510. rpc_st.__tid = syscall(SYS_gettid);
  511. memset(cmd, '\0', BUF_SZ);
  512. cmd[0] = RPC_SOCKET;
  513. memcpy(&cmd[1], &rpc_st, sizeof(struct socket_st));
  514. pthread_mutex_lock(&lock);
  515. send_command(fdret_sock, cmd);
  516. /* get new fd */
  517. char rbuf[16];
  518. ssize_t sz = sock_fd_read(fdret_sock, rbuf, sizeof(rbuf), &newfd);
  519. if(sz > 0)
  520. {
  521. /* send our local-fd number back to service so
  522. it can complete its mapping table entry */
  523. memset(cmd, '\0', BUF_SZ);
  524. cmd[0] = RPC_FD_MAP_COMPLETION;
  525. memcpy(&cmd[1], &newfd, sizeof(newfd));
  526. if(newfd > -1) {
  527. send_command(fdret_sock, cmd);
  528. pthread_mutex_unlock(&lock);
  529. errno = ERR_OK; // OK
  530. return newfd;
  531. }
  532. else { // Try to read retval+errno since we RXed a bad fd
  533. dwr("Error, service sent bad fd.\n");
  534. err = get_retval();
  535. pthread_mutex_unlock(&lock);
  536. return err;
  537. }
  538. }
  539. else {
  540. dwr("Error while receiving new FD.\n");
  541. err = get_retval();
  542. pthread_mutex_unlock(&lock);
  543. return err;
  544. }
  545. #endif
  546. }
  547. /*------------------------------------------------------------------------------
  548. ---------------------------------- connect() -----------------------------------
  549. ------------------------------------------------------------------------------*/
  550. /* int __fd, const struct sockaddr * __addr, socklen_t __len
  551. connect() intercept function */
  552. int connect(CONNECT_SIG)
  553. {
  554. struct sockaddr_in *connaddr;
  555. connaddr = (struct sockaddr_in *) __addr;
  556. #ifdef CHECKS
  557. /* Check that this is a valid fd */
  558. if(fcntl(__fd, F_GETFD) < 0) {
  559. return -1;
  560. errno = EBADF;
  561. }
  562. /* Check that it is a socket */
  563. int sock_type;
  564. socklen_t sock_type_len = sizeof(sock_type);
  565. if(getsockopt(__fd, SOL_SOCKET, SO_TYPE, (void *) &sock_type, &sock_type_len) < 0) {
  566. errno = ENOTSOCK;
  567. return -1;
  568. }
  569. /* Check family */
  570. if (connaddr->sin_family < 0 || connaddr->sin_family >= NPROTO){
  571. errno = EAFNOSUPPORT;
  572. return -1;
  573. }
  574. /* FIXME: Check that address is in user space, return EFAULT ? */
  575. #endif
  576. #ifdef DUMMY
  577. dwr("connect(%d)\n", __fd);
  578. return realconnect(__fd, __addr, __len);
  579. #else
  580. /* make sure we don't touch any standard outputs */
  581. if(__fd == STDIN_FILENO || __fd == STDOUT_FILENO || __fd == STDERR_FILENO){
  582. if (realconnect == NULL) {
  583. dwr("Unresolved symbol: connect(). Library is exiting.\n");
  584. exit(-1);
  585. }
  586. return(realconnect(__fd, __addr, __len));
  587. }
  588. if(__addr != NULL && (connaddr->sin_family == AF_LOCAL
  589. || connaddr->sin_family == PF_NETLINK
  590. || connaddr->sin_family == AF_NETLINK
  591. || connaddr->sin_family == AF_UNIX)) {
  592. int err = realconnect(__fd, __addr, __len);
  593. return err;
  594. }
  595. /* assemble and route command */
  596. int err;
  597. char cmd[BUF_SZ];
  598. memset(cmd, '\0', BUF_SZ);
  599. struct connect_st rpc_st;
  600. rpc_st.__tid = syscall(SYS_gettid);
  601. rpc_st.__fd = __fd;
  602. memcpy(&rpc_st.__addr, __addr, sizeof(struct sockaddr));
  603. memcpy(&rpc_st.__len, &__len, sizeof(socklen_t));
  604. cmd[0] = RPC_CONNECT;
  605. memcpy(&cmd[1], &rpc_st, sizeof(struct connect_st));
  606. pthread_mutex_lock(&lock);
  607. send_command(fdret_sock, cmd);
  608. err = get_retval();
  609. pthread_mutex_unlock(&lock);
  610. return err;
  611. #endif
  612. }
  613. /*------------------------------------------------------------------------------
  614. ---------------------------------- select() ------------------------------------
  615. ------------------------------------------------------------------------------*/
  616. /* int n, fd_set *readfds, fd_set *writefds,
  617. fd_set *exceptfds, struct timeval *timeout */
  618. int select(SELECT_SIG)
  619. {
  620. #ifdef DUMMY
  621. dwr("select(n=%d, <readfds>, <writefds>, <exceptfds>, <timeout>)\n", n);
  622. return realselect(n, readfds, writefds, exceptfds, timeout);
  623. #else
  624. return realselect(n, readfds, writefds, exceptfds, timeout);
  625. #endif
  626. }
  627. /*------------------------------------------------------------------------------
  628. ----------------------------------- poll() -------------------------------------
  629. ------------------------------------------------------------------------------*/
  630. /* struct pollfd *__fds, nfds_t __nfds, int __timeout */
  631. int poll(POLL_SIG)
  632. {
  633. #ifdef DUMMY
  634. dwr("poll(<ufds>, nfds=%d, timeout=%d)\n", __fds, __timeout);
  635. return realpoll(__fds, __nfds, __timeout);
  636. #else
  637. return realpoll(__fds, __nfds, __timeout);
  638. #endif
  639. }
  640. /*------------------------------------------------------------------------------
  641. ------------------------------------ bind() ------------------------------------
  642. ------------------------------------------------------------------------------*/
  643. /* int sockfd, const struct sockaddr *addr, socklen_t addrlen
  644. bind() intercept function */
  645. int bind(BIND_SIG)
  646. {
  647. #ifdef CHECKS
  648. /* Check that this is a valid fd */
  649. if(fcntl(sockfd, F_GETFD) < 0) {
  650. return -1;
  651. errno = EBADF;
  652. }
  653. /* Check that it is a socket */
  654. int sock_type = -1;
  655. socklen_t sock_type_len = sizeof(sock_type);
  656. if(getsockopt(sockfd, SOL_SOCKET, SO_TYPE, (void *) &sock_type, &sock_type_len) < 0) {
  657. errno = ENOTSOCK;
  658. return -1;
  659. }
  660. #endif
  661. int err;
  662. #ifdef DUMMY
  663. dwr("bind(%d)\n", sockfd);
  664. return realbind(sockfd, addr, addrlen);
  665. #else
  666. /* make sure we don't touch any standard outputs */
  667. if(sockfd == STDIN_FILENO || sockfd == STDOUT_FILENO || sockfd == STDERR_FILENO)
  668. return(realbind(sockfd, addr, addrlen));
  669. /* If local, just use normal syscall */
  670. struct sockaddr_in *connaddr;
  671. connaddr = (struct sockaddr_in *) addr;
  672. if (addr != NULL && (connaddr->sin_family == AF_LOCAL
  673. || connaddr->sin_family == PF_NETLINK
  674. || connaddr->sin_family == AF_NETLINK
  675. || connaddr->sin_family == AF_UNIX))
  676. {
  677. if(realbind == NULL) {
  678. dwr("Unresolved symbol: bind(). Library is exiting.\n");
  679. exit(-1);
  680. }
  681. return(realbind(sockfd, addr, addrlen));
  682. }
  683. /* Assemble and route command */
  684. char cmd[BUF_SZ];
  685. struct bind_st rpc_st;
  686. rpc_st.sockfd = sockfd;
  687. rpc_st.__tid = syscall(SYS_gettid);
  688. memcpy(&rpc_st.addr, addr, sizeof(struct sockaddr));
  689. memcpy(&rpc_st.addrlen, &addrlen, sizeof(socklen_t));
  690. cmd[0]=RPC_BIND;
  691. memcpy(&cmd[1], &rpc_st, sizeof(struct bind_st));
  692. pthread_mutex_lock(&lock);
  693. send_command(fdret_sock, cmd);
  694. err = get_retval();
  695. pthread_mutex_unlock(&lock);
  696. errno = ERR_OK;
  697. return err;
  698. #endif
  699. }
  700. /*------------------------------------------------------------------------------
  701. ----------------------------------- accept4() ----------------------------------
  702. ------------------------------------------------------------------------------*/
  703. /* int sockfd, struct sockaddr *addr, socklen_t *addrlen, int flags */
  704. int accept4(ACCEPT4_SIG)
  705. {
  706. #ifdef CHECKS
  707. if (flags & ~(SOCK_CLOEXEC | SOCK_NONBLOCK)) {
  708. errno = EINVAL;
  709. return -1;
  710. }
  711. #endif
  712. #ifdef DUMMY
  713. dwr("accept4(%d)\n", sockfd);
  714. return accept(sockfd, addr, addrlen);
  715. #else
  716. return accept(sockfd, addr, addrlen);
  717. #endif
  718. }
  719. /*------------------------------------------------------------------------------
  720. ----------------------------------- accept() -----------------------------------
  721. ------------------------------------------------------------------------------*/
  722. /* int sockfd struct sockaddr *addr, socklen_t *addrlen
  723. accept() intercept function */
  724. int accept(ACCEPT_SIG)
  725. {
  726. #ifdef CHECKS
  727. /* Check that this is a valid fd */
  728. if(fcntl(sockfd, F_GETFD) < 0) {
  729. return -1;
  730. errno = EBADF;
  731. }
  732. /* Check that it is a socket */
  733. int sock_type;
  734. socklen_t sock_type_len = sizeof(sock_type);
  735. if(getsockopt(sockfd, SOL_SOCKET, SO_TYPE, (void *) &sock_type, &sock_type_len) < 0) {
  736. errno = ENOTSOCK;
  737. return -1;
  738. }
  739. /* Check that this socket supports accept() */
  740. if(!(sock_type && (SOCK_STREAM | SOCK_SEQPACKET))) {
  741. errno = EOPNOTSUPP;
  742. return -1;
  743. }
  744. /* Check that we haven't hit the soft-limit file descriptors allowed */
  745. struct rlimit rl;
  746. getrlimit(RLIMIT_NOFILE, &rl);
  747. if(sockfd >= rl.rlim_cur){
  748. errno = EMFILE;
  749. return -1;
  750. }
  751. #endif
  752. #ifdef DUMMY
  753. return realaccept(sockfd, addr, addrlen);
  754. #else
  755. /* make sure we don't touch any standard outputs */
  756. if(sockfd == STDIN_FILENO || sockfd == STDOUT_FILENO || sockfd == STDERR_FILENO)
  757. return(realaccept(sockfd, addr, addrlen));
  758. addr->sa_family = AF_INET;
  759. /* TODO: also get address info */
  760. char cmd[BUF_SZ];
  761. if(realaccept == NULL) {
  762. dwr( "Unresolved symbol: accept()\n");
  763. return -1;
  764. }
  765. char rbuf[16], c[1];
  766. int new_conn_socket;
  767. int n = read(sockfd, c, sizeof(c)); // Read signal byte
  768. if(n > 0)
  769. {
  770. ssize_t size = sock_fd_read(fdret_sock, rbuf, sizeof(rbuf), &new_conn_socket);
  771. if(size > 0) {
  772. /* Send our local-fd number back to service so it can complete its mapping table */
  773. memset(cmd, '\0', BUF_SZ);
  774. cmd[0] = RPC_FD_MAP_COMPLETION;
  775. memcpy(&cmd[1], &new_conn_socket, sizeof(new_conn_socket));
  776. pthread_mutex_lock(&lock);
  777. int n_write = write(fdret_sock, cmd, BUF_SZ);
  778. if(n_write < 0) {
  779. dwr("Error sending perceived FD to service.\n");
  780. errno = ECONNABORTED; // FIXME: Closest match, service unreachable
  781. return -1;
  782. }
  783. pthread_mutex_unlock(&lock);
  784. errno = ERR_OK;
  785. return new_conn_socket; // OK
  786. }
  787. else {
  788. dwr("Error receiving new FD from service.\n");
  789. errno = ECONNABORTED; // FIXME: Closest match, service unreachable
  790. return -1;
  791. }
  792. }
  793. dwr("Error reading signal byte from service.\n");
  794. //errno = EWOULDBLOCK;
  795. errno = ECONNABORTED; // FIXME: Closest match, service unreachable
  796. return -1;
  797. #endif
  798. }
  799. /*------------------------------------------------------------------------------
  800. ------------------------------------- listen()----------------------------------
  801. ------------------------------------------------------------------------------*/
  802. /* int sockfd, int backlog
  803. listen() intercept function */
  804. int listen(LISTEN_SIG)
  805. {
  806. #ifdef CHECKS
  807. /* Check that this is a valid fd */
  808. if(fcntl(sockfd, F_GETFD) < 0) {
  809. return -1;
  810. errno = EBADF;
  811. }
  812. /* Check that it is a socket */
  813. int sock_type;
  814. socklen_t sock_type_len = sizeof(sock_type);
  815. if(getsockopt(sockfd, SOL_SOCKET, SO_TYPE, (void *) &sock_type, &sock_type_len) < 0) {
  816. errno = ENOTSOCK;
  817. return -1;
  818. }
  819. /* Check that this socket supports accept() */
  820. if(!(sock_type && (SOCK_STREAM | SOCK_SEQPACKET))) {
  821. errno = EOPNOTSUPP;
  822. return -1;
  823. }
  824. #endif
  825. int err;
  826. #ifdef DUMMY
  827. dwr("listen(%d)\n", sockfd);
  828. return reallisten(sockfd, backlog);
  829. #else
  830. /* make sure we don't touch any standard outputs */
  831. if(sockfd == STDIN_FILENO || sockfd == STDOUT_FILENO || sockfd == STDERR_FILENO)
  832. return(reallisten(sockfd, backlog));
  833. char cmd[BUF_SZ];
  834. dwr("listen(%d)\n", sockfd);
  835. /* Assemble and route command */
  836. memset(cmd, '\0', BUF_SZ);
  837. struct listen_st rpc_st;
  838. rpc_st.sockfd = sockfd;
  839. rpc_st.backlog = backlog;
  840. rpc_st.__tid = syscall(SYS_gettid);
  841. cmd[0] = RPC_LISTEN;
  842. memcpy(&cmd[1], &rpc_st, sizeof(struct listen_st));
  843. pthread_mutex_lock(&lock);
  844. send_command(fdret_sock, cmd);
  845. err = get_retval();
  846. pthread_mutex_unlock(&lock);
  847. errno = ERR_OK;
  848. return err;
  849. #endif
  850. }