![Jörn Engel](/assets/img/avatar_default.png)
Signed-off-by: Jörn Engel <joern@wohnheim.fh-wedel.de> Signed-off-by: Adrian Bunk <bunk@stusta.de>
173 lines
3.9 KiB
C
173 lines
3.9 KiB
C
/*
|
||
* arch/v850/kernel/sim.c -- Machine-specific stuff for GDB v850e simulator
|
||
*
|
||
* Copyright (C) 2001,02 NEC Corporation
|
||
* Copyright (C) 2001,02 Miles Bader <miles@gnu.org>
|
||
*
|
||
* This file is subject to the terms and conditions of the GNU General
|
||
* Public License. See the file COPYING in the main directory of this
|
||
* archive for more details.
|
||
*
|
||
* Written by Miles Bader <miles@gnu.org>
|
||
*/
|
||
|
||
#include <linux/kernel.h>
|
||
#include <linux/module.h>
|
||
#include <linux/init.h>
|
||
#include <linux/mm.h>
|
||
#include <linux/swap.h>
|
||
#include <linux/bootmem.h>
|
||
#include <linux/irq.h>
|
||
|
||
#include <asm/atomic.h>
|
||
#include <asm/page.h>
|
||
#include <asm/machdep.h>
|
||
#include <asm/simsyscall.h>
|
||
|
||
#include "mach.h"
|
||
|
||
/* The name of a file containing the root filesystem. */
|
||
#define ROOT_FS "rootfs.image"
|
||
|
||
extern void simcons_setup (void);
|
||
extern void simcons_poll_ttys (void);
|
||
extern void set_mem_root (void *addr, size_t len, char *cmd_line);
|
||
|
||
static int read_file (const char *name,
|
||
unsigned long *addr, unsigned long *len,
|
||
const char **err);
|
||
|
||
void __init mach_setup (char **cmdline)
|
||
{
|
||
const char *err;
|
||
unsigned long root_dev_addr, root_dev_len;
|
||
|
||
simcons_setup ();
|
||
|
||
printk (KERN_INFO "Reading root filesystem: %s", ROOT_FS);
|
||
|
||
if (read_file (ROOT_FS, &root_dev_addr, &root_dev_len, &err)) {
|
||
printk (" (size %luK)\n", root_dev_len / 1024);
|
||
set_mem_root ((void *)root_dev_addr, (size_t)root_dev_len,
|
||
*cmdline);
|
||
} else
|
||
printk ("...%s failed!\n", err);
|
||
}
|
||
|
||
void mach_get_physical_ram (unsigned long *ram_start, unsigned long *ram_len)
|
||
{
|
||
*ram_start = RAM_ADDR;
|
||
*ram_len = RAM_SIZE;
|
||
}
|
||
|
||
void __init mach_sched_init (struct irqaction *timer_action)
|
||
{
|
||
/* ...do magic timer initialization?... */
|
||
mach_tick = simcons_poll_ttys;
|
||
setup_irq (0, timer_action);
|
||
}
|
||
|
||
|
||
static void irq_nop (unsigned irq) { }
|
||
static unsigned irq_zero (unsigned irq) { return 0; }
|
||
|
||
static struct hw_interrupt_type sim_irq_type = {
|
||
.typename = "IRQ",
|
||
.startup = irq_zero, /* startup */
|
||
.shutdown = irq_nop, /* shutdown */
|
||
.enable = irq_nop, /* enable */
|
||
.disable = irq_nop, /* disable */
|
||
.ack = irq_nop, /* ack */
|
||
.end = irq_nop, /* end */
|
||
};
|
||
|
||
void __init mach_init_irqs (void)
|
||
{
|
||
init_irq_handlers (0, NUM_MACH_IRQS, 1, &sim_irq_type);
|
||
}
|
||
|
||
|
||
void mach_gettimeofday (struct timespec *tv)
|
||
{
|
||
long timeval[2], timezone[2];
|
||
int rval = V850_SIM_SYSCALL (gettimeofday, timeval, timezone);
|
||
if (rval == 0) {
|
||
tv->tv_sec = timeval[0];
|
||
tv->tv_nsec = timeval[1] * 1000;
|
||
}
|
||
}
|
||
|
||
void machine_restart (char *__unused)
|
||
{
|
||
V850_SIM_SYSCALL (write, 1, "RESTART\n", 8);
|
||
V850_SIM_SYSCALL (exit, 0);
|
||
}
|
||
|
||
void machine_halt (void)
|
||
{
|
||
V850_SIM_SYSCALL (write, 1, "HALT\n", 5);
|
||
V850_SIM_SYSCALL (exit, 0);
|
||
}
|
||
|
||
void machine_power_off (void)
|
||
{
|
||
V850_SIM_SYSCALL (write, 1, "POWER OFF\n", 10);
|
||
V850_SIM_SYSCALL (exit, 0);
|
||
}
|
||
|
||
|
||
/* Load data from a file called NAME into ram. The address and length
|
||
of the data image are returned in ADDR and LEN. */
|
||
static int __init
|
||
read_file (const char *name,
|
||
unsigned long *addr, unsigned long *len,
|
||
const char **err)
|
||
{
|
||
int rval, fd;
|
||
unsigned long cur, left;
|
||
/* Note this is not a normal stat buffer, it's an ad-hoc
|
||
structure defined by the simulator. */
|
||
unsigned long stat_buf[10];
|
||
|
||
/* Stat the file to find out the length. */
|
||
rval = V850_SIM_SYSCALL (stat, name, stat_buf);
|
||
if (rval < 0) {
|
||
if (err) *err = "stat";
|
||
return 0;
|
||
}
|
||
*len = stat_buf[4];
|
||
|
||
/* Open the file; `0' is O_RDONLY. */
|
||
fd = V850_SIM_SYSCALL (open, name, 0);
|
||
if (fd < 0) {
|
||
if (err) *err = "open";
|
||
return 0;
|
||
}
|
||
|
||
*addr = (unsigned long)alloc_bootmem(*len);
|
||
if (! *addr) {
|
||
V850_SIM_SYSCALL (close, fd);
|
||
if (err) *err = "alloc_bootmem";
|
||
return 0;
|
||
}
|
||
|
||
cur = *addr;
|
||
left = *len;
|
||
while (left > 0) {
|
||
int chunk = V850_SIM_SYSCALL (read, fd, cur, left);
|
||
if (chunk <= 0)
|
||
break;
|
||
cur += chunk;
|
||
left -= chunk;
|
||
}
|
||
V850_SIM_SYSCALL (close, fd);
|
||
if (left > 0) {
|
||
/* Some read failed. */
|
||
free_bootmem (*addr, *len);
|
||
if (err) *err = "read";
|
||
return 0;
|
||
}
|
||
|
||
return 1;
|
||
}
|