Subversion Repositories c0or1k

 
#include <l4/platform/realview/uart.h>
#include <l4/lib/spinlock.h>
#include INC_PLAT(offsets.h)
#include INC_ARCH(io.h)
 
extern struct spinlock printk_lock;
 
void print_early(char *str)
{
	unsigned int reg = 0;
	unsigned long uart_base;
	unsigned long irq_state;
 
	/* Check if mmu is on */
	__asm__ __volatile__ (
		"mrc     p15, 0, %0, c1, c0"
		: "=r" (reg)
                : "r" (reg)
	);
 
	/*
	 * Get uart phys/virt base based on mmu on/off
	 * Also strings are linked at virtual address, so if
	 * we are running with mmu off we should translate
	 * string address to physical
	 */
	if (reg & 1) {
		spin_lock_irq(&printk_lock, &irq_state);
		uart_base = PLATFORM_CONSOLE_VBASE;
	}
	else {
		uart_base = PLATFORM_UART0_BASE;
		str = (char *)(((unsigned long)str & ~KERNEL_AREA_START) |
			       PLATFORM_PHYS_MEM_START);
	}
 
	/* call uart tx function */
	while (*str != '\0') {
		uart_tx_char(uart_base, *str);
 
		if (*str == '\n')
			uart_tx_char(uart_base, '\r');
 
		++str;
	}
	if (reg & 1)
		spin_unlock_irq(&printk_lock, irq_state);
}
 
void printhex8(unsigned int val)
{
	char hexbuf[16];
	char *temp = hexbuf + 15;
	int v;
 
	/* put end of string */
	*(temp--) = '\0';
 
	if (!val) {
		*temp = '0';
	}
	else {
		while (val) {
			v = val & 0xf;
			val = val >> 4;
			--temp;
 
			/* convert decimal value to ascii */
			if (v >= 10)
				v += ('a' - 10);
			else
				v = v + '0';
 
			*temp = *((char *)&v);
		}
	}
 
	*(--temp) = 'x';
	*(--temp) = '0';
	print_early(temp);
}