[deliverable/linux.git] / arch / arm / mach-omap2 / gpmc-onenand.c

/*
 * linux/arch/arm/mach-omap2/gpmc-onenand.c
 *
 * Copyright (C) 2006 - 2009 Nokia Corporation
 * Contacts:	Juha Yrjola
 *		Tony Lindgren
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License version 2 as
 * published by the Free Software Foundation.
 */

#include <linux/string.h>
#include <linux/kernel.h>
#include <linux/platform_device.h>
#include <linux/mtd/onenand_regs.h>
#include <linux/io.h>
#include <linux/platform_data/mtd-onenand-omap2.h>

#include <asm/mach/flash.h>

#include <plat/gpmc.h>

#include "soc.h"

#define	ONENAND_IO_SIZE	SZ_128K

static struct omap_onenand_platform_data *gpmc_onenand_data;

static struct resource gpmc_onenand_resource = {
	.flags		= IORESOURCE_MEM,
};

static struct platform_device gpmc_onenand_device = {
	.name		= "omap2-onenand",
	.id		= -1,
	.num_resources	= 1,
	.resource	= &gpmc_onenand_resource,
};

static int omap2_onenand_set_async_mode(int cs, void __iomem *onenand_base)
{
	struct gpmc_timings t;
	u32 reg;
	int err;

	const int t_cer = 15;
	const int t_avdp = 12;
	const int t_aavdh = 7;
	const int t_ce = 76;
	const int t_aa = 76;
	const int t_oe = 20;
	const int t_cez = 20; /* max of t_cez, t_oez */
	const int t_ds = 30;
	const int t_wpl = 40;
	const int t_wph = 30;

	/* Ensure sync read and sync write are disabled */
	reg = readw(onenand_base + ONENAND_REG_SYS_CFG1);
	reg &= ~ONENAND_SYS_CFG1_SYNC_READ & ~ONENAND_SYS_CFG1_SYNC_WRITE;
	writew(reg, onenand_base + ONENAND_REG_SYS_CFG1);

	memset(&t, 0, sizeof(t));
	t.sync_clk = 0;
	t.cs_on = 0;
	t.adv_on = 0;

	/* Read */
	t.adv_rd_off = gpmc_round_ns_to_ticks(max_t(int, t_avdp, t_cer));
	t.oe_on  = t.adv_rd_off + gpmc_round_ns_to_ticks(t_aavdh);
	t.access = t.adv_on + gpmc_round_ns_to_ticks(t_aa);
	t.access = max_t(int, t.access, t.cs_on + gpmc_round_ns_to_ticks(t_ce));
	t.access = max_t(int, t.access, t.oe_on + gpmc_round_ns_to_ticks(t_oe));
	t.oe_off = t.access + gpmc_round_ns_to_ticks(1);
	t.cs_rd_off = t.oe_off;
	t.rd_cycle  = t.cs_rd_off + gpmc_round_ns_to_ticks(t_cez);

	/* Write */
	t.adv_wr_off = t.adv_rd_off;
	t.we_on  = t.oe_on;
	if (cpu_is_omap34xx()) {
		t.wr_data_mux_bus = t.we_on;
		t.wr_access = t.we_on + gpmc_round_ns_to_ticks(t_ds);
	}
	t.we_off = t.we_on + gpmc_round_ns_to_ticks(t_wpl);
	t.cs_wr_off = t.we_off + gpmc_round_ns_to_ticks(t_wph);
	t.wr_cycle  = t.cs_wr_off + gpmc_round_ns_to_ticks(t_cez);

	/* Configure GPMC for asynchronous read */
	gpmc_cs_write_reg(cs, GPMC_CS_CONFIG1,
			  GPMC_CONFIG1_DEVICESIZE_16 |
			  GPMC_CONFIG1_MUXADDDATA);

	err = gpmc_cs_set_timings(cs, &t);
	if (err)
		return err;

	/* Ensure sync read and sync write are disabled */
	reg = readw(onenand_base + ONENAND_REG_SYS_CFG1);
	reg &= ~ONENAND_SYS_CFG1_SYNC_READ & ~ONENAND_SYS_CFG1_SYNC_WRITE;
	writew(reg, onenand_base + ONENAND_REG_SYS_CFG1);

	return 0;
}

static void set_onenand_cfg(void __iomem *onenand_base, int latency,
				int sync_read, int sync_write, int hf, int vhf)
{
	u32 reg;

	reg = readw(onenand_base + ONENAND_REG_SYS_CFG1);
	reg &= ~((0x7 << ONENAND_SYS_CFG1_BRL_SHIFT) | (0x7 << 9));
	reg |=	(latency << ONENAND_SYS_CFG1_BRL_SHIFT) |
		ONENAND_SYS_CFG1_BL_16;
	if (sync_read)
		reg |= ONENAND_SYS_CFG1_SYNC_READ;
	else
		reg &= ~ONENAND_SYS_CFG1_SYNC_READ;
	if (sync_write)
		reg |= ONENAND_SYS_CFG1_SYNC_WRITE;
	else
		reg &= ~ONENAND_SYS_CFG1_SYNC_WRITE;
	if (hf)
		reg |= ONENAND_SYS_CFG1_HF;
	else
		reg &= ~ONENAND_SYS_CFG1_HF;
	if (vhf)
		reg |= ONENAND_SYS_CFG1_VHF;
	else
		reg &= ~ONENAND_SYS_CFG1_VHF;
	writew(reg, onenand_base + ONENAND_REG_SYS_CFG1);
}

static int omap2_onenand_get_freq(struct omap_onenand_platform_data *cfg,
				  void __iomem *onenand_base, bool *clk_dep)
{
	u16 ver = readw(onenand_base + ONENAND_REG_VERSION_ID);
	int freq = 0;

	if (cfg->get_freq) {
		struct onenand_freq_info fi;

		fi.maf_id = readw(onenand_base + ONENAND_REG_MANUFACTURER_ID);
		fi.dev_id = readw(onenand_base + ONENAND_REG_DEVICE_ID);
		fi.ver_id = ver;
		freq = cfg->get_freq(&fi, clk_dep);
		if (freq)
			return freq;
	}

	switch ((ver >> 4) & 0xf) {
	case 0:
		freq = 40;
		break;
	case 1:
		freq = 54;
		break;
	case 2:
		freq = 66;
		break;
	case 3:
		freq = 83;
		break;
	case 4:
		freq = 104;
		break;
	default:
		freq = 54;
		break;
	}

	return freq;
}

static int omap2_onenand_set_sync_mode(struct omap_onenand_platform_data *cfg,
					void __iomem *onenand_base,
					int *freq_ptr)
{
	struct gpmc_timings t;
	const int t_cer  = 15;
	const int t_avdp = 12;
	const int t_cez  = 20; /* max of t_cez, t_oez */
	const int t_ds   = 30;
	const int t_wpl  = 40;
	const int t_wph  = 30;
	int min_gpmc_clk_period, t_ces, t_avds, t_avdh, t_ach, t_aavdh, t_rdyo;
	int div, fclk_offset_ns, fclk_offset, gpmc_clk_ns, latency;
	int first_time = 0, hf = 0, vhf = 0, sync_read = 0, sync_write = 0;
	int err, ticks_cez;
	int cs = cfg->cs, freq = *freq_ptr;
	u32 reg;
	bool clk_dep = false;

	if (cfg->flags & ONENAND_SYNC_READ) {
		sync_read = 1;
	} else if (cfg->flags & ONENAND_SYNC_READWRITE) {
		sync_read = 1;
		sync_write = 1;
	} else
		return omap2_onenand_set_async_mode(cs, onenand_base);

	if (!freq) {
		/* Very first call freq is not known */
		err = omap2_onenand_set_async_mode(cs, onenand_base);
		if (err)
			return err;
		freq = omap2_onenand_get_freq(cfg, onenand_base, &clk_dep);
		first_time = 1;
	}

	switch (freq) {
	case 104:
		min_gpmc_clk_period = 9600; /* 104 MHz */
		t_ces   = 3;
		t_avds  = 4;
		t_avdh  = 2;
		t_ach   = 3;
		t_aavdh = 6;
		t_rdyo  = 6;
		break;
	case 83:
		min_gpmc_clk_period = 12000; /* 83 MHz */
		t_ces   = 5;
		t_avds  = 4;
		t_avdh  = 2;
		t_ach   = 6;
		t_aavdh = 6;
		t_rdyo  = 9;
		break;
	case 66:
		min_gpmc_clk_period = 15000; /* 66 MHz */
		t_ces   = 6;
		t_avds  = 5;
		t_avdh  = 2;
		t_ach   = 6;
		t_aavdh = 6;
		t_rdyo  = 11;
		break;
	default:
		min_gpmc_clk_period = 18500; /* 54 MHz */
		t_ces   = 7;
		t_avds  = 7;
		t_avdh  = 7;
		t_ach   = 9;
		t_aavdh = 7;
		t_rdyo  = 15;
		sync_write = 0;
		break;
	}

	div = gpmc_cs_calc_divider(cs, min_gpmc_clk_period);
	gpmc_clk_ns = gpmc_ticks_to_ns(div);
	if (gpmc_clk_ns < 15) /* >66Mhz */
		hf = 1;
	if (gpmc_clk_ns < 12) /* >83Mhz */
		vhf = 1;
	if (vhf)
		latency = 8;
	else if (hf)
		latency = 6;
	else if (gpmc_clk_ns >= 25) /* 40 MHz*/
		latency = 3;
	else
		latency = 4;

	if (clk_dep) {
		if (gpmc_clk_ns < 12) { /* >83Mhz */
			t_ces   = 3;
			t_avds  = 4;
		} else if (gpmc_clk_ns < 15) { /* >66Mhz */
			t_ces   = 5;
			t_avds  = 4;
		} else if (gpmc_clk_ns < 25) { /* >40Mhz */
			t_ces   = 6;
			t_avds  = 5;
		} else {
			t_ces   = 7;
			t_avds  = 7;
		}
	}

	if (first_time)
		set_onenand_cfg(onenand_base, latency,
					sync_read, sync_write, hf, vhf);

	if (div == 1) {
		reg = gpmc_cs_read_reg(cs, GPMC_CS_CONFIG2);
		reg |= (1 << 7);
		gpmc_cs_write_reg(cs, GPMC_CS_CONFIG2, reg);
		reg = gpmc_cs_read_reg(cs, GPMC_CS_CONFIG3);
		reg |= (1 << 7);
		gpmc_cs_write_reg(cs, GPMC_CS_CONFIG3, reg);
		reg = gpmc_cs_read_reg(cs, GPMC_CS_CONFIG4);
		reg |= (1 << 7);
		reg |= (1 << 23);
		gpmc_cs_write_reg(cs, GPMC_CS_CONFIG4, reg);
	} else {
		reg = gpmc_cs_read_reg(cs, GPMC_CS_CONFIG2);
		reg &= ~(1 << 7);
		gpmc_cs_write_reg(cs, GPMC_CS_CONFIG2, reg);
		reg = gpmc_cs_read_reg(cs, GPMC_CS_CONFIG3);
		reg &= ~(1 << 7);
		gpmc_cs_write_reg(cs, GPMC_CS_CONFIG3, reg);
		reg = gpmc_cs_read_reg(cs, GPMC_CS_CONFIG4);
		reg &= ~(1 << 7);
		reg &= ~(1 << 23);
		gpmc_cs_write_reg(cs, GPMC_CS_CONFIG4, reg);
	}

	/* Set synchronous read timings */
	memset(&t, 0, sizeof(t));
	t.sync_clk = min_gpmc_clk_period;
	t.cs_on = 0;
	t.adv_on = 0;
	fclk_offset_ns = gpmc_round_ns_to_ticks(max_t(int, t_ces, t_avds));
	fclk_offset = gpmc_ns_to_ticks(fclk_offset_ns);
	t.page_burst_access = gpmc_clk_ns;

	/* Read */
	t.adv_rd_off = gpmc_ticks_to_ns(fclk_offset + gpmc_ns_to_ticks(t_avdh));
	t.oe_on = gpmc_ticks_to_ns(fclk_offset + gpmc_ns_to_ticks(t_ach));
	/* Force at least 1 clk between AVD High to OE Low */
	if (t.oe_on <= t.adv_rd_off)
		t.oe_on = t.adv_rd_off + gpmc_round_ns_to_ticks(1);
	t.access = gpmc_ticks_to_ns(fclk_offset + (latency + 1) * div);
	t.oe_off = t.access + gpmc_round_ns_to_ticks(1);
	t.cs_rd_off = t.oe_off;
	ticks_cez = ((gpmc_ns_to_ticks(t_cez) + div - 1) / div) * div;
	t.rd_cycle = gpmc_ticks_to_ns(fclk_offset + (latency + 1) * div +
		     ticks_cez);

	/* Write */
	if (sync_write) {
		t.adv_wr_off = t.adv_rd_off;
		t.we_on  = 0;
		t.we_off = t.cs_rd_off;
		t.cs_wr_off = t.cs_rd_off;
		t.wr_cycle  = t.rd_cycle;
		if (cpu_is_omap34xx()) {
			t.wr_data_mux_bus = gpmc_ticks_to_ns(fclk_offset +
					gpmc_ps_to_ticks(min_gpmc_clk_period +
					t_rdyo * 1000));
			t.wr_access = t.access;
		}
	} else {
		t.adv_wr_off = gpmc_round_ns_to_ticks(max_t(int,
							t_avdp, t_cer));
		t.we_on  = t.adv_wr_off + gpmc_round_ns_to_ticks(t_aavdh);
		t.we_off = t.we_on + gpmc_round_ns_to_ticks(t_wpl);
		t.cs_wr_off = t.we_off + gpmc_round_ns_to_ticks(t_wph);
		t.wr_cycle  = t.cs_wr_off + gpmc_round_ns_to_ticks(t_cez);
		if (cpu_is_omap34xx()) {
			t.wr_data_mux_bus = t.we_on;
			t.wr_access = t.we_on + gpmc_round_ns_to_ticks(t_ds);
		}
	}

	/* Configure GPMC for synchronous read */
	gpmc_cs_write_reg(cs, GPMC_CS_CONFIG1,
			  GPMC_CONFIG1_WRAPBURST_SUPP |
			  GPMC_CONFIG1_READMULTIPLE_SUPP |
			  (sync_read ? GPMC_CONFIG1_READTYPE_SYNC : 0) |
			  (sync_write ? GPMC_CONFIG1_WRITEMULTIPLE_SUPP : 0) |
			  (sync_write ? GPMC_CONFIG1_WRITETYPE_SYNC : 0) |
			  GPMC_CONFIG1_CLKACTIVATIONTIME(fclk_offset) |
			  GPMC_CONFIG1_PAGE_LEN(2) |
			  (cpu_is_omap34xx() ? 0 :
				(GPMC_CONFIG1_WAIT_READ_MON |
				 GPMC_CONFIG1_WAIT_PIN_SEL(0))) |
			  GPMC_CONFIG1_DEVICESIZE_16 |
			  GPMC_CONFIG1_DEVICETYPE_NOR |
			  GPMC_CONFIG1_MUXADDDATA);

	err = gpmc_cs_set_timings(cs, &t);
	if (err)
		return err;

	set_onenand_cfg(onenand_base, latency, sync_read, sync_write, hf, vhf);

	*freq_ptr = freq;

	return 0;
}

static int gpmc_onenand_setup(void __iomem *onenand_base, int *freq_ptr)
{
	struct device *dev = &gpmc_onenand_device.dev;

	/* Set sync timings in GPMC */
	if (omap2_onenand_set_sync_mode(gpmc_onenand_data, onenand_base,
			freq_ptr) < 0) {
		dev_err(dev, "Unable to set synchronous mode\n");
		return -EINVAL;
	}

	return 0;
}

void __init gpmc_onenand_init(struct omap_onenand_platform_data *_onenand_data)
{
	int err;

	gpmc_onenand_data = _onenand_data;
	gpmc_onenand_data->onenand_setup = gpmc_onenand_setup;
	gpmc_onenand_device.dev.platform_data = gpmc_onenand_data;

	if (cpu_is_omap24xx() &&
			(gpmc_onenand_data->flags & ONENAND_SYNC_READWRITE)) {
		printk(KERN_ERR "Onenand using only SYNC_READ on 24xx\n");
		gpmc_onenand_data->flags &= ~ONENAND_SYNC_READWRITE;
		gpmc_onenand_data->flags |= ONENAND_SYNC_READ;
	}

	err = gpmc_cs_request(gpmc_onenand_data->cs, ONENAND_IO_SIZE,
				(unsigned long *)&gpmc_onenand_resource.start);
	if (err < 0) {
		pr_err("%s: Cannot request GPMC CS\n", __func__);
		return;
	}

	gpmc_onenand_resource.end = gpmc_onenand_resource.start +
							ONENAND_IO_SIZE - 1;

	if (platform_device_register(&gpmc_onenand_device) < 0) {
		pr_err("%s: Unable to register OneNAND device\n", __func__);
		gpmc_cs_free(gpmc_onenand_data->cs);
		return;
	}
}
Commit	Line	Data
aa62e90f JY	1	/*
	2	* linux/arch/arm/mach-omap2/gpmc-onenand.c
	3	*
	4	* Copyright (C) 2006 - 2009 Nokia Corporation
	5	* Contacts: Juha Yrjola
	6	* Tony Lindgren
	7	*
	8	* This program is free software; you can redistribute it and/or modify
	9	* it under the terms of the GNU General Public License version 2 as
	10	* published by the Free Software Foundation.
	11	*/
	12
d44b28c4	13	#include <linux/string.h>
aa62e90f JY	14	#include <linux/kernel.h>
	15	#include <linux/platform_device.h>
	16	#include <linux/mtd/onenand_regs.h>
	17	#include <linux/io.h>
2203747c	18	#include <linux/platform_data/mtd-onenand-omap2.h>
aa62e90f JY	19
	20	#include <asm/mach/flash.h>
	21
ce491cf8	22	#include <plat/gpmc.h>
aa62e90f	23
dbc04161 TL	24	#include "soc.h"
dbc04161 TL	25
681988ba AM	26	#define ONENAND_IO_SIZE SZ_128K
681988ba AM	27
aa62e90f JY	28	static struct omap_onenand_platform_data *gpmc_onenand_data;
aa62e90f JY	29
681988ba AM	30	static struct resource gpmc_onenand_resource = {
	31	.flags = IORESOURCE_MEM,
	32	};
	33
aa62e90f JY	34	static struct platform_device gpmc_onenand_device = {
	35	.name = "omap2-onenand",
	36	.id = -1,
681988ba AM	37	.num_resources = 1,
681988ba AM	38	.resource = &gpmc_onenand_resource,
aa62e90f JY	39	};
	40
	41	static int omap2_onenand_set_async_mode(int cs, void __iomem *onenand_base)
	42	{
	43	struct gpmc_timings t;
6d453e84 AH	44	u32 reg;
6d453e84 AH	45	int err;
aa62e90f JY	46
	47	const int t_cer = 15;
	48	const int t_avdp = 12;
	49	const int t_aavdh = 7;
	50	const int t_ce = 76;
	51	const int t_aa = 76;
	52	const int t_oe = 20;
	53	const int t_cez = 20; /* max of t_cez, t_oez */
	54	const int t_ds = 30;
	55	const int t_wpl = 40;
	56	const int t_wph = 30;
	57
6d453e84 AH	58	/* Ensure sync read and sync write are disabled */
	59	reg = readw(onenand_base + ONENAND_REG_SYS_CFG1);
	60	reg &= ~ONENAND_SYS_CFG1_SYNC_READ & ~ONENAND_SYS_CFG1_SYNC_WRITE;
	61	writew(reg, onenand_base + ONENAND_REG_SYS_CFG1);
	62
aa62e90f JY	63	memset(&t, 0, sizeof(t));
	64	t.sync_clk = 0;
	65	t.cs_on = 0;
	66	t.adv_on = 0;
	67
	68	/* Read */
	69	t.adv_rd_off = gpmc_round_ns_to_ticks(max_t(int, t_avdp, t_cer));
	70	t.oe_on = t.adv_rd_off + gpmc_round_ns_to_ticks(t_aavdh);
	71	t.access = t.adv_on + gpmc_round_ns_to_ticks(t_aa);
	72	t.access = max_t(int, t.access, t.cs_on + gpmc_round_ns_to_ticks(t_ce));
	73	t.access = max_t(int, t.access, t.oe_on + gpmc_round_ns_to_ticks(t_oe));
	74	t.oe_off = t.access + gpmc_round_ns_to_ticks(1);
	75	t.cs_rd_off = t.oe_off;
	76	t.rd_cycle = t.cs_rd_off + gpmc_round_ns_to_ticks(t_cez);
	77
	78	/* Write */
	79	t.adv_wr_off = t.adv_rd_off;
	80	t.we_on = t.oe_on;
	81	if (cpu_is_omap34xx()) {
	82	t.wr_data_mux_bus = t.we_on;
	83	t.wr_access = t.we_on + gpmc_round_ns_to_ticks(t_ds);
	84	}
	85	t.we_off = t.we_on + gpmc_round_ns_to_ticks(t_wpl);
	86	t.cs_wr_off = t.we_off + gpmc_round_ns_to_ticks(t_wph);
	87	t.wr_cycle = t.cs_wr_off + gpmc_round_ns_to_ticks(t_cez);
	88
	89	/* Configure GPMC for asynchronous read */
	90	gpmc_cs_write_reg(cs, GPMC_CS_CONFIG1,
	91	GPMC_CONFIG1_DEVICESIZE_16 \|
	92	GPMC_CONFIG1_MUXADDDATA);
	93
6d453e84 AH	94	err = gpmc_cs_set_timings(cs, &t);
	95	if (err)
	96	return err;
	97
	98	/* Ensure sync read and sync write are disabled */
	99	reg = readw(onenand_base + ONENAND_REG_SYS_CFG1);
	100	reg &= ~ONENAND_SYS_CFG1_SYNC_READ & ~ONENAND_SYS_CFG1_SYNC_WRITE;
	101	writew(reg, onenand_base + ONENAND_REG_SYS_CFG1);
	102
	103	return 0;
aa62e90f JY	104	}
	105
	106	static void set_onenand_cfg(void __iomem *onenand_base, int latency,
1435ca0f	107	int sync_read, int sync_write, int hf, int vhf)
aa62e90f JY	108	{
	109	u32 reg;
	110
	111	reg = readw(onenand_base + ONENAND_REG_SYS_CFG1);
	112	reg &= ~((0x7 << ONENAND_SYS_CFG1_BRL_SHIFT) \| (0x7 << 9));
	113	reg \|= (latency << ONENAND_SYS_CFG1_BRL_SHIFT) \|
	114	ONENAND_SYS_CFG1_BL_16;
	115	if (sync_read)
	116	reg \|= ONENAND_SYS_CFG1_SYNC_READ;
	117	else
	118	reg &= ~ONENAND_SYS_CFG1_SYNC_READ;
	119	if (sync_write)
	120	reg \|= ONENAND_SYS_CFG1_SYNC_WRITE;
	121	else
	122	reg &= ~ONENAND_SYS_CFG1_SYNC_WRITE;
	123	if (hf)
	124	reg \|= ONENAND_SYS_CFG1_HF;
	125	else
	126	reg &= ~ONENAND_SYS_CFG1_HF;
1435ca0f AH	127	if (vhf)
	128	reg \|= ONENAND_SYS_CFG1_VHF;
	129	else
	130	reg &= ~ONENAND_SYS_CFG1_VHF;
aa62e90f JY	131	writew(reg, onenand_base + ONENAND_REG_SYS_CFG1);
	132	}
	133
5714b7ed AH	134	static int omap2_onenand_get_freq(struct omap_onenand_platform_data *cfg,
	135	void __iomem onenand_base, bool clk_dep)
	136	{
	137	u16 ver = readw(onenand_base + ONENAND_REG_VERSION_ID);
	138	int freq = 0;
	139
	140	if (cfg->get_freq) {
	141	struct onenand_freq_info fi;
	142
	143	fi.maf_id = readw(onenand_base + ONENAND_REG_MANUFACTURER_ID);
	144	fi.dev_id = readw(onenand_base + ONENAND_REG_DEVICE_ID);
	145	fi.ver_id = ver;
	146	freq = cfg->get_freq(&fi, clk_dep);
	147	if (freq)
	148	return freq;
	149	}
	150
	151	switch ((ver >> 4) & 0xf) {
	152	case 0:
	153	freq = 40;
	154	break;
	155	case 1:
	156	freq = 54;
	157	break;
	158	case 2:
	159	freq = 66;
	160	break;
	161	case 3:
	162	freq = 83;
	163	break;
	164	case 4:
	165	freq = 104;
	166	break;
	167	default:
	168	freq = 54;
	169	break;
	170	}
	171
	172	return freq;
	173	}
	174
aa62e90f JY	175	static int omap2_onenand_set_sync_mode(struct omap_onenand_platform_data *cfg,
aa62e90f JY	176	void __iomem *onenand_base,
3ad2d861	177	int *freq_ptr)
aa62e90f JY	178	{
	179	struct gpmc_timings t;
	180	const int t_cer = 15;
	181	const int t_avdp = 12;
	182	const int t_cez = 20; /* max of t_cez, t_oez */
	183	const int t_ds = 30;
	184	const int t_wpl = 40;
	185	const int t_wph = 30;
	186	int min_gpmc_clk_period, t_ces, t_avds, t_avdh, t_ach, t_aavdh, t_rdyo;
eeb3711b	187	int div, fclk_offset_ns, fclk_offset, gpmc_clk_ns, latency;
1435ca0f	188	int first_time = 0, hf = 0, vhf = 0, sync_read = 0, sync_write = 0;
aa62e90f	189	int err, ticks_cez;
3ad2d861	190	int cs = cfg->cs, freq = *freq_ptr;
aa62e90f	191	u32 reg;
5714b7ed	192	bool clk_dep = false;
aa62e90f JY	193
	194	if (cfg->flags & ONENAND_SYNC_READ) {
	195	sync_read = 1;
	196	} else if (cfg->flags & ONENAND_SYNC_READWRITE) {
	197	sync_read = 1;
	198	sync_write = 1;
6d453e84 AH	199	} else
6d453e84 AH	200	return omap2_onenand_set_async_mode(cs, onenand_base);
aa62e90f JY	201
	202	if (!freq) {
	203	/* Very first call freq is not known */
	204	err = omap2_onenand_set_async_mode(cs, onenand_base);
	205	if (err)
	206	return err;
5714b7ed	207	freq = omap2_onenand_get_freq(cfg, onenand_base, &clk_dep);
aa62e90f JY	208	first_time = 1;
	209	}
	210
	211	switch (freq) {
4931445b AH	212	case 104:
	213	min_gpmc_clk_period = 9600; /* 104 MHz */
	214	t_ces = 3;
	215	t_avds = 4;
	216	t_avdh = 2;
	217	t_ach = 3;
	218	t_aavdh = 6;
1435ca0f	219	t_rdyo = 6;
4931445b	220	break;
aa62e90f	221	case 83:
a3551f5b	222	min_gpmc_clk_period = 12000; /* 83 MHz */
aa62e90f JY	223	t_ces = 5;
	224	t_avds = 4;
	225	t_avdh = 2;
	226	t_ach = 6;
	227	t_aavdh = 6;
	228	t_rdyo = 9;
	229	break;
	230	case 66:
a3551f5b	231	min_gpmc_clk_period = 15000; /* 66 MHz */
aa62e90f JY	232	t_ces = 6;
	233	t_avds = 5;
	234	t_avdh = 2;
	235	t_ach = 6;
	236	t_aavdh = 6;
	237	t_rdyo = 11;
	238	break;
	239	default:
a3551f5b	240	min_gpmc_clk_period = 18500; /* 54 MHz */
aa62e90f JY	241	t_ces = 7;
	242	t_avds = 7;
	243	t_avdh = 7;
	244	t_ach = 9;
	245	t_aavdh = 7;
	246	t_rdyo = 15;
	247	sync_write = 0;
	248	break;
	249	}
	250
aa62e90f JY	251	div = gpmc_cs_calc_divider(cs, min_gpmc_clk_period);
	252	gpmc_clk_ns = gpmc_ticks_to_ns(div);
	253	if (gpmc_clk_ns < 15) /* >66Mhz */
	254	hf = 1;
1435ca0f AH	255	if (gpmc_clk_ns < 12) /* >83Mhz */
	256	vhf = 1;
	257	if (vhf)
	258	latency = 8;
	259	else if (hf)
aa62e90f JY	260	latency = 6;
	261	else if (gpmc_clk_ns >= 25) /* 40 MHz*/
	262	latency = 3;
	263	else
	264	latency = 4;
	265
5714b7ed AH	266	if (clk_dep) {
	267	if (gpmc_clk_ns < 12) { /* >83Mhz */
	268	t_ces = 3;
	269	t_avds = 4;
	270	} else if (gpmc_clk_ns < 15) { /* >66Mhz */
	271	t_ces = 5;
	272	t_avds = 4;
	273	} else if (gpmc_clk_ns < 25) { /* >40Mhz */
	274	t_ces = 6;
	275	t_avds = 5;
	276	} else {
	277	t_ces = 7;
	278	t_avds = 7;
	279	}
	280	}
	281
aa62e90f JY	282	if (first_time)
aa62e90f JY	283	set_onenand_cfg(onenand_base, latency,
1435ca0f	284	sync_read, sync_write, hf, vhf);
aa62e90f JY	285
	286	if (div == 1) {
	287	reg = gpmc_cs_read_reg(cs, GPMC_CS_CONFIG2);
	288	reg \|= (1 << 7);
	289	gpmc_cs_write_reg(cs, GPMC_CS_CONFIG2, reg);
	290	reg = gpmc_cs_read_reg(cs, GPMC_CS_CONFIG3);
	291	reg \|= (1 << 7);
	292	gpmc_cs_write_reg(cs, GPMC_CS_CONFIG3, reg);
	293	reg = gpmc_cs_read_reg(cs, GPMC_CS_CONFIG4);
	294	reg \|= (1 << 7);
	295	reg \|= (1 << 23);
	296	gpmc_cs_write_reg(cs, GPMC_CS_CONFIG4, reg);
	297	} else {
	298	reg = gpmc_cs_read_reg(cs, GPMC_CS_CONFIG2);
	299	reg &= ~(1 << 7);
	300	gpmc_cs_write_reg(cs, GPMC_CS_CONFIG2, reg);
	301	reg = gpmc_cs_read_reg(cs, GPMC_CS_CONFIG3);
	302	reg &= ~(1 << 7);
	303	gpmc_cs_write_reg(cs, GPMC_CS_CONFIG3, reg);
	304	reg = gpmc_cs_read_reg(cs, GPMC_CS_CONFIG4);
	305	reg &= ~(1 << 7);
	306	reg &= ~(1 << 23);
	307	gpmc_cs_write_reg(cs, GPMC_CS_CONFIG4, reg);
	308	}
	309
	310	/* Set synchronous read timings */
	311	memset(&t, 0, sizeof(t));
	312	t.sync_clk = min_gpmc_clk_period;
	313	t.cs_on = 0;
	314	t.adv_on = 0;
	315	fclk_offset_ns = gpmc_round_ns_to_ticks(max_t(int, t_ces, t_avds));
	316	fclk_offset = gpmc_ns_to_ticks(fclk_offset_ns);
	317	t.page_burst_access = gpmc_clk_ns;
	318
	319	/* Read */
	320	t.adv_rd_off = gpmc_ticks_to_ns(fclk_offset + gpmc_ns_to_ticks(t_avdh));
	321	t.oe_on = gpmc_ticks_to_ns(fclk_offset + gpmc_ns_to_ticks(t_ach));
1435ca0f AH	322	/* Force at least 1 clk between AVD High to OE Low */
	323	if (t.oe_on <= t.adv_rd_off)
	324	t.oe_on = t.adv_rd_off + gpmc_round_ns_to_ticks(1);
aa62e90f JY	325	t.access = gpmc_ticks_to_ns(fclk_offset + (latency + 1) * div);
	326	t.oe_off = t.access + gpmc_round_ns_to_ticks(1);
	327	t.cs_rd_off = t.oe_off;
	328	ticks_cez = ((gpmc_ns_to_ticks(t_cez) + div - 1) / div) * div;
	329	t.rd_cycle = gpmc_ticks_to_ns(fclk_offset + (latency + 1) * div +
	330	ticks_cez);
	331
	332	/* Write */
	333	if (sync_write) {
	334	t.adv_wr_off = t.adv_rd_off;
	335	t.we_on = 0;
	336	t.we_off = t.cs_rd_off;
	337	t.cs_wr_off = t.cs_rd_off;
	338	t.wr_cycle = t.rd_cycle;
	339	if (cpu_is_omap34xx()) {
	340	t.wr_data_mux_bus = gpmc_ticks_to_ns(fclk_offset +
a3551f5b AH	341	gpmc_ps_to_ticks(min_gpmc_clk_period +
a3551f5b AH	342	t_rdyo * 1000));
aa62e90f JY	343	t.wr_access = t.access;
	344	}
	345	} else {
	346	t.adv_wr_off = gpmc_round_ns_to_ticks(max_t(int,
	347	t_avdp, t_cer));
	348	t.we_on = t.adv_wr_off + gpmc_round_ns_to_ticks(t_aavdh);
	349	t.we_off = t.we_on + gpmc_round_ns_to_ticks(t_wpl);
	350	t.cs_wr_off = t.we_off + gpmc_round_ns_to_ticks(t_wph);
	351	t.wr_cycle = t.cs_wr_off + gpmc_round_ns_to_ticks(t_cez);
	352	if (cpu_is_omap34xx()) {
	353	t.wr_data_mux_bus = t.we_on;
	354	t.wr_access = t.we_on + gpmc_round_ns_to_ticks(t_ds);
	355	}
	356	}
	357
	358	/* Configure GPMC for synchronous read */
	359	gpmc_cs_write_reg(cs, GPMC_CS_CONFIG1,
	360	GPMC_CONFIG1_WRAPBURST_SUPP \|
	361	GPMC_CONFIG1_READMULTIPLE_SUPP \|
	362	(sync_read ? GPMC_CONFIG1_READTYPE_SYNC : 0) \|
	363	(sync_write ? GPMC_CONFIG1_WRITEMULTIPLE_SUPP : 0) \|
	364	(sync_write ? GPMC_CONFIG1_WRITETYPE_SYNC : 0) \|
	365	GPMC_CONFIG1_CLKACTIVATIONTIME(fclk_offset) \|
	366	GPMC_CONFIG1_PAGE_LEN(2) \|
	367	(cpu_is_omap34xx() ? 0 :
	368	(GPMC_CONFIG1_WAIT_READ_MON \|
	369	GPMC_CONFIG1_WAIT_PIN_SEL(0))) \|
	370	GPMC_CONFIG1_DEVICESIZE_16 \|
	371	GPMC_CONFIG1_DEVICETYPE_NOR \|
	372	GPMC_CONFIG1_MUXADDDATA);
	373
	374	err = gpmc_cs_set_timings(cs, &t);
	375	if (err)
	376	return err;
	377
1435ca0f	378	set_onenand_cfg(onenand_base, latency, sync_read, sync_write, hf, vhf);
aa62e90f	379
3ad2d861 AH	380	*freq_ptr = freq;
3ad2d861 AH	381
aa62e90f JY	382	return 0;
	383	}
	384
3ad2d861	385	static int gpmc_onenand_setup(void __iomem onenand_base, int freq_ptr)
aa62e90f JY	386	{
	387	struct device *dev = &gpmc_onenand_device.dev;
	388
	389	/* Set sync timings in GPMC */
	390	if (omap2_onenand_set_sync_mode(gpmc_onenand_data, onenand_base,
3ad2d861	391	freq_ptr) < 0) {
aa62e90f JY	392	dev_err(dev, "Unable to set synchronous mode\n");
	393	return -EINVAL;
	394	}
	395
	396	return 0;
	397	}
	398
	399	void __init gpmc_onenand_init(struct omap_onenand_platform_data *_onenand_data)
	400	{
681988ba AM	401	int err;
681988ba AM	402
aa62e90f JY	403	gpmc_onenand_data = _onenand_data;
	404	gpmc_onenand_data->onenand_setup = gpmc_onenand_setup;
	405	gpmc_onenand_device.dev.platform_data = gpmc_onenand_data;
	406
	407	if (cpu_is_omap24xx() &&
	408	(gpmc_onenand_data->flags & ONENAND_SYNC_READWRITE)) {
	409	printk(KERN_ERR "Onenand using only SYNC_READ on 24xx\n");
	410	gpmc_onenand_data->flags &= ~ONENAND_SYNC_READWRITE;
	411	gpmc_onenand_data->flags \|= ONENAND_SYNC_READ;
	412	}
	413
681988ba AM	414	err = gpmc_cs_request(gpmc_onenand_data->cs, ONENAND_IO_SIZE,
	415	(unsigned long *)&gpmc_onenand_resource.start);
	416	if (err < 0) {
	417	pr_err("%s: Cannot request GPMC CS\n", __func__);
	418	return;
	419	}
	420
	421	gpmc_onenand_resource.end = gpmc_onenand_resource.start +
	422	ONENAND_IO_SIZE - 1;
	423
aa62e90f	424	if (platform_device_register(&gpmc_onenand_device) < 0) {
681988ba AM	425	pr_err("%s: Unable to register OneNAND device\n", __func__);
681988ba AM	426	gpmc_cs_free(gpmc_onenand_data->cs);
aa62e90f JY	427	return;
	428	}
	429	}