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

/*
 * linux/arch/arm/mach-at91/sam9_smc.c
 *
 * Copyright (C) 2008 Andrew Victor
 * Copyright (C) 2011 Jean-Christophe PLAGNIOL-VILLARD <plagnioj@jcrosoft.com>
 *
 * 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/module.h>
#include <linux/io.h>
#include <linux/of.h>
#include <linux/of_address.h>

#include <mach/at91sam9_smc.h>

#include "sam9_smc.h"


#define AT91_SMC_CS(id, n)	(smc_base_addr[id] + ((n) * 0x10))

static void __iomem *smc_base_addr[2];

static void sam9_smc_cs_write_mode(void __iomem *base,
					struct sam9_smc_config *config)
{
	__raw_writel(config->mode
		   | AT91_SMC_TDF_(config->tdf_cycles),
		   base + AT91_SMC_MODE);
}

void sam9_smc_write_mode(int id, int cs,
					struct sam9_smc_config *config)
{
	sam9_smc_cs_write_mode(AT91_SMC_CS(id, cs), config);
}
EXPORT_SYMBOL_GPL(sam9_smc_write_mode);

static void sam9_smc_cs_configure(void __iomem *base,
					struct sam9_smc_config *config)
{

	/* Setup register */
	__raw_writel(AT91_SMC_NWESETUP_(config->nwe_setup)
		   | AT91_SMC_NCS_WRSETUP_(config->ncs_write_setup)
		   | AT91_SMC_NRDSETUP_(config->nrd_setup)
		   | AT91_SMC_NCS_RDSETUP_(config->ncs_read_setup),
		   base + AT91_SMC_SETUP);

	/* Pulse register */
	__raw_writel(AT91_SMC_NWEPULSE_(config->nwe_pulse)
		   | AT91_SMC_NCS_WRPULSE_(config->ncs_write_pulse)
		   | AT91_SMC_NRDPULSE_(config->nrd_pulse)
		   | AT91_SMC_NCS_RDPULSE_(config->ncs_read_pulse),
		   base + AT91_SMC_PULSE);

	/* Cycle register */
	__raw_writel(AT91_SMC_NWECYCLE_(config->write_cycle)
		   | AT91_SMC_NRDCYCLE_(config->read_cycle),
		   base + AT91_SMC_CYCLE);

	/* Mode register */
	sam9_smc_cs_write_mode(base, config);
}

void sam9_smc_configure(int id, int cs,
					struct sam9_smc_config *config)
{
	sam9_smc_cs_configure(AT91_SMC_CS(id, cs), config);
}
EXPORT_SYMBOL_GPL(sam9_smc_configure);

static void sam9_smc_cs_read_mode(void __iomem *base,
					struct sam9_smc_config *config)
{
	u32 val = __raw_readl(base + AT91_SMC_MODE);

	config->mode = (val & ~AT91_SMC_NWECYCLE);
	config->tdf_cycles = (val & AT91_SMC_NWECYCLE) >> 16 ;
}

void sam9_smc_read_mode(int id, int cs,
					struct sam9_smc_config *config)
{
	sam9_smc_cs_read_mode(AT91_SMC_CS(id, cs), config);
}
EXPORT_SYMBOL_GPL(sam9_smc_read_mode);

static void sam9_smc_cs_read(void __iomem *base,
					struct sam9_smc_config *config)
{
	u32 val;

	/* Setup register */
	val = __raw_readl(base + AT91_SMC_SETUP);

	config->nwe_setup = val & AT91_SMC_NWESETUP;
	config->ncs_write_setup = (val & AT91_SMC_NCS_WRSETUP) >> 8;
	config->nrd_setup = (val & AT91_SMC_NRDSETUP) >> 16;
	config->ncs_read_setup = (val & AT91_SMC_NCS_RDSETUP) >> 24;

	/* Pulse register */
	val = __raw_readl(base + AT91_SMC_PULSE);

	config->nwe_pulse = val & AT91_SMC_NWEPULSE;
	config->ncs_write_pulse = (val & AT91_SMC_NCS_WRPULSE) >> 8;
	config->nrd_pulse = (val & AT91_SMC_NRDPULSE) >> 16;
	config->ncs_read_pulse = (val & AT91_SMC_NCS_RDPULSE) >> 24;

	/* Cycle register */
	val = __raw_readl(base + AT91_SMC_CYCLE);

	config->write_cycle = val & AT91_SMC_NWECYCLE;
	config->read_cycle = (val & AT91_SMC_NRDCYCLE) >> 16;

	/* Mode register */
	sam9_smc_cs_read_mode(base, config);
}

void sam9_smc_read(int id, int cs, struct sam9_smc_config *config)
{
	sam9_smc_cs_read(AT91_SMC_CS(id, cs), config);
}

void __init at91sam9_ioremap_smc(int id, u32 addr)
{
	if (id > 1) {
		pr_warn("%s: id > 2\n", __func__);
		return;
	}
	smc_base_addr[id] = ioremap(addr, 512);
	if (!smc_base_addr[id])
		pr_warn("Impossible to ioremap smc.%d 0x%x\n", id, addr);
}
Commit	Line	Data
6781002b AV	1	/*
	2	* linux/arch/arm/mach-at91/sam9_smc.c
	3	*
	4	* Copyright (C) 2008 Andrew Victor
59594e13	5	* Copyright (C) 2011 Jean-Christophe PLAGNIOL-VILLARD <plagnioj@jcrosoft.com>
6781002b AV	6	*
	7	* This program is free software; you can redistribute it and/or modify
	8	* it under the terms of the GNU General Public License version 2 as
	9	* published by the Free Software Foundation.
	10	*/
	11
	12	#include <linux/module.h>
	13	#include <linux/io.h>
faee0cc3 JCPV	14	#include <linux/of.h>
faee0cc3 JCPV	15	#include <linux/of_address.h>
6781002b AV	16
	17	#include <mach/at91sam9_smc.h>
	18
	19	#include "sam9_smc.h"
	20
faee0cc3 JCPV	21
	22	#define AT91_SMC_CS(id, n) (smc_base_addr[id] + ((n) * 0x10))
	23
	24	static void __iomem *smc_base_addr[2];
	25
59594e13 JCPV	26	static void sam9_smc_cs_write_mode(void __iomem *base,
	27	struct sam9_smc_config *config)
	28	{
	29	__raw_writel(config->mode
	30	\| AT91_SMC_TDF_(config->tdf_cycles),
	31	base + AT91_SMC_MODE);
	32	}
	33
	34	void sam9_smc_write_mode(int id, int cs,
	35	struct sam9_smc_config *config)
	36	{
	37	sam9_smc_cs_write_mode(AT91_SMC_CS(id, cs), config);
	38	}
c85fc989	39	EXPORT_SYMBOL_GPL(sam9_smc_write_mode);
59594e13 JCPV	40
	41	static void sam9_smc_cs_configure(void __iomem *base,
	42	struct sam9_smc_config *config)
6781002b	43	{
faee0cc3	44
6781002b	45	/* Setup register */
faee0cc3 JCPV	46	__raw_writel(AT91_SMC_NWESETUP_(config->nwe_setup)
	47	\| AT91_SMC_NCS_WRSETUP_(config->ncs_write_setup)
	48	\| AT91_SMC_NRDSETUP_(config->nrd_setup)
	49	\| AT91_SMC_NCS_RDSETUP_(config->ncs_read_setup),
	50	base + AT91_SMC_SETUP);
6781002b AV	51
6781002b AV	52	/* Pulse register */
faee0cc3 JCPV	53	__raw_writel(AT91_SMC_NWEPULSE_(config->nwe_pulse)
	54	\| AT91_SMC_NCS_WRPULSE_(config->ncs_write_pulse)
	55	\| AT91_SMC_NRDPULSE_(config->nrd_pulse)
	56	\| AT91_SMC_NCS_RDPULSE_(config->ncs_read_pulse),
	57	base + AT91_SMC_PULSE);
6781002b AV	58
6781002b AV	59	/* Cycle register */
faee0cc3 JCPV	60	__raw_writel(AT91_SMC_NWECYCLE_(config->write_cycle)
	61	\| AT91_SMC_NRDCYCLE_(config->read_cycle),
	62	base + AT91_SMC_CYCLE);
6781002b AV	63
6781002b AV	64	/* Mode register */
59594e13	65	sam9_smc_cs_write_mode(base, config);
faee0cc3 JCPV	66	}
faee0cc3 JCPV	67
59594e13 JCPV	68	void sam9_smc_configure(int id, int cs,
59594e13 JCPV	69	struct sam9_smc_config *config)
faee0cc3 JCPV	70	{
	71	sam9_smc_cs_configure(AT91_SMC_CS(id, cs), config);
	72	}
c85fc989	73	EXPORT_SYMBOL_GPL(sam9_smc_configure);
faee0cc3	74
59594e13 JCPV	75	static void sam9_smc_cs_read_mode(void __iomem *base,
	76	struct sam9_smc_config *config)
	77	{
	78	u32 val = __raw_readl(base + AT91_SMC_MODE);
	79
	80	config->mode = (val & ~AT91_SMC_NWECYCLE);
	81	config->tdf_cycles = (val & AT91_SMC_NWECYCLE) >> 16 ;
	82	}
	83
	84	void sam9_smc_read_mode(int id, int cs,
	85	struct sam9_smc_config *config)
	86	{
	87	sam9_smc_cs_read_mode(AT91_SMC_CS(id, cs), config);
	88	}
c85fc989	89	EXPORT_SYMBOL_GPL(sam9_smc_read_mode);
59594e13 JCPV	90
	91	static void sam9_smc_cs_read(void __iomem *base,
	92	struct sam9_smc_config *config)
	93	{
	94	u32 val;
	95
	96	/* Setup register */
	97	val = __raw_readl(base + AT91_SMC_SETUP);
	98
	99	config->nwe_setup = val & AT91_SMC_NWESETUP;
	100	config->ncs_write_setup = (val & AT91_SMC_NCS_WRSETUP) >> 8;
	101	config->nrd_setup = (val & AT91_SMC_NRDSETUP) >> 16;
	102	config->ncs_read_setup = (val & AT91_SMC_NCS_RDSETUP) >> 24;
	103
	104	/* Pulse register */
	105	val = __raw_readl(base + AT91_SMC_PULSE);
	106
1588c51c	107	config->nwe_pulse = val & AT91_SMC_NWEPULSE;
59594e13 JCPV	108	config->ncs_write_pulse = (val & AT91_SMC_NCS_WRPULSE) >> 8;
	109	config->nrd_pulse = (val & AT91_SMC_NRDPULSE) >> 16;
	110	config->ncs_read_pulse = (val & AT91_SMC_NCS_RDPULSE) >> 24;
	111
	112	/* Cycle register */
	113	val = __raw_readl(base + AT91_SMC_CYCLE);
	114
	115	config->write_cycle = val & AT91_SMC_NWECYCLE;
	116	config->read_cycle = (val & AT91_SMC_NRDCYCLE) >> 16;
	117
	118	/* Mode register */
	119	sam9_smc_cs_read_mode(base, config);
	120	}
	121
	122	void sam9_smc_read(int id, int cs, struct sam9_smc_config *config)
	123	{
	124	sam9_smc_cs_read(AT91_SMC_CS(id, cs), config);
	125	}
	126
faee0cc3 JCPV	127	void __init at91sam9_ioremap_smc(int id, u32 addr)
	128	{
	129	if (id > 1) {
	130	pr_warn("%s: id > 2\n", __func__);
	131	return;
	132	}
	133	smc_base_addr[id] = ioremap(addr, 512);
	134	if (!smc_base_addr[id])
	135	pr_warn("Impossible to ioremap smc.%d 0x%x\n", id, addr);
6781002b	136	}