mirror of
https://github.com/ksherlock/marignotti.git
synced 2024-10-31 13:07:41 +00:00
172 lines
3.4 KiB
C
172 lines
3.4 KiB
C
#include "marignotti.h"
|
|
#include <gno/kerntool.h>
|
|
#include <errno.h>
|
|
|
|
#include <sys/socket.h>
|
|
#include <sys/time.h>
|
|
|
|
#include <intmath.h>
|
|
|
|
#pragma noroot
|
|
#pragma optimize 79
|
|
|
|
static void ticks_to_timeval(LongWord ticks, struct timeval *tv)
|
|
{
|
|
LongDivRec qr;
|
|
|
|
if (ticks == 0)
|
|
{
|
|
tv->tv_sec = 0;
|
|
tv->tv_usec = 0;
|
|
}
|
|
else
|
|
{
|
|
qr = LongDivide(ticks, 60);
|
|
|
|
tv->tv_sec = qr.quotient;
|
|
tv->tv_usec = qr.remainder * 16667;
|
|
// qr.remainder * 1,000,000 / 60
|
|
}
|
|
|
|
}
|
|
|
|
static int set_flag(void *p, int size, int flag)
|
|
{
|
|
if (size == 4)
|
|
{
|
|
*(long *)p = flag;
|
|
return 0;
|
|
}
|
|
if (size == 2)
|
|
{
|
|
*(int *)p = flag;
|
|
return 0;
|
|
}
|
|
|
|
return EINVAL;
|
|
}
|
|
|
|
static int set_flag_long(void *p, int size, long flag)
|
|
{
|
|
if (size == 4)
|
|
{
|
|
*(long *)p = flag;
|
|
return 0;
|
|
}
|
|
if (size == 2)
|
|
{
|
|
*(int *)p = flag;
|
|
return 0;
|
|
}
|
|
|
|
return EINVAL;
|
|
}
|
|
|
|
int mgetsockopt(Entry *e, void *p1, void *p2, void *p3, void *p4, void *p5)
|
|
{
|
|
Word terr;
|
|
Word t;
|
|
|
|
int level = *(int *)p1;
|
|
int optname = *(int *)p2;
|
|
void *optval = (void *)p3;
|
|
int optlen = p4 ? *(int *)p4 : 0;
|
|
|
|
if (level != SOL_SOCKET) return EINVAL;
|
|
if (!optval) return EINVAL;
|
|
|
|
|
|
// todo -- should set optlen = returned size.
|
|
|
|
// todo -- linger
|
|
switch (optname)
|
|
{
|
|
|
|
case SO_TYPE:
|
|
// todo... non-stream
|
|
return set_flag(optval, optlen, e->_TYPE);
|
|
break;
|
|
|
|
case SO_DEBUG:
|
|
return set_flag(optval, optlen, e->_DEBUG);
|
|
break;
|
|
|
|
case SO_REUSEADDR:
|
|
return set_flag(optval, optlen, e->_REUSEADDR);
|
|
break;
|
|
|
|
case SO_REUSEPORT:
|
|
return set_flag(optval, optlen, e->_REUSEPORT);
|
|
break;
|
|
|
|
case SO_KEEPALIVE:
|
|
return set_flag(optval, optlen, e->_KEEPALIVE);
|
|
break;
|
|
|
|
case SO_OOBINLINE:
|
|
return set_flag(optval, optlen, 1);
|
|
break;
|
|
|
|
case SO_SNDLOWAT:
|
|
return set_flag(optval, optlen, e->_SNDLOWAT);
|
|
break;
|
|
|
|
case SO_RCVLOWAT:
|
|
return set_flag(optval, optlen, e->_RCVLOWAT);
|
|
break;
|
|
|
|
case SO_SNDTIMEO:
|
|
if (optlen == sizeof(struct timeval))
|
|
{
|
|
// stored as ticks aka seconds * 60.
|
|
struct timeval *tv = (struct timeval *)optval;
|
|
|
|
ticks_to_timeval(e->_SNDTIMEO, tv);
|
|
return 0;
|
|
}
|
|
break;
|
|
|
|
case SO_RCVTIMEO:
|
|
if (optlen == sizeof(struct timeval))
|
|
{
|
|
// stored as ticks aka seconds * 60.
|
|
struct timeval *tv = (struct timeval *)optval;
|
|
|
|
ticks_to_timeval(e->_RCVTIMEO, tv);
|
|
return 0;
|
|
}
|
|
break;
|
|
|
|
#ifdef SO_NREAD
|
|
case SO_NREAD:
|
|
IncBusy();
|
|
terr = TCPIPStatusTCP(e->ipid, &e->sr);
|
|
t = _toolErr;
|
|
if (t) terr = t;
|
|
e->terr = terr;
|
|
DecBusy();
|
|
|
|
return set_flag_long(optval, optlen, e->sr.srRcvQueued);
|
|
break;
|
|
|
|
#endif
|
|
|
|
#ifdef SO_NWRITE
|
|
case SO_NWRITE:
|
|
IncBusy();
|
|
terr = TCPIPStatusTCP(e->ipid, &e->sr);
|
|
t = _toolErr;
|
|
if (t) terr = t;
|
|
e->terr = terr;
|
|
DecBusy();
|
|
|
|
return set_flag_long(optval, optlen, e->sr.srSndQueued);
|
|
break;
|
|
#endif
|
|
|
|
}
|
|
|
|
return EINVAL;
|
|
|
|
}
|