1 // SPDX-License-Identifier: GPL-2.0+
5 * Copyright (C) 2007 MontaVista Software, Inc.
6 * Anton Vorontsov <avorontsov@ru.mvista.com>
12 #include <linux/errno.h>
13 #include <linux/mtd/mtd.h>
14 #include <linux/mtd/fsl_upm.h>
17 static void fsl_upm_start_pattern(struct fsl_upm *upm, u32 pat_offset)
19 clrsetbits_be32(upm->mxmr, MxMR_MAD_MSK, MxMR_OP_RUNP | pat_offset);
20 (void)in_be32(upm->mxmr);
23 static void fsl_upm_end_pattern(struct fsl_upm *upm)
25 clrbits_be32(upm->mxmr, MxMR_OP_RUNP);
27 while (in_be32(upm->mxmr) & MxMR_OP_RUNP)
31 static void fsl_upm_run_pattern(struct fsl_upm *upm, int width,
32 void __iomem *io_addr, u32 mar)
34 out_be32(upm->mar, mar);
35 (void)in_be32(upm->mar);
41 out_be16(io_addr, 0x0);
44 out_be32(io_addr, 0x0);
49 static void fun_wait(struct fsl_upm_nand *fun)
52 while (!fun->dev_ready(fun->chip_nr))
53 debug("unexpected busy state\n");
56 * If the R/B pin is not connected,
57 * a short delay is necessary.
63 #if CONFIG_SYS_NAND_MAX_CHIPS > 1
64 static void fun_select_chip(struct mtd_info *mtd, int chip_nr)
66 struct nand_chip *chip = mtd_to_nand(mtd);
67 struct fsl_upm_nand *fun = nand_get_controller_data(chip);
70 fun->chip_nr = chip_nr;
71 chip->IO_ADDR_R = chip->IO_ADDR_W =
72 fun->upm.io_addr + fun->chip_offset * chip_nr;
73 } else if (chip_nr == -1) {
74 chip->cmd_ctrl(mtd, NAND_CMD_NONE, 0 | NAND_CTRL_CHANGE);
79 static void fun_cmd_ctrl(struct mtd_info *mtd, int cmd, unsigned int ctrl)
81 struct nand_chip *chip = mtd_to_nand(mtd);
82 struct fsl_upm_nand *fun = nand_get_controller_data(chip);
83 void __iomem *io_addr;
86 if (!(ctrl & fun->last_ctrl)) {
87 fsl_upm_end_pattern(&fun->upm);
89 if (cmd == NAND_CMD_NONE)
92 fun->last_ctrl = ctrl & (NAND_ALE | NAND_CLE);
95 if (ctrl & NAND_CTRL_CHANGE) {
97 fsl_upm_start_pattern(&fun->upm, fun->upm_addr_offset);
98 else if (ctrl & NAND_CLE)
99 fsl_upm_start_pattern(&fun->upm, fun->upm_cmd_offset);
102 mar = cmd << (32 - fun->width);
103 io_addr = fun->upm.io_addr;
104 #if CONFIG_SYS_NAND_MAX_CHIPS > 1
105 if (fun->chip_nr > 0) {
106 io_addr += fun->chip_offset * fun->chip_nr;
107 if (fun->upm_mar_chip_offset)
108 mar |= fun->upm_mar_chip_offset * fun->chip_nr;
111 fsl_upm_run_pattern(&fun->upm, fun->width, io_addr, mar);
114 * Some boards/chips needs this. At least the MPC8360E-RDK
115 * needs it. Probably weird chip, because I don't see any
116 * need for this on MPC8555E + Samsung K9F1G08U0A. Usually
117 * here are 0-2 unexpected busy states per block read.
119 if (fun->wait_flags & FSL_UPM_WAIT_RUN_PATTERN)
123 static u8 upm_nand_read_byte(struct mtd_info *mtd)
125 struct nand_chip *chip = mtd_to_nand(mtd);
127 return in_8(chip->IO_ADDR_R);
130 static void upm_nand_write_buf(struct mtd_info *mtd, const u_char *buf, int len)
133 struct nand_chip *chip = mtd_to_nand(mtd);
134 struct fsl_upm_nand *fun = nand_get_controller_data(chip);
136 for (i = 0; i < len; i++) {
137 out_8(chip->IO_ADDR_W, buf[i]);
138 if (fun->wait_flags & FSL_UPM_WAIT_WRITE_BYTE)
142 if (fun->wait_flags & FSL_UPM_WAIT_WRITE_BUFFER)
146 static void upm_nand_read_buf(struct mtd_info *mtd, u_char *buf, int len)
149 struct nand_chip *chip = mtd_to_nand(mtd);
151 for (i = 0; i < len; i++)
152 buf[i] = in_8(chip->IO_ADDR_R);
155 static int nand_dev_ready(struct mtd_info *mtd)
157 struct nand_chip *chip = mtd_to_nand(mtd);
158 struct fsl_upm_nand *fun = nand_get_controller_data(chip);
160 return fun->dev_ready(fun->chip_nr);
163 int fsl_upm_nand_init(struct nand_chip *chip, struct fsl_upm_nand *fun)
165 if (fun->width != 8 && fun->width != 16 && fun->width != 32)
168 fun->last_ctrl = NAND_CLE;
170 nand_set_controller_data(chip, fun);
171 chip->chip_delay = fun->chip_delay;
172 chip->ecc.mode = NAND_ECC_SOFT;
173 chip->cmd_ctrl = fun_cmd_ctrl;
174 #if CONFIG_SYS_NAND_MAX_CHIPS > 1
175 chip->select_chip = fun_select_chip;
177 chip->read_byte = upm_nand_read_byte;
178 chip->read_buf = upm_nand_read_buf;
179 chip->write_buf = upm_nand_write_buf;
181 chip->dev_ready = nand_dev_ready;