1 // SPDX-License-Identifier: GPL-2.0
2 /*
3 * Nintendo 64 init.
4 *
5 * Copyright (C) 2021 Lauri Kasanen
6 */
7 #include <linux/init.h>
8 #include <linux/ioport.h>
9 #include <linux/irq.h>
10 #include <linux/memblock.h>
11 #include <linux/platform_device.h>
12 #include <linux/platform_data/simplefb.h>
13 #include <linux/string.h>
14
15 #include <asm/bootinfo.h>
16 #include <asm/fw/fw.h>
17 #include <asm/time.h>
18
19 #define IO_MEM_RESOURCE_START 0UL
20 #define IO_MEM_RESOURCE_END 0x1fffffffUL
21
22 /*
23 * System-specifc irq names for clarity
24 */
25 #define MIPS_CPU_IRQ(x) (MIPS_CPU_IRQ_BASE + (x))
26 #define MIPS_SOFTINT0_IRQ MIPS_CPU_IRQ(0)
27 #define MIPS_SOFTINT1_IRQ MIPS_CPU_IRQ(1)
28 #define RCP_IRQ MIPS_CPU_IRQ(2)
29 #define CART_IRQ MIPS_CPU_IRQ(3)
30 #define PRENMI_IRQ MIPS_CPU_IRQ(4)
31 #define RDBR_IRQ MIPS_CPU_IRQ(5)
32 #define RDBW_IRQ MIPS_CPU_IRQ(6)
33 #define TIMER_IRQ MIPS_CPU_IRQ(7)
34
iomem_resource_init(void)35 static void __init iomem_resource_init(void)
36 {
37 iomem_resource.start = IO_MEM_RESOURCE_START;
38 iomem_resource.end = IO_MEM_RESOURCE_END;
39 }
40
get_system_type(void)41 const char *get_system_type(void)
42 {
43 return "Nintendo 64";
44 }
45
prom_init(void)46 void __init prom_init(void)
47 {
48 fw_init_cmdline();
49 }
50
51 #define W 320
52 #define H 240
53 #define REG_BASE ((u32 *) CKSEG1ADDR(0x4400000))
54
n64rdp_write_reg(const u8 reg,const u32 value)55 static void __init n64rdp_write_reg(const u8 reg, const u32 value)
56 {
57 __raw_writel(value, REG_BASE + reg);
58 }
59
60 #undef REG_BASE
61
62 static const u32 ntsc_320[] __initconst = {
63 0x00013212, 0x00000000, 0x00000140, 0x00000200,
64 0x00000000, 0x03e52239, 0x0000020d, 0x00000c15,
65 0x0c150c15, 0x006c02ec, 0x002501ff, 0x000e0204,
66 0x00000200, 0x00000400
67 };
68
69 #define MI_REG_BASE 0x4300000
70 #define NUM_MI_REGS 4
71 #define AI_REG_BASE 0x4500000
72 #define NUM_AI_REGS 6
73 #define PI_REG_BASE 0x4600000
74 #define NUM_PI_REGS 5
75 #define SI_REG_BASE 0x4800000
76 #define NUM_SI_REGS 7
77
n64_platform_init(void)78 static int __init n64_platform_init(void)
79 {
80 static const char simplefb_resname[] = "FB";
81 static const struct simplefb_platform_data mode = {
82 .width = W,
83 .height = H,
84 .stride = W * 2,
85 .format = "r5g5b5a1"
86 };
87 struct resource res[3];
88 void *orig;
89 unsigned long phys;
90 unsigned i;
91
92 memset(res, 0, sizeof(struct resource) * 3);
93 res[0].flags = IORESOURCE_MEM;
94 res[0].start = MI_REG_BASE;
95 res[0].end = MI_REG_BASE + NUM_MI_REGS * 4 - 1;
96
97 res[1].flags = IORESOURCE_MEM;
98 res[1].start = AI_REG_BASE;
99 res[1].end = AI_REG_BASE + NUM_AI_REGS * 4 - 1;
100
101 res[2].flags = IORESOURCE_IRQ;
102 res[2].start = RCP_IRQ;
103 res[2].end = RCP_IRQ;
104
105 platform_device_register_simple("n64audio", -1, res, 3);
106
107 memset(&res[0], 0, sizeof(res[0]));
108 res[0].flags = IORESOURCE_MEM;
109 res[0].start = PI_REG_BASE;
110 res[0].end = PI_REG_BASE + NUM_PI_REGS * 4 - 1;
111
112 platform_device_register_simple("n64cart", -1, res, 1);
113
114 memset(&res[0], 0, sizeof(res[0]));
115 res[0].flags = IORESOURCE_MEM;
116 res[0].start = SI_REG_BASE;
117 res[0].end = SI_REG_BASE + NUM_SI_REGS * 4 - 1;
118
119 platform_device_register_simple("n64joy", -1, res, 1);
120
121 /* The framebuffer needs 64-byte alignment */
122 orig = kzalloc(W * H * 2 + 63, GFP_DMA | GFP_KERNEL);
123 if (!orig)
124 return -ENOMEM;
125 phys = virt_to_phys(orig);
126 phys += 63;
127 phys &= ~63;
128
129 for (i = 0; i < ARRAY_SIZE(ntsc_320); i++) {
130 if (i == 1)
131 n64rdp_write_reg(i, phys);
132 else
133 n64rdp_write_reg(i, ntsc_320[i]);
134 }
135
136 /* setup IORESOURCE_MEM as framebuffer memory */
137 memset(&res[0], 0, sizeof(res[0]));
138 res[0].flags = IORESOURCE_MEM;
139 res[0].name = simplefb_resname;
140 res[0].start = phys;
141 res[0].end = phys + W * H * 2 - 1;
142
143 platform_device_register_resndata(NULL, "simple-framebuffer", 0,
144 &res[0], 1, &mode, sizeof(mode));
145
146 return 0;
147 }
148
149 #undef W
150 #undef H
151
152 arch_initcall(n64_platform_init);
153
plat_mem_setup(void)154 void __init plat_mem_setup(void)
155 {
156 iomem_resource_init();
157 memblock_add(0x0, 8 * 1024 * 1024); /* Bootloader blocks the 4mb config */
158 }
159
plat_time_init(void)160 void __init plat_time_init(void)
161 {
162 /* 93.75 MHz cpu, count register runs at half rate */
163 mips_hpt_frequency = 93750000 / 2;
164 }
165