Subversion Repositories HelenOS

Rev

Rev 4347 | 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 <console.h>
  57. #include <errno.h>
  58. #include <async.h>
  59. #include <as.h>
  60.  
  61. #include <elf.h>
  62. #include <elf_load.h>
  63.  
  64. #define DPRINTF(...)
  65.  
  66. void program_run(void *entry, pcb_t *pcb);
  67.  
  68. /** Pathname of the file that will be loaded */
  69. static char *pathname = NULL;
  70.  
  71. /** The Program control block */
  72. static pcb_t pcb;
  73.  
  74. /** Number of arguments */
  75. static int argc = 0;
  76. /** Argument vector */
  77. static char **argv = NULL;
  78. /** Buffer holding all arguments */
  79. static char *arg_buf = NULL;
  80.  
  81. static elf_info_t prog_info;
  82. static elf_info_t interp_info;
  83.  
  84. static bool is_dyn_linked;
  85.  
  86. /** Used to limit number of connections to one. */
  87. static bool connected;
  88.  
  89. static void loader_get_taskid(ipc_callid_t rid, ipc_call_t *request)
  90. {
  91.     ipc_callid_t callid;
  92.     task_id_t task_id;
  93.     size_t len;
  94.    
  95.     task_id = task_get_id();
  96.    
  97.     if (!ipc_data_read_receive(&callid, &len)) {
  98.         ipc_answer_0(callid, EINVAL);
  99.         ipc_answer_0(rid, EINVAL);
  100.         return;
  101.     }
  102.    
  103.     if (len > sizeof(task_id))
  104.         len = sizeof(task_id);
  105.    
  106.     ipc_data_read_finalize(callid, &task_id, len);
  107.     ipc_answer_0(rid, EOK);
  108. }
  109.  
  110.  
  111. /** Receive a call setting pathname of the program to execute.
  112.  *
  113.  * @param rid
  114.  * @param request
  115.  */
  116. static void loader_set_pathname(ipc_callid_t rid, ipc_call_t *request)
  117. {
  118.     ipc_callid_t callid;
  119.     size_t len;
  120.     char *name_buf;
  121.    
  122.     if (!ipc_data_write_receive(&callid, &len)) {
  123.         ipc_answer_0(callid, EINVAL);
  124.         ipc_answer_0(rid, EINVAL);
  125.         return;
  126.     }
  127.    
  128.     name_buf = malloc(len + 1);
  129.     if (!name_buf) {
  130.         ipc_answer_0(callid, ENOMEM);
  131.         ipc_answer_0(rid, ENOMEM);
  132.         return;
  133.     }
  134.    
  135.     ipc_data_write_finalize(callid, name_buf, len);
  136.     ipc_answer_0(rid, EOK);
  137.    
  138.     if (pathname != NULL) {
  139.         free(pathname);
  140.         pathname = NULL;
  141.     }
  142.    
  143.     name_buf[len] = '\0';
  144.     pathname = name_buf;
  145. }
  146.  
  147. /** Receive a call setting arguments of the program to execute.
  148.  *
  149.  * @param rid
  150.  * @param request
  151.  */
  152. static void loader_set_args(ipc_callid_t rid, ipc_call_t *request)
  153. {
  154.     ipc_callid_t callid;
  155.     size_t buf_size, arg_size;
  156.     char *p;
  157.     int n;
  158.    
  159.     if (!ipc_data_write_receive(&callid, &buf_size)) {
  160.         ipc_answer_0(callid, EINVAL);
  161.         ipc_answer_0(rid, EINVAL);
  162.         return;
  163.     }
  164.    
  165.     if (arg_buf != NULL) {
  166.         free(arg_buf);
  167.         arg_buf = NULL;
  168.     }
  169.    
  170.     if (argv != NULL) {
  171.         free(argv);
  172.         argv = NULL;
  173.     }
  174.    
  175.     arg_buf = malloc(buf_size + 1);
  176.     if (!arg_buf) {
  177.         ipc_answer_0(callid, ENOMEM);
  178.         ipc_answer_0(rid, ENOMEM);
  179.         return;
  180.     }
  181.    
  182.     ipc_data_write_finalize(callid, arg_buf, buf_size);
  183.    
  184.     arg_buf[buf_size] = '\0';
  185.    
  186.     /*
  187.      * Count number of arguments
  188.      */
  189.     p = arg_buf;
  190.     n = 0;
  191.     while (p < arg_buf + buf_size) {
  192.         arg_size = str_size(p);
  193.         p = p + arg_size + 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(rid, ENOMEM);
  203.         return;
  204.     }
  205.  
  206.     /*
  207.      * Fill argv with argument pointers
  208.      */
  209.     p = arg_buf;
  210.     n = 0;
  211.     while (p < arg_buf + buf_size) {
  212.         argv[n] = p;
  213.        
  214.         arg_size = str_size(p);
  215.         p = p + arg_size + 1;
  216.         ++n;
  217.     }
  218.    
  219.     argc = n;
  220.     argv[n] = NULL;
  221.  
  222.     ipc_answer_0(rid, EOK);
  223. }
  224.  
  225. /** Load the previously selected program.
  226.  *
  227.  * @param rid
  228.  * @param request
  229.  * @return 0 on success, !0 on error.
  230.  */
  231. static int loader_load(ipc_callid_t rid, ipc_call_t *request)
  232. {
  233.     int rc;
  234.    
  235.     rc = elf_load_file(pathname, 0, 0, &prog_info);
  236.     if (rc != EE_OK) {
  237.         DPRINTF("Failed to load executable '%s'.\n", pathname);
  238.         ipc_answer_0(rid, EINVAL);
  239.         return 1;
  240.     }
  241.    
  242.     elf_create_pcb(&prog_info, &pcb);
  243.    
  244.     pcb.argc = argc;
  245.     pcb.argv = argv;
  246.    
  247.     if (prog_info.interp == NULL) {
  248.         /* Statically linked program */
  249.         is_dyn_linked = false;
  250.         ipc_answer_0(rid, EOK);
  251.         return 0;
  252.     }
  253.    
  254.     printf("Load ELF interpreter '%s'\n", prog_info.interp);
  255.     rc = elf_load_file(prog_info.interp, 0, 0, &interp_info);
  256.     if (rc != EE_OK) {
  257.         DPRINTF("Failed to load interpreter '%s.'\n",
  258.             prog_info.interp);
  259.         ipc_answer_0(rid, EINVAL);
  260.         return 1;
  261.     }
  262.    
  263.     printf("Run interpreter.\n");
  264.     printf("entry point: 0x%lx\n", interp_info.entry);
  265.     printf("pcb address: 0x%lx\n", &pcb);
  266.     printf("prog dynamic: 0x%lx\n", prog_info.dynamic);
  267.  
  268.     is_dyn_linked = true;
  269.     ipc_answer_0(rid, EOK);
  270.    
  271.     return 0;
  272. }
  273.  
  274.  
  275. /** Run the previously loaded program.
  276.  *
  277.  * @param rid
  278.  * @param request
  279.  * @return 0 on success, !0 on error.
  280.  */
  281. static void loader_run(ipc_callid_t rid, ipc_call_t *request)
  282. {
  283.     const char *cp;
  284.    
  285.     /* Set the task name. */
  286.     cp = str_rchr(pathname, '/');
  287.     cp = (cp == NULL) ? pathname : (cp + 1);
  288.     task_set_name(cp);
  289.    
  290.     if (is_dyn_linked == true) {
  291.         /* Dynamically linked program */
  292.         DPRINTF("Run ELF interpreter.\n");
  293.         DPRINTF("Entry point: 0x%lx\n", interp_info.entry);
  294.         console_close();
  295.        
  296.         ipc_answer_0(rid, EOK);
  297.         program_run(interp_info.entry, &pcb);
  298.     } else {
  299.         /* Statically linked program */
  300.         console_close();
  301.         ipc_answer_0(rid, EOK);
  302.         program_run(prog_info.entry, &pcb);
  303.     }
  304.  
  305.     /* Not reached */
  306. }
  307.  
  308. /** Handle loader connection.
  309.  *
  310.  * Receive and carry out commands (of which the last one should be
  311.  * to execute the loaded program).
  312.  */
  313. static void loader_connection(ipc_callid_t iid, ipc_call_t *icall)
  314. {
  315.     ipc_callid_t callid;
  316.     ipc_call_t call;
  317.     int retval;
  318.    
  319.     /* Already have a connection? */
  320.     if (connected) {
  321.         ipc_answer_0(iid, ELIMIT);
  322.         return;
  323.     }
  324.    
  325.     connected = true;
  326.    
  327.     /* Accept the connection */
  328.     ipc_answer_0(iid, EOK);
  329.    
  330.     /* Ignore parameters, the connection is already open */
  331.     (void) iid;
  332.     (void) icall;
  333.    
  334.     while (1) {
  335.         callid = async_get_call(&call);
  336.        
  337.         switch (IPC_GET_METHOD(call)) {
  338.         case IPC_M_PHONE_HUNGUP:
  339.             exit(0);
  340.         case LOADER_GET_TASKID:
  341.             loader_get_taskid(callid, &call);
  342.             continue;
  343.         case LOADER_SET_PATHNAME:
  344.             loader_set_pathname(callid, &call);
  345.             continue;
  346.         case LOADER_SET_ARGS:
  347.             loader_set_args(callid, &call);
  348.             continue;
  349.         case LOADER_LOAD:
  350.             loader_load(callid, &call);
  351.             continue;
  352.         case LOADER_RUN:
  353.             loader_run(callid, &call);
  354.             /* Not reached */
  355.         default:
  356.             retval = ENOENT;
  357.             break;
  358.         }
  359.         if ((callid & IPC_CALLID_NOTIFICATION) == 0 &&
  360.             IPC_GET_METHOD(call) != IPC_M_PHONE_HUNGUP) {
  361.             DPRINTF("Responding EINVAL to method %d.\n",
  362.                 IPC_GET_METHOD(call));
  363.             ipc_answer_0(callid, EINVAL);
  364.         }
  365.     }
  366. }
  367.  
  368. /** Program loader main function.
  369.  */
  370. int main(int argc, char *argv[])
  371. {
  372.     ipcarg_t phonead;
  373.    
  374.     connected = false;
  375.    
  376.     /* Set a handler of incomming connections. */
  377.     async_set_client_connection(loader_connection);
  378.    
  379.     /* Register at naming service. */
  380.     if (ipc_connect_to_me(PHONE_NS, SERVICE_LOAD, 0, 0, &phonead) != 0)
  381.         return -1;
  382.    
  383.     async_manager();
  384.    
  385.     /* Never reached */
  386.     return 0;
  387. }
  388.  
  389. /** @}
  390.  */
  391.