| Amit Kucheria | a329b48 | 2010-02-04 12:21:53 -0800 | [diff] [blame] | 1 | /* | 
| Dinh Nguyen | b66ff7a | 2010-11-15 11:30:00 -0600 | [diff] [blame] | 2 |  * Copyright 2008-2010 Freescale Semiconductor, Inc. All Rights Reserved. | 
| Amit Kucheria | a329b48 | 2010-02-04 12:21:53 -0800 | [diff] [blame] | 3 |  * | 
 | 4 |  * The code contained herein is licensed under the GNU General Public | 
 | 5 |  * License. You may obtain a copy of the GNU General Public License | 
 | 6 |  * Version 2 or later at the following locations: | 
 | 7 |  * | 
 | 8 |  * http://www.opensource.org/licenses/gpl-license.html | 
 | 9 |  * http://www.gnu.org/copyleft/gpl.html | 
 | 10 |  * | 
 | 11 |  * This file contains the CPU initialization code. | 
 | 12 |  */ | 
 | 13 |  | 
 | 14 | #include <linux/types.h> | 
 | 15 | #include <linux/kernel.h> | 
 | 16 | #include <linux/init.h> | 
| Sascha Hauer | 5443856 | 2010-03-19 10:50:55 +0100 | [diff] [blame] | 17 | #include <linux/module.h> | 
| Fabio Estevam | ca06679 | 2011-11-21 16:26:52 -0200 | [diff] [blame] | 18 | #include <linux/io.h> | 
| Amit Kucheria | a329b48 | 2010-02-04 12:21:53 -0800 | [diff] [blame] | 19 |  | 
| Shawn Guo | 50f2de6 | 2012-09-14 14:14:45 +0800 | [diff] [blame] | 20 | #include "hardware.h" | 
| Fabio Estevam | 2256779 | 2013-03-25 09:20:31 -0300 | [diff] [blame] | 21 | #include "common.h" | 
| Shawn Guo | 50f2de6 | 2012-09-14 14:14:45 +0800 | [diff] [blame] | 22 |  | 
| Jason Liu | c52c983 | 2011-08-26 13:35:23 +0800 | [diff] [blame] | 23 | static int mx5_cpu_rev = -1; | 
| Sascha Hauer | 5443856 | 2010-03-19 10:50:55 +0100 | [diff] [blame] | 24 |  | 
| Dinh Nguyen | 9ab4650 | 2010-11-15 11:30:01 -0600 | [diff] [blame] | 25 | #define IIM_SREV 0x24 | 
| Sascha Hauer | 5443856 | 2010-03-19 10:50:55 +0100 | [diff] [blame] | 26 |  | 
| Dinh Nguyen | 9ab4650 | 2010-11-15 11:30:01 -0600 | [diff] [blame] | 27 | static int get_mx51_srev(void) | 
| Sascha Hauer | 5443856 | 2010-03-19 10:50:55 +0100 | [diff] [blame] | 28 | { | 
| Dinh Nguyen | 9ab4650 | 2010-11-15 11:30:01 -0600 | [diff] [blame] | 29 | 	void __iomem *iim_base = MX51_IO_ADDRESS(MX51_IIM_BASE_ADDR); | 
 | 30 | 	u32 rev = readl(iim_base + IIM_SREV) & 0xff; | 
| Sascha Hauer | 5443856 | 2010-03-19 10:50:55 +0100 | [diff] [blame] | 31 |  | 
| Jason Liu | c52c983 | 2011-08-26 13:35:23 +0800 | [diff] [blame] | 32 | 	switch (rev) { | 
 | 33 | 	case 0x0: | 
| Dinh Nguyen | 9ab4650 | 2010-11-15 11:30:01 -0600 | [diff] [blame] | 34 | 		return IMX_CHIP_REVISION_2_0; | 
| Jason Liu | c52c983 | 2011-08-26 13:35:23 +0800 | [diff] [blame] | 35 | 	case 0x10: | 
| Dinh Nguyen | 9ab4650 | 2010-11-15 11:30:01 -0600 | [diff] [blame] | 36 | 		return IMX_CHIP_REVISION_3_0; | 
| Jason Liu | c52c983 | 2011-08-26 13:35:23 +0800 | [diff] [blame] | 37 | 	default: | 
 | 38 | 		return IMX_CHIP_REVISION_UNKNOWN; | 
 | 39 | 	} | 
| Sascha Hauer | 5443856 | 2010-03-19 10:50:55 +0100 | [diff] [blame] | 40 | } | 
 | 41 |  | 
 | 42 | /* | 
 | 43 |  * Returns: | 
 | 44 |  *	the silicon revision of the cpu | 
 | 45 |  *	-EINVAL - not a mx51 | 
 | 46 |  */ | 
 | 47 | int mx51_revision(void) | 
 | 48 | { | 
 | 49 | 	if (!cpu_is_mx51()) | 
 | 50 | 		return -EINVAL; | 
 | 51 |  | 
| Jason Liu | c52c983 | 2011-08-26 13:35:23 +0800 | [diff] [blame] | 52 | 	if (mx5_cpu_rev == -1) | 
 | 53 | 		mx5_cpu_rev = get_mx51_srev(); | 
| Sascha Hauer | 5443856 | 2010-03-19 10:50:55 +0100 | [diff] [blame] | 54 |  | 
| Jason Liu | c52c983 | 2011-08-26 13:35:23 +0800 | [diff] [blame] | 55 | 	return mx5_cpu_rev; | 
| Sascha Hauer | 5443856 | 2010-03-19 10:50:55 +0100 | [diff] [blame] | 56 | } | 
 | 57 | EXPORT_SYMBOL(mx51_revision); | 
 | 58 |  | 
| Amit Kucheria | 33d7c5c | 2010-09-01 22:49:13 +0300 | [diff] [blame] | 59 | #ifdef CONFIG_NEON | 
 | 60 |  | 
 | 61 | /* | 
 | 62 |  * All versions of the silicon before Rev. 3 have broken NEON implementations. | 
 | 63 |  * Dependent on link order - so the assumption is that vfp_init is called | 
 | 64 |  * before us. | 
 | 65 |  */ | 
| Shawn Guo | 8321b75 | 2012-04-26 11:42:34 +0800 | [diff] [blame] | 66 | int __init mx51_neon_fixup(void) | 
| Amit Kucheria | 33d7c5c | 2010-09-01 22:49:13 +0300 | [diff] [blame] | 67 | { | 
| Fabio Estevam | ca06679 | 2011-11-21 16:26:52 -0200 | [diff] [blame] | 68 | 	if (mx51_revision() < IMX_CHIP_REVISION_3_0 && | 
 | 69 | 			(elf_hwcap & HWCAP_NEON)) { | 
| Amit Kucheria | 33d7c5c | 2010-09-01 22:49:13 +0300 | [diff] [blame] | 70 | 		elf_hwcap &= ~HWCAP_NEON; | 
 | 71 | 		pr_info("Turning off NEON support, detected broken NEON implementation\n"); | 
 | 72 | 	} | 
 | 73 | 	return 0; | 
 | 74 | } | 
 | 75 |  | 
| Amit Kucheria | 33d7c5c | 2010-09-01 22:49:13 +0300 | [diff] [blame] | 76 | #endif | 
 | 77 |  | 
| Dinh Nguyen | 9ab4650 | 2010-11-15 11:30:01 -0600 | [diff] [blame] | 78 | static int get_mx53_srev(void) | 
 | 79 | { | 
 | 80 | 	void __iomem *iim_base = MX51_IO_ADDRESS(MX53_IIM_BASE_ADDR); | 
 | 81 | 	u32 rev = readl(iim_base + IIM_SREV) & 0xff; | 
 | 82 |  | 
| Richard Zhao | 503e163 | 2011-02-18 20:26:30 +0800 | [diff] [blame] | 83 | 	switch (rev) { | 
 | 84 | 	case 0x0: | 
| Dinh Nguyen | 9ab4650 | 2010-11-15 11:30:01 -0600 | [diff] [blame] | 85 | 		return IMX_CHIP_REVISION_1_0; | 
| Richard Zhao | 503e163 | 2011-02-18 20:26:30 +0800 | [diff] [blame] | 86 | 	case 0x2: | 
| Dinh Nguyen | 9ab4650 | 2010-11-15 11:30:01 -0600 | [diff] [blame] | 87 | 		return IMX_CHIP_REVISION_2_0; | 
| Richard Zhao | 503e163 | 2011-02-18 20:26:30 +0800 | [diff] [blame] | 88 | 	case 0x3: | 
 | 89 | 		return IMX_CHIP_REVISION_2_1; | 
 | 90 | 	default: | 
 | 91 | 		return IMX_CHIP_REVISION_UNKNOWN; | 
 | 92 | 	} | 
| Dinh Nguyen | 9ab4650 | 2010-11-15 11:30:01 -0600 | [diff] [blame] | 93 | } | 
 | 94 |  | 
| Dinh Nguyen | b66ff7a | 2010-11-15 11:30:00 -0600 | [diff] [blame] | 95 | /* | 
 | 96 |  * Returns: | 
 | 97 |  *	the silicon revision of the cpu | 
 | 98 |  *	-EINVAL - not a mx53 | 
 | 99 |  */ | 
 | 100 | int mx53_revision(void) | 
 | 101 | { | 
 | 102 | 	if (!cpu_is_mx53()) | 
 | 103 | 		return -EINVAL; | 
 | 104 |  | 
| Jason Liu | c52c983 | 2011-08-26 13:35:23 +0800 | [diff] [blame] | 105 | 	if (mx5_cpu_rev == -1) | 
 | 106 | 		mx5_cpu_rev = get_mx53_srev(); | 
| Dinh Nguyen | b66ff7a | 2010-11-15 11:30:00 -0600 | [diff] [blame] | 107 |  | 
| Jason Liu | c52c983 | 2011-08-26 13:35:23 +0800 | [diff] [blame] | 108 | 	return mx5_cpu_rev; | 
| Dinh Nguyen | b66ff7a | 2010-11-15 11:30:00 -0600 | [diff] [blame] | 109 | } | 
 | 110 | EXPORT_SYMBOL(mx53_revision); |