ath79: port cybertan_part from ar71xx

This patch ports the cybertan_part code from ar71xx and converts the
driver to a DT-supported mtd parser. As a result, it will no longer
add the u-boot, nvram and art partitions, which were never part of
the special Cybertan header.

Instead these partitions have to be specified in the DT, which has the
upside of making it possible to add properties (i.e.: read-only), labels
and references to these important partitions.

Signed-off-by: Christian Lamparter <chunkeey@gmail.com>

3 files changed, 183 insertions, 0 deletions

diff --git a/target/linux/ath79/config-4.14 b/target/linux/ath79/config-4.14
index a834904..6f273e1 100644
--- a/target/linux/ath79/config-4.14
+++ b/target/linux/ath79/config-4.14
@@ -163,6 +163,7 @@ CONFIG_MTD_CMDLINE_PARTS=y
 CONFIG_MTD_M25P80=y
 # CONFIG_MTD_MAP_BANK_WIDTH_1 is not set
 # CONFIG_MTD_MAP_BANK_WIDTH_4 is not set
+CONFIG_MTD_PARSER_CYBERTAN=y
 CONFIG_MTD_PHYSMAP=y
 CONFIG_MTD_SPI_NOR=y
 CONFIG_MTD_SPLIT_FIRMWARE=y
diff --git a/target/linux/ath79/files/drivers/mtd/parsers/parser_cybertan.c b/target/linux/ath79/files/drivers/mtd/parsers/parser_cybertan.c
new file mode 100644
index 0000000..7b67e31
--- /dev/null
+++ b/target/linux/ath79/files/drivers/mtd/parsers/parser_cybertan.c
@@ -0,0 +1,163 @@
+/*
+ * Copyright (C) 2009 Christian Daniel <cd@maintech.de>
+ * Copyright (C) 2009 Gabor Juhos <juhosg@openwrt.org>
+ *
+ * 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., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
+ *
+ * TRX flash partition table.
+ * Based on ar7 map by Felix Fietkau <nbd@nbd.name>
+ *
+ */
+
+#include <linux/kernel.h>
+#include <linux/module.h>
+#include <linux/slab.h>
+#include <linux/vmalloc.h>
+
+#include <linux/mtd/mtd.h>
+#include <linux/mtd/partitions.h>
+#include <linux/version.h>
+
+struct cybertan_header {
+	char	magic[4];
+	u8	res1[4];
+	char	fw_date[3];
+	char	fw_ver[3];
+	char	id[4];
+	char	hw_ver;
+	char	unused;
+	u8	flags[2];
+	u8	res2[10];
+} __packed;
+
+#define TRX_PARTS	3
+#define TRX_MAGIC	0x30524448
+#define TRX_MAX_OFFSET	3
+
+struct trx_header {
+	__le32 magic;           /* "HDR0" */
+	__le32 len;             /* Length of file including header */
+	__le32 crc32;           /* 32-bit CRC from flag_version to end of file */
+	__le32 flag_version;    /* 0:15 flags, 16:31 version */
+	__le32 offsets[TRX_MAX_OFFSET]; /* Offsets of partitions from start of header */
+} __packed;
+
+#define IH_MAGIC	0x27051956	/* Image Magic Number */
+#define IH_NMLEN	32		/* Image Name Length */
+
+struct uimage_header {
+	__be32	ih_magic;	/* Image Header Magic Number */
+	__be32	ih_hcrc;	/* Image Header CRC Checksum */
+	__be32	ih_time;	/* Image Creation Timestamp */
+	__be32	ih_size;	/* Image Data Size */
+	__be32	ih_load;	/* Data» Load  Address */
+	__be32	ih_ep;		/* Entry Point Address */
+	__be32	ih_dcrc;	/* Image Data CRC Checksum */
+	uint8_t	ih_os;		/* Operating System */
+	uint8_t	ih_arch;	/* CPU architecture */
+	uint8_t	ih_type;	/* Image Type */
+	uint8_t	ih_comp;	/* Compression Type */
+	uint8_t	ih_name[IH_NMLEN];	/* Image Name */
+} __packed;
+
+struct firmware_header {
+	struct cybertan_header	cybertan;
+	struct trx_header	trx;
+	struct uimage_header	uimage;
+} __packed;
+
+static int cybertan_parse_partitions(struct mtd_info *master,
+				     const struct mtd_partition **pparts,
+				     struct mtd_part_parser_data *data)
+{
+	struct firmware_header header;
+	struct trx_header *theader;
+	struct uimage_header *uheader;
+	struct mtd_partition *trx_parts;
+	size_t retlen;
+	unsigned int kernel_len;
+	int ret;
+
+	trx_parts = kcalloc(TRX_PARTS, sizeof(struct mtd_partition),
+			    GFP_KERNEL);
+	if (!trx_parts) {
+		ret = -ENOMEM;
+		goto out;
+	}
+
+	ret = mtd_read(master, 0, sizeof(header),
+		       &retlen, (uint8_t *)&header);
+	if (ret)
+		goto free_parts;
+
+	if (retlen != sizeof(header)) {
+		ret = -EIO;
+		goto free_parts;
+	}
+
+	theader = &header.trx;
+	if (theader->magic != cpu_to_le32(TRX_MAGIC)) {
+		printk(KERN_NOTICE "%s: no TRX header found\n", master->name);
+		goto free_parts;
+	}
+
+	uheader = &header.uimage;
+	if (uheader->ih_magic != cpu_to_be32(IH_MAGIC)) {
+		printk(KERN_NOTICE "%s: no uImage found\n", master->name);
+		goto free_parts;
+	}
+
+	kernel_len = le32_to_cpu(theader->offsets[1]) +
+		sizeof(struct cybertan_header);
+
+	trx_parts[0].name = "header";
+	trx_parts[0].offset = 0;
+	trx_parts[0].size = offsetof(struct firmware_header, uimage);
+	trx_parts[0].mask_flags = 0;
+
+	trx_parts[1].name = "kernel";
+	trx_parts[1].offset = trx_parts[0].offset + trx_parts[0].size;
+	trx_parts[1].size = kernel_len - trx_parts[0].size;
+	trx_parts[1].mask_flags = 0;
+
+	trx_parts[2].name = "rootfs";
+	trx_parts[2].offset = trx_parts[1].offset + trx_parts[1].size;
+	trx_parts[2].size = master->size - trx_parts[1].size - trx_parts[0].size;
+	trx_parts[2].mask_flags = 0;
+
+	*pparts = trx_parts;
+	return TRX_PARTS;
+
+free_parts:
+	kfree(trx_parts);
+out:
+	return ret;
+}
+
+static const struct of_device_id mtd_parser_cybertan_of_match_table[] = {
+	{ .compatible = "cybertan,trx" },
+	{},
+};
+MODULE_DEVICE_TABLE(of, mtd_parser_cybertan_of_match_table);
+
+static struct mtd_part_parser mtd_parser_cybertan = {
+	.parse_fn = cybertan_parse_partitions,
+	.name = "cybertan-trx",
+	.of_match_table = mtd_parser_cybertan_of_match_table,
+};
+module_mtd_part_parser(mtd_parser_cybertan);
+
+MODULE_LICENSE("GPL");
+MODULE_AUTHOR("Christian Daniel <cd@maintech.de>");
diff --git a/target/linux/ath79/patches-4.14/404-mtd-cybertan-trx-parser.patch b/target/linux/ath79/patches-4.14/404-mtd-cybertan-trx-parser.patch
new file mode 100644
index 0000000..2d2a042
--- /dev/null
+++ b/target/linux/ath79/patches-4.14/404-mtd-cybertan-trx-parser.patch
@@ -0,0 +1,19 @@
+--- a/drivers/mtd/parsers/Makefile	2018-08-12 02:32:47.951243067 +0200
++++ b/drivers/mtd/parsers/Makefile	2018-08-12 02:33:09.844626814 +0200
+@@ -1 +1,2 @@
++obj-$(CONFIG_MTD_PARSER_CYBERTAN)	+= parser_cybertan.o
+ obj-$(CONFIG_MTD_PARSER_TRX)		+= parser_trx.o
+--- a/drivers/mtd/parsers/Kconfig	2018-08-12 02:28:43.987357803 +0200
++++ b/drivers/mtd/parsers/Kconfig	2018-08-12 02:32:23.237852972 +0200
+@@ -1,3 +1,11 @@
++config MTD_PARSER_CYBERTAN
++	tristate "Parser for Cybertan format partitions"
++	depends on MTD && (ATH79 || COMPILE_TEST)
++	help
++	  Cybertan has a proprietory header than encompasses a Broadcom trx
++	  header. This driver will parse the header and take care of the
++	  special offsets that result in the extra headers.
++
+ config MTD_PARSER_TRX
+ 	tristate "Parser for TRX format partitions"
+ 	depends on MTD && (BCM47XX || ARCH_BCM_5301X || COMPILE_TEST)