2 * gpio_cfi_flash.c - GPIO-assisted Flash Chip Support
4 * Copyright (c) 2009 Analog Devices Inc.
6 * Licensed under the GPL-2 or later.
10 #include <asm/blackfin.h>
12 #include "gpio_cfi_flash.h"
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)
20 void *gpio_cfi_flash_swizzle(void *vaddr)
22 unsigned long addr = (unsigned long)vaddr;
24 if (addr & GPIO_MASK_1)
25 bfin_write_PORTFIO_SET(GPIO_PIN_1);
27 bfin_write_PORTFIO_CLEAR(GPIO_PIN_1);
30 if (addr & GPIO_MASK_2)
31 bfin_write_PORTFIO_SET(GPIO_PIN_2);
33 bfin_write_PORTFIO_CLEAR(GPIO_PIN_2);
38 return (void *)(addr & ~GPIO_MASK);
41 #define __raw_writeq(value, addr) *(volatile u64 *)addr = value
42 #define __raw_readq(addr) *(volatile u64 *)addr
44 #define MAKE_FLASH(size, sfx) \
45 void flash_write##size(u##size value, void *addr) \
47 __raw_write##sfx(value, gpio_cfi_flash_swizzle(addr)); \
49 u##size flash_read##size(void *addr) \
51 return __raw_read##sfx(gpio_cfi_flash_swizzle(addr)); \
53 MAKE_FLASH(8, b) /* flash_write8() flash_read8() */
54 MAKE_FLASH(16, w) /* flash_write16() flash_write16() */
55 MAKE_FLASH(32, l) /* flash_write32() flash_write32() */
56 MAKE_FLASH(64, q) /* flash_write64() flash_write64() */
58 void gpio_cfi_flash_init(void)
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);