[mirror_qemu.git] / hw / arm_sysctl.c

/*
 * Status and system control registers for ARM RealView/Versatile boards.
 *
 * Copyright (c) 2006-2007 CodeSourcery.
 * Written by Paul Brook
 *
 * This code is licensed under the GPL.
 */

#include "hw.h"
#include "qemu/timer.h"
#include "sysbus.h"
#include "primecell.h"
#include "sysemu.h"

#define LOCK_VALUE 0xa05f

typedef struct {
    SysBusDevice busdev;
    MemoryRegion iomem;
    qemu_irq pl110_mux_ctrl;

    uint32_t sys_id;
    uint32_t leds;
    uint16_t lockval;
    uint32_t cfgdata1;
    uint32_t cfgdata2;
    uint32_t flags;
    uint32_t nvflags;
    uint32_t resetlevel;
    uint32_t proc_id;
    uint32_t sys_mci;
    uint32_t sys_cfgdata;
    uint32_t sys_cfgctrl;
    uint32_t sys_cfgstat;
    uint32_t sys_clcd;
} arm_sysctl_state;

static const VMStateDescription vmstate_arm_sysctl = {
    .name = "realview_sysctl",
    .version_id = 3,
    .minimum_version_id = 1,
    .fields = (VMStateField[]) {
        VMSTATE_UINT32(leds, arm_sysctl_state),
        VMSTATE_UINT16(lockval, arm_sysctl_state),
        VMSTATE_UINT32(cfgdata1, arm_sysctl_state),
        VMSTATE_UINT32(cfgdata2, arm_sysctl_state),
        VMSTATE_UINT32(flags, arm_sysctl_state),
        VMSTATE_UINT32(nvflags, arm_sysctl_state),
        VMSTATE_UINT32(resetlevel, arm_sysctl_state),
        VMSTATE_UINT32_V(sys_mci, arm_sysctl_state, 2),
        VMSTATE_UINT32_V(sys_cfgdata, arm_sysctl_state, 2),
        VMSTATE_UINT32_V(sys_cfgctrl, arm_sysctl_state, 2),
        VMSTATE_UINT32_V(sys_cfgstat, arm_sysctl_state, 2),
        VMSTATE_UINT32_V(sys_clcd, arm_sysctl_state, 3),
        VMSTATE_END_OF_LIST()
    }
};

/* The PB926 actually uses a different format for
 * its SYS_ID register. Fortunately the bits which are
 * board type on later boards are distinct.
 */
#define BOARD_ID_PB926 0x100
#define BOARD_ID_EB 0x140
#define BOARD_ID_PBA8 0x178
#define BOARD_ID_PBX 0x182
#define BOARD_ID_VEXPRESS 0x190

static int board_id(arm_sysctl_state *s)
{
    /* Extract the board ID field from the SYS_ID register value */
    return (s->sys_id >> 16) & 0xfff;
}

static void arm_sysctl_reset(DeviceState *d)
{
    arm_sysctl_state *s = FROM_SYSBUS(arm_sysctl_state, sysbus_from_qdev(d));

    s->leds = 0;
    s->lockval = 0;
    s->cfgdata1 = 0;
    s->cfgdata2 = 0;
    s->flags = 0;
    s->resetlevel = 0;
    if (board_id(s) == BOARD_ID_VEXPRESS) {
        /* On VExpress this register will RAZ/WI */
        s->sys_clcd = 0;
    } else {
        /* All others: CLCDID 0x1f, indicating VGA */
        s->sys_clcd = 0x1f00;
    }
}

static uint64_t arm_sysctl_read(void *opaque, hwaddr offset,
                                unsigned size)
{
    arm_sysctl_state *s = (arm_sysctl_state *)opaque;

    switch (offset) {
    case 0x00: /* ID */
        return s->sys_id;
    case 0x04: /* SW */
        /* General purpose hardware switches.
           We don't have a useful way of exposing these to the user.  */
        return 0;
    case 0x08: /* LED */
        return s->leds;
    case 0x20: /* LOCK */
        return s->lockval;
    case 0x0c: /* OSC0 */
    case 0x10: /* OSC1 */
    case 0x14: /* OSC2 */
    case 0x18: /* OSC3 */
    case 0x1c: /* OSC4 */
    case 0x24: /* 100HZ */
        /* ??? Implement these.  */
        return 0;
    case 0x28: /* CFGDATA1 */
        return s->cfgdata1;
    case 0x2c: /* CFGDATA2 */
        return s->cfgdata2;
    case 0x30: /* FLAGS */
        return s->flags;
    case 0x38: /* NVFLAGS */
        return s->nvflags;
    case 0x40: /* RESETCTL */
        if (board_id(s) == BOARD_ID_VEXPRESS) {
            /* reserved: RAZ/WI */
            return 0;
        }
        return s->resetlevel;
    case 0x44: /* PCICTL */
        return 1;
    case 0x48: /* MCI */
        return s->sys_mci;
    case 0x4c: /* FLASH */
        return 0;
    case 0x50: /* CLCD */
        return s->sys_clcd;
    case 0x54: /* CLCDSER */
        return 0;
    case 0x58: /* BOOTCS */
        return 0;
    case 0x5c: /* 24MHz */
        return muldiv64(qemu_get_clock_ns(vm_clock), 24000000, get_ticks_per_sec());
    case 0x60: /* MISC */
        return 0;
    case 0x84: /* PROCID0 */
        return s->proc_id;
    case 0x88: /* PROCID1 */
        return 0xff000000;
    case 0x64: /* DMAPSR0 */
    case 0x68: /* DMAPSR1 */
    case 0x6c: /* DMAPSR2 */
    case 0x70: /* IOSEL */
    case 0x74: /* PLDCTL */
    case 0x80: /* BUSID */
    case 0x8c: /* OSCRESET0 */
    case 0x90: /* OSCRESET1 */
    case 0x94: /* OSCRESET2 */
    case 0x98: /* OSCRESET3 */
    case 0x9c: /* OSCRESET4 */
    case 0xc0: /* SYS_TEST_OSC0 */
    case 0xc4: /* SYS_TEST_OSC1 */
    case 0xc8: /* SYS_TEST_OSC2 */
    case 0xcc: /* SYS_TEST_OSC3 */
    case 0xd0: /* SYS_TEST_OSC4 */
        return 0;
    case 0xa0: /* SYS_CFGDATA */
        if (board_id(s) != BOARD_ID_VEXPRESS) {
            goto bad_reg;
        }
        return s->sys_cfgdata;
    case 0xa4: /* SYS_CFGCTRL */
        if (board_id(s) != BOARD_ID_VEXPRESS) {
            goto bad_reg;
        }
        return s->sys_cfgctrl;
    case 0xa8: /* SYS_CFGSTAT */
        if (board_id(s) != BOARD_ID_VEXPRESS) {
            goto bad_reg;
        }
        return s->sys_cfgstat;
    default:
    bad_reg:
        qemu_log_mask(LOG_GUEST_ERROR,
                      "arm_sysctl_read: Bad register offset 0x%x\n",
                      (int)offset);
        return 0;
    }
}

static void arm_sysctl_write(void *opaque, hwaddr offset,
                             uint64_t val, unsigned size)
{
    arm_sysctl_state *s = (arm_sysctl_state *)opaque;

    switch (offset) {
    case 0x08: /* LED */
        s->leds = val;
    case 0x0c: /* OSC0 */
    case 0x10: /* OSC1 */
    case 0x14: /* OSC2 */
    case 0x18: /* OSC3 */
    case 0x1c: /* OSC4 */
        /* ??? */
        break;
    case 0x20: /* LOCK */
        if (val == LOCK_VALUE)
            s->lockval = val;
        else
            s->lockval = val & 0x7fff;
        break;
    case 0x28: /* CFGDATA1 */
        /* ??? Need to implement this.  */
        s->cfgdata1 = val;
        break;
    case 0x2c: /* CFGDATA2 */
        /* ??? Need to implement this.  */
        s->cfgdata2 = val;
        break;
    case 0x30: /* FLAGSSET */
        s->flags |= val;
        break;
    case 0x34: /* FLAGSCLR */
        s->flags &= ~val;
        break;
    case 0x38: /* NVFLAGSSET */
        s->nvflags |= val;
        break;
    case 0x3c: /* NVFLAGSCLR */
        s->nvflags &= ~val;
        break;
    case 0x40: /* RESETCTL */
        switch (board_id(s)) {
        case BOARD_ID_PB926:
            if (s->lockval == LOCK_VALUE) {
                s->resetlevel = val;
                if (val & 0x100) {
                    qemu_system_reset_request();
                }
            }
            break;
        case BOARD_ID_PBX:
        case BOARD_ID_PBA8:
            if (s->lockval == LOCK_VALUE) {
                s->resetlevel = val;
                if (val & 0x04) {
                    qemu_system_reset_request();
                }
            }
            break;
        case BOARD_ID_VEXPRESS:
        case BOARD_ID_EB:
        default:
            /* reserved: RAZ/WI */
            break;
        }
        break;
    case 0x44: /* PCICTL */
        /* nothing to do.  */
        break;
    case 0x4c: /* FLASH */
        break;
    case 0x50: /* CLCD */
        switch (board_id(s)) {
        case BOARD_ID_PB926:
            /* On 926 bits 13:8 are R/O, bits 1:0 control
             * the mux that defines how to interpret the PL110
             * graphics format, and other bits are r/w but we
             * don't implement them to do anything.
             */
            s->sys_clcd &= 0x3f00;
            s->sys_clcd |= val & ~0x3f00;
            qemu_set_irq(s->pl110_mux_ctrl, val & 3);
            break;
        case BOARD_ID_EB:
            /* The EB is the same except that there is no mux since
             * the EB has a PL111.
             */
            s->sys_clcd &= 0x3f00;
            s->sys_clcd |= val & ~0x3f00;
            break;
        case BOARD_ID_PBA8:
        case BOARD_ID_PBX:
            /* On PBA8 and PBX bit 7 is r/w and all other bits
             * are either r/o or RAZ/WI.
             */
            s->sys_clcd &= (1 << 7);
            s->sys_clcd |= val & ~(1 << 7);
            break;
        case BOARD_ID_VEXPRESS:
        default:
            /* On VExpress this register is unimplemented and will RAZ/WI */
            break;
        }
    case 0x54: /* CLCDSER */
    case 0x64: /* DMAPSR0 */
    case 0x68: /* DMAPSR1 */
    case 0x6c: /* DMAPSR2 */
    case 0x70: /* IOSEL */
    case 0x74: /* PLDCTL */
    case 0x80: /* BUSID */
    case 0x84: /* PROCID0 */
    case 0x88: /* PROCID1 */
    case 0x8c: /* OSCRESET0 */
    case 0x90: /* OSCRESET1 */
    case 0x94: /* OSCRESET2 */
    case 0x98: /* OSCRESET3 */
    case 0x9c: /* OSCRESET4 */
        break;
    case 0xa0: /* SYS_CFGDATA */
        if (board_id(s) != BOARD_ID_VEXPRESS) {
            goto bad_reg;
        }
        s->sys_cfgdata = val;
        return;
    case 0xa4: /* SYS_CFGCTRL */
        if (board_id(s) != BOARD_ID_VEXPRESS) {
            goto bad_reg;
        }
        s->sys_cfgctrl = val & ~(3 << 18);
        s->sys_cfgstat = 1;            /* complete */
        switch (s->sys_cfgctrl) {
        case 0xc0800000:            /* SYS_CFG_SHUTDOWN to motherboard */
            qemu_system_shutdown_request();
            break;
        case 0xc0900000:            /* SYS_CFG_REBOOT to motherboard */
            qemu_system_reset_request();
            break;
        default:
            s->sys_cfgstat |= 2;        /* error */
        }
        return;
    case 0xa8: /* SYS_CFGSTAT */
        if (board_id(s) != BOARD_ID_VEXPRESS) {
            goto bad_reg;
        }
        s->sys_cfgstat = val & 3;
        return;
    default:
    bad_reg:
        qemu_log_mask(LOG_GUEST_ERROR,
                      "arm_sysctl_write: Bad register offset 0x%x\n",
                      (int)offset);
        return;
    }
}

static const MemoryRegionOps arm_sysctl_ops = {
    .read = arm_sysctl_read,
    .write = arm_sysctl_write,
    .endianness = DEVICE_NATIVE_ENDIAN,
};

static void arm_sysctl_gpio_set(void *opaque, int line, int level)
{
    arm_sysctl_state *s = (arm_sysctl_state *)opaque;
    switch (line) {
    case ARM_SYSCTL_GPIO_MMC_WPROT:
    {
        /* For PB926 and EB write-protect is bit 2 of SYS_MCI;
         * for all later boards it is bit 1.
         */
        int bit = 2;
        if ((board_id(s) == BOARD_ID_PB926) || (board_id(s) == BOARD_ID_EB)) {
            bit = 4;
        }
        s->sys_mci &= ~bit;
        if (level) {
            s->sys_mci |= bit;
        }
        break;
    }
    case ARM_SYSCTL_GPIO_MMC_CARDIN:
        s->sys_mci &= ~1;
        if (level) {
            s->sys_mci |= 1;
        }
        break;
    }
}

static int arm_sysctl_init(SysBusDevice *dev)
{
    arm_sysctl_state *s = FROM_SYSBUS(arm_sysctl_state, dev);

    memory_region_init_io(&s->iomem, &arm_sysctl_ops, s, "arm-sysctl", 0x1000);
    sysbus_init_mmio(dev, &s->iomem);
    qdev_init_gpio_in(&s->busdev.qdev, arm_sysctl_gpio_set, 2);
    qdev_init_gpio_out(&s->busdev.qdev, &s->pl110_mux_ctrl, 1);
    return 0;
}

static Property arm_sysctl_properties[] = {
    DEFINE_PROP_UINT32("sys_id", arm_sysctl_state, sys_id, 0),
    DEFINE_PROP_UINT32("proc_id", arm_sysctl_state, proc_id, 0),
    DEFINE_PROP_END_OF_LIST(),
};

static void arm_sysctl_class_init(ObjectClass *klass, void *data)
{
    DeviceClass *dc = DEVICE_CLASS(klass);
    SysBusDeviceClass *k = SYS_BUS_DEVICE_CLASS(klass);

    k->init = arm_sysctl_init;
    dc->reset = arm_sysctl_reset;
    dc->vmsd = &vmstate_arm_sysctl;
    dc->props = arm_sysctl_properties;
}

static TypeInfo arm_sysctl_info = {
    .name          = "realview_sysctl",
    .parent        = TYPE_SYS_BUS_DEVICE,
    .instance_size = sizeof(arm_sysctl_state),
    .class_init    = arm_sysctl_class_init,
};

static void arm_sysctl_register_types(void)
{
    type_register_static(&arm_sysctl_info);
}

type_init(arm_sysctl_register_types)
Commit	Line	Data
5fafdf24	1	/*
e69954b9 PB	2	* Status and system control registers for ARM RealView/Versatile boards.
e69954b9 PB	3	*
9ee6e8bb	4	* Copyright (c) 2006-2007 CodeSourcery.
e69954b9 PB	5	* Written by Paul Brook
e69954b9 PB	6	*
8e31bf38	7	* This code is licensed under the GPL.
e69954b9 PB	8	*/
e69954b9 PB	9
042eb37a	10	#include "hw.h"
1de7afc9	11	#include "qemu/timer.h"
82634c2d	12	#include "sysbus.h"
9596ebb7	13	#include "primecell.h"
87ecb68b	14	#include "sysemu.h"
e69954b9 PB	15
	16	#define LOCK_VALUE 0xa05f
	17
	18	typedef struct {
82634c2d	19	SysBusDevice busdev;
460d7c53	20	MemoryRegion iomem;
242ea2c6 PM	21	qemu_irq pl110_mux_ctrl;
242ea2c6 PM	22
e69954b9 PB	23	uint32_t sys_id;
	24	uint32_t leds;
	25	uint16_t lockval;
	26	uint32_t cfgdata1;
	27	uint32_t cfgdata2;
	28	uint32_t flags;
	29	uint32_t nvflags;
	30	uint32_t resetlevel;
26e92f65	31	uint32_t proc_id;
b50ff6f5	32	uint32_t sys_mci;
34933c8c PM	33	uint32_t sys_cfgdata;
	34	uint32_t sys_cfgctrl;
	35	uint32_t sys_cfgstat;
242ea2c6	36	uint32_t sys_clcd;
e69954b9 PB	37	} arm_sysctl_state;
e69954b9 PB	38
b5ad0ae7 PM	39	static const VMStateDescription vmstate_arm_sysctl = {
b5ad0ae7 PM	40	.name = "realview_sysctl",
242ea2c6	41	.version_id = 3,
b5ad0ae7 PM	42	.minimum_version_id = 1,
	43	.fields = (VMStateField[]) {
	44	VMSTATE_UINT32(leds, arm_sysctl_state),
	45	VMSTATE_UINT16(lockval, arm_sysctl_state),
	46	VMSTATE_UINT32(cfgdata1, arm_sysctl_state),
	47	VMSTATE_UINT32(cfgdata2, arm_sysctl_state),
	48	VMSTATE_UINT32(flags, arm_sysctl_state),
	49	VMSTATE_UINT32(nvflags, arm_sysctl_state),
	50	VMSTATE_UINT32(resetlevel, arm_sysctl_state),
34933c8c PM	51	VMSTATE_UINT32_V(sys_mci, arm_sysctl_state, 2),
	52	VMSTATE_UINT32_V(sys_cfgdata, arm_sysctl_state, 2),
	53	VMSTATE_UINT32_V(sys_cfgctrl, arm_sysctl_state, 2),
	54	VMSTATE_UINT32_V(sys_cfgstat, arm_sysctl_state, 2),
242ea2c6	55	VMSTATE_UINT32_V(sys_clcd, arm_sysctl_state, 3),
b5ad0ae7 PM	56	VMSTATE_END_OF_LIST()
	57	}
	58	};
	59
b50ff6f5 PM	60	/* The PB926 actually uses a different format for
	61	* its SYS_ID register. Fortunately the bits which are
	62	* board type on later boards are distinct.
	63	*/
	64	#define BOARD_ID_PB926 0x100
	65	#define BOARD_ID_EB 0x140
	66	#define BOARD_ID_PBA8 0x178
	67	#define BOARD_ID_PBX 0x182
34933c8c	68	#define BOARD_ID_VEXPRESS 0x190
b50ff6f5 PM	69
	70	static int board_id(arm_sysctl_state *s)
	71	{
	72	/* Extract the board ID field from the SYS_ID register value */
	73	return (s->sys_id >> 16) & 0xfff;
	74	}
	75
be0f204a PB	76	static void arm_sysctl_reset(DeviceState *d)
	77	{
	78	arm_sysctl_state *s = FROM_SYSBUS(arm_sysctl_state, sysbus_from_qdev(d));
	79
	80	s->leds = 0;
	81	s->lockval = 0;
	82	s->cfgdata1 = 0;
	83	s->cfgdata2 = 0;
	84	s->flags = 0;
	85	s->resetlevel = 0;
242ea2c6 PM	86	if (board_id(s) == BOARD_ID_VEXPRESS) {
	87	/* On VExpress this register will RAZ/WI */
	88	s->sys_clcd = 0;
	89	} else {
	90	/* All others: CLCDID 0x1f, indicating VGA */
	91	s->sys_clcd = 0x1f00;
	92	}
be0f204a PB	93	}
be0f204a PB	94
a8170e5e	95	static uint64_t arm_sysctl_read(void *opaque, hwaddr offset,
460d7c53	96	unsigned size)
e69954b9 PB	97	{
	98	arm_sysctl_state s = (arm_sysctl_state )opaque;
	99
e69954b9 PB	100	switch (offset) {
	101	case 0x00: /* ID */
	102	return s->sys_id;
	103	case 0x04: /* SW */
	104	/* General purpose hardware switches.
	105	We don't have a useful way of exposing these to the user. */
	106	return 0;
	107	case 0x08: /* LED */
	108	return s->leds;
	109	case 0x20: /* LOCK */
	110	return s->lockval;
	111	case 0x0c: /* OSC0 */
	112	case 0x10: /* OSC1 */
	113	case 0x14: /* OSC2 */
	114	case 0x18: /* OSC3 */
	115	case 0x1c: /* OSC4 */
	116	case 0x24: /* 100HZ */
	117	/* ??? Implement these. */
	118	return 0;
	119	case 0x28: /* CFGDATA1 */
	120	return s->cfgdata1;
	121	case 0x2c: /* CFGDATA2 */
	122	return s->cfgdata2;
	123	case 0x30: /* FLAGS */
	124	return s->flags;
	125	case 0x38: /* NVFLAGS */
	126	return s->nvflags;
	127	case 0x40: /* RESETCTL */
34933c8c PM	128	if (board_id(s) == BOARD_ID_VEXPRESS) {
	129	/* reserved: RAZ/WI */
	130	return 0;
	131	}
e69954b9 PB	132	return s->resetlevel;
	133	case 0x44: /* PCICTL */
	134	return 1;
	135	case 0x48: /* MCI */
b50ff6f5	136	return s->sys_mci;
e69954b9 PB	137	case 0x4c: /* FLASH */
	138	return 0;
	139	case 0x50: /* CLCD */
242ea2c6	140	return s->sys_clcd;
e69954b9 PB	141	case 0x54: /* CLCDSER */
	142	return 0;
	143	case 0x58: /* BOOTCS */
	144	return 0;
	145	case 0x5c: /* 24MHz */
74475455	146	return muldiv64(qemu_get_clock_ns(vm_clock), 24000000, get_ticks_per_sec());
e69954b9 PB	147	case 0x60: /* MISC */
	148	return 0;
	149	case 0x84: /* PROCID0 */
26e92f65	150	return s->proc_id;
e69954b9 PB	151	case 0x88: /* PROCID1 */
	152	return 0xff000000;
	153	case 0x64: /* DMAPSR0 */
	154	case 0x68: /* DMAPSR1 */
	155	case 0x6c: /* DMAPSR2 */
	156	case 0x70: /* IOSEL */
	157	case 0x74: /* PLDCTL */
	158	case 0x80: /* BUSID */
	159	case 0x8c: /* OSCRESET0 */
	160	case 0x90: /* OSCRESET1 */
	161	case 0x94: /* OSCRESET2 */
	162	case 0x98: /* OSCRESET3 */
	163	case 0x9c: /* OSCRESET4 */
	164	case 0xc0: /* SYS_TEST_OSC0 */
	165	case 0xc4: /* SYS_TEST_OSC1 */
	166	case 0xc8: /* SYS_TEST_OSC2 */
	167	case 0xcc: /* SYS_TEST_OSC3 */
	168	case 0xd0: /* SYS_TEST_OSC4 */
	169	return 0;
34933c8c PM	170	case 0xa0: /* SYS_CFGDATA */
	171	if (board_id(s) != BOARD_ID_VEXPRESS) {
	172	goto bad_reg;
	173	}
	174	return s->sys_cfgdata;
	175	case 0xa4: /* SYS_CFGCTRL */
	176	if (board_id(s) != BOARD_ID_VEXPRESS) {
	177	goto bad_reg;
	178	}
	179	return s->sys_cfgctrl;
	180	case 0xa8: /* SYS_CFGSTAT */
	181	if (board_id(s) != BOARD_ID_VEXPRESS) {
	182	goto bad_reg;
	183	}
	184	return s->sys_cfgstat;
e69954b9	185	default:
34933c8c	186	bad_reg:
0c896f06 PM	187	qemu_log_mask(LOG_GUEST_ERROR,
	188	"arm_sysctl_read: Bad register offset 0x%x\n",
	189	(int)offset);
e69954b9 PB	190	return 0;
	191	}
	192	}
	193
a8170e5e	194	static void arm_sysctl_write(void *opaque, hwaddr offset,
460d7c53	195	uint64_t val, unsigned size)
e69954b9 PB	196	{
e69954b9 PB	197	arm_sysctl_state s = (arm_sysctl_state )opaque;
e69954b9 PB	198
	199	switch (offset) {
	200	case 0x08: /* LED */
	201	s->leds = val;
	202	case 0x0c: /* OSC0 */
	203	case 0x10: /* OSC1 */
	204	case 0x14: /* OSC2 */
	205	case 0x18: /* OSC3 */
	206	case 0x1c: /* OSC4 */
	207	/* ??? */
	208	break;
	209	case 0x20: /* LOCK */
	210	if (val == LOCK_VALUE)
	211	s->lockval = val;
	212	else
	213	s->lockval = val & 0x7fff;
	214	break;
	215	case 0x28: /* CFGDATA1 */
	216	/* ??? Need to implement this. */
	217	s->cfgdata1 = val;
	218	break;
	219	case 0x2c: /* CFGDATA2 */
	220	/* ??? Need to implement this. */
	221	s->cfgdata2 = val;
	222	break;
	223	case 0x30: /* FLAGSSET */
	224	s->flags \|= val;
	225	break;
	226	case 0x34: /* FLAGSCLR */
	227	s->flags &= ~val;
	228	break;
	229	case 0x38: /* NVFLAGSSET */
	230	s->nvflags \|= val;
	231	break;
	232	case 0x3c: /* NVFLAGSCLR */
	233	s->nvflags &= ~val;
	234	break;
	235	case 0x40: /* RESETCTL */
b2887c43 JCD	236	switch (board_id(s)) {
	237	case BOARD_ID_PB926:
	238	if (s->lockval == LOCK_VALUE) {
	239	s->resetlevel = val;
	240	if (val & 0x100) {
	241	qemu_system_reset_request();
	242	}
	243	}
	244	break;
	245	case BOARD_ID_PBX:
	246	case BOARD_ID_PBA8:
	247	if (s->lockval == LOCK_VALUE) {
	248	s->resetlevel = val;
	249	if (val & 0x04) {
	250	qemu_system_reset_request();
	251	}
	252	}
	253	break;
	254	case BOARD_ID_VEXPRESS:
	255	case BOARD_ID_EB:
	256	default:
34933c8c PM	257	/* reserved: RAZ/WI */
	258	break;
	259	}
e69954b9 PB	260	break;
	261	case 0x44: /* PCICTL */
	262	/* nothing to do. */
	263	break;
	264	case 0x4c: /* FLASH */
242ea2c6	265	break;
e69954b9	266	case 0x50: /* CLCD */
242ea2c6 PM	267	switch (board_id(s)) {
	268	case BOARD_ID_PB926:
	269	/* On 926 bits 13:8 are R/O, bits 1:0 control
	270	* the mux that defines how to interpret the PL110
	271	* graphics format, and other bits are r/w but we
	272	* don't implement them to do anything.
	273	*/
	274	s->sys_clcd &= 0x3f00;
	275	s->sys_clcd \|= val & ~0x3f00;
	276	qemu_set_irq(s->pl110_mux_ctrl, val & 3);
	277	break;
	278	case BOARD_ID_EB:
	279	/* The EB is the same except that there is no mux since
	280	* the EB has a PL111.
	281	*/
	282	s->sys_clcd &= 0x3f00;
	283	s->sys_clcd \|= val & ~0x3f00;
	284	break;
	285	case BOARD_ID_PBA8:
	286	case BOARD_ID_PBX:
	287	/* On PBA8 and PBX bit 7 is r/w and all other bits
	288	* are either r/o or RAZ/WI.
	289	*/
	290	s->sys_clcd &= (1 << 7);
	291	s->sys_clcd \|= val & ~(1 << 7);
	292	break;
	293	case BOARD_ID_VEXPRESS:
	294	default:
	295	/* On VExpress this register is unimplemented and will RAZ/WI */
	296	break;
	297	}
e69954b9 PB	298	case 0x54: /* CLCDSER */
	299	case 0x64: /* DMAPSR0 */
	300	case 0x68: /* DMAPSR1 */
	301	case 0x6c: /* DMAPSR2 */
	302	case 0x70: /* IOSEL */
	303	case 0x74: /* PLDCTL */
	304	case 0x80: /* BUSID */
	305	case 0x84: /* PROCID0 */
	306	case 0x88: /* PROCID1 */
	307	case 0x8c: /* OSCRESET0 */
	308	case 0x90: /* OSCRESET1 */
	309	case 0x94: /* OSCRESET2 */
	310	case 0x98: /* OSCRESET3 */
	311	case 0x9c: /* OSCRESET4 */
	312	break;
34933c8c PM	313	case 0xa0: /* SYS_CFGDATA */
	314	if (board_id(s) != BOARD_ID_VEXPRESS) {
	315	goto bad_reg;
	316	}
	317	s->sys_cfgdata = val;
	318	return;
	319	case 0xa4: /* SYS_CFGCTRL */
	320	if (board_id(s) != BOARD_ID_VEXPRESS) {
	321	goto bad_reg;
	322	}
	323	s->sys_cfgctrl = val & ~(3 << 18);
	324	s->sys_cfgstat = 1; /* complete */
	325	switch (s->sys_cfgctrl) {
	326	case 0xc0800000: /* SYS_CFG_SHUTDOWN to motherboard */
	327	qemu_system_shutdown_request();
	328	break;
	329	case 0xc0900000: /* SYS_CFG_REBOOT to motherboard */
	330	qemu_system_reset_request();
	331	break;
	332	default:
	333	s->sys_cfgstat \|= 2; /* error */
	334	}
	335	return;
	336	case 0xa8: /* SYS_CFGSTAT */
	337	if (board_id(s) != BOARD_ID_VEXPRESS) {
	338	goto bad_reg;
	339	}
	340	s->sys_cfgstat = val & 3;
	341	return;
e69954b9	342	default:
34933c8c	343	bad_reg:
0c896f06 PM	344	qemu_log_mask(LOG_GUEST_ERROR,
	345	"arm_sysctl_write: Bad register offset 0x%x\n",
	346	(int)offset);
e69954b9 PB	347	return;
	348	}
	349	}
	350
460d7c53 AK	351	static const MemoryRegionOps arm_sysctl_ops = {
	352	.read = arm_sysctl_read,
	353	.write = arm_sysctl_write,
	354	.endianness = DEVICE_NATIVE_ENDIAN,
e69954b9 PB	355	};
e69954b9 PB	356
b50ff6f5 PM	357	static void arm_sysctl_gpio_set(void *opaque, int line, int level)
	358	{
	359	arm_sysctl_state s = (arm_sysctl_state )opaque;
	360	switch (line) {
	361	case ARM_SYSCTL_GPIO_MMC_WPROT:
	362	{
	363	/* For PB926 and EB write-protect is bit 2 of SYS_MCI;
	364	* for all later boards it is bit 1.
	365	*/
	366	int bit = 2;
	367	if ((board_id(s) == BOARD_ID_PB926) \|\| (board_id(s) == BOARD_ID_EB)) {
	368	bit = 4;
	369	}
	370	s->sys_mci &= ~bit;
	371	if (level) {
	372	s->sys_mci \|= bit;
	373	}
	374	break;
	375	}
	376	case ARM_SYSCTL_GPIO_MMC_CARDIN:
	377	s->sys_mci &= ~1;
	378	if (level) {
	379	s->sys_mci \|= 1;
	380	}
	381	break;
	382	}
	383	}
	384
54de1e5b	385	static int arm_sysctl_init(SysBusDevice *dev)
e69954b9	386	{
82634c2d	387	arm_sysctl_state *s = FROM_SYSBUS(arm_sysctl_state, dev);
e69954b9	388
460d7c53	389	memory_region_init_io(&s->iomem, &arm_sysctl_ops, s, "arm-sysctl", 0x1000);
750ecd44	390	sysbus_init_mmio(dev, &s->iomem);
b50ff6f5	391	qdev_init_gpio_in(&s->busdev.qdev, arm_sysctl_gpio_set, 2);
242ea2c6	392	qdev_init_gpio_out(&s->busdev.qdev, &s->pl110_mux_ctrl, 1);
81a322d4	393	return 0;
e69954b9	394	}
82634c2d	395
999e12bb AL	396	static Property arm_sysctl_properties[] = {
	397	DEFINE_PROP_UINT32("sys_id", arm_sysctl_state, sys_id, 0),
	398	DEFINE_PROP_UINT32("proc_id", arm_sysctl_state, proc_id, 0),
	399	DEFINE_PROP_END_OF_LIST(),
	400	};
	401
	402	static void arm_sysctl_class_init(ObjectClass klass, void data)
	403	{
39bffca2	404	DeviceClass *dc = DEVICE_CLASS(klass);
999e12bb AL	405	SysBusDeviceClass *k = SYS_BUS_DEVICE_CLASS(klass);
999e12bb AL	406
54de1e5b	407	k->init = arm_sysctl_init;
39bffca2 AL	408	dc->reset = arm_sysctl_reset;
	409	dc->vmsd = &vmstate_arm_sysctl;
	410	dc->props = arm_sysctl_properties;
999e12bb AL	411	}
999e12bb AL	412
39bffca2 AL	413	static TypeInfo arm_sysctl_info = {
	414	.name = "realview_sysctl",
	415	.parent = TYPE_SYS_BUS_DEVICE,
	416	.instance_size = sizeof(arm_sysctl_state),
	417	.class_init = arm_sysctl_class_init,
ee6847d1 GH	418	};
ee6847d1 GH	419
83f7d43a	420	static void arm_sysctl_register_types(void)
82634c2d	421	{
39bffca2	422	type_register_static(&arm_sysctl_info);
82634c2d PB	423	}
82634c2d PB	424
83f7d43a	425	type_init(arm_sysctl_register_types)