1// SPDX-License-Identifier: GPL-2.0
  2
  3#include <linux/reboot.h>
  4#include <linux/serial_core.h>
  5#include <clocksource/timer-goldfish.h>
  6
  7#include <asm/bootinfo.h>
  8#include <asm/bootinfo-virt.h>
  9#include <asm/byteorder.h>
 10#include <asm/machdep.h>
 11#include <asm/virt.h>
 12#include <asm/config.h>
 13
 14struct virt_booter_data virt_bi_data;
 15
 16#define VIRT_CTRL_REG_FEATURES	0x00
 17#define VIRT_CTRL_REG_CMD	0x04
 18
 19static struct resource ctrlres;
 20
 21enum {
 22	CMD_NOOP,
 23	CMD_RESET,
 24	CMD_HALT,
 25	CMD_PANIC,
 26};
 27
 28static void virt_get_model(char *str)
 29{
 30	/* str is 80 characters long */
 31	sprintf(str, "QEMU Virtual M68K Machine (%u.%u.%u)",
 32		(u8)(virt_bi_data.qemu_version >> 24),
 33		(u8)(virt_bi_data.qemu_version >> 16),
 34		(u8)(virt_bi_data.qemu_version >> 8));
 35}
 36
 37static void virt_halt(void)
 38{
 39	void __iomem *base = (void __iomem *)virt_bi_data.ctrl.mmio;
 40
 41	iowrite32be(CMD_HALT, base + VIRT_CTRL_REG_CMD);
 42	local_irq_disable();
 43	while (1)
 44		;
 45}
 46
 47static void virt_reset(void)
 48{
 49	void __iomem *base = (void __iomem *)virt_bi_data.ctrl.mmio;
 50
 51	iowrite32be(CMD_RESET, base + VIRT_CTRL_REG_CMD);
 52	local_irq_disable();
 53	while (1)
 54		;
 55}
 56
 57/*
 58 * Parse a virtual-m68k-specific record in the bootinfo
 59 */
 60
 61int __init virt_parse_bootinfo(const struct bi_record *record)
 62{
 63	int unknown = 0;
 64	const void *data = record->data;
 65
 66	switch (be16_to_cpu(record->tag)) {
 67	case BI_VIRT_QEMU_VERSION:
 68		virt_bi_data.qemu_version = be32_to_cpup(data);
 69		break;
 70	case BI_VIRT_GF_PIC_BASE:
 71		virt_bi_data.pic.mmio = be32_to_cpup(data);
 72		data += 4;
 73		virt_bi_data.pic.irq = be32_to_cpup(data);
 74		break;
 75	case BI_VIRT_GF_RTC_BASE:
 76		virt_bi_data.rtc.mmio = be32_to_cpup(data);
 77		data += 4;
 78		virt_bi_data.rtc.irq = be32_to_cpup(data);
 79		break;
 80	case BI_VIRT_GF_TTY_BASE:
 81		virt_bi_data.tty.mmio = be32_to_cpup(data);
 82		data += 4;
 83		virt_bi_data.tty.irq = be32_to_cpup(data);
 84		break;
 85	case BI_VIRT_CTRL_BASE:
 86		virt_bi_data.ctrl.mmio = be32_to_cpup(data);
 87		data += 4;
 88		virt_bi_data.ctrl.irq = be32_to_cpup(data);
 89		break;
 90	case BI_VIRT_VIRTIO_BASE:
 91		virt_bi_data.virtio.mmio = be32_to_cpup(data);
 92		data += 4;
 93		virt_bi_data.virtio.irq = be32_to_cpup(data);
 94		break;
 95	default:
 96		unknown = 1;
 97		break;
 98	}
 99	return unknown;
100}
101
102static void __init virt_sched_init(void)
103{
104	goldfish_timer_init(virt_bi_data.rtc.irq,
105			    (void __iomem *)virt_bi_data.rtc.mmio);
106}
107
108void __init config_virt(void)
109{
110	char earlycon[24];
111
112	snprintf(earlycon, sizeof(earlycon), "early_gf_tty,0x%08x",
113		 virt_bi_data.tty.mmio);
114	setup_earlycon(earlycon);
115
116	ctrlres = (struct resource)
117		   DEFINE_RES_MEM_NAMED(virt_bi_data.ctrl.mmio, 0x100,
118					"virtctrl");
119
120	if (request_resource(&iomem_resource, &ctrlres)) {
121		pr_err("Cannot allocate virt controller resource\n");
122		return;
123	}
124
125	mach_init_IRQ = virt_init_IRQ;
126	mach_sched_init = virt_sched_init;
127	mach_get_model = virt_get_model;
128	mach_reset = virt_reset;
129	mach_halt = virt_halt;
130
131	register_platform_power_off(virt_halt);
132}