191 lines
		
	
	
	
		
			4.8 KiB
			
		
	
	
	
		
			C
		
	
	
	
	
	
		
		
			
		
	
	
			191 lines
		
	
	
	
		
			4.8 KiB
			
		
	
	
	
		
			C
		
	
	
	
	
	
| 
								 | 
							
								/*
							 | 
						||
| 
								 | 
							
								 * GEFanuc C2K platform code.
							 | 
						||
| 
								 | 
							
								 *
							 | 
						||
| 
								 | 
							
								 * Author: Remi Machet <rmachet@slac.stanford.edu>
							 | 
						||
| 
								 | 
							
								 *
							 | 
						||
| 
								 | 
							
								 * Originated from prpmc2800.c
							 | 
						||
| 
								 | 
							
								 *
							 | 
						||
| 
								 | 
							
								 * 2008 (c) Stanford University
							 | 
						||
| 
								 | 
							
								 * 2007 (c) MontaVista, Software, Inc.
							 | 
						||
| 
								 | 
							
								 *
							 | 
						||
| 
								 | 
							
								 * 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 "types.h"
							 | 
						||
| 
								 | 
							
								#include "stdio.h"
							 | 
						||
| 
								 | 
							
								#include "io.h"
							 | 
						||
| 
								 | 
							
								#include "ops.h"
							 | 
						||
| 
								 | 
							
								#include "elf.h"
							 | 
						||
| 
								 | 
							
								#include "gunzip_util.h"
							 | 
						||
| 
								 | 
							
								#include "mv64x60.h"
							 | 
						||
| 
								 | 
							
								#include "cuboot.h"
							 | 
						||
| 
								 | 
							
								#include "ppcboot.h"
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								static u8 *bridge_base;
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								static void c2k_bridge_setup(u32 mem_size)
							 | 
						||
| 
								 | 
							
								{
							 | 
						||
| 
								 | 
							
									u32 i, v[30], enables, acc_bits;
							 | 
						||
| 
								 | 
							
									u32 pci_base_hi, pci_base_lo, size, buf[2];
							 | 
						||
| 
								 | 
							
									unsigned long cpu_base;
							 | 
						||
| 
								 | 
							
									int rc;
							 | 
						||
| 
								 | 
							
									void *devp, *mv64x60_devp;
							 | 
						||
| 
								 | 
							
									u8 *bridge_pbase, is_coherent;
							 | 
						||
| 
								 | 
							
									struct mv64x60_cpu2pci_win *tbl;
							 | 
						||
| 
								 | 
							
									int bus;
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
									bridge_pbase = mv64x60_get_bridge_pbase();
							 | 
						||
| 
								 | 
							
									is_coherent = mv64x60_is_coherent();
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
									if (is_coherent)
							 | 
						||
| 
								 | 
							
										acc_bits = MV64x60_PCI_ACC_CNTL_SNOOP_WB
							 | 
						||
| 
								 | 
							
											| MV64x60_PCI_ACC_CNTL_SWAP_NONE
							 | 
						||
| 
								 | 
							
											| MV64x60_PCI_ACC_CNTL_MBURST_32_BYTES
							 | 
						||
| 
								 | 
							
											| MV64x60_PCI_ACC_CNTL_RDSIZE_32_BYTES;
							 | 
						||
| 
								 | 
							
									else
							 | 
						||
| 
								 | 
							
										acc_bits = MV64x60_PCI_ACC_CNTL_SNOOP_NONE
							 | 
						||
| 
								 | 
							
											| MV64x60_PCI_ACC_CNTL_SWAP_NONE
							 | 
						||
| 
								 | 
							
											| MV64x60_PCI_ACC_CNTL_MBURST_128_BYTES
							 | 
						||
| 
								 | 
							
											| MV64x60_PCI_ACC_CNTL_RDSIZE_256_BYTES;
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
									mv64x60_config_ctlr_windows(bridge_base, bridge_pbase, is_coherent);
							 | 
						||
| 
								 | 
							
									mv64x60_devp = find_node_by_compatible(NULL, "marvell,mv64360");
							 | 
						||
| 
								 | 
							
									if (mv64x60_devp == NULL)
							 | 
						||
| 
								 | 
							
										fatal("Error: Missing marvell,mv64360 device tree node\n\r");
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
									enables = in_le32((u32 *)(bridge_base + MV64x60_CPU_BAR_ENABLE));
							 | 
						||
| 
								 | 
							
									enables |= 0x007ffe00; /* Disable all cpu->pci windows */
							 | 
						||
| 
								 | 
							
									out_le32((u32 *)(bridge_base + MV64x60_CPU_BAR_ENABLE), enables);
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
									/* Get the cpu -> pci i/o & mem mappings from the device tree */
							 | 
						||
| 
								 | 
							
									devp = NULL;
							 | 
						||
| 
								 | 
							
									for (bus = 0; ; bus++) {
							 | 
						||
| 
								 | 
							
										char name[] = "pci ";
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
										name[strlen(name)-1] = bus+'0';
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
										devp = find_node_by_alias(name);
							 | 
						||
| 
								 | 
							
										if (devp == NULL)
							 | 
						||
| 
								 | 
							
											break;
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
										if (bus >= 2)
							 | 
						||
| 
								 | 
							
											fatal("Error: Only 2 PCI controllers are supported at" \
							 | 
						||
| 
								 | 
							
												" this time.\n");
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
										mv64x60_config_pci_windows(bridge_base, bridge_pbase, bus, 0,
							 | 
						||
| 
								 | 
							
												mem_size, acc_bits);
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
										rc = getprop(devp, "ranges", v, sizeof(v));
							 | 
						||
| 
								 | 
							
										if (rc == 0)
							 | 
						||
| 
								 | 
							
											fatal("Error: Can't find marvell,mv64360-pci ranges"
							 | 
						||
| 
								 | 
							
												" property\n\r");
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
										/* Get the cpu -> pci i/o & mem mappings from the device tree */
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
										for (i = 0; i < rc; i += 6) {
							 | 
						||
| 
								 | 
							
											switch (v[i] & 0xff000000) {
							 | 
						||
| 
								 | 
							
											case 0x01000000: /* PCI I/O Space */
							 | 
						||
| 
								 | 
							
												tbl = mv64x60_cpu2pci_io;
							 | 
						||
| 
								 | 
							
												break;
							 | 
						||
| 
								 | 
							
											case 0x02000000: /* PCI MEM Space */
							 | 
						||
| 
								 | 
							
												tbl = mv64x60_cpu2pci_mem;
							 | 
						||
| 
								 | 
							
												break;
							 | 
						||
| 
								 | 
							
											default:
							 | 
						||
| 
								 | 
							
												continue;
							 | 
						||
| 
								 | 
							
											}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
											pci_base_hi = v[i+1];
							 | 
						||
| 
								 | 
							
											pci_base_lo = v[i+2];
							 | 
						||
| 
								 | 
							
											cpu_base = v[i+3];
							 | 
						||
| 
								 | 
							
											size = v[i+5];
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
											buf[0] = cpu_base;
							 | 
						||
| 
								 | 
							
											buf[1] = size;
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
											if (!dt_xlate_addr(devp, buf, sizeof(buf), &cpu_base))
							 | 
						||
| 
								 | 
							
												fatal("Error: Can't translate PCI address " \
							 | 
						||
| 
								 | 
							
														"0x%x\n\r", (u32)cpu_base);
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
											mv64x60_config_cpu2pci_window(bridge_base, bus,
							 | 
						||
| 
								 | 
							
												pci_base_hi, pci_base_lo, cpu_base, size, tbl);
							 | 
						||
| 
								 | 
							
										}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
										enables &= ~(3<<(9+bus*5)); /* Enable cpu->pci<bus> i/o,
							 | 
						||
| 
								 | 
							
														cpu->pci<bus> mem0 */
							 | 
						||
| 
								 | 
							
										out_le32((u32 *)(bridge_base + MV64x60_CPU_BAR_ENABLE),
							 | 
						||
| 
								 | 
							
											enables);
							 | 
						||
| 
								 | 
							
									};
							 | 
						||
| 
								 | 
							
								}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								static void c2k_fixups(void)
							 | 
						||
| 
								 | 
							
								{
							 | 
						||
| 
								 | 
							
									u32 mem_size;
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
									mem_size = mv64x60_get_mem_size(bridge_base);
							 | 
						||
| 
								 | 
							
									c2k_bridge_setup(mem_size); /* Do necessary bridge setup */
							 | 
						||
| 
								 | 
							
								}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								#define MV64x60_MPP_CNTL_0	0xf000
							 | 
						||
| 
								 | 
							
								#define MV64x60_MPP_CNTL_2	0xf008
							 | 
						||
| 
								 | 
							
								#define MV64x60_GPP_IO_CNTL	0xf100
							 | 
						||
| 
								 | 
							
								#define MV64x60_GPP_LEVEL_CNTL	0xf110
							 | 
						||
| 
								 | 
							
								#define MV64x60_GPP_VALUE_SET	0xf118
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								static void c2k_reset(void)
							 | 
						||
| 
								 | 
							
								{
							 | 
						||
| 
								 | 
							
									u32 temp;
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
									udelay(5000000);
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
									if (bridge_base != 0) {
							 | 
						||
| 
								 | 
							
										temp = in_le32((u32 *)(bridge_base + MV64x60_MPP_CNTL_0));
							 | 
						||
| 
								 | 
							
										temp &= 0xFFFF0FFF;
							 | 
						||
| 
								 | 
							
										out_le32((u32 *)(bridge_base + MV64x60_MPP_CNTL_0), temp);
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
										temp = in_le32((u32 *)(bridge_base + MV64x60_GPP_LEVEL_CNTL));
							 | 
						||
| 
								 | 
							
										temp |= 0x00000004;
							 | 
						||
| 
								 | 
							
										out_le32((u32 *)(bridge_base + MV64x60_GPP_LEVEL_CNTL), temp);
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
										temp = in_le32((u32 *)(bridge_base + MV64x60_GPP_IO_CNTL));
							 | 
						||
| 
								 | 
							
										temp |= 0x00000004;
							 | 
						||
| 
								 | 
							
										out_le32((u32 *)(bridge_base + MV64x60_GPP_IO_CNTL), temp);
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
										temp = in_le32((u32 *)(bridge_base + MV64x60_MPP_CNTL_2));
							 | 
						||
| 
								 | 
							
										temp &= 0xFFFF0FFF;
							 | 
						||
| 
								 | 
							
										out_le32((u32 *)(bridge_base + MV64x60_MPP_CNTL_2), temp);
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
										temp = in_le32((u32 *)(bridge_base + MV64x60_GPP_LEVEL_CNTL));
							 | 
						||
| 
								 | 
							
										temp |= 0x00080000;
							 | 
						||
| 
								 | 
							
										out_le32((u32 *)(bridge_base + MV64x60_GPP_LEVEL_CNTL), temp);
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
										temp = in_le32((u32 *)(bridge_base + MV64x60_GPP_IO_CNTL));
							 | 
						||
| 
								 | 
							
										temp |= 0x00080000;
							 | 
						||
| 
								 | 
							
										out_le32((u32 *)(bridge_base + MV64x60_GPP_IO_CNTL), temp);
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
										out_le32((u32 *)(bridge_base + MV64x60_GPP_VALUE_SET),
							 | 
						||
| 
								 | 
							
												0x00080004);
							 | 
						||
| 
								 | 
							
									}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
									for (;;);
							 | 
						||
| 
								 | 
							
								}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								static bd_t bd;
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								void platform_init(unsigned long r3, unsigned long r4, unsigned long r5,
							 | 
						||
| 
								 | 
							
											unsigned long r6, unsigned long r7)
							 | 
						||
| 
								 | 
							
								{
							 | 
						||
| 
								 | 
							
									CUBOOT_INIT();
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
									fdt_init(_dtb_start);
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
									bridge_base = mv64x60_get_bridge_base();
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
									platform_ops.fixups = c2k_fixups;
							 | 
						||
| 
								 | 
							
									platform_ops.exit = c2k_reset;
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
									if (serial_console_init() < 0)
							 | 
						||
| 
								 | 
							
										exit();
							 | 
						||
| 
								 | 
							
								}
							 |