Subversion Repositories HelenOS-historic

Rev

Rev 1452 | Rev 1490 | Go to most recent revision | Blame | Compare with Previous | Last modification | View Log | Download | RSS feed

  1. /*
  2.  * Copyright (C) 2006 Josef Cejka
  3.  * Copyright (C) 2006 Jakub Vana
  4.  * All rights reserved.
  5.  *
  6.  * Redistribution and use in source and binary forms, with or without
  7.  * modification, are permitted provided that the following conditions
  8.  * are met:
  9.  *
  10.  * - Redistributions of source code must retain the above copyright
  11.  *   notice, this list of conditions and the following disclaimer.
  12.  * - Redistributions in binary form must reproduce the above copyright
  13.  *   notice, this list of conditions and the following disclaimer in the
  14.  *   documentation and/or other materials provided with the distribution.
  15.  * - The name of the author may not be used to endorse or promote products
  16.  *   derived from this software without specific prior written permission.
  17.  *
  18.  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
  19.  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
  20.  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
  21.  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
  22.  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
  23.  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
  24.  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
  25.  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  26.  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
  27.  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  28.  */
  29.  
  30.  
  31. #include <io/io.h>
  32. #include <io/stream.h>
  33. #include <string.h>
  34. #include <malloc.h>
  35. #include <libc.h>
  36. #include <ipc/ipc.h>
  37. #include <ipc/ns.h>
  38. #include <ipc/fb.h>
  39. #include <ipc/services.h>
  40. #include <console.h>
  41. #include <unistd.h>
  42.  
  43. #define FDS 32
  44.  
  45. typedef struct stream_t {
  46.     pwritefn_t w;
  47.     preadfn_t r;
  48.     void * param;
  49. } stream_t;
  50.  
  51. int console_phone = -1;
  52.  
  53. stream_t streams[FDS] = {{0, 0, 0}};
  54.  
  55. /*
  56. ssize_t write_stdout(void *param, const void * buf, size_t count);
  57. ssize_t write_stdout(void *param, const void * buf, size_t count)
  58. {
  59.     return (ssize_t) __SYSCALL3(SYS_IO, 1, (sysarg_t) buf, (sysarg_t) count);
  60. }*/
  61.  
  62. static ssize_t write_stderr(void *param, const void *buf, size_t count)
  63. {
  64.     return count;
  65.     //return (ssize_t) __SYSCALL3(SYS_IO, 1, (sysarg_t) buf, (sysarg_t) count);
  66. }
  67.  
  68. static ssize_t read_stdin(void *param, void *buf, size_t count)
  69. {
  70.     ipcarg_t r0,r1;
  71.     size_t i = 0;
  72.  
  73.     while (i < count) {
  74.         if (ipc_call_sync_2(console_phone, CONSOLE_GETCHAR, 0, 0, &r0, &r1) < 0) {
  75.             return -1;
  76.         }
  77.         ((char *)buf)[i++] = r0;
  78.     }
  79.     return i;
  80.     //return (ssize_t) __SYSCALL3(SYS_IO, 1, (sysarg_t) buf, (sysarg_t) count);
  81. }
  82.  
  83. static ssize_t write_stdout(void *param, const void *buf, size_t count)
  84. {
  85.     int i;
  86.     ipcarg_t r0,r1;
  87.  
  88.     for (i = 0; i < count; i++)
  89.         ipc_call_sync_2(console_phone, CONSOLE_PUTCHAR, 0, ((const char *)buf)[i], &r0, &r1);
  90.    
  91.     return count;
  92.     //return (ssize_t) __SYSCALL3(SYS_IO, 1, (sysarg_t) buf, (sysarg_t) count);
  93. }
  94.  
  95.  
  96.  
  97. static stream_t open_stdin(void)
  98. {
  99.     stream_t stream;
  100.     int phoneid;
  101.     int res;
  102.    
  103.     if (console_phone < 0) {
  104.         while ((console_phone = ipc_connect_me_to(PHONE_NS, SERVICE_CONSOLE, 0)) < 0) {
  105.             usleep(10000);
  106.         }
  107.     }
  108.    
  109.     stream.r = read_stdin;
  110.     stream.param = 0;
  111.     return stream;
  112. }
  113.  
  114. static stream_t open_stdout(void)
  115. {
  116.     stream_t stream;
  117.     int res;
  118.    
  119.     if (console_phone < 0) {
  120.         while ((console_phone = ipc_connect_me_to(PHONE_NS, SERVICE_CONSOLE, 0)) < 0) {
  121.             volatile int a;
  122.             for (a = 0; a < 1048576; a++);
  123.         }
  124.     }
  125.    
  126.     stream.w = write_stdout;
  127.     stream.param = 0;
  128.     return stream;
  129. }
  130.  
  131. fd_t open(const char *fname, int flags)
  132. {
  133.     int c = 0;
  134.    
  135.     while (((streams[c].w) || (streams[c].r)) && (c < FDS))
  136.         c++;
  137.     if (c == FDS)
  138.         return EMFILE;
  139.    
  140.     if (!strcmp(fname, "stdin")) {
  141.         streams[c] = open_stdin();
  142.         return c;
  143.     }
  144.    
  145.     if (!strcmp(fname, "stdout")) {
  146.         //streams[c].w = write_stdout;
  147.         //return c;
  148.         streams[c] = open_stdout();
  149.         return c;
  150.     }
  151.    
  152.     if (!strcmp(fname, "stderr")) {
  153.         streams[c].w = write_stderr;
  154.         return c;
  155.     }
  156. }
  157.  
  158.  
  159. ssize_t write(int fd, const void *buf, size_t count)
  160. {
  161.     if (fd < FDS)
  162.         return streams[fd].w(streams[fd].param, buf, count);
  163.    
  164.     return 0;
  165. }
  166.  
  167. ssize_t read(int fd, void *buf, size_t count)
  168. {
  169.     if (fd < FDS)
  170.         return streams[fd].r(streams[fd].param, buf, count);
  171.    
  172.     return 0;
  173. }
  174.  
  175.