1 /* 2 * Copyright 2013 Freescale Semiconductor, Inc. 3 * 4 * This program is free software; you can redistribute it and/or modify 5 * it under the terms of the GNU General Public License version 2 as 6 * published by the Free Software Foundation. 7 * 8 */ 9 10 #include <linux/irqchip.h> 11 #include <linux/of.h> 12 #include <linux/of_platform.h> 13 #include <linux/mfd/syscon.h> 14 #include <linux/mfd/syscon/imx6q-iomuxc-gpr.h> 15 #include <linux/regmap.h> 16 #include <asm/mach/arch.h> 17 #include <asm/mach/map.h> 18 19 #include "common.h" 20 21 static void __init imx6sl_fec_init(void) 22 { 23 struct regmap *gpr; 24 25 /* set FEC clock from internal PLL clock source */ 26 gpr = syscon_regmap_lookup_by_compatible("fsl,imx6sl-iomuxc-gpr"); 27 if (!IS_ERR(gpr)) { 28 regmap_update_bits(gpr, IOMUXC_GPR1, 29 IMX6SL_GPR1_FEC_CLOCK_MUX2_SEL_MASK, 0); 30 regmap_update_bits(gpr, IOMUXC_GPR1, 31 IMX6SL_GPR1_FEC_CLOCK_MUX1_SEL_MASK, 0); 32 } else { 33 pr_err("failed to find fsl,imx6sl-iomux-gpr regmap\n"); 34 } 35 } 36 37 static void __init imx6sl_init_late(void) 38 { 39 /* imx6sl reuses imx6q cpufreq driver */ 40 if (IS_ENABLED(CONFIG_ARM_IMX6Q_CPUFREQ)) 41 platform_device_register_simple("imx6q-cpufreq", -1, NULL, 0); 42 } 43 44 static void __init imx6sl_init_machine(void) 45 { 46 struct device *parent; 47 48 mxc_arch_reset_init_dt(); 49 50 parent = imx_soc_device_init(); 51 if (parent == NULL) 52 pr_warn("failed to initialize soc device\n"); 53 54 of_platform_populate(NULL, of_default_bus_match_table, NULL, parent); 55 56 imx6sl_fec_init(); 57 imx_anatop_init(); 58 /* Reuse imx6q pm code */ 59 imx6q_pm_init(); 60 } 61 62 static void __init imx6sl_init_irq(void) 63 { 64 imx_init_revision_from_anatop(); 65 imx_init_l2cache(); 66 imx_src_init(); 67 imx_gpc_init(); 68 irqchip_init(); 69 } 70 71 static const char *imx6sl_dt_compat[] __initconst = { 72 "fsl,imx6sl", 73 NULL, 74 }; 75 76 DT_MACHINE_START(IMX6SL, "Freescale i.MX6 SoloLite (Device Tree)") 77 .map_io = debug_ll_io_init, 78 .init_irq = imx6sl_init_irq, 79 .init_machine = imx6sl_init_machine, 80 .init_late = imx6sl_init_late, 81 .dt_compat = imx6sl_dt_compat, 82 .restart = mxc_restart, 83 MACHINE_END 84