99 lines
2.2 KiB
C
99 lines
2.2 KiB
C
/*
|
|
* Copyright 2010 Stefan Lankes, Chair for Operating Systems,
|
|
* RWTH Aachen University
|
|
*
|
|
* Licensed under the Apache License, Version 2.0 (the "License");
|
|
* you may not use this file except in compliance with the License.
|
|
* You may obtain a copy of the License at
|
|
*
|
|
* http://www.apache.org/licenses/LICENSE-2.0
|
|
*
|
|
* Unless required by applicable law or agreed to in writing, software
|
|
* distributed under the License is distributed on an "AS IS" BASIS,
|
|
* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
|
* See the License for the specific language governing permissions and
|
|
* limitations under the License.
|
|
*
|
|
* This file is part of MetalSVM.
|
|
*/
|
|
|
|
#include <metalsvm/stdio.h>
|
|
#include <metalsvm/string.h>
|
|
#include <metalsvm/stdarg.h>
|
|
#include <metalsvm/tasks.h>
|
|
#include <metalsvm/semaphore.h>
|
|
#include <asm/atomic.h>
|
|
#include <asm/processor.h>
|
|
#include <asm/io.h>
|
|
#ifdef CONFIG_VGA
|
|
#include <asm/vga.h>
|
|
#endif
|
|
|
|
#define NO_EARLY_PRINT 0
|
|
#define VGA_EARLY_PRINT 1
|
|
#define UART_EARLY_PRINT 2
|
|
|
|
#ifdef CONFIG_VGA
|
|
static uint32_t early_print = VGA_EARLY_PRINT;
|
|
#elif defined(CONFIG_UART)
|
|
static uint32_t early_print = UART_EARLY_PRINT;
|
|
#else
|
|
static uint32_t early_print = NO_EARLY_PRINT;
|
|
#endif
|
|
static atomic_int32_t kmsg_counter = ATOMIC_INIT(0);
|
|
static unsigned char kmessages[KMSG_SIZE] __attribute__ ((section(".kmsg"))) = {[0 ... KMSG_SIZE-1] = 0x00};
|
|
|
|
int koutput_init(void)
|
|
{
|
|
#ifdef CONFIG_VGA
|
|
vga_init();
|
|
#endif
|
|
|
|
return 0;
|
|
}
|
|
|
|
int kputchar(int c)
|
|
{
|
|
int pos;
|
|
|
|
pos = atomic_int32_inc(&kmsg_counter);
|
|
kmessages[pos % KMSG_SIZE] = (unsigned char) c;
|
|
#ifdef CONFIG_VGA
|
|
if (early_print == VGA_EARLY_PRINT)
|
|
vga_putchar(c);
|
|
#endif
|
|
#ifdef CONFIG_UART
|
|
if (early_print == UART_EARLY_PRINT)
|
|
uart_putchar(c);
|
|
#endif
|
|
|
|
return 1;
|
|
}
|
|
|
|
int kputs(const char *str)
|
|
{
|
|
int pos;
|
|
int i;
|
|
|
|
for(i=0; str[i] != '\0'; i++) {
|
|
pos = atomic_int32_inc(&kmsg_counter);
|
|
kmessages[pos % KMSG_SIZE] = str[i];
|
|
#ifdef CONFIG_VGA
|
|
if (early_print == VGA_EARLY_PRINT)
|
|
vga_putchar(str[i]);
|
|
#endif
|
|
#ifdef CONFIG_UART
|
|
if (early_print == UART_EARLY_PRINT)
|
|
uart_putchar(str[i]);
|
|
#endif
|
|
}
|
|
|
|
return i;
|
|
}
|
|
|
|
int kflush(void)
|
|
{
|
|
flush_cache();
|
|
|
|
return 0;
|
|
}
|