| Paul Mundt | efd590d | 2010-01-20 15:08:36 +0900 | [diff] [blame] | 1 | /* | 
 | 2 |  * SDK7786 FPGA Support. | 
 | 3 |  * | 
 | 4 |  * Copyright (C) 2010  Paul Mundt | 
 | 5 |  * | 
 | 6 |  * This file is subject to the terms and conditions of the GNU General Public | 
 | 7 |  * License.  See the file "COPYING" in the main directory of this archive | 
 | 8 |  * for more details. | 
 | 9 |  */ | 
 | 10 | #include <linux/init.h> | 
 | 11 | #include <linux/io.h> | 
 | 12 | #include <linux/bcd.h> | 
 | 13 | #include <mach/fpga.h> | 
| Paul Mundt | d9116d0 | 2010-01-20 18:25:19 +0900 | [diff] [blame] | 14 | #include <asm/sizes.h> | 
| Paul Mundt | efd590d | 2010-01-20 15:08:36 +0900 | [diff] [blame] | 15 |  | 
| Paul Mundt | d9116d0 | 2010-01-20 18:25:19 +0900 | [diff] [blame] | 16 | #define FPGA_REGS_OFFSET	0x03fff800 | 
 | 17 | #define FPGA_REGS_SIZE		0x490 | 
 | 18 |  | 
 | 19 | /* | 
 | 20 |  * The FPGA can be mapped in any of the generally available areas, | 
 | 21 |  * so we attempt to scan for it using the fixed SRSTR read magic. | 
 | 22 |  * | 
 | 23 |  * Once the FPGA is located, the rest of the mapping data for the other | 
 | 24 |  * components can be determined dynamically from its section mapping | 
 | 25 |  * registers. | 
 | 26 |  */ | 
 | 27 | static void __iomem *sdk7786_fpga_probe(void) | 
 | 28 | { | 
 | 29 | 	unsigned long area; | 
 | 30 | 	void __iomem *base; | 
 | 31 |  | 
 | 32 | 	/* | 
 | 33 | 	 * Iterate over all of the areas where the FPGA could be mapped. | 
 | 34 | 	 * The possible range is anywhere from area 0 through 6, area 7 | 
 | 35 | 	 * is reserved. | 
 | 36 | 	 */ | 
 | 37 | 	for (area = PA_AREA0; area < PA_AREA7; area += SZ_64M) { | 
 | 38 | 		base = ioremap_nocache(area + FPGA_REGS_OFFSET, FPGA_REGS_SIZE); | 
 | 39 | 		if (!base) { | 
 | 40 | 			/* Failed to remap this area, move along. */ | 
 | 41 | 			continue; | 
 | 42 | 		} | 
 | 43 |  | 
 | 44 | 		if (ioread16(base + SRSTR) == SRSTR_MAGIC) | 
 | 45 | 			return base;	/* Found it! */ | 
 | 46 |  | 
 | 47 | 		iounmap(base); | 
 | 48 | 	} | 
 | 49 |  | 
 | 50 | 	return NULL; | 
 | 51 | } | 
| Paul Mundt | efd590d | 2010-01-20 15:08:36 +0900 | [diff] [blame] | 52 |  | 
 | 53 | void __iomem *sdk7786_fpga_base; | 
 | 54 |  | 
 | 55 | void __init sdk7786_fpga_init(void) | 
 | 56 | { | 
 | 57 | 	u16 version, date; | 
 | 58 |  | 
| Paul Mundt | d9116d0 | 2010-01-20 18:25:19 +0900 | [diff] [blame] | 59 | 	sdk7786_fpga_base = sdk7786_fpga_probe(); | 
| Paul Mundt | efd590d | 2010-01-20 15:08:36 +0900 | [diff] [blame] | 60 | 	if (unlikely(!sdk7786_fpga_base)) { | 
| Paul Mundt | d9116d0 | 2010-01-20 18:25:19 +0900 | [diff] [blame] | 61 | 		panic("FPGA detection failed.\n"); | 
| Paul Mundt | efd590d | 2010-01-20 15:08:36 +0900 | [diff] [blame] | 62 | 		return; | 
 | 63 | 	} | 
 | 64 |  | 
 | 65 | 	version = fpga_read_reg(FPGAVR); | 
 | 66 | 	date = fpga_read_reg(FPGADR); | 
 | 67 |  | 
 | 68 | 	pr_info("\tFPGA version:\t%d.%d (built on %d/%d/%d)\n", | 
 | 69 | 		bcd2bin(version >> 8) & 0xf, bcd2bin(version & 0xf), | 
 | 70 | 		((date >> 12) & 0xf) + 2000, | 
 | 71 | 		(date >> 8) & 0xf, bcd2bin(date & 0xff)); | 
 | 72 | } |