uis.c 4.0 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155
  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/socket.h>
  33. #include <sys/un.h>
  34. #include <sys/sysinfo.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. #define SERVER_BACKLOG 5
  50. char *socketname = "lcr.socket";
  51. static void uis_lcr_bind (int *server_fd)
  52. {
  53. int fd;
  54. struct sockaddr_un un_addr;
  55. int res;
  56. /*
  57. * Create socket for lcr clients, name socket, listen for connections
  58. */
  59. fd = socket (PF_UNIX, SOCK_STREAM, 0);
  60. if (fd == -1) {
  61. printf ("lcr_bind failed\n");
  62. };
  63. memset (&un_addr, 0, sizeof (struct sockaddr_un));
  64. un_addr.sun_family = AF_UNIX;
  65. strcpy (un_addr.sun_path + 1, socketname);
  66. res = bind (fd, (struct sockaddr *)&un_addr, sizeof (struct sockaddr_un));
  67. if (res) {
  68. printf ("Could not bind AF_UNIX: %s\n", strerror (errno));
  69. }
  70. listen (fd, SERVER_BACKLOG);
  71. *server_fd = fd;
  72. }
  73. struct uis_commands {
  74. char *command;
  75. void (*cmd_handler) (char *);
  76. };
  77. void cmd1 (char *cmd) {
  78. printf ("cmd1 executed with cmd line %s\n", cmd);
  79. }
  80. struct uis_commands uis_commands[] = {
  81. {
  82. "cmd1", cmd1
  83. }
  84. };
  85. struct req_msg {
  86. int len;
  87. char msg[0];
  88. };
  89. static void lcr_uis_dispatch (int fd)
  90. {
  91. struct req_msg header;
  92. char msg_contents[512];
  93. read (fd, &header, sizeof (header));
  94. read (fd, msg_contents, sizeof (msg_contents));
  95. printf ("msg contents %s\n", msg_contents);
  96. }
  97. static void *lcr_uis_server (void *data)
  98. {
  99. struct pollfd ufds[2];
  100. struct sockaddr_un un_addr;
  101. socklen_t addrlen;
  102. int nfds = 1;
  103. int on = 1;
  104. int res;
  105. /*
  106. * Main acceptance and dispatch loop
  107. */
  108. uis_lcr_bind (&ufds[0].fd);
  109. printf ("UIS server thread started %d\n", ufds[0].fd);
  110. ufds[0].events = POLLIN;
  111. ufds[1].events = POLLOUT;
  112. for (;;) {
  113. res = poll (ufds, nfds, -1);
  114. if (nfds == 1 && ufds[0].revents & POLLIN) {
  115. ufds[1].fd = accept (ufds[0].fd,
  116. (struct sockaddr *)&un_addr, &addrlen);
  117. setsockopt(ufds[1].fd, SOL_SOCKET, SO_PASSCRED,
  118. &on, sizeof (on));
  119. nfds = 2;
  120. }
  121. if (ufds[0].revents & POLLIN) {
  122. lcr_uis_dispatch (ufds[1].fd);
  123. }
  124. }
  125. return 0;
  126. }
  127. static int lcr_uis_ctors (void)
  128. {
  129. pthread_t thread;
  130. pthread_create (&thread, NULL, lcr_uis_server, NULL);
  131. return (0);
  132. }
  133. static int (*const __init_uis[1]) (void) __attribute__ ((section(".ctors"))) =
  134. { lcr_uis_ctors };