Tom Rini | 10e4779 | 2018-05-06 17:58:06 -0400 | [diff] [blame] | 1 | // SPDX-License-Identifier: GPL-2.0+ |
Stefan Roese | 459e064 | 2016-01-20 08:13:29 +0100 | [diff] [blame] | 2 | /* |
Stefan Roese | 8c8b15b | 2019-03-11 13:56:14 +0100 | [diff] [blame] | 3 | * Copyright (C) 2015-2019 Stefan Roese <sr@denx.de> |
Stefan Roese | 459e064 | 2016-01-20 08:13:29 +0100 | [diff] [blame] | 4 | */ |
| 5 | |
| 6 | #include <common.h> |
Simon Glass | ed38aef | 2020-05-10 11:40:03 -0600 | [diff] [blame] | 7 | #include <command.h> |
Stefan Roese | 8c8b15b | 2019-03-11 13:56:14 +0100 | [diff] [blame] | 8 | #include <console.h> |
Stefan Roese | d1e4fc8 | 2021-01-25 15:27:19 +0100 | [diff] [blame^] | 9 | #include <dm.h> |
Stefan Roese | a2f62fd | 2016-04-08 15:58:30 +0200 | [diff] [blame] | 10 | #include <i2c.h> |
Simon Glass | a7b5130 | 2019-11-14 12:57:46 -0700 | [diff] [blame] | 11 | #include <init.h> |
Simon Glass | 274e0b0 | 2020-05-10 11:39:56 -0600 | [diff] [blame] | 12 | #include <net.h> |
Stefan Roese | a2f62fd | 2016-04-08 15:58:30 +0200 | [diff] [blame] | 13 | #include <pci.h> |
Stefan Roese | 8c8b15b | 2019-03-11 13:56:14 +0100 | [diff] [blame] | 14 | #if !defined(CONFIG_SPL_BUILD) |
| 15 | #include <bootcount.h> |
| 16 | #endif |
Stefan Roese | d0047fc | 2016-04-07 10:48:13 +0200 | [diff] [blame] | 17 | #include <asm/gpio.h> |
Stefan Roese | 459e064 | 2016-01-20 08:13:29 +0100 | [diff] [blame] | 18 | #include <asm/io.h> |
| 19 | #include <asm/arch/cpu.h> |
| 20 | #include <asm/arch/soc.h> |
Simon Glass | dbd7954 | 2020-05-10 11:40:11 -0600 | [diff] [blame] | 21 | #include <linux/delay.h> |
Stefan Roese | f054758 | 2016-02-12 14:24:07 +0100 | [diff] [blame] | 22 | #include <linux/mbus.h> |
Stefan Roese | 459e064 | 2016-01-20 08:13:29 +0100 | [diff] [blame] | 23 | #ifdef CONFIG_NET |
| 24 | #include <netdev.h> |
| 25 | #endif |
Simon Glass | ca9b0af | 2019-11-14 12:57:14 -0700 | [diff] [blame] | 26 | #include <u-boot/crc.h> |
Stefan Roese | f054758 | 2016-02-12 14:24:07 +0100 | [diff] [blame] | 27 | #include "theadorable.h" |
Stefan Roese | 459e064 | 2016-01-20 08:13:29 +0100 | [diff] [blame] | 28 | |
| 29 | #include "../drivers/ddr/marvell/axp/ddr3_hw_training.h" |
| 30 | #include "../arch/arm/mach-mvebu/serdes/axp/high_speed_env_spec.h" |
| 31 | |
| 32 | DECLARE_GLOBAL_DATA_PTR; |
| 33 | |
Stefan Roese | d0047fc | 2016-04-07 10:48:13 +0200 | [diff] [blame] | 34 | #define MV_USB_PHY_BASE (MVEBU_AXP_USB_BASE + 0x800) |
| 35 | #define PHY_CHANNEL_RX_CTRL0_REG(port, chan) \ |
| 36 | (MV_USB_PHY_BASE + ((port) << 12) + ((chan) << 6) + 0x8) |
| 37 | |
Stefan Roese | 459e064 | 2016-01-20 08:13:29 +0100 | [diff] [blame] | 38 | #define THEADORABLE_GPP_OUT_ENA_LOW 0x00336780 |
| 39 | #define THEADORABLE_GPP_OUT_ENA_MID 0x00003cf0 |
| 40 | #define THEADORABLE_GPP_OUT_ENA_HIGH (~(0x0)) |
| 41 | |
| 42 | #define THEADORABLE_GPP_OUT_VAL_LOW 0x2c0c983f |
| 43 | #define THEADORABLE_GPP_OUT_VAL_MID 0x0007000c |
| 44 | #define THEADORABLE_GPP_OUT_VAL_HIGH 0x00000000 |
| 45 | |
Stefan Roese | d0047fc | 2016-04-07 10:48:13 +0200 | [diff] [blame] | 46 | #define GPIO_USB0_PWR_ON 18 |
| 47 | #define GPIO_USB1_PWR_ON 19 |
| 48 | |
Stefan Roese | a2f62fd | 2016-04-08 15:58:30 +0200 | [diff] [blame] | 49 | #define PEX_SWITCH_NOT_FOUNT_LIMIT 3 |
| 50 | |
| 51 | #define STM_I2C_BUS 1 |
| 52 | #define STM_I2C_ADDR 0x27 |
| 53 | #define REBOOT_DELAY 1000 /* reboot-delay in ms */ |
Stefan Roese | 8c8b15b | 2019-03-11 13:56:14 +0100 | [diff] [blame] | 54 | #define ABORT_TIMEOUT 3000 /* 3 seconds reboot abort timeout */ |
Stefan Roese | a2f62fd | 2016-04-08 15:58:30 +0200 | [diff] [blame] | 55 | |
Stefan Roese | 459e064 | 2016-01-20 08:13:29 +0100 | [diff] [blame] | 56 | /* DDR3 static configuration */ |
| 57 | static MV_DRAM_MC_INIT ddr3_theadorable[MV_MAX_DDR3_STATIC_SIZE] = { |
| 58 | {0x00001400, 0x7301ca28}, /* DDR SDRAM Configuration Register */ |
| 59 | {0x00001404, 0x30000800}, /* Dunit Control Low Register */ |
| 60 | {0x00001408, 0x44149887}, /* DDR SDRAM Timing (Low) Register */ |
| 61 | {0x0000140C, 0x38d93fc7}, /* DDR SDRAM Timing (High) Register */ |
| 62 | {0x00001410, 0x1b100001}, /* DDR SDRAM Address Control Register */ |
| 63 | {0x00001424, 0x0000f3ff}, /* Dunit Control High Register */ |
| 64 | {0x00001428, 0x000f8830}, /* ODT Timing (Low) Register */ |
| 65 | {0x0000142C, 0x014c50f4}, /* DDR3 Timing Register */ |
| 66 | {0x0000147C, 0x0000c671}, /* ODT Timing (High) Register */ |
| 67 | |
| 68 | {0x00001494, 0x00010000}, /* DDR SDRAM ODT Control (Low) Reg */ |
| 69 | {0x0000149C, 0x00000001}, /* DDR Dunit ODT Control Register */ |
| 70 | {0x000014A0, 0x00000001}, /* DRAM FIFO Control Register */ |
| 71 | {0x000014A8, 0x00000101}, /* AXI Control Register */ |
| 72 | |
| 73 | /* |
| 74 | * DO NOT Modify - Open Mbus Window - 2G - Mbus is required for the |
| 75 | * training sequence |
| 76 | */ |
| 77 | {0x000200e8, 0x3fff0e01}, |
| 78 | {0x00020184, 0x3fffffe0}, /* Close fast path Window to - 2G */ |
| 79 | |
| 80 | {0x0001504, 0x7fffffe1}, /* CS0 Size */ |
| 81 | {0x000150C, 0x00000000}, /* CS1 Size */ |
| 82 | {0x0001514, 0x00000000}, /* CS2 Size */ |
| 83 | {0x000151C, 0x00000000}, /* CS3 Size */ |
| 84 | |
| 85 | {0x00020220, 0x00000007}, /* Reserved */ |
| 86 | |
| 87 | {0x00001538, 0x00000009}, /* Read Data Sample Delays Register */ |
| 88 | {0x0000153C, 0x00000009}, /* Read Data Ready Delay Register */ |
| 89 | |
| 90 | {0x000015D0, 0x00000650}, /* MR0 */ |
| 91 | {0x000015D4, 0x00000044}, /* MR1 */ |
| 92 | {0x000015D8, 0x00000010}, /* MR2 */ |
| 93 | {0x000015DC, 0x00000000}, /* MR3 */ |
| 94 | {0x000015E0, 0x00000001}, |
| 95 | {0x000015E4, 0x00203c18}, /* ZQDS Configuration Register */ |
| 96 | {0x000015EC, 0xf800a225}, /* DDR PHY */ |
| 97 | |
| 98 | /* Recommended Settings from Marvell for 4 x 16 bit devices: */ |
| 99 | {0x000014C0, 0x192424c9}, /* DRAM addr and Ctrl Driving Strenght*/ |
| 100 | {0x000014C4, 0x0aaa24c9}, /* DRAM Data and DQS Driving Strenght */ |
| 101 | |
| 102 | {0x0, 0x0} |
| 103 | }; |
| 104 | |
| 105 | static MV_DRAM_MODES board_ddr_modes[MV_DDR3_MODES_NUMBER] = { |
| 106 | {"theadorable_1333-667", 0x3, 0x5, 0x0, A0, ddr3_theadorable, NULL}, |
| 107 | }; |
| 108 | |
| 109 | extern MV_SERDES_CHANGE_M_PHY serdes_change_m_phy[]; |
| 110 | |
| 111 | /* |
| 112 | * Lane0 - PCIE0.0 X1 (to WIFI Module) |
| 113 | * Lane5 - SATA0 |
| 114 | * Lane6 - SATA1 |
| 115 | * Lane7 - SGMII0 (to Ethernet Phy) |
| 116 | * Lane8-11 - PCIE2.0 X4 (to PEX Switch) |
| 117 | * all other lanes are disabled |
| 118 | */ |
| 119 | MV_BIN_SERDES_CFG theadorable_serdes_cfg[] = { |
| 120 | { MV_PEX_ROOT_COMPLEX, 0x22200001, 0x00001111, |
| 121 | { PEX_BUS_MODE_X1, PEX_BUS_DISABLED, PEX_BUS_MODE_X4, |
| 122 | PEX_BUS_DISABLED }, |
| 123 | 0x0060, serdes_change_m_phy |
| 124 | }, |
| 125 | }; |
| 126 | |
Stefan Roese | a60ceb8 | 2017-03-10 15:40:31 +0100 | [diff] [blame] | 127 | /* |
| 128 | * Define a board-specific detection pulse-width array for the SerDes PCIe |
| 129 | * interfaces. If not defined in the board code, the default of currently 2 |
| 130 | * is used. Values from 0...3 are possible (2 bits). |
| 131 | */ |
| 132 | u8 serdes_pex_pulse_width[4] = { 0, 2, 2, 2 }; |
| 133 | |
Stefan Roese | 459e064 | 2016-01-20 08:13:29 +0100 | [diff] [blame] | 134 | MV_DRAM_MODES *ddr3_get_static_ddr_mode(void) |
| 135 | { |
| 136 | /* Only one mode supported for this board */ |
| 137 | return &board_ddr_modes[0]; |
| 138 | } |
| 139 | |
Stefan Roese | f00854f | 2019-04-08 14:51:49 +0200 | [diff] [blame] | 140 | MV_BIN_SERDES_CFG *board_serdes_cfg_get(void) |
Stefan Roese | 459e064 | 2016-01-20 08:13:29 +0100 | [diff] [blame] | 141 | { |
| 142 | return &theadorable_serdes_cfg[0]; |
| 143 | } |
| 144 | |
Stefan Roese | 4caab60 | 2016-08-25 16:22:10 +0200 | [diff] [blame] | 145 | u8 board_sat_r_get(u8 dev_num, u8 reg) |
| 146 | { |
Stefan Roese | f00854f | 2019-04-08 14:51:49 +0200 | [diff] [blame] | 147 | /* Bit x enables PCI 2.0 link capabilities instead of PCI 1.x */ |
| 148 | return 0xe; /* PEX port 0 is PCIe Gen1, PEX port 1..3 PCIe Gen2 */ |
Stefan Roese | 4caab60 | 2016-08-25 16:22:10 +0200 | [diff] [blame] | 149 | } |
| 150 | |
Stefan Roese | 459e064 | 2016-01-20 08:13:29 +0100 | [diff] [blame] | 151 | int board_early_init_f(void) |
| 152 | { |
| 153 | /* Configure MPP */ |
| 154 | writel(0x00000000, MVEBU_MPP_BASE + 0x00); |
| 155 | writel(0x03300000, MVEBU_MPP_BASE + 0x04); |
| 156 | writel(0x00000033, MVEBU_MPP_BASE + 0x08); |
| 157 | writel(0x00000000, MVEBU_MPP_BASE + 0x0c); |
| 158 | writel(0x11110000, MVEBU_MPP_BASE + 0x10); |
| 159 | writel(0x00221100, MVEBU_MPP_BASE + 0x14); |
| 160 | writel(0x00000000, MVEBU_MPP_BASE + 0x18); |
| 161 | writel(0x00000000, MVEBU_MPP_BASE + 0x1c); |
| 162 | writel(0x00000000, MVEBU_MPP_BASE + 0x20); |
| 163 | |
| 164 | /* Configure GPIO */ |
| 165 | writel(THEADORABLE_GPP_OUT_VAL_LOW, MVEBU_GPIO0_BASE + 0x00); |
| 166 | writel(THEADORABLE_GPP_OUT_ENA_LOW, MVEBU_GPIO0_BASE + 0x04); |
| 167 | writel(THEADORABLE_GPP_OUT_VAL_MID, MVEBU_GPIO1_BASE + 0x00); |
| 168 | writel(THEADORABLE_GPP_OUT_ENA_MID, MVEBU_GPIO1_BASE + 0x04); |
| 169 | writel(THEADORABLE_GPP_OUT_VAL_HIGH, MVEBU_GPIO2_BASE + 0x00); |
| 170 | writel(THEADORABLE_GPP_OUT_ENA_HIGH, MVEBU_GPIO2_BASE + 0x04); |
| 171 | |
| 172 | return 0; |
| 173 | } |
| 174 | |
| 175 | int board_init(void) |
| 176 | { |
Stefan Roese | d0047fc | 2016-04-07 10:48:13 +0200 | [diff] [blame] | 177 | int ret; |
| 178 | |
Stefan Roese | 459e064 | 2016-01-20 08:13:29 +0100 | [diff] [blame] | 179 | /* adress of boot parameters */ |
| 180 | gd->bd->bi_boot_params = mvebu_sdram_bar(0) + 0x100; |
| 181 | |
Stefan Roese | f054758 | 2016-02-12 14:24:07 +0100 | [diff] [blame] | 182 | /* |
| 183 | * Map SPI devices via MBUS so that they can be accessed via |
| 184 | * the SPI direct access mode |
| 185 | */ |
| 186 | mbus_dt_setup_win(&mbus_state, SPI_BUS0_DEV1_BASE, SPI_BUS0_DEV1_SIZE, |
| 187 | CPU_TARGET_DEVICEBUS_BOOTROM_SPI, CPU_ATTR_SPI0_CS1); |
| 188 | mbus_dt_setup_win(&mbus_state, SPI_BUS1_DEV2_BASE, SPI_BUS0_DEV1_SIZE, |
| 189 | CPU_TARGET_DEVICEBUS_BOOTROM_SPI, CPU_ATTR_SPI1_CS2); |
| 190 | |
Stefan Roese | d0047fc | 2016-04-07 10:48:13 +0200 | [diff] [blame] | 191 | /* |
| 192 | * Set RX Channel Control 0 Register: |
| 193 | * Tests have shown, that setting the LPF_COEF from 0 (1/8) |
| 194 | * to 3 (1/1) results in a more stable USB connection. |
| 195 | */ |
| 196 | setbits_le32(PHY_CHANNEL_RX_CTRL0_REG(0, 1), 0xc); |
| 197 | setbits_le32(PHY_CHANNEL_RX_CTRL0_REG(0, 2), 0xc); |
| 198 | setbits_le32(PHY_CHANNEL_RX_CTRL0_REG(0, 3), 0xc); |
| 199 | |
| 200 | /* Toggle USB power */ |
| 201 | ret = gpio_request(GPIO_USB0_PWR_ON, "USB0_PWR_ON"); |
| 202 | if (ret < 0) |
| 203 | return ret; |
| 204 | gpio_direction_output(GPIO_USB0_PWR_ON, 0); |
| 205 | ret = gpio_request(GPIO_USB1_PWR_ON, "USB1_PWR_ON"); |
| 206 | if (ret < 0) |
| 207 | return ret; |
| 208 | gpio_direction_output(GPIO_USB1_PWR_ON, 0); |
| 209 | mdelay(1); |
| 210 | gpio_set_value(GPIO_USB0_PWR_ON, 1); |
| 211 | gpio_set_value(GPIO_USB1_PWR_ON, 1); |
| 212 | |
Stefan Roese | 459e064 | 2016-01-20 08:13:29 +0100 | [diff] [blame] | 213 | return 0; |
| 214 | } |
| 215 | |
| 216 | int checkboard(void) |
| 217 | { |
Stefan Roese | f054758 | 2016-02-12 14:24:07 +0100 | [diff] [blame] | 218 | board_fpga_add(); |
| 219 | |
Stefan Roese | 459e064 | 2016-01-20 08:13:29 +0100 | [diff] [blame] | 220 | return 0; |
| 221 | } |
| 222 | |
| 223 | #ifdef CONFIG_NET |
Masahiro Yamada | f7ed78b | 2020-06-26 15:13:33 +0900 | [diff] [blame] | 224 | int board_eth_init(struct bd_info *bis) |
Stefan Roese | 459e064 | 2016-01-20 08:13:29 +0100 | [diff] [blame] | 225 | { |
| 226 | cpu_eth_init(bis); /* Built in controller(s) come first */ |
| 227 | return pci_eth_init(bis); |
| 228 | } |
| 229 | #endif |
| 230 | |
Stefan Roese | 8c8b15b | 2019-03-11 13:56:14 +0100 | [diff] [blame] | 231 | #if !defined(CONFIG_SPL_BUILD) && defined(CONFIG_BOARD_LATE_INIT) |
Stefan Roese | a2f62fd | 2016-04-08 15:58:30 +0200 | [diff] [blame] | 232 | int board_late_init(void) |
| 233 | { |
| 234 | pci_dev_t bdf; |
| 235 | ulong bootcount; |
| 236 | |
| 237 | /* |
| 238 | * Check if the PEX switch is detected (somtimes its not available |
| 239 | * on the PCIe bus). In this case, try to recover by issuing a |
| 240 | * soft-reset or even a power-cycle, depending on the bootcounter |
| 241 | * value. |
| 242 | */ |
| 243 | bdf = pci_find_device(PCI_VENDOR_ID_PLX, 0x8619, 0); |
| 244 | if (bdf == -1) { |
Stefan Roese | 8c8b15b | 2019-03-11 13:56:14 +0100 | [diff] [blame] | 245 | unsigned long start_time = get_timer(0); |
Stefan Roese | a2f62fd | 2016-04-08 15:58:30 +0200 | [diff] [blame] | 246 | u8 i2c_buf[8]; |
| 247 | int ret; |
| 248 | |
| 249 | /* PEX switch not found! */ |
| 250 | bootcount = bootcount_load(); |
| 251 | printf("Failed to find PLX PEX-switch (bootcount=%ld)\n", |
| 252 | bootcount); |
Stefan Roese | 8c8b15b | 2019-03-11 13:56:14 +0100 | [diff] [blame] | 253 | |
| 254 | /* |
| 255 | * The user can exit this boot-loop in the error case by |
| 256 | * hitting Ctrl-C. So wait some time for this key here. |
| 257 | */ |
| 258 | printf("Continue booting with Ctrl-C, otherwise rebooting\n"); |
| 259 | do { |
| 260 | /* Handle control-c and timeouts */ |
| 261 | if (ctrlc()) { |
| 262 | printf("PEX error boot-loop aborted!\n"); |
| 263 | return 0; |
| 264 | } |
| 265 | } while (get_timer(start_time) < ABORT_TIMEOUT); |
| 266 | |
| 267 | |
| 268 | /* |
| 269 | * At this stage the bootcounter has not been incremented |
| 270 | * yet. We need to do this manually here to get an actually |
| 271 | * working bootcounter in this error case. |
| 272 | */ |
| 273 | bootcount_inc(); |
| 274 | |
Stefan Roese | a2f62fd | 2016-04-08 15:58:30 +0200 | [diff] [blame] | 275 | if (bootcount > PEX_SWITCH_NOT_FOUNT_LIMIT) { |
| 276 | printf("Issuing power-switch via uC!\n"); |
| 277 | |
| 278 | printf("Issuing power-switch via uC!\n"); |
| 279 | i2c_set_bus_num(STM_I2C_BUS); |
| 280 | i2c_buf[0] = STM_I2C_ADDR << 1; |
| 281 | i2c_buf[1] = 0xc5; /* cmd */ |
| 282 | i2c_buf[2] = 0x01; /* enable */ |
| 283 | /* Delay before reboot */ |
| 284 | i2c_buf[3] = REBOOT_DELAY & 0x00ff; |
| 285 | i2c_buf[4] = (REBOOT_DELAY & 0xff00) >> 8; |
| 286 | /* Delay before shutdown */ |
| 287 | i2c_buf[5] = 0x00; |
| 288 | i2c_buf[6] = 0x00; |
| 289 | i2c_buf[7] = crc8(0x72, &i2c_buf[0], 7); |
| 290 | |
| 291 | ret = i2c_write(STM_I2C_ADDR, 0, 0, &i2c_buf[1], 7); |
| 292 | if (ret) { |
| 293 | printf("I2C write error (ret=%d)\n", ret); |
| 294 | printf("Issuing soft-reset...\n"); |
| 295 | /* default handling: SOFT reset */ |
| 296 | do_reset(NULL, 0, 0, NULL); |
| 297 | } |
| 298 | |
| 299 | /* Wait for power-cycle to occur... */ |
| 300 | printf("Waiting for power-cycle via uC...\n"); |
| 301 | while (1) |
| 302 | ; |
| 303 | } else { |
| 304 | printf("Issuing soft-reset...\n"); |
| 305 | /* default handling: SOFT reset */ |
| 306 | do_reset(NULL, 0, 0, NULL); |
| 307 | } |
| 308 | } |
| 309 | |
| 310 | return 0; |
| 311 | } |
| 312 | #endif |
Stefan Roese | 2816a63 | 2017-03-10 15:40:32 +0100 | [diff] [blame] | 313 | |
| 314 | #if !defined(CONFIG_SPL_BUILD) && defined(CONFIG_PCI) |
Stefan Roese | d1e4fc8 | 2021-01-25 15:27:19 +0100 | [diff] [blame^] | 315 | static int pcie_get_link_speed_width(pci_dev_t bdf, int *speed, int *width) |
Stefan Roese | 2816a63 | 2017-03-10 15:40:32 +0100 | [diff] [blame] | 316 | { |
Stefan Roese | d1e4fc8 | 2021-01-25 15:27:19 +0100 | [diff] [blame^] | 317 | struct udevice *dev; |
Stefan Roese | 2816a63 | 2017-03-10 15:40:32 +0100 | [diff] [blame] | 318 | u16 ven_id, dev_id; |
Stefan Roese | d1e4fc8 | 2021-01-25 15:27:19 +0100 | [diff] [blame^] | 319 | u16 lnksta; |
| 320 | int ret; |
| 321 | int pos; |
Stefan Roese | 2816a63 | 2017-03-10 15:40:32 +0100 | [diff] [blame] | 322 | |
Stefan Roese | d1e4fc8 | 2021-01-25 15:27:19 +0100 | [diff] [blame^] | 323 | /* |
| 324 | * Check if the PCIe device is detected (sometimes its not available |
| 325 | * on the PCIe bus) |
| 326 | */ |
| 327 | ret = dm_pci_bus_find_bdf(bdf, &dev); |
| 328 | if (ret) |
| 329 | return -ENODEV; |
Stefan Roese | 2816a63 | 2017-03-10 15:40:32 +0100 | [diff] [blame] | 330 | |
Stefan Roese | d1e4fc8 | 2021-01-25 15:27:19 +0100 | [diff] [blame^] | 331 | /* PCIe device found */ |
| 332 | dm_pci_read_config16(dev, PCI_VENDOR_ID, &ven_id); |
| 333 | dm_pci_read_config16(dev, PCI_DEVICE_ID, &dev_id); |
| 334 | printf("Detected PCIe device: VendorID 0x%04x DeviceId 0x%04x @ BDF %d.%d.%d\n", |
| 335 | ven_id, dev_id, PCI_BUS(bdf), PCI_DEV(bdf), PCI_FUNC(bdf)); |
| 336 | |
| 337 | /* Now read EXP_LNKSTA register */ |
| 338 | pos = dm_pci_find_capability(dev, PCI_CAP_ID_EXP); |
| 339 | dm_pci_read_config16(dev, pos + PCI_EXP_LNKSTA, &lnksta); |
| 340 | *speed = lnksta & PCI_EXP_LNKSTA_CLS; |
| 341 | *width = (lnksta & PCI_EXP_LNKSTA_NLW) >> PCI_EXP_LNKSTA_NLW_SHIFT; |
| 342 | |
| 343 | return 0; |
| 344 | } |
| 345 | |
| 346 | /* |
| 347 | * U-Boot cmd to test for the presence of the directly connected PCIe devices |
| 348 | * the theadorable board. This cmd can be used by U-Boot scripts for automated |
| 349 | * testing, if the PCIe setup is correct. Meaning, that all PCIe devices are |
| 350 | * correctly detected and the link speed and width is corrent. |
| 351 | * |
| 352 | * Here a short script that may be used for an automated test. It results in |
| 353 | * an endless reboot loop, if the PCIe devices are detected correctly. If at |
| 354 | * any time a problem is detected (PCIe device not available or link is |
| 355 | * incorrect), then booting will halt. So just use this "bootcmd" and let the |
| 356 | * board run over a longer time (e.g. one night) and if the board still reboots |
| 357 | * after this time, then everything is okay. |
| 358 | * |
| 359 | * bootcmd=echo bootcount=$bootcount; pcie ;if test $? -eq 0; |
| 360 | * then echo PCIe status okay, resetting...; reset; else; |
| 361 | * echo PCIe status NOT okay, hanging (bootcount=$bootcount); fi; |
| 362 | */ |
| 363 | int do_pcie_test(struct cmd_tbl *cmdtp, int flag, int argc, char *const argv[]) |
| 364 | { |
| 365 | pci_dev_t bdf; |
| 366 | int speed; |
| 367 | int width; |
| 368 | int ret; |
Stefan Roese | 2816a63 | 2017-03-10 15:40:32 +0100 | [diff] [blame] | 369 | |
Stefan Roese | d1e4fc8 | 2021-01-25 15:27:19 +0100 | [diff] [blame^] | 370 | if (argc != 1) |
| 371 | return cmd_usage(cmdtp); |
Stefan Roese | 2816a63 | 2017-03-10 15:40:32 +0100 | [diff] [blame] | 372 | |
| 373 | /* |
Stefan Roese | d1e4fc8 | 2021-01-25 15:27:19 +0100 | [diff] [blame^] | 374 | * Check if the PCIe device is detected (sometimes its not available |
Stefan Roese | 2816a63 | 2017-03-10 15:40:32 +0100 | [diff] [blame] | 375 | * on the PCIe bus) |
| 376 | */ |
Stefan Roese | d1e4fc8 | 2021-01-25 15:27:19 +0100 | [diff] [blame^] | 377 | |
| 378 | /* Check for PCIe device on PCIe port/bus 0 */ |
| 379 | bdf = PCI_BDF(0, 1, 0); |
| 380 | ret = pcie_get_link_speed_width(bdf, &speed, &width); |
| 381 | if (ret) { |
Stefan Roese | 2816a63 | 2017-03-10 15:40:32 +0100 | [diff] [blame] | 382 | /* PCIe device not found! */ |
Stefan Roese | d1e4fc8 | 2021-01-25 15:27:19 +0100 | [diff] [blame^] | 383 | printf("Failed to find PCIe device @ BDF %d.%d.%d\n", |
| 384 | PCI_BUS(bdf), PCI_DEV(bdf), PCI_FUNC(bdf)); |
| 385 | return CMD_RET_FAILURE; |
| 386 | } |
Stefan Roese | 2816a63 | 2017-03-10 15:40:32 +0100 | [diff] [blame] | 387 | |
Stefan Roese | d1e4fc8 | 2021-01-25 15:27:19 +0100 | [diff] [blame^] | 388 | printf("Established speed=%d width=%d\n", speed, width); |
| 389 | if ((speed != 1 || width != 1)) { |
| 390 | printf("Detected incorrect speed/width!!!\n"); |
| 391 | return CMD_RET_FAILURE; |
Stefan Roese | 2816a63 | 2017-03-10 15:40:32 +0100 | [diff] [blame] | 392 | } |
| 393 | |
Stefan Roese | d1e4fc8 | 2021-01-25 15:27:19 +0100 | [diff] [blame^] | 394 | /* Check for PCIe device on PCIe port/bus 1 */ |
| 395 | bdf = PCI_BDF(1, 1, 0); |
| 396 | ret = pcie_get_link_speed_width(bdf, &speed, &width); |
| 397 | if (ret) { |
| 398 | /* PCIe device not found! */ |
| 399 | printf("Failed to find PCIe device @ BDF %d.%d.%d\n", |
| 400 | PCI_BUS(bdf), PCI_DEV(bdf), PCI_FUNC(bdf)); |
| 401 | return CMD_RET_FAILURE; |
| 402 | } |
| 403 | |
| 404 | printf("Established speed=%d width=%d\n", speed, width); |
| 405 | if ((speed != 2 || width != 4)) { |
| 406 | printf("Detected incorrect speed/width!!!\n"); |
| 407 | return CMD_RET_FAILURE; |
| 408 | } |
| 409 | |
| 410 | return CMD_RET_SUCCESS; |
Stefan Roese | 2816a63 | 2017-03-10 15:40:32 +0100 | [diff] [blame] | 411 | } |
| 412 | |
| 413 | U_BOOT_CMD( |
Stefan Roese | d1e4fc8 | 2021-01-25 15:27:19 +0100 | [diff] [blame^] | 414 | pcie, 1, 0, do_pcie_test, |
| 415 | "Test for presence of a PCIe devices with correct link", |
| 416 | "" |
Stefan Roese | 2816a63 | 2017-03-10 15:40:32 +0100 | [diff] [blame] | 417 | ); |
| 418 | #endif |