pty.cpp 2.7 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125
  1. /*
  2. * Copyright (c) 2018-2020, Andreas Kling <kling@serenityos.org>
  3. * Copyright (c) 2021, Gunnar Beutner <gbeutner@serenityos.org>
  4. * Copyright (c) 2021, Linus Groh <linusg@serenityos.org>
  5. *
  6. * SPDX-License-Identifier: BSD-2-Clause
  7. */
  8. #include <errno.h>
  9. #include <fcntl.h>
  10. #include <pty.h>
  11. #include <stdlib.h>
  12. #include <string.h>
  13. #include <sys/ioctl.h>
  14. #include <unistd.h>
  15. int openpty(int* amaster, int* aslave, char* name, const struct termios* termp, const struct winsize* winp)
  16. {
  17. *amaster = posix_openpt(O_RDWR);
  18. if (*amaster < 0) {
  19. return -1;
  20. }
  21. if (grantpt(*amaster) < 0) {
  22. int error = errno;
  23. close(*amaster);
  24. errno = error;
  25. return -1;
  26. }
  27. if (unlockpt(*amaster) < 0) {
  28. int error = errno;
  29. close(*amaster);
  30. errno = error;
  31. return -1;
  32. }
  33. char tty_name[32];
  34. int rc = ptsname_r(*amaster, tty_name, sizeof(tty_name));
  35. if (rc < 0) {
  36. int error = errno;
  37. close(*amaster);
  38. errno = error;
  39. return -1;
  40. }
  41. if (name) {
  42. /* The spec doesn't say how large name has to be. Good luck. */
  43. [[maybe_unused]] auto rc = strlcpy(name, tty_name, 128);
  44. }
  45. *aslave = open(tty_name, O_RDWR | O_NOCTTY);
  46. if (*aslave < 0) {
  47. int error = errno;
  48. close(*amaster);
  49. errno = error;
  50. return -1;
  51. }
  52. if (termp) {
  53. if (tcsetattr(*aslave, TCSAFLUSH, termp) == -1) {
  54. int error = errno;
  55. close(*aslave);
  56. close(*amaster);
  57. errno = error;
  58. return -1;
  59. }
  60. }
  61. if (winp) {
  62. if (ioctl(*aslave, TIOCGWINSZ, winp) == -1) {
  63. int error = errno;
  64. close(*aslave);
  65. close(*amaster);
  66. errno = error;
  67. return -1;
  68. }
  69. }
  70. return 0;
  71. }
  72. pid_t forkpty(int* amaster, char* name, const struct termios* termp, const struct winsize* winp)
  73. {
  74. int master;
  75. int slave;
  76. if (openpty(&master, &slave, name, termp, winp) < 0)
  77. return -1;
  78. pid_t pid = fork();
  79. if (pid < 0) {
  80. close(master);
  81. close(slave);
  82. return -1;
  83. }
  84. *amaster = master;
  85. if (pid == 0) {
  86. close(master);
  87. if (login_tty(slave) < 0)
  88. _exit(1);
  89. return 0;
  90. }
  91. close(slave);
  92. return pid;
  93. }
  94. int login_tty(int fd)
  95. {
  96. setsid();
  97. close(0);
  98. close(1);
  99. close(2);
  100. int rc = dup2(fd, 0);
  101. if (rc < 0)
  102. return rc;
  103. rc = dup2(fd, 1);
  104. if (rc < 0)
  105. return -1;
  106. rc = dup2(fd, 2);
  107. if (rc < 0)
  108. return rc;
  109. rc = close(fd);
  110. if (rc < 0)
  111. return rc;
  112. rc = ioctl(0, TIOCSCTTY);
  113. if (rc < 0)
  114. return rc;
  115. return 0;
  116. }