|
@@ -615,8 +615,7 @@ static int nand_davinci_probe(struct platform_device *pdev)
|
|
info = devm_kzalloc(&pdev->dev, sizeof(*info), GFP_KERNEL);
|
|
info = devm_kzalloc(&pdev->dev, sizeof(*info), GFP_KERNEL);
|
|
if (!info) {
|
|
if (!info) {
|
|
dev_err(&pdev->dev, "unable to allocate memory\n");
|
|
dev_err(&pdev->dev, "unable to allocate memory\n");
|
|
- ret = -ENOMEM;
|
|
|
|
- goto err_nomem;
|
|
|
|
|
|
+ return -ENOMEM;
|
|
}
|
|
}
|
|
|
|
|
|
platform_set_drvdata(pdev, info);
|
|
platform_set_drvdata(pdev, info);
|
|
@@ -625,20 +624,16 @@ static int nand_davinci_probe(struct platform_device *pdev)
|
|
res2 = platform_get_resource(pdev, IORESOURCE_MEM, 1);
|
|
res2 = platform_get_resource(pdev, IORESOURCE_MEM, 1);
|
|
if (!res1 || !res2) {
|
|
if (!res1 || !res2) {
|
|
dev_err(&pdev->dev, "resource missing\n");
|
|
dev_err(&pdev->dev, "resource missing\n");
|
|
- ret = -EINVAL;
|
|
|
|
- goto err_nomem;
|
|
|
|
|
|
+ return -EINVAL;
|
|
}
|
|
}
|
|
|
|
|
|
vaddr = devm_ioremap_resource(&pdev->dev, res1);
|
|
vaddr = devm_ioremap_resource(&pdev->dev, res1);
|
|
- if (IS_ERR(vaddr)) {
|
|
|
|
- ret = PTR_ERR(vaddr);
|
|
|
|
- goto err_ioremap;
|
|
|
|
- }
|
|
|
|
|
|
+ if (IS_ERR(vaddr))
|
|
|
|
+ return PTR_ERR(vaddr);
|
|
|
|
+
|
|
base = devm_ioremap_resource(&pdev->dev, res2);
|
|
base = devm_ioremap_resource(&pdev->dev, res2);
|
|
- if (IS_ERR(base)) {
|
|
|
|
- ret = PTR_ERR(base);
|
|
|
|
- goto err_ioremap;
|
|
|
|
- }
|
|
|
|
|
|
+ if (IS_ERR(base))
|
|
|
|
+ return PTR_ERR(base);
|
|
|
|
|
|
info->dev = &pdev->dev;
|
|
info->dev = &pdev->dev;
|
|
info->base = base;
|
|
info->base = base;
|
|
@@ -705,7 +700,7 @@ static int nand_davinci_probe(struct platform_device *pdev)
|
|
spin_unlock_irq(&davinci_nand_lock);
|
|
spin_unlock_irq(&davinci_nand_lock);
|
|
|
|
|
|
if (ret == -EBUSY)
|
|
if (ret == -EBUSY)
|
|
- goto err_ecc;
|
|
|
|
|
|
+ return ret;
|
|
|
|
|
|
info->chip.ecc.calculate = nand_davinci_calculate_4bit;
|
|
info->chip.ecc.calculate = nand_davinci_calculate_4bit;
|
|
info->chip.ecc.correct = nand_davinci_correct_4bit;
|
|
info->chip.ecc.correct = nand_davinci_correct_4bit;
|
|
@@ -721,8 +716,7 @@ static int nand_davinci_probe(struct platform_device *pdev)
|
|
info->chip.ecc.strength = pdata->ecc_bits;
|
|
info->chip.ecc.strength = pdata->ecc_bits;
|
|
break;
|
|
break;
|
|
default:
|
|
default:
|
|
- ret = -EINVAL;
|
|
|
|
- goto err_ecc;
|
|
|
|
|
|
+ return -EINVAL;
|
|
}
|
|
}
|
|
info->chip.ecc.mode = ecc_mode;
|
|
info->chip.ecc.mode = ecc_mode;
|
|
|
|
|
|
@@ -730,7 +724,7 @@ static int nand_davinci_probe(struct platform_device *pdev)
|
|
if (IS_ERR(info->clk)) {
|
|
if (IS_ERR(info->clk)) {
|
|
ret = PTR_ERR(info->clk);
|
|
ret = PTR_ERR(info->clk);
|
|
dev_dbg(&pdev->dev, "unable to get AEMIF clock, err %d\n", ret);
|
|
dev_dbg(&pdev->dev, "unable to get AEMIF clock, err %d\n", ret);
|
|
- goto err_clk;
|
|
|
|
|
|
+ return ret;
|
|
}
|
|
}
|
|
|
|
|
|
ret = clk_prepare_enable(info->clk);
|
|
ret = clk_prepare_enable(info->clk);
|
|
@@ -759,7 +753,7 @@ static int nand_davinci_probe(struct platform_device *pdev)
|
|
info->core_chipsel);
|
|
info->core_chipsel);
|
|
if (ret < 0) {
|
|
if (ret < 0) {
|
|
dev_dbg(&pdev->dev, "NAND timing values setup fail\n");
|
|
dev_dbg(&pdev->dev, "NAND timing values setup fail\n");
|
|
- goto err_timing;
|
|
|
|
|
|
+ goto err;
|
|
}
|
|
}
|
|
|
|
|
|
spin_lock_irq(&davinci_nand_lock);
|
|
spin_lock_irq(&davinci_nand_lock);
|
|
@@ -775,7 +769,7 @@ static int nand_davinci_probe(struct platform_device *pdev)
|
|
ret = nand_scan_ident(&info->mtd, pdata->mask_chipsel ? 2 : 1, NULL);
|
|
ret = nand_scan_ident(&info->mtd, pdata->mask_chipsel ? 2 : 1, NULL);
|
|
if (ret < 0) {
|
|
if (ret < 0) {
|
|
dev_dbg(&pdev->dev, "no NAND chip(s) found\n");
|
|
dev_dbg(&pdev->dev, "no NAND chip(s) found\n");
|
|
- goto err_scan;
|
|
|
|
|
|
+ goto err;
|
|
}
|
|
}
|
|
|
|
|
|
/* Update ECC layout if needed ... for 1-bit HW ECC, the default
|
|
/* Update ECC layout if needed ... for 1-bit HW ECC, the default
|
|
@@ -789,7 +783,7 @@ static int nand_davinci_probe(struct platform_device *pdev)
|
|
if (!chunks || info->mtd.oobsize < 16) {
|
|
if (!chunks || info->mtd.oobsize < 16) {
|
|
dev_dbg(&pdev->dev, "too small\n");
|
|
dev_dbg(&pdev->dev, "too small\n");
|
|
ret = -EINVAL;
|
|
ret = -EINVAL;
|
|
- goto err_scan;
|
|
|
|
|
|
+ goto err;
|
|
}
|
|
}
|
|
|
|
|
|
/* For small page chips, preserve the manufacturer's
|
|
/* For small page chips, preserve the manufacturer's
|
|
@@ -820,7 +814,7 @@ static int nand_davinci_probe(struct platform_device *pdev)
|
|
dev_warn(&pdev->dev, "no 4-bit ECC support yet "
|
|
dev_warn(&pdev->dev, "no 4-bit ECC support yet "
|
|
"for 4KiB-page NAND\n");
|
|
"for 4KiB-page NAND\n");
|
|
ret = -EIO;
|
|
ret = -EIO;
|
|
- goto err_scan;
|
|
|
|
|
|
+ goto err;
|
|
|
|
|
|
syndrome_done:
|
|
syndrome_done:
|
|
info->chip.ecc.layout = &info->ecclayout;
|
|
info->chip.ecc.layout = &info->ecclayout;
|
|
@@ -828,7 +822,7 @@ syndrome_done:
|
|
|
|
|
|
ret = nand_scan_tail(&info->mtd);
|
|
ret = nand_scan_tail(&info->mtd);
|
|
if (ret < 0)
|
|
if (ret < 0)
|
|
- goto err_scan;
|
|
|
|
|
|
+ goto err;
|
|
|
|
|
|
if (pdata->parts)
|
|
if (pdata->parts)
|
|
ret = mtd_device_parse_register(&info->mtd, NULL, NULL,
|
|
ret = mtd_device_parse_register(&info->mtd, NULL, NULL,
|
|
@@ -841,7 +835,7 @@ syndrome_done:
|
|
NULL, 0);
|
|
NULL, 0);
|
|
}
|
|
}
|
|
if (ret < 0)
|
|
if (ret < 0)
|
|
- goto err_scan;
|
|
|
|
|
|
+ goto err;
|
|
|
|
|
|
val = davinci_nand_readl(info, NRCSR_OFFSET);
|
|
val = davinci_nand_readl(info, NRCSR_OFFSET);
|
|
dev_info(&pdev->dev, "controller rev. %d.%d\n",
|
|
dev_info(&pdev->dev, "controller rev. %d.%d\n",
|
|
@@ -849,8 +843,7 @@ syndrome_done:
|
|
|
|
|
|
return 0;
|
|
return 0;
|
|
|
|
|
|
-err_scan:
|
|
|
|
-err_timing:
|
|
|
|
|
|
+err:
|
|
clk_disable_unprepare(info->clk);
|
|
clk_disable_unprepare(info->clk);
|
|
|
|
|
|
err_clk_enable:
|
|
err_clk_enable:
|
|
@@ -858,11 +851,6 @@ err_clk_enable:
|
|
if (ecc_mode == NAND_ECC_HW_SYNDROME)
|
|
if (ecc_mode == NAND_ECC_HW_SYNDROME)
|
|
ecc4_busy = false;
|
|
ecc4_busy = false;
|
|
spin_unlock_irq(&davinci_nand_lock);
|
|
spin_unlock_irq(&davinci_nand_lock);
|
|
-
|
|
|
|
-err_ecc:
|
|
|
|
-err_clk:
|
|
|
|
-err_ioremap:
|
|
|
|
-err_nomem:
|
|
|
|
return ret;
|
|
return ret;
|
|
}
|
|
}
|
|
|
|
|