Thomas Gleixner | d2912cb | 2019-06-04 10:11:33 +0200 | [diff] [blame] | 1 | // SPDX-License-Identifier: GPL-2.0-only |
Anton Vorontsov | 61f7162 | 2008-01-09 22:10:41 +0300 | [diff] [blame] | 2 | /* |
| 3 | * OF-platform PATA driver |
| 4 | * |
| 5 | * Copyright (c) 2007 MontaVista Software, Inc. |
| 6 | * Anton Vorontsov <avorontsov@ru.mvista.com> |
Anton Vorontsov | 61f7162 | 2008-01-09 22:10:41 +0300 | [diff] [blame] | 7 | */ |
| 8 | |
| 9 | #include <linux/kernel.h> |
| 10 | #include <linux/module.h> |
Pawel Moll | 37210fb | 2011-09-07 13:36:26 +0100 | [diff] [blame] | 11 | #include <linux/of_address.h> |
Rob Herring | d0643aa | 2011-12-22 15:07:00 -0500 | [diff] [blame] | 12 | #include <linux/platform_device.h> |
Jeff Garzik | 0a87e3e | 2008-02-01 18:02:30 -0500 | [diff] [blame] | 13 | #include <linux/ata_platform.h> |
Brian Norris | 84043ac | 2012-12-03 10:34:42 -0800 | [diff] [blame] | 14 | #include <linux/libata.h> |
Anton Vorontsov | 61f7162 | 2008-01-09 22:10:41 +0300 | [diff] [blame] | 15 | |
Akinobu Mita | 1726390 | 2015-01-29 08:30:30 +0900 | [diff] [blame] | 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 | |
Greg Kroah-Hartman | 0ec2491 | 2012-12-21 13:19:58 -0800 | [diff] [blame] | 22 | static int pata_of_platform_probe(struct platform_device *ofdev) |
Anton Vorontsov | 61f7162 | 2008-01-09 22:10:41 +0300 | [diff] [blame] | 23 | { |
| 24 | int ret; |
Grant Likely | 61c7a08 | 2010-04-13 16:12:29 -0700 | [diff] [blame] | 25 | struct device_node *dn = ofdev->dev.of_node; |
Anton Vorontsov | 61f7162 | 2008-01-09 22:10:41 +0300 | [diff] [blame] | 26 | struct resource io_res; |
| 27 | struct resource ctl_res; |
Rob Herring | d0643aa | 2011-12-22 15:07:00 -0500 | [diff] [blame] | 28 | struct resource *irq_res; |
Anton Vorontsov | 61f7162 | 2008-01-09 22:10:41 +0300 | [diff] [blame] | 29 | unsigned int reg_shift = 0; |
| 30 | int pio_mode = 0; |
| 31 | int pio_mask; |
Alexander Shiyan | f3d5e4f | 2019-01-19 07:52:01 +0300 | [diff] [blame] | 32 | bool use16bit; |
Anton Vorontsov | 61f7162 | 2008-01-09 22:10:41 +0300 | [diff] [blame] | 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 | |
Alexander Shiyan | ca99140 | 2014-08-23 14:46:10 +0400 | [diff] [blame] | 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; |
Anton Vorontsov | 61f7162 | 2008-01-09 22:10:41 +0300 | [diff] [blame] | 46 | } |
| 47 | |
Rob Herring | d0643aa | 2011-12-22 15:07:00 -0500 | [diff] [blame] | 48 | irq_res = platform_get_resource(ofdev, IORESOURCE_IRQ, 0); |
Anton Vorontsov | 61f7162 | 2008-01-09 22:10:41 +0300 | [diff] [blame] | 49 | |
Kefeng Wang | 73b2951 | 2017-01-24 20:08:29 +0800 | [diff] [blame] | 50 | of_property_read_u32(dn, "reg-shift", ®_shift); |
Anton Vorontsov | 61f7162 | 2008-01-09 22:10:41 +0300 | [diff] [blame] | 51 | |
Kefeng Wang | 73b2951 | 2017-01-24 20:08:29 +0800 | [diff] [blame] | 52 | if (!of_property_read_u32(dn, "pio-mode", &pio_mode)) { |
Anton Vorontsov | 61f7162 | 2008-01-09 22:10:41 +0300 | [diff] [blame] | 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 | |
Alexander Shiyan | f3d5e4f | 2019-01-19 07:52:01 +0300 | [diff] [blame] | 61 | use16bit = of_property_read_bool(dn, "ata-generic,use16bit"); |
| 62 | |
Anton Vorontsov | 61f7162 | 2008-01-09 22:10:41 +0300 | [diff] [blame] | 63 | pio_mask = 1 << pio_mode; |
| 64 | pio_mask |= (1 << pio_mode) - 1; |
| 65 | |
Rob Herring | d0643aa | 2011-12-22 15:07:00 -0500 | [diff] [blame] | 66 | return __pata_platform_probe(&ofdev->dev, &io_res, &ctl_res, irq_res, |
Alexander Shiyan | f3d5e4f | 2019-01-19 07:52:01 +0300 | [diff] [blame] | 67 | reg_shift, pio_mask, &pata_platform_sht, |
| 68 | use16bit); |
Anton Vorontsov | 61f7162 | 2008-01-09 22:10:41 +0300 | [diff] [blame] | 69 | } |
| 70 | |
Bhumika Goyal | e3779f6 | 2017-03-02 01:03:28 +0530 | [diff] [blame] | 71 | static const struct of_device_id pata_of_platform_match[] = { |
Anton Vorontsov | 61f7162 | 2008-01-09 22:10:41 +0300 | [diff] [blame] | 72 | { .compatible = "ata-generic", }, |
Alexander Shiyan | ca99140 | 2014-08-23 14:46:10 +0400 | [diff] [blame] | 73 | { }, |
Anton Vorontsov | 61f7162 | 2008-01-09 22:10:41 +0300 | [diff] [blame] | 74 | }; |
| 75 | MODULE_DEVICE_TABLE(of, pata_of_platform_match); |
| 76 | |
Grant Likely | 1c48a5c | 2011-02-17 02:43:24 -0700 | [diff] [blame] | 77 | static struct platform_driver pata_of_platform_driver = { |
Grant Likely | 4018294 | 2010-04-13 16:13:02 -0700 | [diff] [blame] | 78 | .driver = { |
Akinobu Mita | 1726390 | 2015-01-29 08:30:30 +0900 | [diff] [blame] | 79 | .name = DRV_NAME, |
Grant Likely | 4018294 | 2010-04-13 16:13:02 -0700 | [diff] [blame] | 80 | .of_match_table = pata_of_platform_match, |
| 81 | }, |
Anton Vorontsov | 61f7162 | 2008-01-09 22:10:41 +0300 | [diff] [blame] | 82 | .probe = pata_of_platform_probe, |
Brian Norris | 3e7068d | 2012-11-02 00:46:22 -0700 | [diff] [blame] | 83 | .remove = ata_platform_remove_one, |
Anton Vorontsov | 61f7162 | 2008-01-09 22:10:41 +0300 | [diff] [blame] | 84 | }; |
| 85 | |
Axel Lin | 99c8ea3 | 2011-11-27 14:44:26 +0800 | [diff] [blame] | 86 | module_platform_driver(pata_of_platform_driver); |
Anton Vorontsov | 61f7162 | 2008-01-09 22:10:41 +0300 | [diff] [blame] | 87 | |
| 88 | MODULE_DESCRIPTION("OF-platform PATA driver"); |
| 89 | MODULE_AUTHOR("Anton Vorontsov <avorontsov@ru.mvista.com>"); |
| 90 | MODULE_LICENSE("GPL"); |