1 /* 2 * Copyright (c) 2010 Kip Macy. All rights reserved. 3 * Copyright (C) 2017 THL A29 Limited, a Tencent company. 4 * All rights reserved. 5 * 6 * Redistribution and use in source and binary forms, with or without 7 * modification, are permitted provided that the following conditions are met: 8 * 9 * 1. Redistributions of source code must retain the above copyright notice, this 10 * list of conditions and the following disclaimer. 11 * 2. Redistributions in binary form must reproduce the above copyright notice, 12 * this list of conditions and the following disclaimer in the documentation 13 * and/or other materials provided with the distribution. 14 * 15 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" AND 16 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED 17 * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE 18 * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR 19 * ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES 20 * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; 21 * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND 22 * ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 23 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS 24 * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 25 * 26 * Derived in part from libplebnet's pn_syscall_wrapper.c. 27 */ 28 29 #include <sys/param.h> 30 #include <sys/limits.h> 31 #include <sys/uio.h> 32 #include <sys/proc.h> 33 #include <sys/syscallsubr.h> 34 #include <sys/module.h> 35 #include <sys/param.h> 36 #include <sys/malloc.h> 37 #include <sys/socketvar.h> 38 #include <sys/event.h> 39 #include <sys/kernel.h> 40 #include <sys/refcount.h> 41 #include <sys/sysctl.h> 42 #include <sys/pcpu.h> 43 #include <sys/select.h> 44 #include <sys/poll.h> 45 #include <sys/event.h> 46 #include <sys/file.h> 47 #include <netinet/in.h> 48 #include <netinet/tcp.h> 49 #include <sys/ttycom.h> 50 #include <sys/filio.h> 51 #include <sys/sysproto.h> 52 #include <sys/fcntl.h> 53 #include <net/route.h> 54 55 #include <machine/stdarg.h> 56 57 #include "ff_api.h" 58 #include "ff_host_interface.h" 59 60 /* setsockopt/getsockopt define start */ 61 62 #define LINUX_SOL_SOCKET 1 63 64 #define LINUX_SO_DEBUG 1 65 #define LINUX_SO_REUSEADDR 2 66 #define LINUX_SO_ERROR 4 67 #define LINUX_SO_DONTROUTE 5 68 #define LINUX_SO_BROADCAST 6 69 #define LINUX_SO_SNDBUF 7 70 #define LINUX_SO_RCVBUF 8 71 #define LINUX_SO_KEEPALIVE 9 72 #define LINUX_SO_OOBINLINE 10 73 #define LINUX_SO_LINGER 13 74 #define LINUX_SO_RCVLOWAT 18 75 #define LINUX_SO_SNDLOWAT 19 76 #define LINUX_SO_RCVTIMEO 20 77 #define LINUX_SO_SNDTIMEO 21 78 #define LINUX_SO_ACCEPTCONN 30 79 #define LINUX_SO_PROTOCOL 38 80 81 82 #define LINUX_IP_TOS 1 83 #define LINUX_IP_TTL 2 84 #define LINUX_IP_HDRINCL 3 85 #define LINUX_IP_OPTIONS 4 86 87 #define LINUX_IP_MULTICAST_IF 32 88 #define LINUX_IP_MULTICAST_TTL 33 89 #define LINUX_IP_MULTICAST_LOOP 34 90 #define LINUX_IP_ADD_MEMBERSHIP 35 91 #define LINUX_IP_DROP_MEMBERSHIP 36 92 93 #define LINUX_TCP_NODELAY 1 94 #define LINUX_TCP_MAXSEG 2 95 #define LINUX_TCP_KEEPIDLE 4 96 #define LINUX_TCP_KEEPINTVL 5 97 #define LINUX_TCP_KEEPCNT 6 98 #define LINUX_TCP_MD5SIG 14 99 100 /* setsockopt/getsockopt define end */ 101 102 103 /* ioctl define start */ 104 105 #define LINUX_TIOCEXCL 0x540C 106 #define LINUX_TIOCNXCL 0x540D 107 #define LINUX_TIOCSCTTY 0x540E 108 #define LINUX_TIOCGPGRP 0x540F 109 #define LINUX_TIOCSPGRP 0x5410 110 #define LINUX_TIOCOUTQ 0x5411 111 #define LINUX_TIOCSTI 0x5412 112 #define LINUX_TIOCGWINSZ 0x5413 113 #define LINUX_TIOCSWINSZ 0x5414 114 #define LINUX_TIOCMGET 0x5415 115 #define LINUX_TIOCMBIS 0x5416 116 #define LINUX_TIOCMBIC 0x5417 117 #define LINUX_TIOCMSET 0x5418 118 119 #define LINUX_FIONREAD 0x541B 120 #define LINUX_TIOCCONS 0x541D 121 #define LINUX_TIOCPKT 0x5420 122 #define LINUX_FIONBIO 0x5421 123 #define LINUX_TIOCNOTTY 0x5422 124 #define LINUX_TIOCSETD 0x5423 125 #define LINUX_TIOCGETD 0x5424 126 #define LINUX_TIOCSBRK 0x5427 127 #define LINUX_TIOCCBRK 0x5428 128 #define LINUX_TIOCGSID 0x5429 129 130 #define LINUX_FIONCLEX 0x5450 131 #define LINUX_FIOCLEX 0x5451 132 #define LINUX_FIOASYNC 0x5452 133 134 #define LINUX_TIOCPKT_DATA 0 135 #define LINUX_TIOCPKT_FLUSHREAD 1 136 #define LINUX_TIOCPKT_FLUSHWRITE 2 137 #define LINUX_TIOCPKT_STOP 4 138 #define LINUX_TIOCPKT_START 8 139 #define LINUX_TIOCPKT_NOSTOP 16 140 #define LINUX_TIOCPKT_DOSTOP 32 141 #define LINUX_TIOCPKT_IOCTL 64 142 143 /* ioctl define end */ 144 145 146 extern int sendit(struct thread *td, int s, struct msghdr *mp, int flags); 147 148 static long 149 linux2freebsd_ioctl(unsigned long request) 150 { 151 switch(request) { 152 case LINUX_TIOCEXCL: 153 return TIOCEXCL; 154 case LINUX_TIOCNXCL: 155 return TIOCNXCL; 156 case LINUX_TIOCSCTTY: 157 return TIOCSCTTY; 158 case LINUX_TIOCGPGRP: 159 return TIOCGPGRP; 160 case LINUX_TIOCSPGRP: 161 return TIOCSPGRP; 162 case LINUX_TIOCOUTQ: 163 return TIOCOUTQ; 164 case LINUX_TIOCSTI: 165 return TIOCSTI; 166 case LINUX_TIOCGWINSZ: 167 return TIOCGWINSZ; 168 case LINUX_TIOCSWINSZ: 169 return TIOCSWINSZ; 170 case LINUX_TIOCMGET: 171 return TIOCMGET; 172 case LINUX_TIOCMBIS: 173 return TIOCMBIS; 174 case LINUX_TIOCMBIC: 175 return TIOCMBIC; 176 case LINUX_TIOCMSET: 177 return TIOCMSET; 178 case LINUX_FIONREAD: 179 return FIONREAD; 180 case LINUX_TIOCCONS: 181 return TIOCCONS; 182 case LINUX_TIOCPKT: 183 return TIOCPKT; 184 case LINUX_FIONBIO: 185 return FIONBIO; 186 case LINUX_TIOCNOTTY: 187 return TIOCNOTTY; 188 case LINUX_TIOCSETD: 189 return TIOCSETD; 190 case LINUX_TIOCGETD: 191 return TIOCGETD; 192 case LINUX_TIOCSBRK: 193 return TIOCSBRK; 194 case LINUX_TIOCCBRK: 195 return TIOCCBRK; 196 case LINUX_TIOCGSID: 197 return TIOCGSID; 198 case LINUX_FIONCLEX: 199 return FIONCLEX; 200 case LINUX_FIOCLEX: 201 return FIOCLEX; 202 case LINUX_FIOASYNC: 203 return FIOASYNC; 204 case LINUX_TIOCPKT_DATA: 205 return TIOCPKT_DATA; 206 case LINUX_TIOCPKT_FLUSHREAD: 207 return TIOCPKT_FLUSHREAD; 208 case LINUX_TIOCPKT_FLUSHWRITE: 209 return TIOCPKT_FLUSHWRITE; 210 case LINUX_TIOCPKT_STOP: 211 return TIOCPKT_STOP; 212 case LINUX_TIOCPKT_START: 213 return TIOCPKT_START; 214 case LINUX_TIOCPKT_NOSTOP: 215 return TIOCPKT_NOSTOP; 216 case LINUX_TIOCPKT_DOSTOP: 217 return TIOCPKT_DOSTOP; 218 case LINUX_TIOCPKT_IOCTL: 219 return TIOCPKT_IOCTL; 220 default: 221 return request; 222 } 223 } 224 225 static int 226 so_opt_convert(int optname) 227 { 228 switch(optname) { 229 case LINUX_SO_DEBUG: 230 return SO_DEBUG; 231 case LINUX_SO_REUSEADDR: 232 return SO_REUSEADDR; 233 case LINUX_SO_ERROR: 234 return SO_ERROR; 235 case LINUX_SO_DONTROUTE: 236 return SO_DONTROUTE; 237 case LINUX_SO_BROADCAST: 238 return SO_BROADCAST; 239 case LINUX_SO_SNDBUF: 240 return SO_SNDBUF; 241 case LINUX_SO_RCVBUF: 242 return SO_RCVBUF; 243 case LINUX_SO_KEEPALIVE: 244 return SO_KEEPALIVE; 245 case LINUX_SO_OOBINLINE: 246 return SO_OOBINLINE; 247 case LINUX_SO_LINGER: 248 return SO_LINGER; 249 case LINUX_SO_RCVLOWAT: 250 return SO_RCVLOWAT; 251 case LINUX_SO_SNDLOWAT: 252 return SO_SNDLOWAT; 253 case LINUX_SO_RCVTIMEO: 254 return SO_RCVTIMEO; 255 case LINUX_SO_SNDTIMEO: 256 return SO_SNDTIMEO; 257 case LINUX_SO_ACCEPTCONN: 258 return SO_ACCEPTCONN; 259 case LINUX_SO_PROTOCOL: 260 return SO_PROTOCOL; 261 default: 262 return optname; 263 } 264 } 265 266 static int 267 ip_opt_convert(int optname) 268 { 269 switch(optname) { 270 case LINUX_IP_TOS: 271 return IP_TOS; 272 case LINUX_IP_TTL: 273 return IP_TTL; 274 case LINUX_IP_HDRINCL: 275 return IP_HDRINCL; 276 case LINUX_IP_OPTIONS: 277 return IP_OPTIONS; 278 case LINUX_IP_MULTICAST_IF: 279 return IP_MULTICAST_IF; 280 case LINUX_IP_MULTICAST_TTL: 281 return IP_MULTICAST_TTL; 282 case LINUX_IP_MULTICAST_LOOP: 283 return IP_MULTICAST_LOOP; 284 case LINUX_IP_ADD_MEMBERSHIP: 285 return IP_ADD_MEMBERSHIP; 286 case LINUX_IP_DROP_MEMBERSHIP: 287 return IP_DROP_MEMBERSHIP; 288 default: 289 return optname; 290 } 291 } 292 293 static int 294 tcp_opt_convert(int optname) 295 { 296 switch(optname) { 297 case LINUX_TCP_NODELAY: 298 return TCP_NODELAY; 299 case LINUX_TCP_MAXSEG: 300 return TCP_MAXSEG; 301 case LINUX_TCP_KEEPIDLE: 302 return TCP_KEEPIDLE; 303 case LINUX_TCP_KEEPINTVL: 304 return TCP_KEEPINTVL; 305 case LINUX_TCP_KEEPCNT: 306 return TCP_KEEPCNT; 307 case LINUX_TCP_MD5SIG: 308 return TCP_MD5SIG; 309 default: 310 return optname; 311 } 312 } 313 314 static int 315 linux2freebsd_opt(int level, int optname) 316 { 317 switch(level) { 318 case SOL_SOCKET: 319 return so_opt_convert(optname); 320 case IPPROTO_IP: 321 return ip_opt_convert(optname); 322 case IPPROTO_TCP: 323 return tcp_opt_convert(optname); 324 default: 325 return optname; 326 } 327 } 328 329 static void 330 linux2freebsd_sockaddr(const struct linux_sockaddr *linux, 331 socklen_t addrlen, struct sockaddr *freebsd) 332 { 333 if (linux == NULL) { 334 return; 335 } 336 337 /* #linux and #freebsd may point to the same address */ 338 freebsd->sa_family = linux->sa_family; 339 freebsd->sa_len = addrlen; 340 bcopy(linux->sa_data, freebsd->sa_data, sizeof(linux->sa_data)); 341 } 342 343 static void 344 freebsd2linux_sockaddr(struct linux_sockaddr *linux, 345 struct sockaddr *freebsd) 346 { 347 if (linux == NULL) { 348 return; 349 } 350 351 linux->sa_family = freebsd->sa_family; 352 bcopy(freebsd->sa_data, linux->sa_data, sizeof(freebsd->sa_data)); 353 } 354 355 int 356 ff_socket(int domain, int type, int protocol) 357 { 358 int rc; 359 struct socket_args sa; 360 sa.domain = domain; 361 sa.type = type; 362 sa.protocol = protocol; 363 if ((rc = sys_socket(curthread, &sa))) 364 goto kern_fail; 365 366 return curthread->td_retval[0]; 367 kern_fail: 368 ff_os_errno(rc); 369 return (-1); 370 } 371 372 int 373 ff_getsockopt(int s, int level, int optname, void *optval, 374 socklen_t *optlen) 375 { 376 int rc; 377 if (level == LINUX_SOL_SOCKET) 378 level = SOL_SOCKET; 379 380 optname = linux2freebsd_opt(level, optname); 381 if (optname < 0) { 382 rc = EINVAL; 383 goto kern_fail; 384 } 385 386 if ((rc = kern_getsockopt(curthread, s, level, optname, 387 optval, UIO_USERSPACE, optlen))) 388 goto kern_fail; 389 390 return (rc); 391 392 kern_fail: 393 ff_os_errno(rc); 394 return (-1); 395 } 396 397 int 398 ff_setsockopt(int s, int level, int optname, const void *optval, 399 socklen_t optlen) 400 { 401 int rc; 402 403 if (level == LINUX_SOL_SOCKET) 404 level = SOL_SOCKET; 405 406 optname = linux2freebsd_opt(level, optname); 407 if (optname < 0) { 408 rc = EINVAL; 409 goto kern_fail; 410 } 411 412 if ((rc = kern_setsockopt(curthread, s, level, optname, 413 __DECONST(void *, optval), UIO_USERSPACE, optlen))) 414 goto kern_fail; 415 416 return (rc); 417 418 kern_fail: 419 ff_os_errno(rc); 420 return (-1); 421 } 422 423 int 424 ff_ioctl(int fd, unsigned long request, ...) 425 { 426 int rc; 427 va_list ap; 428 caddr_t argp; 429 430 long req = linux2freebsd_ioctl(request); 431 if (req < 0) { 432 rc = EINVAL; 433 goto kern_fail; 434 } 435 436 va_start(ap, request); 437 438 argp = va_arg(ap, caddr_t); 439 va_end(ap); 440 if ((rc = kern_ioctl(curthread, fd, req, argp))) 441 goto kern_fail; 442 443 return (rc); 444 445 kern_fail: 446 ff_os_errno(rc); 447 return (-1); 448 } 449 450 int 451 ff_close(int fd) 452 { 453 int rc; 454 455 if ((rc = kern_close(curthread, fd))) 456 goto kern_fail; 457 458 return (rc); 459 kern_fail: 460 ff_os_errno(rc); 461 return (-1); 462 } 463 464 ssize_t 465 ff_read(int fd, void *buf, size_t nbytes) 466 { 467 struct uio auio; 468 struct iovec aiov; 469 int rc; 470 471 if (nbytes > INT_MAX) { 472 rc = EINVAL; 473 goto kern_fail; 474 } 475 476 aiov.iov_base = buf; 477 aiov.iov_len = nbytes; 478 auio.uio_iov = &aiov; 479 auio.uio_iovcnt = 1; 480 auio.uio_resid = nbytes; 481 auio.uio_segflg = UIO_SYSSPACE; 482 if ((rc = kern_readv(curthread, fd, &auio))) 483 goto kern_fail; 484 rc = curthread->td_retval[0]; 485 486 return (rc); 487 kern_fail: 488 ff_os_errno(rc); 489 return (-1); 490 } 491 492 ssize_t 493 ff_readv(int fd, const struct iovec *iov, int iovcnt) 494 { 495 struct uio auio; 496 int rc, len, i; 497 498 len = 0; 499 for (i = 0; i < iovcnt; i++) 500 len += iov[i].iov_len; 501 auio.uio_iov = __DECONST(struct iovec *, iov); 502 auio.uio_iovcnt = iovcnt; 503 auio.uio_resid = len; 504 auio.uio_segflg = UIO_SYSSPACE; 505 506 if ((rc = kern_readv(curthread, fd, &auio))) 507 goto kern_fail; 508 rc = curthread->td_retval[0]; 509 510 return (rc); 511 kern_fail: 512 ff_os_errno(rc); 513 return (-1); 514 } 515 516 ssize_t 517 ff_write(int fd, const void *buf, size_t nbytes) 518 { 519 struct uio auio; 520 struct iovec aiov; 521 int rc; 522 523 if (nbytes > INT_MAX) { 524 rc = EINVAL; 525 goto kern_fail; 526 } 527 528 aiov.iov_base = (void *)(uintptr_t)buf; 529 aiov.iov_len = nbytes; 530 auio.uio_iov = &aiov; 531 auio.uio_iovcnt = 1; 532 auio.uio_resid = nbytes; 533 auio.uio_segflg = UIO_SYSSPACE; 534 if ((rc = kern_writev(curthread, fd, &auio))) 535 goto kern_fail; 536 rc = curthread->td_retval[0]; 537 538 return (rc); 539 kern_fail: 540 ff_os_errno(rc); 541 return (-1); 542 } 543 544 ssize_t 545 ff_writev(int fd, const struct iovec *iov, int iovcnt) 546 { 547 struct uio auio; 548 int i, rc, len; 549 550 len = 0; 551 for (i = 0; i < iovcnt; i++) 552 len += iov[i].iov_len; 553 auio.uio_iov = __DECONST(struct iovec *, iov); 554 auio.uio_iovcnt = iovcnt; 555 auio.uio_resid = len; 556 auio.uio_segflg = UIO_SYSSPACE; 557 if ((rc = kern_writev(curthread, fd, &auio))) 558 goto kern_fail; 559 rc = curthread->td_retval[0]; 560 561 return (rc); 562 kern_fail: 563 ff_os_errno(rc); 564 return (-1); 565 } 566 567 ssize_t 568 ff_send(int s, const void *buf, size_t len, int flags) 569 { 570 return (ff_sendto(s, buf, len, flags, NULL, 0)); 571 } 572 573 ssize_t 574 ff_sendto(int s, const void *buf, size_t len, int flags, 575 const struct linux_sockaddr *to, socklen_t tolen) 576 { 577 struct msghdr msg; 578 struct iovec aiov; 579 int rc; 580 581 struct sockaddr bsdaddr; 582 struct sockaddr *pf = &bsdaddr; 583 584 if (to) { 585 linux2freebsd_sockaddr(to, tolen, pf); 586 } else { 587 pf = NULL; 588 } 589 590 msg.msg_name = pf; 591 msg.msg_namelen = tolen; 592 msg.msg_iov = &aiov; 593 msg.msg_iovlen = 1; 594 msg.msg_control = 0; 595 aiov.iov_base = __DECONST(void *, buf); 596 aiov.iov_len = len; 597 if ((rc = sendit(curthread, s, &msg, flags))) 598 goto kern_fail; 599 600 rc = curthread->td_retval[0]; 601 602 return (rc); 603 kern_fail: 604 ff_os_errno(rc); 605 return (-1); 606 } 607 608 ssize_t 609 ff_sendmsg(int s, const struct msghdr *msg, int flags) 610 { 611 int rc; 612 613 if (msg->msg_name != NULL) { 614 linux2freebsd_sockaddr(msg->msg_name, 615 sizeof(struct linux_sockaddr), msg->msg_name); 616 } 617 618 if ((rc = sendit(curthread, s, __DECONST(struct msghdr *, msg), flags))) 619 goto kern_fail; 620 621 return (rc); 622 kern_fail: 623 ff_os_errno(rc); 624 return (-1); 625 } 626 627 628 ssize_t 629 ff_recv(int s, void *buf, size_t len, int flags) 630 { 631 return (ff_recvfrom(s, buf, len, flags, NULL, 0)); 632 } 633 634 ssize_t 635 ff_recvfrom(int s, void *buf, size_t len, int flags, 636 struct linux_sockaddr *from, socklen_t *fromlen) 637 { 638 struct msghdr msg; 639 struct iovec aiov; 640 int rc; 641 struct sockaddr bsdaddr; 642 643 if (fromlen != NULL) 644 msg.msg_namelen = *fromlen; 645 else 646 msg.msg_namelen = 0; 647 648 msg.msg_name = &bsdaddr; 649 msg.msg_iov = &aiov; 650 msg.msg_iovlen = 1; 651 aiov.iov_base = buf; 652 aiov.iov_len = len; 653 msg.msg_control = 0; 654 msg.msg_flags = flags; 655 if ((rc = kern_recvit(curthread, s, &msg, UIO_SYSSPACE, NULL))) 656 goto kern_fail; 657 rc = curthread->td_retval[0]; 658 if (fromlen != NULL) 659 *fromlen = msg.msg_namelen; 660 661 if (from) 662 freebsd2linux_sockaddr(from, &bsdaddr); 663 664 return (rc); 665 kern_fail: 666 ff_os_errno(rc); 667 return (-1); 668 } 669 670 ssize_t 671 ff_recvmsg(int s, struct msghdr *msg, int flags) 672 { 673 int rc, oldflags; 674 675 oldflags = msg->msg_flags; 676 msg->msg_flags = flags; 677 678 if ((rc = kern_recvit(curthread, s, msg, UIO_SYSSPACE, NULL))) { 679 msg->msg_flags = oldflags; 680 goto kern_fail; 681 } 682 rc = curthread->td_retval[0]; 683 684 freebsd2linux_sockaddr(msg->msg_name, msg->msg_name); 685 686 return (rc); 687 kern_fail: 688 ff_os_errno(rc); 689 return (-1); 690 } 691 692 int 693 ff_fcntl(int fd, int cmd, ...) 694 { 695 int rc; 696 va_list ap; 697 uintptr_t argp; 698 699 va_start(ap, cmd); 700 701 argp = va_arg(ap, uintptr_t); 702 va_end(ap); 703 704 if ((rc = kern_fcntl(curthread, fd, cmd, argp))) 705 goto kern_fail; 706 rc = curthread->td_retval[0]; 707 return (rc); 708 kern_fail: 709 ff_os_errno(rc); 710 return (-1); 711 } 712 713 int 714 ff_accept(int s, struct linux_sockaddr * addr, 715 socklen_t * addrlen) 716 { 717 int rc; 718 struct file *fp; 719 struct sockaddr *pf = NULL; 720 socklen_t socklen = sizeof(struct sockaddr); 721 722 if ((rc = kern_accept(curthread, s, &pf, &socklen, &fp))) 723 goto kern_fail; 724 725 rc = curthread->td_retval[0]; 726 fdrop(fp, curthread); 727 728 if (addr && pf) 729 freebsd2linux_sockaddr(addr, pf); 730 731 if (addrlen) 732 *addrlen = socklen; 733 734 if(pf != NULL) 735 free(pf, M_SONAME); 736 return (rc); 737 738 kern_fail: 739 if(pf != NULL) 740 free(pf, M_SONAME); 741 ff_os_errno(rc); 742 return (-1); 743 } 744 745 int 746 ff_listen(int s, int backlog) 747 { 748 int rc; 749 struct listen_args la = { 750 .s = s, 751 .backlog = backlog, 752 }; 753 if ((rc = sys_listen(curthread, &la))) 754 goto kern_fail; 755 756 return (rc); 757 kern_fail: 758 ff_os_errno(rc); 759 return (-1); 760 } 761 762 int 763 ff_bind(int s, const struct linux_sockaddr *addr, socklen_t addrlen) 764 { 765 int rc; 766 struct sockaddr bsdaddr; 767 linux2freebsd_sockaddr(addr, addrlen, &bsdaddr); 768 769 if ((rc = kern_bindat(curthread, AT_FDCWD, s, &bsdaddr))) 770 goto kern_fail; 771 772 return (rc); 773 kern_fail: 774 ff_os_errno(rc); 775 return (-1); 776 } 777 778 int 779 ff_connect(int s, const struct linux_sockaddr *name, socklen_t namelen) 780 { 781 int rc; 782 struct sockaddr bsdaddr; 783 linux2freebsd_sockaddr(name, namelen, &bsdaddr); 784 785 if ((rc = kern_connectat(curthread, AT_FDCWD, s, &bsdaddr))) 786 goto kern_fail; 787 788 return (rc); 789 kern_fail: 790 ff_os_errno(rc); 791 return (-1); 792 } 793 794 int 795 ff_getpeername(int s, struct linux_sockaddr * name, 796 socklen_t *namelen) 797 { 798 int rc; 799 struct sockaddr *pf = NULL; 800 801 if ((rc = kern_getpeername(curthread, s, &pf, namelen))) 802 goto kern_fail; 803 804 if (name && pf) 805 freebsd2linux_sockaddr(name, pf); 806 807 if(pf != NULL) 808 free(pf, M_SONAME); 809 return (rc); 810 811 kern_fail: 812 if(pf != NULL) 813 free(pf, M_SONAME); 814 ff_os_errno(rc); 815 return (-1); 816 } 817 818 int 819 ff_getsockname(int s, struct linux_sockaddr *name, 820 socklen_t *namelen) 821 { 822 int rc; 823 struct sockaddr *pf = NULL; 824 825 if ((rc = kern_getsockname(curthread, s, &pf, namelen))) 826 goto kern_fail; 827 828 if (name && pf) 829 freebsd2linux_sockaddr(name, pf); 830 831 if(pf != NULL) 832 free(pf, M_SONAME); 833 return (rc); 834 835 kern_fail: 836 if(pf != NULL) 837 free(pf, M_SONAME); 838 ff_os_errno(rc); 839 return (-1); 840 } 841 842 int 843 ff_shutdown(int s, int how) 844 { 845 int rc; 846 847 struct shutdown_args sa = { 848 .s = s, 849 .how = how, 850 }; 851 if ((rc = sys_shutdown(curthread, &sa))) 852 goto kern_fail; 853 854 return (rc); 855 kern_fail: 856 ff_os_errno(rc); 857 return (-1); 858 } 859 860 int 861 ff_sysctl(const int *name, u_int namelen, void *oldp, size_t *oldlenp, 862 const void *newp, size_t newlen) 863 { 864 int rc; 865 size_t retval; 866 867 rc = userland_sysctl(curthread, __DECONST(int *, name), namelen, oldp, oldlenp, 868 1, __DECONST(void *, newp), newlen, &retval, 0); 869 if (rc) 870 goto kern_fail; 871 if (oldlenp) 872 *oldlenp = retval; 873 return (0); 874 kern_fail: 875 ff_os_errno(rc); 876 return (-1); 877 } 878 879 int 880 ff_select(int nfds, fd_set *readfds, fd_set *writefds, fd_set *exceptfds, 881 struct timeval *timeout) 882 883 { 884 int rc; 885 886 rc = kern_select(curthread, nfds, readfds, writefds, exceptfds, timeout, 64); 887 if (rc) 888 goto kern_fail; 889 rc = curthread->td_retval[0]; 890 891 return (rc); 892 kern_fail: 893 ff_os_errno(rc); 894 return (-1); 895 896 } 897 898 int 899 ff_poll(struct pollfd fds[], nfds_t nfds, int timeout) 900 { 901 int rc; 902 struct timespec ts; 903 ts.tv_sec = 0; 904 ts.tv_nsec = 0; 905 if ((rc = kern_poll(curthread, fds, nfds, &ts, NULL))) 906 goto kern_fail; 907 rc = curthread->td_retval[0]; 908 return (rc); 909 910 kern_fail: 911 ff_os_errno(rc); 912 return (-1); 913 } 914 915 int 916 ff_kqueue(void) 917 { 918 int rc; 919 if ((rc = kern_kqueue(curthread, 0, NULL))) 920 goto kern_fail; 921 922 rc = curthread->td_retval[0]; 923 return (rc); 924 925 kern_fail: 926 ff_os_errno(rc); 927 return (-1); 928 } 929 930 struct sys_kevent_args { 931 int fd; 932 const struct kevent *changelist; 933 int nchanges; 934 void *eventlist; 935 int nevents; 936 const struct timespec *timeout; 937 void (*do_each)(void **, struct kevent *); 938 }; 939 940 static int 941 kevent_copyout(void *arg, struct kevent *kevp, int count) 942 { 943 int i; 944 struct kevent *ke; 945 struct sys_kevent_args *uap; 946 947 uap = (struct sys_kevent_args *)arg; 948 949 if (!uap->do_each) { 950 bcopy(kevp, uap->eventlist, count * sizeof *kevp); 951 uap->eventlist = (void *)((struct kevent *)(uap->eventlist) + count); 952 953 } else { 954 for (ke = kevp, i = 0; i < count; i++, ke++) { 955 uap->do_each(&(uap->eventlist), ke); 956 } 957 } 958 959 return (0); 960 } 961 962 /* 963 * Copy 'count' items from the list pointed to by uap->changelist. 964 */ 965 static int 966 kevent_copyin(void *arg, struct kevent *kevp, int count) 967 { 968 struct sys_kevent_args *uap; 969 970 uap = (struct sys_kevent_args *)arg; 971 bcopy(uap->changelist, kevp, count * sizeof *kevp); 972 973 uap->changelist += count; 974 975 return (0); 976 } 977 978 int 979 ff_kevent_do_each(int kq, const struct kevent *changelist, int nchanges, 980 void *eventlist, int nevents, const struct timespec *timeout, 981 void (*do_each)(void **, struct kevent *)) 982 { 983 int rc; 984 struct timespec ts; 985 ts.tv_sec = 0; 986 ts.tv_nsec = 0; 987 988 struct sys_kevent_args ska = { 989 kq, 990 changelist, 991 nchanges, 992 eventlist, 993 nevents, 994 &ts, 995 do_each 996 }; 997 998 struct kevent_copyops k_ops = { 999 &ska, 1000 kevent_copyout, 1001 kevent_copyin 1002 }; 1003 1004 if ((rc = kern_kevent(curthread, kq, nchanges, nevents, &k_ops, 1005 &ts))) 1006 goto kern_fail; 1007 1008 rc = curthread->td_retval[0]; 1009 return (rc); 1010 kern_fail: 1011 ff_os_errno(rc); 1012 return (-1); 1013 } 1014 1015 int 1016 ff_kevent(int kq, const struct kevent *changelist, int nchanges, 1017 struct kevent *eventlist, int nevents, const struct timespec *timeout) 1018 { 1019 return ff_kevent_do_each(kq, changelist, nchanges, eventlist, nevents, timeout, NULL); 1020 } 1021 1022 int 1023 ff_gettimeofday(struct timeval *tv, struct timezone *tz) 1024 { 1025 long nsec; 1026 ff_get_current_time(&(tv->tv_sec), &nsec); 1027 tv->tv_usec = nsec/1000; 1028 return 0; 1029 } 1030 1031 int 1032 ff_route_ctl(enum FF_ROUTE_CTL req, enum FF_ROUTE_FLAG flag, 1033 struct linux_sockaddr *dst, struct linux_sockaddr *gw, 1034 struct linux_sockaddr *netmask) 1035 1036 { 1037 struct sockaddr sa_gw, sa_dst, sa_nm; 1038 struct sockaddr *psa_gw, *psa_dst, *psa_nm; 1039 int rtreq, rtflag; 1040 int rc; 1041 1042 switch (req) { 1043 case FF_ROUTE_ADD: 1044 rtreq = RTM_ADD; 1045 break; 1046 case FF_ROUTE_DEL: 1047 rtreq = RTM_DELETE; 1048 break; 1049 case FF_ROUTE_CHANGE: 1050 rtreq = RTM_CHANGE; 1051 break; 1052 default: 1053 rc = EINVAL; 1054 goto kern_fail; 1055 } 1056 1057 switch (flag) { 1058 case FF_RTF_HOST: 1059 rtflag = RTF_HOST; 1060 break; 1061 case FF_RTF_GATEWAY: 1062 rtflag = RTF_GATEWAY; 1063 break; 1064 default: 1065 rc = EINVAL; 1066 goto kern_fail; 1067 }; 1068 1069 if (gw != NULL) { 1070 psa_gw = &sa_gw; 1071 linux2freebsd_sockaddr(gw, sizeof(*gw), psa_gw); 1072 } else { 1073 psa_gw = NULL; 1074 } 1075 1076 if (dst != NULL) { 1077 psa_dst = &sa_dst; 1078 linux2freebsd_sockaddr(dst, sizeof(*dst), psa_dst); 1079 } else { 1080 psa_dst = NULL; 1081 } 1082 1083 if (netmask != NULL) { 1084 psa_nm = &sa_nm; 1085 linux2freebsd_sockaddr(netmask, sizeof(*netmask), psa_nm); 1086 } else { 1087 psa_nm = NULL; 1088 } 1089 1090 rc = rtrequest_fib(rtreq, psa_dst, psa_gw, psa_nm, rtflag, 1091 NULL, RT_DEFAULT_FIB); 1092 1093 if (rc != 0) 1094 goto kern_fail; 1095 1096 return (rc); 1097 1098 kern_fail: 1099 ff_os_errno(rc); 1100 return (-1); 1101 } 1102