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