xlnx-zynqmp-rtc.c 8.4 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275
  1. /*
  2. * QEMU model of the Xilinx ZynqMP Real Time Clock (RTC).
  3. *
  4. * Copyright (c) 2017 Xilinx Inc.
  5. *
  6. * Written-by: Alistair Francis <alistair.francis@xilinx.com>
  7. *
  8. * Permission is hereby granted, free of charge, to any person obtaining a copy
  9. * of this software and associated documentation files (the "Software"), to deal
  10. * in the Software without restriction, including without limitation the rights
  11. * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
  12. * copies of the Software, and to permit persons to whom the Software is
  13. * furnished to do so, subject to the following conditions:
  14. *
  15. * The above copyright notice and this permission notice shall be included in
  16. * all copies or substantial portions of the Software.
  17. *
  18. * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  19. * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  20. * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
  21. * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
  22. * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
  23. * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
  24. * THE SOFTWARE.
  25. */
  26. #include "qemu/osdep.h"
  27. #include "qemu-common.h"
  28. #include "hw/sysbus.h"
  29. #include "hw/register.h"
  30. #include "qemu/bitops.h"
  31. #include "qemu/log.h"
  32. #include "qemu/module.h"
  33. #include "hw/irq.h"
  34. #include "qemu/cutils.h"
  35. #include "sysemu/sysemu.h"
  36. #include "trace.h"
  37. #include "hw/rtc/xlnx-zynqmp-rtc.h"
  38. #include "migration/vmstate.h"
  39. #ifndef XLNX_ZYNQMP_RTC_ERR_DEBUG
  40. #define XLNX_ZYNQMP_RTC_ERR_DEBUG 0
  41. #endif
  42. static void rtc_int_update_irq(XlnxZynqMPRTC *s)
  43. {
  44. bool pending = s->regs[R_RTC_INT_STATUS] & ~s->regs[R_RTC_INT_MASK];
  45. qemu_set_irq(s->irq_rtc_int, pending);
  46. }
  47. static void addr_error_int_update_irq(XlnxZynqMPRTC *s)
  48. {
  49. bool pending = s->regs[R_ADDR_ERROR] & ~s->regs[R_ADDR_ERROR_INT_MASK];
  50. qemu_set_irq(s->irq_addr_error_int, pending);
  51. }
  52. static uint32_t rtc_get_count(XlnxZynqMPRTC *s)
  53. {
  54. int64_t now = qemu_clock_get_ns(rtc_clock);
  55. return s->tick_offset + now / NANOSECONDS_PER_SECOND;
  56. }
  57. static uint64_t current_time_postr(RegisterInfo *reg, uint64_t val64)
  58. {
  59. XlnxZynqMPRTC *s = XLNX_ZYNQMP_RTC(reg->opaque);
  60. return rtc_get_count(s);
  61. }
  62. static void rtc_int_status_postw(RegisterInfo *reg, uint64_t val64)
  63. {
  64. XlnxZynqMPRTC *s = XLNX_ZYNQMP_RTC(reg->opaque);
  65. rtc_int_update_irq(s);
  66. }
  67. static uint64_t rtc_int_en_prew(RegisterInfo *reg, uint64_t val64)
  68. {
  69. XlnxZynqMPRTC *s = XLNX_ZYNQMP_RTC(reg->opaque);
  70. s->regs[R_RTC_INT_MASK] &= (uint32_t) ~val64;
  71. rtc_int_update_irq(s);
  72. return 0;
  73. }
  74. static uint64_t rtc_int_dis_prew(RegisterInfo *reg, uint64_t val64)
  75. {
  76. XlnxZynqMPRTC *s = XLNX_ZYNQMP_RTC(reg->opaque);
  77. s->regs[R_RTC_INT_MASK] |= (uint32_t) val64;
  78. rtc_int_update_irq(s);
  79. return 0;
  80. }
  81. static void addr_error_postw(RegisterInfo *reg, uint64_t val64)
  82. {
  83. XlnxZynqMPRTC *s = XLNX_ZYNQMP_RTC(reg->opaque);
  84. addr_error_int_update_irq(s);
  85. }
  86. static uint64_t addr_error_int_en_prew(RegisterInfo *reg, uint64_t val64)
  87. {
  88. XlnxZynqMPRTC *s = XLNX_ZYNQMP_RTC(reg->opaque);
  89. s->regs[R_ADDR_ERROR_INT_MASK] &= (uint32_t) ~val64;
  90. addr_error_int_update_irq(s);
  91. return 0;
  92. }
  93. static uint64_t addr_error_int_dis_prew(RegisterInfo *reg, uint64_t val64)
  94. {
  95. XlnxZynqMPRTC *s = XLNX_ZYNQMP_RTC(reg->opaque);
  96. s->regs[R_ADDR_ERROR_INT_MASK] |= (uint32_t) val64;
  97. addr_error_int_update_irq(s);
  98. return 0;
  99. }
  100. static const RegisterAccessInfo rtc_regs_info[] = {
  101. { .name = "SET_TIME_WRITE", .addr = A_SET_TIME_WRITE,
  102. .unimp = MAKE_64BIT_MASK(0, 32),
  103. },{ .name = "SET_TIME_READ", .addr = A_SET_TIME_READ,
  104. .ro = 0xffffffff,
  105. .post_read = current_time_postr,
  106. },{ .name = "CALIB_WRITE", .addr = A_CALIB_WRITE,
  107. .unimp = MAKE_64BIT_MASK(0, 32),
  108. },{ .name = "CALIB_READ", .addr = A_CALIB_READ,
  109. .ro = 0x1fffff,
  110. },{ .name = "CURRENT_TIME", .addr = A_CURRENT_TIME,
  111. .ro = 0xffffffff,
  112. .post_read = current_time_postr,
  113. },{ .name = "CURRENT_TICK", .addr = A_CURRENT_TICK,
  114. .ro = 0xffff,
  115. },{ .name = "ALARM", .addr = A_ALARM,
  116. },{ .name = "RTC_INT_STATUS", .addr = A_RTC_INT_STATUS,
  117. .w1c = 0x3,
  118. .post_write = rtc_int_status_postw,
  119. },{ .name = "RTC_INT_MASK", .addr = A_RTC_INT_MASK,
  120. .reset = 0x3,
  121. .ro = 0x3,
  122. },{ .name = "RTC_INT_EN", .addr = A_RTC_INT_EN,
  123. .pre_write = rtc_int_en_prew,
  124. },{ .name = "RTC_INT_DIS", .addr = A_RTC_INT_DIS,
  125. .pre_write = rtc_int_dis_prew,
  126. },{ .name = "ADDR_ERROR", .addr = A_ADDR_ERROR,
  127. .w1c = 0x1,
  128. .post_write = addr_error_postw,
  129. },{ .name = "ADDR_ERROR_INT_MASK", .addr = A_ADDR_ERROR_INT_MASK,
  130. .reset = 0x1,
  131. .ro = 0x1,
  132. },{ .name = "ADDR_ERROR_INT_EN", .addr = A_ADDR_ERROR_INT_EN,
  133. .pre_write = addr_error_int_en_prew,
  134. },{ .name = "ADDR_ERROR_INT_DIS", .addr = A_ADDR_ERROR_INT_DIS,
  135. .pre_write = addr_error_int_dis_prew,
  136. },{ .name = "CONTROL", .addr = A_CONTROL,
  137. .reset = 0x1000000,
  138. .rsvd = 0x70fffffe,
  139. },{ .name = "SAFETY_CHK", .addr = A_SAFETY_CHK,
  140. }
  141. };
  142. static void rtc_reset(DeviceState *dev)
  143. {
  144. XlnxZynqMPRTC *s = XLNX_ZYNQMP_RTC(dev);
  145. unsigned int i;
  146. for (i = 0; i < ARRAY_SIZE(s->regs_info); ++i) {
  147. register_reset(&s->regs_info[i]);
  148. }
  149. rtc_int_update_irq(s);
  150. addr_error_int_update_irq(s);
  151. }
  152. static const MemoryRegionOps rtc_ops = {
  153. .read = register_read_memory,
  154. .write = register_write_memory,
  155. .endianness = DEVICE_LITTLE_ENDIAN,
  156. .valid = {
  157. .min_access_size = 4,
  158. .max_access_size = 4,
  159. },
  160. };
  161. static void rtc_init(Object *obj)
  162. {
  163. XlnxZynqMPRTC *s = XLNX_ZYNQMP_RTC(obj);
  164. SysBusDevice *sbd = SYS_BUS_DEVICE(obj);
  165. RegisterInfoArray *reg_array;
  166. struct tm current_tm;
  167. memory_region_init(&s->iomem, obj, TYPE_XLNX_ZYNQMP_RTC,
  168. XLNX_ZYNQMP_RTC_R_MAX * 4);
  169. reg_array =
  170. register_init_block32(DEVICE(obj), rtc_regs_info,
  171. ARRAY_SIZE(rtc_regs_info),
  172. s->regs_info, s->regs,
  173. &rtc_ops,
  174. XLNX_ZYNQMP_RTC_ERR_DEBUG,
  175. XLNX_ZYNQMP_RTC_R_MAX * 4);
  176. memory_region_add_subregion(&s->iomem,
  177. 0x0,
  178. &reg_array->mem);
  179. sysbus_init_mmio(sbd, &s->iomem);
  180. sysbus_init_irq(sbd, &s->irq_rtc_int);
  181. sysbus_init_irq(sbd, &s->irq_addr_error_int);
  182. qemu_get_timedate(&current_tm, 0);
  183. s->tick_offset = mktimegm(&current_tm) -
  184. qemu_clock_get_ns(rtc_clock) / NANOSECONDS_PER_SECOND;
  185. trace_xlnx_zynqmp_rtc_gettime(current_tm.tm_year, current_tm.tm_mon,
  186. current_tm.tm_mday, current_tm.tm_hour,
  187. current_tm.tm_min, current_tm.tm_sec);
  188. }
  189. static int rtc_pre_save(void *opaque)
  190. {
  191. XlnxZynqMPRTC *s = opaque;
  192. int64_t now = qemu_clock_get_ns(rtc_clock) / NANOSECONDS_PER_SECOND;
  193. /* Add the time at migration */
  194. s->tick_offset = s->tick_offset + now;
  195. return 0;
  196. }
  197. static int rtc_post_load(void *opaque, int version_id)
  198. {
  199. XlnxZynqMPRTC *s = opaque;
  200. int64_t now = qemu_clock_get_ns(rtc_clock) / NANOSECONDS_PER_SECOND;
  201. /* Subtract the time after migration. This combined with the pre_save
  202. * action results in us having subtracted the time that the guest was
  203. * stopped to the offset.
  204. */
  205. s->tick_offset = s->tick_offset - now;
  206. return 0;
  207. }
  208. static const VMStateDescription vmstate_rtc = {
  209. .name = TYPE_XLNX_ZYNQMP_RTC,
  210. .version_id = 1,
  211. .minimum_version_id = 1,
  212. .pre_save = rtc_pre_save,
  213. .post_load = rtc_post_load,
  214. .fields = (VMStateField[]) {
  215. VMSTATE_UINT32_ARRAY(regs, XlnxZynqMPRTC, XLNX_ZYNQMP_RTC_R_MAX),
  216. VMSTATE_UINT32(tick_offset, XlnxZynqMPRTC),
  217. VMSTATE_END_OF_LIST(),
  218. }
  219. };
  220. static void rtc_class_init(ObjectClass *klass, void *data)
  221. {
  222. DeviceClass *dc = DEVICE_CLASS(klass);
  223. dc->reset = rtc_reset;
  224. dc->vmsd = &vmstate_rtc;
  225. }
  226. static const TypeInfo rtc_info = {
  227. .name = TYPE_XLNX_ZYNQMP_RTC,
  228. .parent = TYPE_SYS_BUS_DEVICE,
  229. .instance_size = sizeof(XlnxZynqMPRTC),
  230. .class_init = rtc_class_init,
  231. .instance_init = rtc_init,
  232. };
  233. static void rtc_register_types(void)
  234. {
  235. type_register_static(&rtc_info);
  236. }
  237. type_init(rtc_register_types)