| 
									
										
										
										
											2008-03-19 04:07:43 +11:00
										 |  |  | /*
 | 
					
						
							|  |  |  |  * The simple platform -- for booting when firmware doesn't supply a device | 
					
						
							|  |  |  |  *                        tree or any platform configuration information. | 
					
						
							|  |  |  |  *                        All data is extracted from an embedded device tree | 
					
						
							|  |  |  |  *                        blob. | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * Authors: Scott Wood <scottwood@freescale.com> | 
					
						
							|  |  |  |  *          Grant Likely <grant.likely@secretlab.ca> | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * Copyright (c) 2007 Freescale Semiconductor, Inc. | 
					
						
							|  |  |  |  * Copyright (c) 2008 Secret Lab Technologies Ltd. | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * This program is free software; you can redistribute it and/or modify it | 
					
						
							|  |  |  |  * under the terms of the GNU General Public License version 2 as published | 
					
						
							|  |  |  |  * by the Free Software Foundation. | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | #include "ops.h"
 | 
					
						
							|  |  |  | #include "types.h"
 | 
					
						
							|  |  |  | #include "io.h"
 | 
					
						
							|  |  |  | #include "stdio.h"
 | 
					
						
							| 
									
										
										
										
											2009-04-30 15:25:53 +10:00
										 |  |  | #include <libfdt.h>
 | 
					
						
							| 
									
										
										
										
											2008-03-19 04:07:43 +11:00
										 |  |  | 
 | 
					
						
							|  |  |  | BSS_STACK(4*1024); | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2008-07-02 15:11:28 -07:00
										 |  |  | extern int platform_specific_init(void) __attribute__((weak)); | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2008-03-19 04:07:43 +11:00
										 |  |  | void platform_init(unsigned long r3, unsigned long r4, unsigned long r5, | 
					
						
							|  |  |  | 		   unsigned long r6, unsigned long r7) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	const u32 *na, *ns, *reg, *timebase; | 
					
						
							|  |  |  | 	u64 memsize64; | 
					
						
							|  |  |  | 	int node, size, i; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	/* Make sure FDT blob is sane */ | 
					
						
							|  |  |  | 	if (fdt_check_header(_dtb_start) != 0) | 
					
						
							|  |  |  | 		fatal("Invalid device tree blob\n"); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	/* Find the #address-cells and #size-cells properties */ | 
					
						
							|  |  |  | 	node = fdt_path_offset(_dtb_start, "/"); | 
					
						
							|  |  |  | 	if (node < 0) | 
					
						
							|  |  |  | 		fatal("Cannot find root node\n"); | 
					
						
							|  |  |  | 	na = fdt_getprop(_dtb_start, node, "#address-cells", &size); | 
					
						
							|  |  |  | 	if (!na || (size != 4)) | 
					
						
							|  |  |  | 		fatal("Cannot find #address-cells property"); | 
					
						
							|  |  |  | 	ns = fdt_getprop(_dtb_start, node, "#size-cells", &size); | 
					
						
							|  |  |  | 	if (!ns || (size != 4)) | 
					
						
							|  |  |  | 		fatal("Cannot find #size-cells property"); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	/* Find the memory range */ | 
					
						
							|  |  |  | 	node = fdt_node_offset_by_prop_value(_dtb_start, -1, "device_type", | 
					
						
							|  |  |  | 					     "memory", sizeof("memory")); | 
					
						
							|  |  |  | 	if (node < 0) | 
					
						
							|  |  |  | 		fatal("Cannot find memory node\n"); | 
					
						
							|  |  |  | 	reg = fdt_getprop(_dtb_start, node, "reg", &size); | 
					
						
							|  |  |  | 	if (size < (*na+*ns) * sizeof(u32)) | 
					
						
							|  |  |  | 		fatal("cannot get memory range\n"); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	/* Only interested in memory based at 0 */ | 
					
						
							|  |  |  | 	for (i = 0; i < *na; i++) | 
					
						
							|  |  |  | 		if (*reg++ != 0) | 
					
						
							|  |  |  | 			fatal("Memory range is not based at address 0\n"); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	/* get the memsize and trucate it to under 4G on 32 bit machines */ | 
					
						
							|  |  |  | 	memsize64 = 0; | 
					
						
							|  |  |  | 	for (i = 0; i < *ns; i++) | 
					
						
							|  |  |  | 		memsize64 = (memsize64 << 32) | *reg++; | 
					
						
							|  |  |  | 	if (sizeof(void *) == 4 && memsize64 >= 0x100000000ULL) | 
					
						
							|  |  |  | 		memsize64 = 0xffffffff; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	/* finally, setup the timebase */ | 
					
						
							|  |  |  | 	node = fdt_node_offset_by_prop_value(_dtb_start, -1, "device_type", | 
					
						
							|  |  |  | 					     "cpu", sizeof("cpu")); | 
					
						
							|  |  |  | 	if (!node) | 
					
						
							|  |  |  | 		fatal("Cannot find cpu node\n"); | 
					
						
							|  |  |  | 	timebase = fdt_getprop(_dtb_start, node, "timebase-frequency", &size); | 
					
						
							|  |  |  | 	if (timebase && (size == 4)) | 
					
						
							|  |  |  | 		timebase_period_ns = 1000000000 / *timebase; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	/* Now we have the memory size; initialize the heap */ | 
					
						
							|  |  |  | 	simple_alloc_init(_end, memsize64 - (unsigned long)_end, 32, 64); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	/* prepare the device tree and find the console */ | 
					
						
							|  |  |  | 	fdt_init(_dtb_start); | 
					
						
							| 
									
										
										
										
											2008-07-02 15:11:28 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	if (platform_specific_init) | 
					
						
							|  |  |  | 		platform_specific_init(); | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2008-03-19 04:07:43 +11:00
										 |  |  | 	serial_console_init(); | 
					
						
							|  |  |  | } |