arch/h8300/kernel/sim-console.c


1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31

/*
 * arch/h8300/kernel/sim-console.c
 *
 *  Copyright (C) 2015 Yoshinori Sato <ysato@users.sourceforge.jp>
 *
 * 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.
 */
#include <linux/console.h>
#include <linux/init.h>
#include <linux/serial_core.h>

static void sim_write(struct console *con, const char *s, unsigned n)
{
	register const char *_ptr __asm__("er1") = s;
	register const unsigned _len __asm__("er2") = n;

	__asm__("sub.l er0,er0\n\t"		/* er0 = 1 (stdout) */
		"inc.l #1,er0\n\t"
		".byte 0x5e,0x00,0x00,0xc7\n\t" /* jsr @0xc7 (sys_write) */
		: : "g"(_ptr), "g"(_len):"er0");
}

static int __init sim_setup(struct earlycon_device *device, const char *opt)
{
	device->con->write = sim_write;
	return 0;
}

EARLYCON_DECLARE(h8sim, sim_setup);