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