1 // SPDX-License-Identifier: GPL-2.0-only 2 /* 3 * OF-platform PATA driver 4 * 5 * Copyright (c) 2007 MontaVista Software, Inc. 6 * Anton Vorontsov <avorontsov@ru.mvista.com> 7 */ 8 9 #include <linux/kernel.h> 10 #include <linux/module.h> 11 #include <linux/of_address.h> 12 #include <linux/platform_device.h> 13 #include <linux/ata_platform.h> 14 #include <linux/libata.h> 15 16 #define DRV_NAME "pata_of_platform" 17 18 static struct scsi_host_template pata_platform_sht = { 19 ATA_PIO_SHT(DRV_NAME), 20 }; 21 22 static int pata_of_platform_probe(struct platform_device *ofdev) 23 { 24 int ret; 25 struct device_node *dn = ofdev->dev.of_node; 26 struct resource io_res; 27 struct resource ctl_res; 28 struct resource *irq_res; 29 unsigned int reg_shift = 0; 30 int pio_mode = 0; 31 int pio_mask; 32 bool use16bit; 33 34 ret = of_address_to_resource(dn, 0, &io_res); 35 if (ret) { 36 dev_err(&ofdev->dev, "can't get IO address from " 37 "device tree\n"); 38 return -EINVAL; 39 } 40 41 ret = of_address_to_resource(dn, 1, &ctl_res); 42 if (ret) { 43 dev_err(&ofdev->dev, "can't get CTL address from " 44 "device tree\n"); 45 return -EINVAL; 46 } 47 48 irq_res = platform_get_resource(ofdev, IORESOURCE_IRQ, 0); 49 50 of_property_read_u32(dn, "reg-shift", ®_shift); 51 52 if (!of_property_read_u32(dn, "pio-mode", &pio_mode)) { 53 if (pio_mode > 6) { 54 dev_err(&ofdev->dev, "invalid pio-mode\n"); 55 return -EINVAL; 56 } 57 } else { 58 dev_info(&ofdev->dev, "pio-mode unspecified, assuming PIO0\n"); 59 } 60 61 use16bit = of_property_read_bool(dn, "ata-generic,use16bit"); 62 63 pio_mask = 1 << pio_mode; 64 pio_mask |= (1 << pio_mode) - 1; 65 66 return __pata_platform_probe(&ofdev->dev, &io_res, &ctl_res, irq_res, 67 reg_shift, pio_mask, &pata_platform_sht, 68 use16bit); 69 } 70 71 static const struct of_device_id pata_of_platform_match[] = { 72 { .compatible = "ata-generic", }, 73 { }, 74 }; 75 MODULE_DEVICE_TABLE(of, pata_of_platform_match); 76 77 static struct platform_driver pata_of_platform_driver = { 78 .driver = { 79 .name = DRV_NAME, 80 .of_match_table = pata_of_platform_match, 81 }, 82 .probe = pata_of_platform_probe, 83 .remove = ata_platform_remove_one, 84 }; 85 86 module_platform_driver(pata_of_platform_driver); 87 88 MODULE_DESCRIPTION("OF-platform PATA driver"); 89 MODULE_AUTHOR("Anton Vorontsov <avorontsov@ru.mvista.com>"); 90 MODULE_LICENSE("GPL"); 91