rjw | 1f88458 | 2022-01-06 17:20:42 +0800 | [diff] [blame^] | 1 | /* |
| 2 | * Copyright (c) 2014 Travis Geiselbrecht |
| 3 | * Copyright (c) 2014 Chris Anderson |
| 4 | * |
| 5 | * Permission is hereby granted, free of charge, to any person obtaining |
| 6 | * a copy of this software and associated documentation files |
| 7 | * (the "Software"), to deal in the Software without restriction, |
| 8 | * including without limitation the rights to use, copy, modify, merge, |
| 9 | * publish, distribute, sublicense, and/or sell copies of the Software, |
| 10 | * and to permit persons to whom the Software is furnished to do so, |
| 11 | * subject to the following conditions: |
| 12 | * |
| 13 | * The above copyright notice and this permission notice shall be |
| 14 | * included in all copies or substantial portions of the Software. |
| 15 | * |
| 16 | * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, |
| 17 | * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF |
| 18 | * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. |
| 19 | * IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY |
| 20 | * CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, |
| 21 | * TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE |
| 22 | * SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. |
| 23 | */ |
| 24 | |
| 25 | #include <stdio.h> |
| 26 | #include <dev/gpio.h> |
| 27 | #include <lib/pktbuf.h> |
| 28 | #include <kernel/vm.h> |
| 29 | #include <platform/zynq.h> |
| 30 | #include <platform/gem.h> |
| 31 | #include <platform/gpio.h> |
| 32 | #include <platform/interrupts.h> |
| 33 | #include <target/gpioconfig.h> |
| 34 | |
| 35 | zynq_pll_cfg_tree_t zynq_pll_cfg = { |
| 36 | .arm = { |
| 37 | .lock_cnt = 375, |
| 38 | .cp = 2, |
| 39 | .res = 12, |
| 40 | .fdiv = 26, |
| 41 | }, |
| 42 | .ddr = { |
| 43 | .lock_cnt = 475, |
| 44 | .cp = 2, |
| 45 | .res = 12, |
| 46 | .fdiv = 26, |
| 47 | }, |
| 48 | .io = { |
| 49 | .lock_cnt = 500, |
| 50 | .cp = 2, |
| 51 | .res = 12, |
| 52 | .fdiv = 20, |
| 53 | } |
| 54 | }; |
| 55 | |
| 56 | const unsigned long zynq_ddr_cfg[] = { |
| 57 | 0XF8006000, 0x00000080U, 0XF8006004, 0x0000107FU, 0XF8006008, 0x03C0780FU, |
| 58 | 0XF800600C, 0x02001001U, 0XF8006010, 0x00014001U, 0XF8006014, 0x0004151AU, |
| 59 | 0XF8006018, 0x44E354D2U, 0XF800601C, 0x720238E5U, 0XF8006020, 0x270872D0U, |
| 60 | 0XF8006024, 0x00000000U, 0XF8006028, 0x00002007U, 0XF800602C, 0x00000008U, |
| 61 | 0XF8006030, 0x00040930U, 0XF8006034, 0x00011014U, 0XF8006038, 0x00000000U, |
| 62 | 0XF800603C, 0x00000777U, 0XF8006040, 0xFFF00000U, 0XF8006044, 0x0FF66666U, |
| 63 | 0XF8006048, 0x0003C000U, 0XF8006050, 0x77010800U, 0XF8006058, 0x00000000U, |
| 64 | 0XF800605C, 0x00005003U, 0XF8006060, 0x0000003EU, 0XF8006064, 0x00020000U, |
| 65 | 0XF8006068, 0x00284141U, 0XF800606C, 0x00001610U, 0XF80060A4, 0x10200802U, |
| 66 | 0XF80060A8, 0x0670C845U, 0XF80060AC, 0x000001FEU, 0XF80060B0, 0x1CFFFFFFU, |
| 67 | 0XF80060B4, 0x00000200U, 0XF80060B8, 0x00200066U, 0XF80060C4, 0x00000003U, |
| 68 | 0XF80060C4, 0x00000000U, 0XF80060C8, 0x00000000U, 0XF80060DC, 0x00000000U, |
| 69 | 0XF80060F0, 0x00000000U, 0XF80060F4, 0x00000008U, 0XF8006114, 0x00000000U, |
| 70 | 0XF8006118, 0x40000001U, 0XF800611C, 0x40000001U, 0XF8006120, 0x40000001U, |
| 71 | 0XF8006124, 0x40000001U, 0XF800612C, 0x00023C00U, 0XF8006130, 0x00022800U, |
| 72 | 0XF8006134, 0x00022C00U, 0XF8006138, 0x00024800U, 0XF8006140, 0x00000035U, |
| 73 | 0XF8006144, 0x00000035U, 0XF8006148, 0x00000035U, 0XF800614C, 0x00000035U, |
| 74 | 0XF8006154, 0x00000077U, 0XF8006158, 0x0000007CU, 0XF800615C, 0x0000007CU, |
| 75 | 0XF8006160, 0x00000075U, 0XF8006168, 0x000000E4U, 0XF800616C, 0x000000DFU, |
| 76 | 0XF8006170, 0x000000E0U, 0XF8006174, 0x000000E7U, 0XF800617C, 0x000000B7U, |
| 77 | 0XF8006180, 0x000000BCU, 0XF8006184, 0x000000BCU, 0XF8006188, 0x000000B5U, |
| 78 | 0XF8006190, 0x00040080U, 0XF8006194, 0x0001FC82U, 0XF8006204, 0x00000000U, |
| 79 | 0XF8006208, 0x000003FFU, 0XF800620C, 0x000003FFU, 0XF8006210, 0x000003FFU, |
| 80 | 0XF8006214, 0x000003FFU, 0XF8006218, 0x000003FFU, 0XF800621C, 0x000003FFU, |
| 81 | 0XF8006220, 0x000003FFU, 0XF8006224, 0x000003FFU, 0XF80062A8, 0x00000000U, |
| 82 | 0XF80062AC, 0x00000000U, 0XF80062B0, 0x00005125U, 0XF80062B4, 0x000012A6U, |
| 83 | }; |
| 84 | |
| 85 | const unsigned long zynq_ddr_cfg_cnt = countof(zynq_ddr_cfg); |
| 86 | |
| 87 | const zynq_ddriob_cfg_t zynq_ddriob_cfg = { |
| 88 | .addr0 = DDRIOB_OUTPUT_EN(0x3), |
| 89 | .addr1 = DDRIOB_OUTPUT_EN(0x3), |
| 90 | .data0 = DDRIOB_INP_TYPE(1) | DDRIOB_TERM_EN | DDRIOB_DCI_TYPE(0x3) | DDRIOB_OUTPUT_EN(0x3), |
| 91 | .data1 = DDRIOB_INP_TYPE(1) | DDRIOB_TERM_EN | DDRIOB_DCI_TYPE(0x3) | DDRIOB_OUTPUT_EN(0x3), |
| 92 | .diff0 = DDRIOB_INP_TYPE(2) | DDRIOB_TERM_EN | DDRIOB_DCI_TYPE(0x3) | DDRIOB_OUTPUT_EN(0x3), |
| 93 | .diff1 = DDRIOB_INP_TYPE(2) | DDRIOB_TERM_EN | DDRIOB_DCI_TYPE(0x3) | DDRIOB_OUTPUT_EN(0x3), |
| 94 | .ibuf_disable = false, |
| 95 | .term_disable = false, |
| 96 | }; |
| 97 | |
| 98 | const uint32_t zynq_mio_cfg[ZYNQ_MIO_CNT] = { |
| 99 | [0] = MIO_DEFAULT, |
| 100 | [1] = MIO_L0_SEL | MIO_SPEED_FAST | MIO_IO_TYPE_LVCMOS33, |
| 101 | [2] = MIO_L0_SEL | MIO_SPEED_FAST | MIO_IO_TYPE_LVCMOS33, |
| 102 | [3] = MIO_L0_SEL | MIO_SPEED_FAST | MIO_IO_TYPE_LVCMOS33, |
| 103 | [4] = MIO_L0_SEL | MIO_SPEED_FAST | MIO_IO_TYPE_LVCMOS33, |
| 104 | [5] = MIO_L0_SEL | MIO_SPEED_FAST | MIO_IO_TYPE_LVCMOS33, |
| 105 | [6] = MIO_L0_SEL | MIO_SPEED_FAST | MIO_IO_TYPE_LVCMOS33, |
| 106 | // LED4 |
| 107 | [7] = MIO_IO_TYPE_LVCMOS18 | MIO_DISABLE_RCVR, |
| 108 | [8] = MIO_L0_SEL | MIO_SPEED_FAST | MIO_IO_TYPE_LVCMOS33, |
| 109 | // 16-21 gem0 |
| 110 | [9] = MIO_DEFAULT, |
| 111 | [10] = MIO_DEFAULT, |
| 112 | [11] = MIO_DEFAULT, |
| 113 | [12] = MIO_DEFAULT, |
| 114 | [13] = MIO_DEFAULT, |
| 115 | [14] = MIO_DEFAULT, |
| 116 | [15] = MIO_DEFAULT, |
| 117 | [16] = MIO_L0_SEL | MIO_SPEED_FAST | MIO_IO_TYPE_HSTL | MIO_PULLUP | MIO_DISABLE_RCVR, |
| 118 | [17] = MIO_L0_SEL | MIO_SPEED_FAST | MIO_IO_TYPE_HSTL | MIO_PULLUP | MIO_DISABLE_RCVR, |
| 119 | [18] = MIO_L0_SEL | MIO_SPEED_FAST | MIO_IO_TYPE_HSTL | MIO_PULLUP | MIO_DISABLE_RCVR, |
| 120 | [19] = MIO_L0_SEL | MIO_SPEED_FAST | MIO_IO_TYPE_HSTL | MIO_PULLUP | MIO_DISABLE_RCVR, |
| 121 | [20] = MIO_L0_SEL | MIO_SPEED_FAST | MIO_IO_TYPE_HSTL | MIO_PULLUP | MIO_DISABLE_RCVR, |
| 122 | [21] = MIO_L0_SEL | MIO_SPEED_FAST | MIO_IO_TYPE_HSTL | MIO_PULLUP | MIO_DISABLE_RCVR, |
| 123 | // 22-27 gem0 |
| 124 | [22] = MIO_L0_SEL | MIO_SPEED_FAST | MIO_IO_TYPE_HSTL | MIO_PULLUP, |
| 125 | [23] = MIO_L0_SEL | MIO_SPEED_FAST | MIO_IO_TYPE_HSTL | MIO_PULLUP, |
| 126 | [24] = MIO_L0_SEL | MIO_SPEED_FAST | MIO_IO_TYPE_HSTL | MIO_PULLUP, |
| 127 | [25] = MIO_L0_SEL | MIO_SPEED_FAST | MIO_IO_TYPE_HSTL | MIO_PULLUP, |
| 128 | [26] = MIO_L0_SEL | MIO_SPEED_FAST | MIO_IO_TYPE_HSTL | MIO_PULLUP, |
| 129 | [27] = MIO_L0_SEL | MIO_SPEED_FAST | MIO_IO_TYPE_HSTL | MIO_PULLUP, |
| 130 | [28] = MIO_L1_SEL | MIO_SPEED_FAST | MIO_IO_TYPE_LVCMOS18, |
| 131 | [29] = MIO_L1_SEL | MIO_SPEED_FAST | MIO_IO_TYPE_LVCMOS18 | MIO_TRI_ENABLE, |
| 132 | [30] = MIO_L1_SEL | MIO_SPEED_FAST | MIO_IO_TYPE_LVCMOS18, |
| 133 | [31] = MIO_L1_SEL | MIO_SPEED_FAST | MIO_IO_TYPE_LVCMOS18 | MIO_TRI_ENABLE, |
| 134 | [32] = MIO_L1_SEL | MIO_SPEED_FAST | MIO_IO_TYPE_LVCMOS18, |
| 135 | [33] = MIO_L1_SEL | MIO_SPEED_FAST | MIO_IO_TYPE_LVCMOS18, |
| 136 | [34] = MIO_L1_SEL | MIO_SPEED_FAST | MIO_IO_TYPE_LVCMOS18, |
| 137 | [35] = MIO_L1_SEL | MIO_SPEED_FAST | MIO_IO_TYPE_LVCMOS18, |
| 138 | [36] = MIO_L1_SEL | MIO_SPEED_FAST | MIO_IO_TYPE_LVCMOS18 | MIO_TRI_ENABLE, |
| 139 | [37] = MIO_L1_SEL | MIO_SPEED_FAST | MIO_IO_TYPE_LVCMOS18, |
| 140 | [38] = MIO_L1_SEL | MIO_SPEED_FAST | MIO_IO_TYPE_LVCMOS18, |
| 141 | [39] = MIO_L1_SEL | MIO_SPEED_FAST | MIO_IO_TYPE_LVCMOS18, |
| 142 | [40] = MIO_L3_SEL(0x4) | MIO_SPEED_FAST | MIO_IO_TYPE_LVCMOS18, |
| 143 | [41] = MIO_L3_SEL(0x4) | MIO_SPEED_FAST | MIO_IO_TYPE_LVCMOS18, |
| 144 | [42] = MIO_L3_SEL(0x4) | MIO_SPEED_FAST | MIO_IO_TYPE_LVCMOS18, |
| 145 | [43] = MIO_L3_SEL(0x4) | MIO_SPEED_FAST | MIO_IO_TYPE_LVCMOS18, |
| 146 | [44] = MIO_L3_SEL(0x4) | MIO_SPEED_FAST | MIO_IO_TYPE_LVCMOS18, |
| 147 | [45] = MIO_L3_SEL(0x4) | MIO_SPEED_FAST | MIO_IO_TYPE_LVCMOS18, |
| 148 | [47] = MIO_TRI_ENABLE | MIO_IO_TYPE_LVCMOS18, |
| 149 | [48] = MIO_L3_SEL(0x7) | MIO_IO_TYPE_LVCMOS18, |
| 150 | [49] = MIO_TRI_ENABLE | MIO_L3_SEL(0x7) | MIO_IO_TYPE_LVCMOS18, |
| 151 | // 50-51 are BTN4 and BTN5 |
| 152 | [50] = MIO_IO_TYPE_LVCMOS18 | MIO_DISABLE_RCVR, |
| 153 | [51] = MIO_IO_TYPE_LVCMOS18 | MIO_DISABLE_RCVR, |
| 154 | // 52-53 gem0 |
| 155 | [52] = MIO_L3_SEL(0x4) | MIO_IO_TYPE_LVCMOS18 | MIO_PULLUP, |
| 156 | [53] = MIO_L3_SEL(0x4) | MIO_IO_TYPE_LVCMOS18 | MIO_PULLUP, |
| 157 | }; |
| 158 | |
| 159 | const zynq_clk_cfg_t zynq_clk_cfg = { |
| 160 | .arm_clk = ARM_CLK_CTRL_DIVISOR(2) | ARM_CLK_CTRL_CPU_6OR4XCLKACT | |
| 161 | ARM_CLK_CTRL_CPU_3OR2XCLKACT | ARM_CLK_CTRL_CPU_2XCLKACT | |
| 162 | ARM_CLK_CTRL_CPU_1XCLKACT |ARM_CLK_CTRL_PERI_CLKACT, |
| 163 | .ddr_clk = DDR_CLK_CTRL_DDR_3XCLKACT | DDR_CLK_CTRL_DDR_2XCLKACT | |
| 164 | DDR_CLK_CTRL_DDR_3XCLK_DIV(2) | DDR_CLK_CTRL_DDR_2XCLK_DIV(3), |
| 165 | .dci_clk = CLK_CTRL_CLKACT | CLK_CTRL_DIVISOR0(52) | CLK_CTRL_DIVISOR1(2), |
| 166 | .gem0_clk = CLK_CTRL_CLKACT | CLK_CTRL_DIVISOR0(8) | CLK_CTRL_DIVISOR1(1), |
| 167 | .gem0_rclk = CLK_CTRL_CLKACT, |
| 168 | .lqspi_clk = CLK_CTRL_CLKACT | CLK_CTRL_DIVISOR0(5), |
| 169 | .sdio_clk = CLK_CTRL_CLKACT | CLK_CTRL_DIVISOR0(20), |
| 170 | .uart_clk = CLK_CTRL_CLKACT1 | CLK_CTRL_DIVISOR0(20), |
| 171 | .pcap_clk = CLK_CTRL_CLKACT | CLK_CTRL_DIVISOR0(5), |
| 172 | .fpga0_clk = CLK_CTRL_DIVISOR0(10) | CLK_CTRL_DIVISOR1(1), |
| 173 | .fpga1_clk = CLK_CTRL_SRCSEL(3) | CLK_CTRL_DIVISOR0(6) | CLK_CTRL_DIVISOR1(1), |
| 174 | .fpga2_clk = CLK_CTRL_SRCSEL(2) | CLK_CTRL_DIVISOR0(53) | CLK_CTRL_DIVISOR1(2), |
| 175 | .fpga3_clk = CLK_CTRL_DIVISOR1(1), |
| 176 | .aper_clk = DMA_CPU_CLK_EN | USB0_CPU_CLK_EN | USB1_CPU_CLK_EN | |
| 177 | GEM0_CPU_CLK_EN | SDI0_CPU_CLK_EN | I2C0_CPU_CLK_EN | |
| 178 | I2C1_CPU_CLK_EN | UART1_CPU_CLK_EN | GPIO_CPU_CLK_EN | |
| 179 | LQSPI_CPU_CLK_EN | SMC_CPU_CLK_EN, |
| 180 | .clk_621_true = CLK_621_ENABLE, |
| 181 | }; |
| 182 | |
| 183 | void target_early_init(void) |
| 184 | { |
| 185 | gpio_config(GPIO_LEDY, GPIO_OUTPUT); |
| 186 | gpio_set(GPIO_LEDY, 0); |
| 187 | } |
| 188 | |
| 189 | static enum handler_return toggle_ledy(void *arg) { |
| 190 | static bool on = false; |
| 191 | |
| 192 | gpio_set(GPIO_LEDY, on); |
| 193 | on = !on; |
| 194 | |
| 195 | return INT_NO_RESCHEDULE; |
| 196 | } |
| 197 | |
| 198 | void target_set_debug_led(unsigned int led, bool on) |
| 199 | { |
| 200 | if (led == 0) { |
| 201 | gpio_set(GPIO_LEDY, on); |
| 202 | } |
| 203 | } |
| 204 | void target_init(void) |
| 205 | { |
| 206 | gem_init(GEM0_BASE); |
| 207 | |
| 208 | register_gpio_int_handler(ZYBO_BTN5, toggle_ledy, NULL); |
| 209 | zynq_unmask_gpio_interrupt(ZYBO_BTN5); |
| 210 | } |
| 211 | |
| 212 | |