10a7bc1c0SAndrey Smirnov /* 20a7bc1c0SAndrey Smirnov * IMX7 Secure Non-Volatile Storage 30a7bc1c0SAndrey Smirnov * 40a7bc1c0SAndrey Smirnov * Copyright (c) 2018, Impinj, Inc. 50a7bc1c0SAndrey Smirnov * 60a7bc1c0SAndrey Smirnov * Author: Andrey Smirnov <andrew.smirnov@gmail.com> 70a7bc1c0SAndrey Smirnov * 80a7bc1c0SAndrey Smirnov * This work is licensed under the terms of the GNU GPL, version 2 or later. 90a7bc1c0SAndrey Smirnov * See the COPYING file in the top-level directory. 100a7bc1c0SAndrey Smirnov * 110a7bc1c0SAndrey Smirnov * Bare minimum emulation code needed to support being able to shut 120a7bc1c0SAndrey Smirnov * down linux guest gracefully. 130a7bc1c0SAndrey Smirnov */ 140a7bc1c0SAndrey Smirnov 150a7bc1c0SAndrey Smirnov #include "qemu/osdep.h" 16*6f9c3aaaSNikita Ostrenkov #include "qemu/bitops.h" 17*6f9c3aaaSNikita Ostrenkov #include "qemu/timer.h" 18*6f9c3aaaSNikita Ostrenkov #include "migration/vmstate.h" 190a7bc1c0SAndrey Smirnov #include "hw/misc/imx7_snvs.h" 20*6f9c3aaaSNikita Ostrenkov #include "qemu/cutils.h" 210b8fa32fSMarkus Armbruster #include "qemu/module.h" 22*6f9c3aaaSNikita Ostrenkov #include "sysemu/sysemu.h" 23*6f9c3aaaSNikita Ostrenkov #include "sysemu/rtc.h" 2454d31236SMarkus Armbruster #include "sysemu/runstate.h" 25bb2fc5b9SBernhard Beschow #include "trace.h" 260a7bc1c0SAndrey Smirnov 27*6f9c3aaaSNikita Ostrenkov #define RTC_FREQ 32768ULL 28*6f9c3aaaSNikita Ostrenkov 29*6f9c3aaaSNikita Ostrenkov static const VMStateDescription vmstate_imx7_snvs = { 30*6f9c3aaaSNikita Ostrenkov .name = TYPE_IMX7_SNVS, 31*6f9c3aaaSNikita Ostrenkov .version_id = 1, 32*6f9c3aaaSNikita Ostrenkov .minimum_version_id = 1, 33*6f9c3aaaSNikita Ostrenkov .fields = (VMStateField[]) { 34*6f9c3aaaSNikita Ostrenkov VMSTATE_UINT64(tick_offset, IMX7SNVSState), 35*6f9c3aaaSNikita Ostrenkov VMSTATE_UINT64(lpcr, IMX7SNVSState), 36*6f9c3aaaSNikita Ostrenkov VMSTATE_END_OF_LIST() 37*6f9c3aaaSNikita Ostrenkov } 38*6f9c3aaaSNikita Ostrenkov }; 39*6f9c3aaaSNikita Ostrenkov 40*6f9c3aaaSNikita Ostrenkov static uint64_t imx7_snvs_get_count(IMX7SNVSState *s) 41*6f9c3aaaSNikita Ostrenkov { 42*6f9c3aaaSNikita Ostrenkov uint64_t ticks = muldiv64(qemu_clock_get_ns(rtc_clock), RTC_FREQ, 43*6f9c3aaaSNikita Ostrenkov NANOSECONDS_PER_SECOND); 44*6f9c3aaaSNikita Ostrenkov return s->tick_offset + ticks; 45*6f9c3aaaSNikita Ostrenkov } 46*6f9c3aaaSNikita Ostrenkov 470a7bc1c0SAndrey Smirnov static uint64_t imx7_snvs_read(void *opaque, hwaddr offset, unsigned size) 480a7bc1c0SAndrey Smirnov { 49*6f9c3aaaSNikita Ostrenkov IMX7SNVSState *s = IMX7_SNVS(opaque); 50*6f9c3aaaSNikita Ostrenkov uint64_t ret = 0; 51bb2fc5b9SBernhard Beschow 52*6f9c3aaaSNikita Ostrenkov switch (offset) { 53*6f9c3aaaSNikita Ostrenkov case SNVS_LPSRTCMR: 54*6f9c3aaaSNikita Ostrenkov ret = extract64(imx7_snvs_get_count(s), 32, 15); 55*6f9c3aaaSNikita Ostrenkov break; 56*6f9c3aaaSNikita Ostrenkov case SNVS_LPSRTCLR: 57*6f9c3aaaSNikita Ostrenkov ret = extract64(imx7_snvs_get_count(s), 0, 32); 58*6f9c3aaaSNikita Ostrenkov break; 59*6f9c3aaaSNikita Ostrenkov case SNVS_LPCR: 60*6f9c3aaaSNikita Ostrenkov ret = s->lpcr; 61*6f9c3aaaSNikita Ostrenkov break; 62*6f9c3aaaSNikita Ostrenkov } 63*6f9c3aaaSNikita Ostrenkov 64*6f9c3aaaSNikita Ostrenkov trace_imx7_snvs_read(offset, ret, size); 65*6f9c3aaaSNikita Ostrenkov 66*6f9c3aaaSNikita Ostrenkov return ret; 67*6f9c3aaaSNikita Ostrenkov } 68*6f9c3aaaSNikita Ostrenkov 69*6f9c3aaaSNikita Ostrenkov static void imx7_snvs_reset(DeviceState *dev) 70*6f9c3aaaSNikita Ostrenkov { 71*6f9c3aaaSNikita Ostrenkov IMX7SNVSState *s = IMX7_SNVS(dev); 72*6f9c3aaaSNikita Ostrenkov 73*6f9c3aaaSNikita Ostrenkov s->lpcr = 0; 740a7bc1c0SAndrey Smirnov } 750a7bc1c0SAndrey Smirnov 760a7bc1c0SAndrey Smirnov static void imx7_snvs_write(void *opaque, hwaddr offset, 770a7bc1c0SAndrey Smirnov uint64_t v, unsigned size) 780a7bc1c0SAndrey Smirnov { 79*6f9c3aaaSNikita Ostrenkov trace_imx7_snvs_write(offset, v, size); 80*6f9c3aaaSNikita Ostrenkov 81*6f9c3aaaSNikita Ostrenkov IMX7SNVSState *s = IMX7_SNVS(opaque); 82*6f9c3aaaSNikita Ostrenkov 83*6f9c3aaaSNikita Ostrenkov uint64_t new_value = 0, snvs_count = 0; 84*6f9c3aaaSNikita Ostrenkov 85*6f9c3aaaSNikita Ostrenkov if (offset == SNVS_LPSRTCMR || offset == SNVS_LPSRTCLR) { 86*6f9c3aaaSNikita Ostrenkov snvs_count = imx7_snvs_get_count(s); 87*6f9c3aaaSNikita Ostrenkov } 88*6f9c3aaaSNikita Ostrenkov 89*6f9c3aaaSNikita Ostrenkov switch (offset) { 90*6f9c3aaaSNikita Ostrenkov case SNVS_LPSRTCMR: 91*6f9c3aaaSNikita Ostrenkov new_value = deposit64(snvs_count, 32, 32, v); 92*6f9c3aaaSNikita Ostrenkov break; 93*6f9c3aaaSNikita Ostrenkov case SNVS_LPSRTCLR: 94*6f9c3aaaSNikita Ostrenkov new_value = deposit64(snvs_count, 0, 32, v); 95*6f9c3aaaSNikita Ostrenkov break; 96*6f9c3aaaSNikita Ostrenkov case SNVS_LPCR: { 97*6f9c3aaaSNikita Ostrenkov s->lpcr = v; 98*6f9c3aaaSNikita Ostrenkov 990a7bc1c0SAndrey Smirnov const uint32_t mask = SNVS_LPCR_TOP | SNVS_LPCR_DP_EN; 1000a7bc1c0SAndrey Smirnov 101*6f9c3aaaSNikita Ostrenkov if ((v & mask) == mask) { 1020a7bc1c0SAndrey Smirnov qemu_system_shutdown_request(SHUTDOWN_CAUSE_GUEST_SHUTDOWN); 1030a7bc1c0SAndrey Smirnov } 104*6f9c3aaaSNikita Ostrenkov break; 105*6f9c3aaaSNikita Ostrenkov } 106*6f9c3aaaSNikita Ostrenkov } 107*6f9c3aaaSNikita Ostrenkov 108*6f9c3aaaSNikita Ostrenkov if (offset == SNVS_LPSRTCMR || offset == SNVS_LPSRTCLR) { 109*6f9c3aaaSNikita Ostrenkov s->tick_offset += new_value - snvs_count; 110*6f9c3aaaSNikita Ostrenkov } 1110a7bc1c0SAndrey Smirnov } 1120a7bc1c0SAndrey Smirnov 1130a7bc1c0SAndrey Smirnov static const struct MemoryRegionOps imx7_snvs_ops = { 1140a7bc1c0SAndrey Smirnov .read = imx7_snvs_read, 1150a7bc1c0SAndrey Smirnov .write = imx7_snvs_write, 1160a7bc1c0SAndrey Smirnov .endianness = DEVICE_NATIVE_ENDIAN, 1170a7bc1c0SAndrey Smirnov .impl = { 1180a7bc1c0SAndrey Smirnov /* 1190a7bc1c0SAndrey Smirnov * Our device would not work correctly if the guest was doing 1200a7bc1c0SAndrey Smirnov * unaligned access. This might not be a limitation on the real 1210a7bc1c0SAndrey Smirnov * device but in practice there is no reason for a guest to access 1220a7bc1c0SAndrey Smirnov * this device unaligned. 1230a7bc1c0SAndrey Smirnov */ 1240a7bc1c0SAndrey Smirnov .min_access_size = 4, 1250a7bc1c0SAndrey Smirnov .max_access_size = 4, 1260a7bc1c0SAndrey Smirnov .unaligned = false, 1270a7bc1c0SAndrey Smirnov }, 1280a7bc1c0SAndrey Smirnov }; 1290a7bc1c0SAndrey Smirnov 1300a7bc1c0SAndrey Smirnov static void imx7_snvs_init(Object *obj) 1310a7bc1c0SAndrey Smirnov { 1320a7bc1c0SAndrey Smirnov SysBusDevice *sd = SYS_BUS_DEVICE(obj); 1330a7bc1c0SAndrey Smirnov IMX7SNVSState *s = IMX7_SNVS(obj); 134*6f9c3aaaSNikita Ostrenkov struct tm tm; 1350a7bc1c0SAndrey Smirnov 1360a7bc1c0SAndrey Smirnov memory_region_init_io(&s->mmio, obj, &imx7_snvs_ops, s, 1370a7bc1c0SAndrey Smirnov TYPE_IMX7_SNVS, 0x1000); 1380a7bc1c0SAndrey Smirnov 1390a7bc1c0SAndrey Smirnov sysbus_init_mmio(sd, &s->mmio); 140*6f9c3aaaSNikita Ostrenkov 141*6f9c3aaaSNikita Ostrenkov qemu_get_timedate(&tm, 0); 142*6f9c3aaaSNikita Ostrenkov s->tick_offset = mktimegm(&tm) - 143*6f9c3aaaSNikita Ostrenkov qemu_clock_get_ns(rtc_clock) / NANOSECONDS_PER_SECOND; 1440a7bc1c0SAndrey Smirnov } 1450a7bc1c0SAndrey Smirnov 1460a7bc1c0SAndrey Smirnov static void imx7_snvs_class_init(ObjectClass *klass, void *data) 1470a7bc1c0SAndrey Smirnov { 1480a7bc1c0SAndrey Smirnov DeviceClass *dc = DEVICE_CLASS(klass); 1490a7bc1c0SAndrey Smirnov 150*6f9c3aaaSNikita Ostrenkov dc->reset = imx7_snvs_reset; 151*6f9c3aaaSNikita Ostrenkov dc->vmsd = &vmstate_imx7_snvs; 1520a7bc1c0SAndrey Smirnov dc->desc = "i.MX7 Secure Non-Volatile Storage Module"; 1530a7bc1c0SAndrey Smirnov } 1540a7bc1c0SAndrey Smirnov 1550a7bc1c0SAndrey Smirnov static const TypeInfo imx7_snvs_info = { 1560a7bc1c0SAndrey Smirnov .name = TYPE_IMX7_SNVS, 1570a7bc1c0SAndrey Smirnov .parent = TYPE_SYS_BUS_DEVICE, 1580a7bc1c0SAndrey Smirnov .instance_size = sizeof(IMX7SNVSState), 1590a7bc1c0SAndrey Smirnov .instance_init = imx7_snvs_init, 1600a7bc1c0SAndrey Smirnov .class_init = imx7_snvs_class_init, 1610a7bc1c0SAndrey Smirnov }; 1620a7bc1c0SAndrey Smirnov 1630a7bc1c0SAndrey Smirnov static void imx7_snvs_register_type(void) 1640a7bc1c0SAndrey Smirnov { 1650a7bc1c0SAndrey Smirnov type_register_static(&imx7_snvs_info); 1660a7bc1c0SAndrey Smirnov } 1670a7bc1c0SAndrey Smirnov type_init(imx7_snvs_register_type) 168