uis.c 4.6 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188
  1. /*
  2. * Copyright (C) 2006 Steven Dake (sdake@mvista.com)
  3. *
  4. * This software licensed under BSD license, the text of which follows:
  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. * - Redistributions of source code must retain the above copyright notice,
  10. * this list of conditions and the following disclaimer.
  11. * - 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. * - Neither the name of the MontaVista Software, Inc. nor the names of its
  15. * contributors may be used to endorse or promote products derived from this
  16. * software without specific prior written permission.
  17. *
  18. * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
  19. * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  20. * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  21. * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
  22. * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
  23. * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
  24. * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
  25. * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
  26. * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
  27. * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF
  28. * THE POSSIBILITY OF SUCH DAMAGE.
  29. */
  30. #include <sys/uio.h>
  31. #include <sys/mman.h>
  32. #include <sys/types.h>
  33. #include <sys/socket.h>
  34. #include <sys/un.h>
  35. #include <sys/time.h>
  36. #include <sys/resource.h>
  37. #include <netinet/in.h>
  38. #include <arpa/inet.h>
  39. #include <unistd.h>
  40. #include <fcntl.h>
  41. #include <stdlib.h>
  42. #include <stdio.h>
  43. #include <errno.h>
  44. #include <signal.h>
  45. #include <sched.h>
  46. #include <time.h>
  47. #include <pthread.h>
  48. #include <sys/poll.h>
  49. #include <string.h>
  50. #define SERVER_BACKLOG 5
  51. #if defined(OPENAIS_LINUX)
  52. /* SUN_LEN is broken for abstract namespace
  53. */
  54. #define AIS_SUN_LEN(a) sizeof(*(a))
  55. static char *socketname = "lcr.socket";
  56. #else
  57. #define AIS_SUN_LEN(a) SUN_LEN(a)
  58. static char *socketname = "/var/run/lcr.socket";
  59. #endif
  60. static void uis_lcr_bind (int *server_fd)
  61. {
  62. int fd;
  63. struct sockaddr_un un_addr;
  64. int res;
  65. /*
  66. * Create socket for lcr clients, name socket, listen for connections
  67. */
  68. fd = socket (PF_UNIX, SOCK_STREAM, 0);
  69. if (fd == -1) {
  70. printf ("lcr_bind failed\n");
  71. };
  72. #if !defined(OPENAIS_LINUX)
  73. unlink(socketname);
  74. #endif
  75. memset (&un_addr, 0, sizeof (struct sockaddr_un));
  76. #if defined(OPENAIS_BSD) || defined(OPENAIS_DARWIN)
  77. un_addr.sun_len = sizeof(struct sockaddr_un);
  78. #endif
  79. un_addr.sun_family = AF_UNIX;
  80. #if defined(OPENAIS_LINUX)
  81. strcpy (un_addr.sun_path + 1, socketname);
  82. #else
  83. strcpy (un_addr.sun_path, socketname);
  84. #endif
  85. res = bind (fd, (struct sockaddr *)&un_addr, AIS_SUN_LEN(&un_addr));
  86. if (res) {
  87. printf ("Could not bind AF_UNIX: %s\n", strerror (errno));
  88. }
  89. listen (fd, SERVER_BACKLOG);
  90. *server_fd = fd;
  91. }
  92. struct uis_commands {
  93. char *command;
  94. void (*cmd_handler) (char *);
  95. };
  96. void cmd1 (char *cmd) {
  97. printf ("cmd1 executed with cmd line %s\n", cmd);
  98. }
  99. struct uis_commands uis_commands[] = {
  100. {
  101. "cmd1", cmd1
  102. }
  103. };
  104. struct req_msg {
  105. int len;
  106. char msg[0];
  107. };
  108. static void lcr_uis_dispatch (int fd)
  109. {
  110. struct req_msg header;
  111. char msg_contents[512];
  112. ssize_t readsize;
  113. /*
  114. * TODO this doesn't handle short reads
  115. */
  116. readsize = read (fd, &header, sizeof (header));
  117. if (readsize == -1) {
  118. return;
  119. }
  120. readsize = read (fd, msg_contents, sizeof (msg_contents));
  121. if (readsize == -1) {
  122. return;
  123. }
  124. printf ("msg contents %s\n", msg_contents);
  125. }
  126. static void *lcr_uis_server (void *data)
  127. {
  128. struct pollfd ufds[2];
  129. struct sockaddr_un un_addr;
  130. socklen_t addrlen;
  131. int nfds = 1;
  132. #ifdef OPENAIS_LINUX
  133. int on = 1;
  134. #endif
  135. int res;
  136. /*
  137. * Main acceptance and dispatch loop
  138. */
  139. uis_lcr_bind (&ufds[0].fd);
  140. printf ("UIS server thread started %d\n", ufds[0].fd);
  141. ufds[0].events = POLLIN;
  142. ufds[1].events = POLLOUT;
  143. for (;;) {
  144. res = poll (ufds, nfds, -1);
  145. if (nfds == 1 && ufds[0].revents & POLLIN) {
  146. ufds[1].fd = accept (ufds[0].fd,
  147. (struct sockaddr *)&un_addr, &addrlen);
  148. #ifdef OPENAIS_LINUX
  149. setsockopt(ufds[1].fd, SOL_SOCKET, SO_PASSCRED,
  150. &on, sizeof (on));
  151. #endif
  152. nfds = 2;
  153. }
  154. if (ufds[0].revents & POLLIN) {
  155. lcr_uis_dispatch (ufds[1].fd);
  156. }
  157. }
  158. return 0;
  159. }
  160. __attribute__ ((constructor)) static int lcr_uis_ctors (void)
  161. {
  162. pthread_t thread;
  163. pthread_create (&thread, NULL, lcr_uis_server, NULL);
  164. return (0);
  165. }