mtd: rawnand: meson: check buffer length
Meson NAND controller has limited buffer length, so check it before command execution to avoid length trim. Also check MTD write size on chip attach. Signed-off-by: Arseniy Krasnov <AVKrasnov@sberdevices.ru> Signed-off-by: Miquel Raynal <miquel.raynal@bootlin.com> Link: https://lore.kernel.org/linux-mtd/20230609112840.2325455-1-AVKrasnov@sberdevices.ru
This commit is contained in:
parent
1a50947df5
commit
46c37b99b5
|
@ -109,6 +109,8 @@
|
|||
|
||||
#define PER_INFO_BYTE 8
|
||||
|
||||
#define NFC_CMD_RAW_LEN GENMASK(13, 0)
|
||||
|
||||
#define NFC_COLUMN_ADDR_0 0
|
||||
#define NFC_COLUMN_ADDR_1 0
|
||||
|
||||
|
@ -285,7 +287,7 @@ static void meson_nfc_cmd_access(struct nand_chip *nand, int raw, bool dir,
|
|||
|
||||
if (raw) {
|
||||
len = mtd->writesize + mtd->oobsize;
|
||||
cmd = (len & GENMASK(13, 0)) | scrambler | DMA_DIR(dir);
|
||||
cmd = len | scrambler | DMA_DIR(dir);
|
||||
writel(cmd, nfc->reg_base + NFC_REG_CMD);
|
||||
return;
|
||||
}
|
||||
|
@ -605,7 +607,7 @@ static int meson_nfc_read_buf(struct nand_chip *nand, u8 *buf, int len)
|
|||
if (ret)
|
||||
goto out;
|
||||
|
||||
cmd = NFC_CMD_N2M | (len & GENMASK(13, 0));
|
||||
cmd = NFC_CMD_N2M | len;
|
||||
writel(cmd, nfc->reg_base + NFC_REG_CMD);
|
||||
|
||||
meson_nfc_drain_cmd(nfc);
|
||||
|
@ -629,7 +631,7 @@ static int meson_nfc_write_buf(struct nand_chip *nand, u8 *buf, int len)
|
|||
if (ret)
|
||||
return ret;
|
||||
|
||||
cmd = NFC_CMD_M2N | (len & GENMASK(13, 0));
|
||||
cmd = NFC_CMD_M2N | len;
|
||||
writel(cmd, nfc->reg_base + NFC_REG_CMD);
|
||||
|
||||
meson_nfc_drain_cmd(nfc);
|
||||
|
@ -960,6 +962,31 @@ meson_nand_op_put_dma_safe_output_buf(const struct nand_op_instr *instr,
|
|||
kfree(buf);
|
||||
}
|
||||
|
||||
static int meson_nfc_check_op(struct nand_chip *chip,
|
||||
const struct nand_operation *op)
|
||||
{
|
||||
int op_id;
|
||||
|
||||
for (op_id = 0; op_id < op->ninstrs; op_id++) {
|
||||
const struct nand_op_instr *instr;
|
||||
|
||||
instr = &op->instrs[op_id];
|
||||
|
||||
switch (instr->type) {
|
||||
case NAND_OP_DATA_IN_INSTR:
|
||||
case NAND_OP_DATA_OUT_INSTR:
|
||||
if (instr->ctx.data.len > NFC_CMD_RAW_LEN)
|
||||
return -ENOTSUPP;
|
||||
|
||||
break;
|
||||
default:
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int meson_nfc_exec_op(struct nand_chip *nand,
|
||||
const struct nand_operation *op, bool check_only)
|
||||
{
|
||||
|
@ -968,8 +995,13 @@ static int meson_nfc_exec_op(struct nand_chip *nand,
|
|||
const struct nand_op_instr *instr = NULL;
|
||||
void *buf;
|
||||
u32 op_id, delay_idle, cmd;
|
||||
int err;
|
||||
int i;
|
||||
|
||||
err = meson_nfc_check_op(nand, op);
|
||||
if (err)
|
||||
return err;
|
||||
|
||||
if (check_only)
|
||||
return 0;
|
||||
|
||||
|
@ -1243,6 +1275,7 @@ static int meson_nand_attach_chip(struct nand_chip *nand)
|
|||
struct meson_nfc_nand_chip *meson_chip = to_meson_nand(nand);
|
||||
struct mtd_info *mtd = nand_to_mtd(nand);
|
||||
int nsectors = mtd->writesize / 1024;
|
||||
int raw_writesize;
|
||||
int ret;
|
||||
|
||||
if (!mtd->name) {
|
||||
|
@ -1254,6 +1287,13 @@ static int meson_nand_attach_chip(struct nand_chip *nand)
|
|||
return -ENOMEM;
|
||||
}
|
||||
|
||||
raw_writesize = mtd->writesize + mtd->oobsize;
|
||||
if (raw_writesize > NFC_CMD_RAW_LEN) {
|
||||
dev_err(nfc->dev, "too big write size in raw mode: %d > %ld\n",
|
||||
raw_writesize, NFC_CMD_RAW_LEN);
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
if (nand->bbt_options & NAND_BBT_USE_FLASH)
|
||||
nand->bbt_options |= NAND_BBT_NO_OOB;
|
||||
|
||||
|
|
Loading…
Reference in New Issue