]> rtime.felk.cvut.cz Git - rtems-devel.git/blob - rtems-omk-template/appdl/init.c
Simple application which object file can be used to test dlopen.
[rtems-devel.git] / 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 #include <rtems/untar.h>
28
29 #ifdef CONFIG_OC_APP_APPDL_NET
30 #include <rtems/rtems_bsdnet.h>
31
32 #include "networkconfig.h"
33 #endif /*CONFIG_OC_APP_APPDL_NET*/
34
35 #include <sys/types.h>
36
37 #ifdef CONFIG_OC_APP_APPDL_NET
38 #include <sys/socket.h>
39 #include <netinet/in.h>
40 #include <arpa/inet.h>
41 #endif /*CONFIG_OC_APP_APPDL_NET*/
42
43 #include <string.h>
44 #include <unistd.h>
45
46 #define CONFIGURE_SHELL_COMMANDS_INIT
47 #define CONFIGURE_SHELL_COMMANDS_ALL
48 #define CONFIGURE_SHELL_COMMANDS_ALL_NETWORKING
49 #define CONFIGURE_SHELL_MOUNT_MSDOS
50 #define CONFIGURE_SHELL_MOUNT_NFS
51
52 #include <rtems/shellconfig.h>
53
54 #define BUILD_VERSION_STRING(major,minor,patch) \
55         __XSTRING(major) "." __XSTRING(minor) "." __XSTRING(patch)
56
57 #define RTEMS_VER_CODE VER_CODE(__RTEMS_MAJOR__ ,__RTEMS_MINOR__ ,__RTEMS_REVISION__)
58
59 #if RTEMS_VER_CODE < VER_CODE(4,7,99)
60   #define rtems_shell_add_cmd shell_add_cmd
61   #define rtems_shell_init(m_task_name,m_task_stacksize,m_task_priority,m_devname,m_forever,m_wait,m_login_check) \
62                 shell_init(m_task_name,m_task_stacksize,m_task_priority,m_devname,B19200 | CS8,m_forever)
63 #elif RTEMS_VER_CODE < VER_CODE(4,9,99)
64   #define rtems_shell_init(m_task_name,m_task_stacksize,m_task_priority,m_devname,m_forever,m_wait,m_login_check) \
65           rtems_shell_init(m_task_name,m_task_stacksize,m_task_priority,m_devname,m_forever,m_wait)
66 #endif
67
68 extern int _binary_rootfs_tarfile_start;
69 extern int _binary_rootfs_tarfile_size;
70 #define TARFILE_START _binary_rootfs_tarfile_start
71 #define TARFILE_SIZE _binary_rootfs_tarfile_size
72
73 #ifdef CONFIG_OC_APP_APPDL_TELNETD
74 #include <rtems/telnetd.h>
75
76 rtems_telnetd_config_table rtems_telnetd_config;
77
78 void run_telnetd_command(char *device_name,  void *arg)
79 {
80   rtems_shell_env_t shell_env;
81
82   rtems_shell_dup_current_env(&shell_env);
83   shell_env.taskname = NULL;
84   shell_env.devname = device_name;
85   rtems_shell_main_loop(&shell_env);
86 }
87 #endif /*CONFIG_OC_APP_APPDL_TELNETD*/
88
89 void 
90 bad_rtems_status(rtems_status_code status, int fail_level, const char *text)
91 {
92   printf("ERROR: %s status %s", text, rtems_status_text(status));
93   status = rtems_task_delete( RTEMS_SELF );
94 }
95
96 int testcmd_forshell(int argc, char **argv)
97 {
98   int i;
99   printf("Command %s called\n",argv[0]);
100   for(i=1;i<argc;i++)
101     if(argv[i])
102       printf("%s",argv[i]);
103   printf("\n");
104   return 0;
105 }
106
107 typedef int (*call_t)(int argc, char* argv[]);
108
109 int dlopen_forshell(int argc, char **argv)
110 {
111   void * handle;
112   int    unresolved;
113   char * message = "loaded";
114   char   *call_file_name;
115   char   *call_symbol = NULL;
116   call_t call;
117   int    call_ret;
118
119   if (argc < 2) {
120     printf ("file to load not specified\n");
121     return 1;
122   }
123   call_file_name = argv[1];
124
125   if (argc >= 3)
126     call_symbol = argv[2];
127
128   argc -= 2;
129   argv += 2;
130
131   handle = dlopen (call_file_name, RTLD_NOW | RTLD_GLOBAL);
132   if (!handle)
133   {
134     printf("dlopen failed: %s\n", dlerror());
135     return 1;
136   }
137
138   if (dlinfo (handle, RTLD_DI_UNRESOLVED, &unresolved) < 0)
139     message = "dlinfo error checking unresolved status";
140   else if (unresolved)
141     message = "has unresolved externals";
142
143   if (call_symbol == NULL) {
144     printf ("handle: %p %s\n", handle, message);
145     return 1;
146   }
147
148   call = dlsym (handle, call_symbol);
149   if (call == NULL)
150   {
151     printf("dlsym failed: symbol %s not found\n", call_symbol);
152     return 1;
153   }
154
155   call_ret = call(argc, argv);
156
157   return call_ret;
158 }
159
160 rtems_task Init(
161   rtems_task_argument ignored
162 )
163 {
164   rtems_status_code status;
165
166   printf( "\n\nRTEMS v "
167           BUILD_VERSION_STRING(__RTEMS_MAJOR__ ,__RTEMS_MINOR__ ,__RTEMS_REVISION__)
168           "\n");
169
170   rtems_monitor_init(RTEMS_MONITOR_SUSPEND|RTEMS_MONITOR_GLOBAL);
171   /*rtems_capture_cli_init (0);*/
172
173  #ifdef CONFIG_OC_APP_APPDL_NET
174   if (rtems_bsdnet_initialize_network() < 0)
175     printf( "Network initialization failed\n");
176   else
177     printf( "Network initialization OK\n");
178  #endif /*CONFIG_OC_APP_APPDL_NET*/
179
180
181   printf( "Starting application " SW_VER_ID " v "
182           BUILD_VERSION_STRING(SW_VER_MAJOR,SW_VER_MINOR,SW_VER_PATCH)
183           "\n" );
184
185   status = Untar_FromMemory((unsigned char *)(&TARFILE_START), (long)&TARFILE_SIZE);
186
187   printf("Untar_FromMemory returned %s\n",rtems_status_text(status));
188
189   Task_1_name = rtems_build_name( 'T', 'S', 'K', '1' );
190
191   status = rtems_task_create(
192      Task_1_name,
193      TASK_1_PRIORITY,
194      RTEMS_MINIMUM_STACK_SIZE+0x10000,
195      RTEMS_DEFAULT_MODES /*& ~(RTEMS_TIMESLICE_MASK) | RTEMS_TIMESLICE*/,
196      RTEMS_DEFAULT_ATTRIBUTES,
197      &Task_1_id
198   );
199   check_rtems_status(status, 0, "rtems_task_create of Task_1");
200
201   status = rtems_task_start( Task_1_id, Task_1, 0 );
202   check_rtems_status(status, 0, "rtems_task_start of Task_1\n");
203
204   rtems_shell_init("SHLL",RTEMS_MINIMUM_STACK_SIZE+0x1000,
205               SHELL_TASK_PRIORITY,"/dev/console",1,0, NULL);
206
207   rtems_shell_add_cmd("testcmd", "app",
208                 "test command for shell",
209                 testcmd_forshell);
210
211   rtems_shell_add_cmd("dlopen", "app",
212                 "runtime load object and call contained function",
213                 dlopen_forshell);
214
215   //rtems_monitor_wakeup();
216
217  #ifdef CONFIG_OC_APP_APPDL_TELNETD
218   rtems_telnetd_config.command = run_telnetd_command;
219   rtems_telnetd_config.arg = NULL;
220   rtems_telnetd_config.priority = SHELL_TASK_PRIORITY;
221   rtems_telnetd_config.stack_size = RTEMS_MINIMUM_STACK_SIZE+0x1000;
222   rtems_telnetd_config.login_check = NULL;
223   rtems_telnetd_config.keep_stdio = 0;
224
225   status = rtems_telnetd_initialize();
226   check_rtems_status(status, 0, "rtems_telnetd_initialize\n");
227  #endif /*CONFIG_OC_APP_APPDL_TELNETD*/
228
229   status = rtems_task_delete( RTEMS_SELF );
230
231   printf( "*** END OF APPDL ***\n" );
232   exit( 0 );
233 }