1 /* 2 * System Register block model of Microsemi SmartFusion2. 3 * 4 * Copyright (c) 2017 Subbaraya Sundeep <sundeep.lkml@gmail.com> 5 * 6 * This program is free software; you can redistribute it and/or 7 * modify it under the terms of the GNU General Public License 8 * as published by the Free Software Foundation; either version 9 * 2 of the License, or (at your option) any later version. 10 * 11 * You should have received a copy of the GNU General Public License along 12 * with this program; if not, see <http://www.gnu.org/licenses/>. 13 */ 14 15 #include "qemu/osdep.h" 16 #include "qapi/error.h" 17 #include "qemu/log.h" 18 #include "qemu/module.h" 19 #include "hw/misc/msf2-sysreg.h" 20 #include "hw/qdev-properties.h" 21 #include "migration/vmstate.h" 22 #include "qemu/error-report.h" 23 #include "trace.h" 24 25 static inline int msf2_divbits(uint32_t div) 26 { 27 int r = ctz32(div); 28 29 return (div < 8) ? r : r + 1; 30 } 31 32 static void msf2_sysreg_reset(DeviceState *d) 33 { 34 MSF2SysregState *s = MSF2_SYSREG(d); 35 36 s->regs[MSSDDR_PLL_STATUS_LOW_CR] = 0x021A2358; 37 s->regs[MSSDDR_PLL_STATUS] = 0x3; 38 s->regs[MSSDDR_FACC1_CR] = msf2_divbits(s->apb0div) << 5 | 39 msf2_divbits(s->apb1div) << 2; 40 } 41 42 static uint64_t msf2_sysreg_read(void *opaque, hwaddr offset, 43 unsigned size) 44 { 45 MSF2SysregState *s = opaque; 46 uint32_t ret = 0; 47 48 offset >>= 2; 49 if (offset < ARRAY_SIZE(s->regs)) { 50 ret = s->regs[offset]; 51 trace_msf2_sysreg_read(offset << 2, ret); 52 } else { 53 qemu_log_mask(LOG_GUEST_ERROR, 54 "%s: Bad offset 0x%08" HWADDR_PRIx "\n", __func__, 55 offset << 2); 56 } 57 58 return ret; 59 } 60 61 static void msf2_sysreg_write(void *opaque, hwaddr offset, 62 uint64_t val, unsigned size) 63 { 64 MSF2SysregState *s = opaque; 65 uint32_t newval = val; 66 67 offset >>= 2; 68 69 switch (offset) { 70 case MSSDDR_PLL_STATUS: 71 trace_msf2_sysreg_write_pll_status(); 72 break; 73 74 case ESRAM_CR: 75 case DDR_CR: 76 case ENVM_REMAP_BASE_CR: 77 if (newval != s->regs[offset]) { 78 qemu_log_mask(LOG_UNIMP, 79 TYPE_MSF2_SYSREG": remapping not supported\n"); 80 } 81 break; 82 83 default: 84 if (offset < ARRAY_SIZE(s->regs)) { 85 trace_msf2_sysreg_write(offset << 2, newval, s->regs[offset]); 86 s->regs[offset] = newval; 87 } else { 88 qemu_log_mask(LOG_GUEST_ERROR, 89 "%s: Bad offset 0x%08" HWADDR_PRIx "\n", __func__, 90 offset << 2); 91 } 92 break; 93 } 94 } 95 96 static const MemoryRegionOps sysreg_ops = { 97 .read = msf2_sysreg_read, 98 .write = msf2_sysreg_write, 99 .endianness = DEVICE_NATIVE_ENDIAN, 100 }; 101 102 static void msf2_sysreg_init(Object *obj) 103 { 104 MSF2SysregState *s = MSF2_SYSREG(obj); 105 106 memory_region_init_io(&s->iomem, obj, &sysreg_ops, s, TYPE_MSF2_SYSREG, 107 MSF2_SYSREG_MMIO_SIZE); 108 sysbus_init_mmio(SYS_BUS_DEVICE(obj), &s->iomem); 109 } 110 111 static const VMStateDescription vmstate_msf2_sysreg = { 112 .name = TYPE_MSF2_SYSREG, 113 .version_id = 1, 114 .minimum_version_id = 1, 115 .fields = (const VMStateField[]) { 116 VMSTATE_UINT32_ARRAY(regs, MSF2SysregState, MSF2_SYSREG_MMIO_SIZE / 4), 117 VMSTATE_END_OF_LIST() 118 } 119 }; 120 121 static const Property msf2_sysreg_properties[] = { 122 /* default divisors in Libero GUI */ 123 DEFINE_PROP_UINT8("apb0divisor", MSF2SysregState, apb0div, 2), 124 DEFINE_PROP_UINT8("apb1divisor", MSF2SysregState, apb1div, 2), 125 }; 126 127 static void msf2_sysreg_realize(DeviceState *dev, Error **errp) 128 { 129 MSF2SysregState *s = MSF2_SYSREG(dev); 130 131 if ((s->apb0div > 32 || !is_power_of_2(s->apb0div)) 132 || (s->apb1div > 32 || !is_power_of_2(s->apb1div))) { 133 error_setg(errp, "Invalid apb divisor value"); 134 error_append_hint(errp, "apb divisor must be a power of 2" 135 " and maximum value is 32\n"); 136 } 137 } 138 139 static void msf2_sysreg_class_init(ObjectClass *klass, void *data) 140 { 141 DeviceClass *dc = DEVICE_CLASS(klass); 142 143 dc->vmsd = &vmstate_msf2_sysreg; 144 device_class_set_legacy_reset(dc, msf2_sysreg_reset); 145 device_class_set_props(dc, msf2_sysreg_properties); 146 dc->realize = msf2_sysreg_realize; 147 } 148 149 static const TypeInfo msf2_sysreg_info = { 150 .name = TYPE_MSF2_SYSREG, 151 .parent = TYPE_SYS_BUS_DEVICE, 152 .class_init = msf2_sysreg_class_init, 153 .instance_size = sizeof(MSF2SysregState), 154 .instance_init = msf2_sysreg_init, 155 }; 156 157 static void msf2_sysreg_register_types(void) 158 { 159 type_register_static(&msf2_sysreg_info); 160 } 161 162 type_init(msf2_sysreg_register_types) 163