Subversion Repositories HelenOS

Rev

Rev 1536 | Rev 1653 | 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. #include <async.h>
  43.  
  44. #define FDS 32
  45.  
  46. typedef struct stream_t {
  47.     pwritefn_t w;
  48.     preadfn_t r;
  49.     void * param;
  50.     int phone;
  51. } stream_t;
  52.  
  53. static int console_phone = -1;
  54. static stream_t streams[FDS];
  55.  
  56. static ssize_t write_stderr(void *param, const void *buf, size_t count)
  57. {
  58.     return count;
  59. }
  60.  
  61. static ssize_t read_stdin(void *param, void *buf, size_t count)
  62. {
  63.     ipcarg_t r0,r1;
  64.     size_t i = 0;
  65.  
  66.     while (i < count) {
  67.         if (async_req_2(streams[0].phone, CONSOLE_GETCHAR, 0, 0, &r0, &r1) < 0) {
  68.             return -1;
  69.         }
  70.         ((char *)buf)[i++] = r0;
  71.     }
  72.     return i;
  73. }
  74.  
  75. static ssize_t write_stdout(void *param, const void *buf, size_t count)
  76. {
  77.     int i;
  78.     ipcarg_t r0,r1;
  79.  
  80.     for (i = 0; i < count; i++)
  81.         async_msg(streams[1].phone, CONSOLE_PUTCHAR, ((const char *)buf)[i]);
  82.    
  83.     return count;
  84. }
  85.  
  86.  
  87.  
  88. static stream_t open_stdin(void)
  89. {
  90.     stream_t stream;
  91.     int phoneid;
  92.     int res;
  93.    
  94.     if (console_phone < 0) {
  95.         while ((console_phone = ipc_connect_me_to(PHONE_NS, SERVICE_CONSOLE, 0)) < 0) {
  96.             usleep(10000);
  97.         }
  98.     }
  99.    
  100.     stream.r = read_stdin;
  101.     stream.param = 0;
  102.     stream.phone = console_phone;
  103.    
  104.     return stream;
  105. }
  106.  
  107. static stream_t open_stdout(void)
  108. {
  109.     stream_t stream;
  110.     int res;
  111.  
  112.     if (console_phone < 0) {
  113.         while ((console_phone = ipc_connect_me_to(PHONE_NS, SERVICE_CONSOLE, 0)) < 0) {
  114.             usleep(10000);
  115.         }
  116.     }
  117.    
  118.     stream.w = write_stdout;
  119.     stream.phone = console_phone;
  120.     stream.param = 0;
  121.     return stream;
  122. }
  123.  
  124. static ssize_t write_null(void *param, const void *buf, size_t count)
  125. {
  126.     return count;
  127. }
  128.  
  129.  
  130. fd_t open(const char *fname, int flags)
  131. {
  132.     int c = 0;
  133.  
  134.     while (((streams[c].w) || (streams[c].r)) && (c < FDS))
  135.         c++;
  136.     if (c == FDS)
  137.         return EMFILE;
  138.    
  139.     if (!strcmp(fname, "stdin")) {
  140.         streams[c] = open_stdin();
  141.         return c;
  142.     }
  143.    
  144.     if (!strcmp(fname, "stdout")) {
  145.         streams[c] = open_stdout();
  146.         return c;
  147.     }
  148.    
  149.     if (!strcmp(fname, "stderr")) {
  150.         streams[c].w = write_stderr;
  151.         return c;
  152.     }
  153.     if (!strcmp(fname, "null")) {
  154.         streams[c].w = write_null;
  155.         return c;
  156.     }
  157. }
  158.  
  159.  
  160. ssize_t write(int fd, const void *buf, size_t count)
  161. {
  162. //  __SYSCALL3(SYS_IO, 1, (sysarg_t)buf, (sysarg_t) count);
  163. //  return count;
  164.     if (fd < FDS)
  165.         return streams[fd].w(streams[fd].param, buf, count);
  166.    
  167.     return 0;
  168. }
  169.  
  170. ssize_t read(int fd, void *buf, size_t count)
  171. {
  172.     if (fd < FDS)
  173.         return streams[fd].r(streams[fd].param, buf, count);
  174.    
  175.     return 0;
  176. }
  177.  
  178. int get_fd_phone(int fd)
  179. {
  180.     if (fd >= FDS || fd < 0)
  181.         return -1;
  182.     return streams[fd].phone;
  183. }
  184.