166200Simp// SPDX-License-Identifier: GPL-2.0 252506Simp/* 352506Simp * Copyright (C) 2021 Rafa�� Mi��ecki <rafal@milecki.pl> 452506Simp */ 552506Simp 652506Simp#include <linux/module.h> 752506Simp#include <linux/init.h> 852506Simp#include <linux/of.h> 952506Simp#include <linux/mtd/mtd.h> 1052506Simp#include <linux/slab.h> 1152506Simp#include <linux/mtd/partitions.h> 1252506Simp 1352506Simp#include "ofpart_bcm4908.h" 1452506Simp 1552506Simp#define BLPARAMS_FW_OFFSET "NAND_RFS_OFS" 1652506Simp 1752506Simpstatic long long bcm4908_partitions_fw_offset(void) 1852506Simp{ 1952506Simp struct device_node *root; 2052506Simp struct property *prop; 2152506Simp const char *s; 2252506Simp 2352506Simp root = of_find_node_by_path("/"); 2452506Simp if (!root) 2552506Simp return -ENOENT; 2652506Simp 2752506Simp of_property_for_each_string(root, "brcm_blparms", prop, s) { 2852506Simp size_t len = strlen(BLPARAMS_FW_OFFSET); 2952506Simp unsigned long offset; 3052506Simp int err; 3152506Simp 3252506Simp if (strncmp(s, BLPARAMS_FW_OFFSET, len) || s[len] != '=') 3352506Simp continue; 3452506Simp 3552506Simp err = kstrtoul(s + len + 1, 0, &offset); 3652506Simp if (err) { 3752506Simp pr_err("failed to parse %s\n", s + len + 1); 3852506Simp of_node_put(root); 3952506Simp return err; 4052506Simp } 4152506Simp 4252506Simp of_node_put(root); 4352506Simp return offset << 10; 4452506Simp } 4552506Simp 4652506Simp of_node_put(root); 4752506Simp return -ENOENT; 4852506Simp} 4954250Simp 5052506Simpint bcm4908_partitions_post_parse(struct mtd_info *mtd, struct mtd_partition *parts, int nr_parts) 5152506Simp{ 5252506Simp long long fw_offset; 5352506Simp int i; 5452506Simp 5552506Simp fw_offset = bcm4908_partitions_fw_offset(); 5652506Simp 5752506Simp for (i = 0; i < nr_parts; i++) { 5852506Simp if (of_device_is_compatible(parts[i].of_node, "brcm,bcm4908-firmware")) { 5952506Simp if (fw_offset < 0 || parts[i].offset == fw_offset) 6052506Simp parts[i].name = "firmware"; 6152506Simp else 6252506Simp parts[i].name = "backup"; 6354250Simp } 6454250Simp } 6552506Simp 6652506Simp return 0; 6752506Simp} 6852506Simp