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); |