diff options
Diffstat (limited to 'target/linux/magicbox/files/drivers')
-rw-r--r-- | target/linux/magicbox/files/drivers/ide/ppc/magicbox_ide.c | 301 |
1 files changed, 0 insertions, 301 deletions
diff --git a/target/linux/magicbox/files/drivers/ide/ppc/magicbox_ide.c b/target/linux/magicbox/files/drivers/ide/ppc/magicbox_ide.c deleted file mode 100644 index 0bc62f2dec..0000000000 --- a/target/linux/magicbox/files/drivers/ide/ppc/magicbox_ide.c +++ /dev/null @@ -1,301 +0,0 @@ -/* - * Driver for MagicBox 2.0 onboard CompactFlash adapter. - * - * Written by Wojtek Kaniewski <wojtekka@toxygen.net> - * Copyright (C) 2008 Gabor Juhos <juhosg@openwrt.org> - * - * GNU General Public License. - */ - -#include <linux/version.h> -#include <linux/types.h> -#include <linux/mm.h> -#include <linux/interrupt.h> -#include <linux/blkdev.h> -#include <linux/hdreg.h> -#include <linux/ide.h> -#include <linux/delay.h> -#include <linux/platform_device.h> - -#define UIC0_PR 0xc4 -#define UIC0_TR 0xc5 -#define MAGICBOX_CF_IRQ 25 - -static u8 magicbox_ide_inb(unsigned long port) -{ - return (u8) (readw((void __iomem *) port) >> 8) & 0xff; -} - -static void magicbox_ide_outb(u8 value, unsigned long port) -{ - writew(value << 8, (void __iomem *) port); -} - -static void magicbox_ide_outbsync(ide_drive_t *drive, u8 value, - unsigned long port) -{ - writew(value << 8, (void __iomem *) port); -} - -static inline void magicbox_ide_insw(unsigned long port, void *addr, u32 count) -{ - u16 *ptr; - - for (ptr = addr; count--; ptr++) - *ptr = readw((void __iomem *) port); -} - -static inline void magicbox_ide_insl(unsigned long port, void *addr, u32 count) -{ - u32 *ptr; - - for (ptr = addr; count--; ptr++) - *ptr = readl((void __iomem *) port); -} - -static inline void magicbox_ide_outsw(unsigned long port, void *addr, - u32 count) -{ - u16 *ptr; - - for (ptr = addr; count--; ptr++) - writew(*ptr, (void __iomem *) port); -} - -static inline void magicbox_ide_outsl(unsigned long port, void *addr, - u32 count) -{ - u32 *ptr; - - for (ptr = addr; count--; ptr++) - writel(*ptr, (void __iomem *) port); -} - -static void magicbox_ide_tf_load(ide_drive_t *drive, ide_task_t *task) -{ - struct ide_io_ports *io_ports = &drive->hwif->io_ports; - struct ide_taskfile *tf = &task->tf; - u8 HIHI = (task->tf_flags & IDE_TFLAG_LBA48) ? 0xE0 : 0xEF; - - if (task->tf_flags & IDE_TFLAG_FLAGGED) - HIHI = 0xFF; - - ide_set_irq(drive, 1); - - if (task->tf_flags & IDE_TFLAG_OUT_DATA) - writel((tf->hob_data << 8) | tf->data, - (void __iomem *) io_ports->data_addr); - - if (task->tf_flags & IDE_TFLAG_OUT_HOB_FEATURE) - magicbox_ide_outb(tf->hob_feature, io_ports->feature_addr); - if (task->tf_flags & IDE_TFLAG_OUT_HOB_NSECT) - magicbox_ide_outb(tf->hob_nsect, io_ports->nsect_addr); - if (task->tf_flags & IDE_TFLAG_OUT_HOB_LBAL) - magicbox_ide_outb(tf->hob_lbal, io_ports->lbal_addr); - if (task->tf_flags & IDE_TFLAG_OUT_HOB_LBAM) - magicbox_ide_outb(tf->hob_lbam, io_ports->lbam_addr); - if (task->tf_flags & IDE_TFLAG_OUT_HOB_LBAH) - magicbox_ide_outb(tf->hob_lbah, io_ports->lbah_addr); - - if (task->tf_flags & IDE_TFLAG_OUT_FEATURE) - magicbox_ide_outb(tf->feature, io_ports->feature_addr); - if (task->tf_flags & IDE_TFLAG_OUT_NSECT) - magicbox_ide_outb(tf->nsect, io_ports->nsect_addr); - if (task->tf_flags & IDE_TFLAG_OUT_LBAL) - magicbox_ide_outb(tf->lbal, io_ports->lbal_addr); - if (task->tf_flags & IDE_TFLAG_OUT_LBAM) - magicbox_ide_outb(tf->lbam, io_ports->lbam_addr); - if (task->tf_flags & IDE_TFLAG_OUT_LBAH) - magicbox_ide_outb(tf->lbah, io_ports->lbah_addr); - - if (task->tf_flags & IDE_TFLAG_OUT_DEVICE) - magicbox_ide_outb((tf->device & HIHI) | drive->select.all, - io_ports->device_addr); -} - -static void magicbox_ide_tf_read(ide_drive_t *drive, ide_task_t *task) -{ - struct ide_io_ports *io_ports = &drive->hwif->io_ports; - struct ide_taskfile *tf = &task->tf; - - if (task->tf_flags & IDE_TFLAG_IN_DATA) { - u16 data = (u16) readl((void __iomem *) io_ports->data_addr); - - tf->data = data & 0xff; - tf->hob_data = (data >> 8) & 0xff; - } - - /* be sure we're looking at the low order bits */ - magicbox_ide_outb(drive->ctl & ~0x80, io_ports->ctl_addr); - - if (task->tf_flags & IDE_TFLAG_IN_NSECT) - tf->nsect = magicbox_ide_inb(io_ports->nsect_addr); - if (task->tf_flags & IDE_TFLAG_IN_LBAL) - tf->lbal = magicbox_ide_inb(io_ports->lbal_addr); - if (task->tf_flags & IDE_TFLAG_IN_LBAM) - tf->lbam = magicbox_ide_inb(io_ports->lbam_addr); - if (task->tf_flags & IDE_TFLAG_IN_LBAH) - tf->lbah = magicbox_ide_inb(io_ports->lbah_addr); - if (task->tf_flags & IDE_TFLAG_IN_DEVICE) - tf->device = magicbox_ide_inb(io_ports->device_addr); - - if (task->tf_flags & IDE_TFLAG_LBA48) { - magicbox_ide_outb(drive->ctl | 0x80, io_ports->ctl_addr); - - if (task->tf_flags & IDE_TFLAG_IN_HOB_FEATURE) - tf->hob_feature = magicbox_ide_inb(io_ports->feature_addr); - if (task->tf_flags & IDE_TFLAG_IN_HOB_NSECT) - tf->hob_nsect = magicbox_ide_inb(io_ports->nsect_addr); - if (task->tf_flags & IDE_TFLAG_IN_HOB_LBAL) - tf->hob_lbal = magicbox_ide_inb(io_ports->lbal_addr); - if (task->tf_flags & IDE_TFLAG_IN_HOB_LBAM) - tf->hob_lbam = magicbox_ide_inb(io_ports->lbam_addr); - if (task->tf_flags & IDE_TFLAG_IN_HOB_LBAH) - tf->hob_lbah = magicbox_ide_inb(io_ports->lbah_addr); - } -} - -static void magicbox_ide_input_data(ide_drive_t *drive, struct request *rq, - void *buf, unsigned int len) -{ - unsigned long port = drive->hwif->io_ports.data_addr; - - len++; - - if (drive->io_32bit) { - magicbox_ide_insl(port, buf, len / 4); - - if ((len & 3) >= 2) - magicbox_ide_insw(port, (u8 *)buf + (len & ~3), 1); - } else - magicbox_ide_insw(port, buf, len / 2); -} - -static void magicbox_ide_output_data(ide_drive_t *drive, struct request *rq, - void *buf, unsigned int len) -{ - unsigned long port = drive->hwif->io_ports.data_addr; - - len++; - - if (drive->io_32bit) { - magicbox_ide_outsl(port, buf, len / 4); - - if ((len & 3) >= 2) - magicbox_ide_outsw(port, (u8 *)buf + (len & ~3), 1); - } else - magicbox_ide_outsw(port, buf, len / 2); -} - -static void __init magicbox_ide_setup_hw(hw_regs_t *hw, u16 __iomem *base, - u16 __iomem *ctrl, int irq) -{ - unsigned long port = (unsigned long) base; - int i; - - memset(hw, 0, sizeof(*hw)); - for (i = 0; i <= 7; i++) - hw->io_ports_array[i] = port + i * 2; - - /* - * the IDE control register is at ATA address 6, - * with CS1 active instead of CS0 - */ - hw->io_ports.ctl_addr = (unsigned long)ctrl + (6 * 2); - - hw->irq = irq; - - hw->chipset = ide_generic; - hw->ack_intr = NULL; -} - -static int __init magibox_ide_probe(void) -{ - hw_regs_t hw; - ide_hwif_t *hwif; - u16 __iomem *base; - u16 __iomem *ctrl; - u8 idx[4] = { 0xff, 0xff, 0xff, 0xff }; - int err; - - /* Remap physical address space */ - base = ioremap_nocache(0xff100000, 4096); - if (base == NULL) { - err = -EBUSY; - goto err_out; - } - - ctrl = ioremap_nocache(0xff200000, 4096); - if (ctrl == NULL) { - err = -EBUSY; - goto err_unmap_base; - } - - magicbox_ide_setup_hw(&hw, base, ctrl, MAGICBOX_CF_IRQ); - - hwif = ide_find_port(); - if (!hwif) { - err = -ENODEV; - goto err_unmap_ctrl; - } - - ide_init_port_data(hwif, hwif->index); - ide_init_port_hw(hwif, &hw); - - hwif->host_flags = IDE_HFLAG_MMIO; - - hwif->tf_load = magicbox_ide_tf_load; - hwif->tf_read = magicbox_ide_tf_read; - - hwif->input_data = magicbox_ide_input_data; - hwif->output_data = magicbox_ide_output_data; - - hwif->drives[0].unmask = 1; - hwif->OUTB = magicbox_ide_outb; - hwif->OUTBSYNC = magicbox_ide_outbsync; - hwif->INB = magicbox_ide_inb; - - printk(KERN_INFO "ide%d: Magicbox CF interface\n", hwif->index); - - idx[0] = hwif->index; - - ide_device_add(idx, NULL); - - return 0; - -err_unmap_ctrl: - iounmap(ctrl); -err_unmap_base: - iounmap(base); -err_out: - return err; -} - -static int __init magicbox_ide_init(void) -{ - /* Turn on PerWE instead of PCIsomething */ - mtdcr(DCRN_CPC0_PCI_BASE, - mfdcr(DCRN_CPC0_PCI_BASE) | (0x80000000L >> 27)); - - /* PerCS1 (CF's CS0): base 0xff100000, 16-bit, rw */ - mtdcr(DCRN_EBC_BASE, 1); - mtdcr(DCRN_EBC_BASE + 1, 0xff11a000); - mtdcr(DCRN_EBC_BASE, 0x11); - mtdcr(DCRN_EBC_BASE + 1, 0x080bd800); - - /* PerCS2 (CF's CS1): base 0xff200000, 16-bit, rw */ - mtdcr(DCRN_EBC_BASE, 2); - mtdcr(DCRN_EBC_BASE + 1, 0xff21a000); - mtdcr(DCRN_EBC_BASE, 0x12); - mtdcr(DCRN_EBC_BASE + 1, 0x080bd800); - - /* Set interrupt to low-to-high-edge-triggered */ - mtdcr(UIC0_TR, mfdcr(UIC0_TR) & ~(0x80000000L >> MAGICBOX_CF_IRQ)); - mtdcr(UIC0_PR, mfdcr(UIC0_PR) | (0x80000000L >> MAGICBOX_CF_IRQ)); - - return magibox_ide_probe(); -} - -module_init(magicbox_ide_init); - -MODULE_LICENSE("GPL"); |