mirror of
https://github.com/openwrt/openwrt.git
synced 2024-12-27 17:18:59 +00:00
6a64eb2664
This is some hack on top of our old hack. Use separated patch for it so it's easier to understand and actually possible to describe. We should ideally get rid of this (and we actually did with kernels 5.15+). Signed-off-by: Rafał Miłecki <rafal@milecki.pl>
121 lines
3.5 KiB
Diff
121 lines
3.5 KiB
Diff
From 6fa9e3678eb002246df1280322b6a024853950a5 Mon Sep 17 00:00:00 2001
|
|
From: Ansuel Smith <ansuelsmth@gmail.com>
|
|
Date: Mon, 11 Oct 2021 00:53:14 +0200
|
|
Subject: [PATCH] drivers: mtd: parsers: add nvmem support to cmdlinepart
|
|
|
|
Assuming cmdlinepart is only one level deep partition scheme and that
|
|
static partition are also defined in DTS, we can assign an of_node for
|
|
partition declared from bootargs. cmdlinepart have priority than
|
|
fiexed-partition parser so in this specific case the parser doesn't
|
|
assign an of_node. Fix this by searching a defined of_node using a
|
|
similar fixed_partition parser and if a partition is found with the same
|
|
label, check that it has the same offset and size and return the DT
|
|
of_node to correctly use NVMEM cells.
|
|
|
|
Signed-off-by: Ansuel Smith <ansuelsmth@gmail.com>
|
|
---
|
|
drivers/mtd/parsers/cmdlinepart.c | 71 +++++++++++++++++++++++++++++++
|
|
1 file changed, 71 insertions(+)
|
|
|
|
--- a/drivers/mtd/parsers/cmdlinepart.c
|
|
+++ b/drivers/mtd/parsers/cmdlinepart.c
|
|
@@ -43,6 +43,7 @@
|
|
#include <linux/mtd/partitions.h>
|
|
#include <linux/module.h>
|
|
#include <linux/err.h>
|
|
+#include <linux/of.h>
|
|
|
|
/* debug macro */
|
|
#if 0
|
|
@@ -323,6 +324,68 @@ static int mtdpart_setup_real(char *s)
|
|
return 0;
|
|
}
|
|
|
|
+static int search_fixed_partition(struct mtd_info *master,
|
|
+ struct mtd_partition *target_part,
|
|
+ struct mtd_partition *fixed_part)
|
|
+{
|
|
+ struct device_node *mtd_node;
|
|
+ struct device_node *ofpart_node;
|
|
+ struct device_node *pp;
|
|
+ struct mtd_partition part;
|
|
+ const char *partname;
|
|
+
|
|
+ mtd_node = mtd_get_of_node(master);
|
|
+ if (!mtd_node)
|
|
+ return -EINVAL;
|
|
+
|
|
+ ofpart_node = of_get_child_by_name(mtd_node, "partitions");
|
|
+
|
|
+ for_each_child_of_node(ofpart_node, pp) {
|
|
+ const __be32 *reg;
|
|
+ int len;
|
|
+ int a_cells, s_cells;
|
|
+
|
|
+ reg = of_get_property(pp, "reg", &len);
|
|
+ if (!reg) {
|
|
+ pr_debug("%s: ofpart partition %pOF (%pOF) missing reg property.\n",
|
|
+ master->name, pp,
|
|
+ mtd_node);
|
|
+ continue;
|
|
+ }
|
|
+
|
|
+ a_cells = of_n_addr_cells(pp);
|
|
+ s_cells = of_n_size_cells(pp);
|
|
+ if (len / 4 != a_cells + s_cells) {
|
|
+ pr_debug("%s: ofpart partition %pOF (%pOF) error parsing reg property.\n",
|
|
+ master->name, pp,
|
|
+ mtd_node);
|
|
+ continue;
|
|
+ }
|
|
+
|
|
+ part.offset = of_read_number(reg, a_cells);
|
|
+ part.size = of_read_number(reg + a_cells, s_cells);
|
|
+ part.of_node = pp;
|
|
+
|
|
+ partname = of_get_property(pp, "label", &len);
|
|
+ if (!partname)
|
|
+ partname = of_get_property(pp, "name", &len);
|
|
+ part.name = partname;
|
|
+
|
|
+ if (!strncmp(target_part->name, part.name, len)) {
|
|
+ if (part.offset != target_part->offset)
|
|
+ return -EINVAL;
|
|
+
|
|
+ if (part.size != target_part->size)
|
|
+ return -EINVAL;
|
|
+
|
|
+ memcpy(fixed_part, &part, sizeof(struct mtd_partition));
|
|
+ return 0;
|
|
+ }
|
|
+ }
|
|
+
|
|
+ return -EINVAL;
|
|
+}
|
|
+
|
|
/*
|
|
* Main function to be called from the MTD mapping driver/device to
|
|
* obtain the partitioning information. At this point the command line
|
|
@@ -338,6 +401,7 @@ static int parse_cmdline_partitions(stru
|
|
int i, err;
|
|
struct cmdline_mtd_partition *part;
|
|
const char *mtd_id = master->name;
|
|
+ struct mtd_partition fixed_part;
|
|
|
|
/* parse command line */
|
|
if (!cmdline_parsed) {
|
|
@@ -382,6 +446,13 @@ static int parse_cmdline_partitions(stru
|
|
sizeof(*part->parts) * (part->num_parts - i));
|
|
i--;
|
|
}
|
|
+
|
|
+ err = search_fixed_partition(master, &part->parts[i], &fixed_part);
|
|
+ if (!err) {
|
|
+ part->parts[i].of_node = fixed_part.of_node;
|
|
+ pr_info("Found partition defined in DT for %s. Assigning OF node to support nvmem.",
|
|
+ part->parts[i].name);
|
|
+ }
|
|
}
|
|
|
|
*pparts = kmemdup(part->parts, sizeof(*part->parts) * part->num_parts,
|