|
Packit |
6c4009 |
/* stdio on a Mach device port.
|
|
Packit |
6c4009 |
Translates \n to \r\n on output, echos and translates \r to \n on input.
|
|
Packit |
6c4009 |
Copyright (C) 1992-2018 Free Software Foundation, Inc.
|
|
Packit |
6c4009 |
This file is part of the GNU C Library.
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
The GNU C Library is free software; you can redistribute it and/or
|
|
Packit |
6c4009 |
modify it under the terms of the GNU Lesser General Public
|
|
Packit |
6c4009 |
License as published by the Free Software Foundation; either
|
|
Packit |
6c4009 |
version 2.1 of the License, or (at your option) any later version.
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
The GNU C Library is distributed in the hope that it will be useful,
|
|
Packit |
6c4009 |
but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
Packit |
6c4009 |
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
|
Packit |
6c4009 |
Lesser General Public License for more details.
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
You should have received a copy of the GNU Lesser General Public
|
|
Packit |
6c4009 |
License along with the GNU C Library; if not, see
|
|
Packit |
6c4009 |
<http://www.gnu.org/licenses/>. */
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
#include <stdio.h>
|
|
Packit |
6c4009 |
#include <mach.h>
|
|
Packit |
6c4009 |
#include <device/device.h>
|
|
Packit |
6c4009 |
#include <errno.h>
|
|
Packit |
6c4009 |
#include <string.h>
|
|
Packit |
6c4009 |
#include <libioP.h>
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
static ssize_t
|
|
Packit |
6c4009 |
devstream_write (void *cookie, const char *buffer, size_t n)
|
|
Packit |
6c4009 |
{
|
|
Packit |
6c4009 |
const device_t dev = (device_t) cookie;
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
int write_some (const char *p, size_t to_write)
|
|
Packit |
6c4009 |
{
|
|
Packit |
6c4009 |
kern_return_t err;
|
|
Packit |
6c4009 |
int wrote;
|
|
Packit |
6c4009 |
int thiswrite;
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
while (to_write > 0)
|
|
Packit |
6c4009 |
{
|
|
Packit |
6c4009 |
thiswrite = to_write;
|
|
Packit |
6c4009 |
if (thiswrite > IO_INBAND_MAX)
|
|
Packit |
6c4009 |
thiswrite = IO_INBAND_MAX;
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
if (err = device_write_inband (dev, 0, 0, p, thiswrite, &wrote))
|
|
Packit |
6c4009 |
{
|
|
Packit |
6c4009 |
errno = err;
|
|
Packit |
6c4009 |
return 0;
|
|
Packit |
6c4009 |
}
|
|
Packit |
6c4009 |
p += wrote;
|
|
Packit |
6c4009 |
to_write -= wrote;
|
|
Packit |
6c4009 |
}
|
|
Packit |
6c4009 |
return 1;
|
|
Packit |
6c4009 |
}
|
|
Packit |
6c4009 |
int write_crlf (void)
|
|
Packit |
6c4009 |
{
|
|
Packit |
6c4009 |
static const char crlf[] = "\r\n";
|
|
Packit |
6c4009 |
return write_some (crlf, 2);
|
|
Packit |
6c4009 |
}
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
/* Search for newlines (LFs) in the buffer. */
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
const char *start = buffer, *p;
|
|
Packit |
6c4009 |
while ((p = memchr (start, '\n', n)) != NULL)
|
|
Packit |
6c4009 |
{
|
|
Packit |
6c4009 |
/* Found one. Write out through the preceding character,
|
|
Packit |
6c4009 |
and then write a CR/LF pair. */
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
if ((p > start && !write_some (start, p - start))
|
|
Packit |
6c4009 |
|| !write_crlf ())
|
|
Packit |
6c4009 |
return (start - buffer) ?: -1;
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
n -= p + 1 - start;
|
|
Packit |
6c4009 |
start = p + 1;
|
|
Packit |
6c4009 |
}
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
/* Write the remainder of the buffer. */
|
|
Packit |
6c4009 |
if (write_some (start, n))
|
|
Packit |
6c4009 |
start += n;
|
|
Packit |
6c4009 |
return (start - buffer) ?: -1;
|
|
Packit |
6c4009 |
}
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
static ssize_t
|
|
Packit |
6c4009 |
devstream_read (void *cookie, char *buffer, size_t to_read)
|
|
Packit |
6c4009 |
{
|
|
Packit |
6c4009 |
const device_t dev = (device_t) cookie;
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
kern_return_t err;
|
|
Packit |
6c4009 |
mach_msg_type_number_t nread = to_read;
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
err = device_read_inband (dev, 0, 0, to_read, buffer, &nread);
|
|
Packit |
6c4009 |
if (err)
|
|
Packit |
6c4009 |
{
|
|
Packit |
6c4009 |
errno = err;
|
|
Packit |
6c4009 |
return -1;
|
|
Packit |
6c4009 |
}
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
/* Translate CR to LF. */
|
|
Packit |
6c4009 |
{
|
|
Packit |
6c4009 |
char *p;
|
|
Packit |
6c4009 |
for (p = memchr (buffer, '\r', nread); p;
|
|
Packit |
6c4009 |
p = memchr (p + 1, '\r', (buffer + nread) - (p + 1)))
|
|
Packit |
6c4009 |
*p = '\n';
|
|
Packit |
6c4009 |
}
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
/* Echo back what we read. */
|
|
Packit |
6c4009 |
(void) devstream_write (cookie, buffer, nread);
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
return nread;
|
|
Packit |
6c4009 |
}
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
static int
|
|
Packit |
6c4009 |
dealloc_ref (void *cookie)
|
|
Packit |
6c4009 |
{
|
|
Packit |
6c4009 |
if (__mach_port_deallocate (mach_task_self (), (mach_port_t) cookie))
|
|
Packit |
6c4009 |
{
|
|
Packit |
6c4009 |
errno = EINVAL;
|
|
Packit |
6c4009 |
return -1;
|
|
Packit |
6c4009 |
}
|
|
Packit |
6c4009 |
return 0;
|
|
Packit |
6c4009 |
}
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
FILE *
|
|
Packit |
6c4009 |
mach_open_devstream (mach_port_t dev, const char *mode)
|
|
Packit |
6c4009 |
{
|
|
Packit |
6c4009 |
FILE *stream;
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
if (mach_port_mod_refs (mach_task_self (), dev, MACH_PORT_RIGHT_SEND, 1))
|
|
Packit |
6c4009 |
{
|
|
Packit |
6c4009 |
errno = EINVAL;
|
|
Packit |
6c4009 |
return NULL;
|
|
Packit |
6c4009 |
}
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
stream = _IO_fopencookie ((void *) dev, mode,
|
|
Packit |
6c4009 |
(cookie_io_functions_t) { write: devstream_write,
|
|
Packit |
6c4009 |
read: devstream_read,
|
|
Packit |
6c4009 |
close: dealloc_ref });
|
|
Packit |
6c4009 |
if (stream == NULL)
|
|
Packit |
6c4009 |
{
|
|
Packit |
6c4009 |
__mach_port_deallocate (mach_task_self (), dev);
|
|
Packit |
6c4009 |
return NULL;
|
|
Packit |
6c4009 |
}
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
return stream;
|
|
Packit |
6c4009 |
}
|