Subversion Repositories HelenOS

Rev

Rev 4344 | Rev 4348 | Go to most recent revision | Blame | Compare with Previous | Last modification | View Log | Download | RSS feed

  1. /*
  2.  * Copyright (c) 2008 Jiri Svoboda
  3.  * All rights reserved.
  4.  *
  5.  * Redistribution and use in source and binary forms, with or without
  6.  * modification, are permitted provided that the following conditions
  7.  * are met:
  8.  *
  9.  * - Redistributions of source code must retain the above copyright
  10.  *   notice, this list of conditions and the following disclaimer.
  11.  * - Redistributions in binary form must reproduce the above copyright
  12.  *   notice, this list of conditions and the following disclaimer in the
  13.  *   documentation and/or other materials provided with the distribution.
  14.  * - The name of the author may not be used to endorse or promote products
  15.  *   derived from this software without specific prior written permission.
  16.  *
  17.  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
  18.  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
  19.  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
  20.  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
  21.  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
  22.  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
  23.  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
  24.  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  25.  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
  26.  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  27.  */
  28.  
  29. /** @addtogroup loader
  30.  * @brief Loads and runs programs from VFS.
  31.  * @{
  32.  */
  33. /**
  34.  * @file
  35.  * @brief Loads and runs programs from VFS.
  36.  *
  37.  * The program loader is a special init binary. Its image is used
  38.  * to create a new task upon a @c task_spawn syscall. The syscall
  39.  * returns the id of a phone connected to the newly created task.
  40.  *
  41.  * The caller uses this phone to send the pathname and various other
  42.  * information to the loader. This is normally done by the C library
  43.  * and completely hidden from applications.
  44.  */
  45.  
  46. #include <stdio.h>
  47. #include <stdlib.h>
  48. #include <unistd.h>
  49. #include <bool.h>
  50. #include <fcntl.h>
  51. #include <sys/types.h>
  52. #include <ipc/ipc.h>
  53. #include <ipc/services.h>
  54. #include <ipc/loader.h>
  55. #include <loader/pcb.h>
  56. #include <errno.h>
  57. #include <async.h>
  58. #include <as.h>
  59.  
  60. #include <elf.h>
  61. #include <elf_load.h>
  62.  
  63. #define DPRINTF(...)
  64.  
  65. void program_run(void *entry, pcb_t *pcb);
  66.  
  67. /** Pathname of the file that will be loaded */
  68. static char *pathname = NULL;
  69.  
  70. /** The Program control block */
  71. static pcb_t pcb;
  72.  
  73. /** Number of arguments */
  74. static int argc = 0;
  75. /** Argument vector */
  76. static char **argv = NULL;
  77. /** Buffer holding all arguments */
  78. static char *arg_buf = NULL;
  79.  
  80. static elf_info_t prog_info;
  81. static elf_info_t interp_info;
  82.  
  83. static bool is_dyn_linked;
  84.  
  85. /** Used to limit number of connections to one. */
  86. static bool connected;
  87.  
  88. static void loader_get_taskid(ipc_callid_t rid, ipc_call_t *request)
  89. {
  90.     ipc_callid_t callid;
  91.     task_id_t task_id;
  92.     size_t len;
  93.    
  94.     task_id = task_get_id();
  95.    
  96.     if (!ipc_data_read_receive(&callid, &len)) {
  97.         ipc_answer_0(callid, EINVAL);
  98.         ipc_answer_0(rid, EINVAL);
  99.         return;
  100.     }
  101.    
  102.     if (len > sizeof(task_id))
  103.         len = sizeof(task_id);
  104.    
  105.     ipc_data_read_finalize(callid, &task_id, len);
  106.     ipc_answer_0(rid, EOK);
  107. }
  108.  
  109.  
  110. /** Receive a call setting pathname of the program to execute.
  111.  *
  112.  * @param rid
  113.  * @param request
  114.  */
  115. static void loader_set_pathname(ipc_callid_t rid, ipc_call_t *request)
  116. {
  117.     ipc_callid_t callid;
  118.     size_t len;
  119.     char *name_buf;
  120.    
  121.     if (!ipc_data_write_receive(&callid, &len)) {
  122.         ipc_answer_0(callid, EINVAL);
  123.         ipc_answer_0(rid, EINVAL);
  124.         return;
  125.     }
  126.    
  127.     name_buf = malloc(len + 1);
  128.     if (!name_buf) {
  129.         ipc_answer_0(callid, ENOMEM);
  130.         ipc_answer_0(rid, ENOMEM);
  131.         return;
  132.     }
  133.    
  134.     ipc_data_write_finalize(callid, name_buf, len);
  135.     ipc_answer_0(rid, EOK);
  136.    
  137.     if (pathname != NULL) {
  138.         free(pathname);
  139.         pathname = NULL;
  140.     }
  141.    
  142.     name_buf[len] = '\0';
  143.     pathname = name_buf;
  144. }
  145.  
  146. /** Receive a call setting arguments of the program to execute.
  147.  *
  148.  * @param rid
  149.  * @param request
  150.  */
  151. static void loader_set_args(ipc_callid_t rid, ipc_call_t *request)
  152. {
  153.     ipc_callid_t callid;
  154.     size_t buf_len, arg_len;
  155.     char *p;
  156.     int n;
  157.    
  158.     if (!ipc_data_write_receive(&callid, &buf_len)) {
  159.         ipc_answer_0(callid, EINVAL);
  160.         ipc_answer_0(rid, EINVAL);
  161.         return;
  162.     }
  163.    
  164.     if (arg_buf != NULL) {
  165.         free(arg_buf);
  166.         arg_buf = NULL;
  167.     }
  168.    
  169.     if (argv != NULL) {
  170.         free(argv);
  171.         argv = NULL;
  172.     }
  173.    
  174.     arg_buf = malloc(buf_len + 1);
  175.     if (!arg_buf) {
  176.         ipc_answer_0(callid, ENOMEM);
  177.         ipc_answer_0(rid, ENOMEM);
  178.         return;
  179.     }
  180.    
  181.     ipc_data_write_finalize(callid, arg_buf, buf_len);
  182.     ipc_answer_0(rid, EOK);
  183.    
  184.     arg_buf[buf_len] = '\0';
  185.    
  186.     /*
  187.      * Count number of arguments
  188.      */
  189.     p = arg_buf;
  190.     n = 0;
  191.     while (p < arg_buf + buf_len) {
  192.         arg_len = strlen(p);
  193.         p = p + arg_len + 1;
  194.         ++n;
  195.     }
  196.    
  197.     /* Allocate argv */
  198.     argv = malloc((n + 1) * sizeof(char *));
  199.    
  200.     if (argv == NULL) {
  201.         free(arg_buf);
  202.         ipc_answer_0(callid, ENOMEM);
  203.         ipc_answer_0(rid, ENOMEM);
  204.         return;
  205.     }
  206.    
  207.     /*
  208.      * Fill argv with argument pointers
  209.      */
  210.     p = arg_buf;
  211.     n = 0;
  212.     while (p < arg_buf + buf_len) {
  213.         argv[n] = p;
  214.        
  215.         arg_len = strlen(p);
  216.         p = p + arg_len + 1;
  217.         ++n;
  218.     }
  219.    
  220.     argc = n;
  221.     argv[n] = NULL;
  222. }
  223.  
  224. /** Load the previously selected program.
  225.  *
  226.  * @param rid
  227.  * @param request
  228.  * @return 0 on success, !0 on error.
  229.  */
  230. static int loader_load(ipc_callid_t rid, ipc_call_t *request)
  231. {
  232.     int rc;
  233.    
  234.     rc = elf_load_file(pathname, 0, 0, &prog_info);
  235.     if (rc < 0) {
  236.         DPRINTF("Failed to load executable '%s'.\n", pathname);
  237.         ipc_answer_0(rid, EINVAL);
  238.         return 1;
  239.     }
  240.    
  241.     elf_create_pcb(&prog_info, &pcb);
  242.    
  243.     pcb.argc = argc;
  244.     pcb.argv = argv;
  245.    
  246.     if (prog_info.interp == NULL) {
  247.         /* Statically linked program */
  248.         is_dyn_linked = false;
  249.         ipc_answer_0(rid, EOK);
  250.         return 0;
  251.     }
  252.    
  253.     printf("Load ELF interpreter '%s'\n", prog_info.interp);
  254.     rc = elf_load_file(prog_info.interp, 0, 0, &interp_info);
  255.     if (rc < 0) {
  256.         DPRINTF("Failed to load interpreter '%s.'\n",
  257.             prog_info.interp);
  258.         ipc_answer_0(rid, EINVAL);
  259.         return 1;
  260.     }
  261.    
  262.     printf("Run interpreter.\n");
  263.     printf("entry point: 0x%lx\n", interp_info.entry);
  264.     printf("pcb address: 0x%lx\n", &pcb);
  265.     printf("prog dynamic: 0x%lx\n", prog_info.dynamic);
  266.  
  267.     is_dyn_linked = true;
  268.     ipc_answer_0(rid, EOK);
  269.    
  270.     return 0;
  271. }
  272.  
  273.  
  274. /** Run the previously loaded program.
  275.  *
  276.  * @param rid
  277.  * @param request
  278.  * @return 0 on success, !0 on error.
  279.  */
  280. static void loader_run(ipc_callid_t rid, ipc_call_t *request)
  281. {
  282.     const char *cp;
  283.    
  284.     /* Set the task name. */
  285.     cp = strrchr(pathname, '/');
  286.     cp = (cp == NULL) ? pathname : (cp + 1);
  287.     task_set_name(cp);
  288.    
  289.     if (is_dyn_linked == true) {
  290.         /* Dynamically linked program */
  291.         DPRINTF("Run ELF interpreter.\n");
  292.         DPRINTF("Entry point: 0x%lx\n", interp_info.entry);
  293.         close_console();
  294.        
  295.         ipc_answer_0(rid, EOK);
  296.         program_run(interp_info.entry, &pcb);
  297.     } else {
  298.         /* Statically linked program */
  299.         close_console();
  300.         ipc_answer_0(rid, EOK);
  301.         program_run(prog_info.entry, &pcb);
  302.     }
  303.  
  304.     /* Not reached */
  305. }
  306.  
  307. /** Handle loader connection.
  308.  *
  309.  * Receive and carry out commands (of which the last one should be
  310.  * to execute the loaded program).
  311.  */
  312. static void loader_connection(ipc_callid_t iid, ipc_call_t *icall)
  313. {
  314.     ipc_callid_t callid;
  315.     ipc_call_t call;
  316.     int retval;
  317.    
  318.     /* Already have a connection? */
  319.     if (connected) {
  320.         ipc_answer_0(iid, ELIMIT);
  321.         return;
  322.     }
  323.    
  324.     connected = true;
  325.    
  326.     /* Accept the connection */
  327.     ipc_answer_0(iid, EOK);
  328.    
  329.     /* Ignore parameters, the connection is already open */
  330.     (void) iid;
  331.     (void) icall;
  332.    
  333.     while (1) {
  334.         callid = async_get_call(&call);
  335.        
  336.         switch (IPC_GET_METHOD(call)) {
  337.         case IPC_M_PHONE_HUNGUP:
  338.             exit(0);
  339.         case LOADER_GET_TASKID:
  340.             loader_get_taskid(callid, &call);
  341.             continue;
  342.         case LOADER_SET_PATHNAME:
  343.             loader_set_pathname(callid, &call);
  344.             continue;
  345.         case LOADER_SET_ARGS:
  346.             loader_set_args(callid, &call);
  347.             continue;
  348.         case LOADER_LOAD:
  349.             loader_load(callid, &call);
  350.             continue;
  351.         case LOADER_RUN:
  352.             loader_run(callid, &call);
  353.             /* Not reached */
  354.         default:
  355.             retval = ENOENT;
  356.             break;
  357.         }
  358.         if ((callid & IPC_CALLID_NOTIFICATION) == 0 &&
  359.             IPC_GET_METHOD(call) != IPC_M_PHONE_HUNGUP) {
  360.             DPRINTF("Responding EINVAL to method %d.\n",
  361.                 IPC_GET_METHOD(call));
  362.             ipc_answer_0(callid, EINVAL);
  363.         }
  364.     }
  365. }
  366.  
  367. /** Program loader main function.
  368.  */
  369. int main(int argc, char *argv[])
  370. {
  371.     ipcarg_t phonead;
  372.    
  373.     connected = false;
  374.    
  375.     /* Set a handler of incomming connections. */
  376.     async_set_client_connection(loader_connection);
  377.    
  378.     /* Register at naming service. */
  379.     if (ipc_connect_to_me(PHONE_NS, SERVICE_LOAD, 0, 0, &phonead) != 0)
  380.         return -1;
  381.    
  382.     async_manager();
  383.    
  384.     /* Never reached */
  385.     return 0;
  386. }
  387.  
  388. /** @}
  389.  */
  390.