Alexey Brodkin | 2c3f926 | 2018-05-28 15:27:43 +0300 | [diff] [blame] | 1 | // SPDX-License-Identifier: GPL-2.0+ |
| 2 | /* |
| 3 | * Copyright (C) 2018 Synopsys, Inc. All rights reserved. |
| 4 | */ |
| 5 | |
| 6 | #include <common.h> |
Simon Glass | 9a3b4ce | 2019-12-28 10:45:01 -0700 | [diff] [blame] | 7 | #include <cpu_func.h> |
Alexey Brodkin | 2c3f926 | 2018-05-28 15:27:43 +0300 | [diff] [blame] | 8 | #include <dwmmc.h> |
| 9 | #include <malloc.h> |
| 10 | |
Alexey Brodkin | 4e86c7e | 2018-11-27 09:46:59 +0300 | [diff] [blame] | 11 | #include <asm/arcregs.h> |
| 12 | |
Alexey Brodkin | 2c3f926 | 2018-05-28 15:27:43 +0300 | [diff] [blame] | 13 | DECLARE_GLOBAL_DATA_PTR; |
| 14 | |
Alexey Brodkin | 4e86c7e | 2018-11-27 09:46:59 +0300 | [diff] [blame] | 15 | #define ARC_PERIPHERAL_BASE 0xF0000000 |
| 16 | |
| 17 | #define CGU_ARC_FMEAS_ARC (void *)(ARC_PERIPHERAL_BASE + 0x84) |
| 18 | #define CGU_ARC_FMEAS_ARC_START BIT(31) |
| 19 | #define CGU_ARC_FMEAS_ARC_DONE BIT(30) |
| 20 | #define CGU_ARC_FMEAS_ARC_CNT_MASK GENMASK(14, 0) |
| 21 | #define CGU_ARC_FMEAS_ARC_RCNT_OFFSET 0 |
| 22 | #define CGU_ARC_FMEAS_ARC_FCNT_OFFSET 15 |
| 23 | |
| 24 | #define SDIO_BASE (void *)(ARC_PERIPHERAL_BASE + 0x10000) |
| 25 | |
| 26 | int mach_cpu_init(void) |
| 27 | { |
| 28 | int rcnt, fcnt; |
| 29 | u32 data; |
| 30 | |
| 31 | /* Start frequency measurement */ |
| 32 | writel(CGU_ARC_FMEAS_ARC_START, CGU_ARC_FMEAS_ARC); |
| 33 | |
| 34 | /* Poll DONE bit */ |
| 35 | do { |
| 36 | data = readl(CGU_ARC_FMEAS_ARC); |
| 37 | } while (!(data & CGU_ARC_FMEAS_ARC_DONE)); |
| 38 | |
| 39 | /* Amount of reference 100 MHz clocks */ |
| 40 | rcnt = ((data >> CGU_ARC_FMEAS_ARC_RCNT_OFFSET) & |
| 41 | CGU_ARC_FMEAS_ARC_CNT_MASK); |
| 42 | |
| 43 | /* Amount of CPU clocks */ |
| 44 | fcnt = ((data >> CGU_ARC_FMEAS_ARC_FCNT_OFFSET) & |
| 45 | CGU_ARC_FMEAS_ARC_CNT_MASK); |
| 46 | |
| 47 | gd->cpu_clk = ((100 * fcnt) / rcnt) * 1000000; |
| 48 | |
| 49 | return 0; |
| 50 | } |
Alexey Brodkin | 2c3f926 | 2018-05-28 15:27:43 +0300 | [diff] [blame] | 51 | |
Alexey Brodkin | 9ddaf1d | 2019-07-18 15:51:25 +0300 | [diff] [blame] | 52 | int board_early_init_r(void) |
| 53 | { |
| 54 | #define EMSDP_PSRAM_BASE 0xf2001000 |
| 55 | #define PSRAM_FLASH_CONFIG_REG_0 (void *)(EMSDP_PSRAM_BASE + 0x10) |
| 56 | #define PSRAM_FLASH_CONFIG_REG_1 (void *)(EMSDP_PSRAM_BASE + 0x14) |
| 57 | #define CRE_ENABLE BIT(31) |
| 58 | #define CRE_DRIVE_CMD BIT(6) |
| 59 | |
| 60 | #define PSRAM_RCR_DPD BIT(1) |
| 61 | #define PSRAM_RCR_PAGE_MODE BIT(7) |
| 62 | |
| 63 | /* |
| 64 | * PSRAM_FLASH_CONFIG_REG_x[30:15] to the address lines[16:1] of flash, |
| 65 | * thus "<< 1". |
| 66 | */ |
| 67 | #define PSRAM_RCR_SETUP ((PSRAM_RCR_DPD | PSRAM_RCR_PAGE_MODE) << 1) |
| 68 | |
| 69 | // Switch PSRAM controller to command mode |
| 70 | writel(CRE_ENABLE | CRE_DRIVE_CMD, PSRAM_FLASH_CONFIG_REG_0); |
| 71 | // Program Refresh Configuration Register (RCR) for BANK0 |
| 72 | writew(0, (void *)(0x10000000 + PSRAM_RCR_SETUP)); |
| 73 | // Switch PSRAM controller back to memory mode |
| 74 | writel(0, PSRAM_FLASH_CONFIG_REG_0); |
| 75 | |
| 76 | |
| 77 | // Switch PSRAM controller to command mode |
| 78 | writel(CRE_ENABLE | CRE_DRIVE_CMD, PSRAM_FLASH_CONFIG_REG_1); |
| 79 | // Program Refresh Configuration Register (RCR) for BANK1 |
| 80 | writew(0, (void *)(0x10800000 + PSRAM_RCR_SETUP)); |
| 81 | // Switch PSRAM controller back to memory mode |
| 82 | writel(0, PSRAM_FLASH_CONFIG_REG_1); |
| 83 | |
| 84 | printf("PSRAM initialized.\n"); |
| 85 | |
| 86 | return 0; |
| 87 | } |
| 88 | |
Alexey Brodkin | 2c3f926 | 2018-05-28 15:27:43 +0300 | [diff] [blame] | 89 | #define CREG_BASE 0xF0001000 |
Alexey Brodkin | fb9a46a | 2018-11-27 09:47:00 +0300 | [diff] [blame] | 90 | #define CREG_BOOT (void *)(CREG_BASE + 0x0FF0) |
| 91 | #define CREG_IP_SW_RESET (void *)(CREG_BASE + 0x0FF0) |
Alexey Brodkin | 6ef705b | 2018-11-27 09:47:01 +0300 | [diff] [blame] | 92 | #define CREG_IP_VERSION (void *)(CREG_BASE + 0x0FF8) |
Alexey Brodkin | 2c3f926 | 2018-05-28 15:27:43 +0300 | [diff] [blame] | 93 | |
Alexey Brodkin | fb9a46a | 2018-11-27 09:47:00 +0300 | [diff] [blame] | 94 | /* Bits in CREG_BOOT register */ |
| 95 | #define CREG_BOOT_WP_BIT BIT(8) |
Alexey Brodkin | 2c3f926 | 2018-05-28 15:27:43 +0300 | [diff] [blame] | 96 | |
| 97 | void reset_cpu(ulong addr) |
| 98 | { |
Alexey Brodkin | fb9a46a | 2018-11-27 09:47:00 +0300 | [diff] [blame] | 99 | writel(1, CREG_IP_SW_RESET); |
Alexey Brodkin | 2c3f926 | 2018-05-28 15:27:43 +0300 | [diff] [blame] | 100 | while (1) |
| 101 | ; /* loop forever till reset */ |
| 102 | } |
| 103 | |
Alexey Brodkin | adc9b09 | 2018-10-18 09:54:58 +0300 | [diff] [blame] | 104 | static int do_emsdp_rom(cmd_tbl_t *cmdtp, int flag, int argc, char *const argv[]) |
Alexey Brodkin | 2c3f926 | 2018-05-28 15:27:43 +0300 | [diff] [blame] | 105 | { |
Alexey Brodkin | fb9a46a | 2018-11-27 09:47:00 +0300 | [diff] [blame] | 106 | u32 creg_boot = readl(CREG_BOOT); |
Alexey Brodkin | 2c3f926 | 2018-05-28 15:27:43 +0300 | [diff] [blame] | 107 | |
| 108 | if (!strcmp(argv[1], "unlock")) |
Alexey Brodkin | fb9a46a | 2018-11-27 09:47:00 +0300 | [diff] [blame] | 109 | creg_boot &= ~CREG_BOOT_WP_BIT; |
Alexey Brodkin | 2c3f926 | 2018-05-28 15:27:43 +0300 | [diff] [blame] | 110 | else if (!strcmp(argv[1], "lock")) |
Alexey Brodkin | fb9a46a | 2018-11-27 09:47:00 +0300 | [diff] [blame] | 111 | creg_boot |= CREG_BOOT_WP_BIT; |
Alexey Brodkin | 2c3f926 | 2018-05-28 15:27:43 +0300 | [diff] [blame] | 112 | else |
| 113 | return CMD_RET_USAGE; |
| 114 | |
Alexey Brodkin | fb9a46a | 2018-11-27 09:47:00 +0300 | [diff] [blame] | 115 | writel(creg_boot, CREG_BOOT); |
Alexey Brodkin | 2c3f926 | 2018-05-28 15:27:43 +0300 | [diff] [blame] | 116 | |
| 117 | return CMD_RET_SUCCESS; |
| 118 | } |
| 119 | |
Alexey Brodkin | adc9b09 | 2018-10-18 09:54:58 +0300 | [diff] [blame] | 120 | cmd_tbl_t cmd_emsdp[] = { |
| 121 | U_BOOT_CMD_MKENT(rom, 2, 0, do_emsdp_rom, "", ""), |
Alexey Brodkin | 2c3f926 | 2018-05-28 15:27:43 +0300 | [diff] [blame] | 122 | }; |
| 123 | |
Alexey Brodkin | adc9b09 | 2018-10-18 09:54:58 +0300 | [diff] [blame] | 124 | static int do_emsdp(cmd_tbl_t *cmdtp, int flag, int argc, char *const argv[]) |
Alexey Brodkin | 2c3f926 | 2018-05-28 15:27:43 +0300 | [diff] [blame] | 125 | { |
| 126 | cmd_tbl_t *c; |
| 127 | |
Alexey Brodkin | adc9b09 | 2018-10-18 09:54:58 +0300 | [diff] [blame] | 128 | c = find_cmd_tbl(argv[1], cmd_emsdp, ARRAY_SIZE(cmd_emsdp)); |
Alexey Brodkin | 2c3f926 | 2018-05-28 15:27:43 +0300 | [diff] [blame] | 129 | |
Alexey Brodkin | adc9b09 | 2018-10-18 09:54:58 +0300 | [diff] [blame] | 130 | /* Strip off leading 'emsdp' command */ |
Alexey Brodkin | 2c3f926 | 2018-05-28 15:27:43 +0300 | [diff] [blame] | 131 | argc--; |
| 132 | argv++; |
| 133 | |
| 134 | if (c == NULL || argc > c->maxargs) |
| 135 | return CMD_RET_USAGE; |
| 136 | |
| 137 | return c->cmd(cmdtp, flag, argc, argv); |
| 138 | } |
| 139 | |
| 140 | U_BOOT_CMD( |
Alexey Brodkin | adc9b09 | 2018-10-18 09:54:58 +0300 | [diff] [blame] | 141 | emsdp, CONFIG_SYS_MAXARGS, 0, do_emsdp, |
| 142 | "Synopsys EMSDP specific commands", |
Alexey Brodkin | 2c3f926 | 2018-05-28 15:27:43 +0300 | [diff] [blame] | 143 | "rom unlock - Unlock non-volatile memory for writing\n" |
Alexey Brodkin | adc9b09 | 2018-10-18 09:54:58 +0300 | [diff] [blame] | 144 | "emsdp rom lock - Lock non-volatile memory to prevent writing\n" |
Alexey Brodkin | 2c3f926 | 2018-05-28 15:27:43 +0300 | [diff] [blame] | 145 | ); |
Alexey Brodkin | 6ef705b | 2018-11-27 09:47:01 +0300 | [diff] [blame] | 146 | |
| 147 | int checkboard(void) |
| 148 | { |
| 149 | int version = readl(CREG_IP_VERSION); |
| 150 | |
| 151 | printf("Board: ARC EM Software Development Platform v%d.%d\n", |
| 152 | (version >> 16) & 0xff, version & 0xff); |
| 153 | return 0; |
| 154 | }; |