From: David van Moolenbroek Date: Mon, 2 Sep 2013 23:59:20 +0000 (+0200) Subject: libaudiodriver: use libchardriver X-Git-Tag: v3.3.0~586 X-Git-Url: http://zhaoyanbai.com/repos/Bv9ARM.html?a=commitdiff_plain;h=refs%2Fchanges%2F69%2F969%2F2;p=minix.git libaudiodriver: use libchardriver Change-Id: I299d58d110ad14b69076276ba46c4325875c34ca --- diff --git a/drivers/audio/es1370/es1370.c b/drivers/audio/es1370/es1370.c index 9e2785987..c2c7cf3e9 100644 --- a/drivers/audio/es1370/es1370.c +++ b/drivers/audio/es1370/es1370.c @@ -286,7 +286,7 @@ int drv_stop(int sub_dev) /* all IO-ctl's sent to the upper driver are passed to this function */ -int drv_io_ctl(int request, void * val, int * len, int sub_dev) { +int drv_io_ctl(unsigned long request, void * val, int * len, int sub_dev) { int status; diff --git a/drivers/audio/es1371/es1371.c b/drivers/audio/es1371/es1371.c index 8830aa18a..ee51f8c7e 100644 --- a/drivers/audio/es1371/es1371.c +++ b/drivers/audio/es1371/es1371.c @@ -287,7 +287,7 @@ int drv_stop(int sub_dev) /* all IO-ctl's sent to the upper driver are passed to this function */ -int drv_io_ctl(int request, void * val, int * len, int sub_dev) { +int drv_io_ctl(unsigned long request, void * val, int * len, int sub_dev) { int status; diff --git a/drivers/audio/sb16/mixer.c b/drivers/audio/sb16/mixer.c index 4dbf5368d..4338dc3ff 100644 --- a/drivers/audio/sb16/mixer.c +++ b/drivers/audio/sb16/mixer.c @@ -14,7 +14,7 @@ static int get_set_output(struct inout_ctrl *output, int flag); /*=========================================================================* * mixer_ioctl *=========================================================================*/ -int mixer_ioctl(int request, void *val, int *UNUSED(len)) { +int mixer_ioctl(unsigned long request, void *val, int *UNUSED(len)) { int status; switch(request) { diff --git a/drivers/audio/sb16/mixer.h b/drivers/audio/sb16/mixer.h index 8cfe2c6b5..5d05fa5d6 100644 --- a/drivers/audio/sb16/mixer.h +++ b/drivers/audio/sb16/mixer.h @@ -2,7 +2,7 @@ #define SB16_MIXER_H int mixer_init(void); -int mixer_ioctl(int request, void *val, int *len); +int mixer_ioctl(unsigned long request, void *val, int *len); int mixer_set(int reg, int data); int mixer_get(int reg); diff --git a/drivers/audio/sb16/sb16.c b/drivers/audio/sb16/sb16.c index db7cd7f45..5ef1a1621 100644 --- a/drivers/audio/sb16/sb16.c +++ b/drivers/audio/sb16/sb16.c @@ -13,7 +13,7 @@ static void dsp_dma_setup(phys_bytes address, int count, int sub_dev); -static int dsp_ioctl(int request, void *val, int *len); +static int dsp_ioctl(unsigned long request, void *val, int *len); static int dsp_set_size(unsigned int size); static int dsp_set_speed(unsigned int speed); static int dsp_set_stereo(unsigned int stereo); @@ -141,7 +141,7 @@ int drv_start(int channel, int DmaMode) { dsp_set_speed(DspSpeed); /* Put the speaker on */ - if(DmaMode == DEV_WRITE_S) { + if(DmaMode == WRITE_DMA) { dsp_command (DSP_CMD_SPKON); /* put speaker on */ /* Program DSP with dma mode */ @@ -232,8 +232,9 @@ int drv_resume(int UNUSED(chan)) { -int drv_io_ctl(int request, void *val, int *len, int sub_dev) { - Dprint(("dsp_ioctl: got ioctl %d, argument: %d sub_dev: %d\n", request, val, sub_dev)); +int drv_io_ctl(unsigned long request, void *val, int *len, int sub_dev) { + Dprint(("dsp_ioctl: got ioctl %lu, argument: %d sub_dev: %d\n", + request, val, sub_dev)); if(sub_dev == AUDIO) { return dsp_ioctl(request, val, len); @@ -262,7 +263,7 @@ int drv_get_frag_size(u32_t *frag_size, int UNUSED(sub_dev)) { -static int dsp_ioctl(int request, void *val, int *len) { +static int dsp_ioctl(unsigned long request, void *val, int *len) { int status; switch(request) { @@ -293,7 +294,7 @@ static void dsp_dma_setup(phys_bytes address, int count, int DmaMode) { pv_set(pvb[1], DMA8_CLEAR, 0x00); /* Clear flip flop */ /* set DMA mode */ - pv_set(pvb[2], DMA8_MODE, (DmaMode == DEV_WRITE_S ? DMA8_AUTO_PLAY : DMA8_AUTO_REC)); + pv_set(pvb[2], DMA8_MODE, (DmaMode == WRITE_DMA ? DMA8_AUTO_PLAY : DMA8_AUTO_REC)); pv_set(pvb[3], DMA8_ADDR, (u8_t)(address >> 0)); /* Low_byte of address */ pv_set(pvb[4], DMA8_ADDR, (u8_t)(address >> 8)); /* High byte of address */ @@ -311,7 +312,7 @@ static void dsp_dma_setup(phys_bytes address, int count, int DmaMode) { pv_set(pvb[1], DMA16_CLEAR, 0x00); /* Clear flip flop */ /* Set dma mode */ - pv_set(pvb[2], DMA16_MODE, (DmaMode == DEV_WRITE_S ? DMA16_AUTO_PLAY : DMA16_AUTO_REC)); + pv_set(pvb[2], DMA16_MODE, (DmaMode == WRITE_DMA ? DMA16_AUTO_PLAY : DMA16_AUTO_REC)); pv_set(pvb[3], DMA16_ADDR, (address >> 1) & 0xFF); /* Low_byte of address */ pv_set(pvb[4], DMA16_ADDR, (address >> 9) & 0xFF); /* High byte of address */ diff --git a/include/minix/audio_fw.h b/include/minix/audio_fw.h index d31392868..324dbfe81 100644 --- a/include/minix/audio_fw.h +++ b/include/minix/audio_fw.h @@ -17,7 +17,7 @@ int drv_int_sum(void); int drv_int(int sub_dev); int drv_pause(int chan); int drv_resume(int chan); -int drv_io_ctl(int request, void * val, int * len, int sub_dev); +int drv_io_ctl(unsigned long request, void * val, int * len, int sub_dev); int drv_get_irq(char *irq); int drv_get_frag_size(u32_t *frag_size, int sub_dev); @@ -42,11 +42,9 @@ typedef struct { int BufFillNext; /* end of extra circular buffer */ int BufLength; int RevivePending; /* process waiting for this dev? */ - int ReviveStatus; /* return val when proc unblocked */ endpoint_t ReviveProcNr; /* the process to unblock */ + cdev_id_t ReviveId; /* request ID */ cp_grant_id_t ReviveGrant; /* grant id associated with io */ - void *UserBuf; /* address of user's data buffer */ - int ReadyToRevive; /* are we ready to revive process?*/ endpoint_t SourceProcNr; /* process to send notify to (FS) */ u32_t FragSize; /* dma fragment size */ char *DmaBuf; /* the dma buffer; extra space for @@ -82,9 +80,8 @@ EXTERN special_file_t special_file[]; #define NO_CHANNEL -1 -#define TRUE 1 -#define FALSE 0 #define NO_DMA 0 - +#define READ_DMA 1 +#define WRITE_DMA 2 #endif /* AUDIO_FW_H */ diff --git a/lib/libaudiodriver/audio_fw.c b/lib/libaudiodriver/audio_fw.c index 13a1bde5f..7dfe03046 100644 --- a/lib/libaudiodriver/audio_fw.c +++ b/lib/libaudiodriver/audio_fw.c @@ -43,14 +43,16 @@ #include -static int msg_open(int minor_dev_nr); +static int msg_open(devminor_t minor_dev_nr, int access, + endpoint_t user_endpt); static int msg_close(int minor_dev_nr); -static int msg_ioctl(const message *m_ptr); -static void msg_write(const message *m_ptr); -static void msg_read(message *m_ptr); -static void msg_hardware(void); -static void msg_status(message *m_ptr); -static int init_driver(void); +static ssize_t msg_read(devminor_t minor, u64_t position, endpoint_t endpt, + cp_grant_id_t grant, size_t size, int flags, cdev_id_t id); +static ssize_t msg_write(devminor_t minor, u64_t position, endpoint_t endpt, + cp_grant_id_t grant, size_t size, int flags, cdev_id_t id); +static int msg_ioctl(devminor_t minor, unsigned long request, endpoint_t endpt, + cp_grant_id_t grant, int flags, endpoint_t user_endpt, cdev_id_t id); +static void msg_hardware(unsigned int mask); static int open_sub_dev(int sub_dev_nr, int operation); static int close_sub_dev(int sub_dev_nr); static void handle_int_write(int sub_dev_nr); @@ -59,7 +61,6 @@ static void data_to_user(sub_dev_t *sub_dev_ptr); static void data_from_user(sub_dev_t *sub_dev_ptr); static int init_buffers(sub_dev_t *sub_dev_ptr); static int get_started(sub_dev_t *sub_dev_ptr); -static void reply(int code, int replyee, int process,int status); static int io_ctl_length(int io_request); static special_file_t* get_special_file(int minor_dev_nr); static void tell_dev(vir_bytes buf, size_t size, int pci_bus, int @@ -68,7 +69,6 @@ static void tell_dev(vir_bytes buf, size_t size, int pci_bus, int static char io_ctl_buf[_IOCPARM_MASK]; static int irq_hook_id = 0; /* id of irq hook at the kernel */ static int irq_hook_set = FALSE; -static int device_available = 0;/*todo*/ /* SEF functions and variables. */ static void sef_local_startup(void); @@ -78,6 +78,15 @@ EXTERN int sef_cb_lu_prepare(int state); EXTERN int sef_cb_lu_state_isvalid(int state); EXTERN void sef_cb_lu_state_dump(int state); +static struct chardriver audio_tab = { + .cdr_open = msg_open, /* open the special file */ + .cdr_close = msg_close, /* close the special file */ + .cdr_read = msg_read, + .cdr_write = msg_write, + .cdr_ioctl = msg_ioctl, + .cdr_intr = msg_hardware +}; + int main(void) { int r, caller; @@ -89,91 +98,9 @@ int main(void) /* Here is the main loop of the dma driver. It waits for a message, carries it out, and sends a reply. */ + chardriver_task(&audio_tab); - while(1) { - if(driver_receive(ANY, &mess, &ipc_status) != OK) { - panic("driver_receive failed"); - } - caller = mess.m_source; - - /* Now carry out the work. First check for notifications. */ - if (is_ipc_notify(ipc_status)) { - switch (_ENDPOINT_P(mess.m_source)) { - case HARDWARE: - msg_hardware(); - break; - default: - printf("%s: %d uncaught notify!\n", - drv.DriverName, mess.m_type); - } - - /* get next message */ - continue; - } - - /* Normal messages. */ - switch(mess.m_type) { - case DEV_OPEN: - /* open the special file ( = parameter) */ - r = msg_open(mess.DEVICE); - repl_mess.m_type = DEV_OPEN_REPL; - repl_mess.REP_ENDPT = mess.USER_ENDPT; - repl_mess.REP_IO_GRANT = - (cp_grant_id_t) mess.IO_GRANT; - repl_mess.REP_STATUS = r; - send(caller, &repl_mess); - - continue; - - case DEV_CLOSE: - /* close the special file ( = parameter) */ - r = msg_close(mess.DEVICE); - repl_mess.m_type = DEV_CLOSE_REPL; - repl_mess.REP_ENDPT = mess.USER_ENDPT; - repl_mess.REP_IO_GRANT = - (cp_grant_id_t) mess.IO_GRANT; - repl_mess.REP_STATUS = r; - send(caller, &repl_mess); - - continue; - - case DEV_IOCTL_S: - r = msg_ioctl(&mess); - - if (r != SUSPEND) - { - repl_mess.m_type = DEV_REVIVE; - repl_mess.REP_ENDPT = mess.USER_ENDPT; - repl_mess.REP_IO_GRANT = - (cp_grant_id_t) mess.IO_GRANT; - repl_mess.REP_STATUS = r; - send(caller, &repl_mess); - } - continue; - - case DEV_READ_S: - msg_read(&mess); continue; /* don't reply */ - case DEV_WRITE_S: - msg_write(&mess); continue; /* don't reply */ - case DEV_REOPEN: - /* reopen the special file ( = parameter) */ - r = msg_open(mess.DEVICE); - repl_mess.m_type = DEV_REOPEN_REPL; - repl_mess.REP_ENDPT = mess.USER_ENDPT; - repl_mess.REP_IO_GRANT = - (cp_grant_id_t) mess.IO_GRANT; - repl_mess.REP_STATUS = r; - send(caller, &repl_mess); - continue; - default: - printf("%s: %d uncaught msg!\n", - drv.DriverName, mess.m_type); - continue; - } - - /* Should not be here. Just continue. */ - } - return 1; + return 0; } /*===========================================================================* @@ -204,10 +131,6 @@ static void sef_local_startup() static int sef_cb_init_fresh(int UNUSED(type), sef_init_info_t *UNUSED(info)) { /* Initialize the audio driver framework. */ - return init_driver(); -} - -static int init_driver(void) { u32_t i; char irq; static int executed = 0; sub_dev_t* sub_dev_ptr; @@ -294,7 +217,9 @@ static void sef_cb_signal_handler(int signo) } } -static int msg_open (int minor_dev_nr) { +static int msg_open(devminor_t minor_dev_nr, int UNUSED(access), + endpoint_t UNUSED(user_endpt)) +{ int r, read_chan, write_chan, io_ctl; special_file_t* special_file_ptr; @@ -317,22 +242,13 @@ static int msg_open (int minor_dev_nr) { drv.DriverName, minor_dev_nr); return EIO; } - /* init driver */ - if (!device_available) { - if (init_driver() != OK) { - printf("%s: Couldn't init driver!\n", drv.DriverName); - return EIO; - } else { - device_available = TRUE; - } - } /* open the sub devices specified in the interface header file */ if (write_chan != NO_CHANNEL) { /* open sub device for writing */ - if (open_sub_dev(write_chan, DEV_WRITE_S) != OK) return EIO; + if (open_sub_dev(write_chan, WRITE_DMA) != OK) return EIO; } if (read_chan != NO_CHANNEL) { - if (open_sub_dev(read_chan, DEV_READ_S) != OK) return EIO; + if (open_sub_dev(read_chan, READ_DMA) != OK) return EIO; } if (read_chan == io_ctl || write_chan == io_ctl) { /* io_ctl is already opened because it's the same as read or write */ @@ -382,7 +298,8 @@ static int open_sub_dev(int sub_dev_nr, int dma_mode) { } -static int msg_close(int minor_dev_nr) { +static int msg_close(devminor_t minor_dev_nr) +{ int r, read_chan, write_chan, io_ctl; special_file_t* special_file_ptr; @@ -421,7 +338,7 @@ static int close_sub_dev(int sub_dev_nr) { size_t size; sub_dev_t *sub_dev_ptr; sub_dev_ptr = &sub_dev[sub_dev_nr]; - if (sub_dev_ptr->DmaMode == DEV_WRITE_S && !sub_dev_ptr->OutOfData) { + if (sub_dev_ptr->DmaMode == WRITE_DMA && !sub_dev_ptr->OutOfData) { /* do nothing, still data in buffers that has to be transferred */ sub_dev_ptr->Opened = FALSE; /* keep DMA busy */ return OK; @@ -443,13 +360,14 @@ static int close_sub_dev(int sub_dev_nr) { } -static int msg_ioctl(const message *m_ptr) +static int msg_ioctl(devminor_t minor, unsigned long request, endpoint_t endpt, + cp_grant_id_t grant, int flags, endpoint_t user_endpt, cdev_id_t id) { int status, len, chan; sub_dev_t *sub_dev_ptr; special_file_t* special_file_ptr; - special_file_ptr = get_special_file(m_ptr->DEVICE); + special_file_ptr = get_special_file(minor); if(special_file_ptr == NULL) { return EIO; } @@ -468,34 +386,24 @@ static int msg_ioctl(const message *m_ptr) return EIO; } + if (request & _IOC_IN) { /* if there is data for us, copy it */ + len = io_ctl_length(request); - /* this is a hack...todo: may we intercept reset calls? */ - /* - if(m_ptr->REQUEST == DSPIORESET) { - device_available = FALSE; - } - */ - - - if (m_ptr->REQUEST & _IOC_IN) { /* if there is data for us, copy it */ - len = io_ctl_length(m_ptr->REQUEST); - - if(sys_safecopyfrom(m_ptr->m_source, - (vir_bytes)m_ptr->ADDRESS, 0, - (vir_bytes)io_ctl_buf, len) != OK) { + if (sys_safecopyfrom(endpt, grant, 0, (vir_bytes)io_ctl_buf, + len) != OK) { printf("%s:%d: safecopyfrom failed\n", __FILE__, __LINE__); } } /* all ioctl's are passed to the device specific part of the driver */ - status = drv_io_ctl(m_ptr->REQUEST, (void *)io_ctl_buf, &len, chan); + status = drv_io_ctl(request, (void *)io_ctl_buf, &len, chan); /* _IOC_OUT bit -> user expects data */ - if (status == OK && m_ptr->REQUEST & _IOC_OUT) { + if (status == OK && request & _IOC_OUT) { /* copy result back to user */ - if(sys_safecopyto(m_ptr->m_source, (vir_bytes)m_ptr->ADDRESS, 0, - (vir_bytes)io_ctl_buf, len) != OK) { + if (sys_safecopyto(endpt, grant, 0, (vir_bytes)io_ctl_buf, + len) != OK) { printf("%s:%d: safecopyto failed\n", __FILE__, __LINE__); } @@ -504,18 +412,19 @@ static int msg_ioctl(const message *m_ptr) } -static void msg_write(const message *m_ptr) +static ssize_t msg_write(devminor_t minor, u64_t UNUSED(position), + endpoint_t endpt, cp_grant_id_t grant, size_t size, int UNUSED(flags), + cdev_id_t id) { int chan; sub_dev_t *sub_dev_ptr; special_file_t* special_file_ptr; - special_file_ptr = get_special_file(m_ptr->DEVICE); + special_file_ptr = get_special_file(minor); chan = special_file_ptr->write_chan; if (chan == NO_CHANNEL) { printf("%s: No write channel specified!\n", drv.DriverName); - reply(DEV_REVIVE, m_ptr->m_source, m_ptr->USER_ENDPT, EIO); - return; + return EIO; } /* get pointer to sub device data */ sub_dev_ptr = &sub_dev[chan]; @@ -523,47 +432,49 @@ static void msg_write(const message *m_ptr) if (!sub_dev_ptr->DmaBusy) { /* get fragment size on first write */ if (drv_get_frag_size(&(sub_dev_ptr->FragSize), sub_dev_ptr->Nr) != OK){ printf("%s; Failed to get fragment size!\n", drv.DriverName); - return; + return EIO; } } - if(m_ptr->COUNT != sub_dev_ptr->FragSize) { + if(size != sub_dev_ptr->FragSize) { printf("Fragment size does not match user's buffer length\n"); - reply(DEV_REVIVE, m_ptr->m_source, m_ptr->USER_ENDPT, EINVAL); - return; + return EINVAL; } /* if we are busy with something else than writing, return EBUSY */ - if(sub_dev_ptr->DmaBusy && sub_dev_ptr->DmaMode != DEV_WRITE_S) { - printf("Already busy with something else then writing\n"); - reply(DEV_REVIVE, m_ptr->m_source, m_ptr->USER_ENDPT, EBUSY); - return; + if(sub_dev_ptr->DmaBusy && sub_dev_ptr->DmaMode != WRITE_DMA) { + printf("Already busy with something else than writing\n"); + return EBUSY; } sub_dev_ptr->RevivePending = TRUE; - sub_dev_ptr->ReviveProcNr = m_ptr->USER_ENDPT; - sub_dev_ptr->ReviveGrant = (cp_grant_id_t) m_ptr->ADDRESS; - sub_dev_ptr->SourceProcNr = m_ptr->m_source; + sub_dev_ptr->ReviveId = id; + sub_dev_ptr->ReviveGrant = grant; + sub_dev_ptr->SourceProcNr = endpt; data_from_user(sub_dev_ptr); if(!sub_dev_ptr->DmaBusy) { /* Dma tranfer not yet started */ get_started(sub_dev_ptr); - sub_dev_ptr->DmaMode = DEV_WRITE_S; /* Dma mode is writing */ - } + sub_dev_ptr->DmaMode = WRITE_DMA; /* Dma mode is writing */ + } + + /* We may already have replied by now. In any case don't reply here. */ + return EDONTREPLY; } -static void msg_read(message *m_ptr) +static ssize_t msg_read(devminor_t minor, u64_t UNUSED(position), + endpoint_t endpt, cp_grant_id_t grant, size_t size, int UNUSED(flags), + cdev_id_t id) { int chan; sub_dev_t *sub_dev_ptr; special_file_t* special_file_ptr; - special_file_ptr = get_special_file(m_ptr->DEVICE); + special_file_ptr = get_special_file(minor); chan = special_file_ptr->read_chan; if (chan == NO_CHANNEL) { printf("%s: No read channel specified!\n", drv.DriverName); - reply(DEV_REVIVE, m_ptr->m_source, m_ptr->USER_ENDPT, EIO); - return; + return EIO; } /* get pointer to sub device data */ sub_dev_ptr = &sub_dev[chan]; @@ -571,39 +482,39 @@ static void msg_read(message *m_ptr) if (!sub_dev_ptr->DmaBusy) { /* get fragment size on first read */ if (drv_get_frag_size(&(sub_dev_ptr->FragSize), sub_dev_ptr->Nr) != OK){ printf("%s: Could not retrieve fragment size!\n", drv.DriverName); - reply(DEV_REVIVE, m_ptr->m_source, m_ptr->USER_ENDPT, - EIO); - return; + return EIO; } } - if(m_ptr->COUNT != sub_dev_ptr->FragSize) { - reply(DEV_REVIVE, m_ptr->m_source, m_ptr->USER_ENDPT, EINVAL); + if(size != sub_dev_ptr->FragSize) { printf("fragment size does not match message size\n"); - return; + return EINVAL; } /* if we are busy with something else than reading, reply EBUSY */ - if(sub_dev_ptr->DmaBusy && sub_dev_ptr->DmaMode != DEV_READ_S) { - reply(DEV_REVIVE, m_ptr->m_source, m_ptr->USER_ENDPT, EBUSY); - return; + if(sub_dev_ptr->DmaBusy && sub_dev_ptr->DmaMode != READ_DMA) { + return EBUSY; } sub_dev_ptr->RevivePending = TRUE; - sub_dev_ptr->ReviveProcNr = m_ptr->USER_ENDPT; - sub_dev_ptr->ReviveGrant = (cp_grant_id_t) m_ptr->ADDRESS; - sub_dev_ptr->SourceProcNr = m_ptr->m_source; + sub_dev_ptr->ReviveId = id; + sub_dev_ptr->ReviveGrant = grant; + sub_dev_ptr->SourceProcNr = endpt; if(!sub_dev_ptr->DmaBusy) { /* Dma tranfer not yet started */ get_started(sub_dev_ptr); - sub_dev_ptr->DmaMode = DEV_READ_S; /* Dma mode is reading */ - return; /* no need to get data from DMA buffer at this point */ + sub_dev_ptr->DmaMode = READ_DMA; /* Dma mode is reading */ + /* no need to get data from DMA buffer at this point */ + return EDONTREPLY; } /* check if data is available and possibly fill user's buffer */ data_to_user(sub_dev_ptr); -} + /* We may already have replied by now. In any case don't reply here. */ + return EDONTREPLY; +} -static void msg_hardware(void) { +static void msg_hardware(unsigned int UNUSED(mask)) +{ u32_t i; /* loop over all sub devices */ @@ -611,8 +522,10 @@ static void msg_hardware(void) { /* if interrupt from sub device and Dma transfer was actually busy, take care of business */ if( drv_int(i) && sub_dev[i].DmaBusy ) { - if (sub_dev[i].DmaMode == DEV_WRITE_S) handle_int_write(i); - if (sub_dev[i].DmaMode == DEV_READ_S) handle_int_read(i); + if (sub_dev[i].DmaMode == WRITE_DMA) + handle_int_write(i); + if (sub_dev[i].DmaMode == READ_DMA) + handle_int_read(i); } } @@ -625,7 +538,7 @@ static void msg_hardware(void) { } -/* handle interrupt for specified sub device; DmaMode == DEV_WRITE_S*/ +/* handle interrupt for specified sub device; DmaMode == WRITE_DMA */ static void handle_int_write(int sub_dev_nr) { sub_dev_t *sub_dev_ptr; @@ -678,7 +591,7 @@ static void handle_int_write(int sub_dev_nr) } -/* handle interrupt for specified sub device; DmaMode == DEV_READ_S */ +/* handle interrupt for specified sub device; DmaMode == READ_DMA */ static void handle_int_read(int sub_dev_nr) { sub_dev_t *sub_dev_ptr; @@ -700,14 +613,9 @@ static void handle_int_read(int sub_dev_nr) printf("All buffers full, we have a problem.\n"); drv_stop(sub_dev_nr); /* stop the sub device */ sub_dev_ptr->DmaBusy = FALSE; - sub_dev_ptr->ReviveStatus = 0; /* no data for user, - * this is a sad story - */ - m.m_type = DEV_REVIVE; - m.REP_ENDPT = sub_dev_ptr->ReviveProcNr; - m.REP_IO_GRANT = sub_dev_ptr->ReviveGrant; - m.REP_STATUS = sub_dev_ptr->ReviveStatus; - send(sub_dev_ptr->SourceProcNr, &m); + /* no data for user, this is a sad story */ + chardriver_reply_task(sub_dev_ptr->SourceProcNr, + sub_dev_ptr->ReviveId, 0); return; } else { /* dma full, still room in extra buf; @@ -807,18 +715,8 @@ static void data_from_user(sub_dev_t *subdev) drv_resume(subdev->Nr); /* resume resume the sub device */ } - subdev->ReviveStatus = subdev->FragSize; - - m.m_type = DEV_REVIVE; /* build message */ - m.REP_ENDPT = subdev->ReviveProcNr; - m.REP_IO_GRANT = subdev->ReviveGrant; - m.REP_STATUS = subdev->ReviveStatus; - r= send(subdev->SourceProcNr, &m); /* send the message */ - if (r != OK) - { - printf("audio_fw: send to %d failed: %d\n", - subdev->SourceProcNr, r); - } + chardriver_reply_task(subdev->SourceProcNr, subdev->ReviveId, + subdev->FragSize); /* reset variables */ subdev->RevivePending = 0; @@ -865,19 +763,8 @@ static void data_to_user(sub_dev_t *sub_dev_ptr) sub_dev_ptr->DmaLength -= 1; } - sub_dev_ptr->ReviveStatus = sub_dev_ptr->FragSize; - /* drv_status will send REVIVE mess to FS*/ - - m.m_type = DEV_REVIVE; /* build message */ - m.REP_ENDPT = sub_dev_ptr->ReviveProcNr; - m.REP_IO_GRANT = sub_dev_ptr->ReviveGrant; - m.REP_STATUS = sub_dev_ptr->ReviveStatus; - r= send(sub_dev_ptr->SourceProcNr, &m); /* send the message */ - if (r != OK) - { - printf("audio_fw: send to %d failed: %d\n", - sub_dev_ptr->SourceProcNr, r); - } + chardriver_reply_task(sub_dev_ptr->SourceProcNr, sub_dev_ptr->ReviveId, + sub_dev_ptr->FragSize); /* reset variables */ sub_dev_ptr->RevivePending = 0; @@ -940,16 +827,6 @@ static int init_buffers(sub_dev_t *sub_dev_ptr) } -static void reply(int code, int replyee, int process, int status) { - message m; - - m.m_type = code; /* DEV_REVIVE */ - m.REP_STATUS = status; /* result of device operation */ - m.REP_ENDPT = process; /* which user made the request */ - send(replyee, &m); -} - - static int io_ctl_length(int io_request) { io_request >>= 16; return io_request & _IOCPARM_MASK; diff --git a/lib/libaudiodriver/liveupdate.c b/lib/libaudiodriver/liveupdate.c index 19364c1b3..000da3672 100644 --- a/lib/libaudiodriver/liveupdate.c +++ b/lib/libaudiodriver/liveupdate.c @@ -21,10 +21,10 @@ static void load_state_info(void) if(sub_dev[i].RevivePending) { dma_mode = sub_dev[i].DmaMode; - if(dma_mode == DEV_READ_S) { + if(dma_mode == READ_DMA) { is_read_pending = TRUE; } - else if (dma_mode == DEV_WRITE_S){ + else if (dma_mode == WRITE_DMA){ is_write_pending = TRUE; } }