4 * Copyright (C) 2007 MontaVista Software, Inc.
5 * Anton Vorontsov <avorontsov@ru.mvista.com>
7 * This program is free software; you can redistribute it and/or
8 * modify it under the terms of the GNU General Public License as
9 * published by the Free Software Foundation; either version 2 of
10 * the License, or (at your option) any later version.
16 #include <asm/errno.h>
17 #include <linux/mtd/mtd.h>
18 #include <linux/mtd/fsl_upm.h>
21 static void fsl_upm_start_pattern(struct fsl_upm *upm, u32 pat_offset)
23 clrsetbits_be32(upm->mxmr, MxMR_MAD_MSK, MxMR_OP_RUNP | pat_offset);
26 static void fsl_upm_end_pattern(struct fsl_upm *upm)
28 clrbits_be32(upm->mxmr, MxMR_OP_RUNP);
30 while (in_be32(upm->mxmr) & MxMR_OP_RUNP)
34 static void fsl_upm_run_pattern(struct fsl_upm *upm, int width,
35 void __iomem *io_addr, u32 mar)
37 out_be32(upm->mar, mar);
43 out_be16(io_addr, 0x0);
46 out_be32(io_addr, 0x0);
51 static void fun_wait(struct fsl_upm_nand *fun)
54 while (!fun->dev_ready(fun->chip_nr))
55 debug("unexpected busy state\n");
58 * If the R/B pin is not connected, like on the TQM8548,
59 * a short delay is necessary.
65 #if CONFIG_SYS_NAND_MAX_CHIPS > 1
66 static void fun_select_chip(struct mtd_info *mtd, int chip_nr)
68 struct nand_chip *chip = mtd->priv;
69 struct fsl_upm_nand *fun = chip->priv;
72 fun->chip_nr = chip_nr;
73 chip->IO_ADDR_R = chip->IO_ADDR_W =
74 fun->upm.io_addr + fun->chip_offset * chip_nr;
75 } else if (chip_nr == -1) {
76 chip->cmd_ctrl(mtd, NAND_CMD_NONE, 0 | NAND_CTRL_CHANGE);
81 static void fun_cmd_ctrl(struct mtd_info *mtd, int cmd, unsigned int ctrl)
83 struct nand_chip *chip = mtd->priv;
84 struct fsl_upm_nand *fun = chip->priv;
85 void __iomem *io_addr;
88 if (!(ctrl & fun->last_ctrl)) {
89 fsl_upm_end_pattern(&fun->upm);
91 if (cmd == NAND_CMD_NONE)
94 fun->last_ctrl = ctrl & (NAND_ALE | NAND_CLE);
97 if (ctrl & NAND_CTRL_CHANGE) {
99 fsl_upm_start_pattern(&fun->upm, fun->upm_addr_offset);
100 else if (ctrl & NAND_CLE)
101 fsl_upm_start_pattern(&fun->upm, fun->upm_cmd_offset);
104 mar = cmd << (32 - fun->width);
105 io_addr = fun->upm.io_addr;
106 #if CONFIG_SYS_NAND_MAX_CHIPS > 1
107 if (fun->chip_nr > 0) {
108 io_addr += fun->chip_offset * fun->chip_nr;
109 if (fun->upm_mar_chip_offset)
110 mar |= fun->upm_mar_chip_offset * fun->chip_nr;
113 fsl_upm_run_pattern(&fun->upm, fun->width, io_addr, mar);
116 * Some boards/chips needs this. At least the MPC8360E-RDK and
117 * TQM8548 need it. Probably weird chip, because I don't see
118 * any need for this on MPC8555E + Samsung K9F1G08U0A. Usually
119 * here are 0-2 unexpected busy states per block read.
121 if (fun->wait_flags & FSL_UPM_WAIT_RUN_PATTERN)
125 static u8 nand_read_byte(struct mtd_info *mtd)
127 struct nand_chip *chip = mtd->priv;
129 return in_8(chip->IO_ADDR_R);
132 static void nand_write_buf(struct mtd_info *mtd, const u_char *buf, int len)
135 struct nand_chip *chip = mtd->priv;
136 struct fsl_upm_nand *fun = chip->priv;
138 for (i = 0; i < len; i++) {
139 out_8(chip->IO_ADDR_W, buf[i]);
140 if (fun->wait_flags & FSL_UPM_WAIT_WRITE_BYTE)
144 if (fun->wait_flags & FSL_UPM_WAIT_WRITE_BUFFER)
148 static void nand_read_buf(struct mtd_info *mtd, u_char *buf, int len)
151 struct nand_chip *chip = mtd->priv;
153 for (i = 0; i < len; i++)
154 buf[i] = in_8(chip->IO_ADDR_R);
157 static int nand_verify_buf(struct mtd_info *mtd, const u_char *buf, int len)
160 struct nand_chip *chip = mtd->priv;
162 for (i = 0; i < len; i++) {
163 if (buf[i] != in_8(chip->IO_ADDR_R))
170 static int nand_dev_ready(struct mtd_info *mtd)
172 struct nand_chip *chip = mtd->priv;
173 struct fsl_upm_nand *fun = chip->priv;
175 return fun->dev_ready(fun->chip_nr);
178 int fsl_upm_nand_init(struct nand_chip *chip, struct fsl_upm_nand *fun)
180 if (fun->width != 8 && fun->width != 16 && fun->width != 32)
183 fun->last_ctrl = NAND_CLE;
186 chip->chip_delay = fun->chip_delay;
187 chip->ecc.mode = NAND_ECC_SOFT;
188 chip->cmd_ctrl = fun_cmd_ctrl;
189 #if CONFIG_SYS_NAND_MAX_CHIPS > 1
190 chip->select_chip = fun_select_chip;
192 chip->read_byte = nand_read_byte;
193 chip->read_buf = nand_read_buf;
194 chip->write_buf = nand_write_buf;
195 chip->verify_buf = nand_verify_buf;
197 chip->dev_ready = nand_dev_ready;