Commit | Line | Data |
---|---|---|
bb17230c RM |
1 | // SPDX-License-Identifier: GPL-2.0 |
2 | /* | |
3 | * Copyright (C) 2021 Rafał Miłecki <rafal@milecki.pl> | |
4 | */ | |
5 | ||
6 | #include <linux/module.h> | |
7 | #include <linux/init.h> | |
8 | #include <linux/of.h> | |
9 | #include <linux/mtd/mtd.h> | |
10 | #include <linux/slab.h> | |
11 | #include <linux/mtd/partitions.h> | |
12 | ||
13 | #include "ofpart_bcm4908.h" | |
14 | ||
15 | #define BLPARAMS_FW_OFFSET "NAND_RFS_OFS" | |
16 | ||
17 | static long long bcm4908_partitions_fw_offset(void) | |
18 | { | |
19 | struct device_node *root; | |
20 | struct property *prop; | |
21 | const char *s; | |
22 | ||
23 | root = of_find_node_by_path("/"); | |
24 | if (!root) | |
25 | return -ENOENT; | |
26 | ||
27 | of_property_for_each_string(root, "brcm_blparms", prop, s) { | |
28 | size_t len = strlen(BLPARAMS_FW_OFFSET); | |
29 | unsigned long offset; | |
30 | int err; | |
31 | ||
32 | if (strncmp(s, BLPARAMS_FW_OFFSET, len) || s[len] != '=') | |
33 | continue; | |
34 | ||
35 | err = kstrtoul(s + len + 1, 0, &offset); | |
36 | if (err) { | |
37 | pr_err("failed to parse %s\n", s + len + 1); | |
e607879b | 38 | of_node_put(root); |
bb17230c RM |
39 | return err; |
40 | } | |
41 | ||
e607879b | 42 | of_node_put(root); |
bb17230c RM |
43 | return offset << 10; |
44 | } | |
45 | ||
e607879b | 46 | of_node_put(root); |
bb17230c RM |
47 | return -ENOENT; |
48 | } | |
49 | ||
50 | int bcm4908_partitions_post_parse(struct mtd_info *mtd, struct mtd_partition *parts, int nr_parts) | |
51 | { | |
52 | long long fw_offset; | |
53 | int i; | |
54 | ||
55 | fw_offset = bcm4908_partitions_fw_offset(); | |
56 | ||
57 | for (i = 0; i < nr_parts; i++) { | |
58 | if (of_device_is_compatible(parts[i].of_node, "brcm,bcm4908-firmware")) { | |
59 | if (fw_offset < 0 || parts[i].offset == fw_offset) | |
60 | parts[i].name = "firmware"; | |
61 | else | |
62 | parts[i].name = "backup"; | |
63 | } | |
64 | } | |
65 | ||
66 | return 0; | |
67 | } |