| Geoff Levand | bafdb64 | 2007-07-04 09:07:18 +1000 | [diff] [blame] | 1 | /* | 
 | 2 |  *  PS3 bootwrapper support. | 
 | 3 |  * | 
 | 4 |  *  Copyright (C) 2007 Sony Computer Entertainment Inc. | 
 | 5 |  *  Copyright 2007 Sony Corp. | 
 | 6 |  * | 
 | 7 |  *  This program is free software; you can redistribute it and/or modify | 
 | 8 |  *  it under the terms of the GNU General Public License as published by | 
 | 9 |  *  the Free Software Foundation; version 2 of the License. | 
 | 10 |  * | 
 | 11 |  *  This program is distributed in the hope that it will be useful, | 
 | 12 |  *  but WITHOUT ANY WARRANTY; without even the implied warranty of | 
 | 13 |  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the | 
 | 14 |  *  GNU General Public License for more details. | 
 | 15 |  * | 
 | 16 |  *  You should have received a copy of the GNU General Public License | 
 | 17 |  *  along with this program; if not, write to the Free Software | 
 | 18 |  *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA | 
 | 19 |  */ | 
 | 20 |  | 
 | 21 | #include <stdarg.h> | 
 | 22 | #include <stddef.h> | 
 | 23 | #include "types.h" | 
 | 24 | #include "elf.h" | 
 | 25 | #include "string.h" | 
 | 26 | #include "stdio.h" | 
 | 27 | #include "page.h" | 
 | 28 | #include "ops.h" | 
 | 29 |  | 
| Geoff Levand | 5761eaa | 2008-03-28 07:41:45 +1100 | [diff] [blame] | 30 | extern int lv1_panic(u64 in_1); | 
 | 31 | extern int lv1_get_logical_partition_id(u64 *out_1); | 
 | 32 | extern int lv1_get_logical_ppe_id(u64 *out_1); | 
 | 33 | extern int lv1_get_repository_node_value(u64 in_1, u64 in_2, u64 in_3, | 
| Geoff Levand | bafdb64 | 2007-07-04 09:07:18 +1000 | [diff] [blame] | 34 | 	u64 in_4, u64 in_5, u64 *out_1, u64 *out_2); | 
 | 35 |  | 
 | 36 | #ifdef DEBUG | 
 | 37 | #define DBG(fmt...) printf(fmt) | 
 | 38 | #else | 
 | 39 | static inline int __attribute__ ((format (printf, 1, 2))) DBG( | 
 | 40 | 	const char *fmt, ...) {return 0;} | 
 | 41 | #endif | 
 | 42 |  | 
 | 43 | BSS_STACK(4096); | 
 | 44 |  | 
 | 45 | /* A buffer that may be edited by tools operating on a zImage binary so as to | 
 | 46 |  * edit the command line passed to vmlinux (by setting /chosen/bootargs). | 
 | 47 |  * The buffer is put in it's own section so that tools may locate it easier. | 
 | 48 |  */ | 
| Geoff Levand | 5761eaa | 2008-03-28 07:41:45 +1100 | [diff] [blame] | 49 |  | 
| Geoff Levand | bafdb64 | 2007-07-04 09:07:18 +1000 | [diff] [blame] | 50 | static char cmdline[COMMAND_LINE_SIZE] | 
 | 51 | 	__attribute__((__section__("__builtin_cmdline"))); | 
 | 52 |  | 
 | 53 | static void prep_cmdline(void *chosen) | 
 | 54 | { | 
 | 55 | 	if (cmdline[0] == '\0') | 
 | 56 | 		getprop(chosen, "bootargs", cmdline, COMMAND_LINE_SIZE-1); | 
 | 57 | 	else | 
 | 58 | 		setprop_str(chosen, "bootargs", cmdline); | 
 | 59 |  | 
 | 60 | 	printf("cmdline: '%s'\n", cmdline); | 
 | 61 | } | 
 | 62 |  | 
 | 63 | static void ps3_console_write(const char *buf, int len) | 
 | 64 | { | 
 | 65 | } | 
 | 66 |  | 
 | 67 | static void ps3_exit(void) | 
 | 68 | { | 
 | 69 | 	printf("ps3_exit\n"); | 
 | 70 |  | 
 | 71 | 	/* lv1_panic will shutdown the lpar. */ | 
 | 72 |  | 
 | 73 | 	lv1_panic(0); /* zero = do not reboot */ | 
 | 74 | 	while (1); | 
 | 75 | } | 
 | 76 |  | 
 | 77 | static int ps3_repository_read_rm_size(u64 *rm_size) | 
 | 78 | { | 
| Geoff Levand | 5761eaa | 2008-03-28 07:41:45 +1100 | [diff] [blame] | 79 | 	int result; | 
| Geoff Levand | bafdb64 | 2007-07-04 09:07:18 +1000 | [diff] [blame] | 80 | 	u64 lpar_id; | 
 | 81 | 	u64 ppe_id; | 
 | 82 | 	u64 v2; | 
 | 83 |  | 
 | 84 | 	result = lv1_get_logical_partition_id(&lpar_id); | 
 | 85 |  | 
 | 86 | 	if (result) | 
 | 87 | 		return -1; | 
 | 88 |  | 
 | 89 | 	result = lv1_get_logical_ppe_id(&ppe_id); | 
 | 90 |  | 
 | 91 | 	if (result) | 
 | 92 | 		return -1; | 
 | 93 |  | 
 | 94 | 	/* | 
 | 95 | 	 * n1: 0000000062690000 : ....bi.. | 
 | 96 | 	 * n2: 7075000000000000 : pu...... | 
 | 97 | 	 * n3: 0000000000000001 : ........ | 
 | 98 | 	 * n4: 726d5f73697a6500 : rm_size. | 
 | 99 | 	*/ | 
 | 100 |  | 
 | 101 | 	result = lv1_get_repository_node_value(lpar_id, 0x0000000062690000ULL, | 
 | 102 | 		0x7075000000000000ULL, ppe_id, 0x726d5f73697a6500ULL, rm_size, | 
 | 103 | 		&v2); | 
 | 104 |  | 
 | 105 | 	printf("%s:%d: ppe_id  %lu \n", __func__, __LINE__, | 
 | 106 | 		(unsigned long)ppe_id); | 
 | 107 | 	printf("%s:%d: lpar_id %lu \n", __func__, __LINE__, | 
 | 108 | 		(unsigned long)lpar_id); | 
 | 109 | 	printf("%s:%d: rm_size %llxh \n", __func__, __LINE__, *rm_size); | 
 | 110 |  | 
 | 111 | 	return result ? -1 : 0; | 
 | 112 | } | 
 | 113 |  | 
 | 114 | void ps3_copy_vectors(void) | 
 | 115 | { | 
 | 116 | 	extern char __system_reset_kernel[]; | 
 | 117 |  | 
| Geoff Levand | 5761eaa | 2008-03-28 07:41:45 +1100 | [diff] [blame] | 118 | 	memcpy((void *)0x100, __system_reset_kernel, 512); | 
 | 119 | 	flush_cache((void *)0x100, 512); | 
| Geoff Levand | bafdb64 | 2007-07-04 09:07:18 +1000 | [diff] [blame] | 120 | } | 
 | 121 |  | 
| Geoff Levand | 5761eaa | 2008-03-28 07:41:45 +1100 | [diff] [blame] | 122 | void platform_init(unsigned long null_check) | 
| Geoff Levand | bafdb64 | 2007-07-04 09:07:18 +1000 | [diff] [blame] | 123 | { | 
| Geoff Levand | bafdb64 | 2007-07-04 09:07:18 +1000 | [diff] [blame] | 124 | 	const u32 heapsize = 0x1000000 - (u32)_end; /* 16MiB */ | 
 | 125 | 	void *chosen; | 
 | 126 | 	unsigned long ft_addr; | 
 | 127 | 	u64 rm_size; | 
| Geoff Levand | 5761eaa | 2008-03-28 07:41:45 +1100 | [diff] [blame] | 128 | 	unsigned long val; | 
| Geoff Levand | bafdb64 | 2007-07-04 09:07:18 +1000 | [diff] [blame] | 129 |  | 
 | 130 | 	console_ops.write = ps3_console_write; | 
 | 131 | 	platform_ops.exit = ps3_exit; | 
 | 132 |  | 
 | 133 | 	printf("\n-- PS3 bootwrapper --\n"); | 
 | 134 |  | 
 | 135 | 	simple_alloc_init(_end, heapsize, 32, 64); | 
| David Gibson | 2f0dfea | 2007-12-10 14:28:39 +1100 | [diff] [blame] | 136 | 	fdt_init(_dtb_start); | 
| Geoff Levand | bafdb64 | 2007-07-04 09:07:18 +1000 | [diff] [blame] | 137 |  | 
 | 138 | 	chosen = finddevice("/chosen"); | 
 | 139 |  | 
 | 140 | 	ps3_repository_read_rm_size(&rm_size); | 
 | 141 | 	dt_fixup_memory(0, rm_size); | 
 | 142 |  | 
 | 143 | 	if (_initrd_end > _initrd_start) { | 
 | 144 | 		setprop_val(chosen, "linux,initrd-start", (u32)(_initrd_start)); | 
 | 145 | 		setprop_val(chosen, "linux,initrd-end", (u32)(_initrd_end)); | 
 | 146 | 	} | 
 | 147 |  | 
 | 148 | 	prep_cmdline(chosen); | 
 | 149 |  | 
 | 150 | 	ft_addr = dt_ops.finalize(); | 
 | 151 |  | 
 | 152 | 	ps3_copy_vectors(); | 
 | 153 |  | 
 | 154 | 	printf(" flat tree at 0x%lx\n\r", ft_addr); | 
 | 155 |  | 
| Geoff Levand | 5761eaa | 2008-03-28 07:41:45 +1100 | [diff] [blame] | 156 | 	val = *(unsigned long *)0; | 
 | 157 |  | 
 | 158 | 	if (val != null_check) | 
 | 159 | 		printf("null check failed: %lx != %lx\n\r", val, null_check); | 
 | 160 |  | 
| Geoff Levand | bafdb64 | 2007-07-04 09:07:18 +1000 | [diff] [blame] | 161 | 	((kernel_entry_t)0)(ft_addr, 0, NULL); | 
 | 162 |  | 
 | 163 | 	ps3_exit(); | 
 | 164 | } |