/*
* Request completion wait
*/
SYSCALL ID tk_wai_dev_impl( ID dd, ID reqid, W *asize, ER *ioer, TMO tmout )
{
WAIFN waitfn;
VP exinf;
#if TA_GP
VP gp;
#endif
OpnCB *opncb;
DevCB *devcb;
ReqCB *reqcb;
T_DEVREQ *devreq;
INT reqno, nreq;
ID tskid;
ER ercd;
tskid = tk_get_tid_impl();
LockDM();
ercd = knl_check_devdesc(dd, 0, &opncb);
if ( ercd < E_OK ) {
goto err_ret2;
}
devcb = opncb->devcb;
waitfn = (WAIFN)devcb->ddev.waitfn;
exinf = devcb->ddev.exinf;
#if TA_GP
gp = devcb->ddev.gp;
#endif
if ( reqid == 0 ) {
/* When waiting for completion of any of requests for 'dd' */
if ( opncb->nwaireq > 0 || opncb->waitone > 0 ) {
ercd = E_OBJ;
goto err_ret2;
}
if ( isQueEmpty(&opncb->requestq) ) {
ercd = E_NOEXS;
goto err_ret2;
}
/* Create wait request list */
reqcb = (ReqCB*)opncb->requestq.next;
for ( nreq = 1;; nreq++ ) {
reqcb->tskid = tskid;
devreq = &reqcb->req;
reqcb = (ReqCB*)reqcb->q.next;
if ( reqcb == (ReqCB*)&opncb->requestq ) {
break;
}
devreq->next = &reqcb->req;
}
devreq->next = NULL;
devreq = &((ReqCB*)opncb->requestq.next)->req;
opncb->waireqlst = devreq;
opncb->nwaireq = nreq;
} else {
/* Wait for completion of abort request processing */
reqcb = knl_check_reqid(reqid, opncb);
if ( reqcb == NULL ) {
ercd = E_ID;
goto err_ret2;
}
if ( opncb->nwaireq > 0 || reqcb->tskid > 0 ) {
ercd = E_OBJ;
goto err_ret2;
}
/* Create waiting request list */
reqcb->tskid = tskid;
devreq = &reqcb->req;
devreq->next = NULL;
nreq = 1;
opncb->waitone++;
}
UnlockDM();
/* Device driver call */
DISABLE_INTERRUPT;
knl_ctxtsk->sysmode++;
ENABLE_INTERRUPT;
#if TA_GP
reqno = CallDeviceDriver(devreq, nreq, tmout, exinf, (FP)waitfn, gp);
#else
reqno = (*waitfn)(devreq, nreq, tmout, exinf);
#endif
DISABLE_INTERRUPT;
knl_ctxtsk->sysmode--;
ENABLE_INTERRUPT;
if ( reqno < E_OK ) {
ercd = reqno;
}
if ( reqno >= nreq ) {
ercd = E_SYS;
}
LockDM();
/* Free wait processing */
if ( reqid == 0 ) {
opncb->nwaireq = 0;
} else {
opncb->waitone--;
}
/* If there is an abort completion wait task,
notify abort completion */
if ( opncb->abort_tskid > 0 && --opncb->abort_cnt == 0 ) {
tk_sig_sem_impl(opncb->abort_semid, 1);
}
/* Get processing result */
while ( devreq != NULL ) {
reqcb = DEVREQ_REQCB(devreq);
if ( reqno-- == 0 ) {
reqid = REQID(reqcb);
*asize = devreq->asize;
*ioer = devreq->error;
}
reqcb->tskid = 0;
devreq = devreq->next;
}
if ( ercd < E_OK ) {
goto err_ret2;
}
/* Unregister completed request */
knl_delReqCB(REQCB(reqid));
UnlockDM();
return reqid;
err_ret2:
UnlockDM();
DEBUG_PRINT(("tk_wai_dev_impl ercd = %d\n", ercd));
return ercd;
}
/*
* wait for I/O completion for a device
*/
LOCAL ID waitcomplete( ID dd, ID reqid, W *asize, ER *ioer,
TMO_U tmout, enum ReqType syncreq )
{
ATR drvatr;
OpnCB *opncb;
DevCB *devcb;
ReqCB *reqcb;
DEVREQ *devreq;
INT reqno, nreq;
ID tskid;
BOOL abort;
ER ercd;
tskid = tk_get_tid();
LockDM();
ercd = check_devdesc(dd, 0, &opncb);
if ( ercd < E_OK ) {
goto err_ret1;
}
/* Check whether there is a break request */
abort = FALSE;
ercd = check_break();
if ( ercd < E_OK ) {
if ( syncreq == AsyncReq ) goto err_ret1;
abort = TRUE;
}
devcb = opncb->devcb;
drvatr = devcb->ddev.drvatr;
if ( reqid == 0 ) {
/* When waiting for completion of any of requests for 'dd' */
if ( opncb->nwaireq > 0 || opncb->waitone > 0
|| opncb->syncreq > 0 ) {
ercd = E_OBJ;
goto err_ret1;
}
if ( isQueEmpty(&opncb->requestq) ) {
ercd = E_NOEXS;
goto err_ret1;
}
/* Create wait request list */
reqcb = (ReqCB*)opncb->requestq.next;
for ( nreq = 1;; nreq++ ) {
reqcb->tskid = tskid;
devreq = &reqcb->req;
reqcb = (ReqCB*)reqcb->q.next;
if ( reqcb == (ReqCB*)&opncb->requestq ) {
break;
}
devreq->c.next = &reqcb->req;
}
devreq->c.next = NULL;
devreq = &((ReqCB*)opncb->requestq.next)->req;
opncb->waireqlst = devreq;
opncb->nwaireq = nreq;
} else {
/* Wait for completion of abort request processing */
reqcb = check_reqid(reqid, opncb);
if ( reqcb == NULL ) {
ercd = E_ID;
goto err_ret1;
}
if ( opncb->nwaireq > 0 || reqcb->tskid > 0 ) {
ercd = E_OBJ;
goto err_ret1;
}
/* Create waiting request list */
reqcb->tskid = tskid;
devreq = &reqcb->req;
devreq->c.next = NULL;
if ( abort ) devreq->c.abort = TRUE;
nreq = 1;
opncb->waitone++;
}
/* Device driver call */
UnlockDM();
reqno = call_waitfn(devcb, devreq, nreq, tmout);
LockDM();
if ( reqno < E_OK ) {
ercd = reqno;
} else if ( reqno >= nreq ) {
ercd = E_SYS;
}
LockDAbort();
/* Free wait processing */
if ( reqid == 0 ) {
opncb->nwaireq = 0;
} else {
opncb->waitone--;
}
/* If there is an abort completion wait task,
notify abort completion */
if ( opncb->abort_tskid > 0 && --opncb->abort_cnt == 0 ) {
SyncSignalDM(opncb->abort_tskid);
}
/* Get processing result */
while ( devreq != NULL ) {
reqcb = DEVREQ_REQCB(devreq);
if ( reqno-- == 0 ) {
reqid = REQID(reqcb);
if ( (drvatr & TDA_DEV_D) == 0 ) {
*asize = devreq->s.asize;
*ioer = devreq->s.error;
} else {
*asize = devreq->l.asize;
*ioer = devreq->l.error;
}
}
reqcb->tskid = 0;
devreq = devreq->c.next;
}
UnlockDAbort();
if ( ercd < E_OK ) {
goto err_ret1;
}
if ( syncreq == SyncReq ) {
opncb->syncreq--;
}
/* Unregister completed request */
delReqCB(REQCB(reqid));
UnlockDM();
return reqid;
err_ret1:
if ( syncreq == SyncReq ) {
opncb->syncreq--;
}
UnlockDM();
DEBUG_PRINT(("waitcomplete ercd = %d\n", ercd));
return ercd;
}
/*
* Request for starting input/output to device
*/
EXPORT ID knl_request( ID dd, W start, VP buf, W size, TMO tmout, INT cmd )
{
EXCFN execfn;
VP exinf;
#if TA_GP
VP gp;
#endif
OpnCB *opncb;
DevCB *devcb;
ReqCB *reqcb;
UINT m;
ER ercd;
LockDM();
if ( start <= -0x00010000 && start >= -0x7fffffff ) {
m = 0; /* Ignore open mode */
} else {
m = ( cmd == TDC_READ )? TD_READ: TD_WRITE;
}
ercd = knl_check_devdesc(dd, m, &opncb);
if ( ercd < E_OK ) {
goto err_ret1;
}
devcb = opncb->devcb;
execfn = (EXCFN)devcb->ddev.execfn;
exinf = devcb->ddev.exinf;
#if TA_GP
gp = devcb->ddev.gp;
#endif
/* Get request management block */
reqcb = newReqCB(opncb);
if ( reqcb == NULL ) {
ercd = E_LIMIT;
goto err_ret1;
}
/* Set request packet */
reqcb->req.next = NULL;
reqcb->req.exinf = NULL;
reqcb->req.devid = DEVID(devcb, opncb->unitno);
reqcb->req.cmd = cmd;
reqcb->req.abort = FALSE;
reqcb->req.start = start;
reqcb->req.size = size;
reqcb->req.buf = buf;
reqcb->req.asize = 0;
reqcb->req.error = 0;
/* Indicate that it is during processing */
reqcb->tskid = tk_get_tid_impl();
UnlockDM();
/* Device driver call */
DISABLE_INTERRUPT;
knl_ctxtsk->sysmode++;
ENABLE_INTERRUPT;
#if TA_GP
ercd = CallDeviceDriver(&reqcb->req, tmout, exinf, 0, (FP)execfn, gp);
#else
ercd = (*execfn)(&reqcb->req, tmout, exinf);
#endif
DISABLE_INTERRUPT;
knl_ctxtsk->sysmode--;
ENABLE_INTERRUPT;
LockDM();
/* Indicate that it is not during processing */
reqcb->tskid = 0;
/* If there is an abort completion wait task,
notify abort completion */
if ( opncb->abort_tskid > 0 && --opncb->abort_cnt == 0 ) {
tk_sig_sem_impl(opncb->abort_semid, 1);
}
if ( ercd < E_OK ) {
goto err_ret2;
}
UnlockDM();
return REQID(reqcb);
err_ret2:
knl_delReqCB(reqcb);
err_ret1:
UnlockDM();
DEBUG_PRINT(("knl_request ercd = %d\n", ercd));
return ercd;
}
/*
* Request for starting input/output to device
*/
LOCAL ID request( ID dd, D start, void *buf, INT size, TMO_U tmout,
INT cmd, enum ReqType syncreq )
{
ATR drvatr;
OpnCB *opncb;
DevCB *devcb;
ReqCB *reqcb;
UINT m;
ER ercd;
LockDM();
/* Check whether there is a break request */
ercd = check_break();
if ( ercd < E_OK ) {
goto err_ret1;
}
m = ( cmd == TDC_READ )? TD_READ: TD_WRITE;
ercd = check_devdesc(dd, m, &opncb);
if ( ercd < E_OK ) {
goto err_ret1;
}
if ( syncreq == SyncReq ) {
/* synchronous I/O is prohibited while there are
pending I/O requests for completion */
if ( opncb->nwaireq > 0 ) { ercd = E_OBJ; goto err_ret1; }
opncb->syncreq++;
}
devcb = opncb->devcb;
drvatr = devcb->ddev.drvatr;
/* check the range of parameter value */
if ( (drvatr & TDA_DEV_D) == 0 ) {
if ( start > 0x7fffffff || start < (-0x7fffffff-1) ) {
ercd = E_PAR; goto err_ret2;
}
}
/* Get request management block */
reqcb = newReqCB(opncb);
if ( reqcb == NULL ) {
ercd = E_LIMIT;
goto err_ret2;
}
/* Set request packet */
MEMSET(&reqcb->req, 0, sizeof(DEVREQ));
reqcb->req.c.devid = DEVID(devcb, opncb->unitno);
reqcb->req.c.cmd = cmd;
if ( (opncb->omode & TD_NOLOCK) != 0 ) {
reqcb->req.c.nolock = TRUE;
}
if ( (drvatr & TDA_DEV_D) == 0 ) {
reqcb->req.s.start = start;
reqcb->req.s.size = size;
reqcb->req.s.buf = buf;
} else {
reqcb->req.l.start_d = start;
reqcb->req.l.size = size;
reqcb->req.l.buf = buf;
}
ercd = tk_get_tsp(TSK_SELF, &reqcb->req.c.tskspc);
if ( ercd < E_OK ) {
goto err_ret3;
}
/* Indicate that it is during processing */
reqcb->tskid = tk_get_tid();
/* Device driver call */
UnlockDM();
ercd = call_execfn(devcb, &reqcb->req, tmout);
LockDM();
LockDAbort();
/* Indicate that it is not during processing */
reqcb->tskid = 0;
/* If there is an abort completion wait task,
notify abort completion */
if ( opncb->abort_tskid > 0 && --opncb->abort_cnt == 0 ) {
SyncSignalDM(opncb->abort_tskid);
}
UnlockDAbort();
if ( ercd < E_OK ) {
goto err_ret3;
}
UnlockDM();
return REQID(reqcb);
err_ret3:
delReqCB(reqcb);
err_ret2:
if ( syncreq == SyncReq ) {
opncb->syncreq--;
}
err_ret1:
UnlockDM();
DEBUG_PRINT(("request ercd = %d\n", ercd));
return ercd;
}
