zynq_slcr.c 18 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625
  1. /*
  2. * Status and system control registers for Xilinx Zynq Platform
  3. *
  4. * Copyright (c) 2011 Michal Simek <monstr@monstr.eu>
  5. * Copyright (c) 2012 PetaLogix Pty Ltd.
  6. * Based on hw/arm_sysctl.c, written by Paul Brook
  7. *
  8. * This program is free software; you can redistribute it and/or
  9. * modify it under the terms of the GNU General Public License
  10. * as published by the Free Software Foundation; either version
  11. * 2 of the License, or (at your option) any later version.
  12. *
  13. * You should have received a copy of the GNU General Public License along
  14. * with this program; if not, see <http://www.gnu.org/licenses/>.
  15. */
  16. #include "qemu/osdep.h"
  17. #include "qemu/timer.h"
  18. #include "sysemu/runstate.h"
  19. #include "hw/sysbus.h"
  20. #include "migration/vmstate.h"
  21. #include "qemu/log.h"
  22. #include "qemu/module.h"
  23. #include "hw/registerfields.h"
  24. #include "hw/qdev-clock.h"
  25. #ifndef ZYNQ_SLCR_ERR_DEBUG
  26. #define ZYNQ_SLCR_ERR_DEBUG 0
  27. #endif
  28. #define DB_PRINT(...) do { \
  29. if (ZYNQ_SLCR_ERR_DEBUG) { \
  30. fprintf(stderr, ": %s: ", __func__); \
  31. fprintf(stderr, ## __VA_ARGS__); \
  32. } \
  33. } while (0)
  34. #define XILINX_LOCK_KEY 0x767b
  35. #define XILINX_UNLOCK_KEY 0xdf0d
  36. REG32(SCL, 0x000)
  37. REG32(LOCK, 0x004)
  38. REG32(UNLOCK, 0x008)
  39. REG32(LOCKSTA, 0x00c)
  40. REG32(ARM_PLL_CTRL, 0x100)
  41. REG32(DDR_PLL_CTRL, 0x104)
  42. REG32(IO_PLL_CTRL, 0x108)
  43. /* fields for [ARM|DDR|IO]_PLL_CTRL registers */
  44. FIELD(xxx_PLL_CTRL, PLL_RESET, 0, 1)
  45. FIELD(xxx_PLL_CTRL, PLL_PWRDWN, 1, 1)
  46. FIELD(xxx_PLL_CTRL, PLL_BYPASS_QUAL, 3, 1)
  47. FIELD(xxx_PLL_CTRL, PLL_BYPASS_FORCE, 4, 1)
  48. FIELD(xxx_PLL_CTRL, PLL_FPDIV, 12, 7)
  49. REG32(PLL_STATUS, 0x10c)
  50. REG32(ARM_PLL_CFG, 0x110)
  51. REG32(DDR_PLL_CFG, 0x114)
  52. REG32(IO_PLL_CFG, 0x118)
  53. REG32(ARM_CLK_CTRL, 0x120)
  54. REG32(DDR_CLK_CTRL, 0x124)
  55. REG32(DCI_CLK_CTRL, 0x128)
  56. REG32(APER_CLK_CTRL, 0x12c)
  57. REG32(USB0_CLK_CTRL, 0x130)
  58. REG32(USB1_CLK_CTRL, 0x134)
  59. REG32(GEM0_RCLK_CTRL, 0x138)
  60. REG32(GEM1_RCLK_CTRL, 0x13c)
  61. REG32(GEM0_CLK_CTRL, 0x140)
  62. REG32(GEM1_CLK_CTRL, 0x144)
  63. REG32(SMC_CLK_CTRL, 0x148)
  64. REG32(LQSPI_CLK_CTRL, 0x14c)
  65. REG32(SDIO_CLK_CTRL, 0x150)
  66. REG32(UART_CLK_CTRL, 0x154)
  67. FIELD(UART_CLK_CTRL, CLKACT0, 0, 1)
  68. FIELD(UART_CLK_CTRL, CLKACT1, 1, 1)
  69. FIELD(UART_CLK_CTRL, SRCSEL, 4, 2)
  70. FIELD(UART_CLK_CTRL, DIVISOR, 8, 6)
  71. REG32(SPI_CLK_CTRL, 0x158)
  72. REG32(CAN_CLK_CTRL, 0x15c)
  73. REG32(CAN_MIOCLK_CTRL, 0x160)
  74. REG32(DBG_CLK_CTRL, 0x164)
  75. REG32(PCAP_CLK_CTRL, 0x168)
  76. REG32(TOPSW_CLK_CTRL, 0x16c)
  77. #define FPGA_CTRL_REGS(n, start) \
  78. REG32(FPGA ## n ## _CLK_CTRL, (start)) \
  79. REG32(FPGA ## n ## _THR_CTRL, (start) + 0x4)\
  80. REG32(FPGA ## n ## _THR_CNT, (start) + 0x8)\
  81. REG32(FPGA ## n ## _THR_STA, (start) + 0xc)
  82. FPGA_CTRL_REGS(0, 0x170)
  83. FPGA_CTRL_REGS(1, 0x180)
  84. FPGA_CTRL_REGS(2, 0x190)
  85. FPGA_CTRL_REGS(3, 0x1a0)
  86. REG32(BANDGAP_TRIP, 0x1b8)
  87. REG32(PLL_PREDIVISOR, 0x1c0)
  88. REG32(CLK_621_TRUE, 0x1c4)
  89. REG32(PSS_RST_CTRL, 0x200)
  90. FIELD(PSS_RST_CTRL, SOFT_RST, 0, 1)
  91. REG32(DDR_RST_CTRL, 0x204)
  92. REG32(TOPSW_RESET_CTRL, 0x208)
  93. REG32(DMAC_RST_CTRL, 0x20c)
  94. REG32(USB_RST_CTRL, 0x210)
  95. REG32(GEM_RST_CTRL, 0x214)
  96. REG32(SDIO_RST_CTRL, 0x218)
  97. REG32(SPI_RST_CTRL, 0x21c)
  98. REG32(CAN_RST_CTRL, 0x220)
  99. REG32(I2C_RST_CTRL, 0x224)
  100. REG32(UART_RST_CTRL, 0x228)
  101. REG32(GPIO_RST_CTRL, 0x22c)
  102. REG32(LQSPI_RST_CTRL, 0x230)
  103. REG32(SMC_RST_CTRL, 0x234)
  104. REG32(OCM_RST_CTRL, 0x238)
  105. REG32(FPGA_RST_CTRL, 0x240)
  106. REG32(A9_CPU_RST_CTRL, 0x244)
  107. REG32(RS_AWDT_CTRL, 0x24c)
  108. REG32(RST_REASON, 0x250)
  109. REG32(REBOOT_STATUS, 0x258)
  110. REG32(BOOT_MODE, 0x25c)
  111. REG32(APU_CTRL, 0x300)
  112. REG32(WDT_CLK_SEL, 0x304)
  113. REG32(TZ_DMA_NS, 0x440)
  114. REG32(TZ_DMA_IRQ_NS, 0x444)
  115. REG32(TZ_DMA_PERIPH_NS, 0x448)
  116. REG32(PSS_IDCODE, 0x530)
  117. REG32(DDR_URGENT, 0x600)
  118. REG32(DDR_CAL_START, 0x60c)
  119. REG32(DDR_REF_START, 0x614)
  120. REG32(DDR_CMD_STA, 0x618)
  121. REG32(DDR_URGENT_SEL, 0x61c)
  122. REG32(DDR_DFI_STATUS, 0x620)
  123. REG32(MIO, 0x700)
  124. #define MIO_LENGTH 54
  125. REG32(MIO_LOOPBACK, 0x804)
  126. REG32(MIO_MST_TRI0, 0x808)
  127. REG32(MIO_MST_TRI1, 0x80c)
  128. REG32(SD0_WP_CD_SEL, 0x830)
  129. REG32(SD1_WP_CD_SEL, 0x834)
  130. REG32(LVL_SHFTR_EN, 0x900)
  131. REG32(OCM_CFG, 0x910)
  132. REG32(CPU_RAM, 0xa00)
  133. REG32(IOU, 0xa30)
  134. REG32(DMAC_RAM, 0xa50)
  135. REG32(AFI0, 0xa60)
  136. REG32(AFI1, 0xa6c)
  137. REG32(AFI2, 0xa78)
  138. REG32(AFI3, 0xa84)
  139. #define AFI_LENGTH 3
  140. REG32(OCM, 0xa90)
  141. REG32(DEVCI_RAM, 0xaa0)
  142. REG32(CSG_RAM, 0xab0)
  143. REG32(GPIOB_CTRL, 0xb00)
  144. REG32(GPIOB_CFG_CMOS18, 0xb04)
  145. REG32(GPIOB_CFG_CMOS25, 0xb08)
  146. REG32(GPIOB_CFG_CMOS33, 0xb0c)
  147. REG32(GPIOB_CFG_HSTL, 0xb14)
  148. REG32(GPIOB_DRVR_BIAS_CTRL, 0xb18)
  149. REG32(DDRIOB, 0xb40)
  150. #define DDRIOB_LENGTH 14
  151. #define ZYNQ_SLCR_MMIO_SIZE 0x1000
  152. #define ZYNQ_SLCR_NUM_REGS (ZYNQ_SLCR_MMIO_SIZE / 4)
  153. #define TYPE_ZYNQ_SLCR "xilinx,zynq_slcr"
  154. #define ZYNQ_SLCR(obj) OBJECT_CHECK(ZynqSLCRState, (obj), TYPE_ZYNQ_SLCR)
  155. typedef struct ZynqSLCRState {
  156. SysBusDevice parent_obj;
  157. MemoryRegion iomem;
  158. uint32_t regs[ZYNQ_SLCR_NUM_REGS];
  159. Clock *ps_clk;
  160. Clock *uart0_ref_clk;
  161. Clock *uart1_ref_clk;
  162. } ZynqSLCRState;
  163. /*
  164. * return the output frequency of ARM/DDR/IO pll
  165. * using input frequency and PLL_CTRL register
  166. */
  167. static uint64_t zynq_slcr_compute_pll(uint64_t input, uint32_t ctrl_reg)
  168. {
  169. uint32_t mult = ((ctrl_reg & R_xxx_PLL_CTRL_PLL_FPDIV_MASK) >>
  170. R_xxx_PLL_CTRL_PLL_FPDIV_SHIFT);
  171. /* first, check if pll is bypassed */
  172. if (ctrl_reg & R_xxx_PLL_CTRL_PLL_BYPASS_FORCE_MASK) {
  173. return input;
  174. }
  175. /* is pll disabled ? */
  176. if (ctrl_reg & (R_xxx_PLL_CTRL_PLL_RESET_MASK |
  177. R_xxx_PLL_CTRL_PLL_PWRDWN_MASK)) {
  178. return 0;
  179. }
  180. /* frequency multiplier -> period division */
  181. return input / mult;
  182. }
  183. /*
  184. * return the output period of a clock given:
  185. * + the periods in an array corresponding to input mux selector
  186. * + the register xxx_CLK_CTRL value
  187. * + enable bit index in ctrl register
  188. *
  189. * This function makes the assumption that the ctrl_reg value is organized as
  190. * follows:
  191. * + bits[13:8] clock frequency divisor
  192. * + bits[5:4] clock mux selector (index in array)
  193. * + bits[index] clock enable
  194. */
  195. static uint64_t zynq_slcr_compute_clock(const uint64_t periods[],
  196. uint32_t ctrl_reg,
  197. unsigned index)
  198. {
  199. uint32_t srcsel = extract32(ctrl_reg, 4, 2); /* bits [5:4] */
  200. uint32_t divisor = extract32(ctrl_reg, 8, 6); /* bits [13:8] */
  201. /* first, check if clock is disabled */
  202. if (((ctrl_reg >> index) & 1u) == 0) {
  203. return 0;
  204. }
  205. /*
  206. * according to the Zynq technical ref. manual UG585 v1.12.2 in
  207. * Clocks chapter, section 25.10.1 page 705:
  208. * "The 6-bit divider provides a divide range of 1 to 63"
  209. * We follow here what is implemented in linux kernel and consider
  210. * the 0 value as a bypass (no division).
  211. */
  212. /* frequency divisor -> period multiplication */
  213. return periods[srcsel] * (divisor ? divisor : 1u);
  214. }
  215. /*
  216. * macro helper around zynq_slcr_compute_clock to avoid repeating
  217. * the register name.
  218. */
  219. #define ZYNQ_COMPUTE_CLK(state, plls, reg, enable_field) \
  220. zynq_slcr_compute_clock((plls), (state)->regs[reg], \
  221. reg ## _ ## enable_field ## _SHIFT)
  222. /**
  223. * Compute and set the ouputs clocks periods.
  224. * But do not propagate them further. Connected clocks
  225. * will not receive any updates (See zynq_slcr_compute_clocks())
  226. */
  227. static void zynq_slcr_compute_clocks(ZynqSLCRState *s)
  228. {
  229. uint64_t ps_clk = clock_get(s->ps_clk);
  230. /* consider outputs clocks are disabled while in reset */
  231. if (device_is_in_reset(DEVICE(s))) {
  232. ps_clk = 0;
  233. }
  234. uint64_t io_pll = zynq_slcr_compute_pll(ps_clk, s->regs[R_IO_PLL_CTRL]);
  235. uint64_t arm_pll = zynq_slcr_compute_pll(ps_clk, s->regs[R_ARM_PLL_CTRL]);
  236. uint64_t ddr_pll = zynq_slcr_compute_pll(ps_clk, s->regs[R_DDR_PLL_CTRL]);
  237. uint64_t uart_mux[4] = {io_pll, io_pll, arm_pll, ddr_pll};
  238. /* compute uartX reference clocks */
  239. clock_set(s->uart0_ref_clk,
  240. ZYNQ_COMPUTE_CLK(s, uart_mux, R_UART_CLK_CTRL, CLKACT0));
  241. clock_set(s->uart1_ref_clk,
  242. ZYNQ_COMPUTE_CLK(s, uart_mux, R_UART_CLK_CTRL, CLKACT1));
  243. }
  244. /**
  245. * Propagate the outputs clocks.
  246. * zynq_slcr_compute_clocks() should have been called before
  247. * to configure them.
  248. */
  249. static void zynq_slcr_propagate_clocks(ZynqSLCRState *s)
  250. {
  251. clock_propagate(s->uart0_ref_clk);
  252. clock_propagate(s->uart1_ref_clk);
  253. }
  254. static void zynq_slcr_ps_clk_callback(void *opaque)
  255. {
  256. ZynqSLCRState *s = (ZynqSLCRState *) opaque;
  257. zynq_slcr_compute_clocks(s);
  258. zynq_slcr_propagate_clocks(s);
  259. }
  260. static void zynq_slcr_reset_init(Object *obj, ResetType type)
  261. {
  262. ZynqSLCRState *s = ZYNQ_SLCR(obj);
  263. int i;
  264. DB_PRINT("RESET\n");
  265. s->regs[R_LOCKSTA] = 1;
  266. /* 0x100 - 0x11C */
  267. s->regs[R_ARM_PLL_CTRL] = 0x0001A008;
  268. s->regs[R_DDR_PLL_CTRL] = 0x0001A008;
  269. s->regs[R_IO_PLL_CTRL] = 0x0001A008;
  270. s->regs[R_PLL_STATUS] = 0x0000003F;
  271. s->regs[R_ARM_PLL_CFG] = 0x00014000;
  272. s->regs[R_DDR_PLL_CFG] = 0x00014000;
  273. s->regs[R_IO_PLL_CFG] = 0x00014000;
  274. /* 0x120 - 0x16C */
  275. s->regs[R_ARM_CLK_CTRL] = 0x1F000400;
  276. s->regs[R_DDR_CLK_CTRL] = 0x18400003;
  277. s->regs[R_DCI_CLK_CTRL] = 0x01E03201;
  278. s->regs[R_APER_CLK_CTRL] = 0x01FFCCCD;
  279. s->regs[R_USB0_CLK_CTRL] = s->regs[R_USB1_CLK_CTRL] = 0x00101941;
  280. s->regs[R_GEM0_RCLK_CTRL] = s->regs[R_GEM1_RCLK_CTRL] = 0x00000001;
  281. s->regs[R_GEM0_CLK_CTRL] = s->regs[R_GEM1_CLK_CTRL] = 0x00003C01;
  282. s->regs[R_SMC_CLK_CTRL] = 0x00003C01;
  283. s->regs[R_LQSPI_CLK_CTRL] = 0x00002821;
  284. s->regs[R_SDIO_CLK_CTRL] = 0x00001E03;
  285. s->regs[R_UART_CLK_CTRL] = 0x00003F03;
  286. s->regs[R_SPI_CLK_CTRL] = 0x00003F03;
  287. s->regs[R_CAN_CLK_CTRL] = 0x00501903;
  288. s->regs[R_DBG_CLK_CTRL] = 0x00000F03;
  289. s->regs[R_PCAP_CLK_CTRL] = 0x00000F01;
  290. /* 0x170 - 0x1AC */
  291. s->regs[R_FPGA0_CLK_CTRL] = s->regs[R_FPGA1_CLK_CTRL]
  292. = s->regs[R_FPGA2_CLK_CTRL]
  293. = s->regs[R_FPGA3_CLK_CTRL] = 0x00101800;
  294. s->regs[R_FPGA0_THR_STA] = s->regs[R_FPGA1_THR_STA]
  295. = s->regs[R_FPGA2_THR_STA]
  296. = s->regs[R_FPGA3_THR_STA] = 0x00010000;
  297. /* 0x1B0 - 0x1D8 */
  298. s->regs[R_BANDGAP_TRIP] = 0x0000001F;
  299. s->regs[R_PLL_PREDIVISOR] = 0x00000001;
  300. s->regs[R_CLK_621_TRUE] = 0x00000001;
  301. /* 0x200 - 0x25C */
  302. s->regs[R_FPGA_RST_CTRL] = 0x01F33F0F;
  303. s->regs[R_RST_REASON] = 0x00000040;
  304. s->regs[R_BOOT_MODE] = 0x00000001;
  305. /* 0x700 - 0x7D4 */
  306. for (i = 0; i < 54; i++) {
  307. s->regs[R_MIO + i] = 0x00001601;
  308. }
  309. for (i = 2; i <= 8; i++) {
  310. s->regs[R_MIO + i] = 0x00000601;
  311. }
  312. s->regs[R_MIO_MST_TRI0] = s->regs[R_MIO_MST_TRI1] = 0xFFFFFFFF;
  313. s->regs[R_CPU_RAM + 0] = s->regs[R_CPU_RAM + 1] = s->regs[R_CPU_RAM + 3]
  314. = s->regs[R_CPU_RAM + 4] = s->regs[R_CPU_RAM + 7]
  315. = 0x00010101;
  316. s->regs[R_CPU_RAM + 2] = s->regs[R_CPU_RAM + 5] = 0x01010101;
  317. s->regs[R_CPU_RAM + 6] = 0x00000001;
  318. s->regs[R_IOU + 0] = s->regs[R_IOU + 1] = s->regs[R_IOU + 2]
  319. = s->regs[R_IOU + 3] = 0x09090909;
  320. s->regs[R_IOU + 4] = s->regs[R_IOU + 5] = 0x00090909;
  321. s->regs[R_IOU + 6] = 0x00000909;
  322. s->regs[R_DMAC_RAM] = 0x00000009;
  323. s->regs[R_AFI0 + 0] = s->regs[R_AFI0 + 1] = 0x09090909;
  324. s->regs[R_AFI1 + 0] = s->regs[R_AFI1 + 1] = 0x09090909;
  325. s->regs[R_AFI2 + 0] = s->regs[R_AFI2 + 1] = 0x09090909;
  326. s->regs[R_AFI3 + 0] = s->regs[R_AFI3 + 1] = 0x09090909;
  327. s->regs[R_AFI0 + 2] = s->regs[R_AFI1 + 2] = s->regs[R_AFI2 + 2]
  328. = s->regs[R_AFI3 + 2] = 0x00000909;
  329. s->regs[R_OCM + 0] = 0x01010101;
  330. s->regs[R_OCM + 1] = s->regs[R_OCM + 2] = 0x09090909;
  331. s->regs[R_DEVCI_RAM] = 0x00000909;
  332. s->regs[R_CSG_RAM] = 0x00000001;
  333. s->regs[R_DDRIOB + 0] = s->regs[R_DDRIOB + 1] = s->regs[R_DDRIOB + 2]
  334. = s->regs[R_DDRIOB + 3] = 0x00000e00;
  335. s->regs[R_DDRIOB + 4] = s->regs[R_DDRIOB + 5] = s->regs[R_DDRIOB + 6]
  336. = 0x00000e00;
  337. s->regs[R_DDRIOB + 12] = 0x00000021;
  338. }
  339. static void zynq_slcr_reset_hold(Object *obj)
  340. {
  341. ZynqSLCRState *s = ZYNQ_SLCR(obj);
  342. /* will disable all output clocks */
  343. zynq_slcr_compute_clocks(s);
  344. zynq_slcr_propagate_clocks(s);
  345. }
  346. static void zynq_slcr_reset_exit(Object *obj)
  347. {
  348. ZynqSLCRState *s = ZYNQ_SLCR(obj);
  349. /* will compute output clocks according to ps_clk and registers */
  350. zynq_slcr_compute_clocks(s);
  351. zynq_slcr_propagate_clocks(s);
  352. }
  353. static bool zynq_slcr_check_offset(hwaddr offset, bool rnw)
  354. {
  355. switch (offset) {
  356. case R_LOCK:
  357. case R_UNLOCK:
  358. case R_DDR_CAL_START:
  359. case R_DDR_REF_START:
  360. return !rnw; /* Write only */
  361. case R_LOCKSTA:
  362. case R_FPGA0_THR_STA:
  363. case R_FPGA1_THR_STA:
  364. case R_FPGA2_THR_STA:
  365. case R_FPGA3_THR_STA:
  366. case R_BOOT_MODE:
  367. case R_PSS_IDCODE:
  368. case R_DDR_CMD_STA:
  369. case R_DDR_DFI_STATUS:
  370. case R_PLL_STATUS:
  371. return rnw;/* read only */
  372. case R_SCL:
  373. case R_ARM_PLL_CTRL ... R_IO_PLL_CTRL:
  374. case R_ARM_PLL_CFG ... R_IO_PLL_CFG:
  375. case R_ARM_CLK_CTRL ... R_TOPSW_CLK_CTRL:
  376. case R_FPGA0_CLK_CTRL ... R_FPGA0_THR_CNT:
  377. case R_FPGA1_CLK_CTRL ... R_FPGA1_THR_CNT:
  378. case R_FPGA2_CLK_CTRL ... R_FPGA2_THR_CNT:
  379. case R_FPGA3_CLK_CTRL ... R_FPGA3_THR_CNT:
  380. case R_BANDGAP_TRIP:
  381. case R_PLL_PREDIVISOR:
  382. case R_CLK_621_TRUE:
  383. case R_PSS_RST_CTRL ... R_A9_CPU_RST_CTRL:
  384. case R_RS_AWDT_CTRL:
  385. case R_RST_REASON:
  386. case R_REBOOT_STATUS:
  387. case R_APU_CTRL:
  388. case R_WDT_CLK_SEL:
  389. case R_TZ_DMA_NS ... R_TZ_DMA_PERIPH_NS:
  390. case R_DDR_URGENT:
  391. case R_DDR_URGENT_SEL:
  392. case R_MIO ... R_MIO + MIO_LENGTH - 1:
  393. case R_MIO_LOOPBACK ... R_MIO_MST_TRI1:
  394. case R_SD0_WP_CD_SEL:
  395. case R_SD1_WP_CD_SEL:
  396. case R_LVL_SHFTR_EN:
  397. case R_OCM_CFG:
  398. case R_CPU_RAM:
  399. case R_IOU:
  400. case R_DMAC_RAM:
  401. case R_AFI0 ... R_AFI3 + AFI_LENGTH - 1:
  402. case R_OCM:
  403. case R_DEVCI_RAM:
  404. case R_CSG_RAM:
  405. case R_GPIOB_CTRL ... R_GPIOB_CFG_CMOS33:
  406. case R_GPIOB_CFG_HSTL:
  407. case R_GPIOB_DRVR_BIAS_CTRL:
  408. case R_DDRIOB ... R_DDRIOB + DDRIOB_LENGTH - 1:
  409. return true;
  410. default:
  411. return false;
  412. }
  413. }
  414. static uint64_t zynq_slcr_read(void *opaque, hwaddr offset,
  415. unsigned size)
  416. {
  417. ZynqSLCRState *s = opaque;
  418. offset /= 4;
  419. uint32_t ret = s->regs[offset];
  420. if (!zynq_slcr_check_offset(offset, true)) {
  421. qemu_log_mask(LOG_GUEST_ERROR, "zynq_slcr: Invalid read access to "
  422. " addr %" HWADDR_PRIx "\n", offset * 4);
  423. }
  424. DB_PRINT("addr: %08" HWADDR_PRIx " data: %08" PRIx32 "\n", offset * 4, ret);
  425. return ret;
  426. }
  427. static void zynq_slcr_write(void *opaque, hwaddr offset,
  428. uint64_t val, unsigned size)
  429. {
  430. ZynqSLCRState *s = (ZynqSLCRState *)opaque;
  431. offset /= 4;
  432. DB_PRINT("addr: %08" HWADDR_PRIx " data: %08" PRIx64 "\n", offset * 4, val);
  433. if (!zynq_slcr_check_offset(offset, false)) {
  434. qemu_log_mask(LOG_GUEST_ERROR, "zynq_slcr: Invalid write access to "
  435. "addr %" HWADDR_PRIx "\n", offset * 4);
  436. return;
  437. }
  438. switch (offset) {
  439. case R_SCL:
  440. s->regs[R_SCL] = val & 0x1;
  441. return;
  442. case R_LOCK:
  443. if ((val & 0xFFFF) == XILINX_LOCK_KEY) {
  444. DB_PRINT("XILINX LOCK 0xF8000000 + 0x%x <= 0x%x\n", (int)offset,
  445. (unsigned)val & 0xFFFF);
  446. s->regs[R_LOCKSTA] = 1;
  447. } else {
  448. DB_PRINT("WRONG XILINX LOCK KEY 0xF8000000 + 0x%x <= 0x%x\n",
  449. (int)offset, (unsigned)val & 0xFFFF);
  450. }
  451. return;
  452. case R_UNLOCK:
  453. if ((val & 0xFFFF) == XILINX_UNLOCK_KEY) {
  454. DB_PRINT("XILINX UNLOCK 0xF8000000 + 0x%x <= 0x%x\n", (int)offset,
  455. (unsigned)val & 0xFFFF);
  456. s->regs[R_LOCKSTA] = 0;
  457. } else {
  458. DB_PRINT("WRONG XILINX UNLOCK KEY 0xF8000000 + 0x%x <= 0x%x\n",
  459. (int)offset, (unsigned)val & 0xFFFF);
  460. }
  461. return;
  462. }
  463. if (s->regs[R_LOCKSTA]) {
  464. qemu_log_mask(LOG_GUEST_ERROR,
  465. "SCLR registers are locked. Unlock them first\n");
  466. return;
  467. }
  468. s->regs[offset] = val;
  469. switch (offset) {
  470. case R_PSS_RST_CTRL:
  471. if (FIELD_EX32(val, PSS_RST_CTRL, SOFT_RST)) {
  472. qemu_system_reset_request(SHUTDOWN_CAUSE_GUEST_RESET);
  473. }
  474. break;
  475. case R_IO_PLL_CTRL:
  476. case R_ARM_PLL_CTRL:
  477. case R_DDR_PLL_CTRL:
  478. case R_UART_CLK_CTRL:
  479. zynq_slcr_compute_clocks(s);
  480. zynq_slcr_propagate_clocks(s);
  481. break;
  482. }
  483. }
  484. static const MemoryRegionOps slcr_ops = {
  485. .read = zynq_slcr_read,
  486. .write = zynq_slcr_write,
  487. .endianness = DEVICE_NATIVE_ENDIAN,
  488. };
  489. static const ClockPortInitArray zynq_slcr_clocks = {
  490. QDEV_CLOCK_IN(ZynqSLCRState, ps_clk, zynq_slcr_ps_clk_callback),
  491. QDEV_CLOCK_OUT(ZynqSLCRState, uart0_ref_clk),
  492. QDEV_CLOCK_OUT(ZynqSLCRState, uart1_ref_clk),
  493. QDEV_CLOCK_END
  494. };
  495. static void zynq_slcr_init(Object *obj)
  496. {
  497. ZynqSLCRState *s = ZYNQ_SLCR(obj);
  498. memory_region_init_io(&s->iomem, obj, &slcr_ops, s, "slcr",
  499. ZYNQ_SLCR_MMIO_SIZE);
  500. sysbus_init_mmio(SYS_BUS_DEVICE(obj), &s->iomem);
  501. qdev_init_clocks(DEVICE(obj), zynq_slcr_clocks);
  502. }
  503. static const VMStateDescription vmstate_zynq_slcr = {
  504. .name = "zynq_slcr",
  505. .version_id = 3,
  506. .minimum_version_id = 2,
  507. .fields = (VMStateField[]) {
  508. VMSTATE_UINT32_ARRAY(regs, ZynqSLCRState, ZYNQ_SLCR_NUM_REGS),
  509. VMSTATE_CLOCK_V(ps_clk, ZynqSLCRState, 3),
  510. VMSTATE_END_OF_LIST()
  511. }
  512. };
  513. static void zynq_slcr_class_init(ObjectClass *klass, void *data)
  514. {
  515. DeviceClass *dc = DEVICE_CLASS(klass);
  516. ResettableClass *rc = RESETTABLE_CLASS(klass);
  517. dc->vmsd = &vmstate_zynq_slcr;
  518. rc->phases.enter = zynq_slcr_reset_init;
  519. rc->phases.hold = zynq_slcr_reset_hold;
  520. rc->phases.exit = zynq_slcr_reset_exit;
  521. }
  522. static const TypeInfo zynq_slcr_info = {
  523. .class_init = zynq_slcr_class_init,
  524. .name = TYPE_ZYNQ_SLCR,
  525. .parent = TYPE_SYS_BUS_DEVICE,
  526. .instance_size = sizeof(ZynqSLCRState),
  527. .instance_init = zynq_slcr_init,
  528. };
  529. static void zynq_slcr_register_types(void)
  530. {
  531. type_register_static(&zynq_slcr_info);
  532. }
  533. type_init(zynq_slcr_register_types)