]>
Commit | Line | Data |
---|---|---|
83d290c5 | 1 | // SPDX-License-Identifier: GPL-2.0+ |
fd51b0e0 SP |
2 | /* |
3 | * (C) Copyright 2008 | |
4 | * Sergei Poselenov, Emcraft Systems, [email protected]. | |
fd51b0e0 SP |
5 | */ |
6 | ||
7 | #include <common.h> | |
8 | ||
4e590945 | 9 | #if defined(CFG_SYS_NAND_BASE) |
fd51b0e0 | 10 | #include <nand.h> |
1221ce45 | 11 | #include <linux/errno.h> |
1cefed1e | 12 | #include <linux/mtd/rawnand.h> |
fd51b0e0 SP |
13 | #include <asm/io.h> |
14 | ||
15 | static int state; | |
169de905 MV |
16 | static void sc_nand_write_byte(struct mtd_info *mtd, u_char byte); |
17 | static void sc_nand_write_buf(struct mtd_info *mtd, const u_char *buf, int len); | |
18 | static u_char sc_nand_read_byte(struct mtd_info *mtd); | |
19 | static u16 sc_nand_read_word(struct mtd_info *mtd); | |
20 | static void sc_nand_read_buf(struct mtd_info *mtd, u_char *buf, int len); | |
169de905 | 21 | static int sc_nand_device_ready(struct mtd_info *mtdinfo); |
fd51b0e0 SP |
22 | |
23 | #define FPGA_NAND_CMD_MASK (0x7 << 28) | |
68cf19aa | 24 | #define FPGA_NAND_CMD_COMMAND (0x0 << 28) |
fd51b0e0 SP |
25 | #define FPGA_NAND_CMD_ADDR (0x1 << 28) |
26 | #define FPGA_NAND_CMD_READ (0x2 << 28) | |
27 | #define FPGA_NAND_CMD_WRITE (0x3 << 28) | |
28 | #define FPGA_NAND_BUSY (0x1 << 15) | |
29 | #define FPGA_NAND_ENABLE (0x1 << 31) | |
68cf19aa | 30 | #define FPGA_NAND_DATA_SHIFT 16 |
fd51b0e0 SP |
31 | |
32 | /** | |
169de905 | 33 | * sc_nand_write_byte - write one byte to the chip |
fd51b0e0 SP |
34 | * @mtd: MTD device structure |
35 | * @byte: pointer to data byte to write | |
36 | */ | |
169de905 | 37 | static void sc_nand_write_byte(struct mtd_info *mtd, u_char byte) |
fd51b0e0 | 38 | { |
169de905 | 39 | sc_nand_write_buf(mtd, (const uchar *)&byte, sizeof(byte)); |
fd51b0e0 SP |
40 | } |
41 | ||
fd51b0e0 | 42 | /** |
169de905 | 43 | * sc_nand_write_buf - write buffer to chip |
fd51b0e0 SP |
44 | * @mtd: MTD device structure |
45 | * @buf: data buffer | |
46 | * @len: number of bytes to write | |
47 | */ | |
169de905 | 48 | static void sc_nand_write_buf(struct mtd_info *mtd, const u_char *buf, int len) |
fd51b0e0 SP |
49 | { |
50 | int i; | |
17cb4b8f | 51 | struct nand_chip *this = mtd_to_nand(mtd); |
fd51b0e0 SP |
52 | |
53 | for (i = 0; i < len; i++) { | |
68cf19aa SW |
54 | out_be32(this->IO_ADDR_W, |
55 | state | (buf[i] << FPGA_NAND_DATA_SHIFT)); | |
fd51b0e0 SP |
56 | } |
57 | } | |
58 | ||
59 | ||
60 | /** | |
169de905 | 61 | * sc_nand_read_byte - read one byte from the chip |
fd51b0e0 SP |
62 | * @mtd: MTD device structure |
63 | */ | |
169de905 | 64 | static u_char sc_nand_read_byte(struct mtd_info *mtd) |
fd51b0e0 SP |
65 | { |
66 | u8 byte; | |
169de905 | 67 | sc_nand_read_buf(mtd, (uchar *)&byte, sizeof(byte)); |
fd51b0e0 SP |
68 | return byte; |
69 | } | |
70 | ||
71 | /** | |
169de905 | 72 | * sc_nand_read_word - read one word from the chip |
fd51b0e0 SP |
73 | * @mtd: MTD device structure |
74 | */ | |
169de905 | 75 | static u16 sc_nand_read_word(struct mtd_info *mtd) |
fd51b0e0 SP |
76 | { |
77 | u16 word; | |
169de905 | 78 | sc_nand_read_buf(mtd, (uchar *)&word, sizeof(word)); |
fd51b0e0 SP |
79 | return word; |
80 | } | |
81 | ||
82 | /** | |
169de905 | 83 | * sc_nand_read_buf - read chip data into buffer |
fd51b0e0 SP |
84 | * @mtd: MTD device structure |
85 | * @buf: buffer to store date | |
86 | * @len: number of bytes to read | |
87 | */ | |
169de905 | 88 | static void sc_nand_read_buf(struct mtd_info *mtd, u_char *buf, int len) |
fd51b0e0 SP |
89 | { |
90 | int i; | |
17cb4b8f | 91 | struct nand_chip *this = mtd_to_nand(mtd); |
fd51b0e0 SP |
92 | int val; |
93 | ||
94 | val = (state & FPGA_NAND_ENABLE) | FPGA_NAND_CMD_READ; | |
95 | ||
96 | out_be32(this->IO_ADDR_W, val); | |
97 | for (i = 0; i < len; i++) { | |
98 | buf[i] = (in_be32(this->IO_ADDR_R) >> FPGA_NAND_DATA_SHIFT) & 0xff; | |
99 | } | |
100 | } | |
101 | ||
fd51b0e0 | 102 | /** |
169de905 | 103 | * sc_nand_device_ready - Check the NAND device is ready for next command. |
fd51b0e0 SP |
104 | * @mtd: MTD device structure |
105 | */ | |
169de905 | 106 | static int sc_nand_device_ready(struct mtd_info *mtdinfo) |
fd51b0e0 | 107 | { |
17cb4b8f | 108 | struct nand_chip *this = mtd_to_nand(mtdinfo); |
fd51b0e0 SP |
109 | |
110 | if (in_be32(this->IO_ADDR_W) & FPGA_NAND_BUSY) | |
111 | return 0; /* busy */ | |
112 | return 1; | |
113 | } | |
114 | ||
115 | /** | |
169de905 | 116 | * sc_nand_hwcontrol - NAND control functions wrapper. |
fd51b0e0 SP |
117 | * @mtd: MTD device structure |
118 | * @cmd: Command | |
119 | */ | |
169de905 | 120 | static void sc_nand_hwcontrol(struct mtd_info *mtdinfo, int cmd, unsigned int ctrl) |
fd51b0e0 | 121 | { |
68cf19aa SW |
122 | if (ctrl & NAND_CTRL_CHANGE) { |
123 | state &= ~(FPGA_NAND_CMD_MASK | FPGA_NAND_ENABLE); | |
124 | ||
125 | switch (ctrl & (NAND_ALE | NAND_CLE)) { | |
126 | case 0: | |
127 | state |= FPGA_NAND_CMD_WRITE; | |
128 | break; | |
129 | ||
130 | case NAND_ALE: | |
131 | state |= FPGA_NAND_CMD_ADDR; | |
132 | break; | |
fd51b0e0 | 133 | |
68cf19aa SW |
134 | case NAND_CLE: |
135 | state |= FPGA_NAND_CMD_COMMAND; | |
136 | break; | |
137 | ||
138 | default: | |
139 | printf("%s: unknown ctrl %#x\n", __FUNCTION__, ctrl); | |
140 | } | |
141 | ||
142 | if (ctrl & NAND_NCE) | |
143 | state |= FPGA_NAND_ENABLE; | |
fd51b0e0 | 144 | } |
68cf19aa SW |
145 | |
146 | if (cmd != NAND_CMD_NONE) | |
169de905 | 147 | sc_nand_write_byte(mtdinfo, cmd); |
fd51b0e0 SP |
148 | } |
149 | ||
150 | int board_nand_init(struct nand_chip *nand) | |
151 | { | |
169de905 | 152 | nand->cmd_ctrl = sc_nand_hwcontrol; |
68cf19aa | 153 | nand->ecc.mode = NAND_ECC_SOFT; |
169de905 MV |
154 | nand->dev_ready = sc_nand_device_ready; |
155 | nand->read_byte = sc_nand_read_byte; | |
156 | nand->read_word = sc_nand_read_word; | |
157 | nand->write_buf = sc_nand_write_buf; | |
158 | nand->read_buf = sc_nand_read_buf; | |
fd51b0e0 SP |
159 | |
160 | return 0; | |
161 | } | |
162 | ||
163 | #endif |