blob: 7137d125580581f729bd8c6099c7f7ee1d32596f (
plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
|
/*
* 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_write16() */
MAKE_FLASH(32, l) /* flash_write32() flash_write32() */
MAKE_FLASH(64, q) /* flash_write64() flash_write64() */
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);
}
|
