10,22 → 10,20 |
|
#define FDS 32 |
|
typedef struct stream_t |
{ |
typedef struct stream_t { |
pwritefn_t w; |
preadfn_t r; |
void * param; |
}stream_t; |
} stream_t; |
|
|
typedef struct vfb_descriptor_t |
{ |
typedef struct vfb_descriptor_t { |
int phone; |
int vfb; |
}vfb_descriptor_t; |
} vfb_descriptor_t; |
|
|
stream_t streams[FDS]={{0,0,0}}; |
stream_t streams[FDS] = {{0, 0, 0}}; |
|
/* |
ssize_t write_stdout(void *param, const void * buf, size_t count); |
34,16 → 32,17 |
return (ssize_t) __SYSCALL3(SYS_IO, 1, (sysarg_t) buf, (sysarg_t) count); |
}*/ |
|
static void vfb_send_char(vfb_descriptor_t *d,char c) |
static void vfb_send_char(vfb_descriptor_t *d, char c) |
{ |
ipcarg_t r0,r1; |
ipc_call_sync_2(d->phone,FB_PUTCHAR,d->vfb,c,&r0,&r1); |
ipc_call_sync_2(d->phone, FB_PUTCHAR, d->vfb, c, &r0, &r1); |
} |
|
static ssize_t write_vfb(void *param, const void * buf, size_t count) |
static ssize_t write_vfb(void *param, const void *buf, size_t count) |
{ |
int i; |
for(i=0;i<count;i++) vfb_send_char((vfb_descriptor_t *)param,((char*)buf)[i]); |
for (i = 0; i < count; i++) |
vfb_send_char((vfb_descriptor_t *) param, ((char *) buf)[i]); |
|
return count; |
//return (ssize_t) __SYSCALL3(SYS_IO, 1, (sysarg_t) buf, (sysarg_t) count); |
50,7 → 49,7 |
} |
|
|
static ssize_t write_stderr(void *param, const void * buf, size_t count) |
static ssize_t write_stderr(void *param, const void *buf, size_t count) |
{ |
return count; |
//return (ssize_t) __SYSCALL3(SYS_IO, 1, (sysarg_t) buf, (sysarg_t) count); |
57,7 → 56,6 |
} |
|
|
stream_t open_vfb(void); |
stream_t open_vfb(void) |
{ |
stream_t stream; |
66,58 → 64,56 |
int res; |
ipcarg_t vfb_no; |
|
while((phoneid=ipc_connect_me_to(PHONE_NS,SERVICE_VIDEO,0))<0) |
{ |
while ((phoneid = ipc_connect_me_to(PHONE_NS, SERVICE_VIDEO, 0)) < 0) { |
volatile int a; |
for(a=0;a<1048576;a++); |
|
for (a = 0; a < 1048576; a++); |
} |
|
ipc_call_sync(phoneid,FB_GET_VFB,0,&vfb_no); |
vfb=malloc(sizeof(vfb_descriptor_t)); |
ipc_call_sync(phoneid, FB_GET_VFB, 0, &vfb_no); |
vfb = malloc(sizeof(vfb_descriptor_t)); |
|
vfb->phone=phoneid; |
vfb->vfb=vfb_no; |
vfb->phone = phoneid; |
vfb->vfb = vfb_no; |
|
|
stream.w=write_vfb; |
stream.param=vfb; |
stream.w = write_vfb; |
stream.param = vfb; |
return stream; |
} |
|
|
fd_t open(const char *fname,int flags) |
fd_t open(const char *fname, int flags) |
{ |
int c=0; |
while(((streams[c].w)||(streams[c].r))&&(c<FDS))c++; |
if(c==FDS) return EMFILE; |
|
|
if(!strcmp(fname,"stdin")) |
{ |
streams[c].r=(preadfn_t)1; |
int c = 0; |
|
while (((streams[c].w) || (streams[c].r)) && (c < FDS)) |
c++; |
if (c == FDS) |
return EMFILE; |
|
if (!strcmp(fname, "stdin")) { |
streams[c].r = (preadfn_t)1; |
return c; |
} |
|
if(!strcmp(fname,"stdout")) |
{ |
//streams[c].w=write_stdout; |
if (!strcmp(fname, "stdout")) { |
//streams[c].w = write_stdout; |
//return c; |
streams[c]=open_vfb(); |
streams[c] = open_vfb(); |
return c; |
} |
|
if(!strcmp(fname,"stderr")) |
{ |
streams[c].w=write_stderr; |
if (!strcmp(fname, "stderr")) { |
streams[c].w = write_stderr; |
return c; |
} |
} |
|
|
ssize_t write(int fd, const void * buf, size_t count) |
ssize_t write(int fd, const void *buf, size_t count) |
{ |
if(fd<FDS) return streams[fd].w(streams[fd].param,buf,count); |
if (fd < FDS) |
return streams[fd].w(streams[fd].param, buf, count); |
|
return 0; |
} |
|
|