1 | /*
|
---|
2 | * Copyright (C) 2005 Martin Decky
|
---|
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 | #include "version.h"
|
---|
30 | #include <ipc/ipc.h>
|
---|
31 | #include <ipc/services.h>
|
---|
32 | #include <ipc/ns.h>
|
---|
33 | #include <stdio.h>
|
---|
34 | #include <unistd.h>
|
---|
35 | #include <stdlib.h>
|
---|
36 | #include <thread.h>
|
---|
37 | #include <task.h>
|
---|
38 | #include <psthread.h>
|
---|
39 | #include <futex.h>
|
---|
40 | #include <as.h>
|
---|
41 | #include <ddi.h>
|
---|
42 | #include <string.h>
|
---|
43 | #include <errno.h>
|
---|
44 | #include <kbd.h>
|
---|
45 | #include <ipc/fb.h>
|
---|
46 |
|
---|
47 | int a;
|
---|
48 | atomic_t ftx;
|
---|
49 |
|
---|
50 | int __thread stage;
|
---|
51 |
|
---|
52 | extern void utest(void *arg);
|
---|
53 | void utest(void *arg)
|
---|
54 | {
|
---|
55 | printf("Uspace thread started.\n");
|
---|
56 | if (futex_down(&ftx) < 0)
|
---|
57 | printf("Futex failed.\n");
|
---|
58 | if (futex_up(&ftx) < 0)
|
---|
59 | printf("Futex failed.\n");
|
---|
60 |
|
---|
61 | printf("%s in good condition.\n", __FUNCTION__);
|
---|
62 |
|
---|
63 | for (;;)
|
---|
64 | ;
|
---|
65 | }
|
---|
66 |
|
---|
67 | /* test different parameters types and modifiers */
|
---|
68 | static void test_printf(void)
|
---|
69 | {
|
---|
70 | printf("Simple text.\n");
|
---|
71 | printf("Now insert '%s' string.\n","this");
|
---|
72 | printf("Signed formats on uns. numbers: '%d', '%+d', '% d', '%u' (,+, ,u)\n", 321, 321, 321, 321);
|
---|
73 | printf("Signed formats on sig. numbers: '%d', '%+d', '% d', '%u' (,+, ,u)\n", -321, -321, -321, -321);
|
---|
74 | printf("Signed with different sized: '%hhd', '%hd', '%d', '%ld', %lld;\n", -3, -32, -321, -32101l, -3210123ll);
|
---|
75 | printf("And now... '%hhd' byte! '%hd' word! '%d' int! \n", 11, 11111, 1111111111);
|
---|
76 | printf("Different bases: %#hx, %#hu, %#ho and %#hb\n", 123, 123, 123, 123);
|
---|
77 | printf("Different bases signed: %#hx, %#hu, %#ho and %#hb\n", -123, -123, -123, -123);
|
---|
78 | printf("'%llX' llX! Another '%llx' llx! \n", 0x1234567887654321ll, 0x1234567887654321ll);
|
---|
79 | printf("'%llX' with 64bit value and '%x' with 32 bit value. \n", 0x1234567887654321ll, 0x12345678 );
|
---|
80 | printf("'%llx' 64bit, '%x' 32bit, '%hhx' 8bit, '%hx' 16bit, '%llX' 64bit and '%s' string.\n", 0x1234567887654321ll, 0x12345678, 0x12, 0x1234, 0x1234567887654321ull, "Lovely string" );
|
---|
81 |
|
---|
82 | printf("Thats all, folks!\n");
|
---|
83 | }
|
---|
84 |
|
---|
85 | /* test width and precision modifiers */
|
---|
86 | static void test_printf2(void)
|
---|
87 | {
|
---|
88 | printf(" text 10.8s %*.*s \n", 5, 3, "text");
|
---|
89 | printf(" very long text 10.8s %10.8s \n", "very long text");
|
---|
90 | printf(" text 8.10s %8.10s \n", "text");
|
---|
91 | printf(" very long text 8.10s %8.10s \n", "very long text");
|
---|
92 |
|
---|
93 | printf(" char: c '%c', 3.2c '%3.2c', -3.2c '%-3.2c', 2.3c '%2.3c', -2.3c '%-2.3c' \n",'a', 'b', 'c', 'd', 'e' );
|
---|
94 | printf(" int: d '%d', 3.2d '%3.2d', -3.2d '%-3.2d', 2.3d '%2.3d', -2.3d '%-2.3d' \n",1, 1, 1, 1, 1 );
|
---|
95 | printf(" -int: d '%d', 3.2d '%3.2d', -3.2d '%-3.2d', 2.3d '%2.3d', -2.3d '%-2.3d' \n",-1, -1, -1, -1, -1 );
|
---|
96 | printf(" 0xint: x '%x', 5.3x '%#5.3x', -5.3x '%#-5.3x', 3.5x '%#3.5x', -3.5x '%#-3.5x' \n",17, 17, 17, 17, 17 );
|
---|
97 |
|
---|
98 | }
|
---|
99 |
|
---|
100 | extern char _heap;
|
---|
101 | static void test_mremap(void)
|
---|
102 | {
|
---|
103 | printf("Writing to good memory\n");
|
---|
104 | as_area_resize(&_heap, 120000, 0);
|
---|
105 | printf("%P\n", ((char *)&_heap));
|
---|
106 | printf("%P\n", ((char *)&_heap) + 80000);
|
---|
107 | *(((char *)&_heap) + 80000) = 10;
|
---|
108 | printf("Making small\n");
|
---|
109 | as_area_resize(&_heap, 16000, 0);
|
---|
110 | printf("Failing..\n");
|
---|
111 | *((&_heap) + 80000) = 10;
|
---|
112 |
|
---|
113 | printf("memory done\n");
|
---|
114 | }
|
---|
115 | /*
|
---|
116 | static void test_sbrk(void)
|
---|
117 | {
|
---|
118 | printf("Writing to good memory\n");
|
---|
119 | printf("Got: %P\n", sbrk(120000));
|
---|
120 | printf("%P\n", ((char *)&_heap));
|
---|
121 | printf("%P\n", ((char *)&_heap) + 80000);
|
---|
122 | *(((char *)&_heap) + 80000) = 10;
|
---|
123 | printf("Making small, got: %P\n",sbrk(-120000));
|
---|
124 | printf("Testing access to heap\n");
|
---|
125 | _heap = 10;
|
---|
126 | printf("Failing..\n");
|
---|
127 | *((&_heap) + 80000) = 10;
|
---|
128 |
|
---|
129 | printf("memory done\n");
|
---|
130 | }
|
---|
131 | */
|
---|
132 | /*
|
---|
133 | static void test_malloc(void)
|
---|
134 | {
|
---|
135 | char *data;
|
---|
136 |
|
---|
137 | data = malloc(10);
|
---|
138 | printf("Heap: %P, data: %P\n", &_heap, data);
|
---|
139 | data[0] = 'a';
|
---|
140 | free(data);
|
---|
141 | }
|
---|
142 | */
|
---|
143 |
|
---|
144 |
|
---|
145 | static void test_ping(void)
|
---|
146 | {
|
---|
147 | ipcarg_t result;
|
---|
148 | int retval;
|
---|
149 |
|
---|
150 | printf("Pinging\n");
|
---|
151 | retval = ipc_call_sync(PHONE_NS, NS_PING, 0xbeef,&result);
|
---|
152 | printf("Retval: %d - received: %P\n", retval, result);
|
---|
153 | }
|
---|
154 |
|
---|
155 | static void got_answer(void *private, int retval, ipc_call_t *data)
|
---|
156 | {
|
---|
157 | printf("Retval: %d...%s...%zX, %zX\n", retval, private,
|
---|
158 | IPC_GET_ARG1(*data), IPC_GET_ARG2(*data));
|
---|
159 | }
|
---|
160 | static void test_async_ipc(void)
|
---|
161 | {
|
---|
162 | ipc_call_t data;
|
---|
163 | int i;
|
---|
164 |
|
---|
165 | printf("Sending ping\n");
|
---|
166 | ipc_call_async_2(PHONE_NS, NS_PING, 1, 0xbeefbee2,
|
---|
167 | "Pong1", got_answer);
|
---|
168 | ipc_call_async_2(PHONE_NS, NS_PING, 2, 0xbeefbee4,
|
---|
169 | "Pong2", got_answer);
|
---|
170 | ipc_call_async_2(PHONE_NS, NS_PING, 3, 0xbeefbee4,
|
---|
171 | "Pong3", got_answer);
|
---|
172 | ipc_call_async_2(PHONE_NS, NS_PING, 4, 0xbeefbee4,
|
---|
173 | "Pong4", got_answer);
|
---|
174 | ipc_call_async_2(PHONE_NS, NS_PING, 5, 0xbeefbee4,
|
---|
175 | "Pong5", got_answer);
|
---|
176 | ipc_call_async_2(PHONE_NS, NS_PING, 6, 0xbeefbee4,
|
---|
177 | "Pong6", got_answer);
|
---|
178 | printf("Waiting forever...\n");
|
---|
179 | for (i=0; i<100;i++)
|
---|
180 | printf(".");
|
---|
181 | printf("\n");
|
---|
182 | ipc_wait_for_call(&data);
|
---|
183 | printf("Received call???\n");
|
---|
184 | }
|
---|
185 |
|
---|
186 |
|
---|
187 | static void got_answer_2(void *private, int retval, ipc_call_t *data)
|
---|
188 | {
|
---|
189 | printf("Pong\n");
|
---|
190 | }
|
---|
191 | static void test_advanced_ipc(void)
|
---|
192 | {
|
---|
193 | int res;
|
---|
194 | ipcarg_t phonead;
|
---|
195 | ipc_callid_t callid;
|
---|
196 | ipc_call_t data;
|
---|
197 | int i;
|
---|
198 |
|
---|
199 | printf("Asking 0 to connect to me...\n");
|
---|
200 | res = ipc_connect_to_me(0, 1, 2, &phonead);
|
---|
201 | printf("Result: %d - phonead: %llu\n", res, phonead);
|
---|
202 | for (i=0; i < 100; i++) {
|
---|
203 | printf("----------------\n");
|
---|
204 | ipc_call_async(PHONE_NS, NS_PING_SVC, 0, "prov",
|
---|
205 | got_answer_2);
|
---|
206 | callid = ipc_wait_for_call(&data);
|
---|
207 | printf("Received ping\n");
|
---|
208 | ipc_answer_fast(callid, 0, 0, 0);
|
---|
209 | }
|
---|
210 | // callid = ipc_wait_for_call(&data, NULL);
|
---|
211 | }
|
---|
212 |
|
---|
213 | static void test_connection_ipc(void)
|
---|
214 | {
|
---|
215 | int res;
|
---|
216 | ipcarg_t result;
|
---|
217 | int phoneid;
|
---|
218 |
|
---|
219 | printf("Starting connect...\n");
|
---|
220 | res = ipc_connect_me_to(PHONE_NS, 10, 20);
|
---|
221 | printf("Connected: %d\n", res);
|
---|
222 | printf("pinging.\n");
|
---|
223 | res = ipc_call_sync(res, NS_PING, 0xbeef,&result);
|
---|
224 | printf("Retval: %d - received: %X\n", res, result);
|
---|
225 |
|
---|
226 | }
|
---|
227 |
|
---|
228 | static void test_hangup(void)
|
---|
229 | {
|
---|
230 | int phoneid;
|
---|
231 | ipc_call_t data;
|
---|
232 | ipc_callid_t callid;
|
---|
233 | int i;
|
---|
234 |
|
---|
235 | printf("Starting connect...\n");
|
---|
236 | phoneid = ipc_connect_me_to(PHONE_NS, 10, 20);
|
---|
237 | printf("Phoneid: %d, pinging\n", phoneid);
|
---|
238 | ipc_call_async_2(PHONE_NS, NS_PING, 1, 0xbeefbee2,
|
---|
239 | "Pong1", got_answer);
|
---|
240 | printf("Hangin up\n");
|
---|
241 | ipc_hangup(phoneid);
|
---|
242 | printf("Connecting\n");
|
---|
243 | phoneid = ipc_connect_me_to(PHONE_NS, 10, 20);
|
---|
244 | printf("Newphid: %d\n", phoneid);
|
---|
245 | for (i=0; i < 1000; i++) {
|
---|
246 | if ((callid=ipc_trywait_for_call(&data)))
|
---|
247 | printf("callid: %d\n");
|
---|
248 | }
|
---|
249 | printf("New new phoneid: %d\n", ipc_connect_me_to(PHONE_NS, 10, 20));
|
---|
250 | }
|
---|
251 |
|
---|
252 | static void test_slam(void)
|
---|
253 | {
|
---|
254 | int i;
|
---|
255 | ipc_call_t data;
|
---|
256 | ipc_callid_t callid;
|
---|
257 |
|
---|
258 | printf("ping");
|
---|
259 | ipc_call_async_2(PHONE_NS, NS_PING, 1, 0xbeefbee2,
|
---|
260 | "Pong1", got_answer);
|
---|
261 | printf("slam");
|
---|
262 | ipc_call_async_2(PHONE_NS, NS_HANGUP, 1, 0xbeefbee2,
|
---|
263 | "Hang", got_answer);
|
---|
264 | printf("ping2\n");
|
---|
265 | ipc_call_async_2(PHONE_NS, NS_PING, 1, 0xbeefbee2,
|
---|
266 | "Ping2", got_answer);
|
---|
267 |
|
---|
268 | for (i=0; i < 1000; i++) {
|
---|
269 | if ((callid=ipc_trywait_for_call(&data)))
|
---|
270 | printf("callid: %d\n");
|
---|
271 | }
|
---|
272 | ipc_call_async_2(PHONE_NS, NS_PING, 1, 0xbeefbee2,
|
---|
273 | "Pong1", got_answer);
|
---|
274 | printf("Closing file\n");
|
---|
275 | ipc_hangup(PHONE_NS);
|
---|
276 | ipc_call_async_2(PHONE_NS, NS_PING, 1, 0xbeefbee2,
|
---|
277 | "Pong1", got_answer);
|
---|
278 | ipc_wait_for_call(&data);
|
---|
279 | }
|
---|
280 |
|
---|
281 | static int ptest(void *arg)
|
---|
282 | {
|
---|
283 | stage = 1;
|
---|
284 | printf("Pseudo thread stage%d.\n", stage);
|
---|
285 | stage++;
|
---|
286 | psthread_schedule_next();
|
---|
287 | printf("Pseudo thread stage%d.\n", stage);
|
---|
288 | stage++;
|
---|
289 | psthread_schedule_next();
|
---|
290 | printf("Pseudo thread stage%d.\n", stage);
|
---|
291 | psthread_schedule_next();
|
---|
292 | stage++;
|
---|
293 | printf("Pseudo thread stage%d.\n", stage);
|
---|
294 | psthread_schedule_next();
|
---|
295 | printf("Pseudo thread exiting.\n");
|
---|
296 | return 0;
|
---|
297 | }
|
---|
298 |
|
---|
299 | static void test_kbd()
|
---|
300 | {
|
---|
301 | int res;
|
---|
302 | ipcarg_t result;
|
---|
303 | int phoneid;
|
---|
304 |
|
---|
305 | printf("Test: Starting connect...\n");
|
---|
306 | while ((phoneid = ipc_connect_me_to(PHONE_NS, SERVICE_KEYBOARD, 0)) < 0) {
|
---|
307 | };
|
---|
308 |
|
---|
309 | printf("Test: Connected: %d\n", res);
|
---|
310 | printf("Test: pinging.\n");
|
---|
311 | while (1) {
|
---|
312 | res = ipc_call_sync(phoneid, KBD_GETCHAR, 0xbeef,&result);
|
---|
313 | // printf("Test: Retval: %d - received: %c\n", res, result);
|
---|
314 | printf("%c", result);
|
---|
315 | }
|
---|
316 |
|
---|
317 | printf("Test: Hangin up\n");
|
---|
318 | ipc_hangup(phoneid);
|
---|
319 | }
|
---|
320 |
|
---|
321 | static void test_pci()
|
---|
322 | {
|
---|
323 | int phone;
|
---|
324 | while ((phone = ipc_connect_me_to(PHONE_NS, SERVICE_PCI, 0)) < 0)
|
---|
325 | ;
|
---|
326 | printf("Connected to PCI service through phone %d.\n", phone);
|
---|
327 | }
|
---|
328 |
|
---|
329 | static int test_as_area_send()
|
---|
330 | {
|
---|
331 | char *as_area;
|
---|
332 | int retval;
|
---|
333 | ipcarg_t result;
|
---|
334 |
|
---|
335 | as_area = as_area_create((void *)(1024*1024), 16384, AS_AREA_READ | AS_AREA_WRITE);
|
---|
336 | if (!as_area) {
|
---|
337 | printf("Error creating as_area.\n");
|
---|
338 | return 0;
|
---|
339 | }
|
---|
340 |
|
---|
341 | memcpy(as_area, "Hello world.\n", 14);
|
---|
342 |
|
---|
343 | retval = ipc_call_sync_2(PHONE_NS, IPC_M_AS_AREA_SEND, 0, (sysarg_t) as_area,
|
---|
344 | NULL, NULL);
|
---|
345 | if (retval) {
|
---|
346 | printf("AS_AREA_SEND failed.\n");
|
---|
347 | return 0;
|
---|
348 | }
|
---|
349 | printf("Done\n");
|
---|
350 | }
|
---|
351 |
|
---|
352 | static void test_fb()
|
---|
353 | {
|
---|
354 | int res;
|
---|
355 | ipcarg_t result;
|
---|
356 | int phoneid;
|
---|
357 |
|
---|
358 | // printf("Test: Starting connect...\n");
|
---|
359 |
|
---|
360 | phoneid = ipc_connect_me_to(PHONE_NS, SERVICE_VIDEO, 0);
|
---|
361 |
|
---|
362 | while ((phoneid = ipc_connect_me_to(PHONE_NS, SERVICE_VIDEO, 0)) < 0) {
|
---|
363 | volatile int a;
|
---|
364 | for(a=0;a<1048576;a++);
|
---|
365 | };
|
---|
366 |
|
---|
367 | // printf("Test: Connected: %d\n", res);
|
---|
368 | // printf("Test: pinging.\n");
|
---|
369 | while (1) {
|
---|
370 | res = ipc_call_sync(phoneid, FB_GET_VFB, 0xbeef,&result);
|
---|
371 | // printf("Test: Retval: %d - received: %c\n", res, result);
|
---|
372 | // printf("%c", result);
|
---|
373 | }
|
---|
374 |
|
---|
375 | // printf("Test: Hangin up\n");
|
---|
376 | ipc_hangup(phoneid);
|
---|
377 | }
|
---|
378 |
|
---|
379 |
|
---|
380 | int main(int argc, char *argv[])
|
---|
381 | {
|
---|
382 | pstid_t ptid;
|
---|
383 | int tid;
|
---|
384 |
|
---|
385 | // version_print();
|
---|
386 |
|
---|
387 | // test_printf();
|
---|
388 | // test_printf2();
|
---|
389 | // test_ping();
|
---|
390 | // test_async_ipc();
|
---|
391 | // test_advanced_ipc();
|
---|
392 | // test_connection_ipc();
|
---|
393 | // test_hangup();
|
---|
394 | // test_slam();
|
---|
395 | // test_as_send();
|
---|
396 | // test_pci();
|
---|
397 | test_kbd();
|
---|
398 | // test_fb();
|
---|
399 |
|
---|
400 | printf("Hello\nThis is Init\n\nBye.");
|
---|
401 |
|
---|
402 |
|
---|
403 | /*
|
---|
404 | printf("Userspace task, taskid=%llX\n", task_get_id());
|
---|
405 |
|
---|
406 | futex_initialize(&ftx, 1);
|
---|
407 | if (futex_down(&ftx) < 0)
|
---|
408 | printf("Futex failed.\n");
|
---|
409 | if (futex_up(&ftx) < 0)
|
---|
410 | printf("Futex failed.\n");
|
---|
411 |
|
---|
412 | if (futex_down(&ftx) < 0)
|
---|
413 | printf("Futex failed.\n");
|
---|
414 |
|
---|
415 | if ((tid = thread_create(utest, NULL, "utest")) != -1) {
|
---|
416 | printf("Created thread tid=%d\n", tid);
|
---|
417 | }
|
---|
418 |
|
---|
419 | if ((tid = thread_create(utest, NULL, "utest")) != -1) {
|
---|
420 | printf("Created thread tid=%d\n", tid);
|
---|
421 | }
|
---|
422 |
|
---|
423 | int i;
|
---|
424 |
|
---|
425 | for (i = 0; i < 50000000; i++)
|
---|
426 | ;
|
---|
427 |
|
---|
428 | if (futex_up(&ftx) < 0)
|
---|
429 | printf("Futex failed.\n");
|
---|
430 |
|
---|
431 |
|
---|
432 | printf("Creating pseudo thread.\n");
|
---|
433 | stage = 1;
|
---|
434 | ptid = psthread_create(ptest, NULL);
|
---|
435 | printf("Main thread stage%d.\n", stage);
|
---|
436 | stage++;
|
---|
437 | psthread_schedule_next();;
|
---|
438 | printf("Main thread stage%d.\n", stage);
|
---|
439 | stage++;
|
---|
440 | psthread_schedule_next();;
|
---|
441 | printf("Main thread stage%d.\n", stage);
|
---|
442 |
|
---|
443 | psthread_join(ptid);
|
---|
444 |
|
---|
445 | printf("Main thread exiting.\n");
|
---|
446 | */
|
---|
447 |
|
---|
448 | return 0;
|
---|
449 | }
|
---|