/*
* Copyright (c) 2006 Ondrej Palkovsky
* All rights reserved.
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions
* are met:
*
* - Redistributions of source code must retain the above copyright
* notice, this list of conditions and the following disclaimer.
* - Redistributions in binary form must reproduce the above copyright
* notice, this list of conditions and the following disclaimer in the
* documentation and/or other materials provided with the distribution.
* - The name of the author may not be used to endorse or promote products
* derived from this software without specific prior written permission.
*
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
* 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.
*/
/** @addtogroup kio
* @{
*/
/**
* @file
*/
#include <stdio.h>
#include <async.h>
#include <as.h>
#include <ddi.h>
#include <errno.h>
#include <str_error.h>
#include <io/kio.h>
#include <sysinfo.h>
#include <stdlib.h>
#include <fibril_synch.h>
#include <adt/list.h>
#include <adt/prodcons.h>
#include <tinput.h>
#include <vfs/vfs.h>
#define NAME "kio"
#define LOG_FNAME "/log/kio"
/* Producer/consumer buffers */
typedef struct {
link_t link;
size_t length;
char32_t *data;
} item_t;
static prodcons_t pc;
/* Pointer to kio area */
static char32_t *kio = (char32_t *) AS_AREA_ANY;
static size_t kio_length;
/* Notification mutex */
static FIBRIL_MUTEX_INITIALIZE(mtx);
/** Klog producer
*
* Copies the contents of a character buffer to local
* producer/consumer queue.
*
* @param length Number of characters to copy.
* @param data Pointer to the kernel kio buffer.
*
*/
static void producer(size_t length, char32_t *data)
{
item_t *item = (item_t *) malloc(sizeof(item_t));
if (item == NULL)
return;
size_t sz = sizeof(char32_t) * length;
char32_t *buf = (char32_t *) malloc(sz);
if (buf == NULL) {
free(item);
return;
}
memcpy(buf, data, sz);
link_initialize(&item->link);
item->length = length;
item->data = buf;
prodcons_produce(&pc, &item->link);
}
/** Klog consumer
*
* Waits in an infinite loop for the character data created by
* the producer and outputs them to stdout and optionally into
* a file.
*
* @param data Unused.
*
* @return Always EOK (unreachable).
*
*/
static errno_t consumer(void *data)
{
FILE *log = fopen(LOG_FNAME, "a");
if (log == NULL)
printf("%s: Unable to create log file %s (%s)\n", NAME, LOG_FNAME,
str_error(errno));
while (true) {
link_t *link = prodcons_consume(&pc);
item_t *item = list_get_instance(link, item_t, link);
for (size_t i = 0; i < item->length; i++)
putuchar(item->data[i]);
if (log != NULL) {
for (size_t i = 0; i < item->length; i++)
fputuc(item->data[i], log);
fflush(log);
vfs_sync(fileno(log));
}
free(item->data);
free(item);
}
fclose(log);
return EOK;
}
/** Kernel notification handler
*
* Receives kernel kio notifications.
*
* @param call IPC call structure
* @param arg Local argument
*
*/
static void kio_notification_handler(ipc_call_t *call, void *arg)
{
/*
* Make sure we process only a single notification
* at any time to limit the chance of the consumer
* starving.
*
* Note: Usually the automatic masking of the kio
* notifications on the kernel side does the trick
* of limiting the chance of accidentally copying
* the same data multiple times. However, due to
* the non-blocking architecture of kio notifications,
* this possibility cannot be generally avoided.
*/
fibril_mutex_lock(&mtx);
size_t kio_start = (size_t) ipc_get_arg1(call);
size_t kio_len = (size_t) ipc_get_arg2(call);
size_t kio_stored = (size_t) ipc_get_arg3(call);
size_t offset = (kio_start + kio_len - kio_stored) % kio_length;
/* Copy data from the ring buffer */
if (offset + kio_stored >= kio_length) {
size_t split = kio_length - offset;
producer(split, kio + offset);
producer(kio_stored - split, kio);
} else
producer(kio_stored, kio + offset);
async_event_unmask(EVENT_KIO);
fibril_mutex_unlock(&mtx);
}
int main(int argc, char *argv[])
{
size_t pages;
errno_t rc = sysinfo_get_value("kio.pages", &pages);
if (rc != EOK) {
fprintf(stderr, "%s: Unable to get number of kio pages\n",
NAME);
return rc;
}
uintptr_t faddr;
rc = sysinfo_get_value("kio.faddr", &faddr);
if (rc != EOK) {
fprintf(stderr, "%s: Unable to get kio physical address\n",
NAME);
return rc;
}
size_t size = pages * PAGE_SIZE;
kio_length = size / sizeof(char32_t);
rc = physmem_map(faddr, pages, AS_AREA_READ | AS_AREA_CACHEABLE,
(void *) &kio);
if (rc != EOK) {
fprintf(stderr, "%s: Unable to map kio\n", NAME);
return rc;
}
prodcons_initialize(&pc);
rc = async_event_subscribe(EVENT_KIO, kio_notification_handler, NULL);
if (rc != EOK) {
fprintf(stderr, "%s: Unable to register kio notifications\n",
NAME);
return rc;
}
fid_t fid = fibril_create(consumer, NULL);
if (!fid) {
fprintf(stderr, "%s: Unable to create consumer fibril\n",
NAME);
return ENOMEM;
}
tinput_t *input = tinput_new();
if (!input) {
fprintf(stderr, "%s: Could not create input\n", NAME);
return ENOMEM;
}
fibril_add_ready(fid);
async_event_unmask(EVENT_KIO);
kio_update();
tinput_set_prompt(input, "kio> ");
char *str;
while ((rc = tinput_read(input, &str)) == EOK) {
if (str_cmp(str, "") == 0) {
free(str);
continue;
}
kio_command(str, str_size(str));
free(str);
}
if (rc == ENOENT)
rc = EOK;
return EOK;
}
/** @}
*/