rtems-omk-template/appdl/init.c

   1 /*  Init
   2  *
   3  *  This routine is the initialization task for this test program.
   4  *  It is called from init_exec and has the responsibility for creating
   5  *  and starting the tasks that make up the test.  If the time of day
   6  *  clock is required for the test, it should also be set to a known
   7  *  value by this function.
   8  *
   9  *  (C) 2015 Pavel Pisa <pisa@cmp.felk.cvut.cz>
  10  *
  11  *  Based on RTEMS example test by
  12  *  On-Line Applications Research Corporation (OAR).
  13  *
  14  */
  15
  16 #define CONFIGURE_INIT
  17 #include <system_def.h>
  18 #include "system.h"
  19 #include "app_def.h"
  20 #include "appl_config.h"
  21 #include <stdio.h>
  22 #include <stdlib.h>
  23 #include <dlfcn.h>
  24 #include <rtems/error.h>
  25 #include <rtems/monitor.h>
  26 #include <rtems/shell.h>
  27
  28 #define USE_RTEMS_TARFS_LOAD
  29
  30 #ifdef USE_RTEMS_TARFS_LOAD
  31 #include <rtems/imfs.h>
  32 #else /*USE_RTEMS_TARFS_LOAD*/
  33 #include <rtems/untar.h>
  34 #endif /*USE_RTEMS_TARFS_LOAD*/
  35
  36 #ifdef CONFIG_OC_APP_APPDL_NET
  37 #include <rtems/rtems_bsdnet.h>
  38
  39 #include "networkconfig.h"
  40 #endif /*CONFIG_OC_APP_APPDL_NET*/
  41
  42 #include <sys/types.h>
  43
  44 #ifdef CONFIG_OC_APP_APPDL_NET
  45 #include <sys/socket.h>
  46 #include <netinet/in.h>
  47 #include <arpa/inet.h>
  48 #endif /*CONFIG_OC_APP_APPDL_NET*/
  49
  50 #include <string.h>
  51 #include <unistd.h>
  52
  53 #define CONFIGURE_SHELL_COMMANDS_INIT
  54 #define CONFIGURE_SHELL_COMMANDS_ALL
  55 #define CONFIGURE_SHELL_COMMANDS_ALL_NETWORKING
  56 #define CONFIGURE_SHELL_MOUNT_MSDOS
  57 #define CONFIGURE_SHELL_MOUNT_NFS
  58
  59 #include <rtems/shellconfig.h>
  60
  61 #define BUILD_VERSION_STRING(major,minor,patch) \
  62         __XSTRING(major) "." __XSTRING(minor) "." __XSTRING(patch)
  63
  64 #define RTEMS_VER_CODE VER_CODE(__RTEMS_MAJOR__ ,__RTEMS_MINOR__ ,__RTEMS_REVISION__)
  65
  66 #if RTEMS_VER_CODE < VER_CODE(4,7,99)
  67   #define rtems_shell_add_cmd shell_add_cmd
  68   #define rtems_shell_init(m_task_name,m_task_stacksize,m_task_priority,m_devname,m_forever,m_wait,m_login_check) \
  69                 shell_init(m_task_name,m_task_stacksize,m_task_priority,m_devname,B19200 | CS8,m_forever)
  70 #elif RTEMS_VER_CODE < VER_CODE(4,9,99)
  71   #define rtems_shell_init(m_task_name,m_task_stacksize,m_task_priority,m_devname,m_forever,m_wait,m_login_check) \
  72           rtems_shell_init(m_task_name,m_task_stacksize,m_task_priority,m_devname,m_forever,m_wait)
  73 #endif
  74
  75 extern int _binary_rootfs_tarfile_start;
  76 extern int _binary_rootfs_tarfile_size;
  77 #define TARFILE_START _binary_rootfs_tarfile_start
  78 #define TARFILE_SIZE _binary_rootfs_tarfile_size
  79
  80 #ifdef CONFIG_OC_APP_APPDL_TELNETD
  81 #include <rtems/telnetd.h>
  82
  83 rtems_telnetd_config_table rtems_telnetd_config;
  84
  85 void run_telnetd_command(char *device_name,  void *arg)
  86 {
  87   rtems_shell_env_t shell_env;
  88
  89   rtems_shell_dup_current_env(&shell_env);
  90   shell_env.taskname = NULL;
  91   shell_env.devname = device_name;
  92   rtems_shell_main_loop(&shell_env);
  93 }
  94 #endif /*CONFIG_OC_APP_APPDL_TELNETD*/
  95
  96 void
  97 bad_rtems_status(rtems_status_code status, int fail_level, const char *text)
  98 {
  99   printf("ERROR: %s status %s", text, rtems_status_text(status));
 100   status = rtems_task_delete( RTEMS_SELF );
 101 }
 102
 103 int testcmd_forshell(int argc, char **argv)
 104 {
 105   int i;
 106   printf("Command %s called\n",argv[0]);
 107   for(i=1;i<argc;i++)
 108     if(argv[i])
 109       printf("%s",argv[i]);
 110   printf("\n");
 111   return 0;
 112 }
 113
 114 typedef int (*call_t)(int argc, char* argv[]);
 115
 116 int dlopen_forshell(int argc, char **argv)
 117 {
 118   void * handle;
 119   int    unresolved;
 120   char * message = "loaded";
 121   char   *call_file_name;
 122   char   *call_symbol = NULL;
 123   call_t call;
 124   int    call_ret;
 125
 126   if (argc < 2) {
 127     printf ("file to load not specified\n");
 128     return 1;
 129   }
 130   call_file_name = argv[1];
 131
 132   if (argc >= 3)
 133     call_symbol = argv[2];
 134
 135   argc -= 2;
 136   argv += 2;
 137
 138   handle = dlopen (call_file_name, RTLD_NOW | RTLD_GLOBAL);
 139   if (!handle)
 140   {
 141     printf("dlopen failed: %s\n", dlerror());
 142     return 1;
 143   }
 144
 145   if (dlinfo (handle, RTLD_DI_UNRESOLVED, &unresolved) < 0)
 146     message = "dlinfo error checking unresolved status";
 147   else if (unresolved)
 148     message = "has unresolved externals";
 149
 150   if (call_symbol == NULL) {
 151     printf ("handle: %p %s\n", handle, message);
 152     return 1;
 153   }
 154
 155   call = dlsym (handle, call_symbol);
 156   if (call == NULL)
 157   {
 158     printf("dlsym failed: symbol %s not found\n", call_symbol);
 159     return 1;
 160   }
 161
 162   call_ret = call(argc, argv);
 163
 164   return call_ret;
 165 }
 166
 167 rtems_task Init(
 168   rtems_task_argument ignored
 169 )
 170 {
 171   rtems_status_code status;
 172  #ifdef USE_RTEMS_TARFS_LOAD
 173   int res;
 174  #endif /*USE_RTEMS_TARFS_LOAD*/
 175
 176   printf( "\n\nRTEMS v "
 177           BUILD_VERSION_STRING(__RTEMS_MAJOR__ ,__RTEMS_MINOR__ ,__RTEMS_REVISION__)
 178           "\n");
 179
 180   rtems_monitor_init(RTEMS_MONITOR_SUSPEND|RTEMS_MONITOR_GLOBAL);
 181   /*rtems_capture_cli_init (0);*/
 182
 183  #ifdef CONFIG_OC_APP_APPDL_NET
 184   if (rtems_bsdnet_initialize_network() < 0)
 185     printf( "Network initialization failed\n");
 186   else
 187     printf( "Network initialization OK\n");
 188  #endif /*CONFIG_OC_APP_APPDL_NET*/
 189
 190
 191   printf( "Starting application " SW_VER_ID " v "
 192           BUILD_VERSION_STRING(SW_VER_MAJOR,SW_VER_MINOR,SW_VER_PATCH)
 193           "\n" );
 194
 195  #ifdef USE_RTEMS_TARFS_LOAD
 196   res = rtems_tarfs_load("/", (void*)(&TARFILE_START), (long)&TARFILE_SIZE);
 197   printf("rtems_tarfs_load returned %d\n", res);
 198  #else /*USE_RTEMS_TARFS_LOAD*/
 199   status = Untar_FromMemory((unsigned char *)(&TARFILE_START), (long)&TARFILE_SIZE);
 200   printf("Untar_FromMemory returned %s\n",rtems_status_text(status));
 201  #endif /*USE_RTEMS_TARFS_LOAD*/
 202
 203   Task_1_name = rtems_build_name( 'T', 'S', 'K', '1' );
 204
 205   status = rtems_task_create(
 206      Task_1_name,
 207      TASK_1_PRIORITY,
 208      RTEMS_MINIMUM_STACK_SIZE+0x10000,
 209      RTEMS_DEFAULT_MODES /*& ~(RTEMS_TIMESLICE_MASK) | RTEMS_TIMESLICE*/,
 210      RTEMS_DEFAULT_ATTRIBUTES,
 211      &Task_1_id
 212   );
 213   check_rtems_status(status, 0, "rtems_task_create of Task_1");
 214
 215   status = rtems_task_start( Task_1_id, Task_1, 0 );
 216   check_rtems_status(status, 0, "rtems_task_start of Task_1\n");
 217
 218   rtems_shell_init("SHLL",RTEMS_MINIMUM_STACK_SIZE+0x1000,
 219               SHELL_TASK_PRIORITY,"/dev/console",1,0, NULL);
 220
 221   rtems_shell_add_cmd("testcmd", "app",
 222                 "test command for shell",
 223                 testcmd_forshell);
 224
 225   rtems_shell_add_cmd("dlopen", "app",
 226                 "runtime load object and call contained function",
 227                 dlopen_forshell);
 228
 229   //rtems_monitor_wakeup();
 230
 231  #ifdef CONFIG_OC_APP_APPDL_TELNETD
 232   rtems_telnetd_config.command = run_telnetd_command;
 233   rtems_telnetd_config.arg = NULL;
 234   rtems_telnetd_config.priority = SHELL_TASK_PRIORITY;
 235   rtems_telnetd_config.stack_size = RTEMS_MINIMUM_STACK_SIZE+0x1000;
 236   rtems_telnetd_config.login_check = NULL;
 237   rtems_telnetd_config.keep_stdio = 0;
 238
 239   status = rtems_telnetd_initialize();
 240   check_rtems_status(status, 0, "rtems_telnetd_initialize\n");
 241  #endif /*CONFIG_OC_APP_APPDL_TELNETD*/
 242
 243   status = rtems_task_delete( RTEMS_SELF );
 244
 245   printf( "*** END OF APPDL ***\n" );
 246   exit( 0 );
 247 }