|
@@ -2475,10 +2475,10 @@ qcom_nandc_calc_ecc_bytes(int step_size, int strength)
|
|
|
NAND_ECC_CAPS_SINGLE(qcom_nandc_ecc_caps, qcom_nandc_calc_ecc_bytes,
|
|
|
NANDC_STEP_SIZE, 4, 8);
|
|
|
|
|
|
-static int qcom_nand_host_setup(struct qcom_nand_host *host)
|
|
|
+static int qcom_nand_attach_chip(struct nand_chip *chip)
|
|
|
{
|
|
|
- struct nand_chip *chip = &host->chip;
|
|
|
struct mtd_info *mtd = nand_to_mtd(chip);
|
|
|
+ struct qcom_nand_host *host = to_qcom_nand_host(chip);
|
|
|
struct nand_ecc_ctrl *ecc = &chip->ecc;
|
|
|
struct qcom_nand_controller *nandc = get_qcom_nand_controller(chip);
|
|
|
int cwperpage, bad_block_byte, ret;
|
|
@@ -2640,6 +2640,10 @@ static int qcom_nand_host_setup(struct qcom_nand_host *host)
|
|
|
return 0;
|
|
|
}
|
|
|
|
|
|
+static const struct nand_controller_ops qcom_nandc_ops = {
|
|
|
+ .attach_chip = qcom_nand_attach_chip,
|
|
|
+};
|
|
|
+
|
|
|
static int qcom_nandc_alloc(struct qcom_nand_controller *nandc)
|
|
|
{
|
|
|
int ret;
|
|
@@ -2729,6 +2733,7 @@ static int qcom_nandc_alloc(struct qcom_nand_controller *nandc)
|
|
|
INIT_LIST_HEAD(&nandc->host_list);
|
|
|
|
|
|
nand_controller_init(&nandc->controller);
|
|
|
+ nandc->controller.ops = &qcom_nandc_ops;
|
|
|
|
|
|
return 0;
|
|
|
}
|
|
@@ -2781,9 +2786,9 @@ static int qcom_nandc_setup(struct qcom_nand_controller *nandc)
|
|
|
return 0;
|
|
|
}
|
|
|
|
|
|
-static int qcom_nand_host_init(struct qcom_nand_controller *nandc,
|
|
|
- struct qcom_nand_host *host,
|
|
|
- struct device_node *dn)
|
|
|
+static int qcom_nand_host_init_and_register(struct qcom_nand_controller *nandc,
|
|
|
+ struct qcom_nand_host *host,
|
|
|
+ struct device_node *dn)
|
|
|
{
|
|
|
struct nand_chip *chip = &host->chip;
|
|
|
struct mtd_info *mtd = nand_to_mtd(chip);
|
|
@@ -2830,30 +2835,13 @@ static int qcom_nand_host_init(struct qcom_nand_controller *nandc,
|
|
|
/* set up initial status value */
|
|
|
host->status = NAND_STATUS_READY | NAND_STATUS_WP;
|
|
|
|
|
|
- ret = nand_scan_ident(mtd, 1, NULL);
|
|
|
- if (ret)
|
|
|
- return ret;
|
|
|
-
|
|
|
- ret = qcom_nand_host_setup(host);
|
|
|
-
|
|
|
- return ret;
|
|
|
-}
|
|
|
-
|
|
|
-static int qcom_nand_mtd_register(struct qcom_nand_controller *nandc,
|
|
|
- struct qcom_nand_host *host,
|
|
|
- struct device_node *dn)
|
|
|
-{
|
|
|
- struct nand_chip *chip = &host->chip;
|
|
|
- struct mtd_info *mtd = nand_to_mtd(chip);
|
|
|
- int ret;
|
|
|
-
|
|
|
- ret = nand_scan_tail(mtd);
|
|
|
+ ret = nand_scan(mtd, 1);
|
|
|
if (ret)
|
|
|
return ret;
|
|
|
|
|
|
ret = mtd_device_register(mtd, NULL, 0);
|
|
|
if (ret)
|
|
|
- nand_cleanup(mtd_to_nand(mtd));
|
|
|
+ nand_cleanup(chip);
|
|
|
|
|
|
return ret;
|
|
|
}
|
|
@@ -2862,28 +2850,9 @@ static int qcom_probe_nand_devices(struct qcom_nand_controller *nandc)
|
|
|
{
|
|
|
struct device *dev = nandc->dev;
|
|
|
struct device_node *dn = dev->of_node, *child;
|
|
|
- struct qcom_nand_host *host, *tmp;
|
|
|
+ struct qcom_nand_host *host;
|
|
|
int ret;
|
|
|
|
|
|
- for_each_available_child_of_node(dn, child) {
|
|
|
- host = devm_kzalloc(dev, sizeof(*host), GFP_KERNEL);
|
|
|
- if (!host) {
|
|
|
- of_node_put(child);
|
|
|
- return -ENOMEM;
|
|
|
- }
|
|
|
-
|
|
|
- ret = qcom_nand_host_init(nandc, host, child);
|
|
|
- if (ret) {
|
|
|
- devm_kfree(dev, host);
|
|
|
- continue;
|
|
|
- }
|
|
|
-
|
|
|
- list_add_tail(&host->node, &nandc->host_list);
|
|
|
- }
|
|
|
-
|
|
|
- if (list_empty(&nandc->host_list))
|
|
|
- return -ENODEV;
|
|
|
-
|
|
|
if (nandc->props->is_bam) {
|
|
|
free_bam_transaction(nandc);
|
|
|
nandc->bam_txn = alloc_bam_transaction(nandc);
|
|
@@ -2894,12 +2863,20 @@ static int qcom_probe_nand_devices(struct qcom_nand_controller *nandc)
|
|
|
}
|
|
|
}
|
|
|
|
|
|
- list_for_each_entry_safe(host, tmp, &nandc->host_list, node) {
|
|
|
- ret = qcom_nand_mtd_register(nandc, host, child);
|
|
|
+ for_each_available_child_of_node(dn, child) {
|
|
|
+ host = devm_kzalloc(dev, sizeof(*host), GFP_KERNEL);
|
|
|
+ if (!host) {
|
|
|
+ of_node_put(child);
|
|
|
+ return -ENOMEM;
|
|
|
+ }
|
|
|
+
|
|
|
+ ret = qcom_nand_host_init_and_register(nandc, host, child);
|
|
|
if (ret) {
|
|
|
- list_del(&host->node);
|
|
|
devm_kfree(dev, host);
|
|
|
+ continue;
|
|
|
}
|
|
|
+
|
|
|
+ list_add_tail(&host->node, &nandc->host_list);
|
|
|
}
|
|
|
|
|
|
if (list_empty(&nandc->host_list))
|