Subversion Repositories HelenOS-historic

Rev

Rev 1363 | Rev 1451 | Go to most recent revision | Details | Compare with Previous | Last modification | View Log | RSS feed

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