| 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; |
| } |
| |
| |