[GitHub/mt8127/android_kernel_alcatel_ttab.git] / arch / arm / mach-orion5x / ts78xx-setup.c

/*
 * arch/arm/mach-orion5x/ts78xx-setup.c
 *
 * Maintainer: Alexander Clouter <alex@digriz.org.uk>
 *
 * This file is licensed under the terms of the GNU General Public
 * License version 2.  This program is licensed "as is" without any
 * warranty of any kind, whether express or implied.
 */

#include <linux/kernel.h>
#include <linux/init.h>
#include <linux/sysfs.h>
#include <linux/platform_device.h>
#include <linux/mv643xx_eth.h>
#include <linux/ata_platform.h>
#include <linux/m48t86.h>
#include <linux/mtd/nand.h>
#include <linux/mtd/partitions.h>
#include <asm/mach-types.h>
#include <asm/mach/arch.h>
#include <asm/mach/map.h>
#include <mach/orion5x.h>
#include "common.h"
#include "mpp.h"
#include "ts78xx-fpga.h"

/*****************************************************************************
 * TS-78xx Info
 ****************************************************************************/

/*
 * FPGA - lives where the PCI bus would be at ORION5X_PCI_MEM_PHYS_BASE
 */
#define TS78XX_FPGA_REGS_PHYS_BASE	0xe8000000
#define TS78XX_FPGA_REGS_VIRT_BASE	0xff900000
#define TS78XX_FPGA_REGS_SIZE		SZ_1M

static struct ts78xx_fpga_data ts78xx_fpga = {
	.id		= 0,
	.state		= 1,
/*	.supports	= ... - populated by ts78xx_fpga_supports() */
};

/*****************************************************************************
 * I/O Address Mapping
 ****************************************************************************/
static struct map_desc ts78xx_io_desc[] __initdata = {
	{
		.virtual	= TS78XX_FPGA_REGS_VIRT_BASE,
		.pfn		= __phys_to_pfn(TS78XX_FPGA_REGS_PHYS_BASE),
		.length		= TS78XX_FPGA_REGS_SIZE,
		.type		= MT_DEVICE,
	},
};

void __init ts78xx_map_io(void)
{
	orion5x_map_io();
	iotable_init(ts78xx_io_desc, ARRAY_SIZE(ts78xx_io_desc));
}

/*****************************************************************************
 * Ethernet
 ****************************************************************************/
static struct mv643xx_eth_platform_data ts78xx_eth_data = {
	.phy_addr	= MV643XX_ETH_PHY_ADDR(0),
};

/*****************************************************************************
 * SATA
 ****************************************************************************/
static struct mv_sata_platform_data ts78xx_sata_data = {
	.n_ports	= 2,
};

/*****************************************************************************
 * RTC M48T86 - nicked^Wborrowed from arch/arm/mach-ep93xx/ts72xx.c
 ****************************************************************************/
#define TS_RTC_CTRL	(TS78XX_FPGA_REGS_VIRT_BASE | 0x808)
#define TS_RTC_DATA	(TS78XX_FPGA_REGS_VIRT_BASE | 0x80c)

static unsigned char ts78xx_ts_rtc_readbyte(unsigned long addr)
{
	writeb(addr, TS_RTC_CTRL);
	return readb(TS_RTC_DATA);
}

static void ts78xx_ts_rtc_writebyte(unsigned char value, unsigned long addr)
{
	writeb(addr, TS_RTC_CTRL);
	writeb(value, TS_RTC_DATA);
}

static struct m48t86_ops ts78xx_ts_rtc_ops = {
	.readbyte	= ts78xx_ts_rtc_readbyte,
	.writebyte	= ts78xx_ts_rtc_writebyte,
};

static struct platform_device ts78xx_ts_rtc_device = {
	.name		= "rtc-m48t86",
	.id		= -1,
	.dev		= {
		.platform_data	= &ts78xx_ts_rtc_ops,
	},
	.num_resources	= 0,
};

/*
 * TS uses some of the user storage space on the RTC chip so see if it is
 * present; as it's an optional feature at purchase time and not all boards
 * will have it present
 *
 * I've used the method TS use in their rtc7800.c example for the detection
 *
 * TODO: track down a guinea pig without an RTC to see if we can work out a
 * 		better RTC detection routine
 */
static int ts78xx_ts_rtc_load(void)
{
	int rc;
	unsigned char tmp_rtc0, tmp_rtc1;

	tmp_rtc0 = ts78xx_ts_rtc_readbyte(126);
	tmp_rtc1 = ts78xx_ts_rtc_readbyte(127);

	ts78xx_ts_rtc_writebyte(0x00, 126);
	ts78xx_ts_rtc_writebyte(0x55, 127);
	if (ts78xx_ts_rtc_readbyte(127) == 0x55) {
		ts78xx_ts_rtc_writebyte(0xaa, 127);
		if (ts78xx_ts_rtc_readbyte(127) == 0xaa
				&& ts78xx_ts_rtc_readbyte(126) == 0x00) {
			ts78xx_ts_rtc_writebyte(tmp_rtc0, 126);
			ts78xx_ts_rtc_writebyte(tmp_rtc1, 127);

			if (ts78xx_fpga.supports.ts_rtc.init == 0) {
				rc = platform_device_register(&ts78xx_ts_rtc_device);
				if (!rc)
					ts78xx_fpga.supports.ts_rtc.init = 1;
			} else
				rc = platform_device_add(&ts78xx_ts_rtc_device);

			return rc;
		}
	}

	return -ENODEV;
};

static void ts78xx_ts_rtc_unload(void)
{
	platform_device_del(&ts78xx_ts_rtc_device);
}

/*****************************************************************************
 * NAND Flash
 ****************************************************************************/
#define TS_NAND_CTRL	(TS78XX_FPGA_REGS_VIRT_BASE | 0x800)	/* VIRT */
#define TS_NAND_DATA	(TS78XX_FPGA_REGS_PHYS_BASE | 0x804)	/* PHYS */

/*
 * hardware specific access to control-lines
 *
 * ctrl:
 * NAND_NCE: bit 0 -> bit 2
 * NAND_CLE: bit 1 -> bit 1
 * NAND_ALE: bit 2 -> bit 0
 */
static void ts78xx_ts_nand_cmd_ctrl(struct mtd_info *mtd, int cmd,
			unsigned int ctrl)
{
	struct nand_chip *this = mtd->priv;

	if (ctrl & NAND_CTRL_CHANGE) {
		unsigned char bits;

		bits = (ctrl & NAND_NCE) << 2;
		bits |= ctrl & NAND_CLE;
		bits |= (ctrl & NAND_ALE) >> 2;

		writeb((readb(TS_NAND_CTRL) & ~0x7) | bits, TS_NAND_CTRL);
	}

	if (cmd != NAND_CMD_NONE)
		writeb(cmd, this->IO_ADDR_W);
}

static int ts78xx_ts_nand_dev_ready(struct mtd_info *mtd)
{
	return readb(TS_NAND_CTRL) & 0x20;
}

const char *ts_nand_part_probes[] = { "cmdlinepart", NULL };

static struct mtd_partition ts78xx_ts_nand_parts[] = {
	{
		.name		= "mbr",
		.offset		= 0,
		.size		= SZ_128K,
		.mask_flags	= MTD_WRITEABLE,
	}, {
		.name		= "kernel",
		.offset		= MTDPART_OFS_APPEND,
		.size		= SZ_4M,
	}, {
		.name		= "initrd",
		.offset		= MTDPART_OFS_APPEND,
		.size		= SZ_4M,
	}, {
		.name		= "rootfs",
		.offset		= MTDPART_OFS_APPEND,
		.size		= MTDPART_SIZ_FULL,
	}
};

static struct platform_nand_data ts78xx_ts_nand_data = {
	.chip	= {
		.part_probe_types	= ts_nand_part_probes,
		.partitions		= ts78xx_ts_nand_parts,
		.nr_partitions		= ARRAY_SIZE(ts78xx_ts_nand_parts),
		.chip_delay		= 15,
		.options		= NAND_USE_FLASH_BBT,
	},
	.ctrl	= {
		/*
		 * The HW ECC offloading functions, used to give about a 9%
		 * performance increase for 'dd if=/dev/mtdblockX' and 5% for
		 * nanddump.  This all however was changed by git commit
		 * e6cf5df1838c28bb060ac45b5585e48e71bbc740 so now there is
		 * no performance advantage to be had so we no longer bother
		 */
		.cmd_ctrl		= ts78xx_ts_nand_cmd_ctrl,
		.dev_ready		= ts78xx_ts_nand_dev_ready,
	},
};

static struct resource ts78xx_ts_nand_resources = {
	.start		= TS_NAND_DATA,
	.end		= TS_NAND_DATA + 4,
	.flags		= IORESOURCE_IO,
};

static struct platform_device ts78xx_ts_nand_device = {
	.name		= "gen_nand",
	.id		= -1,
	.dev		= {
		.platform_data	= &ts78xx_ts_nand_data,
	},
	.resource	= &ts78xx_ts_nand_resources,
	.num_resources	= 1,
};

static int ts78xx_ts_nand_load(void)
{
	int rc;

	if (ts78xx_fpga.supports.ts_nand.init == 0) {
		rc = platform_device_register(&ts78xx_ts_nand_device);
		if (!rc)
			ts78xx_fpga.supports.ts_nand.init = 1;
	} else
		rc = platform_device_add(&ts78xx_ts_nand_device);

	return rc;
};

static void ts78xx_ts_nand_unload(void)
{
	platform_device_del(&ts78xx_ts_nand_device);
}

/*****************************************************************************
 * FPGA 'hotplug' support code
 ****************************************************************************/
static void ts78xx_fpga_devices_zero_init(void)
{
	ts78xx_fpga.supports.ts_rtc.init = 0;
	ts78xx_fpga.supports.ts_nand.init = 0;
}

static void ts78xx_fpga_supports(void)
{
	/* TODO: put this 'table' into ts78xx-fpga.h */
	switch (ts78xx_fpga.id) {
	case TS7800_REV_B2:
	case TS7800_REV_B3:
		ts78xx_fpga.supports.ts_rtc.present = 1;
		ts78xx_fpga.supports.ts_nand.present = 1;
		break;
	default:
		ts78xx_fpga.supports.ts_rtc.present = 0;
		ts78xx_fpga.supports.ts_nand.present = 0;
	}
}

static int ts78xx_fpga_load_devices(void)
{
	int tmp, ret = 0;

	if (ts78xx_fpga.supports.ts_rtc.present == 1) {
		tmp = ts78xx_ts_rtc_load();
		if (tmp) {
			printk(KERN_INFO "TS-78xx: RTC not registered\n");
			ts78xx_fpga.supports.ts_rtc.present = 0;
		}
		ret |= tmp;
	}
	if (ts78xx_fpga.supports.ts_nand.present == 1) {
		tmp = ts78xx_ts_nand_load();
		if (tmp) {
			printk(KERN_INFO "TS-78xx: NAND not registered\n");
			ts78xx_fpga.supports.ts_nand.present = 0;
		}
		ret |= tmp;
	}

	return ret;
}

static int ts78xx_fpga_unload_devices(void)
{
	int ret = 0;

	if (ts78xx_fpga.supports.ts_rtc.present == 1)
		ts78xx_ts_rtc_unload();
	if (ts78xx_fpga.supports.ts_nand.present == 1)
		ts78xx_ts_nand_unload();

	return ret;
}

static int ts78xx_fpga_load(void)
{
	ts78xx_fpga.id = readl(TS78XX_FPGA_REGS_VIRT_BASE);

	printk(KERN_INFO "TS-78xx FPGA: magic=0x%.6x, rev=0x%.2x\n",
			(ts78xx_fpga.id >> 8) & 0xffffff,
			ts78xx_fpga.id & 0xff);

	ts78xx_fpga_supports();

	if (ts78xx_fpga_load_devices()) {
		ts78xx_fpga.state = -1;
		return -EBUSY;
	}

	return 0;
};

static int ts78xx_fpga_unload(void)
{
	unsigned int fpga_id;

	fpga_id = readl(TS78XX_FPGA_REGS_VIRT_BASE);

	/*
	 * There does not seem to be a feasible way to block access to the GPIO
	 * pins from userspace (/dev/mem).  This if clause should hopefully warn
	 * those foolish enough not to follow 'policy' :)
	 *
	 * UrJTAG SVN since r1381 can be used to reprogram the FPGA
	 */
	if (ts78xx_fpga.id != fpga_id) {
		printk(KERN_ERR	"TS-78xx FPGA: magic/rev mismatch\n"
			"TS-78xx FPGA: was 0x%.6x/%.2x but now 0x%.6x/%.2x\n",
			(ts78xx_fpga.id >> 8) & 0xffffff, ts78xx_fpga.id & 0xff,
			(fpga_id >> 8) & 0xffffff, fpga_id & 0xff);
		ts78xx_fpga.state = -1;
		return -EBUSY;
	}

	if (ts78xx_fpga_unload_devices()) {
		ts78xx_fpga.state = -1;
		return -EBUSY;
	}

	return 0;
};

static ssize_t ts78xx_fpga_show(struct kobject *kobj,
			struct kobj_attribute *attr, char *buf)
{
	if (ts78xx_fpga.state < 0)
		return sprintf(buf, "borked\n");

	return sprintf(buf, "%s\n", (ts78xx_fpga.state) ? "online" : "offline");
}

static ssize_t ts78xx_fpga_store(struct kobject *kobj,
			struct kobj_attribute *attr, const char *buf, size_t n)
{
	int value, ret;

	if (ts78xx_fpga.state < 0) {
		printk(KERN_ERR "TS-78xx FPGA: borked, you must powercycle asap\n");
		return -EBUSY;
	}

	if (strncmp(buf, "online", sizeof("online") - 1) == 0)
		value = 1;
	else if (strncmp(buf, "offline", sizeof("offline") - 1) == 0)
		value = 0;
	else {
		printk(KERN_ERR "ts78xx_fpga_store: Invalid value\n");
		return -EINVAL;
	}

	if (ts78xx_fpga.state == value)
		return n;

	ret = (ts78xx_fpga.state == 0)
		? ts78xx_fpga_load()
		: ts78xx_fpga_unload();

	if (!(ret < 0))
		ts78xx_fpga.state = value;

	return n;
}

static struct kobj_attribute ts78xx_fpga_attr =
	__ATTR(ts78xx_fpga, 0644, ts78xx_fpga_show, ts78xx_fpga_store);

/*****************************************************************************
 * General Setup
 ****************************************************************************/
static struct orion5x_mpp_mode ts78xx_mpp_modes[] __initdata = {
	{  0, MPP_UNUSED },
	{  1, MPP_GPIO },		/* JTAG Clock */
	{  2, MPP_GPIO },		/* JTAG Data In */
	{  3, MPP_GPIO },		/* Lat ECP2 256 FPGA - PB2B */
	{  4, MPP_GPIO },		/* JTAG Data Out */
	{  5, MPP_GPIO },		/* JTAG TMS */
	{  6, MPP_GPIO },		/* Lat ECP2 256 FPGA - PB31A_CLK4+ */
	{  7, MPP_GPIO },		/* Lat ECP2 256 FPGA - PB22B */
	{  8, MPP_UNUSED },
	{  9, MPP_UNUSED },
	{ 10, MPP_UNUSED },
	{ 11, MPP_UNUSED },
	{ 12, MPP_UNUSED },
	{ 13, MPP_UNUSED },
	{ 14, MPP_UNUSED },
	{ 15, MPP_UNUSED },
	{ 16, MPP_UART },
	{ 17, MPP_UART },
	{ 18, MPP_UART },
	{ 19, MPP_UART },
	/*
	 * MPP[20] PCI Clock Out 1
	 * MPP[21] PCI Clock Out 0
	 * MPP[22] Unused
	 * MPP[23] Unused
	 * MPP[24] Unused
	 * MPP[25] Unused
	 */
	{ -1 },
};

static void __init ts78xx_init(void)
{
	int ret;

	/*
	 * Setup basic Orion functions. Need to be called early.
	 */
	orion5x_init();

	orion5x_mpp_conf(ts78xx_mpp_modes);

	/*
	 * Configure peripherals.
	 */
	orion5x_ehci0_init();
	orion5x_ehci1_init();
	orion5x_eth_init(&ts78xx_eth_data);
	orion5x_sata_init(&ts78xx_sata_data);
	orion5x_uart0_init();
	orion5x_uart1_init();
	orion5x_xor_init();

	/* FPGA init */
	ts78xx_fpga_devices_zero_init();
	ret = ts78xx_fpga_load();
	ret = sysfs_create_file(power_kobj, &ts78xx_fpga_attr.attr);
	if (ret)
		printk(KERN_ERR "sysfs_create_file failed: %d\n", ret);
}

MACHINE_START(TS78XX, "Technologic Systems TS-78xx SBC")
	/* Maintainer: Alexander Clouter <alex@digriz.org.uk> */
	.phys_io	= ORION5X_REGS_PHYS_BASE,
	.io_pg_offst	= ((ORION5X_REGS_VIRT_BASE) >> 18) & 0xFFFC,
	.boot_params	= 0x00000100,
	.init_machine	= ts78xx_init,
	.map_io		= ts78xx_map_io,
	.init_irq	= orion5x_init_irq,
	.timer		= &orion5x_timer,
MACHINE_END
Commit	Line	Data
7171d867 AC	1	/*
	2	* arch/arm/mach-orion5x/ts78xx-setup.c
	3	*
	4	* Maintainer: Alexander Clouter <alex@digriz.org.uk>
	5	*
	6	* This file is licensed under the terms of the GNU General Public
	7	* License version 2. This program is licensed "as is" without any
	8	* warranty of any kind, whether express or implied.
	9	*/
	10
	11	#include <linux/kernel.h>
	12	#include <linux/init.h>
39008f95	13	#include <linux/sysfs.h>
7171d867	14	#include <linux/platform_device.h>
7171d867 AC	15	#include <linux/mv643xx_eth.h>
	16	#include <linux/ata_platform.h>
	17	#include <linux/m48t86.h>
75bb6b9a AC	18	#include <linux/mtd/nand.h>
75bb6b9a AC	19	#include <linux/mtd/partitions.h>
7171d867 AC	20	#include <asm/mach-types.h>
	21	#include <asm/mach/arch.h>
	22	#include <asm/mach/map.h>
a09e64fb	23	#include <mach/orion5x.h>
7171d867 AC	24	#include "common.h"
7171d867 AC	25	#include "mpp.h"
39008f95	26	#include "ts78xx-fpga.h"
7171d867 AC	27
	28	/*****************************************************************************
	29	* TS-78xx Info
	30	****************************************************************************/
	31
	32	/*
	33	* FPGA - lives where the PCI bus would be at ORION5X_PCI_MEM_PHYS_BASE
	34	*/
	35	#define TS78XX_FPGA_REGS_PHYS_BASE 0xe8000000
	36	#define TS78XX_FPGA_REGS_VIRT_BASE 0xff900000
	37	#define TS78XX_FPGA_REGS_SIZE SZ_1M
	38
39008f95 AC	39	static struct ts78xx_fpga_data ts78xx_fpga = {
	40	.id = 0,
	41	.state = 1,
	42	/* .supports = ... - populated by ts78xx_fpga_supports() */
	43	};
7171d867	44
7171d867 AC	45	/*****************************************************************************
	46	* I/O Address Mapping
	47	****************************************************************************/
	48	static struct map_desc ts78xx_io_desc[] __initdata = {
	49	{
	50	.virtual = TS78XX_FPGA_REGS_VIRT_BASE,
	51	.pfn = __phys_to_pfn(TS78XX_FPGA_REGS_PHYS_BASE),
	52	.length = TS78XX_FPGA_REGS_SIZE,
	53	.type = MT_DEVICE,
	54	},
	55	};
	56
	57	void __init ts78xx_map_io(void)
	58	{
	59	orion5x_map_io();
	60	iotable_init(ts78xx_io_desc, ARRAY_SIZE(ts78xx_io_desc));
	61	}
	62
7171d867 AC	63	/*****************************************************************************
	64	* Ethernet
	65	****************************************************************************/
	66	static struct mv643xx_eth_platform_data ts78xx_eth_data = {
ac840605	67	.phy_addr = MV643XX_ETH_PHY_ADDR(0),
7171d867 AC	68	};
7171d867 AC	69
39008f95 AC	70	/*****************************************************************************
	71	* SATA
	72	****************************************************************************/
	73	static struct mv_sata_platform_data ts78xx_sata_data = {
	74	.n_ports = 2,
	75	};
	76
7171d867 AC	77	/*****************************************************************************
	78	* RTC M48T86 - nicked^Wborrowed from arch/arm/mach-ep93xx/ts72xx.c
	79	****************************************************************************/
39008f95 AC	80	#define TS_RTC_CTRL (TS78XX_FPGA_REGS_VIRT_BASE \| 0x808)
	81	#define TS_RTC_DATA (TS78XX_FPGA_REGS_VIRT_BASE \| 0x80c)
	82
	83	static unsigned char ts78xx_ts_rtc_readbyte(unsigned long addr)
7171d867	84	{
39008f95 AC	85	writeb(addr, TS_RTC_CTRL);
39008f95 AC	86	return readb(TS_RTC_DATA);
7171d867 AC	87	}
7171d867 AC	88
39008f95	89	static void ts78xx_ts_rtc_writebyte(unsigned char value, unsigned long addr)
7171d867	90	{
39008f95 AC	91	writeb(addr, TS_RTC_CTRL);
39008f95 AC	92	writeb(value, TS_RTC_DATA);
7171d867 AC	93	}
7171d867 AC	94
39008f95 AC	95	static struct m48t86_ops ts78xx_ts_rtc_ops = {
	96	.readbyte = ts78xx_ts_rtc_readbyte,
	97	.writebyte = ts78xx_ts_rtc_writebyte,
7171d867 AC	98	};
7171d867 AC	99
39008f95	100	static struct platform_device ts78xx_ts_rtc_device = {
7171d867 AC	101	.name = "rtc-m48t86",
	102	.id = -1,
	103	.dev = {
39008f95	104	.platform_data = &ts78xx_ts_rtc_ops,
7171d867 AC	105	},
	106	.num_resources = 0,
	107	};
	108
	109	/*
	110	* TS uses some of the user storage space on the RTC chip so see if it is
	111	* present; as it's an optional feature at purchase time and not all boards
	112	* will have it present
	113	*
	114	* I've used the method TS use in their rtc7800.c example for the detection
	115	*
	116	* TODO: track down a guinea pig without an RTC to see if we can work out a
	117	* better RTC detection routine
	118	*/
39008f95	119	static int ts78xx_ts_rtc_load(void)
7171d867	120	{
f5273fa3	121	int rc;
7171d867 AC	122	unsigned char tmp_rtc0, tmp_rtc1;
7171d867 AC	123
39008f95 AC	124	tmp_rtc0 = ts78xx_ts_rtc_readbyte(126);
	125	tmp_rtc1 = ts78xx_ts_rtc_readbyte(127);
	126
	127	ts78xx_ts_rtc_writebyte(0x00, 126);
	128	ts78xx_ts_rtc_writebyte(0x55, 127);
	129	if (ts78xx_ts_rtc_readbyte(127) == 0x55) {
	130	ts78xx_ts_rtc_writebyte(0xaa, 127);
	131	if (ts78xx_ts_rtc_readbyte(127) == 0xaa
	132	&& ts78xx_ts_rtc_readbyte(126) == 0x00) {
	133	ts78xx_ts_rtc_writebyte(tmp_rtc0, 126);
	134	ts78xx_ts_rtc_writebyte(tmp_rtc1, 127);
f5273fa3	135
39008f95	136	if (ts78xx_fpga.supports.ts_rtc.init == 0) {
f5273fa3 AC	137	rc = platform_device_register(&ts78xx_ts_rtc_device);
	138	if (!rc)
	139	ts78xx_fpga.supports.ts_rtc.init = 1;
39008f95	140	} else
f5273fa3 AC	141	rc = platform_device_add(&ts78xx_ts_rtc_device);
	142
	143	return rc;
7171d867 AC	144	}
	145	}
	146
39008f95	147	return -ENODEV;
7171d867	148	};
39008f95 AC	149
	150	static void ts78xx_ts_rtc_unload(void)
	151	{
	152	platform_device_del(&ts78xx_ts_rtc_device);
	153	}
7171d867	154
75bb6b9a AC	155	/*****************************************************************************
	156	* NAND Flash
	157	****************************************************************************/
	158	#define TS_NAND_CTRL (TS78XX_FPGA_REGS_VIRT_BASE \| 0x800) /* VIRT */
	159	#define TS_NAND_DATA (TS78XX_FPGA_REGS_PHYS_BASE \| 0x804) /* PHYS */
	160
	161	/*
	162	* hardware specific access to control-lines
	163	*
	164	* ctrl:
	165	* NAND_NCE: bit 0 -> bit 2
	166	* NAND_CLE: bit 1 -> bit 1
	167	* NAND_ALE: bit 2 -> bit 0
	168	*/
	169	static void ts78xx_ts_nand_cmd_ctrl(struct mtd_info *mtd, int cmd,
	170	unsigned int ctrl)
	171	{
	172	struct nand_chip *this = mtd->priv;
	173
	174	if (ctrl & NAND_CTRL_CHANGE) {
	175	unsigned char bits;
	176
	177	bits = (ctrl & NAND_NCE) << 2;
	178	bits \|= ctrl & NAND_CLE;
	179	bits \|= (ctrl & NAND_ALE) >> 2;
	180
	181	writeb((readb(TS_NAND_CTRL) & ~0x7) \| bits, TS_NAND_CTRL);
	182	}
	183
	184	if (cmd != NAND_CMD_NONE)
	185	writeb(cmd, this->IO_ADDR_W);
	186	}
	187
	188	static int ts78xx_ts_nand_dev_ready(struct mtd_info *mtd)
	189	{
	190	return readb(TS_NAND_CTRL) & 0x20;
	191	}
	192
	193	const char *ts_nand_part_probes[] = { "cmdlinepart", NULL };
	194
	195	static struct mtd_partition ts78xx_ts_nand_parts[] = {
	196	{
	197	.name = "mbr",
	198	.offset = 0,
	199	.size = SZ_128K,
	200	.mask_flags = MTD_WRITEABLE,
	201	}, {
	202	.name = "kernel",
	203	.offset = MTDPART_OFS_APPEND,
	204	.size = SZ_4M,
	205	}, {
	206	.name = "initrd",
	207	.offset = MTDPART_OFS_APPEND,
	208	.size = SZ_4M,
	209	}, {
	210	.name = "rootfs",
	211	.offset = MTDPART_OFS_APPEND,
	212	.size = MTDPART_SIZ_FULL,
	213	}
	214	};
	215
	216	static struct platform_nand_data ts78xx_ts_nand_data = {
	217	.chip = {
	218	.part_probe_types = ts_nand_part_probes,
219	.partitions = ts78xx_ts_nand_parts,
220	.nr_partitions = ARRAY_SIZE(ts78xx_ts_nand_parts),
221	.chip_delay = 15,
222	.options = NAND_USE_FLASH_BBT,
223	},
224	.ctrl = {
225	/*
226	* The HW ECC offloading functions, used to give about a 9%
227	* performance increase for 'dd if=/dev/mtdblockX' and 5% for
228	* nanddump. This all however was changed by git commit
229	* e6cf5df1838c28bb060ac45b5585e48e71bbc740 so now there is
230	* no performance advantage to be had so we no longer bother
231	*/
232	.cmd_ctrl = ts78xx_ts_nand_cmd_ctrl,
233	.dev_ready = ts78xx_ts_nand_dev_ready,
234	},
235	};
236
237	static struct resource ts78xx_ts_nand_resources = {
238	.start = TS_NAND_DATA,
239	.end = TS_NAND_DATA + 4,
240	.flags = IORESOURCE_IO,
241	};
242
243	static struct platform_device ts78xx_ts_nand_device = {
244	.name = "gen_nand",
245	.id = -1,
246	.dev = {
247	.platform_data = &ts78xx_ts_nand_data,
248	},
249	.resource = &ts78xx_ts_nand_resources,
250	.num_resources = 1,
251	};
252
253	static int ts78xx_ts_nand_load(void)
254	{
255	int rc;
256
257	if (ts78xx_fpga.supports.ts_nand.init == 0) {
258	rc = platform_device_register(&ts78xx_ts_nand_device);
259	if (!rc)
260	ts78xx_fpga.supports.ts_nand.init = 1;
261	} else
262	rc = platform_device_add(&ts78xx_ts_nand_device);
263
264	return rc;
265	};
266
267	static void ts78xx_ts_nand_unload(void)
268	{
269	platform_device_del(&ts78xx_ts_nand_device);
270	}
271
7171d867	272	/*****************************************************************************
39008f95	273	* FPGA 'hotplug' support code
7171d867	274	****************************************************************************/
39008f95 AC	275	static void ts78xx_fpga_devices_zero_init(void)
	276	{
	277	ts78xx_fpga.supports.ts_rtc.init = 0;
75bb6b9a	278	ts78xx_fpga.supports.ts_nand.init = 0;
39008f95 AC	279	}
	280
	281	static void ts78xx_fpga_supports(void)
	282	{
	283	/* TODO: put this 'table' into ts78xx-fpga.h */
	284	switch (ts78xx_fpga.id) {
195f4a17 AC	285	case TS7800_REV_B2:
195f4a17 AC	286	case TS7800_REV_B3:
39008f95	287	ts78xx_fpga.supports.ts_rtc.present = 1;
75bb6b9a	288	ts78xx_fpga.supports.ts_nand.present = 1;
39008f95 AC	289	break;
	290	default:
	291	ts78xx_fpga.supports.ts_rtc.present = 0;
75bb6b9a	292	ts78xx_fpga.supports.ts_nand.present = 0;
39008f95 AC	293	}
	294	}
	295
	296	static int ts78xx_fpga_load_devices(void)
	297	{
	298	int tmp, ret = 0;
	299
	300	if (ts78xx_fpga.supports.ts_rtc.present == 1) {
	301	tmp = ts78xx_ts_rtc_load();
f5273fa3	302	if (tmp) {
673492a8	303	printk(KERN_INFO "TS-78xx: RTC not registered\n");
f5273fa3 AC	304	ts78xx_fpga.supports.ts_rtc.present = 0;
f5273fa3 AC	305	}
39008f95 AC	306	ret \|= tmp;
39008f95 AC	307	}
75bb6b9a AC	308	if (ts78xx_fpga.supports.ts_nand.present == 1) {
	309	tmp = ts78xx_ts_nand_load();
	310	if (tmp) {
	311	printk(KERN_INFO "TS-78xx: NAND not registered\n");
	312	ts78xx_fpga.supports.ts_nand.present = 0;
	313	}
	314	ret \|= tmp;
	315	}
39008f95 AC	316
	317	return ret;
	318	}
	319
	320	static int ts78xx_fpga_unload_devices(void)
	321	{
	322	int ret = 0;
	323
	324	if (ts78xx_fpga.supports.ts_rtc.present == 1)
	325	ts78xx_ts_rtc_unload();
75bb6b9a AC	326	if (ts78xx_fpga.supports.ts_nand.present == 1)
75bb6b9a AC	327	ts78xx_ts_nand_unload();
39008f95 AC	328
	329	return ret;
	330	}
	331
	332	static int ts78xx_fpga_load(void)
	333	{
	334	ts78xx_fpga.id = readl(TS78XX_FPGA_REGS_VIRT_BASE);
	335
	336	printk(KERN_INFO "TS-78xx FPGA: magic=0x%.6x, rev=0x%.2x\n",
	337	(ts78xx_fpga.id >> 8) & 0xffffff,
	338	ts78xx_fpga.id & 0xff);
	339
	340	ts78xx_fpga_supports();
	341
	342	if (ts78xx_fpga_load_devices()) {
	343	ts78xx_fpga.state = -1;
	344	return -EBUSY;
	345	}
	346
	347	return 0;
7171d867 AC	348	};
7171d867 AC	349
39008f95 AC	350	static int ts78xx_fpga_unload(void)
	351	{
	352	unsigned int fpga_id;
	353
	354	fpga_id = readl(TS78XX_FPGA_REGS_VIRT_BASE);
	355
	356	/*
	357	* There does not seem to be a feasible way to block access to the GPIO
	358	* pins from userspace (/dev/mem). This if clause should hopefully warn
	359	* those foolish enough not to follow 'policy' :)
	360	*
	361	* UrJTAG SVN since r1381 can be used to reprogram the FPGA
	362	*/
	363	if (ts78xx_fpga.id != fpga_id) {
	364	printk(KERN_ERR "TS-78xx FPGA: magic/rev mismatch\n"
	365	"TS-78xx FPGA: was 0x%.6x/%.2x but now 0x%.6x/%.2x\n",
	366	(ts78xx_fpga.id >> 8) & 0xffffff, ts78xx_fpga.id & 0xff,
	367	(fpga_id >> 8) & 0xffffff, fpga_id & 0xff);
	368	ts78xx_fpga.state = -1;
	369	return -EBUSY;
	370	}
	371
	372	if (ts78xx_fpga_unload_devices()) {
	373	ts78xx_fpga.state = -1;
	374	return -EBUSY;
	375	}
	376
	377	return 0;
7171d867 AC	378	};
7171d867 AC	379
39008f95 AC	380	static ssize_t ts78xx_fpga_show(struct kobject *kobj,
	381	struct kobj_attribute attr, char buf)
	382	{
	383	if (ts78xx_fpga.state < 0)
	384	return sprintf(buf, "borked\n");
	385
	386	return sprintf(buf, "%s\n", (ts78xx_fpga.state) ? "online" : "offline");
	387	}
	388
	389	static ssize_t ts78xx_fpga_store(struct kobject *kobj,
	390	struct kobj_attribute attr, const char buf, size_t n)
	391	{
	392	int value, ret;
	393
	394	if (ts78xx_fpga.state < 0) {
	395	printk(KERN_ERR "TS-78xx FPGA: borked, you must powercycle asap\n");
	396	return -EBUSY;
	397	}
	398
	399	if (strncmp(buf, "online", sizeof("online") - 1) == 0)
	400	value = 1;
	401	else if (strncmp(buf, "offline", sizeof("offline") - 1) == 0)
	402	value = 0;
	403	else {
	404	printk(KERN_ERR "ts78xx_fpga_store: Invalid value\n");
	405	return -EINVAL;
	406	}
	407
	408	if (ts78xx_fpga.state == value)
	409	return n;
	410
	411	ret = (ts78xx_fpga.state == 0)
	412	? ts78xx_fpga_load()
	413	: ts78xx_fpga_unload();
	414
	415	if (!(ret < 0))
	416	ts78xx_fpga.state = value;
	417
	418	return n;
	419	}
	420
	421	static struct kobj_attribute ts78xx_fpga_attr =
	422	__ATTR(ts78xx_fpga, 0644, ts78xx_fpga_show, ts78xx_fpga_store);
	423
7171d867 AC	424	/*****************************************************************************
	425	* General Setup
	426	****************************************************************************/
	427	static struct orion5x_mpp_mode ts78xx_mpp_modes[] __initdata = {
	428	{ 0, MPP_UNUSED },
	429	{ 1, MPP_GPIO }, /* JTAG Clock */
	430	{ 2, MPP_GPIO }, /* JTAG Data In */
	431	{ 3, MPP_GPIO }, /* Lat ECP2 256 FPGA - PB2B */
	432	{ 4, MPP_GPIO }, /* JTAG Data Out */
	433	{ 5, MPP_GPIO }, /* JTAG TMS */
	434	{ 6, MPP_GPIO }, /* Lat ECP2 256 FPGA - PB31A_CLK4+ */
	435	{ 7, MPP_GPIO }, /* Lat ECP2 256 FPGA - PB22B */
	436	{ 8, MPP_UNUSED },
	437	{ 9, MPP_UNUSED },
	438	{ 10, MPP_UNUSED },
	439	{ 11, MPP_UNUSED },
	440	{ 12, MPP_UNUSED },
	441	{ 13, MPP_UNUSED },
	442	{ 14, MPP_UNUSED },
	443	{ 15, MPP_UNUSED },
	444	{ 16, MPP_UART },
	445	{ 17, MPP_UART },
	446	{ 18, MPP_UART },
	447	{ 19, MPP_UART },
f5412860 AC	448	/*
	449	* MPP[20] PCI Clock Out 1
	450	* MPP[21] PCI Clock Out 0
	451	* MPP[22] Unused
	452	* MPP[23] Unused
	453	* MPP[24] Unused
	454	* MPP[25] Unused
	455	*/
7171d867 AC	456	{ -1 },
	457	};
	458
	459	static void __init ts78xx_init(void)
	460	{
39008f95 AC	461	int ret;
39008f95 AC	462
7171d867 AC	463	/*
	464	* Setup basic Orion functions. Need to be called early.
	465	*/
	466	orion5x_init();
	467
7171d867 AC	468	orion5x_mpp_conf(ts78xx_mpp_modes);
7171d867 AC	469
7171d867 AC	470	/*
	471	* Configure peripherals.
	472	*/
	473	orion5x_ehci0_init();
	474	orion5x_ehci1_init();
	475	orion5x_eth_init(&ts78xx_eth_data);
	476	orion5x_sata_init(&ts78xx_sata_data);
	477	orion5x_uart0_init();
	478	orion5x_uart1_init();
1d5a1a6e	479	orion5x_xor_init();
7171d867	480
39008f95 AC	481	/* FPGA init */
	482	ts78xx_fpga_devices_zero_init();
	483	ret = ts78xx_fpga_load();
	484	ret = sysfs_create_file(power_kobj, &ts78xx_fpga_attr.attr);
	485	if (ret)
	486	printk(KERN_ERR "sysfs_create_file failed: %d\n", ret);
7171d867 AC	487	}
	488
	489	MACHINE_START(TS78XX, "Technologic Systems TS-78xx SBC")
	490	/* Maintainer: Alexander Clouter <alex@digriz.org.uk> */
	491	.phys_io = ORION5X_REGS_PHYS_BASE,
	492	.io_pg_offst = ((ORION5X_REGS_VIRT_BASE) >> 18) & 0xFFFC,
	493	.boot_params = 0x00000100,
	494	.init_machine = ts78xx_init,
	495	.map_io = ts78xx_map_io,
	496	.init_irq = orion5x_init_irq,
	497	.timer = &orion5x_timer,
	498	MACHINE_END