hc
2023-12-11 d2ccde1c8e90d38cee87a1b0309ad2827f3fd30d
kernel/drivers/ata/pata_palmld.c
....@@ -1,3 +1,4 @@
1
+// SPDX-License-Identifier: GPL-2.0-only
12 /*
23 * drivers/ata/pata_palmld.c
34 *
....@@ -13,11 +14,6 @@
1314 * ixp4xx PATA/Compact Flash driver
1415 * Copyright (C) 2006-07 Tower Technologies
1516 * Author: Alessandro Zummo <a.zummo@towertech.it>
16
- *
17
- * This program is free software; you can redistribute it and/or modify
18
- * it under the terms of the GNU General Public License version 2 as
19
- * published by the Free Software Foundation.
20
- *
2117 */
2218
2319 #include <linux/kernel.h>
....@@ -26,16 +22,17 @@
2622 #include <linux/irq.h>
2723 #include <linux/platform_device.h>
2824 #include <linux/delay.h>
29
-#include <linux/gpio.h>
25
+#include <linux/gpio/consumer.h>
3026
3127 #include <scsi/scsi_host.h>
3228 #include <mach/palmld.h>
3329
3430 #define DRV_NAME "pata_palmld"
3531
36
-static struct gpio palmld_hdd_gpios[] = {
37
- { GPIO_NR_PALMLD_IDE_PWEN, GPIOF_INIT_HIGH, "HDD Power" },
38
- { GPIO_NR_PALMLD_IDE_RESET, GPIOF_INIT_LOW, "HDD Reset" },
32
+struct palmld_pata {
33
+ struct ata_host *host;
34
+ struct gpio_desc *power;
35
+ struct gpio_desc *reset;
3936 };
4037
4138 static struct scsi_host_template palmld_sht = {
....@@ -50,39 +47,44 @@
5047
5148 static int palmld_pata_probe(struct platform_device *pdev)
5249 {
53
- struct ata_host *host;
50
+ struct palmld_pata *lda;
5451 struct ata_port *ap;
5552 void __iomem *mem;
53
+ struct device *dev = &pdev->dev;
5654 int ret;
5755
56
+ lda = devm_kzalloc(dev, sizeof(*lda), GFP_KERNEL);
57
+ if (!lda)
58
+ return -ENOMEM;
59
+
5860 /* allocate host */
59
- host = ata_host_alloc(&pdev->dev, 1);
60
- if (!host) {
61
- ret = -ENOMEM;
62
- goto err1;
63
- }
61
+ lda->host = ata_host_alloc(dev, 1);
62
+ if (!lda->host)
63
+ return -ENOMEM;
6464
6565 /* remap drive's physical memory address */
66
- mem = devm_ioremap(&pdev->dev, PALMLD_IDE_PHYS, 0x1000);
67
- if (!mem) {
68
- ret = -ENOMEM;
69
- goto err1;
66
+ mem = devm_ioremap(dev, PALMLD_IDE_PHYS, 0x1000);
67
+ if (!mem)
68
+ return -ENOMEM;
69
+
70
+ /* request and activate power and reset GPIOs */
71
+ lda->power = devm_gpiod_get(dev, "power", GPIOD_OUT_HIGH);
72
+ if (IS_ERR(lda->power))
73
+ return PTR_ERR(lda->power);
74
+ lda->reset = devm_gpiod_get(dev, "reset", GPIOD_OUT_HIGH);
75
+ if (IS_ERR(lda->reset)) {
76
+ gpiod_set_value(lda->power, 0);
77
+ return PTR_ERR(lda->reset);
7078 }
7179
72
- /* request and activate power GPIO, IRQ GPIO */
73
- ret = gpio_request_array(palmld_hdd_gpios,
74
- ARRAY_SIZE(palmld_hdd_gpios));
75
- if (ret)
76
- goto err1;
77
-
78
- /* reset the drive */
79
- gpio_set_value(GPIO_NR_PALMLD_IDE_RESET, 0);
80
+ /* Assert reset to reset the drive */
81
+ gpiod_set_value(lda->reset, 1);
8082 msleep(30);
81
- gpio_set_value(GPIO_NR_PALMLD_IDE_RESET, 1);
83
+ gpiod_set_value(lda->reset, 0);
8284 msleep(30);
8385
8486 /* setup the ata port */
85
- ap = host->ports[0];
87
+ ap = lda->host->ports[0];
8688 ap->ops = &palmld_port_ops;
8789 ap->pio_mask = ATA_PIO4;
8890 ap->flags |= ATA_FLAG_PIO_POLLING;
....@@ -96,27 +98,26 @@
9698 ata_sff_std_ports(&ap->ioaddr);
9799
98100 /* activate host */
99
- ret = ata_host_activate(host, 0, NULL, IRQF_TRIGGER_RISING,
100
- &palmld_sht);
101
- if (ret)
102
- goto err2;
101
+ ret = ata_host_activate(lda->host, 0, NULL, IRQF_TRIGGER_RISING,
102
+ &palmld_sht);
103
+ /* power down on failure */
104
+ if (ret) {
105
+ gpiod_set_value(lda->power, 0);
106
+ return ret;
107
+ }
103108
104
- return ret;
105
-
106
-err2:
107
- gpio_free_array(palmld_hdd_gpios, ARRAY_SIZE(palmld_hdd_gpios));
108
-err1:
109
- return ret;
109
+ platform_set_drvdata(pdev, lda);
110
+ return 0;
110111 }
111112
112
-static int palmld_pata_remove(struct platform_device *dev)
113
+static int palmld_pata_remove(struct platform_device *pdev)
113114 {
114
- ata_platform_remove_one(dev);
115
+ struct palmld_pata *lda = platform_get_drvdata(pdev);
116
+
117
+ ata_platform_remove_one(pdev);
115118
116119 /* power down the HDD */
117
- gpio_set_value(GPIO_NR_PALMLD_IDE_PWEN, 0);
118
-
119
- gpio_free_array(palmld_hdd_gpios, ARRAY_SIZE(palmld_hdd_gpios));
120
+ gpiod_set_value(lda->power, 0);
120121
121122 return 0;
122123 }