169 lines
		
	
	
		
			4.6 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
		
		
			
		
	
	
			169 lines
		
	
	
		
			4.6 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
|   | /*
 | ||
|  |  * Allwinner Security ID emulation | ||
|  |  * | ||
|  |  * Copyright (C) 2019 Niek Linnenbank <nieklinnenbank@gmail.com> | ||
|  |  * | ||
|  |  * This program is free software: you can redistribute it and/or modify | ||
|  |  * it under the terms of the GNU General Public License as published by | ||
|  |  * the Free Software Foundation, either version 2 of the License, or | ||
|  |  * (at your option) any later version. | ||
|  |  * | ||
|  |  * This program is distributed in the hope that it will be useful, | ||
|  |  * but WITHOUT ANY WARRANTY; without even the implied warranty of | ||
|  |  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the | ||
|  |  * GNU General Public License for more details. | ||
|  |  * | ||
|  |  * You should have received a copy of the GNU General Public License | ||
|  |  * along with this program.  If not, see <http://www.gnu.org/licenses/>.
 | ||
|  |  */ | ||
|  | 
 | ||
|  | #include "qemu/osdep.h"
 | ||
|  | #include "qemu/units.h"
 | ||
|  | #include "hw/sysbus.h"
 | ||
|  | #include "migration/vmstate.h"
 | ||
|  | #include "qemu/log.h"
 | ||
|  | #include "qemu/module.h"
 | ||
|  | #include "qemu/guest-random.h"
 | ||
|  | #include "qapi/error.h"
 | ||
|  | #include "hw/qdev-properties.h"
 | ||
|  | #include "hw/misc/allwinner-sid.h"
 | ||
|  | #include "trace.h"
 | ||
|  | 
 | ||
|  | /* SID register offsets */ | ||
|  | enum { | ||
|  |     REG_PRCTL = 0x40,   /* Control */ | ||
|  |     REG_RDKEY = 0x60,   /* Read Key */ | ||
|  | }; | ||
|  | 
 | ||
|  | /* SID register flags */ | ||
|  | enum { | ||
|  |     REG_PRCTL_WRITE   = 0x0002, /* Unknown write flag */ | ||
|  |     REG_PRCTL_OP_LOCK = 0xAC00, /* Lock operation */ | ||
|  | }; | ||
|  | 
 | ||
|  | static uint64_t allwinner_sid_read(void *opaque, hwaddr offset, | ||
|  |                                    unsigned size) | ||
|  | { | ||
|  |     const AwSidState *s = AW_SID(opaque); | ||
|  |     uint64_t val = 0; | ||
|  | 
 | ||
|  |     switch (offset) { | ||
|  |     case REG_PRCTL:    /* Control */ | ||
|  |         val = s->control; | ||
|  |         break; | ||
|  |     case REG_RDKEY:    /* Read Key */ | ||
|  |         val = s->rdkey; | ||
|  |         break; | ||
|  |     default: | ||
|  |         qemu_log_mask(LOG_GUEST_ERROR, "%s: out-of-bounds offset 0x%04x\n", | ||
|  |                       __func__, (uint32_t)offset); | ||
|  |         return 0; | ||
|  |     } | ||
|  | 
 | ||
|  |     trace_allwinner_sid_read(offset, val, size); | ||
|  | 
 | ||
|  |     return val; | ||
|  | } | ||
|  | 
 | ||
|  | static void allwinner_sid_write(void *opaque, hwaddr offset, | ||
|  |                                 uint64_t val, unsigned size) | ||
|  | { | ||
|  |     AwSidState *s = AW_SID(opaque); | ||
|  | 
 | ||
|  |     trace_allwinner_sid_write(offset, val, size); | ||
|  | 
 | ||
|  |     switch (offset) { | ||
|  |     case REG_PRCTL:    /* Control */ | ||
|  |         s->control = val; | ||
|  | 
 | ||
|  |         if ((s->control & REG_PRCTL_OP_LOCK) && | ||
|  |             (s->control & REG_PRCTL_WRITE)) { | ||
|  |             uint32_t id = s->control >> 16; | ||
|  | 
 | ||
|  |             if (id <= sizeof(QemuUUID) - sizeof(s->rdkey)) { | ||
|  |                 s->rdkey = ldl_be_p(&s->identifier.data[id]); | ||
|  |             } | ||
|  |         } | ||
|  |         s->control &= ~REG_PRCTL_WRITE; | ||
|  |         break; | ||
|  |     case REG_RDKEY:    /* Read Key */ | ||
|  |         break; | ||
|  |     default: | ||
|  |         qemu_log_mask(LOG_GUEST_ERROR, "%s: out-of-bounds offset 0x%04x\n", | ||
|  |                       __func__, (uint32_t)offset); | ||
|  |         break; | ||
|  |     } | ||
|  | } | ||
|  | 
 | ||
|  | static const MemoryRegionOps allwinner_sid_ops = { | ||
|  |     .read = allwinner_sid_read, | ||
|  |     .write = allwinner_sid_write, | ||
|  |     .endianness = DEVICE_NATIVE_ENDIAN, | ||
|  |     .valid = { | ||
|  |         .min_access_size = 4, | ||
|  |         .max_access_size = 4, | ||
|  |     }, | ||
|  |     .impl.min_access_size = 4, | ||
|  | }; | ||
|  | 
 | ||
|  | static void allwinner_sid_reset(DeviceState *dev) | ||
|  | { | ||
|  |     AwSidState *s = AW_SID(dev); | ||
|  | 
 | ||
|  |     /* Set default values for registers */ | ||
|  |     s->control = 0; | ||
|  |     s->rdkey = 0; | ||
|  | } | ||
|  | 
 | ||
|  | static void allwinner_sid_init(Object *obj) | ||
|  | { | ||
|  |     SysBusDevice *sbd = SYS_BUS_DEVICE(obj); | ||
|  |     AwSidState *s = AW_SID(obj); | ||
|  | 
 | ||
|  |     /* Memory mapping */ | ||
|  |     memory_region_init_io(&s->iomem, OBJECT(s), &allwinner_sid_ops, s, | ||
|  |                            TYPE_AW_SID, 1 * KiB); | ||
|  |     sysbus_init_mmio(sbd, &s->iomem); | ||
|  | } | ||
|  | 
 | ||
|  | static Property allwinner_sid_properties[] = { | ||
|  |     DEFINE_PROP_UUID_NODEFAULT("identifier", AwSidState, identifier), | ||
|  |     DEFINE_PROP_END_OF_LIST() | ||
|  | }; | ||
|  | 
 | ||
|  | static const VMStateDescription allwinner_sid_vmstate = { | ||
|  |     .name = "allwinner-sid", | ||
|  |     .version_id = 1, | ||
|  |     .minimum_version_id = 1, | ||
|  |     .fields = (VMStateField[]) { | ||
|  |         VMSTATE_UINT32(control, AwSidState), | ||
|  |         VMSTATE_UINT32(rdkey, AwSidState), | ||
|  |         VMSTATE_UINT8_ARRAY_V(identifier.data, AwSidState, sizeof(QemuUUID), 1), | ||
|  |         VMSTATE_END_OF_LIST() | ||
|  |     } | ||
|  | }; | ||
|  | 
 | ||
|  | static void allwinner_sid_class_init(ObjectClass *klass, void *data) | ||
|  | { | ||
|  |     DeviceClass *dc = DEVICE_CLASS(klass); | ||
|  | 
 | ||
|  |     dc->reset = allwinner_sid_reset; | ||
|  |     dc->vmsd = &allwinner_sid_vmstate; | ||
|  |     device_class_set_props(dc, allwinner_sid_properties); | ||
|  | } | ||
|  | 
 | ||
|  | static const TypeInfo allwinner_sid_info = { | ||
|  |     .name          = TYPE_AW_SID, | ||
|  |     .parent        = TYPE_SYS_BUS_DEVICE, | ||
|  |     .instance_init = allwinner_sid_init, | ||
|  |     .instance_size = sizeof(AwSidState), | ||
|  |     .class_init    = allwinner_sid_class_init, | ||
|  | }; | ||
|  | 
 | ||
|  | static void allwinner_sid_register(void) | ||
|  | { | ||
|  |     type_register_static(&allwinner_sid_info); | ||
|  | } | ||
|  | 
 | ||
|  | type_init(allwinner_sid_register) |