Subversion Repositories HelenOS

Rev

Rev 1366 | Rev 1452 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 1366 Rev 1451
Line 5... Line 5...
5
#include <libc.h>
5
#include <libc.h>
6
#include <ipc/ipc.h>
6
#include <ipc/ipc.h>
7
#include <ipc/ns.h>
7
#include <ipc/ns.h>
8
#include <ipc/fb.h>
8
#include <ipc/fb.h>
9
#include <ipc/services.h>
9
#include <ipc/services.h>
-
 
10
#include <console.h>
10
 
11
 
11
#define FDS 32
12
#define FDS 32
12
 
13
 
13
typedef struct stream_t {
14
typedef struct stream_t {
14
    pwritefn_t w;
15
    pwritefn_t w;
15
    preadfn_t r;
16
    preadfn_t r;
16
    void * param;
17
    void * param;
17
} stream_t;
18
} stream_t;
18
 
19
 
19
 
-
 
20
typedef struct vfb_descriptor_t {
-
 
21
    int phone;
20
int console_phone = -1;
22
    int vfb;
-
 
23
} vfb_descriptor_t;
-
 
24
 
-
 
25
 
21
 
26
stream_t streams[FDS] = {{0, 0, 0}};
22
stream_t streams[FDS] = {{0, 0, 0}};
27
 
23
 
28
/*
24
/*
29
ssize_t write_stdout(void *param, const void * buf, size_t count);
25
ssize_t write_stdout(void *param, const void * buf, size_t count);
30
ssize_t write_stdout(void *param, const void * buf, size_t count)
26
ssize_t write_stdout(void *param, const void * buf, size_t count)
31
{
27
{
32
    return (ssize_t) __SYSCALL3(SYS_IO, 1, (sysarg_t) buf, (sysarg_t) count);
28
    return (ssize_t) __SYSCALL3(SYS_IO, 1, (sysarg_t) buf, (sysarg_t) count);
33
}*/
29
}*/
34
 
30
 
35
static void vfb_send_char(vfb_descriptor_t *d, char c)
31
static ssize_t write_stderr(void *param, const void *buf, size_t count)
-
 
32
{
-
 
33
    return count;
-
 
34
    //return (ssize_t) __SYSCALL3(SYS_IO, 1, (sysarg_t) buf, (sysarg_t) count);
-
 
35
}
-
 
36
 
-
 
37
static char read_stdin(void)
36
{
38
{
37
    ipcarg_t r0,r1;
39
    ipcarg_t r0,r1;
38
    ipc_call_sync_2(d->phone, FB_PUTCHAR, d->vfb, c, &r0, &r1);
40
    ipc_call_sync_2(console_phone, CONSOLE_GETCHAR, 0, 0, &r0, &r1);
-
 
41
   
-
 
42
    return r0;
-
 
43
    //return (ssize_t) __SYSCALL3(SYS_IO, 1, (sysarg_t) buf, (sysarg_t) count);
39
}
44
}
40
               
-
 
41
static ssize_t write_vfb(void *param, const void *buf, size_t count)
45
static ssize_t write_stdout(void *param, const void *buf, size_t count)
42
{
46
{
43
    int i;
47
    int i;
-
 
48
    ipcarg_t r0,r1;
-
 
49
 
44
    for (i = 0; i < count; i++)
50
    for (i = 0; i < count; i++)
45
        vfb_send_char((vfb_descriptor_t *) param, ((char *) buf)[i]);
51
        ipc_call_sync_2(console_phone, CONSOLE_PUTCHAR, 0, ((const char *)buf)[i], &r0, &r1);
46
   
52
   
47
    return count;
53
    return count;
48
    //return (ssize_t) __SYSCALL3(SYS_IO, 1, (sysarg_t) buf, (sysarg_t) count);
54
    //return (ssize_t) __SYSCALL3(SYS_IO, 1, (sysarg_t) buf, (sysarg_t) count);
49
}
55
}
50
 
56
 
51
 
57
 
52
static ssize_t write_stderr(void *param, const void *buf, size_t count)
-
 
53
{
-
 
54
    return count;
-
 
55
    //return (ssize_t) __SYSCALL3(SYS_IO, 1, (sysarg_t) buf, (sysarg_t) count);
-
 
56
}
-
 
57
 
-
 
58
 
58
 
59
stream_t open_vfb(void)
59
static stream_t open_stdin(void)
60
{
60
{
61
    stream_t stream;
61
    stream_t stream;
62
    vfb_descriptor_t *vfb;
-
 
63
    int phoneid;
62
    int phoneid;
64
    int res;
63
    int res;
65
    ipcarg_t vfb_no;
-
 
66
   
64
   
-
 
65
    if (console_phone < 0) {
67
    while ((phoneid = ipc_connect_me_to(PHONE_NS, SERVICE_VIDEO, 0)) < 0) {
66
        while ((console_phone = ipc_connect_me_to(PHONE_NS, SERVICE_CONSOLE, 0)) < 0) {
68
        volatile int a;
67
            volatile int a;
69
       
-
 
70
        for (a = 0; a < 1048576; a++);
68
            for (a = 0; a < 1048576; a++);
-
 
69
        }
71
    }
70
    }
72
   
71
   
73
    ipc_call_sync(phoneid, FB_GET_VFB, 0, &vfb_no);
72
    stream.r = read_stdin;
-
 
73
    stream.param = 0;
-
 
74
    return stream;
-
 
75
}
-
 
76
 
74
    vfb = malloc(sizeof(vfb_descriptor_t));
77
static stream_t open_stdout(void)
-
 
78
{
-
 
79
    stream_t stream;
-
 
80
    int res;
75
   
81
   
76
    vfb->phone = phoneid;
82
    if (console_phone < 0) {
-
 
83
        while ((console_phone = ipc_connect_me_to(PHONE_NS, SERVICE_CONSOLE, 0)) < 0) {
77
    vfb->vfb = vfb_no;
84
            volatile int a;
-
 
85
            for (a = 0; a < 1048576; a++);
-
 
86
        }
-
 
87
    }
78
   
88
   
79
    stream.w = write_vfb;
89
    stream.w = write_stdout;
80
    stream.param = vfb;
90
    stream.param = 0;
81
    return stream;
91
    return stream;
82
}
92
}
83
 
93
 
84
 
-
 
85
fd_t open(const char *fname, int flags)
94
fd_t open(const char *fname, int flags)
86
{
95
{
87
    int c = 0;
96
    int c = 0;
88
   
97
   
89
    while (((streams[c].w) || (streams[c].r)) && (c < FDS))
98
    while (((streams[c].w) || (streams[c].r)) && (c < FDS))
90
        c++;
99
        c++;
91
    if (c == FDS)
100
    if (c == FDS)
92
        return EMFILE;
101
        return EMFILE;
93
   
102
   
94
    if (!strcmp(fname, "stdin")) {
103
    if (!strcmp(fname, "stdin")) {
95
        streams[c].r = (preadfn_t)1;
104
        streams[c] = open_stdin();
96
        return c;
105
        return c;
97
    }
106
    }
98
   
107
   
99
    if (!strcmp(fname, "stdout")) {
108
    if (!strcmp(fname, "stdout")) {
100
        //streams[c].w = write_stdout;
109
        //streams[c].w = write_stdout;
101
        //return c;
110
        //return c;
102
        streams[c] = open_vfb();
111
        streams[c] = open_stdout();
103
        return c;
112
        return c;
104
    }
113
    }
105
   
114
   
106
    if (!strcmp(fname, "stderr")) {
115
    if (!strcmp(fname, "stderr")) {
107
        streams[c].w = write_stderr;
116
        streams[c].w = write_stderr;