Received: by 2002:ac0:8c9a:0:0:0:0:0 with SMTP id r26csp2462276ima; Sat, 2 Feb 2019 23:36:24 -0800 (PST) X-Google-Smtp-Source: ALg8bN7rucSQZx7WlOeW7GnUxlJ/Fx6iTZIb9X2KiqJLnmjebTgyipPNy/+BhcMtWueYE59AMoXn X-Received: by 2002:a63:5e43:: with SMTP id s64mr42229471pgb.101.1549179384435; Sat, 02 Feb 2019 23:36:24 -0800 (PST) ARC-Seal: i=1; a=rsa-sha256; t=1549179384; cv=none; d=google.com; s=arc-20160816; b=H9VvmUzxD+KXfQtZPhBn/KxLBCwJ59J6WEGG3ptAsU+UCieXGUaDgFpOHqCsC7hDsS KPaLBeV3oa7LBljlT7afP2duFwXcHCnY7hYcmM3PMIZUBv+TFdRj99WQpA4D2pif5gVc ViqO8nPQwarZTh2Tu7q1VH2KyY/XLj8VcNGb2FDyLMhew0JIMfQG86pWkbdWEgAhnsJv 9RATNvZ+m4IT+hLyrlsohwnYC65T7Me4a40aI6KKVE0NPGeMpr+MjIKUMIA208Xh1PfI rCjzkVZjqb62HD00FxlXm6pn6PhKQ5m4npO6Fwpvry9/zxG0ZJIDQnBUGZIgV3C2eJv4 ffuA== ARC-Message-Signature: i=1; a=rsa-sha256; c=relaxed/relaxed; d=google.com; s=arc-20160816; h=list-id:precedence:sender:content-transfer-encoding:mime-version :references:in-reply-to:message-id:subject:cc:to:from:date :dkim-signature; bh=OGn8Cc5a0XOgOO+rk3sfiH15hGF5m1hkAeXoEkSFP70=; b=ICRU+NFu9oyhbDk9v5TAOjwXSDPz/JGYNIFaMUBGLEq2aU5L4KxqQ+QSv6HwHU0v+N A9weiWEihwK6SDq059gmEZINiatbSxZyrq05y7bJESk8KGtVdTxqjGVBfrAi4T+S2zCb ouIC2oER4VMrkNimDyYtss1Q4hggfDlF/EGzfeIUSw4N1uogb3vdXd4jFccKJadr0RIq mY26XpzNfX37k9TkSkkNEz0WphO8oPF1Fm2t7oW2u/Cwi0w8Q0lnPeGSwG4JDNyXs+3H 6CNLHgsOw0NJ0f+RhZNkscEvbEOX+FhsqVOusubjT9FeH8/0D/c1DuWfmi4gTwYSFFuT yuQQ== ARC-Authentication-Results: i=1; mx.google.com; dkim=pass header.i=@kernel.org header.s=default header.b=x+80ocae; spf=pass (google.com: best guess record for domain of linux-kernel-owner@vger.kernel.org designates 209.132.180.67 as permitted sender) smtp.mailfrom=linux-kernel-owner@vger.kernel.org; dmarc=pass (p=NONE sp=NONE dis=NONE) header.from=kernel.org Return-Path: Received: from vger.kernel.org (vger.kernel.org. [209.132.180.67]) by mx.google.com with ESMTP id bc3si2463204plb.130.2019.02.02.23.36.08; Sat, 02 Feb 2019 23:36:24 -0800 (PST) Received-SPF: pass (google.com: best guess record for domain of linux-kernel-owner@vger.kernel.org designates 209.132.180.67 as permitted sender) client-ip=209.132.180.67; Authentication-Results: mx.google.com; dkim=pass header.i=@kernel.org header.s=default header.b=x+80ocae; spf=pass (google.com: best guess record for domain of linux-kernel-owner@vger.kernel.org designates 209.132.180.67 as permitted sender) smtp.mailfrom=linux-kernel-owner@vger.kernel.org; dmarc=pass (p=NONE sp=NONE dis=NONE) header.from=kernel.org Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S1727531AbfBCHfS (ORCPT + 99 others); Sun, 3 Feb 2019 02:35:18 -0500 Received: from mail.kernel.org ([198.145.29.99]:58050 "EHLO mail.kernel.org" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S1725891AbfBCHfR (ORCPT ); Sun, 3 Feb 2019 02:35:17 -0500 Received: from bbrezillon (91-160-177-164.subs.proxad.net [91.160.177.164]) (using TLSv1.2 with cipher ECDHE-RSA-AES256-GCM-SHA384 (256/256 bits)) (No client certificate requested) by mail.kernel.org (Postfix) with ESMTPSA id D97C42075B; Sun, 3 Feb 2019 07:35:11 +0000 (UTC) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/simple; d=kernel.org; s=default; t=1549179316; bh=oTR9s6qvfrcP8iTi7jJSmWe+Z4LNKbrkx3DeU0QAUS0=; h=Date:From:To:Cc:Subject:In-Reply-To:References:From; b=x+80ocaeMMfqDe+9I7G98jh/P45qoKrZ/89sjZRnLpcrGNAHucZeNoaG64t4qajNb fHwdoQrGLzeYYJ4e0GbBIPD8JlK7MlUx4bsjzOiXlgu5RbvLnkA+bqsatHnRiqf/os kPs2qeP1KX092X+9jNltIG+c7nX5C1P4U832wfi4= Date: Sun, 3 Feb 2019 08:35:05 +0100 From: Boris Brezillon To: Paul Cercueil Cc: David Woodhouse , Brian Norris , Marek Vasut , Richard Weinberger , Rob Herring , Mark Rutland , Miquel Raynal , Harvey Hunt , Mathieu Malaterre , linux-mtd@lists.infradead.org, devicetree@vger.kernel.org, linux-kernel@vger.kernel.org Subject: Re: [PATCH v2 9/9] mtd: rawnand: jz4780-bch: Add support for the JZ4740 Message-ID: <20190203083505.4dc52278@bbrezillon> In-Reply-To: <20190202231926.2444-10-paul@crapouillou.net> References: <20190202231926.2444-1-paul@crapouillou.net> <20190202231926.2444-10-paul@crapouillou.net> X-Mailer: Claws Mail 3.16.0 (GTK+ 2.24.32; x86_64-pc-linux-gnu) MIME-Version: 1.0 Content-Type: text/plain; charset=US-ASCII Content-Transfer-Encoding: 7bit Sender: linux-kernel-owner@vger.kernel.org Precedence: bulk List-ID: X-Mailing-List: linux-kernel@vger.kernel.org On Sat, 2 Feb 2019 20:19:26 -0300 Paul Cercueil wrote: > Add the backend code for the jz4780-bch driver to support the JZ4740 > SoC from Ingenic. > > Signed-off-by: Paul Cercueil > --- > > Changes: > > v2: New patch > > drivers/mtd/nand/raw/ingenic/Makefile | 2 +- > drivers/mtd/nand/raw/ingenic/jz4740_bch.c | 173 ++++++++++++++++++ > .../mtd/nand/raw/ingenic/jz4780_bch_common.c | 1 + > .../nand/raw/ingenic/jz4780_bch_internal.h | 1 + > 4 files changed, 176 insertions(+), 1 deletion(-) > create mode 100644 drivers/mtd/nand/raw/ingenic/jz4740_bch.c > > diff --git a/drivers/mtd/nand/raw/ingenic/Makefile b/drivers/mtd/nand/raw/ingenic/Makefile > index f38b467490cf..d16c96113a93 100644 > --- a/drivers/mtd/nand/raw/ingenic/Makefile > +++ b/drivers/mtd/nand/raw/ingenic/Makefile > @@ -1,3 +1,3 @@ > obj-$(CONFIG_MTD_NAND_JZ4740) += jz4740_nand.o > obj-$(CONFIG_MTD_NAND_JZ4780) += jz4780_nand.o jz4780_bch_common.o \ > - jz4780_bch.o jz4725b_bch.o > + jz4780_bch.o jz4725b_bch.o jz4740_bch.o I still don't see the point of the jz4780_bch_common/jz47xxx_bch separation. You seem to always embed all objects anyway, so you can just put the code for both engines in the same source file and decide which one to use based on the compat (which you already do anyway). > diff --git a/drivers/mtd/nand/raw/ingenic/jz4740_bch.c b/drivers/mtd/nand/raw/ingenic/jz4740_bch.c > new file mode 100644 > index 000000000000..61ea109cee9d > --- /dev/null > +++ b/drivers/mtd/nand/raw/ingenic/jz4740_bch.c > @@ -0,0 +1,173 @@ > +// SPDX-License-Identifier: GPL-2.0 > +/* > + * JZ4740 backend code for the jz4780-bch driver > + * based on jz4740-nand.c > + * > + * Copyright (c) 2019 Paul Cercueil > + */ > + > +#include > +#include > + > +#include "jz4780_bch.h" > +#include "jz4780_bch_internal.h" > + > +#define JZ_REG_NAND_ECC_CTRL 0x00 > +#define JZ_REG_NAND_DATA 0x04 > +#define JZ_REG_NAND_PAR0 0x08 > +#define JZ_REG_NAND_PAR1 0x0C > +#define JZ_REG_NAND_PAR2 0x10 > +#define JZ_REG_NAND_IRQ_STAT 0x14 > +#define JZ_REG_NAND_IRQ_CTRL 0x18 > +#define JZ_REG_NAND_ERR(x) (0x1C + ((x) << 2)) > + > +#define JZ_NAND_ECC_CTRL_PAR_READY BIT(4) > +#define JZ_NAND_ECC_CTRL_ENCODING BIT(3) > +#define JZ_NAND_ECC_CTRL_RS BIT(2) > +#define JZ_NAND_ECC_CTRL_RESET BIT(1) > +#define JZ_NAND_ECC_CTRL_ENABLE BIT(0) > + > +#define JZ_NAND_STATUS_ERR_COUNT (BIT(31) | BIT(30) | BIT(29)) > +#define JZ_NAND_STATUS_PAD_FINISH BIT(4) > +#define JZ_NAND_STATUS_DEC_FINISH BIT(3) > +#define JZ_NAND_STATUS_ENC_FINISH BIT(2) > +#define JZ_NAND_STATUS_UNCOR_ERROR BIT(1) > +#define JZ_NAND_STATUS_ERROR BIT(0) > + > +static const uint8_t empty_block_ecc[] = { > + 0xcd, 0x9d, 0x90, 0x58, 0xf4, 0x8b, 0xff, 0xb7, 0x6f > +}; > + > +static void jz4740_bch_init(struct jz4780_bch *bch, bool encode) > +{ > + uint32_t reg; > + > + /* Clear interrupt status */ > + writel(0, bch->base + JZ_REG_NAND_IRQ_STAT); > + > + /* Initialize and enable BCH */ > + reg = readl(bch->base + JZ_REG_NAND_ECC_CTRL); > + reg |= JZ_NAND_ECC_CTRL_RESET; > + reg |= JZ_NAND_ECC_CTRL_ENABLE; > + reg |= JZ_NAND_ECC_CTRL_RS; > + if (encode) > + reg |= JZ_NAND_ECC_CTRL_ENCODING; > + else > + reg &= ~JZ_NAND_ECC_CTRL_ENCODING; > + > + writel(reg, bch->base + JZ_REG_NAND_ECC_CTRL); > +} > + > +static int jz4740_bch_calculate(struct jz4780_bch *bch, > + struct jz4780_bch_params *params, > + const u8 *buf, u8 *ecc_code) > +{ > + uint32_t reg, status; > + unsigned int timeout = 1000; > + int i; > + > + jz4740_bch_init(bch, true); > + > + do { > + status = readl(bch->base + JZ_REG_NAND_IRQ_STAT); > + } while (!(status & JZ_NAND_STATUS_ENC_FINISH) && --timeout); > + > + if (timeout == 0) > + return -ETIMEDOUT; > + > + reg = readl(bch->base + JZ_REG_NAND_ECC_CTRL); > + reg &= ~JZ_NAND_ECC_CTRL_ENABLE; > + writel(reg, bch->base + JZ_REG_NAND_ECC_CTRL); > + > + for (i = 0; i < params->bytes; ++i) > + ecc_code[i] = readb(bch->base + JZ_REG_NAND_PAR0 + i); > + > + /* If the written data is completely 0xff, we also want to write 0xff as > + * ecc, otherwise we will get in trouble when doing subpage writes. > + */ > + if (memcmp(ecc_code, empty_block_ecc, ARRAY_SIZE(empty_block_ecc)) == 0) > + memset(ecc_code, 0xff, ARRAY_SIZE(empty_block_ecc)); > + > + return 0; > +} > + > +static void jz_nand_correct_data(uint8_t *buf, int index, int mask) > +{ > + int offset = index & 0x7; > + uint16_t data; > + > + index += (index >> 3); > + > + data = buf[index]; > + data |= buf[index + 1] << 8; > + > + mask ^= (data >> offset) & 0x1ff; > + data &= ~(0x1ff << offset); > + data |= (mask << offset); > + > + buf[index] = data & 0xff; > + buf[index + 1] = (data >> 8) & 0xff; > +} > + > +static int jz4740_bch_correct(struct jz4780_bch *bch, > + struct jz4780_bch_params *params, > + u8 *buf, u8 *ecc_code) > +{ > + int i, error_count, index; > + uint32_t reg, status, error; > + unsigned int timeout = 1000; > + > + jz4740_bch_init(bch, false); > + > + for (i = 0; i < params->bytes; ++i) > + writeb(ecc_code[i], bch->base + JZ_REG_NAND_PAR0 + i); > + > + reg = readl(bch->base + JZ_REG_NAND_ECC_CTRL); > + reg |= JZ_NAND_ECC_CTRL_PAR_READY; > + writel(reg, bch->base + JZ_REG_NAND_ECC_CTRL); > + > + do { > + status = readl(bch->base + JZ_REG_NAND_IRQ_STAT); > + } while (!(status & JZ_NAND_STATUS_DEC_FINISH) && --timeout); > + > + if (timeout == 0) > + return -ETIMEDOUT; > + > + reg = readl(bch->base + JZ_REG_NAND_ECC_CTRL); > + reg &= ~JZ_NAND_ECC_CTRL_ENABLE; > + writel(reg, bch->base + JZ_REG_NAND_ECC_CTRL); > + > + if (status & JZ_NAND_STATUS_ERROR) { > + if (status & JZ_NAND_STATUS_UNCOR_ERROR) > + return -EBADMSG; > + > + error_count = (status & JZ_NAND_STATUS_ERR_COUNT) >> 29; > + > + for (i = 0; i < error_count; ++i) { > + error = readl(bch->base + JZ_REG_NAND_ERR(i)); > + index = ((error >> 16) & 0x1ff) - 1; > + if (index >= 0 && index < params->size) > + jz_nand_correct_data(buf, index, error & 0x1ff); > + } > + > + return error_count; > + } > + > + return 0; > +} > + > +static void jz4740_bch_disable(struct jz4780_bch *bch) > +{ > + u32 reg; > + > + writel(0, bch->base + JZ_REG_NAND_IRQ_STAT); > + reg = readl(bch->base + JZ_REG_NAND_ECC_CTRL); > + reg &= ~JZ_NAND_ECC_CTRL_ENABLE; > + writel(reg, bch->base + JZ_REG_NAND_ECC_CTRL); > +} > + > +const struct jz4780_bch_ops jz4780_bch_jz4740_ops = { > + .disable = jz4740_bch_disable, > + .calculate = jz4740_bch_calculate, > + .correct = jz4740_bch_correct, > +}; > diff --git a/drivers/mtd/nand/raw/ingenic/jz4780_bch_common.c b/drivers/mtd/nand/raw/ingenic/jz4780_bch_common.c > index f505816193a8..c2326286abb2 100644 > --- a/drivers/mtd/nand/raw/ingenic/jz4780_bch_common.c > +++ b/drivers/mtd/nand/raw/ingenic/jz4780_bch_common.c > @@ -157,6 +157,7 @@ static int jz4780_bch_probe(struct platform_device *pdev) > } > > static const struct of_device_id jz4780_bch_dt_match[] = { > + { .compatible = "ingenic,jz4740-bch", .data = &jz4780_bch_jz4740_ops}, > { .compatible = "ingenic,jz4725b-bch", .data = &jz4780_bch_jz4725b_ops}, > { .compatible = "ingenic,jz4780-bch", .data = &jz4780_bch_jz4780_ops }, > {}, > diff --git a/drivers/mtd/nand/raw/ingenic/jz4780_bch_internal.h b/drivers/mtd/nand/raw/ingenic/jz4780_bch_internal.h > index 462aded811b1..7909a49c57db 100644 > --- a/drivers/mtd/nand/raw/ingenic/jz4780_bch_internal.h > +++ b/drivers/mtd/nand/raw/ingenic/jz4780_bch_internal.h > @@ -30,6 +30,7 @@ struct jz4780_bch { > struct mutex lock; > }; > > +extern const struct jz4780_bch_ops jz4780_bch_jz4740_ops; > extern const struct jz4780_bch_ops jz4780_bch_jz4725b_ops; > extern const struct jz4780_bch_ops jz4780_bch_jz4780_ops; >