From: Gabor Juhos Date: Sun, 19 Jul 2009 17:46:07 +0000 (+0000) Subject: backport Magicbox CF driver to 2.6.28 X-Git-Tag: reboot~22909 X-Git-Url: https://git.librecmc.org/?a=commitdiff_plain;h=ceaa5d87900161b31e83fb574f602e25ade7bc2c;p=oweals%2Fopenwrt.git backport Magicbox CF driver to 2.6.28 SVN-Revision: 16923 --- diff --git a/target/linux/ppc40x/patches/100-magicbox-ide-driver.patch b/target/linux/ppc40x/patches/100-magicbox-ide-driver.patch new file mode 100644 index 0000000000..eca26a9e4a --- /dev/null +++ b/target/linux/ppc40x/patches/100-magicbox-ide-driver.patch @@ -0,0 +1,359 @@ +--- a/drivers/ide/Kconfig ++++ b/drivers/ide/Kconfig +@@ -712,6 +712,11 @@ config BLK_DEV_IDE_AU1XXX_SEQTS_PER_RQ + default "128" + depends on BLK_DEV_IDE_AU1XXX + ++config BLK_DEV_IDE_MAGICBOX ++ tristate "Magicbox CF card support" ++ depends on MAGICBOXV2 || OPENRB_LIGHT ++ select IDE_XFER_MODE ++ + config BLK_DEV_IDE_TX4938 + tristate "TX4938 internal IDE support" + depends on SOC_TX4938 +--- a/drivers/ide/Makefile ++++ b/drivers/ide/Makefile +@@ -110,6 +110,7 @@ obj-$(CONFIG_BLK_DEV_IDE_RAPIDE) += rapi + obj-$(CONFIG_BLK_DEV_PALMCHIP_BK3710) += palm_bk3710.o + + obj-$(CONFIG_BLK_DEV_IDE_AU1XXX) += au1xxx-ide.o ++obj-$(CONFIG_BLK_DEV_IDE_MAGICBOX) += magicbox_ide.o + + obj-$(CONFIG_BLK_DEV_IDE_TX4938) += tx4938ide.o + obj-$(CONFIG_BLK_DEV_IDE_TX4939) += tx4939ide.o +--- /dev/null ++++ b/drivers/ide/magicbox_ide.c +@@ -0,0 +1,332 @@ ++/* ++ * IDE driver for the MagicBox 2.0 onboard CompactFlash slot. ++ * ++ * Copyright (C) 2009 Gabor Juhos ++ * ++ * Based on the original driver by Wojtek Kaniewski ++ * ++ * 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. ++ */ ++ ++#include ++#include ++#include ++#include ++#include ++#include ++ ++#define DRV_DESC "IDE driver for Magicbox 2.0 onboard CF slot" ++#define DRV_NAME "magicbox_cf" ++ ++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 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_exec_command(ide_hwif_t *hwif, u8 cmd) ++{ ++ magicbox_ide_outb(cmd, hwif->io_ports.command_addr); ++} ++ ++static u8 magicbox_ide_read_status(ide_hwif_t *hwif) ++{ ++ return magicbox_ide_inb(hwif->io_ports.status_addr); ++} ++ ++static u8 magicbox_ide_read_altstatus(ide_hwif_t *hwif) ++{ ++ return magicbox_ide_inb(hwif->io_ports.ctl_addr); ++} ++ ++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; ++ ++ 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, ++ 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(ATA_DEVCTL_OBS & ~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(ATA_DEVCTL_OBS | 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 magicbox_ide_set_pio_mode(ide_drive_t *drive, const u8 pio) ++{ ++} ++ ++static u8 magicbox_ide_cable_detect(ide_hwif_t *hwif) ++{ ++ return ATA_CBL_PATA40; ++} ++ ++static const struct ide_tp_ops magicbox_ide_tp_ops = { ++ .exec_command = magicbox_ide_exec_command, ++ .read_status = magicbox_ide_read_status, ++ .read_altstatus = magicbox_ide_read_altstatus, ++ ++ .set_irq = ide_set_irq, ++ .tf_load = magicbox_ide_tf_load, ++ .tf_read = magicbox_ide_tf_read, ++ ++ .input_data = magicbox_ide_input_data, ++ .output_data = magicbox_ide_output_data, ++}; ++ ++static const struct ide_port_ops magicbox_ide_port_ops = { ++ .set_pio_mode = magicbox_ide_set_pio_mode, ++ .cable_detect = magicbox_ide_cable_detect, ++}; ++ ++static const struct ide_port_info magicbox_ide_port_info = { ++ .name = DRV_NAME, ++ .chipset = ide_generic, ++ .tp_ops = &magicbox_ide_tp_ops, ++ .port_ops = &magicbox_ide_port_ops, ++ .host_flags = IDE_HFLAG_SINGLE | ++ IDE_HFLAG_NO_DMA | ++ IDE_HFLAG_MMIO | ++ IDE_HFLAG_UNMASK_IRQS, ++ .pio_mask = ATA_PIO4, ++}; ++ ++static inline void 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 __devinit magicbox_ide_of_probe(struct of_device *op, ++ const struct of_device_id *match) ++{ ++ hw_regs_t hw; ++ hw_regs_t *hws[] = { &hw, NULL, NULL, NULL }; ++ struct ide_host *host; ++ u16 __iomem *base; ++ u16 __iomem *ctrl; ++ int irq; ++ int ret = 0; ++ ++ irq = irq_of_parse_and_map(op->node, 0); ++ if (irq < 0) { ++ dev_err(&op->dev, "invalid irq\n"); ++ ret = -EINVAL; ++ goto err_exit; ++ } ++ ++ base = of_iomap(op->node, 0); ++ if (base == NULL) { ++ ret = -ENOMEM; ++ goto err_exit; ++ } ++ ++ ctrl = of_iomap(op->node, 1); ++ if (ctrl == NULL) { ++ ret = -ENOMEM; ++ goto err_unmap_base; ++ } ++ ++ magicbox_ide_setup_hw(&hw, base, ctrl, irq); ++ ++ hw.dev = &op->dev; ++ ++ ret = ide_host_add(&magicbox_ide_port_info, hws, &host); ++ if (ret) ++ goto err_unmap_ctrl; ++ ++ dev_set_drvdata(&op->dev, host); ++ ++ return 0; ++ ++ err_unmap_ctrl: ++ iounmap(ctrl); ++ err_unmap_base: ++ iounmap(base); ++ err_exit: ++ return ret; ++} ++ ++static struct of_device_id magicbox_ide_of_match[] = { ++ { .compatible = "magicbox-cf", }, ++ {}, ++}; ++ ++static struct of_platform_driver magicbox_ide_of_platform_driver = { ++ .owner = THIS_MODULE, ++ .name = DRV_NAME, ++ .match_table = magicbox_ide_of_match, ++ .probe = magicbox_ide_of_probe, ++ .driver = { ++ .name = DRV_NAME, ++ .owner = THIS_MODULE, ++ }, ++}; ++ ++static int __init magicbox_ide_init(void) ++{ ++ return of_register_platform_driver(&magicbox_ide_of_platform_driver); ++} ++ ++module_init(magicbox_ide_init); ++ ++MODULE_DESCRIPTION(DRV_DESC); ++MODULE_AUTHOR("Gabor Juhos "); ++MODULE_LICENSE("GPL v2"); ++MODULE_DEVICE_TABLE(of, magicbox_ide_of_match); diff --git a/target/linux/ppc40x/patches/101-powerpc-add-EBC_BXCR_BW-defines.patch b/target/linux/ppc40x/patches/101-powerpc-add-EBC_BXCR_BW-defines.patch new file mode 100644 index 0000000000..8e380c1c9c --- /dev/null +++ b/target/linux/ppc40x/patches/101-powerpc-add-EBC_BXCR_BW-defines.patch @@ -0,0 +1,12 @@ +--- a/arch/powerpc/boot/dcr.h ++++ b/arch/powerpc/boot/dcr.h +@@ -57,6 +57,9 @@ static const unsigned long sdram_bxcr[] + #define EBC_BXCR_BU_WO 0x00010000 + #define EBC_BXCR_BU_RW 0x00018000 + #define EBC_BXCR_BW 0x00006000 ++#define EBC_BXCR_BW_8 0x00000000 ++#define EBC_BXCR_BW_16 0x00002000 ++#define EBC_BXCR_BW_32 0x00006000 + #define EBC_B0AP 0x10 + #define EBC_B1AP 0x11 + #define EBC_B2AP 0x12 diff --git a/target/linux/ppc40x/patches/102-openrb-light-cf-card-fixup.patch b/target/linux/ppc40x/patches/102-openrb-light-cf-card-fixup.patch new file mode 100644 index 0000000000..7e8d2ef36e --- /dev/null +++ b/target/linux/ppc40x/patches/102-openrb-light-cf-card-fixup.patch @@ -0,0 +1,39 @@ +--- a/arch/powerpc/boot/cuboot-openrb-light.c ++++ b/arch/powerpc/boot/cuboot-openrb-light.c +@@ -22,8 +22,36 @@ + + static bd_t bd; + ++static void fixup_cf_card(void) ++{ ++#define DCRN_CPC0_PCI_BASE 0xf9 ++#define CF_CS0_BASE 0xff100000 ++#define CF_CS1_BASE 0xff200000 ++ ++ /* 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_EBC0_CFGADDR, EBC_B1CR); ++ mtdcr(DCRN_EBC0_CFGDATA, CF_CS0_BASE | EBC_BXCR_BU_RW | EBC_BXCR_BW_16); ++ mtdcr(DCRN_EBC0_CFGADDR, EBC_B1AP); ++ mtdcr(DCRN_EBC0_CFGDATA, 0x080bd800); ++ ++ /* PerCS2 (CF's CS1): base 0xff200000, 16-bit, rw */ ++ mtdcr(DCRN_EBC0_CFGADDR, EBC_B2CR); ++ mtdcr(DCRN_EBC0_CFGDATA, CF_CS1_BASE | EBC_BXCR_BU_RW | EBC_BXCR_BW_16); ++ mtdcr(DCRN_EBC0_CFGADDR, EBC_B2AP); ++ mtdcr(DCRN_EBC0_CFGDATA, 0x080bd800); ++ ++#undef DCRN_CPC0_PCI_BASE ++#undef CF_CS0_BASE ++#undef CF_CS1_BASE ++} ++ + static void openrb_light_fixups(void) + { ++ fixup_cf_card(); + ibm405ep_fixup_clocks(33333000); + ibm4xx_sdram_fixup_memsize(); + dt_fixup_mac_addresses(&bd.bi_enetaddr, &bd.bi_enet1addr); diff --git a/target/linux/ppc40x/patches/103-openrb-light-add-cf-card-to-dts.patch b/target/linux/ppc40x/patches/103-openrb-light-add-cf-card-to-dts.patch new file mode 100644 index 0000000000..ee49aa1c9d --- /dev/null +++ b/target/linux/ppc40x/patches/103-openrb-light-add-cf-card-to-dts.patch @@ -0,0 +1,17 @@ +--- a/arch/powerpc/boot/dts/openrb-light.dts ++++ b/arch/powerpc/boot/dts/openrb-light.dts +@@ -177,6 +177,14 @@ + */ + clock-frequency = <0>; /* Filled in by zImage */ + ++ cf_card@ff100000 { ++ compatible = "magicbox-cf"; ++ reg = <0x00000000 0xff100000 0x00001000 ++ 0x00000000 0xff200000 0x00001000>; ++ interrupt-parent = <&UIC0>; ++ interrupts = <0x19 0x1 /* IRQ_TYPE_EDGE_RISING */ >; ++ }; ++ + nor_flash@ff800000 { + compatible = "cfi-flash"; + bank-width = <2>; diff --git a/target/linux/ppc40x/patches/104-magicboxv2-cf-card-fixup.patch b/target/linux/ppc40x/patches/104-magicboxv2-cf-card-fixup.patch new file mode 100644 index 0000000000..56e337c281 --- /dev/null +++ b/target/linux/ppc40x/patches/104-magicboxv2-cf-card-fixup.patch @@ -0,0 +1,47 @@ +--- a/arch/powerpc/boot/cuboot-magicboxv2.c ++++ b/arch/powerpc/boot/cuboot-magicboxv2.c +@@ -2,6 +2,7 @@ + * Old U-boot compatibility for Magicbox v2 + * + * Author: Imre Kaloz ++ * Gabor Juhos + * + * 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 +@@ -22,8 +23,36 @@ + + static bd_t bd; + ++static void fixup_cf_card(void) ++{ ++#define DCRN_CPC0_PCI_BASE 0xf9 ++#define CF_CS0_BASE 0xff100000 ++#define CF_CS1_BASE 0xff200000 ++ ++ /* 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_EBC0_CFGADDR, EBC_B1CR); ++ mtdcr(DCRN_EBC0_CFGDATA, CF_CS0_BASE | EBC_BXCR_BU_RW | EBC_BXCR_BW_16); ++ mtdcr(DCRN_EBC0_CFGADDR, EBC_B1AP); ++ mtdcr(DCRN_EBC0_CFGDATA, 0x080bd800); ++ ++ /* PerCS2 (CF's CS1): base 0xff200000, 16-bit, rw */ ++ mtdcr(DCRN_EBC0_CFGADDR, EBC_B2CR); ++ mtdcr(DCRN_EBC0_CFGDATA, CF_CS1_BASE | EBC_BXCR_BU_RW | EBC_BXCR_BW_16); ++ mtdcr(DCRN_EBC0_CFGADDR, EBC_B2AP); ++ mtdcr(DCRN_EBC0_CFGDATA, 0x080bd800); ++ ++#undef DCRN_CPC0_PCI_BASE ++#undef CF_CS0_BASE ++#undef CF_CS1_BASE ++} ++ + static void magicboxv2_fixups(void) + { ++ fixup_cf_card(); + ibm405ep_fixup_clocks(25000000); + ibm4xx_sdram_fixup_memsize(); + dt_fixup_mac_addresses(&bd.bi_enetaddr, &bd.bi_enet1addr); diff --git a/target/linux/ppc40x/patches/105-magicboxv2-add-cf-card-to-dts.patch b/target/linux/ppc40x/patches/105-magicboxv2-add-cf-card-to-dts.patch new file mode 100644 index 0000000000..97990909bf --- /dev/null +++ b/target/linux/ppc40x/patches/105-magicboxv2-add-cf-card-to-dts.patch @@ -0,0 +1,25 @@ +--- a/arch/powerpc/boot/dts/magicboxv2.dts ++++ b/arch/powerpc/boot/dts/magicboxv2.dts +@@ -2,6 +2,7 @@ + * Device Tree Source for Magicbox v2 + * + * Copyright 2008 Imre Kaloz ++ * Copyright 2009 Gabor Juhos + * + * Based on walnut.dts + * +@@ -183,6 +184,14 @@ + */ + clock-frequency = <0>; /* Filled in by zImage */ + ++ cf_card@ff100000 { ++ compatible = "magicbox-cf"; ++ reg = <0x00000000 0xff100000 0x00001000 ++ 0x00000000 0xff200000 0x00001000>; ++ interrupt-parent = <&UIC0>; ++ interrupts = <0x19 0x1 /* IRQ_TYPE_EDGE_RISING */ >; ++ }; ++ + nor_flash@ffc00000 { + compatible = "cfi-flash"; + bank-width = <2>;