1 | ////////////////////////////////////////////////////////////////////////////////// |
---|
2 | // File : stdio.c |
---|
3 | // Date : 01/04/2010 |
---|
4 | // Author : alain greiner & Joel Porquet |
---|
5 | // Copyright (c) UPMC-LIP6 |
---|
6 | /////////////////////////////////////////////////////////////////////////////////// |
---|
7 | // The stdio.c and stdio.h files are part of the GIET_VM nano-kernel. |
---|
8 | // This library contains all user-level functions that contain a system call |
---|
9 | // to access protected or shared ressources. |
---|
10 | /////////////////////////////////////////////////////////////////////////////////// |
---|
11 | |
---|
12 | #include <stdarg.h> |
---|
13 | #include <stdio.h> |
---|
14 | |
---|
15 | |
---|
16 | //////////////////////////////////////////////////////////////////////////////////// |
---|
17 | ////////////////////// MIPS32 related system calls /////////////////////////////// |
---|
18 | //////////////////////////////////////////////////////////////////////////////////// |
---|
19 | |
---|
20 | //////////////////////////////////////////////////////////////////////////////////// |
---|
21 | // giet_procid() |
---|
22 | //////////////////////////////////////////////////////////////////////////////////// |
---|
23 | // This function returns the processor identifier. |
---|
24 | //////////////////////////////////////////////////////////////////////////////////// |
---|
25 | int giet_procid() |
---|
26 | { |
---|
27 | return sys_call( SYSCALL_PROCID, |
---|
28 | 0, 0, 0, 0 ); |
---|
29 | } |
---|
30 | //////////////////////////////////////////////////////////////////////////////////// |
---|
31 | // giet_proctime() |
---|
32 | //////////////////////////////////////////////////////////////////////////////////// |
---|
33 | // This function returns the local processor time (clock cycles since boot) |
---|
34 | //////////////////////////////////////////////////////////////////////////////////// |
---|
35 | int giet_proctime() |
---|
36 | { |
---|
37 | return sys_call( SYSCALL_PROCTIME, |
---|
38 | 0, 0, 0, 0 ); |
---|
39 | } |
---|
40 | |
---|
41 | |
---|
42 | //////////////////////////////////////////////////////////////////////////////////// |
---|
43 | ///////////////////// TTY device related system calls ///////////////////////////// |
---|
44 | //////////////////////////////////////////////////////////////////////////////////// |
---|
45 | |
---|
46 | //////////////////////////////////////////////////////////////////////////////////// |
---|
47 | // giet_tty_putc() |
---|
48 | //////////////////////////////////////////////////////////////////////////////////// |
---|
49 | // This function displays a single ascii character on a terminal. |
---|
50 | // The terminal index must be defined in the task context in the boot phase. |
---|
51 | // It doesn't use the TTY_PUT_IRQ interrupt, and the associated kernel buffer. |
---|
52 | // - Returns 1 if the character has been written, 0 otherwise. |
---|
53 | //////////////////////////////////////////////////////////////////////////////////// |
---|
54 | int giet_tty_putc(char byte) |
---|
55 | { |
---|
56 | return sys_call(SYSCALL_TTY_WRITE, |
---|
57 | (unsigned int)(&byte), |
---|
58 | 1, |
---|
59 | 0xFFFFFFFF, |
---|
60 | 0); |
---|
61 | } |
---|
62 | //////////////////////////////////////////////////////////////////////////////////// |
---|
63 | // giet_tty_puts() |
---|
64 | //////////////////////////////////////////////////////////////////////////////////// |
---|
65 | // This function displays a string on a terminal. |
---|
66 | // The terminal index must be defined in the task context in the boot phase. |
---|
67 | // The string must be terminated by a NUL character. |
---|
68 | // It doesn't use the TTY_PUT_IRQ interrupt, and the associated kernel buffer. |
---|
69 | // - Returns the number of written characters. |
---|
70 | //////////////////////////////////////////////////////////////////////////////////// |
---|
71 | int giet_tty_puts(char * buf) |
---|
72 | { |
---|
73 | unsigned int length = 0; |
---|
74 | while (buf[length] != 0) { length++; } |
---|
75 | return sys_call(SYSCALL_TTY_WRITE, |
---|
76 | (unsigned int)buf, |
---|
77 | length, |
---|
78 | 0xFFFFFFFF, |
---|
79 | 0); |
---|
80 | } |
---|
81 | //////////////////////////////////////////////////////////////////////////////////// |
---|
82 | // giet_tty_putw() |
---|
83 | //////////////////////////////////////////////////////////////////////////////////// |
---|
84 | // This function displays the value of a 32-bit word with decimal characters. |
---|
85 | // The terminal index must be defined in the task context in the boot phase. |
---|
86 | // It doesn't use the TTY_PUT_IRQ interrupt, and the associated kernel buffer. |
---|
87 | // Returns the number of written characters (should be equal to ten). |
---|
88 | //////////////////////////////////////////////////////////////////////////////////// |
---|
89 | int giet_tty_putw(unsigned int val) |
---|
90 | { |
---|
91 | char buf[10]; |
---|
92 | unsigned int i; |
---|
93 | for (i = 0; i < 10; i++) |
---|
94 | { |
---|
95 | buf[9 - i] = (val % 10) + 0x30; |
---|
96 | val = val / 10; |
---|
97 | } |
---|
98 | return sys_call(SYSCALL_TTY_WRITE, |
---|
99 | (unsigned int)buf, |
---|
100 | 10, |
---|
101 | 0xFFFFFFFF, |
---|
102 | 0); |
---|
103 | } |
---|
104 | //////////////////////////////////////////////////////////////////////////////////// |
---|
105 | // giet_tty_getc() |
---|
106 | //////////////////////////////////////////////////////////////////////////////////// |
---|
107 | // This blocking function fetches a single ascii character from a terminal. |
---|
108 | // The terminal index must be defined in the task context in the boot phase. |
---|
109 | // It uses the IRQ_GET interrupt, and the associated kernel buffer. |
---|
110 | // - Returns 0 when completed. |
---|
111 | //////////////////////////////////////////////////////////////////////////////////// |
---|
112 | int giet_tty_getc(char * byte) |
---|
113 | { |
---|
114 | unsigned int ret = 0; |
---|
115 | while (ret == 0) |
---|
116 | { |
---|
117 | ret = sys_call(SYSCALL_TTY_READ, |
---|
118 | (unsigned int)byte, // buffer address |
---|
119 | 1, // number of characters |
---|
120 | 0xFFFFFFFF, // channel index from task context |
---|
121 | 0); |
---|
122 | } |
---|
123 | return 0; |
---|
124 | } |
---|
125 | //////////////////////////////////////////////////////////////////////////////////// |
---|
126 | // giet_tty_gets() |
---|
127 | //////////////////////////////////////////////////////////////////////////////////// |
---|
128 | // This blocking function fetches a string from a terminal to a fixed length buffer. |
---|
129 | // The terminal index must be defined in the task context in the boot phase. |
---|
130 | // It uses the TTY_GET_IRQ interrupt, anf the associated kernel buffer. |
---|
131 | // - Returns 0 when completed. |
---|
132 | // - Up to (bufsize - 1) characters (including the non printable characters) |
---|
133 | // will be copied into buffer, and the string is always completed by a NUL |
---|
134 | // character. |
---|
135 | // - The <LF> character is interpreted, and the function close the string with a |
---|
136 | // NUL character if <LF> is read. |
---|
137 | // - The <DEL> character is interpreted, and the corresponding character(s) are |
---|
138 | // removed from the target buffer. |
---|
139 | //////////////////////////////////////////////////////////////////////////////////// |
---|
140 | int giet_tty_gets( char* buf, |
---|
141 | unsigned int bufsize) |
---|
142 | { |
---|
143 | unsigned int ret; |
---|
144 | unsigned char byte; |
---|
145 | unsigned int index = 0; |
---|
146 | |
---|
147 | while (index < (bufsize - 1)) |
---|
148 | { |
---|
149 | do |
---|
150 | { |
---|
151 | ret = sys_call(SYSCALL_TTY_READ, |
---|
152 | (unsigned int)(&byte), |
---|
153 | 1, |
---|
154 | 0xFFFFFFFF, |
---|
155 | 0); |
---|
156 | } |
---|
157 | while (ret != 1); |
---|
158 | |
---|
159 | if (byte == 0x0A) /* LF */ |
---|
160 | { |
---|
161 | break; |
---|
162 | } |
---|
163 | else if ((byte == 0x7F) && (index > 0)) /* DEL */ |
---|
164 | { |
---|
165 | index--; |
---|
166 | } |
---|
167 | else |
---|
168 | { |
---|
169 | buf[index] = byte; |
---|
170 | index++; |
---|
171 | } |
---|
172 | } |
---|
173 | buf[index] = 0; |
---|
174 | return 0; |
---|
175 | } |
---|
176 | //////////////////////////////////////////////////////////////////////////////////// |
---|
177 | // giet_tty_getw() |
---|
178 | //////////////////////////////////////////////////////////////////////////////////// |
---|
179 | // This blocking function fetches a string of decimal characters (most |
---|
180 | // significant digit first) to build a 32-bit unsigned integer. |
---|
181 | // The terminal index must be defined in the task context in the boot phase. |
---|
182 | // It uses the TTY_GET_IRQ interrupt, anf the associated kernel buffer. |
---|
183 | // - Returns necessarily 0 when completed. |
---|
184 | // |
---|
185 | // - The non-blocking system function _tty_read_irq is called several times, |
---|
186 | // and the decimal characters are written in a 32 characters buffer until a |
---|
187 | // <LF> character is read. |
---|
188 | // - The <DEL> character is interpreted, and previous characters can be |
---|
189 | // cancelled. All others characters are ignored. |
---|
190 | // - When the <LF> character is received, the string is converted to an |
---|
191 | // unsigned int value. If the number of decimal digit is too large for the 32 |
---|
192 | // bits range, the zero value is returned. |
---|
193 | //////////////////////////////////////////////////////////////////////////////////// |
---|
194 | int giet_tty_getw(unsigned int * val) |
---|
195 | { |
---|
196 | unsigned char buf[32]; |
---|
197 | unsigned char byte; |
---|
198 | unsigned int save = 0; |
---|
199 | unsigned int dec = 0; |
---|
200 | unsigned int done = 0; |
---|
201 | unsigned int overflow = 0; |
---|
202 | unsigned int max = 0; |
---|
203 | unsigned int i; |
---|
204 | unsigned int ret; |
---|
205 | |
---|
206 | while (done == 0) |
---|
207 | { |
---|
208 | do |
---|
209 | { |
---|
210 | ret = sys_call(SYSCALL_TTY_READ, |
---|
211 | (unsigned int)(&byte), |
---|
212 | 1, |
---|
213 | 0xFFFFFFFF, |
---|
214 | 0); |
---|
215 | } |
---|
216 | while (ret != 1); |
---|
217 | |
---|
218 | if ((byte > 0x2F) && (byte < 0x3A)) /* decimal character */ |
---|
219 | { |
---|
220 | buf[max] = byte; |
---|
221 | max++; |
---|
222 | giet_tty_putc(byte); |
---|
223 | } |
---|
224 | else if ((byte == 0x0A)) /* LF */ |
---|
225 | { |
---|
226 | done = 1; |
---|
227 | } |
---|
228 | else if (byte == 0x7F) /* DEL */ |
---|
229 | { |
---|
230 | if (max > 0) |
---|
231 | { |
---|
232 | max--; /* cancel the character */ |
---|
233 | giet_tty_putc(0x08); |
---|
234 | giet_tty_putc(0x20); |
---|
235 | giet_tty_putc(0x08); |
---|
236 | } |
---|
237 | } |
---|
238 | if (max == 32) /* decimal string overflow */ |
---|
239 | { |
---|
240 | for (i = 0; i < max; i++) |
---|
241 | { |
---|
242 | /* cancel the string */ |
---|
243 | giet_tty_putc(0x08); |
---|
244 | giet_tty_putc(0x20); |
---|
245 | giet_tty_putc(0x08); |
---|
246 | } |
---|
247 | giet_tty_putc(0x30); |
---|
248 | *val = 0; /* return 0 value */ |
---|
249 | return 0; |
---|
250 | } |
---|
251 | } |
---|
252 | |
---|
253 | /* string conversion */ |
---|
254 | for (i = 0; i < max; i++) |
---|
255 | { |
---|
256 | dec = dec * 10 + (buf[i] - 0x30); |
---|
257 | if (dec < save) overflow = 1; |
---|
258 | save = dec; |
---|
259 | } |
---|
260 | |
---|
261 | /* check overflow */ |
---|
262 | if (overflow == 0) |
---|
263 | { |
---|
264 | *val = dec; /* return decimal value */ |
---|
265 | } |
---|
266 | else |
---|
267 | { |
---|
268 | for (i = 0; i < max; i++) |
---|
269 | { |
---|
270 | /* cancel the string */ |
---|
271 | giet_tty_putc(0x08); |
---|
272 | giet_tty_putc(0x20); |
---|
273 | giet_tty_putc(0x08); |
---|
274 | } |
---|
275 | giet_tty_putc(0x30); |
---|
276 | *val = 0; /* return 0 value */ |
---|
277 | } |
---|
278 | return 0; |
---|
279 | } |
---|
280 | //////////////////////////////////////////////////////////////////////////////////// |
---|
281 | // giet_tty_printf() |
---|
282 | //////////////////////////////////////////////////////////////////////////////////// |
---|
283 | // This function is a simplified version of the mutek_printf() function. |
---|
284 | // The terminal index must be defined in the calling task context. |
---|
285 | // It doesn't use the IRQ_PUT interrupt, and the associated kernel buffer. |
---|
286 | // Only a limited number of formats are supported: |
---|
287 | // - %d : signed decimal |
---|
288 | // - %u : unsigned decimal |
---|
289 | // - %x : hexadecimal |
---|
290 | // - %c : char |
---|
291 | // - %s : string |
---|
292 | // - Returns 0 if success, > 0 if error. |
---|
293 | //////////////////////////////////////////////////////////////////////////////////// |
---|
294 | int giet_tty_printf(char * format, ...) |
---|
295 | { |
---|
296 | va_list ap; |
---|
297 | va_start(ap, format); |
---|
298 | unsigned int ret; |
---|
299 | |
---|
300 | printf_text: |
---|
301 | |
---|
302 | while (*format) |
---|
303 | { |
---|
304 | unsigned int i; |
---|
305 | for (i = 0 ; format[i] && (format[i] != '%') ; i++); |
---|
306 | if (i) |
---|
307 | { |
---|
308 | ret = sys_call(SYSCALL_TTY_WRITE, |
---|
309 | (unsigned int)format, |
---|
310 | i, |
---|
311 | 0xFFFFFFFF, |
---|
312 | 0); |
---|
313 | if (ret != i) return 1; /* return error */ |
---|
314 | format += i; |
---|
315 | } |
---|
316 | if (*format == '%') |
---|
317 | { |
---|
318 | format++; |
---|
319 | goto printf_arguments; |
---|
320 | } |
---|
321 | } |
---|
322 | |
---|
323 | va_end(ap); |
---|
324 | return 0; |
---|
325 | |
---|
326 | printf_arguments: |
---|
327 | |
---|
328 | { |
---|
329 | int val = va_arg(ap, long); |
---|
330 | char buf[20]; |
---|
331 | char * pbuf; |
---|
332 | unsigned int len = 0; |
---|
333 | static const char HexaTab[] = "0123456789ABCDEF"; |
---|
334 | unsigned int i; |
---|
335 | |
---|
336 | switch (*format++) { |
---|
337 | case ('c'): /* char conversion */ |
---|
338 | len = 1; |
---|
339 | buf[0] = val; |
---|
340 | pbuf = buf; |
---|
341 | break; |
---|
342 | case ('d'): /* decimal signed integer */ |
---|
343 | if (val < 0) |
---|
344 | { |
---|
345 | val = -val; |
---|
346 | ret = sys_call(SYSCALL_TTY_WRITE, |
---|
347 | (unsigned int)"-", |
---|
348 | 1, |
---|
349 | 0xFFFFFFFF, |
---|
350 | 0); |
---|
351 | if (ret != 1) return 1; /* return error */ |
---|
352 | } |
---|
353 | case ('u'): /* decimal unsigned integer */ |
---|
354 | for(i = 0; i < 10; i++) |
---|
355 | { |
---|
356 | buf[9 - i] = HexaTab[val % 10]; |
---|
357 | if (!(val /= 10)) break; |
---|
358 | } |
---|
359 | len = i + 1; |
---|
360 | pbuf = &buf[9 - i]; |
---|
361 | break; |
---|
362 | case ('x'): /* hexadecimal integer */ |
---|
363 | ret = sys_call(SYSCALL_TTY_WRITE, |
---|
364 | (unsigned int)"0x", |
---|
365 | 2, |
---|
366 | 0xFFFFFFFF, |
---|
367 | 0); |
---|
368 | if (ret != 2) return 1; /* return error */ |
---|
369 | for(i = 0; i < 8; i++) |
---|
370 | { |
---|
371 | buf[7 - i] = HexaTab[val % 16U]; |
---|
372 | if (!(val /= 16U)) break; |
---|
373 | } |
---|
374 | len = i + 1; |
---|
375 | pbuf = &buf[7 - i]; |
---|
376 | break; |
---|
377 | case ('s'): /* string */ |
---|
378 | { |
---|
379 | char * str = (char *) val; |
---|
380 | while (str[len]) |
---|
381 | { |
---|
382 | len++; |
---|
383 | } |
---|
384 | pbuf = (char *) val; |
---|
385 | } |
---|
386 | break; |
---|
387 | default: |
---|
388 | goto printf_text; |
---|
389 | } |
---|
390 | |
---|
391 | ret = sys_call(SYSCALL_TTY_WRITE, |
---|
392 | (unsigned int)pbuf, |
---|
393 | len, |
---|
394 | 0xFFFFFFFF, |
---|
395 | 0); |
---|
396 | if (ret != len) return 1; |
---|
397 | goto printf_text; |
---|
398 | } |
---|
399 | } |
---|
400 | |
---|
401 | |
---|
402 | |
---|
403 | ////////////////////////////////////////////////////////////////////////////////// |
---|
404 | ///////////////////// TIMER related system calls //////////////////////////////// |
---|
405 | ////////////////////////////////////////////////////////////////////////////////// |
---|
406 | |
---|
407 | ////////////////////////////////////////////////////////////////////////////////// |
---|
408 | // giet_timer_start() |
---|
409 | ////////////////////////////////////////////////////////////////////////////////// |
---|
410 | // This function activates the private user timer allocated to the calling task |
---|
411 | // in the boot phase. |
---|
412 | // - Returns 0 if success, > 0 if error. |
---|
413 | ////////////////////////////////////////////////////////////////////////////////// |
---|
414 | int giet_timer_start() |
---|
415 | { |
---|
416 | return sys_call( SYSCALL_TIMER_START, |
---|
417 | 0, 0, 0, 0 ); |
---|
418 | } |
---|
419 | ////////////////////////////////////////////////////////////////////////////////// |
---|
420 | // giet_timer_stop() |
---|
421 | ////////////////////////////////////////////////////////////////////////////////// |
---|
422 | // This function activates the user timer allocated to the calling task. |
---|
423 | // - Returns 0 if success, > 0 if error. |
---|
424 | ////////////////////////////////////////////////////////////////////////////////// |
---|
425 | int giet_timer_stop() |
---|
426 | { |
---|
427 | return sys_call( SYSCALL_TIMER_STOP, |
---|
428 | 0, 0, 0, 0 ); |
---|
429 | } |
---|
430 | |
---|
431 | |
---|
432 | ////////////////////////////////////////////////////////////////////////////////// |
---|
433 | /////////////// Frame buffer device related system calls /////////////////////// |
---|
434 | ////////////////////////////////////////////////////////////////////////////////// |
---|
435 | |
---|
436 | ////////////////////////////////////////////////////////////////////////////////// |
---|
437 | // giet_fb_sync_write() |
---|
438 | ////////////////////////////////////////////////////////////////////////////////// |
---|
439 | // This blocking function use a memory copy strategy to transfer data from a |
---|
440 | // user buffer to the frame buffer device in kernel space. |
---|
441 | // offset : offset (in bytes) in the frame buffer |
---|
442 | // buffer : base address of the memory buffer |
---|
443 | // length : number of bytes to be transfered |
---|
444 | // - Returns 0 if success, > 0 if error (e.g. memory buffer not in user space). |
---|
445 | ////////////////////////////////////////////////////////////////////////////////// |
---|
446 | int giet_fb_sync_write( unsigned int offset, |
---|
447 | void * buffer, |
---|
448 | unsigned int length ) |
---|
449 | { |
---|
450 | return sys_call( SYSCALL_FB_SYNC_WRITE, |
---|
451 | offset, |
---|
452 | (unsigned int)buffer, |
---|
453 | length, |
---|
454 | 0 ); |
---|
455 | } |
---|
456 | ////////////////////////////////////////////////////////////////////////////////// |
---|
457 | // giet_fb_sync_read() |
---|
458 | ////////////////////////////////////////////////////////////////////////////////// |
---|
459 | // This blocking function use a memory copy strategy to transfer data from the |
---|
460 | // frame buffer device in kernel space to an user buffer. |
---|
461 | // offset : offset (in bytes) in the frame buffer |
---|
462 | // buffer : base address of the user buffer |
---|
463 | // length : number of bytes to be transfered |
---|
464 | // - Returns 0 if success, > 0 if error (e.g. memory buffer not in user space). |
---|
465 | ////////////////////////////////////////////////////////////////////////////////// |
---|
466 | int giet_fb_sync_read( unsigned int offset, |
---|
467 | void * buffer, |
---|
468 | unsigned int length ) |
---|
469 | { |
---|
470 | return sys_call( SYSCALL_FB_SYNC_READ, |
---|
471 | offset, |
---|
472 | (unsigned int)buffer, |
---|
473 | length, |
---|
474 | 0 ); |
---|
475 | } |
---|
476 | ////////////////////////////////////////////////////////////////////////////////// |
---|
477 | // giet_fb_cma_init() |
---|
478 | ////////////////////////////////////////////////////////////////////////////////// |
---|
479 | // This function initializes the two chbuf SRC an DST used by the CMA controller |
---|
480 | // and activates the CMA channel allocated to the calling task. |
---|
481 | // - buf0 : first user buffer virtual address |
---|
482 | // - buf0 : second user buffer virtual address |
---|
483 | // - length : buffer size (bytes) |
---|
484 | // - Returns 0 if success, > 0 if error. |
---|
485 | ////////////////////////////////////////////////////////////////////////////////// |
---|
486 | int giet_fb_cma_init( void * buf0, |
---|
487 | void * buf1, |
---|
488 | unsigned int length ) |
---|
489 | { |
---|
490 | return sys_call( SYSCALL_FB_CMA_INIT, |
---|
491 | (unsigned int)buf0, |
---|
492 | (unsigned int)buf1, |
---|
493 | length, |
---|
494 | 0 ); |
---|
495 | } |
---|
496 | ////////////////////////////////////////////////////////////////////////////////// |
---|
497 | // giet_fb_cma_write() |
---|
498 | ////////////////////////////////////////////////////////////////////////////////// |
---|
499 | // This function set the valid status for one of the SRC user buffer. |
---|
500 | // and reset the valid status for the DST frame buffer. |
---|
501 | // - bufffer_id : 0 => buf0 valid is set / not 0 => buf1 valid is set |
---|
502 | // - Returns 0 if success, > 0 if error. |
---|
503 | ////////////////////////////////////////////////////////////////////////////////// |
---|
504 | int giet_fb_cma_write( unsigned int buffer_id ) |
---|
505 | { |
---|
506 | return sys_call( SYSCALL_FB_CMA_WRITE, |
---|
507 | buffer_id, |
---|
508 | 0, 0, 0 ); |
---|
509 | } |
---|
510 | ////////////////////////////////////////////////////////////////////////////////// |
---|
511 | // giet_fb_cma_stop() |
---|
512 | ////////////////////////////////////////////////////////////////////////////////// |
---|
513 | // This function desactivates the CMA channel allocated to the calling task. |
---|
514 | // - Returns 0 if success, > 0 if error. |
---|
515 | ////////////////////////////////////////////////////////////////////////////////// |
---|
516 | int giet_fb_cma_stop( ) |
---|
517 | { |
---|
518 | return sys_call( SYSCALL_FB_CMA_STOP, |
---|
519 | 0, 0, 0, 0 ); |
---|
520 | } |
---|
521 | |
---|
522 | |
---|
523 | ////////////////////////////////////////////////////////////////////////////////// |
---|
524 | /////////////////////// NIC related system calls ///////////////////////////////// |
---|
525 | ////////////////////////////////////////////////////////////////////////////////// |
---|
526 | |
---|
527 | ////////////////////////////////////////////////////////////////////////////////// |
---|
528 | // giet_nic_cma_init() |
---|
529 | ////////////////////////////////////////////////////////////////////////////////// |
---|
530 | // This function initializes the memory chbuf used by the CMA controller, |
---|
531 | // activates the NIC channel allocated to the calling task, and the CMA channel. |
---|
532 | // - tx : RX channel if 0 / TX channel if non 0 |
---|
533 | // - buf0 : first user buffer virtual address |
---|
534 | // - buf1 : second user buffer virtual address |
---|
535 | // - length : buffer size (bytes) |
---|
536 | // - Returns 0 if success, > 0 if error |
---|
537 | ////////////////////////////////////////////////////////////////////////////////// |
---|
538 | int giet_nic_cma_start() |
---|
539 | { |
---|
540 | return sys_call( SYSCALL_NIC_CMA_START, |
---|
541 | 0, 0, 0, 0 ); |
---|
542 | } |
---|
543 | ////////////////////////////////////////////////////////////////////////////////// |
---|
544 | // giet_nic_cma_stop() |
---|
545 | ////////////////////////////////////////////////////////////////////////////////// |
---|
546 | // This function desactivates the NIC channel and the two CMA channels |
---|
547 | // allocated to the calling task. |
---|
548 | // - Returns 0 if success, > 0 if error. |
---|
549 | ////////////////////////////////////////////////////////////////////////////////// |
---|
550 | int giet_nic_cma_stop( ) |
---|
551 | { |
---|
552 | return sys_call( SYSCALL_NIC_CMA_STOP, |
---|
553 | 0, 0, 0, 0 ); |
---|
554 | } |
---|
555 | |
---|
556 | |
---|
557 | ////////////////////////////////////////////////////////////////////////////////// |
---|
558 | ///////////////////// Miscellaneous system calls ///////////////////////////////// |
---|
559 | ////////////////////////////////////////////////////////////////////////////////// |
---|
560 | |
---|
561 | /////////////////////////////////////////////////////////////////////////////////// |
---|
562 | // giet_assert() |
---|
563 | /////////////////////////////////////////////////////////////////////////////////// |
---|
564 | // This function uses the giet_tty_puts() and giet_exit() system calls. |
---|
565 | /////////////////////////////////////////////////////////////////////////////////// |
---|
566 | void giet_assert( unsigned int condition, |
---|
567 | char* string ) |
---|
568 | { |
---|
569 | if ( condition == 0 ) |
---|
570 | { |
---|
571 | giet_tty_puts( string ); |
---|
572 | giet_exit(); |
---|
573 | } |
---|
574 | } |
---|
575 | ////////////////////////////////////////////////////////////////////////////////// |
---|
576 | // giet_vobj_get_vbase() |
---|
577 | ////////////////////////////////////////////////////////////////////////////////// |
---|
578 | // This function writes in argument (vobj_vaddr) the virtual base address |
---|
579 | // of a vobj (defined in the mapping_info data structure), identified by |
---|
580 | // the two arguments (vspace_name and vobj_name). |
---|
581 | // The (vobj_type) argument is redundant, and used for coherence checking. |
---|
582 | // - Returns the address if success, 0 if error ( not defined or wrong type ) |
---|
583 | ////////////////////////////////////////////////////////////////////////////////// |
---|
584 | int giet_vobj_get_vbase( char* vspace_name, |
---|
585 | char* vobj_name, |
---|
586 | unsigned int vobj_type, |
---|
587 | unsigned int* vobj_vaddr ) |
---|
588 | { |
---|
589 | return sys_call( SYSCALL_VOBJ_GET_VBASE, |
---|
590 | (unsigned int) vspace_name, |
---|
591 | (unsigned int) vobj_name, |
---|
592 | (unsigned int) vobj_type, |
---|
593 | (unsigned int) vobj_vaddr ); |
---|
594 | } |
---|
595 | //////////////////////////////////////////////////////////////////////////////////// |
---|
596 | // giet_proc_number() |
---|
597 | //////////////////////////////////////////////////////////////////////////////////// |
---|
598 | // This function returns in the buffer argument the number of processors |
---|
599 | // in the cluster specified by the cluster_id argument. |
---|
600 | // - Returns 0 if success, > 0 if error ( cluster index too large ) |
---|
601 | //////////////////////////////////////////////////////////////////////////////////// |
---|
602 | int giet_proc_number( unsigned int cluster_id, |
---|
603 | unsigned int* buffer ) |
---|
604 | { |
---|
605 | return sys_call(SYSCALL_PROC_NUMBER, cluster_id, (unsigned int) buffer, 0, 0); |
---|
606 | } |
---|
607 | ////////////////////////////////////////////////////////////////////////////////// |
---|
608 | // giet_exit() |
---|
609 | ////////////////////////////////////////////////////////////////////////////////// |
---|
610 | // This function stops execution of the calling task with a TTY message, |
---|
611 | // the user task is descheduled and becomes not runable. |
---|
612 | // It does not consume processor cycles anymore. |
---|
613 | ////////////////////////////////////////////////////////////////////////////////// |
---|
614 | void giet_exit() |
---|
615 | { |
---|
616 | sys_call( SYSCALL_EXIT, |
---|
617 | 0, 0, 0, 0 ); |
---|
618 | } |
---|
619 | ////////////////////////////////////////////////////////////////////////////////// |
---|
620 | // giet_context_switch() |
---|
621 | ////////////////////////////////////////////////////////////////////////////////// |
---|
622 | // The user task calling this function is descheduled and |
---|
623 | // the processor is allocated to another task. |
---|
624 | ////////////////////////////////////////////////////////////////////////////////// |
---|
625 | int giet_context_switch() |
---|
626 | { |
---|
627 | return sys_call( SYSCALL_CTX_SWITCH, |
---|
628 | 0, 0, 0, 0 ); |
---|
629 | } |
---|
630 | ////////////////////////////////////////////////////////////////////////////////// |
---|
631 | // giet_proc_task_id() |
---|
632 | ////////////////////////////////////////////////////////////////////////////////// |
---|
633 | // This functions returns the local task id. |
---|
634 | // If processor has n tasks the local task index is ranging from 0 to n-1 |
---|
635 | ////////////////////////////////////////////////////////////////////////////////// |
---|
636 | int giet_proc_task_id() |
---|
637 | { |
---|
638 | return sys_call( SYSCALL_LOCAL_TASK_ID, |
---|
639 | 0, 0, 0, 0 ); |
---|
640 | } |
---|
641 | ////////////////////////////////////////////////////////////////////////////////// |
---|
642 | // giet_heap_info() |
---|
643 | ////////////////////////////////////////////////////////////////////////////////// |
---|
644 | // This function returns the base address and size of the current task's heap |
---|
645 | ////////////////////////////////////////////////////////////////////////////////// |
---|
646 | int giet_heap_info( unsigned int* vaddr, |
---|
647 | unsigned int* length ) |
---|
648 | { |
---|
649 | return sys_call( SYSCALL_HEAP_INFO, |
---|
650 | (unsigned int)vaddr, |
---|
651 | (unsigned int)length, |
---|
652 | 0, 0 ); |
---|
653 | } |
---|
654 | ////////////////////////////////////////////////////////////////////////////////// |
---|
655 | // giet_global_task_id() |
---|
656 | ////////////////////////////////////////////////////////////////////////////////// |
---|
657 | // This functions returns the global task id, which is unique in all the giet. |
---|
658 | ////////////////////////////////////////////////////////////////////////////////// |
---|
659 | int giet_global_task_id() |
---|
660 | { |
---|
661 | return sys_call( SYSCALL_GLOBAL_TASK_ID, |
---|
662 | 0, 0, 0, 0 ); |
---|
663 | } |
---|
664 | |
---|
665 | /////////////////////////////////////////////////////////////////////////////////// |
---|
666 | ///////////////////// FAT related system calls //////////////////////////////////// |
---|
667 | /////////////////////////////////////////////////////////////////////////////////// |
---|
668 | |
---|
669 | /////////////////////////////////////////////////////////////////////////////////// |
---|
670 | // giet_fat_open() |
---|
671 | /////////////////////////////////////////////////////////////////////////////////// |
---|
672 | // Open a file identified by a pathname, and contained in the system FAT. |
---|
673 | // The read/write flags are not supported yet: no effect. |
---|
674 | /////////////////////////////////////////////////////////////////////////////////// |
---|
675 | int giet_fat_open( const char* pathname, |
---|
676 | unsigned int flags ) |
---|
677 | { |
---|
678 | return sys_call( SYSCALL_FAT_OPEN, |
---|
679 | (unsigned int)pathname, |
---|
680 | flags, |
---|
681 | 0, 0 ); |
---|
682 | } |
---|
683 | /////////////////////////////////////////////////////////////////////////////////// |
---|
684 | // giet_fat_read() |
---|
685 | /////////////////////////////////////////////////////////////////////////////////// |
---|
686 | // Read "count" sectors from a file identified by "fd", skipping "offset" |
---|
687 | // sectors in file, and writing into the user "buffer". |
---|
688 | // The user buffer base address shoulb be 64 bytes aligned. |
---|
689 | /////////////////////////////////////////////////////////////////////////////////// |
---|
690 | // This system call specification should evolve to the UNIX specification: |
---|
691 | // - count must be a number of bytes, with no alignment constraint on user buffer. |
---|
692 | // - offset argument should be removed and replaced by an implicit "lseek" pointer |
---|
693 | // stored in the file descriptor. |
---|
694 | // This suppose to implement a sectors cache |
---|
695 | /////////////////////////////////////////////////////////////////////////////////// |
---|
696 | int giet_fat_read( unsigned int fd, |
---|
697 | void* buffer, |
---|
698 | unsigned int count, |
---|
699 | unsigned int offset ) |
---|
700 | { |
---|
701 | return sys_call( SYSCALL_FAT_READ, |
---|
702 | fd, |
---|
703 | (unsigned int)buffer, |
---|
704 | count, |
---|
705 | offset ); |
---|
706 | } |
---|
707 | /////////////////////////////////////////////////////////////////////////////////// |
---|
708 | // giet_fat_write() |
---|
709 | /////////////////////////////////////////////////////////////////////////////////// |
---|
710 | // Write "count" sectors from a file identified by "fd", skipping "offset" |
---|
711 | // sectors in file, and reading from the user "buffer". |
---|
712 | // The user buffer base address shoulb be 64 bytes aligned. |
---|
713 | /////////////////////////////////////////////////////////////////////////////////// |
---|
714 | // This system call specification should evolve to the UNIX specification: |
---|
715 | // - count must be a number of bytes, with no alignment constraint on buffer |
---|
716 | // - offset argument should be removed and replaced by an implicit "lseek" pointer |
---|
717 | // stored in the file descriptor. |
---|
718 | // This suppose to implement a sectors cache |
---|
719 | /////////////////////////////////////////////////////////////////////////////////// |
---|
720 | int giet_fat_write( unsigned int fd, |
---|
721 | void* buffer, |
---|
722 | unsigned int count, |
---|
723 | unsigned int offset ) |
---|
724 | { |
---|
725 | return sys_call( SYSCALL_FAT_WRITE, |
---|
726 | fd, |
---|
727 | (unsigned int)buffer, |
---|
728 | count, |
---|
729 | offset ); |
---|
730 | } |
---|
731 | /////////////////////////////////////////////////////////////////////////////////// |
---|
732 | // giet_fat_lseek() |
---|
733 | /////////////////////////////////////////////////////////////////////////////////// |
---|
734 | // Change the lseek file pointer value for a file identified by "fd". |
---|
735 | /////////////////////////////////////////////////////////////////////////////////// |
---|
736 | int giet_fat_lseek( unsigned int fd, |
---|
737 | unsigned int offset, |
---|
738 | unsigned int whence) |
---|
739 | { |
---|
740 | return sys_call( SYSCALL_FAT_LSEEK, |
---|
741 | fd, |
---|
742 | offset, |
---|
743 | whence, |
---|
744 | 0 ); |
---|
745 | } |
---|
746 | /////////////////////////////////////////////////////////////////////////////////// |
---|
747 | // giet_fat_close() |
---|
748 | /////////////////////////////////////////////////////////////////////////////////// |
---|
749 | // Close a file identified by "fd". |
---|
750 | /////////////////////////////////////////////////////////////////////////////////// |
---|
751 | int giet_fat_close( unsigned int fd ) |
---|
752 | { |
---|
753 | return sys_call( SYSCALL_FAT_CLOSE, |
---|
754 | fd, |
---|
755 | 0, 0, 0 ); |
---|
756 | } |
---|
757 | |
---|
758 | |
---|
759 | /////////////////////////////////////////////////////////////////////////////////// |
---|
760 | ////////////////// Pseudo system calls (no syscall instruction) /////////////////// |
---|
761 | /////////////////////////////////////////////////////////////////////////////////// |
---|
762 | |
---|
763 | /////////////////////////////////////////////////////////////////////////////////// |
---|
764 | // giet_rand() |
---|
765 | // This function returns a pseudo-random value derived from the processor cycle |
---|
766 | // count. This value is comprised between 0 & 65535. |
---|
767 | /////////////////////////////////////////////////////////////////////////////////// |
---|
768 | int giet_rand() |
---|
769 | { |
---|
770 | unsigned int x = sys_call(SYSCALL_PROCTIME, 0, 0, 0, 0); |
---|
771 | if ((x & 0xF) > 7) { |
---|
772 | return (x*x & 0xFFFF); |
---|
773 | } |
---|
774 | else { |
---|
775 | return (x*x*x & 0xFFFF); |
---|
776 | } |
---|
777 | } |
---|
778 | /////////////////////////////////////////////////////////////////////////////////// |
---|
779 | // memcpy() |
---|
780 | /////////////////////////////////////////////////////////////////////////////////// |
---|
781 | inline void* memcpy( void* dest, |
---|
782 | const void* source, |
---|
783 | unsigned int size ) |
---|
784 | { |
---|
785 | unsigned int* dst = dest; |
---|
786 | const unsigned int* src = source; |
---|
787 | |
---|
788 | // word-by-word copy |
---|
789 | if (!((unsigned int) dst & 3) && !((unsigned int) src & 3)) |
---|
790 | { |
---|
791 | while (size > 3) |
---|
792 | { |
---|
793 | *dst++ = *src++; |
---|
794 | size -= 4; |
---|
795 | } |
---|
796 | } |
---|
797 | |
---|
798 | unsigned char * cdst = (unsigned char *) dst; |
---|
799 | unsigned char * csrc = (unsigned char *) src; |
---|
800 | |
---|
801 | /* byte-by-byte copy */ |
---|
802 | while (size--) |
---|
803 | { |
---|
804 | *cdst++ = *csrc++; |
---|
805 | } |
---|
806 | return dest; |
---|
807 | } |
---|
808 | |
---|
809 | // Local Variables: |
---|
810 | // tab-width: 4 |
---|
811 | // c-basic-offset: 4 |
---|
812 | // c-file-offsets:((innamespace . 0)(inline-open . 0)) |
---|
813 | // indent-tabs-mode: nil |
---|
814 | // End: |
---|
815 | // vim: filetype=c:expandtab:shiftwidth=4:tabstop=4:softtabstop=4 |
---|
816 | |
---|