| 
									
										
										
										
											2018-03-02 10:45:34 +00:00
										 |  |  | /*
 | 
					
						
							|  |  |  |  * QEMU model of the Xilinx ZynqMP Real Time Clock (RTC). | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * Copyright (c) 2017 Xilinx Inc. | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * Written-by: Alistair Francis <alistair.francis@xilinx.com> | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * Permission is hereby granted, free of charge, to any person obtaining a copy | 
					
						
							|  |  |  |  * of this software and associated documentation files (the "Software"), to deal | 
					
						
							|  |  |  |  * in the Software without restriction, including without limitation the rights | 
					
						
							|  |  |  |  * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell | 
					
						
							|  |  |  |  * copies of the Software, and to permit persons to whom the Software is | 
					
						
							|  |  |  |  * furnished to do so, subject to the following conditions: | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * The above copyright notice and this permission notice shall be included in | 
					
						
							|  |  |  |  * all copies or substantial portions of the Software. | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR | 
					
						
							|  |  |  |  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, | 
					
						
							|  |  |  |  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL | 
					
						
							|  |  |  |  * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER | 
					
						
							|  |  |  |  * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, | 
					
						
							|  |  |  |  * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN | 
					
						
							|  |  |  |  * THE SOFTWARE. | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | #include "qemu/osdep.h"
 | 
					
						
							| 
									
										
										
										
											2019-05-23 16:35:08 +02:00
										 |  |  | #include "qemu-common.h"
 | 
					
						
							| 
									
										
										
										
											2018-03-02 10:45:34 +00:00
										 |  |  | #include "hw/sysbus.h"
 | 
					
						
							|  |  |  | #include "hw/register.h"
 | 
					
						
							|  |  |  | #include "qemu/bitops.h"
 | 
					
						
							|  |  |  | #include "qemu/log.h"
 | 
					
						
							| 
									
										
										
										
											2019-05-23 16:35:07 +02:00
										 |  |  | #include "qemu/module.h"
 | 
					
						
							| 
									
										
										
										
											2019-08-12 07:23:42 +02:00
										 |  |  | #include "hw/irq.h"
 | 
					
						
							| 
									
										
										
										
											2018-03-02 10:45:34 +00:00
										 |  |  | #include "qemu/cutils.h"
 | 
					
						
							|  |  |  | #include "sysemu/sysemu.h"
 | 
					
						
							|  |  |  | #include "trace.h"
 | 
					
						
							| 
									
										
										
										
											2019-10-04 01:03:59 +02:00
										 |  |  | #include "hw/rtc/xlnx-zynqmp-rtc.h"
 | 
					
						
							| 
									
										
										
										
											2019-08-12 07:23:45 +02:00
										 |  |  | #include "migration/vmstate.h"
 | 
					
						
							| 
									
										
										
										
											2018-03-02 10:45:34 +00:00
										 |  |  | 
 | 
					
						
							|  |  |  | #ifndef XLNX_ZYNQMP_RTC_ERR_DEBUG
 | 
					
						
							|  |  |  | #define XLNX_ZYNQMP_RTC_ERR_DEBUG 0
 | 
					
						
							|  |  |  | #endif
 | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | static void rtc_int_update_irq(XlnxZynqMPRTC *s) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  |     bool pending = s->regs[R_RTC_INT_STATUS] & ~s->regs[R_RTC_INT_MASK]; | 
					
						
							|  |  |  |     qemu_set_irq(s->irq_rtc_int, pending); | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | static void addr_error_int_update_irq(XlnxZynqMPRTC *s) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  |     bool pending = s->regs[R_ADDR_ERROR] & ~s->regs[R_ADDR_ERROR_INT_MASK]; | 
					
						
							|  |  |  |     qemu_set_irq(s->irq_addr_error_int, pending); | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2018-03-02 10:45:34 +00:00
										 |  |  | static uint32_t rtc_get_count(XlnxZynqMPRTC *s) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  |     int64_t now = qemu_clock_get_ns(rtc_clock); | 
					
						
							|  |  |  |     return s->tick_offset + now / NANOSECONDS_PER_SECOND; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | static uint64_t current_time_postr(RegisterInfo *reg, uint64_t val64) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  |     XlnxZynqMPRTC *s = XLNX_ZYNQMP_RTC(reg->opaque); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  |     return rtc_get_count(s); | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2018-03-02 10:45:34 +00:00
										 |  |  | static void rtc_int_status_postw(RegisterInfo *reg, uint64_t val64) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  |     XlnxZynqMPRTC *s = XLNX_ZYNQMP_RTC(reg->opaque); | 
					
						
							|  |  |  |     rtc_int_update_irq(s); | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | static uint64_t rtc_int_en_prew(RegisterInfo *reg, uint64_t val64) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  |     XlnxZynqMPRTC *s = XLNX_ZYNQMP_RTC(reg->opaque); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  |     s->regs[R_RTC_INT_MASK] &= (uint32_t) ~val64; | 
					
						
							|  |  |  |     rtc_int_update_irq(s); | 
					
						
							|  |  |  |     return 0; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | static uint64_t rtc_int_dis_prew(RegisterInfo *reg, uint64_t val64) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  |     XlnxZynqMPRTC *s = XLNX_ZYNQMP_RTC(reg->opaque); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  |     s->regs[R_RTC_INT_MASK] |= (uint32_t) val64; | 
					
						
							|  |  |  |     rtc_int_update_irq(s); | 
					
						
							|  |  |  |     return 0; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | static void addr_error_postw(RegisterInfo *reg, uint64_t val64) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  |     XlnxZynqMPRTC *s = XLNX_ZYNQMP_RTC(reg->opaque); | 
					
						
							|  |  |  |     addr_error_int_update_irq(s); | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | static uint64_t addr_error_int_en_prew(RegisterInfo *reg, uint64_t val64) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  |     XlnxZynqMPRTC *s = XLNX_ZYNQMP_RTC(reg->opaque); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  |     s->regs[R_ADDR_ERROR_INT_MASK] &= (uint32_t) ~val64; | 
					
						
							|  |  |  |     addr_error_int_update_irq(s); | 
					
						
							|  |  |  |     return 0; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | static uint64_t addr_error_int_dis_prew(RegisterInfo *reg, uint64_t val64) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  |     XlnxZynqMPRTC *s = XLNX_ZYNQMP_RTC(reg->opaque); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  |     s->regs[R_ADDR_ERROR_INT_MASK] |= (uint32_t) val64; | 
					
						
							|  |  |  |     addr_error_int_update_irq(s); | 
					
						
							|  |  |  |     return 0; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | static const RegisterAccessInfo rtc_regs_info[] = { | 
					
						
							|  |  |  |     {   .name = "SET_TIME_WRITE",  .addr = A_SET_TIME_WRITE, | 
					
						
							| 
									
										
										
										
											2018-03-02 10:45:34 +00:00
										 |  |  |         .unimp = MAKE_64BIT_MASK(0, 32), | 
					
						
							| 
									
										
										
										
											2018-03-02 10:45:34 +00:00
										 |  |  |     },{ .name = "SET_TIME_READ",  .addr = A_SET_TIME_READ, | 
					
						
							|  |  |  |         .ro = 0xffffffff, | 
					
						
							| 
									
										
										
										
											2018-03-02 10:45:34 +00:00
										 |  |  |         .post_read = current_time_postr, | 
					
						
							| 
									
										
										
										
											2018-03-02 10:45:34 +00:00
										 |  |  |     },{ .name = "CALIB_WRITE",  .addr = A_CALIB_WRITE, | 
					
						
							| 
									
										
										
										
											2018-03-02 10:45:34 +00:00
										 |  |  |         .unimp = MAKE_64BIT_MASK(0, 32), | 
					
						
							| 
									
										
										
										
											2018-03-02 10:45:34 +00:00
										 |  |  |     },{ .name = "CALIB_READ",  .addr = A_CALIB_READ, | 
					
						
							|  |  |  |         .ro = 0x1fffff, | 
					
						
							|  |  |  |     },{ .name = "CURRENT_TIME",  .addr = A_CURRENT_TIME, | 
					
						
							|  |  |  |         .ro = 0xffffffff, | 
					
						
							| 
									
										
										
										
											2018-03-02 10:45:34 +00:00
										 |  |  |         .post_read = current_time_postr, | 
					
						
							| 
									
										
										
										
											2018-03-02 10:45:34 +00:00
										 |  |  |     },{ .name = "CURRENT_TICK",  .addr = A_CURRENT_TICK, | 
					
						
							|  |  |  |         .ro = 0xffff, | 
					
						
							|  |  |  |     },{ .name = "ALARM",  .addr = A_ALARM, | 
					
						
							|  |  |  |     },{ .name = "RTC_INT_STATUS",  .addr = A_RTC_INT_STATUS, | 
					
						
							|  |  |  |         .w1c = 0x3, | 
					
						
							|  |  |  |         .post_write = rtc_int_status_postw, | 
					
						
							|  |  |  |     },{ .name = "RTC_INT_MASK",  .addr = A_RTC_INT_MASK, | 
					
						
							|  |  |  |         .reset = 0x3, | 
					
						
							|  |  |  |         .ro = 0x3, | 
					
						
							|  |  |  |     },{ .name = "RTC_INT_EN",  .addr = A_RTC_INT_EN, | 
					
						
							|  |  |  |         .pre_write = rtc_int_en_prew, | 
					
						
							|  |  |  |     },{ .name = "RTC_INT_DIS",  .addr = A_RTC_INT_DIS, | 
					
						
							|  |  |  |         .pre_write = rtc_int_dis_prew, | 
					
						
							|  |  |  |     },{ .name = "ADDR_ERROR",  .addr = A_ADDR_ERROR, | 
					
						
							|  |  |  |         .w1c = 0x1, | 
					
						
							|  |  |  |         .post_write = addr_error_postw, | 
					
						
							|  |  |  |     },{ .name = "ADDR_ERROR_INT_MASK",  .addr = A_ADDR_ERROR_INT_MASK, | 
					
						
							|  |  |  |         .reset = 0x1, | 
					
						
							|  |  |  |         .ro = 0x1, | 
					
						
							|  |  |  |     },{ .name = "ADDR_ERROR_INT_EN",  .addr = A_ADDR_ERROR_INT_EN, | 
					
						
							|  |  |  |         .pre_write = addr_error_int_en_prew, | 
					
						
							|  |  |  |     },{ .name = "ADDR_ERROR_INT_DIS",  .addr = A_ADDR_ERROR_INT_DIS, | 
					
						
							|  |  |  |         .pre_write = addr_error_int_dis_prew, | 
					
						
							|  |  |  |     },{ .name = "CONTROL",  .addr = A_CONTROL, | 
					
						
							|  |  |  |         .reset = 0x1000000, | 
					
						
							|  |  |  |         .rsvd = 0x70fffffe, | 
					
						
							|  |  |  |     },{ .name = "SAFETY_CHK",  .addr = A_SAFETY_CHK, | 
					
						
							|  |  |  |     } | 
					
						
							|  |  |  | }; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | static void rtc_reset(DeviceState *dev) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  |     XlnxZynqMPRTC *s = XLNX_ZYNQMP_RTC(dev); | 
					
						
							|  |  |  |     unsigned int i; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  |     for (i = 0; i < ARRAY_SIZE(s->regs_info); ++i) { | 
					
						
							|  |  |  |         register_reset(&s->regs_info[i]); | 
					
						
							|  |  |  |     } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  |     rtc_int_update_irq(s); | 
					
						
							|  |  |  |     addr_error_int_update_irq(s); | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | static const MemoryRegionOps rtc_ops = { | 
					
						
							|  |  |  |     .read = register_read_memory, | 
					
						
							|  |  |  |     .write = register_write_memory, | 
					
						
							|  |  |  |     .endianness = DEVICE_LITTLE_ENDIAN, | 
					
						
							|  |  |  |     .valid = { | 
					
						
							|  |  |  |         .min_access_size = 4, | 
					
						
							|  |  |  |         .max_access_size = 4, | 
					
						
							|  |  |  |     }, | 
					
						
							|  |  |  | }; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | static void rtc_init(Object *obj) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  |     XlnxZynqMPRTC *s = XLNX_ZYNQMP_RTC(obj); | 
					
						
							|  |  |  |     SysBusDevice *sbd = SYS_BUS_DEVICE(obj); | 
					
						
							|  |  |  |     RegisterInfoArray *reg_array; | 
					
						
							| 
									
										
										
										
											2018-03-02 10:45:34 +00:00
										 |  |  |     struct tm current_tm; | 
					
						
							| 
									
										
										
										
											2018-03-02 10:45:34 +00:00
										 |  |  | 
 | 
					
						
							|  |  |  |     memory_region_init(&s->iomem, obj, TYPE_XLNX_ZYNQMP_RTC, | 
					
						
							|  |  |  |                        XLNX_ZYNQMP_RTC_R_MAX * 4); | 
					
						
							|  |  |  |     reg_array = | 
					
						
							|  |  |  |         register_init_block32(DEVICE(obj), rtc_regs_info, | 
					
						
							|  |  |  |                               ARRAY_SIZE(rtc_regs_info), | 
					
						
							|  |  |  |                               s->regs_info, s->regs, | 
					
						
							|  |  |  |                               &rtc_ops, | 
					
						
							|  |  |  |                               XLNX_ZYNQMP_RTC_ERR_DEBUG, | 
					
						
							|  |  |  |                               XLNX_ZYNQMP_RTC_R_MAX * 4); | 
					
						
							|  |  |  |     memory_region_add_subregion(&s->iomem, | 
					
						
							|  |  |  |                                 0x0, | 
					
						
							|  |  |  |                                 ®_array->mem); | 
					
						
							|  |  |  |     sysbus_init_mmio(sbd, &s->iomem); | 
					
						
							|  |  |  |     sysbus_init_irq(sbd, &s->irq_rtc_int); | 
					
						
							|  |  |  |     sysbus_init_irq(sbd, &s->irq_addr_error_int); | 
					
						
							| 
									
										
										
										
											2018-03-02 10:45:34 +00:00
										 |  |  | 
 | 
					
						
							|  |  |  |     qemu_get_timedate(¤t_tm, 0); | 
					
						
							|  |  |  |     s->tick_offset = mktimegm(¤t_tm) - | 
					
						
							|  |  |  |         qemu_clock_get_ns(rtc_clock) / NANOSECONDS_PER_SECOND; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  |     trace_xlnx_zynqmp_rtc_gettime(current_tm.tm_year, current_tm.tm_mon, | 
					
						
							|  |  |  |                                   current_tm.tm_mday, current_tm.tm_hour, | 
					
						
							|  |  |  |                                   current_tm.tm_min, current_tm.tm_sec); | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | static int rtc_pre_save(void *opaque) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  |     XlnxZynqMPRTC *s = opaque; | 
					
						
							|  |  |  |     int64_t now = qemu_clock_get_ns(rtc_clock) / NANOSECONDS_PER_SECOND; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  |     /* Add the time at migration */ | 
					
						
							|  |  |  |     s->tick_offset = s->tick_offset + now; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  |     return 0; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | static int rtc_post_load(void *opaque, int version_id) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  |     XlnxZynqMPRTC *s = opaque; | 
					
						
							|  |  |  |     int64_t now = qemu_clock_get_ns(rtc_clock) / NANOSECONDS_PER_SECOND; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  |     /* Subtract the time after migration. This combined with the pre_save
 | 
					
						
							|  |  |  |      * action results in us having subtracted the time that the guest was | 
					
						
							|  |  |  |      * stopped to the offset. | 
					
						
							|  |  |  |      */ | 
					
						
							|  |  |  |     s->tick_offset = s->tick_offset - now; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  |     return 0; | 
					
						
							| 
									
										
										
										
											2018-03-02 10:45:34 +00:00
										 |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | static const VMStateDescription vmstate_rtc = { | 
					
						
							|  |  |  |     .name = TYPE_XLNX_ZYNQMP_RTC, | 
					
						
							|  |  |  |     .version_id = 1, | 
					
						
							|  |  |  |     .minimum_version_id = 1, | 
					
						
							| 
									
										
										
										
											2018-03-02 10:45:34 +00:00
										 |  |  |     .pre_save = rtc_pre_save, | 
					
						
							|  |  |  |     .post_load = rtc_post_load, | 
					
						
							| 
									
										
										
										
											2018-03-02 10:45:34 +00:00
										 |  |  |     .fields = (VMStateField[]) { | 
					
						
							|  |  |  |         VMSTATE_UINT32_ARRAY(regs, XlnxZynqMPRTC, XLNX_ZYNQMP_RTC_R_MAX), | 
					
						
							| 
									
										
										
										
											2018-03-02 10:45:34 +00:00
										 |  |  |         VMSTATE_UINT32(tick_offset, XlnxZynqMPRTC), | 
					
						
							| 
									
										
										
										
											2018-03-02 10:45:34 +00:00
										 |  |  |         VMSTATE_END_OF_LIST(), | 
					
						
							|  |  |  |     } | 
					
						
							|  |  |  | }; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | static void rtc_class_init(ObjectClass *klass, void *data) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  |     DeviceClass *dc = DEVICE_CLASS(klass); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  |     dc->reset = rtc_reset; | 
					
						
							|  |  |  |     dc->vmsd = &vmstate_rtc; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | static const TypeInfo rtc_info = { | 
					
						
							|  |  |  |     .name          = TYPE_XLNX_ZYNQMP_RTC, | 
					
						
							|  |  |  |     .parent        = TYPE_SYS_BUS_DEVICE, | 
					
						
							|  |  |  |     .instance_size = sizeof(XlnxZynqMPRTC), | 
					
						
							|  |  |  |     .class_init    = rtc_class_init, | 
					
						
							|  |  |  |     .instance_init = rtc_init, | 
					
						
							|  |  |  | }; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | static void rtc_register_types(void) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  |     type_register_static(&rtc_info); | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | type_init(rtc_register_types) |