| /* |
| * (C) Copyright 2008 |
| * Sergei Poselenov, Emcraft Systems, sposelenov@emcraft.com. |
| * |
| * See file CREDITS for list of people who contributed to this |
| * project. |
| * |
| * This program is free software; you can redistribute it and/or |
| * modify it under the terms of the GNU General Public License as |
| * published by the Free Software Foundation; either version 2 of |
| * the License, or (at your option) any later version. |
| * |
| * This program is distributed in the hope that it will be useful, |
| * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| * GNU General Public License for more details. |
| * |
| * You should have received a copy of the GNU General Public License |
| * along with this program; if not, write to the Free Software |
| * Foundation, Inc., 59 Temple Place, Suite 330, Boston, |
| * MA 02111-1307 USA |
| */ |
| |
| #include <common.h> |
| |
| #if defined(CONFIG_SYS_NAND_BASE) |
| #include <nand.h> |
| #include <asm/errno.h> |
| #include <asm/io.h> |
| |
| static int state; |
| static void sc_nand_write_byte(struct mtd_info *mtd, u_char byte); |
| static void sc_nand_write_buf(struct mtd_info *mtd, const u_char *buf, int len); |
| static u_char sc_nand_read_byte(struct mtd_info *mtd); |
| static u16 sc_nand_read_word(struct mtd_info *mtd); |
| static void sc_nand_read_buf(struct mtd_info *mtd, u_char *buf, int len); |
| static int sc_nand_verify_buf(struct mtd_info *mtd, const u_char *buf, int len); |
| static int sc_nand_device_ready(struct mtd_info *mtdinfo); |
| |
| #define FPGA_NAND_CMD_MASK (0x7 << 28) |
| #define FPGA_NAND_CMD_COMMAND (0x0 << 28) |
| #define FPGA_NAND_CMD_ADDR (0x1 << 28) |
| #define FPGA_NAND_CMD_READ (0x2 << 28) |
| #define FPGA_NAND_CMD_WRITE (0x3 << 28) |
| #define FPGA_NAND_BUSY (0x1 << 15) |
| #define FPGA_NAND_ENABLE (0x1 << 31) |
| #define FPGA_NAND_DATA_SHIFT 16 |
| |
| /** |
| * sc_nand_write_byte - write one byte to the chip |
| * @mtd: MTD device structure |
| * @byte: pointer to data byte to write |
| */ |
| static void sc_nand_write_byte(struct mtd_info *mtd, u_char byte) |
| { |
| sc_nand_write_buf(mtd, (const uchar *)&byte, sizeof(byte)); |
| } |
| |
| /** |
| * sc_nand_write_buf - write buffer to chip |
| * @mtd: MTD device structure |
| * @buf: data buffer |
| * @len: number of bytes to write |
| */ |
| static void sc_nand_write_buf(struct mtd_info *mtd, const u_char *buf, int len) |
| { |
| int i; |
| struct nand_chip *this = mtd->priv; |
| |
| for (i = 0; i < len; i++) { |
| out_be32(this->IO_ADDR_W, |
| state | (buf[i] << FPGA_NAND_DATA_SHIFT)); |
| } |
| } |
| |
| |
| /** |
| * sc_nand_read_byte - read one byte from the chip |
| * @mtd: MTD device structure |
| */ |
| static u_char sc_nand_read_byte(struct mtd_info *mtd) |
| { |
| u8 byte; |
| sc_nand_read_buf(mtd, (uchar *)&byte, sizeof(byte)); |
| return byte; |
| } |
| |
| /** |
| * sc_nand_read_word - read one word from the chip |
| * @mtd: MTD device structure |
| */ |
| static u16 sc_nand_read_word(struct mtd_info *mtd) |
| { |
| u16 word; |
| sc_nand_read_buf(mtd, (uchar *)&word, sizeof(word)); |
| return word; |
| } |
| |
| /** |
| * sc_nand_read_buf - read chip data into buffer |
| * @mtd: MTD device structure |
| * @buf: buffer to store date |
| * @len: number of bytes to read |
| */ |
| static void sc_nand_read_buf(struct mtd_info *mtd, u_char *buf, int len) |
| { |
| int i; |
| struct nand_chip *this = mtd->priv; |
| int val; |
| |
| val = (state & FPGA_NAND_ENABLE) | FPGA_NAND_CMD_READ; |
| |
| out_be32(this->IO_ADDR_W, val); |
| for (i = 0; i < len; i++) { |
| buf[i] = (in_be32(this->IO_ADDR_R) >> FPGA_NAND_DATA_SHIFT) & 0xff; |
| } |
| } |
| |
| /** |
| * sc_nand_verify_buf - Verify chip data against buffer |
| * @mtd: MTD device structure |
| * @buf: buffer containing the data to compare |
| * @len: number of bytes to compare |
| */ |
| static int sc_nand_verify_buf(struct mtd_info *mtd, const u_char *buf, int len) |
| { |
| int i; |
| |
| for (i = 0; i < len; i++) { |
| if (buf[i] != sc_nand_read_byte(mtd)); |
| return -EFAULT; |
| } |
| return 0; |
| } |
| |
| /** |
| * sc_nand_device_ready - Check the NAND device is ready for next command. |
| * @mtd: MTD device structure |
| */ |
| static int sc_nand_device_ready(struct mtd_info *mtdinfo) |
| { |
| struct nand_chip *this = mtdinfo->priv; |
| |
| if (in_be32(this->IO_ADDR_W) & FPGA_NAND_BUSY) |
| return 0; /* busy */ |
| return 1; |
| } |
| |
| /** |
| * sc_nand_hwcontrol - NAND control functions wrapper. |
| * @mtd: MTD device structure |
| * @cmd: Command |
| */ |
| static void sc_nand_hwcontrol(struct mtd_info *mtdinfo, int cmd, unsigned int ctrl) |
| { |
| if (ctrl & NAND_CTRL_CHANGE) { |
| state &= ~(FPGA_NAND_CMD_MASK | FPGA_NAND_ENABLE); |
| |
| switch (ctrl & (NAND_ALE | NAND_CLE)) { |
| case 0: |
| state |= FPGA_NAND_CMD_WRITE; |
| break; |
| |
| case NAND_ALE: |
| state |= FPGA_NAND_CMD_ADDR; |
| break; |
| |
| case NAND_CLE: |
| state |= FPGA_NAND_CMD_COMMAND; |
| break; |
| |
| default: |
| printf("%s: unknown ctrl %#x\n", __FUNCTION__, ctrl); |
| } |
| |
| if (ctrl & NAND_NCE) |
| state |= FPGA_NAND_ENABLE; |
| } |
| |
| if (cmd != NAND_CMD_NONE) |
| sc_nand_write_byte(mtdinfo, cmd); |
| } |
| |
| int board_nand_init(struct nand_chip *nand) |
| { |
| nand->cmd_ctrl = sc_nand_hwcontrol; |
| nand->ecc.mode = NAND_ECC_SOFT; |
| nand->dev_ready = sc_nand_device_ready; |
| nand->read_byte = sc_nand_read_byte; |
| nand->read_word = sc_nand_read_word; |
| nand->write_buf = sc_nand_write_buf; |
| nand->read_buf = sc_nand_read_buf; |
| nand->verify_buf = sc_nand_verify_buf; |
| |
| return 0; |
| } |
| |
| #endif |