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-22 19:06:57 +00:00
|
|
|
mio_t* mio;
|
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;
|
|
|
|
mio_tmridx_t cleanup_tmridx;
|
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;
|
|
|
|
|
|
|
|
|
|
|
|
static void free_thr_info (mio_t* mio, mio_dev_thr_info_t* ti)
|
|
|
|
{
|
|
|
|
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;
|
|
|
|
}
|
|
|
|
|
|
|
|
mio_freemem (mio, ti);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void mark_thr_done (void* ctx)
|
|
|
|
{
|
|
|
|
mio_dev_thr_info_t* ti = (mio_dev_thr_info_t*)ctx;
|
|
|
|
printf ("QQQQQQQQQQQQQQQQQQQQQQQQQQQQQQQQQ\n");
|
|
|
|
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);
|
|
|
|
|
|
|
|
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-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;
|
|
|
|
}
|
|
|
|
|
2020-05-22 19:06:57 +00:00
|
|
|
static void check_and_free_thr_info (mio_t* mio, const mio_ntime_t* now, mio_tmrjob_t* job)
|
|
|
|
{
|
|
|
|
mio_dev_thr_info_t* ti = (mio_dev_thr_info_t*)job->ctx;
|
|
|
|
if (ti->thr_done)
|
|
|
|
{
|
|
|
|
free_thr_info (mio, ti);
|
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2020-05-21 17:05:40 +00:00
|
|
|
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. */
|
|
|
|
free_thr_info (mio, ti);
|
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
|
|
|
mio_tmrjob_t tmrjob;
|
|
|
|
MIO_MEMSET (&tmrjob, 0, MIO_SIZEOF(tmrjob));
|
|
|
|
tmrjob.ctx = ti;
|
|
|
|
mio_gettime (mio, &tmrjob.when);
|
|
|
|
tmrjob.when.sec++;
|
|
|
|
tmrjob.handler = check_and_free_thr_info;
|
|
|
|
tmrjob.idxptr = &ti->cleanup_tmridx;
|
|
|
|
|
|
|
|
if (ti->thr_done)
|
|
|
|
{
|
|
|
|
printf ("THREAD DONE>...222\n");
|
|
|
|
pthread_detach (ti->thr_hnd); /* pthread_join() may be blocking. */
|
|
|
|
free_thr_info (mio, ti);
|
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
|
|
|
printf ("THREAD NOT DONE>...222\n");
|
|
|
|
//ti->cleanup_tmridx = mio_instmrjob(mio, &tmrjob);
|
|
|
|
pthread_join (ti->thr_hnd, MIO_NULL); /* pthread_join() may be blocking. */
|
|
|
|
mio_freemem (mio, ti);
|
|
|
|
//mio_instmrjob (mio,
|
|
|
|
}
|
|
|
|
}
|
|
|
|
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);
|
|
|
|
}
|
|
|
|
|
|
|
|
#if 0
|
|
|
|
int mio_dev_thr_killchild (mio_dev_thr_t* dev)
|
|
|
|
{
|
|
|
|
return mio_dev_ioctl((mio_dev_t*)dev, MIO_DEV_THR_KILL_CHILD, MIO_NULL);
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
|
|
|
|
#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
|