1 #include <linux/err.h> 2 #include <linux/module.h> 3 #include <linux/io.h> 4 #include <linux/of.h> 5 #include <linux/of_address.h> 6 #include <linux/slab.h> 7 #include <linux/sys_soc.h> 8 9 #include "hardware.h" 10 #include "common.h" 11 12 unsigned int __mxc_cpu_type; 13 EXPORT_SYMBOL(__mxc_cpu_type); 14 15 static unsigned int imx_soc_revision; 16 17 void mxc_set_cpu_type(unsigned int type) 18 { 19 __mxc_cpu_type = type; 20 } 21 22 void imx_set_soc_revision(unsigned int rev) 23 { 24 imx_soc_revision = rev; 25 } 26 27 unsigned int imx_get_soc_revision(void) 28 { 29 return imx_soc_revision; 30 } 31 32 void imx_print_silicon_rev(const char *cpu, int srev) 33 { 34 if (srev == IMX_CHIP_REVISION_UNKNOWN) 35 pr_info("CPU identified as %s, unknown revision\n", cpu); 36 else 37 pr_info("CPU identified as %s, silicon rev %d.%d\n", 38 cpu, (srev >> 4) & 0xf, srev & 0xf); 39 } 40 41 void __init imx_set_aips(void __iomem *base) 42 { 43 unsigned int reg; 44 /* 45 * Set all MPROTx to be non-bufferable, trusted for R/W, 46 * not forced to user-mode. 47 */ 48 __raw_writel(0x77777777, base + 0x0); 49 __raw_writel(0x77777777, base + 0x4); 50 51 /* 52 * Set all OPACRx to be non-bufferable, to not require 53 * supervisor privilege level for access, allow for 54 * write access and untrusted master access. 55 */ 56 __raw_writel(0x0, base + 0x40); 57 __raw_writel(0x0, base + 0x44); 58 __raw_writel(0x0, base + 0x48); 59 __raw_writel(0x0, base + 0x4C); 60 reg = __raw_readl(base + 0x50) & 0x00FFFFFF; 61 __raw_writel(reg, base + 0x50); 62 } 63 64 void __init imx_aips_allow_unprivileged_access( 65 const char *compat) 66 { 67 void __iomem *aips_base_addr; 68 struct device_node *np; 69 70 for_each_compatible_node(np, NULL, compat) { 71 aips_base_addr = of_iomap(np, 0); 72 imx_set_aips(aips_base_addr); 73 } 74 } 75 76 struct device * __init imx_soc_device_init(void) 77 { 78 struct soc_device_attribute *soc_dev_attr; 79 struct soc_device *soc_dev; 80 struct device_node *root; 81 const char *soc_id; 82 int ret; 83 84 soc_dev_attr = kzalloc(sizeof(*soc_dev_attr), GFP_KERNEL); 85 if (!soc_dev_attr) 86 return NULL; 87 88 soc_dev_attr->family = "Freescale i.MX"; 89 90 root = of_find_node_by_path("/"); 91 ret = of_property_read_string(root, "model", &soc_dev_attr->machine); 92 of_node_put(root); 93 if (ret) 94 goto free_soc; 95 96 switch (__mxc_cpu_type) { 97 case MXC_CPU_MX1: 98 soc_id = "i.MX1"; 99 break; 100 case MXC_CPU_MX21: 101 soc_id = "i.MX21"; 102 break; 103 case MXC_CPU_MX25: 104 soc_id = "i.MX25"; 105 break; 106 case MXC_CPU_MX27: 107 soc_id = "i.MX27"; 108 break; 109 case MXC_CPU_MX31: 110 soc_id = "i.MX31"; 111 break; 112 case MXC_CPU_MX35: 113 soc_id = "i.MX35"; 114 break; 115 case MXC_CPU_MX51: 116 soc_id = "i.MX51"; 117 break; 118 case MXC_CPU_MX53: 119 soc_id = "i.MX53"; 120 break; 121 case MXC_CPU_IMX6SL: 122 soc_id = "i.MX6SL"; 123 break; 124 case MXC_CPU_IMX6DL: 125 soc_id = "i.MX6DL"; 126 break; 127 case MXC_CPU_IMX6SX: 128 soc_id = "i.MX6SX"; 129 break; 130 case MXC_CPU_IMX6Q: 131 soc_id = "i.MX6Q"; 132 break; 133 case MXC_CPU_IMX7D: 134 soc_id = "i.MX7D"; 135 break; 136 default: 137 soc_id = "Unknown"; 138 } 139 soc_dev_attr->soc_id = soc_id; 140 141 soc_dev_attr->revision = kasprintf(GFP_KERNEL, "%d.%d", 142 (imx_soc_revision >> 4) & 0xf, 143 imx_soc_revision & 0xf); 144 if (!soc_dev_attr->revision) 145 goto free_soc; 146 147 soc_dev = soc_device_register(soc_dev_attr); 148 if (IS_ERR(soc_dev)) 149 goto free_rev; 150 151 return soc_device_to_device(soc_dev); 152 153 free_rev: 154 kfree(soc_dev_attr->revision); 155 free_soc: 156 kfree(soc_dev_attr); 157 return NULL; 158 } 159