--- zzzz-none-000/linux-5.4.213/drivers/mtd/ubi/build.c 2022-09-15 10:04:56.000000000 +0000 +++ alder-5690pro-762/linux-5.4.213/drivers/mtd/ubi/build.c 2024-08-14 09:02:07.000000000 +0000 @@ -1161,6 +1161,73 @@ return mtd; } +/* + * This function tries attaching mtd partitions named either "ubi" or "data" + * during boot. + */ +static void __init ubi_auto_attach(void) +{ + int err; + struct mtd_info *mtd; + loff_t offset = 0; + size_t len; + char magic[4]; + + /* try attaching mtd device named "ubi" or "data" */ + mtd = open_mtd_device("ubi"); + if (IS_ERR(mtd)) + mtd = open_mtd_device("data"); + + if (IS_ERR(mtd)) + return; + + /* get the first not bad block */ + if (mtd_can_have_bb(mtd)) + while (mtd_block_isbad(mtd, offset)) { + offset += mtd->erasesize; + + if (offset > mtd->size) { + pr_err("UBI error: Failed to find a non-bad " + "block on mtd%d\n", mtd->index); + goto cleanup; + } + } + + /* check if the read from flash was successful */ + err = mtd_read(mtd, offset, 4, &len, (void *) magic); + if ((err && !mtd_is_bitflip(err)) || len != 4) { + pr_err("UBI error: unable to read from mtd%d\n", mtd->index); + goto cleanup; + } + + /* check for a valid ubi magic */ + if (strncmp(magic, "UBI#", 4)) { + pr_err("UBI error: no valid UBI magic found inside mtd%d\n", mtd->index); + goto cleanup; + } + + /* don't auto-add media types where UBI doesn't makes sense */ + if (mtd->type != MTD_NANDFLASH && + mtd->type != MTD_NORFLASH && + mtd->type != MTD_DATAFLASH && + mtd->type != MTD_MLCNANDFLASH) + goto cleanup; + + mutex_lock(&ubi_devices_mutex); + pr_notice("UBI: auto-attach mtd%d\n", mtd->index); + err = ubi_attach_mtd_dev(mtd, UBI_DEV_NUM_AUTO, 0, 0); + mutex_unlock(&ubi_devices_mutex); + if (err < 0) { + pr_err("UBI error: cannot attach mtd%d\n", mtd->index); + goto cleanup; + } + + return; + +cleanup: + put_mtd_device(mtd); +} + static int __init ubi_init(void) { int err, i, k; @@ -1244,6 +1311,12 @@ } } + /* auto-attach mtd devices only if built-in to the kernel and no ubi.mtd + * parameter was given */ + if (IS_ENABLED(CONFIG_MTD_ROOTFS_ROOT_DEV) && + !ubi_is_module() && !mtd_devs) + ubi_auto_attach(); + err = ubiblock_init(); if (err) { pr_err("UBI error: block: cannot initialize, error %d\n", err); @@ -1340,7 +1413,11 @@ * This function returns zero in case of success and a negative error code in * case of error. */ +#if ! defined(CONFIG_AVM_ENHANCED) static int ubi_mtd_param_parse(const char *val, const struct kernel_param *kp) +#else +int ubi_mtd_param_parse(const char *val, const struct kernel_param *kp) +#endif { int i, len; struct mtd_dev_param *p;