[deliverable/linux.git] / arch / arm / mach-mxs / mach-mxs.c

/*
 * Copyright 2012 Freescale Semiconductor, Inc.
 * Copyright 2012 Linaro Ltd.
 *
 * The code contained herein is licensed under the GNU General Public
 * License. You may obtain a copy of the GNU General Public License
 * Version 2 or later at the following locations:
 *
 * http://www.opensource.org/licenses/gpl-license.html
 * http://www.gnu.org/copyleft/gpl.html
 */

#include <linux/clk.h>
#include <linux/clk/mxs.h>
#include <linux/clkdev.h>
#include <linux/delay.h>
#include <linux/err.h>
#include <linux/gpio.h>
#include <linux/init.h>
#include <linux/irqchip/mxs.h>
#include <linux/reboot.h>
#include <linux/micrel_phy.h>
#include <linux/of_address.h>
#include <linux/of_platform.h>
#include <linux/phy.h>
#include <linux/pinctrl/consumer.h>
#include <linux/sys_soc.h>
#include <asm/mach/arch.h>
#include <asm/mach/map.h>
#include <asm/mach/time.h>
#include <asm/system_misc.h>

#include "pm.h"

/* MXS DIGCTL SAIF CLKMUX */
#define MXS_DIGCTL_SAIF_CLKMUX_DIRECT		0x0
#define MXS_DIGCTL_SAIF_CLKMUX_CROSSINPUT	0x1
#define MXS_DIGCTL_SAIF_CLKMUX_EXTMSTR0		0x2
#define MXS_DIGCTL_SAIF_CLKMUX_EXTMSTR1		0x3

#define HW_DIGCTL_CHIPID	0x310
#define HW_DIGCTL_CHIPID_MASK	(0xffff << 16)
#define HW_DIGCTL_REV_MASK	0xff
#define HW_DIGCTL_CHIPID_MX23	(0x3780 << 16)
#define HW_DIGCTL_CHIPID_MX28	(0x2800 << 16)

#define MXS_CHIP_REVISION_1_0	0x10
#define MXS_CHIP_REVISION_1_1	0x11
#define MXS_CHIP_REVISION_1_2	0x12
#define MXS_CHIP_REVISION_1_3	0x13
#define MXS_CHIP_REVISION_1_4	0x14
#define MXS_CHIP_REV_UNKNOWN	0xff

#define MXS_GPIO_NR(bank, nr)	((bank) * 32 + (nr))

#define MXS_SET_ADDR		0x4
#define MXS_CLR_ADDR		0x8
#define MXS_TOG_ADDR		0xc

static u32 chipid;
static u32 socid;

static void __iomem *reset_addr;

static inline void __mxs_setl(u32 mask, void __iomem *reg)
{
	__raw_writel(mask, reg + MXS_SET_ADDR);
}

static inline void __mxs_clrl(u32 mask, void __iomem *reg)
{
	__raw_writel(mask, reg + MXS_CLR_ADDR);
}

static inline void __mxs_togl(u32 mask, void __iomem *reg)
{
	__raw_writel(mask, reg + MXS_TOG_ADDR);
}

#define OCOTP_WORD_OFFSET		0x20
#define OCOTP_WORD_COUNT		0x20

#define BM_OCOTP_CTRL_BUSY		(1 << 8)
#define BM_OCOTP_CTRL_ERROR		(1 << 9)
#define BM_OCOTP_CTRL_RD_BANK_OPEN	(1 << 12)

static DEFINE_MUTEX(ocotp_mutex);
static u32 ocotp_words[OCOTP_WORD_COUNT];

static const u32 *mxs_get_ocotp(void)
{
	struct device_node *np;
	void __iomem *ocotp_base;
	int timeout = 0x400;
	size_t i;
	static int once;

	if (once)
		return ocotp_words;

	np = of_find_compatible_node(NULL, NULL, "fsl,ocotp");
	ocotp_base = of_iomap(np, 0);
	WARN_ON(!ocotp_base);

	mutex_lock(&ocotp_mutex);

	/*
	 * clk_enable(hbus_clk) for ocotp can be skipped
	 * as it must be on when system is running.
	 */

	/* try to clear ERROR bit */
	__mxs_clrl(BM_OCOTP_CTRL_ERROR, ocotp_base);

	/* check both BUSY and ERROR cleared */
	while ((__raw_readl(ocotp_base) &
		(BM_OCOTP_CTRL_BUSY | BM_OCOTP_CTRL_ERROR)) && --timeout)
		cpu_relax();

	if (unlikely(!timeout))
		goto error_unlock;

	/* open OCOTP banks for read */
	__mxs_setl(BM_OCOTP_CTRL_RD_BANK_OPEN, ocotp_base);

	/* approximately wait 32 hclk cycles */
	udelay(1);

	/* poll BUSY bit becoming cleared */
	timeout = 0x400;
	while ((__raw_readl(ocotp_base) & BM_OCOTP_CTRL_BUSY) && --timeout)
		cpu_relax();

	if (unlikely(!timeout))
		goto error_unlock;

	for (i = 0; i < OCOTP_WORD_COUNT; i++)
		ocotp_words[i] = __raw_readl(ocotp_base + OCOTP_WORD_OFFSET +
						i * 0x10);

	/* close banks for power saving */
	__mxs_clrl(BM_OCOTP_CTRL_RD_BANK_OPEN, ocotp_base);

	once = 1;

	mutex_unlock(&ocotp_mutex);

	return ocotp_words;

error_unlock:
	mutex_unlock(&ocotp_mutex);
	pr_err("%s: timeout in reading OCOTP\n", __func__);
	return NULL;
}

enum mac_oui {
	OUI_FSL,
	OUI_DENX,
	OUI_CRYSTALFONTZ,
	OUI_I2SE,
	OUI_ARMADEUS,
};

static void __init update_fec_mac_prop(enum mac_oui oui)
{
	struct device_node *np, *from = NULL;
	struct property *newmac;
	const u32 *ocotp = mxs_get_ocotp();
	u8 *macaddr;
	u32 val;
	int i;

	for (i = 0; i < 2; i++) {
		np = of_find_compatible_node(from, NULL, "fsl,imx28-fec");
		if (!np)
			return;

		from = np;

		if (of_get_property(np, "local-mac-address", NULL))
			continue;

		newmac = kzalloc(sizeof(*newmac) + 6, GFP_KERNEL);
		if (!newmac)
			return;
		newmac->value = newmac + 1;
		newmac->length = 6;

		newmac->name = kstrdup("local-mac-address", GFP_KERNEL);
		if (!newmac->name) {
			kfree(newmac);
			return;
		}

		/*
		 * OCOTP only stores the last 4 octets for each mac address,
		 * so hard-code OUI here.
		 */
		macaddr = newmac->value;
		switch (oui) {
		case OUI_FSL:
			macaddr[0] = 0x00;
			macaddr[1] = 0x04;
			macaddr[2] = 0x9f;
			break;
		case OUI_DENX:
			macaddr[0] = 0xc0;
			macaddr[1] = 0xe5;
			macaddr[2] = 0x4e;
			break;
		case OUI_CRYSTALFONTZ:
			macaddr[0] = 0x58;
			macaddr[1] = 0xb9;
			macaddr[2] = 0xe1;
			break;
		case OUI_I2SE:
			macaddr[0] = 0x00;
			macaddr[1] = 0x01;
			macaddr[2] = 0x87;
			break;
		case OUI_ARMADEUS:
			macaddr[0] = 0x00;
			macaddr[1] = 0x1e;
			macaddr[2] = 0xac;
			break;
		}
		val = ocotp[i];
		macaddr[3] = (val >> 16) & 0xff;
		macaddr[4] = (val >> 8) & 0xff;
		macaddr[5] = (val >> 0) & 0xff;

		of_update_property(np, newmac);
	}
}

static inline void enable_clk_enet_out(void)
{
	struct clk *clk = clk_get_sys("enet_out", NULL);

	if (!IS_ERR(clk))
		clk_prepare_enable(clk);
}

static void __init imx28_evk_init(void)
{
	update_fec_mac_prop(OUI_FSL);

	mxs_saif_clkmux_select(MXS_DIGCTL_SAIF_CLKMUX_EXTMSTR0);
}

static void __init imx28_apf28_init(void)
{
	update_fec_mac_prop(OUI_ARMADEUS);
}

static int apx4devkit_phy_fixup(struct phy_device *phy)
{
	phy->dev_flags |= MICREL_PHY_50MHZ_CLK;
	return 0;
}

static void __init apx4devkit_init(void)
{
	enable_clk_enet_out();

	if (IS_BUILTIN(CONFIG_PHYLIB))
		phy_register_fixup_for_uid(PHY_ID_KSZ8051, MICREL_PHY_ID_MASK,
					   apx4devkit_phy_fixup);
}

static void __init crystalfontz_init(void)
{
	update_fec_mac_prop(OUI_CRYSTALFONTZ);
}

static void __init duckbill_init(void)
{
	update_fec_mac_prop(OUI_I2SE);
}

static void __init m28cu3_init(void)
{
	update_fec_mac_prop(OUI_DENX);
}

static const char __init *mxs_get_soc_id(void)
{
	struct device_node *np;
	void __iomem *digctl_base;

	np = of_find_compatible_node(NULL, NULL, "fsl,imx23-digctl");
	digctl_base = of_iomap(np, 0);
	WARN_ON(!digctl_base);

	chipid = readl(digctl_base + HW_DIGCTL_CHIPID);
	socid = chipid & HW_DIGCTL_CHIPID_MASK;

	iounmap(digctl_base);
	of_node_put(np);

	switch (socid) {
	case HW_DIGCTL_CHIPID_MX23:
		return "i.MX23";
	case HW_DIGCTL_CHIPID_MX28:
		return "i.MX28";
	default:
		return "Unknown";
	}
}

static u32 __init mxs_get_cpu_rev(void)
{
	u32 rev = chipid & HW_DIGCTL_REV_MASK;

	switch (socid) {
	case HW_DIGCTL_CHIPID_MX23:
		switch (rev) {
		case 0x0:
			return MXS_CHIP_REVISION_1_0;
		case 0x1:
			return MXS_CHIP_REVISION_1_1;
		case 0x2:
			return MXS_CHIP_REVISION_1_2;
		case 0x3:
			return MXS_CHIP_REVISION_1_3;
		case 0x4:
			return MXS_CHIP_REVISION_1_4;
		default:
			return MXS_CHIP_REV_UNKNOWN;
		}
	case HW_DIGCTL_CHIPID_MX28:
		switch (rev) {
		case 0x0:
			return MXS_CHIP_REVISION_1_1;
		case 0x1:
			return MXS_CHIP_REVISION_1_2;
		default:
			return MXS_CHIP_REV_UNKNOWN;
		}
	default:
		return MXS_CHIP_REV_UNKNOWN;
	}
}

static const char __init *mxs_get_revision(void)
{
	u32 rev = mxs_get_cpu_rev();

	if (rev != MXS_CHIP_REV_UNKNOWN)
		return kasprintf(GFP_KERNEL, "%d.%d", (rev >> 4) & 0xf,
				rev & 0xf);
	else
		return kasprintf(GFP_KERNEL, "%s", "Unknown");
}

#define MX23_CLKCTRL_RESET_OFFSET	0x120
#define MX28_CLKCTRL_RESET_OFFSET	0x1e0

static int __init mxs_restart_init(void)
{
	struct device_node *np;

	np = of_find_compatible_node(NULL, NULL, "fsl,clkctrl");
	reset_addr = of_iomap(np, 0);
	if (!reset_addr)
		return -ENODEV;

	if (of_device_is_compatible(np, "fsl,imx23-clkctrl"))
		reset_addr += MX23_CLKCTRL_RESET_OFFSET;
	else
		reset_addr += MX28_CLKCTRL_RESET_OFFSET;
	of_node_put(np);

	return 0;
}

static void __init eukrea_mbmx283lc_init(void)
{
	mxs_saif_clkmux_select(MXS_DIGCTL_SAIF_CLKMUX_EXTMSTR0);
}

static void __init mxs_machine_init(void)
{
	struct device_node *root;
	struct device *parent;
	struct soc_device *soc_dev;
	struct soc_device_attribute *soc_dev_attr;
	int ret;

	soc_dev_attr = kzalloc(sizeof(*soc_dev_attr), GFP_KERNEL);
	if (!soc_dev_attr)
		return;

	root = of_find_node_by_path("/");
	ret = of_property_read_string(root, "model", &soc_dev_attr->machine);
	if (ret)
		return;

	soc_dev_attr->family = "Freescale MXS Family";
	soc_dev_attr->soc_id = mxs_get_soc_id();
	soc_dev_attr->revision = mxs_get_revision();

	soc_dev = soc_device_register(soc_dev_attr);
	if (IS_ERR(soc_dev)) {
		kfree(soc_dev_attr->revision);
		kfree(soc_dev_attr);
		return;
	}

	parent = soc_device_to_device(soc_dev);

	if (of_machine_is_compatible("fsl,imx28-evk"))
		imx28_evk_init();
	if (of_machine_is_compatible("armadeus,imx28-apf28"))
		imx28_apf28_init();
	else if (of_machine_is_compatible("bluegiga,apx4devkit"))
		apx4devkit_init();
	else if (of_machine_is_compatible("crystalfontz,cfa10036"))
		crystalfontz_init();
	else if (of_machine_is_compatible("eukrea,mbmx283lc"))
		eukrea_mbmx283lc_init();
	else if (of_machine_is_compatible("i2se,duckbill"))
		duckbill_init();
	else if (of_machine_is_compatible("msr,m28cu3"))
		m28cu3_init();

	of_platform_default_populate(NULL, NULL, parent);

	mxs_restart_init();
}

#define MXS_CLKCTRL_RESET_CHIP		(1 << 1)

/*
 * Reset the system. It is called by machine_restart().
 */
static void mxs_restart(enum reboot_mode mode, const char *cmd)
{
	if (reset_addr) {
		/* reset the chip */
		__mxs_setl(MXS_CLKCTRL_RESET_CHIP, reset_addr);

		pr_err("Failed to assert the chip reset\n");

		/* Delay to allow the serial port to show the message */
		mdelay(50);
	}

	/* We'll take a jump through zero as a poor second */
	soft_restart(0);
}

static const char *const mxs_dt_compat[] __initconst = {
	"fsl,imx28",
	"fsl,imx23",
	NULL,
};

DT_MACHINE_START(MXS, "Freescale MXS (Device Tree)")
	.handle_irq	= icoll_handle_irq,
	.init_machine	= mxs_machine_init,
	.init_late      = mxs_pm_init,
	.dt_compat	= mxs_dt_compat,
	.restart	= mxs_restart,
MACHINE_END
Commit	Line	Data
bc3a59c1 DA	1	/*
	2	* Copyright 2012 Freescale Semiconductor, Inc.
	3	* Copyright 2012 Linaro Ltd.
	4	*
	5	* The code contained herein is licensed under the GNU General Public
	6	* License. You may obtain a copy of the GNU General Public License
	7	* Version 2 or later at the following locations:
	8	*
	9	* http://www.opensource.org/licenses/gpl-license.html
	10	* http://www.gnu.org/copyleft/gpl.html
	11	*/
	12
	13	#include <linux/clk.h>
3cb7825b	14	#include <linux/clk/mxs.h>
bc3a59c1	15	#include <linux/clkdev.h>
2c7c2c1d	16	#include <linux/delay.h>
bc3a59c1	17	#include <linux/err.h>
2c7c2c1d	18	#include <linux/gpio.h>
bc3a59c1	19	#include <linux/init.h>
6a8e95b0	20	#include <linux/irqchip/mxs.h>
7b6d864b	21	#include <linux/reboot.h>
3143bbb4	22	#include <linux/micrel_phy.h>
974a9af5	23	#include <linux/of_address.h>
bc3a59c1	24	#include <linux/of_platform.h>
3143bbb4	25	#include <linux/phy.h>
2c7c2c1d	26	#include <linux/pinctrl/consumer.h>
2046338d	27	#include <linux/sys_soc.h>
bc3a59c1	28	#include <asm/mach/arch.h>
1f629564	29	#include <asm/mach/map.h>
bc3a59c1	30	#include <asm/mach/time.h>
974a9af5	31	#include <asm/system_misc.h>
0b48d3a6	32
45680995 SG	33	#include "pm.h"
45680995 SG	34
0b48d3a6 SG	35	/* MXS DIGCTL SAIF CLKMUX */
	36	#define MXS_DIGCTL_SAIF_CLKMUX_DIRECT 0x0
	37	#define MXS_DIGCTL_SAIF_CLKMUX_CROSSINPUT 0x1
	38	#define MXS_DIGCTL_SAIF_CLKMUX_EXTMSTR0 0x2
	39	#define MXS_DIGCTL_SAIF_CLKMUX_EXTMSTR1 0x3
	40
2046338d FE	41	#define HW_DIGCTL_CHIPID 0x310
	42	#define HW_DIGCTL_CHIPID_MASK (0xffff << 16)
	43	#define HW_DIGCTL_REV_MASK 0xff
	44	#define HW_DIGCTL_CHIPID_MX23 (0x3780 << 16)
	45	#define HW_DIGCTL_CHIPID_MX28 (0x2800 << 16)
	46
	47	#define MXS_CHIP_REVISION_1_0 0x10
	48	#define MXS_CHIP_REVISION_1_1 0x11
	49	#define MXS_CHIP_REVISION_1_2 0x12
	50	#define MXS_CHIP_REVISION_1_3 0x13
	51	#define MXS_CHIP_REVISION_1_4 0x14
	52	#define MXS_CHIP_REV_UNKNOWN 0xff
	53
0b48d3a6 SG	54	#define MXS_GPIO_NR(bank, nr) ((bank) * 32 + (nr))
	55
	56	#define MXS_SET_ADDR 0x4
	57	#define MXS_CLR_ADDR 0x8
	58	#define MXS_TOG_ADDR 0xc
	59
2046338d FE	60	static u32 chipid;
	61	static u32 socid;
	62
56b7eec0 LW	63	static void __iomem *reset_addr;
56b7eec0 LW	64
0b48d3a6 SG	65	static inline void __mxs_setl(u32 mask, void __iomem *reg)
	66	{
	67	__raw_writel(mask, reg + MXS_SET_ADDR);
	68	}
	69
	70	static inline void __mxs_clrl(u32 mask, void __iomem *reg)
	71	{
	72	__raw_writel(mask, reg + MXS_CLR_ADDR);
	73	}
	74
	75	static inline void __mxs_togl(u32 mask, void __iomem *reg)
	76	{
	77	__raw_writel(mask, reg + MXS_TOG_ADDR);
	78	}
bc3a59c1	79
1bff2d76 SG	80	#define OCOTP_WORD_OFFSET 0x20
	81	#define OCOTP_WORD_COUNT 0x20
	82
	83	#define BM_OCOTP_CTRL_BUSY (1 << 8)
	84	#define BM_OCOTP_CTRL_ERROR (1 << 9)
	85	#define BM_OCOTP_CTRL_RD_BANK_OPEN (1 << 12)
	86
	87	static DEFINE_MUTEX(ocotp_mutex);
	88	static u32 ocotp_words[OCOTP_WORD_COUNT];
	89
	90	static const u32 *mxs_get_ocotp(void)
	91	{
	92	struct device_node *np;
	93	void __iomem *ocotp_base;
	94	int timeout = 0x400;
	95	size_t i;
	96	static int once;
	97
	98	if (once)
	99	return ocotp_words;
	100
	101	np = of_find_compatible_node(NULL, NULL, "fsl,ocotp");
	102	ocotp_base = of_iomap(np, 0);
	103	WARN_ON(!ocotp_base);
	104
	105	mutex_lock(&ocotp_mutex);
	106
	107	/*
	108	* clk_enable(hbus_clk) for ocotp can be skipped
	109	* as it must be on when system is running.
	110	*/
	111
	112	/* try to clear ERROR bit */
	113	__mxs_clrl(BM_OCOTP_CTRL_ERROR, ocotp_base);
	114
	115	/* check both BUSY and ERROR cleared */
	116	while ((__raw_readl(ocotp_base) &
	117	(BM_OCOTP_CTRL_BUSY \| BM_OCOTP_CTRL_ERROR)) && --timeout)
	118	cpu_relax();
	119
	120	if (unlikely(!timeout))
	121	goto error_unlock;
	122
	123	/* open OCOTP banks for read */
	124	__mxs_setl(BM_OCOTP_CTRL_RD_BANK_OPEN, ocotp_base);
	125
	126	/* approximately wait 32 hclk cycles */
	127	udelay(1);
	128
	129	/* poll BUSY bit becoming cleared */
	130	timeout = 0x400;
	131	while ((__raw_readl(ocotp_base) & BM_OCOTP_CTRL_BUSY) && --timeout)
	132	cpu_relax();
	133
	134	if (unlikely(!timeout))
	135	goto error_unlock;
	136
	137	for (i = 0; i < OCOTP_WORD_COUNT; i++)
	138	ocotp_words[i] = __raw_readl(ocotp_base + OCOTP_WORD_OFFSET +
	139	i * 0x10);
	140
	141	/* close banks for power saving */
	142	__mxs_clrl(BM_OCOTP_CTRL_RD_BANK_OPEN, ocotp_base);
	143
144	once = 1;
145
146	mutex_unlock(&ocotp_mutex);
147
148	return ocotp_words;
149
150	error_unlock:
151	mutex_unlock(&ocotp_mutex);
152	pr_err("%s: timeout in reading OCOTP\n", __func__);
153	return NULL;
154	}
155
5653acc2 SG	156	enum mac_oui {
	157	OUI_FSL,
	158	OUI_DENX,
8eec4b31	159	OUI_CRYSTALFONTZ,
df0355f2	160	OUI_I2SE,
9648b2ef	161	OUI_ARMADEUS,
5653acc2 SG	162	};
	163
	164	static void __init update_fec_mac_prop(enum mac_oui oui)
	165	{
	166	struct device_node np, from = NULL;
fa7c865a	167	struct property *newmac;
5653acc2 SG	168	const u32 *ocotp = mxs_get_ocotp();
	169	u8 *macaddr;
	170	u32 val;
	171	int i;
	172
	173	for (i = 0; i < 2; i++) {
	174	np = of_find_compatible_node(from, NULL, "fsl,imx28-fec");
	175	if (!np)
	176	return;
16d47701	177
5653acc2 SG	178	from = np;
5653acc2 SG	179
16d47701 MV	180	if (of_get_property(np, "local-mac-address", NULL))
	181	continue;
	182
5653acc2 SG	183	newmac = kzalloc(sizeof(*newmac) + 6, GFP_KERNEL);
	184	if (!newmac)
	185	return;
	186	newmac->value = newmac + 1;
	187	newmac->length = 6;
	188
	189	newmac->name = kstrdup("local-mac-address", GFP_KERNEL);
	190	if (!newmac->name) {
	191	kfree(newmac);
	192	return;
	193	}
	194
	195	/*
	196	* OCOTP only stores the last 4 octets for each mac address,
	197	* so hard-code OUI here.
	198	*/
	199	macaddr = newmac->value;
	200	switch (oui) {
	201	case OUI_FSL:
	202	macaddr[0] = 0x00;
	203	macaddr[1] = 0x04;
	204	macaddr[2] = 0x9f;
	205	break;
	206	case OUI_DENX:
	207	macaddr[0] = 0xc0;
	208	macaddr[1] = 0xe5;
	209	macaddr[2] = 0x4e;
	210	break;
8eec4b31 MR	211	case OUI_CRYSTALFONTZ:
	212	macaddr[0] = 0x58;
	213	macaddr[1] = 0xb9;
	214	macaddr[2] = 0xe1;
	215	break;
df0355f2 MH	216	case OUI_I2SE:
	217	macaddr[0] = 0x00;
	218	macaddr[1] = 0x01;
	219	macaddr[2] = 0x87;
	220	break;
9648b2ef GGM	221	case OUI_ARMADEUS:
	222	macaddr[0] = 0x00;
	223	macaddr[1] = 0x1e;
	224	macaddr[2] = 0xac;
	225	break;
5653acc2 SG	226	}
	227	val = ocotp[i];
	228	macaddr[3] = (val >> 16) & 0xff;
	229	macaddr[4] = (val >> 8) & 0xff;
	230	macaddr[5] = (val >> 0) & 0xff;
	231
79d1c712	232	of_update_property(np, newmac);
5653acc2 SG	233	}
	234	}
	235
8fa62e11	236	static inline void enable_clk_enet_out(void)
bc3a59c1	237	{
8fa62e11	238	struct clk *clk = clk_get_sys("enet_out", NULL);
bc3a59c1	239
bc3a59c1 DA	240	if (!IS_ERR(clk))
bc3a59c1 DA	241	clk_prepare_enable(clk);
8fa62e11	242	}
5653acc2	243
8fa62e11 MV	244	static void __init imx28_evk_init(void)
8fa62e11 MV	245	{
5653acc2	246	update_fec_mac_prop(OUI_FSL);
ab2815c3	247
e317317a	248	mxs_saif_clkmux_select(MXS_DIGCTL_SAIF_CLKMUX_EXTMSTR0);
bc3a59c1 DA	249	}
bc3a59c1 DA	250
9648b2ef GGM	251	static void __init imx28_apf28_init(void)
	252	{
	253	update_fec_mac_prop(OUI_ARMADEUS);
	254	}
	255
3143bbb4 SG	256	static int apx4devkit_phy_fixup(struct phy_device *phy)
	257	{
	258	phy->dev_flags \|= MICREL_PHY_50MHZ_CLK;
	259	return 0;
	260	}
	261
	262	static void __init apx4devkit_init(void)
	263	{
	264	enable_clk_enet_out();
	265
	266	if (IS_BUILTIN(CONFIG_PHYLIB))
510d573f	267	phy_register_fixup_for_uid(PHY_ID_KSZ8051, MICREL_PHY_ID_MASK,
3143bbb4 SG	268	apx4devkit_phy_fixup);
	269	}
	270
ed138c36	271	static void __init crystalfontz_init(void)
8eec4b31	272	{
8eec4b31 MR	273	update_fec_mac_prop(OUI_CRYSTALFONTZ);
	274	}
	275
df0355f2 MH	276	static void __init duckbill_init(void)
	277	{
	278	update_fec_mac_prop(OUI_I2SE);
	279	}
	280
e0ec2f39 MV	281	static void __init m28cu3_init(void)
	282	{
	283	update_fec_mac_prop(OUI_DENX);
	284	}
	285
2046338d	286	static const char __init *mxs_get_soc_id(void)
e0f7d905	287	{
2046338d FE	288	struct device_node *np;
	289	void __iomem *digctl_base;
	290
	291	np = of_find_compatible_node(NULL, NULL, "fsl,imx23-digctl");
	292	digctl_base = of_iomap(np, 0);
	293	WARN_ON(!digctl_base);
	294
	295	chipid = readl(digctl_base + HW_DIGCTL_CHIPID);
	296	socid = chipid & HW_DIGCTL_CHIPID_MASK;
	297
	298	iounmap(digctl_base);
	299	of_node_put(np);
	300
	301	switch (socid) {
	302	case HW_DIGCTL_CHIPID_MX23:
	303	return "i.MX23";
	304	case HW_DIGCTL_CHIPID_MX28:
	305	return "i.MX28";
	306	default:
	307	return "Unknown";
	308	}
	309	}
	310
	311	static u32 __init mxs_get_cpu_rev(void)
	312	{
	313	u32 rev = chipid & HW_DIGCTL_REV_MASK;
	314
	315	switch (socid) {
	316	case HW_DIGCTL_CHIPID_MX23:
	317	switch (rev) {
	318	case 0x0:
	319	return MXS_CHIP_REVISION_1_0;
	320	case 0x1:
	321	return MXS_CHIP_REVISION_1_1;
	322	case 0x2:
	323	return MXS_CHIP_REVISION_1_2;
	324	case 0x3:
	325	return MXS_CHIP_REVISION_1_3;
	326	case 0x4:
	327	return MXS_CHIP_REVISION_1_4;
	328	default:
	329	return MXS_CHIP_REV_UNKNOWN;
	330	}
	331	case HW_DIGCTL_CHIPID_MX28:
	332	switch (rev) {
	333	case 0x0:
	334	return MXS_CHIP_REVISION_1_1;
	335	case 0x1:
	336	return MXS_CHIP_REVISION_1_2;
	337	default:
	338	return MXS_CHIP_REV_UNKNOWN;
	339	}
	340	default:
	341	return MXS_CHIP_REV_UNKNOWN;
	342	}
	343	}
	344
	345	static const char __init *mxs_get_revision(void)
	346	{
	347	u32 rev = mxs_get_cpu_rev();
	348
	349	if (rev != MXS_CHIP_REV_UNKNOWN)
e115d63c	350	return kasprintf(GFP_KERNEL, "%d.%d", (rev >> 4) & 0xf,
2046338d FE	351	rev & 0xf);
	352	else
	353	return kasprintf(GFP_KERNEL, "%s", "Unknown");
e0f7d905 MR	354	}
e0f7d905 MR	355
56b7eec0 LW	356	#define MX23_CLKCTRL_RESET_OFFSET 0x120
	357	#define MX28_CLKCTRL_RESET_OFFSET 0x1e0
	358
	359	static int __init mxs_restart_init(void)
	360	{
	361	struct device_node *np;
	362
	363	np = of_find_compatible_node(NULL, NULL, "fsl,clkctrl");
	364	reset_addr = of_iomap(np, 0);
	365	if (!reset_addr)
	366	return -ENODEV;
	367
	368	if (of_device_is_compatible(np, "fsl,imx23-clkctrl"))
	369	reset_addr += MX23_CLKCTRL_RESET_OFFSET;
	370	else
	371	reset_addr += MX28_CLKCTRL_RESET_OFFSET;
	372	of_node_put(np);
	373
	374	return 0;
	375	}
	376
9a4cc056 EB	377	static void __init eukrea_mbmx283lc_init(void)
	378	{
	379	mxs_saif_clkmux_select(MXS_DIGCTL_SAIF_CLKMUX_EXTMSTR0);
	380	}
	381
bc3a59c1 DA	382	static void __init mxs_machine_init(void)
bc3a59c1 DA	383	{
2046338d FE	384	struct device_node *root;
	385	struct device *parent;
	386	struct soc_device *soc_dev;
	387	struct soc_device_attribute *soc_dev_attr;
	388	int ret;
	389
	390	soc_dev_attr = kzalloc(sizeof(*soc_dev_attr), GFP_KERNEL);
	391	if (!soc_dev_attr)
	392	return;
	393
	394	root = of_find_node_by_path("/");
	395	ret = of_property_read_string(root, "model", &soc_dev_attr->machine);
	396	if (ret)
	397	return;
	398
	399	soc_dev_attr->family = "Freescale MXS Family";
	400	soc_dev_attr->soc_id = mxs_get_soc_id();
	401	soc_dev_attr->revision = mxs_get_revision();
	402
	403	soc_dev = soc_device_register(soc_dev_attr);
	404	if (IS_ERR(soc_dev)) {
	405	kfree(soc_dev_attr->revision);
	406	kfree(soc_dev_attr);
	407	return;
	408	}
	409
	410	parent = soc_device_to_device(soc_dev);
	411
bc3a59c1 DA	412	if (of_machine_is_compatible("fsl,imx28-evk"))
bc3a59c1 DA	413	imx28_evk_init();
9648b2ef GGM	414	if (of_machine_is_compatible("armadeus,imx28-apf28"))
9648b2ef GGM	415	imx28_apf28_init();
3143bbb4 SG	416	else if (of_machine_is_compatible("bluegiga,apx4devkit"))
3143bbb4 SG	417	apx4devkit_init();
f71f2e95	418	else if (of_machine_is_compatible("crystalfontz,cfa10036"))
ed138c36	419	crystalfontz_init();
9a4cc056 EB	420	else if (of_machine_is_compatible("eukrea,mbmx283lc"))
9a4cc056 EB	421	eukrea_mbmx283lc_init();
df0355f2 MH	422	else if (of_machine_is_compatible("i2se,duckbill"))
df0355f2 MH	423	duckbill_init();
e0ec2f39 MV	424	else if (of_machine_is_compatible("msr,m28cu3"))
e0ec2f39 MV	425	m28cu3_init();
bc3a59c1	426
435ebcbc	427	of_platform_default_populate(NULL, NULL, parent);
2c7c2c1d	428
56b7eec0	429	mxs_restart_init();
bc3a59c1 DA	430	}
bc3a59c1 DA	431
974a9af5 SG	432	#define MXS_CLKCTRL_RESET_CHIP (1 << 1)
	433
	434	/*
	435	* Reset the system. It is called by machine_restart().
	436	*/
7b6d864b	437	static void mxs_restart(enum reboot_mode mode, const char *cmd)
974a9af5	438	{
56b7eec0 LW	439	if (reset_addr) {
	440	/* reset the chip */
	441	__mxs_setl(MXS_CLKCTRL_RESET_CHIP, reset_addr);
974a9af5	442
56b7eec0	443	pr_err("Failed to assert the chip reset\n");
974a9af5	444
56b7eec0 LW	445	/* Delay to allow the serial port to show the message */
	446	mdelay(50);
	447	}
974a9af5	448
974a9af5 SG	449	/* We'll take a jump through zero as a poor second */
	450	soft_restart(0);
	451	}
	452
19c233b7	453	static const char *const mxs_dt_compat[] __initconst = {
bc3a59c1	454	"fsl,imx28",
39490ab0	455	"fsl,imx23",
bc3a59c1 DA	456	NULL,
	457	};
	458
39490ab0	459	DT_MACHINE_START(MXS, "Freescale MXS (Device Tree)")
4e0a1b8c	460	.handle_irq = icoll_handle_irq,
bc3a59c1	461	.init_machine = mxs_machine_init,
45680995	462	.init_late = mxs_pm_init,
39490ab0	463	.dt_compat = mxs_dt_compat,
bc3a59c1 DA	464	.restart = mxs_restart,
bc3a59c1 DA	465	MACHINE_END