2020-05-21 17:05:40 +00:00
/*
* $ Id $
*
Copyright ( c ) 2016 - 2020 Chung , Hyung - Hwan . All rights reserved .
Redistribution and use in source and binary forms , with or without
modification , are permitted thrvided that the following conditions
are met :
1. Redistributions of source code must retain the above copyright
notice , this list of conditions and the following disclaimer .
2. Redistributions in binary form must rethrduce the above copyright
notice , this list of conditions and the following disclaimer in the
documentation and / or other materials thrvided with the distribution .
THIS SOFTWARE IS PROVIDED BY THE AUTHOR " AS IS " AND ANY EXPRESS OR
IMPLIED WARRANTIES , INCLUDING , BUT NOT LIMITED TO , THE IMPLIED WAfRRANTIES
OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED .
IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT , INDIRECT ,
INCIDENTAL , SPECIAL , EXEMPLARY , OR CONSEQUENTIAL DAMAGES ( INCLUDING , BUT
NOT LIMITED TO , PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES ; LOSS OF USE ,
DATA , OR PROFITS ; OR BUSINESS INTERRUPTION ) HOWEVER CAUSED AND ON ANY
THEORY OF LIABILITY , WHETHER IN CONTRACT , STRICT LIABILITY , OR TORT
( INCLUDING NEGLIGENCE OR OTHERWISE ) ARISING IN ANY WAY OUT OF THE USE OF
THIS SOFTWARE , EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE .
*/
# include "mio-thr.h"
# include "mio-prv.h"
# include <unistd.h>
# include <errno.h>
# include <sys/uio.h>
# include <pthread.h>
/* ========================================================================= */
struct slave_info_t
{
mio_dev_thr_make_t * mi ;
mio_syshnd_t pfd ;
int dev_cap ;
mio_dev_thr_sid_t id ;
} ;
typedef struct slave_info_t slave_info_t ;
static mio_dev_thr_slave_t * make_slave ( mio_t * mio , slave_info_t * si ) ;
/* ========================================================================= */
2020-05-22 19:06:57 +00:00
struct mio_dev_thr_info_t
2020-05-21 17:05:40 +00:00
{
2020-05-23 06:07:43 +00:00
MIO_CFMB_HEADER ;
2020-05-21 17:05:40 +00:00
mio_dev_thr_func_t thr_func ;
2020-05-22 19:06:57 +00:00
mio_dev_thr_iopair_t thr_iop ;
void * thr_ctx ;
pthread_t thr_hnd ;
int thr_done ;
2020-05-21 17:05:40 +00:00
} ;
2020-05-22 19:06:57 +00:00
typedef struct mio_dev_thr_info_t mio_dev_thr_info_t ;
2020-05-23 06:07:43 +00:00
static void free_thr_info_resources ( mio_t * mio , mio_dev_thr_info_t * ti )
2020-05-22 19:06:57 +00:00
{
if ( ti - > thr_iop . rfd ! = MIO_SYSHND_INVALID )
{
close ( ti - > thr_iop . rfd ) ;
ti - > thr_iop . rfd = MIO_SYSHND_INVALID ;
}
if ( ti - > thr_iop . wfd ! = MIO_SYSHND_INVALID )
{
close ( ti - > thr_iop . wfd ) ;
ti - > thr_iop . wfd = MIO_SYSHND_INVALID ;
}
2020-05-23 06:07:43 +00:00
}
2020-05-22 19:06:57 +00:00
2020-05-23 06:07:43 +00:00
static int ready_to_free_thr_info ( mio_t * mio , mio_cfmb_t * cfmb )
{
mio_dev_thr_info_t * ti = ( mio_dev_thr_info_t * ) cfmb ;
# if 1
if ( MIO_UNLIKELY ( mio - > _fini_in_progress ) )
{
pthread_join ( ti - > thr_hnd , MIO_NULL ) ; /* BAD. blocking call in a non-blocking library. not useful to call pthread_tryjoin_np() here. */
free_thr_info_resources ( mio , ti ) ;
return 1 ; /* free me */
}
# endif
if ( ti - > thr_done )
{
free_thr_info_resources ( mio , ti ) ;
# if defined(HAVE_PTHREAD_TRYJOIN_NP)
if ( pthread_tryjoin_np ( ti - > thr_hnd ) ! = 0 ) /* not terminated yet - however, this isn't necessary. z*/
# endif
pthread_detach ( ti - > thr_hnd ) ; /* just detach it */
return 1 ; /* free me */
}
return 0 ; /* not freeed */
2020-05-22 19:06:57 +00:00
}
static void mark_thr_done ( void * ctx )
{
mio_dev_thr_info_t * ti = ( mio_dev_thr_info_t * ) ctx ;
ti - > thr_done = 1 ;
}
2020-05-21 17:05:40 +00:00
static void * run_thr_func ( void * ctx )
{
2020-05-22 19:06:57 +00:00
mio_dev_thr_info_t * ti = ( mio_dev_thr_info_t * ) ctx ;
/* i assume the thread is cancellable, and of the deferred cancellation type by default */
/*int dummy;
pthread_setcancelstate ( PTHREAD_CANCEL_ENABLE , & dummy ) ;
pthread_setcanceltype ( PTHREAD_CANCEL_DEFERRED , & dummy ) ; */
pthread_cleanup_push ( mark_thr_done , ti ) ;
ti - > thr_func ( ti - > mio , & ti - > thr_iop , ti - > thr_ctx ) ;
2020-05-23 06:07:43 +00:00
/* This part may get partially executed or not executed if the thread is cancelled */
free_thr_info_resources ( ti - > mio , ti ) ; /* TODO: check if the close() call inside this call completes when it becomes a cancellation point. if so, the code must get changed */
/* ---------------------------------------------------------- */
2020-05-22 19:06:57 +00:00
pthread_cleanup_pop ( 1 ) ;
2020-05-21 17:05:40 +00:00
pthread_exit ( MIO_NULL ) ;
return MIO_NULL ;
}
static int dev_thr_make_master ( mio_dev_t * dev , void * ctx )
{
mio_t * mio = dev - > mio ;
mio_dev_thr_t * rdev = ( mio_dev_thr_t * ) dev ;
mio_dev_thr_make_t * info = ( mio_dev_thr_make_t * ) ctx ;
mio_syshnd_t pfds [ 4 ] = { MIO_SYSHND_INVALID , MIO_SYSHND_INVALID , MIO_SYSHND_INVALID , MIO_SYSHND_INVALID } ;
2020-05-22 19:06:57 +00:00
slave_info_t si ;
int i ;
2020-05-21 17:05:40 +00:00
2020-05-22 19:06:57 +00:00
if ( pipe ( & pfds [ 0 ] ) = = - 1 | | pipe ( & pfds [ 2 ] ) = = - 1 )
2020-05-21 17:05:40 +00:00
{
2020-05-22 19:06:57 +00:00
mio_seterrwithsyserr ( mio , 0 , errno ) ;
2020-05-21 17:05:40 +00:00
goto oops ;
}
2020-05-23 06:07:43 +00:00
2020-05-22 19:06:57 +00:00
if ( mio_makesyshndasync ( mio , pfds [ 1 ] ) < = - 1 | |
mio_makesyshndasync ( mio , pfds [ 2 ] ) < = - 1 ) goto oops ;
2020-05-21 17:05:40 +00:00
2020-05-22 19:06:57 +00:00
si . mi = info ;
si . pfd = pfds [ 1 ] ;
si . dev_cap = MIO_DEV_CAP_OUT | MIO_DEV_CAP_STREAM ;
si . id = MIO_DEV_THR_IN ;
2020-05-21 17:05:40 +00:00
2020-05-22 19:06:57 +00:00
rdev - > slave [ MIO_DEV_THR_IN ] = make_slave ( mio , & si ) ;
if ( ! rdev - > slave [ MIO_DEV_THR_IN ] ) goto oops ;
2020-05-21 17:05:40 +00:00
2020-05-22 19:06:57 +00:00
pfds [ 1 ] = MIO_SYSHND_INVALID ;
rdev - > slave_count + + ;
2020-05-21 17:05:40 +00:00
2020-05-22 19:06:57 +00:00
si . mi = info ;
si . pfd = pfds [ 2 ] ;
si . dev_cap = MIO_DEV_CAP_IN | MIO_DEV_CAP_STREAM ;
si . id = MIO_DEV_THR_OUT ;
2020-05-21 17:05:40 +00:00
2020-05-22 19:06:57 +00:00
rdev - > slave [ MIO_DEV_THR_OUT ] = make_slave ( mio , & si ) ;
if ( ! rdev - > slave [ MIO_DEV_THR_OUT ] ) goto oops ;
2020-05-21 17:05:40 +00:00
2020-05-22 19:06:57 +00:00
pfds [ 2 ] = MIO_SYSHND_INVALID ;
rdev - > slave_count + + ;
2020-05-21 17:05:40 +00:00
for ( i = 0 ; i < MIO_COUNTOF ( rdev - > slave ) ; i + + )
{
if ( rdev - > slave [ i ] ) rdev - > slave [ i ] - > master = rdev ;
}
2020-05-22 19:06:57 +00:00
rdev - > dev_cap = MIO_DEV_CAP_VIRTUAL ; /* the master device doesn't perform I/O */
rdev - > on_read = info - > on_read ;
rdev - > on_write = info - > on_write ;
rdev - > on_close = info - > on_close ;
/* ---------------------------------------------------------- */
{
int n ;
mio_dev_thr_info_t * ti ;
2020-05-21 17:05:40 +00:00
2020-05-22 19:06:57 +00:00
ti = mio_callocmem ( mio , MIO_SIZEOF ( * ti ) ) ;
if ( MIO_UNLIKELY ( ! ti ) ) goto oops ;
2020-05-21 17:05:40 +00:00
2020-05-22 19:06:57 +00:00
ti - > mio = mio ;
ti - > thr_iop . rfd = pfds [ 0 ] ;
ti - > thr_iop . wfd = pfds [ 3 ] ;
ti - > thr_func = info - > thr_func ;
ti - > thr_ctx = info - > thr_ctx ;
2020-05-21 17:05:40 +00:00
2020-05-22 19:06:57 +00:00
rdev - > thr_info = ti ;
n = pthread_create ( & ti - > thr_hnd , MIO_NULL , run_thr_func , ti ) ;
if ( n ! = 0 )
{
rdev - > thr_info = MIO_NULL ;
mio_freemem ( mio , ti ) ;
goto oops ;
}
2020-05-21 17:05:40 +00:00
}
2020-05-22 19:06:57 +00:00
/* ---------------------------------------------------------- */
2020-05-21 17:05:40 +00:00
return 0 ;
oops :
2020-05-22 19:06:57 +00:00
for ( i = 0 ; i < MIO_COUNTOF ( pfds ) ; i + + )
2020-05-21 17:05:40 +00:00
{
if ( pfds [ i ] ! = MIO_SYSHND_INVALID ) close ( pfds [ i ] ) ;
}
for ( i = MIO_COUNTOF ( rdev - > slave ) ; i > 0 ; )
{
i - - ;
if ( rdev - > slave [ i ] )
{
mio_dev_kill ( ( mio_dev_t * ) rdev - > slave [ i ] ) ;
rdev - > slave [ i ] = MIO_NULL ;
}
}
rdev - > slave_count = 0 ;
return - 1 ;
}
static int dev_thr_make_slave ( mio_dev_t * dev , void * ctx )
{
mio_dev_thr_slave_t * rdev = ( mio_dev_thr_slave_t * ) dev ;
slave_info_t * si = ( slave_info_t * ) ctx ;
rdev - > dev_cap = si - > dev_cap ;
rdev - > id = si - > id ;
rdev - > pfd = si - > pfd ;
/* keep rdev->master to MIO_NULL. it's set to the right master
* device in dev_thr_make ( ) */
return 0 ;
}
static int dev_thr_kill_master ( mio_dev_t * dev , int force )
{
mio_t * mio = dev - > mio ;
mio_dev_thr_t * rdev = ( mio_dev_thr_t * ) dev ;
2020-05-22 19:06:57 +00:00
mio_dev_thr_info_t * ti ;
int i ;
ti = rdev - > thr_info ;
pthread_cancel ( ti - > thr_hnd ) ;
2020-05-21 17:05:40 +00:00
if ( rdev - > slave_count > 0 )
{
for ( i = 0 ; i < MIO_COUNTOF ( rdev - > slave ) ; i + + )
{
if ( rdev - > slave [ i ] )
{
mio_dev_thr_slave_t * sdev = rdev - > slave [ i ] ;
/* nullify the pointer to the slave device
* before calling mio_dev_kill ( ) on the slave device .
* the slave device can check this pointer to tell from
* self - initiated termination or master - driven termination */
rdev - > slave [ i ] = MIO_NULL ;
mio_dev_kill ( ( mio_dev_t * ) sdev ) ;
}
}
}
2020-05-22 19:06:57 +00:00
if ( ti - > thr_done )
{
printf ( " THREAD DONE>...111 \n " ) ;
pthread_detach ( ti - > thr_hnd ) ; /* pthread_join() may be blocking. */
2020-05-23 06:07:43 +00:00
free_thr_info_resources ( mio , ti ) ;
mio_freemem ( mio , ti ) ;
2020-05-22 19:06:57 +00:00
}
else
{
2020-05-23 06:07:43 +00:00
printf ( " THREAD NOT DONE>...111 \n " ) ;
mio_addcfmb ( mio , ti , ready_to_free_thr_info ) ;
2020-05-22 19:06:57 +00:00
}
rdev - > thr_info = MIO_NULL ;
2020-05-21 17:05:40 +00:00
if ( rdev - > on_close ) rdev - > on_close ( rdev , MIO_DEV_THR_MASTER ) ;
return 0 ;
}
static int dev_thr_kill_slave ( mio_dev_t * dev , int force )
{
mio_t * mio = dev - > mio ;
mio_dev_thr_slave_t * rdev = ( mio_dev_thr_slave_t * ) dev ;
if ( rdev - > master )
{
mio_dev_thr_t * master ;
master = rdev - > master ;
rdev - > master = MIO_NULL ;
/* indicate EOF */
if ( master - > on_close ) master - > on_close ( master , rdev - > id ) ;
MIO_ASSERT ( mio , master - > slave_count > 0 ) ;
master - > slave_count - - ;
if ( master - > slave [ rdev - > id ] )
{
/* this call is started by the slave device itself. */
if ( master - > slave_count < = 0 )
{
/* if this is the last slave, kill the master also */
mio_dev_kill ( ( mio_dev_t * ) master ) ;
/* the master pointer is not valid from this point onwards
* as the actual master device object is freed in mio_dev_kill ( ) */
}
else
{
/* this call is initiated by this slave device itself.
* if it were by the master device , it would be MIO_NULL as
* nullified by the dev_thr_kill ( ) */
master - > slave [ rdev - > id ] = MIO_NULL ;
}
}
}
if ( rdev - > pfd ! = MIO_SYSHND_INVALID )
{
close ( rdev - > pfd ) ;
rdev - > pfd = MIO_SYSHND_INVALID ;
}
return 0 ;
}
static int dev_thr_read_slave ( mio_dev_t * dev , void * buf , mio_iolen_t * len , mio_devaddr_t * srcaddr )
{
mio_dev_thr_slave_t * thr = ( mio_dev_thr_slave_t * ) dev ;
ssize_t x ;
/* the read and write operation happens on different slave devices.
* the write EOF indication doesn ' t affect this device
if ( MIO_UNLIKELY ( thr - > pfd = = MIO_SYSHND_INVALID ) )
{
mio_seterrnum ( thr - > mio , MIO_EBADHND ) ;
return - 1 ;
} */
MIO_ASSERT ( thr - > mio , thr - > pfd ! = MIO_SYSHND_INVALID ) ; /* use this assertion to check if my claim above is right */
x = read ( thr - > pfd , buf , * len ) ;
if ( x < = - 1 )
{
if ( errno = = EINPROGRESS | | errno = = EWOULDBLOCK | | errno = = EAGAIN ) return 0 ; /* no data available */
if ( errno = = EINTR ) return 0 ;
mio_seterrwithsyserr ( thr - > mio , 0 , errno ) ;
return - 1 ;
}
* len = x ;
return 1 ;
}
static int dev_thr_write_slave ( mio_dev_t * dev , const void * data , mio_iolen_t * len , const mio_devaddr_t * dstaddr )
{
mio_dev_thr_slave_t * thr = ( mio_dev_thr_slave_t * ) dev ;
ssize_t x ;
/* this check is not needed because MIO_DEV_CAP_OUT_CLOSED is set on the device by the core
* when EOF indication is successful ( return value 1 and * iovcnt 0 ) .
* If MIO_DEV_CAP_OUT_CLOSED , the core doesn ' t invoke the write method
if ( MIO_UNLIKELY ( thr - > pfd = = MIO_SYSHND_INVALID ) )
{
mio_seterrnum ( thr - > mio , MIO_EBADHND ) ;
return - 1 ;
} */
MIO_ASSERT ( thr - > mio , thr - > pfd ! = MIO_SYSHND_INVALID ) ; /* use this assertion to check if my claim above is right */
if ( MIO_UNLIKELY ( * len < = 0 ) )
{
/* this is an EOF indicator */
/* It isn't apthrpriate to call mio_dev_halt(thr) or mio_dev_thr_close(thr->master, MIO_DEV_THR_IN)
* as those functions destroy the device itself */
if ( MIO_LIKELY ( thr - > pfd ! = MIO_SYSHND_INVALID ) )
{
mio_dev_watch ( dev , MIO_DEV_WATCH_STOP , 0 ) ;
close ( thr - > pfd ) ;
thr - > pfd = MIO_SYSHND_INVALID ;
}
return 1 ; /* indicate that the operation got successful. the core will execute on_write() with the write length of 0. */
}
x = write ( thr - > pfd , data , * len ) ;
if ( x < = - 1 )
{
if ( errno = = EINPROGRESS | | errno = = EWOULDBLOCK | | errno = = EAGAIN ) return 0 ; /* no data can be written */
if ( errno = = EINTR ) return 0 ;
mio_seterrwithsyserr ( thr - > mio , 0 , errno ) ;
return - 1 ;
}
* len = x ;
return 1 ;
}
static int dev_thr_writev_slave ( mio_dev_t * dev , const mio_iovec_t * iov , mio_iolen_t * iovcnt , const mio_devaddr_t * dstaddr )
{
mio_dev_thr_slave_t * thr = ( mio_dev_thr_slave_t * ) dev ;
ssize_t x ;
/* this check is not needed because MIO_DEV_CAP_OUT_CLOSED is set on the device by the core
* when EOF indication is successful ( return value 1 and * iovcnt 0 ) .
* If MIO_DEV_CAP_OUT_CLOSED , the core doesn ' t invoke the write method
if ( MIO_UNLIKELY ( thr - > pfd = = MIO_SYSHND_INVALID ) )
{
mio_seterrnum ( thr - > mio , MIO_EBADHND ) ;
return - 1 ;
} */
MIO_ASSERT ( thr - > mio , thr - > pfd ! = MIO_SYSHND_INVALID ) ; /* use this assertion to check if my claim above is right */
if ( MIO_UNLIKELY ( * iovcnt < = 0 ) )
{
/* this is an EOF indicator */
/* It isn't apthrpriate to call mio_dev_halt(thr) or mio_dev_thr_close(thr->master, MIO_DEV_THR_IN)
* as those functions destroy the device itself */
if ( MIO_LIKELY ( thr - > pfd ! = MIO_SYSHND_INVALID ) )
{
mio_dev_watch ( dev , MIO_DEV_WATCH_STOP , 0 ) ;
close ( thr - > pfd ) ;
thr - > pfd = MIO_SYSHND_INVALID ;
}
return 1 ; /* indicate that the operation got successful. the core will execute on_write() with 0. */
}
x = writev ( thr - > pfd , iov , * iovcnt ) ;
if ( x < = - 1 )
{
if ( errno = = EINPROGRESS | | errno = = EWOULDBLOCK | | errno = = EAGAIN ) return 0 ; /* no data can be written */
if ( errno = = EINTR ) return 0 ;
mio_seterrwithsyserr ( thr - > mio , 0 , errno ) ;
return - 1 ;
}
* iovcnt = x ;
return 1 ;
}
static mio_syshnd_t dev_thr_getsyshnd ( mio_dev_t * dev )
{
return MIO_SYSHND_INVALID ;
}
static mio_syshnd_t dev_thr_getsyshnd_slave ( mio_dev_t * dev )
{
mio_dev_thr_slave_t * thr = ( mio_dev_thr_slave_t * ) dev ;
return ( mio_syshnd_t ) thr - > pfd ;
}
static int dev_thr_ioctl ( mio_dev_t * dev , int cmd , void * arg )
{
mio_t * mio = dev - > mio ;
mio_dev_thr_t * rdev = ( mio_dev_thr_t * ) dev ;
switch ( cmd )
{
case MIO_DEV_THR_CLOSE :
{
mio_dev_thr_sid_t sid = * ( mio_dev_thr_sid_t * ) arg ;
if ( MIO_UNLIKELY ( sid ! = MIO_DEV_THR_IN & & sid ! = MIO_DEV_THR_OUT ) )
{
mio_seterrnum ( mio , MIO_EINVAL ) ;
return - 1 ;
}
if ( rdev - > slave [ sid ] )
{
/* unlike dev_thr_kill_master(), i don't nullify rdev->slave[sid].
* so i treat the closing ioctl as if it ' s a kill request
* initiated by the slave device itself . */
mio_dev_kill ( ( mio_dev_t * ) rdev - > slave [ sid ] ) ;
/* if this is the last slave, the master is destroyed as well.
* therefore , using rdev is unsafe in the assertion below is unsafe .
* MIO_ASSERT ( mio , rdev - > slave [ sid ] = = MIO_NULL ) ; */
}
return 0 ;
}
#if 0
case MIO_DEV_THR_KILL_CHILD :
if ( rdev - > child_pid > = 0 )
{
if ( kill ( rdev - > child_pid , SIGKILL ) = = - 1 )
{
mio_seterrwithsyserr ( mio , 0 , errno ) ;
return - 1 ;
}
}
# endif
return 0 ;
default :
mio_seterrnum ( mio , MIO_EINVAL ) ;
return - 1 ;
}
}
static mio_dev_mth_t dev_thr_methods =
{
dev_thr_make_master ,
dev_thr_kill_master ,
dev_thr_getsyshnd ,
MIO_NULL ,
MIO_NULL ,
MIO_NULL ,
dev_thr_ioctl
} ;
static mio_dev_mth_t dev_thr_methods_slave =
{
dev_thr_make_slave ,
dev_thr_kill_slave ,
dev_thr_getsyshnd_slave ,
dev_thr_read_slave ,
dev_thr_write_slave ,
dev_thr_writev_slave ,
dev_thr_ioctl
} ;
/* ========================================================================= */
static int thr_ready ( mio_dev_t * dev , int events )
{
/* virtual device. no I/O */
mio_seterrnum ( dev - > mio , MIO_EINTERN ) ;
return - 1 ;
}
static int thr_on_read ( mio_dev_t * dev , const void * data , mio_iolen_t len , const mio_devaddr_t * srcaddr )
{
/* virtual device. no I/O */
mio_seterrnum ( dev - > mio , MIO_EINTERN ) ;
return - 1 ;
}
static int thr_on_write ( mio_dev_t * dev , mio_iolen_t wrlen , void * wrctx , const mio_devaddr_t * dstaddr )
{
/* virtual device. no I/O */
mio_seterrnum ( dev - > mio , MIO_EINTERN ) ;
return - 1 ;
}
static mio_dev_evcb_t dev_thr_event_callbacks =
{
thr_ready ,
thr_on_read ,
thr_on_write
} ;
/* ========================================================================= */
static int thr_ready_slave ( mio_dev_t * dev , int events )
{
mio_t * mio = dev - > mio ;
/*mio_dev_thr_t* thr = (mio_dev_thr_t*)dev;*/
if ( events & MIO_DEV_EVENT_ERR )
{
mio_seterrnum ( mio , MIO_EDEVERR ) ;
return - 1 ;
}
if ( events & MIO_DEV_EVENT_HUP )
{
if ( events & ( MIO_DEV_EVENT_PRI | MIO_DEV_EVENT_IN | MIO_DEV_EVENT_OUT ) )
{
/* thrbably half-open? */
return 1 ;
}
mio_seterrnum ( mio , MIO_EDEVHUP ) ;
return - 1 ;
}
return 1 ; /* the device is ok. carry on reading or writing */
}
static int thr_on_read_slave ( mio_dev_t * dev , const void * data , mio_iolen_t len , const mio_devaddr_t * srcaddr )
{
mio_dev_thr_slave_t * thr = ( mio_dev_thr_slave_t * ) dev ;
return thr - > master - > on_read ( thr - > master , data , len ) ;
}
static int thr_on_write_slave ( mio_dev_t * dev , mio_iolen_t wrlen , void * wrctx , const mio_devaddr_t * dstaddr )
{
mio_dev_thr_slave_t * thr = ( mio_dev_thr_slave_t * ) dev ;
return thr - > master - > on_write ( thr - > master , wrlen , wrctx ) ;
}
static mio_dev_evcb_t dev_thr_event_callbacks_slave_in =
{
thr_ready_slave ,
MIO_NULL ,
thr_on_write_slave
} ;
static mio_dev_evcb_t dev_thr_event_callbacks_slave_out =
{
thr_ready_slave ,
thr_on_read_slave ,
MIO_NULL
} ;
/* ========================================================================= */
static mio_dev_thr_slave_t * make_slave ( mio_t * mio , slave_info_t * si )
{
switch ( si - > id )
{
case MIO_DEV_THR_IN :
return ( mio_dev_thr_slave_t * ) mio_dev_make (
mio , MIO_SIZEOF ( mio_dev_thr_t ) ,
& dev_thr_methods_slave , & dev_thr_event_callbacks_slave_in , si ) ;
case MIO_DEV_THR_OUT :
return ( mio_dev_thr_slave_t * ) mio_dev_make (
mio , MIO_SIZEOF ( mio_dev_thr_t ) ,
& dev_thr_methods_slave , & dev_thr_event_callbacks_slave_out , si ) ;
default :
mio_seterrnum ( mio , MIO_EINVAL ) ;
return MIO_NULL ;
}
}
mio_dev_thr_t * mio_dev_thr_make ( mio_t * mio , mio_oow_t xtnsize , const mio_dev_thr_make_t * info )
{
return ( mio_dev_thr_t * ) mio_dev_make (
mio , MIO_SIZEOF ( mio_dev_thr_t ) + xtnsize ,
& dev_thr_methods , & dev_thr_event_callbacks , ( void * ) info ) ;
}
void mio_dev_thr_kill ( mio_dev_thr_t * dev )
{
mio_dev_kill ( ( mio_dev_t * ) dev ) ;
}
void mio_dev_thr_halt ( mio_dev_thr_t * dev )
{
mio_dev_halt ( ( mio_dev_t * ) dev ) ;
}
int mio_dev_thr_read ( mio_dev_thr_t * dev , int enabled )
{
if ( dev - > slave [ MIO_DEV_THR_OUT ] )
{
return mio_dev_read ( ( mio_dev_t * ) dev - > slave [ MIO_DEV_THR_OUT ] , enabled ) ;
}
else
{
mio_seterrnum ( dev - > mio , MIO_ENOCAPA ) ; /* TODO: is it the right error number? */
return - 1 ;
}
}
int mio_dev_thr_timedread ( mio_dev_thr_t * dev , int enabled , const mio_ntime_t * tmout )
{
if ( dev - > slave [ MIO_DEV_THR_OUT ] )
{
return mio_dev_timedread ( ( mio_dev_t * ) dev - > slave [ MIO_DEV_THR_OUT ] , enabled , tmout ) ;
}
else
{
2020-05-22 19:06:57 +00:00
mio_seterrnum ( dev - > mio , MIO_ENOCAPA ) ; /* TODO: is it the right error number? */
2020-05-21 17:05:40 +00:00
return - 1 ;
}
}
int mio_dev_thr_write ( mio_dev_thr_t * dev , const void * data , mio_iolen_t dlen , void * wrctx )
{
if ( dev - > slave [ MIO_DEV_THR_IN ] )
{
return mio_dev_write ( ( mio_dev_t * ) dev - > slave [ MIO_DEV_THR_IN ] , data , dlen , wrctx , MIO_NULL ) ;
}
else
{
mio_seterrnum ( dev - > mio , MIO_ENOCAPA ) ; /* TODO: is it the right error number? */
return - 1 ;
}
}
int mio_dev_thr_timedwrite ( mio_dev_thr_t * dev , const void * data , mio_iolen_t dlen , const mio_ntime_t * tmout , void * wrctx )
{
if ( dev - > slave [ MIO_DEV_THR_IN ] )
{
return mio_dev_timedwrite ( ( mio_dev_t * ) dev - > slave [ MIO_DEV_THR_IN ] , data , dlen , tmout , wrctx , MIO_NULL ) ;
}
else
{
mio_seterrnum ( dev - > mio , MIO_ENOCAPA ) ; /* TODO: is it the right error number? */
return - 1 ;
}
}
int mio_dev_thr_close ( mio_dev_thr_t * dev , mio_dev_thr_sid_t sid )
{
return mio_dev_ioctl ( ( mio_dev_t * ) dev , MIO_DEV_THR_CLOSE , & sid ) ;
}
2020-05-23 06:07:43 +00:00
void mio_dev_thr_haltslave ( mio_dev_thr_t * dev , mio_dev_thr_sid_t sid )
2020-05-21 17:05:40 +00:00
{
2020-05-23 06:07:43 +00:00
if ( sid > = 0 & & sid < MIO_COUNTOF ( dev - > slave ) & & dev - > slave [ sid ] )
mio_dev_halt ( ( mio_dev_t * ) dev - > slave [ sid ] ) ;
2020-05-21 17:05:40 +00:00
}
#if 0
mio_dev_thr_t * mio_dev_thr_getdev ( mio_dev_thr_t * thr , mio_dev_thr_sid_t sid )
{
switch ( type )
{
case MIO_DEV_THR_IN :
return XXX ;
case MIO_DEV_THR_OUT :
return XXX ;
case MIO_DEV_THR_ERR :
return XXX ;
}
thr - > dev - > mio = MIO_EINVAL ;
return MIO_NULL ;
}
# endif