| /* |
| * AVR32 SMC/CFC PATA Driver |
| * |
| * Copyright (C) 2007 Atmel Norway |
| * |
| * This program is free software; you can redistribute it and/or |
| * modify it under the terms of the GNU General Public License version |
| * 2 as published by the Free Software Foundation. |
| */ |
| |
| #define DEBUG |
| |
| #include <linux/kernel.h> |
| #include <linux/module.h> |
| #include <linux/init.h> |
| #include <linux/device.h> |
| #include <linux/platform_device.h> |
| #include <linux/delay.h> |
| #include <linux/interrupt.h> |
| #include <linux/irq.h> |
| #include <scsi/scsi_host.h> |
| #include <linux/ata.h> |
| #include <linux/libata.h> |
| #include <linux/err.h> |
| #include <linux/io.h> |
| |
| #include <asm/arch/board.h> |
| #include <asm/arch/smc.h> |
| |
| #define DRV_NAME "pata_at32" |
| #define DRV_VERSION "0.0.3" |
| |
| /* |
| * CompactFlash controller memory layout relative to the base address: |
| * |
| * Attribute memory: 0000 0000 -> 003f ffff |
| * Common memory: 0040 0000 -> 007f ffff |
| * I/O memory: 0080 0000 -> 00bf ffff |
| * True IDE Mode: 00c0 0000 -> 00df ffff |
| * Alt IDE Mode: 00e0 0000 -> 00ff ffff |
| * |
| * Only True IDE and Alt True IDE mode are needed for this driver. |
| * |
| * True IDE mode => CS0 = 0, CS1 = 1 (cmd, error, stat, etc) |
| * Alt True IDE mode => CS0 = 1, CS1 = 0 (ctl, alt_stat) |
| */ |
| #define CF_IDE_OFFSET 0x00c00000 |
| #define CF_ALT_IDE_OFFSET 0x00e00000 |
| #define CF_RES_SIZE 2048 |
| |
| /* |
| * Define DEBUG_BUS if you are doing debugging of your own EBI -> PATA |
| * adaptor with a logic analyzer or similar. |
| */ |
| #undef DEBUG_BUS |
| |
| /* |
| * ATA PIO modes |
| * |
| * Name | Mb/s | Min cycle time | Mask |
| * --------+-------+----------------+-------- |
| * Mode 0 | 3.3 | 600 ns | 0x01 |
| * Mode 1 | 5.2 | 383 ns | 0x03 |
| * Mode 2 | 8.3 | 240 ns | 0x07 |
| * Mode 3 | 11.1 | 180 ns | 0x0f |
| * Mode 4 | 16.7 | 120 ns | 0x1f |
| * |
| * Alter PIO_MASK below according to table to set maximal PIO mode. |
| */ |
| #define PIO_MASK (0x1f) |
| |
| /* |
| * Struct containing private information about device. |
| */ |
| struct at32_ide_info { |
| unsigned int irq; |
| struct resource res_ide; |
| struct resource res_alt; |
| void __iomem *ide_addr; |
| void __iomem *alt_addr; |
| unsigned int cs; |
| struct smc_config smc; |
| }; |
| |
| /* |
| * Setup SMC for the given ATA timing. |
| */ |
| static int pata_at32_setup_timing(struct device *dev, |
| struct at32_ide_info *info, |
| const struct ata_timing *ata) |
| { |
| struct smc_config *smc = &info->smc; |
| struct smc_timing timing; |
| |
| int active; |
| int recover; |
| |
| memset(&timing, 0, sizeof(struct smc_timing)); |
| |
| /* Total cycle time */ |
| timing.read_cycle = ata->cyc8b; |
| |
| /* DIOR <= CFIOR timings */ |
| timing.nrd_setup = ata->setup; |
| timing.nrd_pulse = ata->act8b; |
| timing.nrd_recover = ata->rec8b; |
| |
| /* Convert nanosecond timing to clock cycles */ |
| smc_set_timing(smc, &timing); |
| |
| /* Add one extra cycle setup due to signal ring */ |
| smc->nrd_setup = smc->nrd_setup + 1; |
| |
| active = smc->nrd_setup + smc->nrd_pulse; |
| recover = smc->read_cycle - active; |
| |
| /* Need at least two cycles recovery */ |
| if (recover < 2) |
| smc->read_cycle = active + 2; |
| |
| /* (CS0, CS1, DIR, OE) <= (CFCE1, CFCE2, CFRNW, NCSX) timings */ |
| smc->ncs_read_setup = 1; |
| smc->ncs_read_pulse = smc->read_cycle - 2; |
| |
| /* Write timings same as read timings */ |
| smc->write_cycle = smc->read_cycle; |
| smc->nwe_setup = smc->nrd_setup; |
| smc->nwe_pulse = smc->nrd_pulse; |
| smc->ncs_write_setup = smc->ncs_read_setup; |
| smc->ncs_write_pulse = smc->ncs_read_pulse; |
| |
| /* Do some debugging output of ATA and SMC timings */ |
| dev_dbg(dev, "ATA: C=%d S=%d P=%d R=%d\n", |
| ata->cyc8b, ata->setup, ata->act8b, ata->rec8b); |
| |
| dev_dbg(dev, "SMC: C=%d S=%d P=%d NS=%d NP=%d\n", |
| smc->read_cycle, smc->nrd_setup, smc->nrd_pulse, |
| smc->ncs_read_setup, smc->ncs_read_pulse); |
| |
| /* Finally, configure the SMC */ |
| return smc_set_configuration(info->cs, smc); |
| } |
| |
| /* |
| * Procedures for libATA. |
| */ |
| static void pata_at32_set_piomode(struct ata_port *ap, struct ata_device *adev) |
| { |
| struct ata_timing timing; |
| struct at32_ide_info *info = ap->host->private_data; |
| |
| int ret; |
| |
| /* Compute ATA timing */ |
| ret = ata_timing_compute(adev, adev->pio_mode, &timing, 1000, 0); |
| if (ret) { |
| dev_warn(ap->dev, "Failed to compute ATA timing %d\n", ret); |
| return; |
| } |
| |
| /* Setup SMC to ATA timing */ |
| ret = pata_at32_setup_timing(ap->dev, info, &timing); |
| if (ret) { |
| dev_warn(ap->dev, "Failed to setup ATA timing %d\n", ret); |
| return; |
| } |
| } |
| |
| static void pata_at32_irq_clear(struct ata_port *ap) |
| { |
| /* No DMA controller yet */ |
| } |
| |
| static struct scsi_host_template at32_sht = { |
| .module = THIS_MODULE, |
| .name = DRV_NAME, |
| .ioctl = ata_scsi_ioctl, |
| .queuecommand = ata_scsi_queuecmd, |
| .can_queue = ATA_DEF_QUEUE, |
| .this_id = ATA_SHT_THIS_ID, |
| .sg_tablesize = LIBATA_MAX_PRD, |
| .cmd_per_lun = ATA_SHT_CMD_PER_LUN, |
| .emulated = ATA_SHT_EMULATED, |
| .use_clustering = ATA_SHT_USE_CLUSTERING, |
| .proc_name = DRV_NAME, |
| .dma_boundary = ATA_DMA_BOUNDARY, |
| .slave_configure = ata_scsi_slave_config, |
| .slave_destroy = ata_scsi_slave_destroy, |
| .bios_param = ata_std_bios_param, |
| }; |
| |
| static struct ata_port_operations at32_port_ops = { |
| .set_piomode = pata_at32_set_piomode, |
| .tf_load = ata_tf_load, |
| .tf_read = ata_tf_read, |
| .exec_command = ata_exec_command, |
| .check_status = ata_check_status, |
| .dev_select = ata_std_dev_select, |
| |
| .freeze = ata_bmdma_freeze, |
| .thaw = ata_bmdma_thaw, |
| .error_handler = ata_bmdma_error_handler, |
| .post_internal_cmd = ata_bmdma_post_internal_cmd, |
| .cable_detect = ata_cable_40wire, |
| |
| .qc_prep = ata_qc_prep, |
| .qc_issue = ata_qc_issue_prot, |
| |
| .data_xfer = ata_data_xfer, |
| |
| .irq_clear = pata_at32_irq_clear, |
| .irq_on = ata_irq_on, |
| |
| .port_start = ata_sff_port_start, |
| }; |
| |
| static int __init pata_at32_init_one(struct device *dev, |
| struct at32_ide_info *info) |
| { |
| struct ata_host *host; |
| struct ata_port *ap; |
| |
| host = ata_host_alloc(dev, 1); |
| if (!host) |
| return -ENOMEM; |
| |
| ap = host->ports[0]; |
| |
| /* Setup ATA bindings */ |
| ap->ops = &at32_port_ops; |
| ap->pio_mask = PIO_MASK; |
| ap->flags |= ATA_FLAG_MMIO | ATA_FLAG_SLAVE_POSS; |
| |
| /* |
| * Since all 8-bit taskfile transfers has to go on the lower |
| * byte of the data bus and there is a bug in the SMC that |
| * makes it impossible to alter the bus width during runtime, |
| * we need to hardwire the address signals as follows: |
| * |
| * A_IDE(2:0) <= A_EBI(3:1) |
| * |
| * This makes all addresses on the EBI even, thus all data |
| * will be on the lower byte of the data bus. All addresses |
| * used by libATA need to be altered according to this. |
| */ |
| ap->ioaddr.altstatus_addr = info->alt_addr + (0x06 << 1); |
| ap->ioaddr.ctl_addr = info->alt_addr + (0x06 << 1); |
| |
| ap->ioaddr.data_addr = info->ide_addr + (ATA_REG_DATA << 1); |
| ap->ioaddr.error_addr = info->ide_addr + (ATA_REG_ERR << 1); |
| ap->ioaddr.feature_addr = info->ide_addr + (ATA_REG_FEATURE << 1); |
| ap->ioaddr.nsect_addr = info->ide_addr + (ATA_REG_NSECT << 1); |
| ap->ioaddr.lbal_addr = info->ide_addr + (ATA_REG_LBAL << 1); |
| ap->ioaddr.lbam_addr = info->ide_addr + (ATA_REG_LBAM << 1); |
| ap->ioaddr.lbah_addr = info->ide_addr + (ATA_REG_LBAH << 1); |
| ap->ioaddr.device_addr = info->ide_addr + (ATA_REG_DEVICE << 1); |
| ap->ioaddr.status_addr = info->ide_addr + (ATA_REG_STATUS << 1); |
| ap->ioaddr.command_addr = info->ide_addr + (ATA_REG_CMD << 1); |
| |
| /* Set info as private data of ATA host */ |
| host->private_data = info; |
| |
| /* Register ATA device and return */ |
| return ata_host_activate(host, info->irq, ata_interrupt, |
| IRQF_SHARED | IRQF_TRIGGER_RISING, |
| &at32_sht); |
| } |
| |
| /* |
| * This function may come in handy for people analyzing their own |
| * EBI -> PATA adaptors. |
| */ |
| #ifdef DEBUG_BUS |
| |
| static void __init pata_at32_debug_bus(struct device *dev, |
| struct at32_ide_info *info) |
| { |
| const int d1 = 0xff; |
| const int d2 = 0x00; |
| |
| int i; |
| |
| /* Write 8-bit values (registers) */ |
| iowrite8(d1, info->alt_addr + (0x06 << 1)); |
| iowrite8(d2, info->alt_addr + (0x06 << 1)); |
| |
| for (i = 0; i < 8; i++) { |
| iowrite8(d1, info->ide_addr + (i << 1)); |
| iowrite8(d2, info->ide_addr + (i << 1)); |
| } |
| |
| /* Write 16 bit values (data) */ |
| iowrite16(d1, info->ide_addr); |
| iowrite16(d1 << 8, info->ide_addr); |
| |
| iowrite16(d1, info->ide_addr); |
| iowrite16(d1 << 8, info->ide_addr); |
| } |
| |
| #endif |
| |
| static int __init pata_at32_probe(struct platform_device *pdev) |
| { |
| const struct ata_timing initial_timing = |
| {XFER_PIO_0, 70, 290, 240, 600, 165, 150, 600, 0}; |
| |
| struct device *dev = &pdev->dev; |
| struct at32_ide_info *info; |
| struct ide_platform_data *board = pdev->dev.platform_data; |
| struct resource *res; |
| |
| int irq; |
| int ret; |
| |
| if (!board) |
| return -ENXIO; |
| |
| res = platform_get_resource(pdev, IORESOURCE_MEM, 0); |
| if (!res) |
| return -ENXIO; |
| |
| /* Retrive IRQ */ |
| irq = platform_get_irq(pdev, 0); |
| if (irq < 0) |
| return irq; |
| |
| /* Setup struct containing private information */ |
| info = kzalloc(sizeof(struct at32_ide_info), GFP_KERNEL); |
| if (!info) |
| return -ENOMEM; |
| |
| memset(info, 0, sizeof(struct at32_ide_info)); |
| |
| info->irq = irq; |
| info->cs = board->cs; |
| |
| /* Request memory resources */ |
| info->res_ide.start = res->start + CF_IDE_OFFSET; |
| info->res_ide.end = info->res_ide.start + CF_RES_SIZE - 1; |
| info->res_ide.name = "ide"; |
| info->res_ide.flags = IORESOURCE_MEM; |
| |
| ret = request_resource(res, &info->res_ide); |
| if (ret) |
| goto err_req_res_ide; |
| |
| info->res_alt.start = res->start + CF_ALT_IDE_OFFSET; |
| info->res_alt.end = info->res_alt.start + CF_RES_SIZE - 1; |
| info->res_alt.name = "alt"; |
| info->res_alt.flags = IORESOURCE_MEM; |
| |
| ret = request_resource(res, &info->res_alt); |
| if (ret) |
| goto err_req_res_alt; |
| |
| /* Setup non-timing elements of SMC */ |
| info->smc.bus_width = 2; /* 16 bit data bus */ |
| info->smc.nrd_controlled = 1; /* Sample data on rising edge of NRD */ |
| info->smc.nwe_controlled = 0; /* Drive data on falling edge of NCS */ |
| info->smc.nwait_mode = 3; /* NWAIT is in READY mode */ |
| info->smc.byte_write = 0; /* Byte select access type */ |
| info->smc.tdf_mode = 0; /* TDF optimization disabled */ |
| info->smc.tdf_cycles = 0; /* No TDF wait cycles */ |
| |
| /* Setup SMC to ATA timing */ |
| ret = pata_at32_setup_timing(dev, info, &initial_timing); |
| if (ret) |
| goto err_setup_timing; |
| |
| /* Map ATA address space */ |
| ret = -ENOMEM; |
| info->ide_addr = devm_ioremap(dev, info->res_ide.start, 16); |
| info->alt_addr = devm_ioremap(dev, info->res_alt.start, 16); |
| if (!info->ide_addr || !info->alt_addr) |
| goto err_ioremap; |
| |
| #ifdef DEBUG_BUS |
| pata_at32_debug_bus(dev, info); |
| #endif |
| |
| /* Setup and register ATA device */ |
| ret = pata_at32_init_one(dev, info); |
| if (ret) |
| goto err_ata_device; |
| |
| return 0; |
| |
| err_ata_device: |
| err_ioremap: |
| err_setup_timing: |
| release_resource(&info->res_alt); |
| err_req_res_alt: |
| release_resource(&info->res_ide); |
| err_req_res_ide: |
| kfree(info); |
| |
| return ret; |
| } |
| |
| static int __exit pata_at32_remove(struct platform_device *pdev) |
| { |
| struct ata_host *host = platform_get_drvdata(pdev); |
| struct at32_ide_info *info; |
| |
| if (!host) |
| return 0; |
| |
| info = host->private_data; |
| ata_host_detach(host); |
| |
| if (!info) |
| return 0; |
| |
| release_resource(&info->res_ide); |
| release_resource(&info->res_alt); |
| |
| kfree(info); |
| |
| return 0; |
| } |
| |
| static struct platform_driver pata_at32_driver = { |
| .remove = __exit_p(pata_at32_remove), |
| .driver = { |
| .name = "at32_ide", |
| .owner = THIS_MODULE, |
| }, |
| }; |
| |
| static int __init pata_at32_init(void) |
| { |
| return platform_driver_probe(&pata_at32_driver, pata_at32_probe); |
| } |
| |
| static void __exit pata_at32_exit(void) |
| { |
| platform_driver_unregister(&pata_at32_driver); |
| } |
| |
| module_init(pata_at32_init); |
| module_exit(pata_at32_exit); |
| |
| MODULE_LICENSE("GPL"); |
| MODULE_DESCRIPTION("AVR32 SMC/CFC PATA Driver"); |
| MODULE_AUTHOR("Kristoffer Nyborg Gregertsen <kngregertsen@norway.atmel.com>"); |
| MODULE_VERSION(DRV_VERSION); |