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