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