Tom Rini | 10e4779 | 2018-05-06 17:58:06 -0400 | [diff] [blame] | 1 | // SPDX-License-Identifier: GPL-2.0+ |
wdenk | ef3386f | 2004-10-10 21:27:30 +0000 | [diff] [blame] | 2 | /* |
| 3 | * (C) Copyright 2004, Psyent Corporation <www.psyent.com> |
| 4 | * Scott McNutt <smcnutt@psyent.com> |
wdenk | ef3386f | 2004-10-10 21:27:30 +0000 | [diff] [blame] | 5 | */ |
| 6 | |
| 7 | #include <common.h> |
Simon Glass | ed38aef | 2020-05-10 11:40:03 -0600 | [diff] [blame] | 8 | #include <command.h> |
Thomas Chou | c617026 | 2015-10-21 21:34:57 +0800 | [diff] [blame] | 9 | #include <cpu.h> |
Simon Glass | 6333448 | 2019-11-14 12:57:39 -0700 | [diff] [blame] | 10 | #include <cpu_func.h> |
Thomas Chou | c617026 | 2015-10-21 21:34:57 +0800 | [diff] [blame] | 11 | #include <dm.h> |
| 12 | #include <errno.h> |
Simon Glass | fc55736 | 2022-03-04 08:43:05 -0700 | [diff] [blame] | 13 | #include <event.h> |
Simon Glass | 9758973 | 2020-05-10 11:40:02 -0600 | [diff] [blame] | 14 | #include <init.h> |
Simon Glass | 8f3f761 | 2019-11-14 12:57:42 -0700 | [diff] [blame] | 15 | #include <irq_func.h> |
Joachim Foerster | f292474 | 2011-10-20 10:28:10 +0200 | [diff] [blame] | 16 | #include <asm/cache.h> |
Simon Glass | 3ba929a | 2020-10-30 21:38:53 -0600 | [diff] [blame] | 17 | #include <asm/global_data.h> |
Simon Glass | 4dcacfc | 2020-05-10 11:40:13 -0600 | [diff] [blame] | 18 | #include <asm/system.h> |
wdenk | ef3386f | 2004-10-10 21:27:30 +0000 | [diff] [blame] | 19 | |
Thomas Chou | cce3e75 | 2014-08-22 11:36:47 +0800 | [diff] [blame] | 20 | DECLARE_GLOBAL_DATA_PTR; |
| 21 | |
Thomas Chou | cce3e75 | 2014-08-22 11:36:47 +0800 | [diff] [blame] | 22 | #ifdef CONFIG_DISPLAY_CPUINFO |
| 23 | int print_cpuinfo(void) |
wdenk | ef3386f | 2004-10-10 21:27:30 +0000 | [diff] [blame] | 24 | { |
Thomas Chou | 36b9c9a | 2015-10-14 08:43:31 +0800 | [diff] [blame] | 25 | printf("CPU: Nios-II\n"); |
| 26 | return 0; |
wdenk | ef3386f | 2004-10-10 21:27:30 +0000 | [diff] [blame] | 27 | } |
Thomas Chou | cce3e75 | 2014-08-22 11:36:47 +0800 | [diff] [blame] | 28 | #endif /* CONFIG_DISPLAY_CPUINFO */ |
wdenk | ef3386f | 2004-10-10 21:27:30 +0000 | [diff] [blame] | 29 | |
Thomas Chou | 48b42e6 | 2015-12-16 16:07:06 +0800 | [diff] [blame] | 30 | #ifdef CONFIG_ALTERA_SYSID |
| 31 | int checkboard(void) |
| 32 | { |
| 33 | display_sysid(); |
| 34 | return 0; |
| 35 | } |
| 36 | #endif |
| 37 | |
Simon Glass | ed38aef | 2020-05-10 11:40:03 -0600 | [diff] [blame] | 38 | int do_reset(struct cmd_tbl *cmdtp, int flag, int argc, char *const argv[]) |
wdenk | ef3386f | 2004-10-10 21:27:30 +0000 | [diff] [blame] | 39 | { |
Thomas Chou | 5975e79 | 2010-08-16 10:49:44 +0800 | [diff] [blame] | 40 | disable_interrupts(); |
| 41 | /* indirect call to go beyond 256MB limitation of toolchain */ |
Thomas Chou | 72b6198 | 2015-10-09 09:43:52 +0800 | [diff] [blame] | 42 | nios2_callr(gd->arch.reset_addr); |
Thomas Chou | 5975e79 | 2010-08-16 10:49:44 +0800 | [diff] [blame] | 43 | return 0; |
wdenk | ef3386f | 2004-10-10 21:27:30 +0000 | [diff] [blame] | 44 | } |
Joachim Foerster | f292474 | 2011-10-20 10:28:10 +0200 | [diff] [blame] | 45 | |
Thomas Chou | 93f9646 | 2015-10-06 14:09:19 +0800 | [diff] [blame] | 46 | /* |
| 47 | * COPY EXCEPTION TRAMPOLINE -- copy the tramp to the |
| 48 | * exception address. Define CONFIG_ROM_STUBS to prevent |
| 49 | * the copy (e.g. exception in flash or in other |
| 50 | * softare/firmware component). |
| 51 | */ |
| 52 | #ifndef CONFIG_ROM_STUBS |
| 53 | static void copy_exception_trampoline(void) |
| 54 | { |
| 55 | extern int _except_start, _except_end; |
| 56 | void *except_target = (void *)gd->arch.exception_addr; |
| 57 | |
| 58 | if (&_except_start != except_target) { |
| 59 | memcpy(except_target, &_except_start, |
| 60 | &_except_end - &_except_start); |
| 61 | flush_cache(gd->arch.exception_addr, |
| 62 | &_except_end - &_except_start); |
| 63 | } |
| 64 | } |
| 65 | #endif |
| 66 | |
Simon Glass | fc55736 | 2022-03-04 08:43:05 -0700 | [diff] [blame] | 67 | static int nios_cpu_setup(void *ctx, struct event *event) |
Thomas Chou | cce3e75 | 2014-08-22 11:36:47 +0800 | [diff] [blame] | 68 | { |
Thomas Chou | c617026 | 2015-10-21 21:34:57 +0800 | [diff] [blame] | 69 | struct udevice *dev; |
| 70 | int ret; |
| 71 | |
Simon Glass | c7298e7 | 2016-02-11 13:23:26 -0700 | [diff] [blame] | 72 | ret = uclass_first_device_err(UCLASS_CPU, &dev); |
Thomas Chou | c617026 | 2015-10-21 21:34:57 +0800 | [diff] [blame] | 73 | if (ret) |
| 74 | return ret; |
Thomas Chou | c617026 | 2015-10-21 21:34:57 +0800 | [diff] [blame] | 75 | |
Tom Rini | bb4dd96 | 2022-11-16 13:10:37 -0500 | [diff] [blame] | 76 | gd->ram_size = CFG_SYS_SDRAM_SIZE; |
Thomas Chou | 93f9646 | 2015-10-06 14:09:19 +0800 | [diff] [blame] | 77 | #ifndef CONFIG_ROM_STUBS |
| 78 | copy_exception_trampoline(); |
| 79 | #endif |
Thomas Chou | cce3e75 | 2014-08-22 11:36:47 +0800 | [diff] [blame] | 80 | |
| 81 | return 0; |
| 82 | } |
Simon Glass | fc55736 | 2022-03-04 08:43:05 -0700 | [diff] [blame] | 83 | EVENT_SPY(EVT_DM_POST_INIT, nios_cpu_setup); |
Thomas Chou | c617026 | 2015-10-21 21:34:57 +0800 | [diff] [blame] | 84 | |
Simon Glass | 791fa45 | 2020-01-26 22:06:27 -0700 | [diff] [blame] | 85 | static int altera_nios2_get_desc(const struct udevice *dev, char *buf, |
| 86 | int size) |
Thomas Chou | c617026 | 2015-10-21 21:34:57 +0800 | [diff] [blame] | 87 | { |
| 88 | const char *cpu_name = "Nios-II"; |
| 89 | |
| 90 | if (size < strlen(cpu_name)) |
| 91 | return -ENOSPC; |
| 92 | strcpy(buf, cpu_name); |
| 93 | |
| 94 | return 0; |
| 95 | } |
| 96 | |
Simon Glass | 791fa45 | 2020-01-26 22:06:27 -0700 | [diff] [blame] | 97 | static int altera_nios2_get_info(const struct udevice *dev, |
| 98 | struct cpu_info *info) |
Thomas Chou | c617026 | 2015-10-21 21:34:57 +0800 | [diff] [blame] | 99 | { |
| 100 | info->cpu_freq = gd->cpu_clk; |
| 101 | info->features = (1 << CPU_FEAT_L1_CACHE) | |
| 102 | (gd->arch.has_mmu ? (1 << CPU_FEAT_MMU) : 0); |
| 103 | |
| 104 | return 0; |
| 105 | } |
| 106 | |
Simon Glass | 791fa45 | 2020-01-26 22:06:27 -0700 | [diff] [blame] | 107 | static int altera_nios2_get_count(const struct udevice *dev) |
Thomas Chou | c617026 | 2015-10-21 21:34:57 +0800 | [diff] [blame] | 108 | { |
| 109 | return 1; |
| 110 | } |
| 111 | |
| 112 | static int altera_nios2_probe(struct udevice *dev) |
| 113 | { |
| 114 | const void *blob = gd->fdt_blob; |
Simon Glass | dd79d6e | 2017-01-17 16:52:55 -0700 | [diff] [blame] | 115 | int node = dev_of_offset(dev); |
Thomas Chou | c617026 | 2015-10-21 21:34:57 +0800 | [diff] [blame] | 116 | |
| 117 | gd->cpu_clk = fdtdec_get_int(blob, node, |
| 118 | "clock-frequency", 0); |
| 119 | gd->arch.dcache_line_size = fdtdec_get_int(blob, node, |
| 120 | "dcache-line-size", 0); |
| 121 | gd->arch.icache_line_size = fdtdec_get_int(blob, node, |
| 122 | "icache-line-size", 0); |
| 123 | gd->arch.dcache_size = fdtdec_get_int(blob, node, |
| 124 | "dcache-size", 0); |
| 125 | gd->arch.icache_size = fdtdec_get_int(blob, node, |
| 126 | "icache-size", 0); |
| 127 | gd->arch.reset_addr = fdtdec_get_int(blob, node, |
| 128 | "altr,reset-addr", 0); |
| 129 | gd->arch.exception_addr = fdtdec_get_int(blob, node, |
| 130 | "altr,exception-addr", 0); |
| 131 | gd->arch.has_initda = fdtdec_get_int(blob, node, |
| 132 | "altr,has-initda", 0); |
| 133 | gd->arch.has_mmu = fdtdec_get_int(blob, node, |
| 134 | "altr,has-mmu", 0); |
Thomas Chou | ebf8aac | 2015-10-27 08:30:22 +0800 | [diff] [blame] | 135 | gd->arch.io_region_base = gd->arch.has_mmu ? 0xe0000000 : 0x80000000; |
| 136 | gd->arch.mem_region_base = gd->arch.has_mmu ? 0xc0000000 : 0x00000000; |
Thomas Chou | 043a497 | 2015-10-27 09:02:17 +0800 | [diff] [blame] | 137 | gd->arch.physaddr_mask = gd->arch.has_mmu ? 0x1fffffff : 0x7fffffff; |
Thomas Chou | c617026 | 2015-10-21 21:34:57 +0800 | [diff] [blame] | 138 | |
| 139 | return 0; |
| 140 | } |
| 141 | |
| 142 | static const struct cpu_ops altera_nios2_ops = { |
| 143 | .get_desc = altera_nios2_get_desc, |
| 144 | .get_info = altera_nios2_get_info, |
| 145 | .get_count = altera_nios2_get_count, |
| 146 | }; |
| 147 | |
| 148 | static const struct udevice_id altera_nios2_ids[] = { |
| 149 | { .compatible = "altr,nios2-1.0" }, |
| 150 | { .compatible = "altr,nios2-1.1" }, |
| 151 | { } |
| 152 | }; |
| 153 | |
| 154 | U_BOOT_DRIVER(altera_nios2) = { |
| 155 | .name = "altera_nios2", |
| 156 | .id = UCLASS_CPU, |
| 157 | .of_match = altera_nios2_ids, |
| 158 | .probe = altera_nios2_probe, |
| 159 | .ops = &altera_nios2_ops, |
| 160 | .flags = DM_FLAG_PRE_RELOC, |
| 161 | }; |
Simon Glass | d35f338 | 2017-04-06 12:47:05 -0600 | [diff] [blame] | 162 | |
| 163 | /* This is a dummy function on nios2 */ |
| 164 | int dram_init(void) |
| 165 | { |
| 166 | return 0; |
| 167 | } |