Blame view

kernel/linux-rt-4.4.41/arch/powerpc/boot/wii.c 3.15 KB
5113f6f70   김현기   kernel add
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
  /*
   * arch/powerpc/boot/wii.c
   *
   * Nintendo Wii bootwrapper support
   * Copyright (C) 2008-2009 The GameCube Linux Team
   * Copyright (C) 2008,2009 Albert Herranz
   *
   * This program is free software; you can redistribute it and/or
   * modify it under the terms of the GNU General Public License
   * as published by the Free Software Foundation; either version 2
   * of the License, or (at your option) any later version.
   *
   */
  
  #include <stddef.h>
  #include "stdio.h"
  #include "types.h"
  #include "io.h"
  #include "ops.h"
  
  #include "ugecon.h"
  
  BSS_STACK(8192);
  
  #define HW_REG(x)		((void *)(x))
  
  #define EXI_CTRL		HW_REG(0x0d800070)
  #define EXI_CTRL_ENABLE		(1<<0)
  
  #define MEM2_TOP		(0x10000000 + 64*1024*1024)
  #define FIRMWARE_DEFAULT_SIZE	(12*1024*1024)
  
  
  struct mipc_infohdr {
  	char magic[3];
  	u8 version;
  	u32 mem2_boundary;
  	u32 ipc_in;
  	size_t ipc_in_size;
  	u32 ipc_out;
  	size_t ipc_out_size;
  };
  
  static int mipc_check_address(u32 pa)
  {
  	/* only MEM2 addresses */
  	if (pa < 0x10000000 || pa > 0x14000000)
  		return -EINVAL;
  	return 0;
  }
  
  static struct mipc_infohdr *mipc_get_infohdr(void)
  {
  	struct mipc_infohdr **hdrp, *hdr;
  
  	/* 'mini' header pointer is the last word of MEM2 memory */
  	hdrp = (struct mipc_infohdr **)0x13fffffc;
  	if (mipc_check_address((u32)hdrp)) {
  		printf("mini: invalid hdrp %08X
  ", (u32)hdrp);
  		hdr = NULL;
  		goto out;
  	}
  
  	hdr = *hdrp;
  	if (mipc_check_address((u32)hdr)) {
  		printf("mini: invalid hdr %08X
  ", (u32)hdr);
  		hdr = NULL;
  		goto out;
  	}
  	if (memcmp(hdr->magic, "IPC", 3)) {
  		printf("mini: invalid magic
  ");
  		hdr = NULL;
  		goto out;
  	}
  
  out:
  	return hdr;
  }
  
  static int mipc_get_mem2_boundary(u32 *mem2_boundary)
  {
  	struct mipc_infohdr *hdr;
  	int error;
  
  	hdr = mipc_get_infohdr();
  	if (!hdr) {
  		error = -1;
  		goto out;
  	}
  
  	if (mipc_check_address(hdr->mem2_boundary)) {
  		printf("mini: invalid mem2_boundary %08X
  ",
  		       hdr->mem2_boundary);
  		error = -EINVAL;
  		goto out;
  	}
  	*mem2_boundary = hdr->mem2_boundary;
  	error = 0;
  out:
  	return error;
  
  }
  
  static void platform_fixups(void)
  {
  	void *mem;
  	u32 reg[4];
  	u32 mem2_boundary;
  	int len;
  	int error;
  
  	mem = finddevice("/memory");
  	if (!mem)
  		fatal("Can't find memory node
  ");
  
  	/* two ranges of (address, size) words */
  	len = getprop(mem, "reg", reg, sizeof(reg));
  	if (len != sizeof(reg)) {
  		/* nothing to do */
  		goto out;
  	}
  
  	/* retrieve MEM2 boundary from 'mini' */
  	error = mipc_get_mem2_boundary(&mem2_boundary);
  	if (error) {
  		/* if that fails use a sane value */
  		mem2_boundary = MEM2_TOP - FIRMWARE_DEFAULT_SIZE;
  	}
  
  	if (mem2_boundary > reg[2] && mem2_boundary < reg[2] + reg[3]) {
  		reg[3] = mem2_boundary - reg[2];
  		printf("top of MEM2 @ %08X
  ", reg[2] + reg[3]);
  		setprop(mem, "reg", reg, sizeof(reg));
  	}
  
  out:
  	return;
  }
  
  void platform_init(unsigned long r3, unsigned long r4, unsigned long r5)
  {
  	u32 heapsize = 24*1024*1024 - (u32)_end;
  
  	simple_alloc_init(_end, heapsize, 32, 64);
  	fdt_init(_dtb_start);
  
  	/*
  	 * 'mini' boots the Broadway processor with EXI disabled.
  	 * We need it enabled before probing for the USB Gecko.
  	 */
  	out_be32(EXI_CTRL, in_be32(EXI_CTRL) | EXI_CTRL_ENABLE);
  
  	if (ug_probe())
  		console_ops.write = ug_console_write;
  
  	platform_ops.fixups = platform_fixups;
  }