[J-u-boot.git] / board / tcm-bf537 / gpio_cfi_flash.c

/*
 * gpio_cfi_flash.c - GPIO-assisted Flash Chip Support
 *
 * Copyright (c) 2009 Analog Devices Inc.
 *
 * Licensed under the GPL-2 or later.
 */

#include <common.h>
#include <asm/blackfin.h>
#include <asm/io.h>
#include "gpio_cfi_flash.h"

#define GPIO_PIN_1  PF4
#define GPIO_MASK_1 (1 << 21)
#define GPIO_PIN_2  PF5
#define GPIO_MASK_2 (1 << 22)
#define GPIO_MASK   (GPIO_MASK_1 | GPIO_MASK_2)

void *gpio_cfi_flash_swizzle(void *vaddr)
{
	unsigned long addr = (unsigned long)vaddr;

	if (addr & GPIO_MASK_1)
		bfin_write_PORTFIO_SET(GPIO_PIN_1);
	else
		bfin_write_PORTFIO_CLEAR(GPIO_PIN_1);

#ifdef GPIO_MASK_2
	if (addr & GPIO_MASK_2)
		bfin_write_PORTFIO_SET(GPIO_PIN_2);
	else
		bfin_write_PORTFIO_CLEAR(GPIO_PIN_2);
#endif

	SSYNC();

	return (void *)(addr & ~GPIO_MASK);
}

#define __raw_writeq(value, addr) *(volatile u64 *)addr = value
#define __raw_readq(addr) *(volatile u64 *)addr

#define MAKE_FLASH(size, sfx) \
void flash_write##size(u##size value, void *addr) \
{ \
	__raw_write##sfx(value, gpio_cfi_flash_swizzle(addr)); \
} \
u##size flash_read##size(void *addr) \
{ \
	return __raw_read##sfx(gpio_cfi_flash_swizzle(addr)); \
}
MAKE_FLASH(8, b)  /* flash_write8()  flash_read8() */
MAKE_FLASH(16, w) /* flash_write16() flash_read16() */
MAKE_FLASH(32, l) /* flash_write32() flash_read32() */
MAKE_FLASH(64, q) /* flash_write64() flash_read64() */

void gpio_cfi_flash_init(void)
{
	bfin_write_PORTFIO_DIR(bfin_read_PORTFIO_DIR() | GPIO_PIN_1 | GPIO_PIN_2);
	gpio_cfi_flash_swizzle((void *)CONFIG_SYS_FLASH_BASE);
}
Commit	Line	Data
9417d9a2 MF	1	/*
	2	* gpio_cfi_flash.c - GPIO-assisted Flash Chip Support
	3	*
	4	* Copyright (c) 2009 Analog Devices Inc.
	5	*
	6	* Licensed under the GPL-2 or later.
	7	*/
	8
	9	#include <common.h>
	10	#include <asm/blackfin.h>
	11	#include <asm/io.h>
	12	#include "gpio_cfi_flash.h"
	13
	14	#define GPIO_PIN_1 PF4
	15	#define GPIO_MASK_1 (1 << 21)
	16	#define GPIO_PIN_2 PF5
	17	#define GPIO_MASK_2 (1 << 22)
	18	#define GPIO_MASK (GPIO_MASK_1 \| GPIO_MASK_2)
	19
	20	void gpio_cfi_flash_swizzle(void vaddr)
	21	{
	22	unsigned long addr = (unsigned long)vaddr;
	23
	24	if (addr & GPIO_MASK_1)
	25	bfin_write_PORTFIO_SET(GPIO_PIN_1);
	26	else
	27	bfin_write_PORTFIO_CLEAR(GPIO_PIN_1);
	28
	29	#ifdef GPIO_MASK_2
	30	if (addr & GPIO_MASK_2)
	31	bfin_write_PORTFIO_SET(GPIO_PIN_2);
	32	else
	33	bfin_write_PORTFIO_CLEAR(GPIO_PIN_2);
	34	#endif
	35
	36	SSYNC();
	37
	38	return (void *)(addr & ~GPIO_MASK);
	39	}
	40
	41	#define __raw_writeq(value, addr) (volatile u64 )addr = value
	42	#define __raw_readq(addr) (volatile u64 )addr
	43
	44	#define MAKE_FLASH(size, sfx) \
	45	void flash_write##size(u##size value, void *addr) \
	46	{ \
	47	__raw_write##sfx(value, gpio_cfi_flash_swizzle(addr)); \
	48	} \
	49	u##size flash_read##size(void *addr) \
	50	{ \
	51	return __raw_read##sfx(gpio_cfi_flash_swizzle(addr)); \
	52	}
	53	MAKE_FLASH(8, b) /* flash_write8() flash_read8() */
e637385e MF	54	MAKE_FLASH(16, w) /* flash_write16() flash_read16() */
	55	MAKE_FLASH(32, l) /* flash_write32() flash_read32() */
	56	MAKE_FLASH(64, q) /* flash_write64() flash_read64() */
9417d9a2 MF	57
	58	void gpio_cfi_flash_init(void)
	59	{
	60	bfin_write_PORTFIO_DIR(bfin_read_PORTFIO_DIR() \| GPIO_PIN_1 \| GPIO_PIN_2);
	61	gpio_cfi_flash_swizzle((void *)CONFIG_SYS_FLASH_BASE);
	62	}