add preliminary MPC83xx support
authorImre Kaloz <kaloz@openwrt.org>
Mon, 9 Nov 2009 11:45:04 +0000 (11:45 +0000)
committerImre Kaloz <kaloz@openwrt.org>
Mon, 9 Nov 2009 11:45:04 +0000 (11:45 +0000)
SVN-Revision: 18353

package/kernel/modules/netdevices.mk
target/linux/mpc83xx/Makefile [new file with mode: 0644]
target/linux/mpc83xx/base-files/etc/inittab [new file with mode: 0644]
target/linux/mpc83xx/config-default [new file with mode: 0644]
target/linux/mpc83xx/image/Makefile [new file with mode: 0644]
target/linux/mpc83xx/patches/001-rb600.patch [new file with mode: 0644]

index b6a7aba..c5d008d 100644 (file)
@@ -113,7 +113,7 @@ $(eval $(call KernelPackage,via-rhine))
 define KernelPackage/via-velocity
   SUBMENU:=$(NETWORK_DEVICES_MENU)
   TITLE:=VIA Velocity Gigabit Ethernet Adapter kernel support
-  DEPENDS:=@TARGET_ixp4xx||TARGET_x86
+  DEPENDS:=@TARGET_ixp4xx||TARGET_mpc83xx||TARGET_x86
   KCONFIG:=CONFIG_VIA_VELOCITY
   FILES:=$(LINUX_DIR)/drivers/net/via-velocity.$(LINUX_KMOD_SUFFIX)
   AUTOLOAD:=$(call AutoLoad,50,via-velocity)
diff --git a/target/linux/mpc83xx/Makefile b/target/linux/mpc83xx/Makefile
new file mode 100644 (file)
index 0000000..4dca616
--- /dev/null
@@ -0,0 +1,25 @@
+#
+# Copyright (C) 2007-2009 OpenWrt.org
+#
+# This is free software, licensed under the GNU General Public License v2.
+# See /LICENSE for more information.
+#
+include $(TOPDIR)/rules.mk
+
+ARCH:=powerpc
+BOARD:=mpc83xx
+BOARDNAME:=Freescale MPC83xx
+FEATURES:=tgz broken
+
+LINUX_VERSION:=2.6.30.9
+LINUX_KARCH:=powerpc
+
+include $(INCLUDE_DIR)/target.mk
+
+DEFAULT_PACKAGES += kmod-via-velocity
+
+define Target/Description
+       Build firmware images for Freescale MPC83xx based boards (eg. RouterBoard 600).
+endef
+
+$(eval $(call BuildTarget))
diff --git a/target/linux/mpc83xx/base-files/etc/inittab b/target/linux/mpc83xx/base-files/etc/inittab
new file mode 100644 (file)
index 0000000..7989a7f
--- /dev/null
@@ -0,0 +1,4 @@
+::sysinit:/etc/init.d/rcS S boot
+::shutdown:/etc/init.d/rcS K stop
+ttyS0::askfirst:/bin/ash --login
+ttyS1::askfirst:/bin/ash --login
diff --git a/target/linux/mpc83xx/config-default b/target/linux/mpc83xx/config-default
new file mode 100644 (file)
index 0000000..a380b00
--- /dev/null
@@ -0,0 +1,235 @@
+# CONFIG_40x is not set
+# CONFIG_44x is not set
+CONFIG_6xx=y
+# CONFIG_8xxx_WDT is not set
+# CONFIG_ADVANCED_OPTIONS is not set
+# CONFIG_AGP is not set
+# CONFIG_ALTIVEC is not set
+# CONFIG_AMIGAONE is not set
+CONFIG_ARCH_ENABLE_MEMORY_HOTPLUG=y
+CONFIG_ARCH_ENABLE_MEMORY_HOTREMOVE=y
+CONFIG_ARCH_HAS_ILOG2_U32=y
+CONFIG_ARCH_HAS_WALK_MEMORY=y
+CONFIG_ARCH_MAY_HAVE_PC_FDC=y
+# CONFIG_ARCH_NO_VIRT_TO_BUS is not set
+# CONFIG_ARCH_PHYS_ADDR_T_64BIT is not set
+CONFIG_ARCH_POPULATES_NODE_MAP=y
+CONFIG_ARCH_REQUIRE_GPIOLIB=y
+CONFIG_ARCH_SUPPORTS_DEBUG_PAGEALLOC=y
+CONFIG_ARCH_SUPPORTS_MSI=y
+CONFIG_ARCH_SUSPEND_POSSIBLE=y
+CONFIG_ARCH_WANT_OPTIONAL_GPIOLIB=y
+# CONFIG_ASP834x is not set
+CONFIG_ATA=y
+# CONFIG_ATA_NONSTANDARD is not set
+# CONFIG_ATA_PIIX is not set
+CONFIG_ATA_SFF=y
+CONFIG_AUDIT_ARCH=y
+CONFIG_BASE_SMALL=0
+# CONFIG_BINARY_PRINTF is not set
+CONFIG_BITREVERSE=y
+# CONFIG_BOOTX_TEXT is not set
+CONFIG_BOUNCE=y
+# CONFIG_BRIQ_PANEL is not set
+CONFIG_CC_OPTIMIZE_FOR_SIZE=y
+CONFIG_CMDLINE="console=ttyS0,115200"
+CONFIG_CMDLINE_BOOL=y
+# CONFIG_CPU_FREQ is not set
+# CONFIG_CRASH_DUMP is not set
+CONFIG_CRYPTO_AEAD2=y
+CONFIG_CRYPTO_BLKCIPHER2=y
+CONFIG_CRYPTO_HASH2=y
+CONFIG_CRYPTO_MANAGER2=y
+CONFIG_CRYPTO_RNG2=y
+CONFIG_CRYPTO_WORKQUEUE=y
+# CONFIG_DEBUG_BUGVERBOSE is not set
+CONFIG_DECOMPRESS_LZMA=y
+CONFIG_DEFAULT_UIMAGE=y
+CONFIG_DEVPORT=y
+CONFIG_DTC=y
+# CONFIG_E200 is not set
+CONFIG_EARLY_PRINTK=y
+# CONFIG_EDAC is not set
+# CONFIG_EMBEDDED6xx is not set
+CONFIG_FORCE_MAX_ZONEORDER=11
+# CONFIG_FSL_EMB_PERFMON is not set
+CONFIG_FSL_PCI=y
+CONFIG_FSL_PQ_MDIO=y
+CONFIG_FSL_SOC=y
+# CONFIG_FSL_ULI1575 is not set
+CONFIG_GENERIC_BUG=y
+CONFIG_GENERIC_CLOCKEVENTS=y
+CONFIG_GENERIC_CLOCKEVENTS_BUILD=y
+CONFIG_GENERIC_CMOS_UPDATE=y
+CONFIG_GENERIC_FIND_LAST_BIT=y
+CONFIG_GENERIC_FIND_NEXT_BIT=y
+CONFIG_GENERIC_GPIO=y
+# CONFIG_GENERIC_IOMAP is not set
+CONFIG_GENERIC_ISA_DMA=y
+CONFIG_GENERIC_NVRAM=y
+# CONFIG_GENERIC_TBSYNC is not set
+CONFIG_GENERIC_TIME_VSYSCALL=y
+# CONFIG_GEN_RTC is not set
+CONFIG_GIANFAR=y
+CONFIG_GPIOLIB=y
+CONFIG_HAS_DMA=y
+CONFIG_HAS_IOMEM=y
+CONFIG_HAS_IOPORT=y
+# CONFIG_HAS_RAPIDIO is not set
+CONFIG_HAVE_ARCH_KGDB=y
+CONFIG_HAVE_ARCH_TRACEHOOK=y
+CONFIG_HAVE_DYNAMIC_FTRACE=y
+CONFIG_HAVE_EFFICIENT_UNALIGNED_ACCESS=y
+CONFIG_HAVE_FTRACE_MCOUNT_RECORD=y
+CONFIG_HAVE_FUNCTION_GRAPH_TRACER=y
+CONFIG_HAVE_FUNCTION_TRACER=y
+# CONFIG_HAVE_GENERIC_DMA_COHERENT is not set
+CONFIG_HAVE_IDE=y
+CONFIG_HAVE_IOREMAP_PROT=y
+CONFIG_HAVE_KPROBES=y
+CONFIG_HAVE_KRETPROBES=y
+CONFIG_HAVE_LATENCYTOP_SUPPORT=y
+CONFIG_HAVE_LMB=y
+CONFIG_HAVE_MLOCK=y
+CONFIG_HAVE_OPROFILE=y
+# CONFIG_HAVE_SETUP_PER_CPU_AREA is not set
+# CONFIG_HVC_RTAS is not set
+# CONFIG_HVC_UDBG is not set
+CONFIG_HW_RANDOM=y
+CONFIG_HZ=250
+# CONFIG_HZ_100 is not set
+CONFIG_HZ_250=y
+# CONFIG_I2C is not set
+CONFIG_INITRAMFS_SOURCE=""
+# CONFIG_IOMMU_HELPER is not set
+CONFIG_IPIC=y
+# CONFIG_IRQSTACKS is not set
+CONFIG_IRQ_PER_CPU=y
+# CONFIG_ISA is not set
+CONFIG_ISA_DMA_API=y
+# CONFIG_JFFS2_FS is not set
+CONFIG_KERNEL_START=0xc0000000
+# CONFIG_LEDS_GPIO is not set
+CONFIG_LOWMEM_SIZE=0x30000000
+# CONFIG_MACINTOSH_DRIVERS is not set
+# CONFIG_MMIO_NVRAM is not set
+# CONFIG_MPC5121_ADS is not set
+# CONFIG_MPC5121_GENERIC is not set
+# CONFIG_MPC831x_RDB is not set
+# CONFIG_MPC832x_MDS is not set
+# CONFIG_MPC832x_RDB is not set
+# CONFIG_MPC834x_ITX is not set
+# CONFIG_MPC834x_MDS is not set
+# CONFIG_MPC836x_MDS is not set
+# CONFIG_MPC836x_RDK is not set
+# CONFIG_MPC837x_MDS is not set
+# CONFIG_MPC837x_RDB is not set
+# CONFIG_MPC8xxx_GPIO is not set
+CONFIG_MPIC=y
+# CONFIG_MPIC_WEIRD is not set
+# CONFIG_MTD_CFI is not set
+CONFIG_MTD_NAND=y
+# CONFIG_MTD_NAND_FSL_ELBC is not set
+# CONFIG_MTD_NAND_FSL_UPM is not set
+CONFIG_MTD_NAND_RB_PPC=y
+# CONFIG_MTD_OF_PARTS is not set
+# CONFIG_NATSEMI is not set
+# CONFIG_NVRAM is not set
+CONFIG_OF=y
+CONFIG_OF_DEVICE=y
+CONFIG_OF_GPIO=y
+CONFIG_PAGEFLAGS_EXTENDED=y
+CONFIG_PAGE_OFFSET=0xc0000000
+CONFIG_PATA_RB_PPC=m
+# CONFIG_PATA_SCH is not set
+CONFIG_PCI=y
+# CONFIG_PCIEPORTBUS is not set
+CONFIG_PCI_DISABLE_COMMON_QUIRKS=y
+CONFIG_PCI_DOMAINS=y
+CONFIG_PCI_SYSCALL=y
+CONFIG_PCSPKR_PLATFORM=y
+CONFIG_PHYLIB=y
+CONFIG_PHYSICAL_START=0x00000000
+CONFIG_PPC=y
+CONFIG_PPC32=y
+# CONFIG_PPC64 is not set
+# CONFIG_PPC_16K_PAGES is not set
+# CONFIG_PPC_256K_PAGES is not set
+CONFIG_PPC_4K_PAGES=y
+# CONFIG_PPC_64K_PAGES is not set
+# CONFIG_PPC_82xx is not set
+CONFIG_PPC_83xx=y
+# CONFIG_PPC_85xx is not set
+# CONFIG_PPC_86xx is not set
+# CONFIG_PPC_8xx is not set
+# CONFIG_PPC_970_NAP is not set
+CONFIG_PPC_BOOK3S=y
+# CONFIG_PPC_CELL is not set
+# CONFIG_PPC_CELL_NATIVE is not set
+CONFIG_PPC_CHRP=y
+# CONFIG_PPC_CLOCK is not set
+# CONFIG_PPC_DCR_MMIO is not set
+# CONFIG_PPC_DCR_NATIVE is not set
+# CONFIG_PPC_EARLY_DEBUG is not set
+CONFIG_PPC_FPU=y
+CONFIG_PPC_I8259=y
+# CONFIG_PPC_INDIRECT_IO is not set
+CONFIG_PPC_INDIRECT_PCI=y
+CONFIG_PPC_LIB_RHEAP=y
+# CONFIG_PPC_MM_SLICES is not set
+CONFIG_PPC_MPC106=y
+# CONFIG_PPC_MPC52xx is not set
+CONFIG_PPC_MPC834x=y
+CONFIG_PPC_NATIVE=y
+CONFIG_PPC_OF=y
+CONFIG_PPC_OF_BOOT_TRAMPOLINE=y
+CONFIG_PPC_PCI_CHOICE=y
+# CONFIG_PPC_PMAC is not set
+CONFIG_PPC_RTAS=y
+CONFIG_PPC_STD_MMU=y
+CONFIG_PPC_STD_MMU_32=y
+CONFIG_PPC_UDBG_16550=y
+# CONFIG_PQ2ADS is not set
+CONFIG_PRINT_STACK_DEPTH=64
+CONFIG_PROC_DEVICETREE=y
+CONFIG_QE_GPIO=y
+CONFIG_QUICC_ENGINE=y
+CONFIG_RB_IOMAP=y
+CONFIG_RB_PPC=y
+# CONFIG_RTAS_ERROR_LOGGING is not set
+CONFIG_RTAS_PROC=y
+CONFIG_RWSEM_XCHGADD_ALGORITHM=y
+# CONFIG_SATA_FSL is not set
+# CONFIG_SBC834x is not set
+CONFIG_SCHED_HRTICK=y
+CONFIG_SCHED_OMIT_FRAME_POINTER=y
+CONFIG_SCSI=y
+# CONFIG_SERIAL_8250_DETECT_IRQ is not set
+CONFIG_SERIAL_8250_EXTENDED=y
+# CONFIG_SERIAL_8250_MANY_PORTS is not set
+# CONFIG_SERIAL_8250_RSA is not set
+CONFIG_SERIAL_8250_SHARE_IRQ=y
+CONFIG_SERIAL_OF_PLATFORM=y
+# CONFIG_SERIAL_QE is not set
+# CONFIG_SIMPLE_GPIO is not set
+# CONFIG_SLOW_WORK is not set
+# CONFIG_SMP is not set
+# CONFIG_SQUASHFS is not set
+CONFIG_TASK_SIZE=0xc0000000
+# CONFIG_TAU is not set
+CONFIG_TICK_ONESHOT=y
+CONFIG_TRACING_SUPPORT=y
+# CONFIG_UCC_GETH is not set
+# CONFIG_UDBG_RTAS_CONSOLE is not set
+# CONFIG_WATCHDOG_RTAS is not set
+CONFIG_WORD_SIZE=32
+# CONFIG_YAFFS_9BYTE_TAGS is not set
+# CONFIG_YAFFS_ALWAYS_CHECK_CHUNK_ERASED is not set
+CONFIG_YAFFS_AUTO_YAFFS2=y
+# CONFIG_YAFFS_DISABLE_LAZY_LOAD is not set
+# CONFIG_YAFFS_DISABLE_WIDE_TNODES is not set
+# CONFIG_YAFFS_DOES_ECC is not set
+CONFIG_YAFFS_FS=y
+CONFIG_YAFFS_SHORT_NAMES_IN_RAM=y
+CONFIG_YAFFS_YAFFS1=y
+CONFIG_YAFFS_YAFFS2=y
diff --git a/target/linux/mpc83xx/image/Makefile b/target/linux/mpc83xx/image/Makefile
new file mode 100644 (file)
index 0000000..1483786
--- /dev/null
@@ -0,0 +1,31 @@
+#
+# Copyright (C) 2009 OpenWrt.org
+#
+# This is free software, licensed under the GNU General Public License v2.
+# See /LICENSE for more information.
+#
+include $(TOPDIR)/rules.mk
+include $(INCLUDE_DIR)/image.mk
+
+
+define Image/Prepare
+endef
+
+define Image/BuildKernel
+       cp $(LINUX_DIR)/arch/powerpc/boot/dtbImage.rb600.elf $(BIN_DIR)/openwrt-$(BOARD)-rb600.elf
+endef
+
+define Image/Build
+       $(call Image/Build/$(1),$(1))
+endef
+
+define Image/Build/squashfs
+       $(call prepare_generic_squashfs,$(KDIR)/root.squashfs)
+       ( \
+               dd if=$(LINUX_DIR)/arch/powerpc/boot/uImage bs=1920k conv=sync; \
+               dd if=$(KDIR)/openwrt-canyonlands.dtb bs=128k conv=sync; \
+               dd if=$(KDIR)/root.$(1) bs=256k conv=sync; \
+       ) > $(BIN_DIR)/openwrt-$(BOARD)-canyonlands-$(1).img
+endef
+
+$(eval $(call BuildImage))
diff --git a/target/linux/mpc83xx/patches/001-rb600.patch b/target/linux/mpc83xx/patches/001-rb600.patch
new file mode 100644 (file)
index 0000000..2337230
--- /dev/null
@@ -0,0 +1,1976 @@
+--- /dev/null
++++ b/arch/powerpc/boot/dts/rb600.dts
+@@ -0,0 +1,242 @@
++/*
++ * RouterBOARD 600 series Device Tree Source
++ *
++ * Copyright 2009 Michael Guntsche <mike@it-loops.com>
++ *
++ * This program is free software; you can redistribute  it and/or modify it
++ * under  the terms of  the GNU General  Public License as published by the
++ * Free Software Foundation;  either version 2 of the  License, or (at your
++ * option) any later version.
++ */
++
++/dts-v1/;
++
++/ {
++      model = "RB600";
++      compatible = "MPC83xx";
++      #address-cells = <1>;
++      #size-cells = <1>;
++
++      aliases {
++              ethernet0 = &enet0;
++              ethernet1 = &enet1;
++      };
++
++      chosen {
++              linux,stdout-path = "/soc8343@e0000000/serial@4500";
++      };
++
++      cpus {
++              #address-cells = <1>;
++              #size-cells = <0>;
++
++              PowerPC,8343E@0 {
++                      device_type = "cpu";
++                      reg = <0x0>;
++                      d-cache-line-size = <0x20>;
++                      i-cache-line-size = <0x20>;
++                      d-cache-size = <0x8000>;
++                      i-cache-size = <0x8000>;
++                      timebase-frequency = <0x0000000>; // filled by the bootwrapper from the firmware blob
++                      clock-frequency = <0x00000000>; // filled by the bootwrapper from the firmware blob
++              };
++      };
++
++      memory {
++              device_type = "memory";
++              reg = <0x0 0x0000000>; // filled by the bootwrapper from the firmware blob
++      };
++
++      cf@f9200000 {
++              lb-timings = <0x5dc 0x3e8 0x1194 0x5dc 0x2af8>;
++              interrupt-at-level = <0x0>;
++              interrupt-parent = <&ipic>;
++              interrupts = <0x16 0x8>;
++              lbc_extra_divider = <0x1>;
++              reg = <0xf9200000 0x200000>;
++              device_type = "rb,cf";
++      };
++
++      cf@f9000000 {
++              lb-timings = <0x5dc 0x3e8 0x1194 0x5dc 0x2af8>;
++              interrupt-at-level = <0x0>;
++              interrupt-parent = <&ipic>;
++              interrupts = <0x14 0x8>;
++              lbc_extra_divider = <0x1>;
++              reg = <0xf9000000 0x200000>;
++              device_type = "rb,cf";
++      };
++
++      flash {
++              reg = <0xff800000 0x20000>;
++      };
++
++      nnand {
++              reg = <0xf0000000 0x1000>;
++      };
++
++      nand {
++              ale = <&gpio 0x6>;
++              cle = <&gpio 0x5>;
++              nce = <&gpio 0x4>;
++              rdy = <&gpio 0x3>;
++              reg = <0xf8000000 0x1000>;
++              device_type = "rb,nand";
++      };
++
++      fancon {
++              interrupt-parent = <&ipic>;
++              interrupts = <0x17 0x8>;
++              sense = <&gpio 0x7>;
++              fan_on = <&gpio 0x9>;
++      };
++
++      pci0: pci@e0008500 {
++              device_type = "pci";
++              compatible = "fsl,mpc8349-pci";
++              reg = <0xe0008500 0x100 0xe0008300 0x8>;
++              #address-cells = <3>;
++              #size-cells = <2>;
++              #interrupt-cells = <1>;
++              ranges = <0x2000000 0x0 0x80000000 0x80000000 0x0 0x20000000 0x1000000 0x0 0x0 0xd0000000 0x0 0x4000000>;
++              bus-range = <0x0 0x0>;
++              interrupt-map = <
++                      0x5800 0x0 0x0 0x1 &ipic 0x15 0x8
++                      0x6000 0x0 0x0 0x1 &ipic 0x30 0x8
++                      0x6000 0x0 0x0 0x2 &ipic 0x11 0x8
++                      0x6800 0x0 0x0 0x1 &ipic 0x11 0x8
++                      0x6800 0x0 0x0 0x2 &ipic 0x12 0x8
++                      0x7000 0x0 0x0 0x1 &ipic 0x12 0x8
++                      0x7000 0x0 0x0 0x2 &ipic 0x13 0x8
++                      0x7800 0x0 0x0 0x1 &ipic 0x13 0x8
++                      0x7800 0x0 0x0 0x2 &ipic 0x30 0x8
++                      0x8000 0x0 0x0 0x1 &ipic 0x30 0x8
++                      0x8000 0x0 0x0 0x2 &ipic 0x12 0x8
++                      0x8000 0x0 0x0 0x3 &ipic 0x11 0x8
++                      0x8000 0x0 0x0 0x4 &ipic 0x13 0x8
++                      0xa000 0x0 0x0 0x1 &ipic 0x30 0x8
++                      0xa000 0x0 0x0 0x2 &ipic 0x11 0x8
++                      0xa000 0x0 0x0 0x3 &ipic 0x12 0x8
++                      0xa000 0x0 0x0 0x4 &ipic 0x13 0x8
++                      0xa800 0x0 0x0 0x1 &ipic 0x11 0x8
++                      0xa800 0x0 0x0 0x2 &ipic 0x12 0x8
++                      0xa800 0x0 0x0 0x3 &ipic 0x13 0x8
++                      0xa800 0x0 0x0 0x4 &ipic 0x30 0x8>;
++              interrupt-map-mask = <0xf800 0x0 0x0 0x7>;
++              interrupt-parent = <&ipic>;
++      };
++
++      soc8343@e0000000 {
++              #address-cells = <1>;
++              #size-cells = <1>;
++              device_type = "soc";
++              compatible = "simple-bus";
++              ranges = <0x0 0xe0000000 0x100000>;
++              reg = <0xe0000000 0x200>;
++              bus-frequency = <0x1>;
++
++              led {
++                      user_led = <0x400 0x8>;
++              };
++
++              beeper {
++                      reg = <0x500 0x100>;
++              };
++
++              gpio: gpio@0 {
++                      reg = <0xc08 0x4>;
++                      device-id = <0x0>;
++                      compatible = "gpio";
++                      device_type = "gpio";
++              };
++
++              enet0: ethernet@25000 {
++                      #address-cells = <1>;
++                      #size-cells = <1>;
++                      cell-index = <0>;
++                      phy-handle = <&phy0>;
++                      tbi-handle = <&tbi0>;
++                      interrupt-parent = <&ipic>;
++                      interrupts = <0x23 0x8 0x24 0x8 0x25 0x8>;
++                      local-mac-address = [00 00 00 00 00 00];
++                      reg = <0x25000 0x1000>;
++                      ranges = <0x0 0x25000 0x1000>;
++                      compatible = "gianfar";
++                      model = "TSEC";
++                      device_type = "network";
++
++                      mdio@520 {
++                              #address-cells = <1>;
++                              #size-cells = <0>;
++                              compatible = "fsl,gianfar-tbi";
++                              reg = <0x520 0x20>;
++
++                              tbi0: tbi-phy@11 {
++                                      reg = <0x11>;
++                                      device_type = "tbi-phy";
++                              };
++                      };
++              };
++
++              enet1: ethernet@24000 {
++                      #address-cells = <1>;
++                      #size-cells = <1>;
++                      cell-index = <1>;
++                      phy-handle = <&phy1>;
++                      tbi-handle = <&tbi1>;
++                      interrupt-parent = <&ipic>;
++                      interrupts = <0x20 0x8 0x21 0x8 0x22 0x8>;
++                      local-mac-address = [00 00 00 00 00 00];
++                      reg = <0x24000 0x1000>;
++                      ranges = <0x0 0x24000 0x1000>;
++                      compatible = "gianfar";
++                      model = "TSEC";
++                      device_type = "network";
++
++                      mdio@520 {
++                              #size-cells = <0x0>;
++                              #address-cells = <0x1>;
++                              reg = <0x520 0x20>;
++                              compatible = "fsl,gianfar-mdio";
++
++                              phy0: ethernet-phy@0 {
++                                      device_type = "ethernet-phy";
++                                      reg = <0x0>;
++                              };
++
++                              phy1: ethernet-phy@1 {
++                                      device_type = "ethernet-phy";
++                                      reg = <0x1>;
++                              };
++
++                              tbi1: tbi-phy@11 {
++                                      reg = <0x11>;
++                                      device_type = "tbi-phy";
++                              };
++                      };
++              };
++
++              ipic: pic@700 {
++                      interrupt-controller;
++                      #address-cells = <0>;
++                      #interrupt-cells = <2>;
++                      reg = <0x700 0x100>;
++                      device_type = "ipic";
++              };
++
++              serial@4500 {
++                      interrupt-parent = <&ipic>;
++                      interrupts = <0x9 0x8>;
++                      clock-frequency = <0xfe4f840>;
++                      reg = <0x4500 0x100>;
++                      compatible = "ns16550";
++                      device_type = "serial";
++              };
++
++              wdt@200 {
++                      reg = <0x200 0x100>;
++                      compatible = "mpc83xx_wdt";
++                      device_type = "watchdog";
++              };
++      };
++};
+--- a/arch/powerpc/boot/Makefile
++++ b/arch/powerpc/boot/Makefile
+@@ -72,7 +72,7 @@ src-plat := of.c cuboot-52xx.c cuboot-82
+               cuboot-pq2.c cuboot-sequoia.c treeboot-walnut.c \
+               cuboot-bamboo.c cuboot-mpc7448hpc2.c cuboot-taishan.c \
+               fixed-head.S ep88xc.c ep405.c cuboot-c2k.c \
+-              cuboot-katmai.c cuboot-rainier.c redboot-8xx.c ep8248e.c \
++              cuboot-katmai.c cuboot-rainier.c redboot-8xx.c ep8248e.c rb600.c \
+               cuboot-warp.c cuboot-85xx-cpm2.c cuboot-yosemite.c simpleboot.c \
+               virtex405-head.S virtex.c redboot-83xx.c cuboot-sam440ep.c \
+               cuboot-acadia.c cuboot-amigaone.c
+@@ -229,6 +229,7 @@ image-$(CONFIG_MPC834x_ITX)                += cuImage.
+ image-$(CONFIG_MPC834x_MDS)           += cuImage.mpc834x_mds
+ image-$(CONFIG_MPC836x_MDS)           += cuImage.mpc836x_mds
+ image-$(CONFIG_ASP834x)                       += dtbImage.asp834x-redboot
++image-$(CONFIG_RB_PPC)                        += dtbImage.rb600
+ # Board ports in arch/powerpc/platform/85xx/Kconfig
+ image-$(CONFIG_MPC8540_ADS)           += cuImage.mpc8540ads
+--- /dev/null
++++ b/arch/powerpc/boot/rb600.c
+@@ -0,0 +1,80 @@
++/*
++ * The RouterBOARD platform -- for booting RB600(A) RouterBOARDs.
++ *
++ * Author: Michael Guntsche <mike@it-loops.com>
++ *
++ * Copyright (c) 2009 Michael Guntsche
++ *
++ * 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 "ops.h"
++#include "types.h"
++#include "io.h"
++#include "stdio.h"
++#include <libfdt.h>
++
++BSS_STACK(4*1024);
++
++u64 memsize64;
++const void *fw_dtb;
++
++static void rb600_fixups(void)
++{
++      const u32 *reg, *timebase, *clock;
++      int node, size;
++      void *chosen;
++      const char* bootargs;
++
++      dt_fixup_memory(0, memsize64);
++
++      /* Set the MAC addresses. */
++      node = fdt_path_offset(fw_dtb, "/soc8343@e0000000/ethernet@24000");
++      reg = fdt_getprop(fw_dtb, node, "mac-address", &size);
++      dt_fixup_mac_address_by_alias("ethernet1", (const u8 *)reg);
++
++      node = fdt_path_offset(fw_dtb, "/soc8343@e0000000/ethernet@25000");
++      reg = fdt_getprop(fw_dtb, node, "mac-address", &size);
++      dt_fixup_mac_address_by_alias("ethernet0", (const u8 *)reg);
++
++      /* Find the CPU timebase and clock frequencies. */
++      node = fdt_node_offset_by_prop_value(fw_dtb, -1, "device_type", "cpu", sizeof("cpu"));
++      timebase = fdt_getprop(fw_dtb, node, "timebase-frequency", &size);
++      clock = fdt_getprop(fw_dtb, node, "clock-frequency", &size);
++      dt_fixup_cpu_clocks(*clock, *timebase, 0);
++
++      /* Fixup chosen
++       * The bootloader reads the kernelparm segment and adds the content to
++       * bootargs. This is needed to specify root and other boot flags.
++       */
++      chosen = finddevice("/chosen");
++      node = fdt_path_offset(fw_dtb, "/chosen");
++      bootargs = fdt_getprop(fw_dtb, node, "bootargs", &size);
++      setprop_str(chosen, "bootargs", bootargs);
++}
++
++void platform_init(unsigned long r3, unsigned long r4, unsigned long r5,
++                 unsigned long r6, unsigned long r7)
++{
++      const u32 *reg;
++      int node, size;
++
++      fw_dtb = (const void *)r3;
++      
++      /* Find the memory range. */
++      node = fdt_node_offset_by_prop_value(fw_dtb, -1, "device_type", "memory", sizeof("memory"));
++      reg = fdt_getprop(fw_dtb, node, "reg", &size);
++      memsize64 = reg[1];
++
++      /* Now we have the memory size; initialize the heap. */
++      simple_alloc_init(_end, memsize64 - (unsigned long)_end, 32, 64);
++
++      /* Prepare the device tree and find the console. */
++      fdt_init(_dtb_start);
++      serial_console_init();
++
++      /* Remaining fixups... */
++      platform_ops.fixups = rb600_fixups;
++}
+--- a/arch/powerpc/boot/wrapper
++++ b/arch/powerpc/boot/wrapper
+@@ -201,7 +201,7 @@ ps3)
+     isection=.kernel:initrd
+     link_address=''
+     ;;
+-ep88xc|ep405|ep8248e)
++ep88xc|ep405|ep8248e|rb600)
+     platformo="$object/fixed-head.o $object/$platform.o"
+     binary=y
+     ;;
+--- a/arch/powerpc/kernel/Makefile
++++ b/arch/powerpc/kernel/Makefile
+@@ -97,9 +97,11 @@ obj-$(CONFIG_FUNCTION_GRAPH_TRACER) += f
+ obj-$(CONFIG_8XX_MINIMAL_FPEMU) += softemu8xx.o
++ifneq ($(CONFIG_RB_IOMAP),y)
+ ifneq ($(CONFIG_PPC_INDIRECT_IO),y)
+ obj-y                         += iomap.o
+ endif
++endif
+ obj-$(CONFIG_PPC64)           += $(obj64-y)
+--- a/arch/powerpc/platforms/83xx/Kconfig
++++ b/arch/powerpc/platforms/83xx/Kconfig
+@@ -30,6 +30,15 @@ config MPC832x_RDB
+       help
+         This option enables support for the MPC8323 RDB board.
++config RB_PPC
++      bool "MikroTik RouterBOARD 600 series"
++      select DEFAULT_UIMAGE
++      select QUICC_ENGINE
++      select PPC_MPC834x
++      select RB_IOMAP
++      help
++        This option enables support for MikroTik RouterBOARD 600 series boards.
++
+ config MPC834x_MDS
+       bool "Freescale MPC834x MDS"
+       select DEFAULT_UIMAGE
+--- a/arch/powerpc/platforms/83xx/Makefile
++++ b/arch/powerpc/platforms/83xx/Makefile
+@@ -6,6 +6,7 @@ obj-$(CONFIG_SUSPEND)          += suspend.o susp
+ obj-$(CONFIG_MCU_MPC8349EMITX)        += mcu_mpc8349emitx.o
+ obj-$(CONFIG_MPC831x_RDB)     += mpc831x_rdb.o
+ obj-$(CONFIG_MPC832x_RDB)     += mpc832x_rdb.o
++obj-$(CONFIG_RB_PPC)          += rbppc.o
+ obj-$(CONFIG_MPC834x_MDS)     += mpc834x_mds.o
+ obj-$(CONFIG_MPC834x_ITX)     += mpc834x_itx.o
+ obj-$(CONFIG_MPC836x_MDS)     += mpc836x_mds.o
+--- /dev/null
++++ b/arch/powerpc/platforms/83xx/rbppc.c
+@@ -0,0 +1,316 @@
++/*
++ * Copyright (C) 2008-2009 Noah Fontes <nfontes@transtruct.org>
++ * Copyright (C) 2009 Michael Guntsche <mike@it-loops.com>
++ * Copyright (C) Mikrotik 2007
++ *
++ * This program is free software; you can redistribute it and/or modify it
++ * under the terms of the GNU General Public License as published by the
++ * Free Software Foundation; either version 2 of the License, or (at your
++ * option) any later version.
++ */
++
++#include <linux/delay.h>
++#include <linux/root_dev.h>
++#include <linux/initrd.h>
++#include <linux/interrupt.h>
++#include <linux/of_platform.h>
++#include <linux/of_device.h>
++#include <linux/of_platform.h>
++#include <asm/time.h>
++#include <asm/ipic.h>
++#include <asm/udbg.h>
++#include <asm/qe.h>
++#include <asm/qe_ic.h>
++#include <sysdev/fsl_soc.h>
++#include <sysdev/fsl_pci.h>
++#include "mpc83xx.h"
++
++#define SYSCTL                0x100
++#define SICRL         0x014
++
++#define GTCFR2                0x04
++#define GTMDR4                0x22
++#define GTRFR4                0x26
++#define GTCNR4                0x2e
++#define GTVER4                0x36
++#define GTPSR4                0x3e
++
++#define GTCFR_BCM     0x40
++#define GTCFR_STP4    0x20
++#define GTCFR_RST4    0x10
++#define GTCFR_STP3    0x02
++#define GTCFR_RST3    0x01
++
++#define GTMDR_ORI     0x10
++#define GTMDR_FRR     0x08
++#define GTMDR_ICLK16  0x04
++
++extern int par_io_data_set(u8 port, u8 pin, u8 val);
++extern int par_io_config_pin(u8 port, u8 pin, int dir, int open_drain,
++                           int assignment, int has_irq);
++
++static unsigned timer_freq;
++static void *gtm;
++
++static int beeper_irq;
++static unsigned beeper_gpio_pin[2];
++
++irqreturn_t rbppc_timer_irq(int irq, void *ptr)
++{
++      static int toggle = 0;
++
++      par_io_data_set(beeper_gpio_pin[0], beeper_gpio_pin[1], toggle);
++      toggle = !toggle;
++
++      /* ack interrupt */
++      out_be16(gtm + GTVER4, 3);
++
++      return IRQ_HANDLED;
++}
++
++void rbppc_beep(unsigned freq)
++{
++      unsigned gtmdr;
++
++      if (freq > 5000) freq = 5000;
++
++      if (!gtm)
++              return;
++      if (!freq) {
++              out_8(gtm + GTCFR2, GTCFR_STP4 | GTCFR_STP3);
++              return;
++      }
++
++      out_8(gtm + GTCFR2, GTCFR_RST4 | GTCFR_STP3);
++      out_be16(gtm + GTPSR4, 255);
++      gtmdr = GTMDR_FRR | GTMDR_ICLK16;
++      if (beeper_irq != NO_IRQ) gtmdr |= GTMDR_ORI;
++      out_be16(gtm + GTMDR4, gtmdr);
++      out_be16(gtm + GTVER4, 3);
++
++      out_be16(gtm + GTRFR4, timer_freq / 16 / 256 / freq / 2);
++      out_be16(gtm + GTCNR4, 0);
++}
++EXPORT_SYMBOL(rbppc_beep);
++
++static void __init rbppc_setup_arch(void)
++{
++      struct device_node *np;
++
++      np = of_find_node_by_type(NULL, "cpu");
++      if (np) {
++              const unsigned *fp = of_get_property(np, "clock-frequency", NULL);
++              loops_per_jiffy = fp ? *fp / HZ : 0;
++
++              of_node_put(np);
++      }
++
++      np = of_find_node_by_name(NULL, "serial");
++      if (np) {
++              timer_freq =
++                  *(unsigned *) of_get_property(np, "clock-frequency", NULL);
++              of_node_put(np);
++      }
++
++#ifdef CONFIG_PCI
++      np = of_find_node_by_type(NULL, "pci");
++      if (np) {
++              mpc83xx_add_bridge(np);
++      }
++#endif
++
++#ifdef CONFIG_QUICC_ENGINE
++      np = of_find_node_by_name(np, "par_io");
++      if (np) {
++              qe_reset();
++              par_io_init(np);
++              of_node_put(np);
++
++              np = NULL;
++              while (1) {
++                      np = of_find_node_by_name(np, "ucc");
++                      if (!np) break;
++
++                      par_io_of_config(np);
++              }
++      }
++#endif
++
++}
++
++void __init rbppc_init_IRQ(void)
++{
++      struct device_node *np;
++
++      np = of_find_node_by_type(NULL, "ipic");
++      if (np) {
++              ipic_init(np, 0);
++              ipic_set_default_priority();
++              of_node_put(np);
++      }
++
++#ifdef CONFIG_QUICC_ENGINE
++      np = of_find_node_by_type(NULL, "qeic");
++      if (np) {
++              qe_ic_init(np, 0, qe_ic_cascade_low_ipic, qe_ic_cascade_high_ipic);
++              of_node_put(np);
++      }
++#endif
++}
++
++static int __init rbppc_probe(void)
++{
++      char *model;
++
++      model = of_get_flat_dt_prop(of_get_flat_dt_root(), "model", NULL);
++
++      if (!model)
++              return 0;
++
++      if (strcmp(model, "RB600") == 0)
++              return 1;
++
++      return 0;
++}
++
++static void __init rbppc_beeper_init(struct device_node *beeper)
++{
++      struct resource res;
++      struct device_node *gpio;
++      const unsigned *pin;
++      const unsigned *gpio_id;
++
++      if (of_address_to_resource(beeper, 0, &res)) {
++              printk(KERN_ERR "rbppc_beeper_init(%s): Beeper error: No region specified\n", beeper->full_name);
++              return;
++      }
++
++      pin = of_get_property(beeper, "gpio", NULL);
++      if (pin) {
++              gpio = of_find_node_by_phandle(pin[0]);
++
++              if (!gpio) {
++                      printk(KERN_ERR "rbppc_beeper_init(%s): Beeper error: GPIO handle %x not found\n", beeper->full_name, pin[0]);
++                      return;
++              }
++
++              gpio_id = of_get_property(gpio, "device-id", NULL);
++              if (!gpio_id) {
++                      printk(KERN_ERR "rbppc_beeper_init(%s): Beeper error: No device-id specified in GPIO\n", beeper->full_name);
++                      return;
++              }
++
++              beeper_gpio_pin[0] = *gpio_id;
++              beeper_gpio_pin[1] = pin[1];
++
++              par_io_config_pin(*gpio_id, pin[1], 1, 0, 0, 0);
++      } else {
++              void *sysctl;
++
++              sysctl = ioremap_nocache(get_immrbase() + SYSCTL, 0x100);
++              out_be32(sysctl + SICRL,
++                       in_be32(sysctl + SICRL) | (1 << (31 - 19)));
++              iounmap(sysctl);
++      }
++
++      gtm = ioremap_nocache(res.start, res.end - res.start + 1);
++
++      beeper_irq = irq_of_parse_and_map(beeper, 0);
++      if (beeper_irq != NO_IRQ) {
++              int e = request_irq(beeper_irq, rbppc_timer_irq, 0, "beeper", NULL);
++              if (e) {
++                      printk(KERN_ERR "rbppc_beeper_init(%s): Request of beeper irq failed!\n", beeper->full_name);
++              }
++      }
++}
++
++#define SBIT(x) (0x80000000 >> (x))
++#define DBIT(x, y) ((y) << (32 - (((x % 16) + 1) * 2)))
++
++#define SICRL_RB600(x) ((x) + (0x114 >> 2))
++#define GPIO_DIR_RB600(x) ((x) + (0xc00 >> 2))
++#define GPIO_DATA_RB600(x) ((x) + (0xc08 >> 2))
++
++static void rbppc_restart(char *cmd)
++{
++      __be32 __iomem *reg;
++
++      reg = ioremap(get_immrbase(), 0x1000);
++      local_irq_disable();
++      out_be32(SICRL_RB600(reg), in_be32(SICRL_RB600(reg)) & ~0x00800000);
++      out_be32(GPIO_DIR_RB600(reg), in_be32(GPIO_DIR_RB600(reg)) | SBIT(2));
++      out_be32(GPIO_DATA_RB600(reg), in_be32(GPIO_DATA_RB600(reg)) & ~SBIT(2));
++
++      while (1);
++}
++
++static void rbppc_halt(void)
++{
++      while (1);
++}
++
++static struct of_device_id rbppc_ids[] = {
++      { .type = "soc", },
++      { .compatible = "soc", },
++      { .compatible = "simple-bus", },
++      { .compatible = "gianfar", },
++      { },
++};
++
++static int __init rbppc_declare_of_platform_devices(void)
++{
++      struct device_node *np;
++      unsigned idx;
++
++      of_platform_bus_probe(NULL, rbppc_ids, NULL);
++
++      np = of_find_node_by_type(NULL, "mdio");
++      if (np) {
++              unsigned len;
++              unsigned *res;
++              const unsigned *eres;
++              struct device_node *ep;
++
++              ep = of_find_compatible_node(NULL, "network", "ucc_geth");
++              if (ep) {
++                      eres = of_get_property(ep, "reg", &len);
++                      res = (unsigned *) of_get_property(np, "reg", &len);
++                      if (res && eres) {
++                              res[0] = eres[0] + 0x120;
++                      }
++              }
++      }
++
++      np = of_find_node_by_name(NULL, "nand");
++      if (np) {
++              of_platform_device_create(np, "nand", NULL);
++      }
++
++      idx = 0;
++      for_each_node_by_type(np, "rb,cf") {
++              char dev_name[12];
++              snprintf(dev_name, sizeof(dev_name), "cf.%u", idx);
++              of_platform_device_create(np, dev_name, NULL);
++              ++idx;
++      }
++
++      np = of_find_node_by_name(NULL, "beeper");
++      if (np) {
++              rbppc_beeper_init(np);
++      }
++
++      return 0;
++}
++device_initcall(rbppc_declare_of_platform_devices);
++
++define_machine(rb600) {
++      .name                           = "MikroTik RouterBOARD 600 series",
++      .probe                          = rbppc_probe,
++      .setup_arch                     = rbppc_setup_arch,
++      .init_IRQ                       = rbppc_init_IRQ,
++      .get_irq                        = ipic_get_irq,
++      .restart                        = rbppc_restart,
++      .halt                           = rbppc_halt,
++      .time_init                      = mpc83xx_time_init,
++      .calibrate_decr                 = generic_calibrate_decr,
++};
+--- a/arch/powerpc/platforms/Kconfig
++++ b/arch/powerpc/platforms/Kconfig
+@@ -142,6 +142,10 @@ config GENERIC_IOMAP
+       bool
+       default n
++config RB_IOMAP
++      bool
++      default y if RB_PPC
++
+ source "drivers/cpufreq/Kconfig"
+ menu "CPU Frequency drivers"
+--- a/arch/powerpc/sysdev/Makefile
++++ b/arch/powerpc/sysdev/Makefile
+@@ -50,3 +50,5 @@ obj-$(CONFIG_UCODE_PATCH)    += micropatch.
+ ifeq ($(CONFIG_SUSPEND),y)
+ obj-$(CONFIG_6xx)             += 6xx-suspend.o
+ endif
++
++obj-$(CONFIG_RB_IOMAP)                += rb_iomap.o
+--- /dev/null
++++ b/arch/powerpc/sysdev/rb_iomap.c
+@@ -0,0 +1,223 @@
++#include <linux/init.h>
++#include <linux/pci.h>
++#include <linux/mm.h>
++#include <asm/io.h>
++
++#define LOCALBUS_START                0x40000000
++#define LOCALBUS_MASK         0x007fffff
++#define LOCALBUS_REGMASK      0x001fffff
++
++static void __iomem *localbus_base;
++
++static inline int is_localbus(void __iomem *addr)
++{
++      return ((unsigned) addr & ~LOCALBUS_MASK) == LOCALBUS_START;
++}
++
++static inline unsigned localbus_regoff(unsigned reg) {
++      return (reg << 16) | (((reg ^ 8) & 8) << 17);
++}
++
++static inline void __iomem *localbus_addr(void __iomem *addr)
++{
++      return localbus_base
++          + ((unsigned) addr & LOCALBUS_MASK & ~LOCALBUS_REGMASK)
++          + localbus_regoff((unsigned) addr & LOCALBUS_REGMASK);
++}
++
++unsigned int ioread8(void __iomem *addr)
++{
++      if (is_localbus(addr))
++              return in_be16(localbus_addr(addr)) >> 8;
++      return readb(addr);
++}
++EXPORT_SYMBOL(ioread8);
++
++unsigned int ioread16(void __iomem *addr)
++{
++      if (is_localbus(addr))
++              return le16_to_cpu(in_be16(localbus_addr(addr)));
++      return readw(addr);
++}
++EXPORT_SYMBOL(ioread16);
++
++unsigned int ioread16be(void __iomem *addr)
++{
++      return in_be16(addr);
++}
++EXPORT_SYMBOL(ioread16be);
++
++unsigned int ioread32(void __iomem *addr)
++{
++      return readl(addr);
++}
++EXPORT_SYMBOL(ioread32);
++
++unsigned int ioread32be(void __iomem *addr)
++{
++      return in_be32(addr);
++}
++EXPORT_SYMBOL(ioread32be);
++
++void iowrite8(u8 val, void __iomem *addr)
++{
++      if (is_localbus(addr))
++              out_be16(localbus_addr(addr), ((u16) val) << 8);
++      else
++              writeb(val, addr);
++}
++EXPORT_SYMBOL(iowrite8);
++
++void iowrite16(u16 val, void __iomem *addr)
++{
++      if (is_localbus(addr))
++              out_be16(localbus_addr(addr), cpu_to_le16(val));
++      else
++              writew(val, addr);
++}
++EXPORT_SYMBOL(iowrite16);
++
++void iowrite16be(u16 val, void __iomem *addr)
++{
++      out_be16(addr, val);
++}
++EXPORT_SYMBOL(iowrite16be);
++
++void iowrite32(u32 val, void __iomem *addr)
++{
++      writel(val, addr);
++}
++EXPORT_SYMBOL(iowrite32);
++
++void iowrite32be(u32 val, void __iomem *addr)
++{
++      out_be32(addr, val);
++}
++EXPORT_SYMBOL(iowrite32be);
++
++void ioread8_rep(void __iomem *addr, void *dst, unsigned long count)
++{
++      if (is_localbus(addr)) {
++              unsigned i;
++              void *laddr = localbus_addr(addr);
++              u8 *buf = dst;
++
++              for (i = 0; i < count; ++i) {
++                      *buf++ = in_be16(laddr) >> 8;
++              }
++      } else {
++              _insb((u8 __iomem *) addr, dst, count);
++      }
++}
++EXPORT_SYMBOL(ioread8_rep);
++
++void ioread16_rep(void __iomem *addr, void *dst, unsigned long count)
++{
++      if (is_localbus(addr)) {
++              unsigned i;
++              void *laddr = localbus_addr(addr);
++              u16 *buf = dst;
++
++              for (i = 0; i < count; ++i) {
++                      *buf++ = in_be16(laddr);
++              }
++      } else {
++              _insw_ns((u16 __iomem *) addr, dst, count);
++      }
++}
++EXPORT_SYMBOL(ioread16_rep);
++
++void ioread32_rep(void __iomem *addr, void *dst, unsigned long count)
++{
++      _insl_ns((u32 __iomem *) addr, dst, count);
++}
++EXPORT_SYMBOL(ioread32_rep);
++
++void iowrite8_rep(void __iomem *addr, const void *src, unsigned long count)
++{
++      if (is_localbus(addr)) {
++              unsigned i;
++              void *laddr = localbus_addr(addr);
++              const u8 *buf = src;
++
++              for (i = 0; i < count; ++i) {
++                      out_be16(laddr, ((u16) *buf++) << 8);
++              }
++      } else {
++              _outsb((u8 __iomem *) addr, src, count);
++      }
++}
++EXPORT_SYMBOL(iowrite8_rep);
++
++void iowrite16_rep(void __iomem *addr, const void *src, unsigned long count)
++{
++      if (is_localbus(addr)) {
++              unsigned i;
++              void *laddr = localbus_addr(addr);
++              const u16 *buf = src;
++
++              for (i = 0; i < count; ++i) {
++                      out_be16(laddr, *buf++);
++              }
++      } else {
++              _outsw_ns((u16 __iomem *) addr, src, count);
++      }
++}
++EXPORT_SYMBOL(iowrite16_rep);
++
++void iowrite32_rep(void __iomem *addr, const void *src, unsigned long count)
++{
++      _outsl_ns((u32 __iomem *) addr, src, count);
++}
++EXPORT_SYMBOL(iowrite32_rep);
++
++void __iomem *ioport_map(unsigned long port, unsigned int len)
++{
++      return (void __iomem *) (port + _IO_BASE);
++}
++EXPORT_SYMBOL(ioport_unmap);
++
++void ioport_unmap(void __iomem *addr)
++{
++      /* Nothing to do */
++}
++EXPORT_SYMBOL(ioport_map);
++
++void __iomem *pci_iomap(struct pci_dev *dev, int bar, unsigned long max)
++{
++      unsigned long start = pci_resource_start(dev, bar);
++      unsigned long len = pci_resource_len(dev, bar);
++      unsigned long flags = pci_resource_flags(dev, bar);
++
++      if (!len)
++              return NULL;
++      if (max && len > max)
++              len = max;
++      if (flags & IORESOURCE_IO)
++              return ioport_map(start, len);
++      if (flags & IORESOURCE_MEM)
++              return ioremap(start, len);
++      /* What? */
++      return NULL;
++}
++EXPORT_SYMBOL(pci_iomap);
++
++void pci_iounmap(struct pci_dev *dev, void __iomem *addr)
++{
++      /* Nothing to do */
++}
++EXPORT_SYMBOL(pci_iounmap);
++
++void __iomem *localbus_map(unsigned long addr, unsigned int len)
++{
++      if (!localbus_base)
++              localbus_base = ioremap(addr & ~LOCALBUS_MASK,
++                                      LOCALBUS_MASK + 1);
++      return (void *) (LOCALBUS_START + (addr & LOCALBUS_MASK));
++}
++EXPORT_SYMBOL(localbus_map);
++
++void localbus_unmap(void __iomem *addr)
++{
++}
++EXPORT_SYMBOL(localbus_unmap);
+--- a/drivers/ata/Kconfig
++++ b/drivers/ata/Kconfig
+@@ -734,5 +734,12 @@ config PATA_BF54X
+         If unsure, say N.
++config PATA_RB_PPC
++      tristate "MikroTik RB600 PATA support"
++      depends on RB_PPC
++      help
++        This option enables support for PATA devices on MikroTik RouterBOARD
++        600 series boards.
++
+ endif # ATA_SFF
+ endif # ATA
+--- a/drivers/ata/Makefile
++++ b/drivers/ata/Makefile
+@@ -73,6 +73,7 @@ obj-$(CONFIG_PATA_OCTEON_CF) += pata_oct
+ obj-$(CONFIG_PATA_PLATFORM)   += pata_platform.o
+ obj-$(CONFIG_PATA_OF_PLATFORM)        += pata_of_platform.o
+ obj-$(CONFIG_PATA_ICSIDE)     += pata_icside.o
++obj-$(CONFIG_PATA_RB_PPC)     += pata_rbppc_cf.o
+ # Should be last but two libata driver
+ obj-$(CONFIG_PATA_ACPI)               += pata_acpi.o
+ # Should be last but one libata driver
+--- /dev/null
++++ b/drivers/ata/pata_rbppc_cf.c
+@@ -0,0 +1,701 @@
++/*
++ * Copyright (C) 2008-2009 Noah Fontes <nfontes@transtruct.org>
++ * Copyright (C) Mikrotik 2007
++ *
++ * This program is free software; you can redistribute it and/or modify it
++ * under the terms of the GNU General Public License as published by the
++ * Free Software Foundation; either version 2 of the License, or (at your
++ * option) any later version.
++ */
++
++#include <linux/kernel.h>
++#include <linux/module.h>
++#include <linux/init.h>
++#include <scsi/scsi_host.h>
++#include <linux/libata.h>
++#include <linux/of_platform.h>
++#include <linux/ata_platform.h>
++
++#define DEBUG_UPM     0
++
++#define DRV_NAME      "pata_rbppc_cf"
++#define DRV_VERSION   "0.0.2"
++
++#define DEV2SEL_OFFSET        0x00100000
++
++#define IMMR_LBCFG_OFFSET     0x00005000
++#define IMMR_LBCFG_SIZE               0x00001000
++
++#define LOCAL_BUS_MCMR                0x00000078
++#define   MxMR_OP_MASK                        0x30000000
++#define   MxMR_OP_NORMAL              0x00000000
++#define   MxMR_OP_WRITE                       0x10000000
++#define   MxMR_OP_READ                        0x20000000
++#define   MxMR_OP_RUN                 0x30000000
++#define   MxMR_LUPWAIT_LOW            0x08000000
++#define   MxMR_LUPWAIT_HIGH           0x00000000
++#define   MxMR_LUPWAIT_ENABLE         0x00040000
++#define   MxMR_RLF_MASK                       0x0003c000
++#define   MxMR_RLF_SHIFT                      14
++#define   MxMR_WLF_MASK                       0x00003c00
++#define   MxMR_WLF_SHIFT                      10
++#define   MxMR_MAD_MASK                       0x0000003f
++#define LOCAL_BUS_MDR         0x00000088
++#define LOCAL_BUS_LCRR                0x000000D4
++#define   LCRR_CLKDIV_MASK            0x0000000f
++
++#define LOOP_SIZE     4
++
++#define UPM_READ_SINGLE_OFFSET        0x00
++#define UPM_WRITE_SINGLE_OFFSET       0x18
++#define UPM_DATA_SIZE 0x40
++
++#define LBT_CPUIN_MIN         0
++#define LBT_CPUOUT_MIN                1
++#define LBT_CPUOUT_MAX                2
++#define LBT_EXTDEL_MIN                3
++#define LBT_EXTDEL_MAX                4
++#define LBT_SIZE              5
++
++/* UPM machine configuration bits */
++#define N_BASE        0x00f00000
++#define N_CS  0xf0000000
++#define N_CS_H1       0xc0000000
++#define N_CS_H2       0x30000000
++#define N_WE  0x0f000000
++#define N_WE_H1       0x0c000000
++#define N_WE_H2       0x03000000
++#define N_OE  0x00030000
++#define N_OE_H1       0x00020000
++#define N_OE_H2       0x00010000
++#define WAEN  0x00001000
++#define REDO_2        0x00000100
++#define REDO_3        0x00000200
++#define REDO_4        0x00000300
++#define LOOP  0x00000080
++#define NA    0x00000008
++#define UTA   0x00000004
++#define LAST  0x00000001
++
++#define REDO_VAL(mult)        (REDO_2 * ((mult) - 1))
++#define REDO_MAX_MULT 4
++
++#define READ_BASE     (N_BASE | N_WE)
++#define WRITE_BASE    (N_BASE | N_OE)
++#define EMPTY         (N_BASE | N_CS | N_OE | N_WE | LAST)
++
++#define EOF_UPM_SETTINGS      0
++#define ANOTHER_TIMING                1
++
++#define OA_CPUIN_MIN          0x01
++#define OA_CPUOUT_MAX         0x02
++#define OD_CPUOUT_MIN         0x04
++#define OA_CPUOUT_DELTA               0x06
++#define OA_EXTDEL_MAX         0x08
++#define OD_EXTDEL_MIN         0x10
++#define OA_EXTDEL_DELTA               0x18
++#define O_MIN_CYCLE_TIME      0x20
++#define O_MINUS_PREV          0x40
++#define O_HALF_CYCLE          0x80
++
++extern void __iomem *localbus_map(unsigned long addr, unsigned int len);
++extern void localbus_unmap(void __iomem *addr);
++
++struct rbppc_cf_info {
++      unsigned lbcfg_addr;
++      unsigned clk_time_ps;
++      int cur_mode;
++      u32 lb_timings[LBT_SIZE];
++};
++static struct rbppc_cf_info *rbinfo = NULL;
++
++struct upm_setting {
++      unsigned value;
++      unsigned ns[7];
++      unsigned clk_minus;
++      unsigned group_size;
++      unsigned options;
++};
++
++static const struct upm_setting cfUpmReadSingle[] = {
++      { READ_BASE | N_OE,
++        /* t1 - ADDR setup time */
++              {  70,  50,  30,  30,  25,  15,  10 }, 0, 0, (OA_CPUOUT_DELTA |
++                                                            OA_EXTDEL_MAX) },
++      { READ_BASE | N_OE_H1,
++              {   0,   0,   0,   0,   0,   0,   0 }, 0, 0, O_HALF_CYCLE },
++      { READ_BASE,
++        /* t2 - OE0 time */
++              { 290, 290, 290,  80,  70,  65,  55 }, 0, 2, (OA_CPUOUT_MAX |
++                                                            OA_CPUIN_MIN) },
++      { READ_BASE | WAEN,
++              {   1,   1,   1,   1,   1,   0,   0 }, 0, 0, 0 },
++      { READ_BASE | UTA,
++              {   1,   1,   1,   1,   1,   1,   1 }, 0, 0, 0 },
++      { READ_BASE | N_OE,
++        /* t9 - ADDR hold time */
++              {  20,  15,  10,  10,  10,  10,  10 }, 0, 0, (OA_CPUOUT_DELTA |
++                                                            OD_EXTDEL_MIN) },
++      { READ_BASE | N_OE | N_CS_H2,
++              {   0,   0,   0,   0,   0,   0,   0 }, 0, 0, O_HALF_CYCLE },
++      { READ_BASE | N_OE | N_CS,
++        /* t6Z -IORD data tristate */
++              {  30,  30,  30,  30,  30,  20,  20 }, 1, 1, O_MINUS_PREV },
++      { ANOTHER_TIMING,
++        /* t2i -IORD recovery time */
++              {   0,   0,   0,  70,  25,  25,  20 }, 2, 0, 0 },
++      { ANOTHER_TIMING,
++        /* CS 0 -> 1 MAX */
++              {   0,   0,   0,   0,   0,   0,   0 }, 1, 0, (OA_CPUOUT_DELTA |
++                                                            OA_EXTDEL_MAX) },
++      { READ_BASE | N_OE | N_CS | LAST,
++              {   1,   1,   1,   1,   1,   1,   1 }, 0, 0, 0 },
++      { EOF_UPM_SETTINGS,
++        /* min total cycle time - includes turnaround and ALE cycle */
++              { 600, 383, 240, 180, 120, 100,  80 }, 2, 0, O_MIN_CYCLE_TIME },
++};
++
++static const struct upm_setting cfUpmWriteSingle[] = {
++      { WRITE_BASE | N_WE,
++        /* t1 - ADDR setup time */
++              {  70,  50,  30,  30,  25,  15,  10 }, 0, 0, (OA_CPUOUT_DELTA |
++                                                            OA_EXTDEL_MAX) },
++      { WRITE_BASE | N_WE_H1,
++              {   0,   0,   0,   0,   0,   0,   0 }, 0, 0, O_HALF_CYCLE },
++      { WRITE_BASE,
++        /* t2 - WE0 time */
++              { 290, 290, 290,  80,  70,  65,  55 }, 0, 1, OA_CPUOUT_DELTA },
++      { WRITE_BASE | WAEN,
++              {   1,   1,   1,   1,   1,   0,   0 }, 0, 0, 0 },
++      { WRITE_BASE | N_WE,
++        /* t9 - ADDR hold time */
++              {  20,  15,  10,  10,  10,  10,  10 }, 0, 0, (OA_CPUOUT_DELTA |
++                                                            OD_EXTDEL_MIN) },
++      { WRITE_BASE | N_WE | N_CS_H2,
++              {   0,   0,   0,   0,   0,   0,   0 }, 0, 0, O_HALF_CYCLE },
++      { WRITE_BASE | N_WE | N_CS,
++        /* t4 - DATA hold time */
++              {  30,  20,  15,  10,  10,  10,  10 }, 0, 1, O_MINUS_PREV },
++      { ANOTHER_TIMING,
++        /* t2i -IOWR recovery time */
++              {   0,   0,   0,  70,  25,  25,  20 }, 1, 0, 0 },
++      { ANOTHER_TIMING,
++        /* CS 0 -> 1 MAX */
++              {   0,   0,   0,   0,   0,   0,   0 }, 0, 0, (OA_CPUOUT_DELTA |
++                                                            OA_EXTDEL_MAX) },
++      { WRITE_BASE | N_WE | N_CS | UTA | LAST,
++              {   1,   1,   1,   1,   1,   1,   1 }, 0, 0, 0 },
++      /* min total cycle time - includes ALE cycle */
++      { EOF_UPM_SETTINGS,
++              { 600, 383, 240, 180, 120, 100,  80 }, 1, 0, O_MIN_CYCLE_TIME },
++};
++
++static u8 rbppc_cf_check_status(struct ata_port *ap) {
++      u8 val = ioread8(ap->ioaddr.status_addr);
++      if (val == 0xF9)
++              val = 0x7F;
++      return val;
++}
++
++static u8 rbppc_cf_check_altstatus(struct ata_port *ap) {
++      u8 val = ioread8(ap->ioaddr.altstatus_addr);
++      if (val == 0xF9)
++              val = 0x7F;
++      return val;
++}
++
++static void rbppc_cf_dummy_noret(struct ata_port *ap) { }
++static int rbppc_cf_dummy_ret0(struct ata_port *ap) { return 0; }
++
++static int ps2clk(int ps, unsigned clk_time_ps) {
++      int psMaxOver;
++      if (ps <= 0) return 0;
++
++      /* round down if <= 2% over clk border, but no more than 1/4 clk cycle */
++      psMaxOver = ps * 2 / 100;
++      if (4 * psMaxOver > clk_time_ps) {
++              psMaxOver = clk_time_ps / 4;
++      }
++      return (ps + clk_time_ps - 1 - psMaxOver) / clk_time_ps;
++}
++
++static int upm_gen_ps_table(const struct upm_setting *upm,
++                          int mode, struct rbppc_cf_info *info,
++                          int *psFinal) {
++      int uidx;
++      int lastUpmValIdx = 0;
++      int group_start_idx = -1;
++      int group_left_num = -1;
++      int clk_time_ps = info->clk_time_ps;
++
++      for (uidx = 0; upm[uidx].value != EOF_UPM_SETTINGS; ++uidx) {
++              const struct upm_setting *us = upm + uidx;
++              unsigned opt = us->options;
++              int ps = us->ns[mode] * 1000 - us->clk_minus * clk_time_ps;
++
++              if (opt & OA_CPUIN_MIN) ps += info->lb_timings[LBT_CPUIN_MIN];
++              if (opt & OD_CPUOUT_MIN) ps -= info->lb_timings[LBT_CPUOUT_MIN];
++              if (opt & OA_CPUOUT_MAX) ps += info->lb_timings[LBT_CPUOUT_MAX];
++              if (opt & OD_EXTDEL_MIN) ps -= info->lb_timings[LBT_EXTDEL_MIN];
++              if (opt & OA_EXTDEL_MAX) ps += info->lb_timings[LBT_EXTDEL_MAX];
++
++              if (us->value == ANOTHER_TIMING) {
++                      /* use longest timing from alternatives */
++                      if (psFinal[lastUpmValIdx] < ps) {
++                              psFinal[lastUpmValIdx] = ps;
++                      }
++                      ps = 0;
++              }
++              else {
++                      if (us->group_size) {
++                              group_start_idx = uidx;
++                              group_left_num = us->group_size;
++                      }
++                      else if (group_left_num > 0) {
++                              /* group time is divided on all group members */
++                              int clk = ps2clk(ps, clk_time_ps);
++                              psFinal[group_start_idx] -= clk * clk_time_ps;
++                              --group_left_num;
++                      }
++                      if ((opt & O_MINUS_PREV) && lastUpmValIdx > 0) {
++                              int clk = ps2clk(psFinal[lastUpmValIdx],
++                                               clk_time_ps);
++                              ps -= clk * clk_time_ps;
++                      }
++                      lastUpmValIdx = uidx;
++              }
++              psFinal[uidx] = ps;
++      }
++      return uidx;
++}
++
++static int free_half(int ps, int clk, int clk_time_ps) {
++    if (clk < 2) return 0;
++    return (clk * clk_time_ps - ps) * 2 >= clk_time_ps;
++}
++
++static void upm_gen_clk_table(const struct upm_setting *upm,
++                            int mode, int clk_time_ps,
++                            int max_uidx, const int *psFinal, int *clkFinal) {
++      int clk_cycle_time;
++      int clk_total;
++      int uidx;
++
++      /* convert picoseconds to clocks */
++      clk_total = 0;
++      for (uidx = 0; uidx < max_uidx; ++uidx) {
++              int clk = ps2clk(psFinal[uidx], clk_time_ps);
++              clkFinal[uidx] = clk;
++              clk_total += clk;
++      }
++
++      /* check possibility of half cycle usage */
++      for (uidx = 1; uidx < max_uidx - 1; ++uidx) {
++              if ((upm[uidx].options & O_HALF_CYCLE) &&
++                  free_half(psFinal[uidx - 1], clkFinal[uidx - 1],
++                            clk_time_ps) &&
++                  free_half(psFinal[uidx + 1], clkFinal[uidx + 1],
++                            clk_time_ps)) {
++                      ++clkFinal[uidx];
++                      --clkFinal[uidx - 1];
++                      --clkFinal[uidx + 1];
++              }
++      }
++
++      if ((upm[max_uidx].options & O_MIN_CYCLE_TIME) == 0) return;
++
++      /* check cycle time, adjust timings if needed */
++      clk_cycle_time = (ps2clk(upm[max_uidx].ns[mode] * 1000, clk_time_ps) -
++                        upm[max_uidx].clk_minus);
++      uidx = 0;
++      while (clk_total < clk_cycle_time) {
++              /* extend all timings in round-robin to match cycle time */
++              if (clkFinal[uidx]) {
++#if DEBUG_UPM
++                      printk(KERN_INFO "extending %u by 1 clk\n", uidx);
++#endif
++                      ++clkFinal[uidx];
++                      ++clk_total;
++              }
++              ++uidx;
++              if (uidx == max_uidx) uidx = 0;
++      }
++}
++
++static void add_data_val(unsigned val, int *clkLeft, int maxClk,
++                      unsigned *data, int *dataIdx) {
++      if (*clkLeft == 0) return;
++
++      if (maxClk == 0 && *clkLeft >= LOOP_SIZE * 2) {
++              int times;
++              int times1;
++              int times2;
++
++              times = *clkLeft / LOOP_SIZE;
++              if (times > REDO_MAX_MULT * 2) times = REDO_MAX_MULT * 2;
++              times1 = times / 2;
++              times2 = times - times1;
++
++              val |= LOOP;
++              data[*dataIdx] = val | REDO_VAL(times1);
++              ++(*dataIdx);
++              data[*dataIdx] = val | REDO_VAL(times2);
++              ++(*dataIdx);
++
++              *clkLeft -= times * LOOP_SIZE;
++              return;
++      }
++
++      if (maxClk < 1 || maxClk > REDO_MAX_MULT) maxClk = REDO_MAX_MULT;
++      if (*clkLeft < maxClk) maxClk = *clkLeft;
++
++      *clkLeft -= maxClk;
++      val |= REDO_VAL(maxClk);
++
++      data[*dataIdx] = val;
++      ++(*dataIdx);
++}
++
++static int upm_gen_final_data(const struct upm_setting *upm,
++                             int max_uidx, int *clkFinal, unsigned *data) {
++      int dataIdx;
++      int uidx;
++
++      dataIdx = 0;
++      for (uidx = 0; uidx < max_uidx; ++uidx) {
++              int clk = clkFinal[uidx];
++              while (clk > 0) {
++                      add_data_val(upm[uidx].value, &clk, 0,
++                                   data, &dataIdx);
++              }
++      }
++      return dataIdx;
++}
++
++static int conv_upm_table(const struct upm_setting *upm,
++                        int mode, struct rbppc_cf_info *info,
++                        unsigned *data) {
++#if DEBUG_UPM
++      int uidx;
++#endif
++      int psFinal[32];
++      int clkFinal[32];
++      int max_uidx;
++      int data_len;
++
++      max_uidx = upm_gen_ps_table(upm, mode, info, psFinal);
++
++      upm_gen_clk_table(upm, mode, info->clk_time_ps, max_uidx,
++                        psFinal, clkFinal);
++
++#if DEBUG_UPM
++      /* dump out debug info */
++      for (uidx = 0; uidx < max_uidx; ++uidx) {
++              if (clkFinal[uidx]) {
++                      printk(KERN_INFO "idx %d val %08x clk %d ps %d\n",
++                              uidx, upm[uidx].value,
++                              clkFinal[uidx], psFinal[uidx]);
++              }
++      }
++#endif
++
++      data_len = upm_gen_final_data(upm, max_uidx, clkFinal, data);
++
++#if DEBUG_UPM
++      for (uidx = 0; uidx < data_len; ++uidx) {
++              printk(KERN_INFO "cf UPM x result: idx %d val %08x\n",
++                     uidx, data[uidx]);
++      }
++#endif
++      return 0;
++}
++
++static int gen_upm_data(int mode, struct rbppc_cf_info *info, unsigned *data) {
++      int i;
++
++      for (i = 0; i < UPM_DATA_SIZE; ++i) {
++              data[i] = EMPTY;
++      }
++
++      if (conv_upm_table(cfUpmReadSingle, mode, info, data + UPM_READ_SINGLE_OFFSET)) {
++              return -1;
++      }
++      if (conv_upm_table(cfUpmWriteSingle, mode, info, data + UPM_WRITE_SINGLE_OFFSET)) {
++              return -1;
++      }
++      return 0;
++}
++
++static void rbppc_cf_program_upm(void *upmMemAddr, volatile void *lbcfg_mxmr, volatile void *lbcfg_mdr, const unsigned *upmData, unsigned offset, unsigned len) {
++      unsigned i;
++      unsigned mxmr;
++
++      mxmr = in_be32(lbcfg_mxmr);
++      mxmr &= ~(MxMR_OP_MASK | MxMR_MAD_MASK);
++      mxmr |= (MxMR_OP_WRITE | offset);
++      out_be32(lbcfg_mxmr, mxmr);
++      in_be32(lbcfg_mxmr); /* flush MxMR write */
++
++      for (i = 0; i < len; ++i) {
++              int to;
++              unsigned data = upmData[i + offset];
++              out_be32(lbcfg_mdr, data);
++              in_be32(lbcfg_mdr); /* flush MDR write */
++
++              iowrite8(1, upmMemAddr); /* dummy write to any CF addr */
++
++              /* wait for dummy write to complete */
++              for (to = 10000; to >= 0; --to) {
++                      mxmr = in_be32(lbcfg_mxmr);
++                      if (((mxmr ^ (i + 1)) & MxMR_MAD_MASK) == 0) {
++                              break;
++                      }
++                      if (to == 0) {
++                              printk(KERN_ERR "rbppc_cf_program_upm: UPMx program error at 0x%x: Timeout\n", i);
++                      }
++              }
++      }
++      mxmr &= ~(MxMR_OP_MASK | MxMR_RLF_MASK | MxMR_WLF_MASK);
++      mxmr |= (MxMR_OP_NORMAL | (LOOP_SIZE << MxMR_RLF_SHIFT) | (LOOP_SIZE << MxMR_WLF_SHIFT));
++      out_be32(lbcfg_mxmr, mxmr);
++}
++
++static int rbppc_cf_update_piomode(struct ata_port *ap, int mode) {
++      struct rbppc_cf_info *info = (struct rbppc_cf_info *)ap->host->private_data;
++      void *lbcfgBase;
++      unsigned upmData[UPM_DATA_SIZE];
++
++      if (gen_upm_data(mode, info, upmData)) {
++              return -1;
++      }
++
++      lbcfgBase = ioremap_nocache(info->lbcfg_addr, IMMR_LBCFG_SIZE);
++
++      rbppc_cf_program_upm(ap->ioaddr.cmd_addr, ((char *)lbcfgBase) + LOCAL_BUS_MCMR, ((char *)lbcfgBase) + LOCAL_BUS_MDR, upmData, 0, UPM_DATA_SIZE);
++      iounmap(lbcfgBase);
++      return 0;
++}
++
++static void rbppc_cf_set_piomode(struct ata_port *ap, struct ata_device *adev)
++{
++      struct rbppc_cf_info *info = (struct rbppc_cf_info *)ap->host->private_data;
++      int mode = adev->pio_mode - XFER_PIO_0;
++
++      DPRINTK("rbppc_cf_set_piomode: PIO %d\n", mode);
++      if (mode < 0) mode = 0;
++      if (mode > 6) mode = 6;
++
++      if (info->cur_mode < 0 || info->cur_mode > mode) {
++              if (rbppc_cf_update_piomode(ap, mode) == 0) {
++                      printk(KERN_INFO "rbppc_cf_set_piomode: PIO mode changed to %d\n", mode);
++                      info->cur_mode = mode;
++              }
++      }
++}
++
++static struct scsi_host_template rbppc_cf_sht = {
++      ATA_BASE_SHT(DRV_NAME),
++};
++
++static struct ata_port_operations rbppc_cf_port_ops = {
++      .inherits               = &ata_bmdma_port_ops,
++
++      .sff_check_status       = rbppc_cf_check_status,
++      .sff_check_altstatus    = rbppc_cf_check_altstatus,
++
++      .set_piomode            = rbppc_cf_set_piomode,
++
++      .port_start             = rbppc_cf_dummy_ret0,
++
++      .sff_irq_clear          = rbppc_cf_dummy_noret,
++};
++
++static int rbppc_cf_init_info(struct of_device *pdev, struct rbppc_cf_info *info) {
++      struct device_node *np;
++      struct resource res;
++      const u32 *u32ptr;
++      void *lbcfgBase;
++      void *lbcfg_lcrr;
++      unsigned lbc_clk_khz;
++      unsigned lbc_extra_divider = 1;
++      unsigned ccb_freq_hz;
++      unsigned lb_div;
++
++      u32ptr = of_get_property(pdev->node, "lbc_extra_divider", NULL);
++      if (u32ptr && *u32ptr) {
++              lbc_extra_divider = *u32ptr;
++#if DEBUG_UPM
++              printk(KERN_INFO "rbppc_cf_init_info: LBC extra divider %u\n",
++                     lbc_extra_divider);
++#endif
++      }
++
++      np = of_find_node_by_type(NULL, "serial");
++      if (!np) {
++              printk(KERN_ERR "rbppc_cf_init_info: No serial node found\n");
++              return -1;
++      }
++      u32ptr = of_get_property(np, "clock-frequency", NULL);
++      if (u32ptr == 0 || *u32ptr == 0) {
++              printk(KERN_ERR "rbppc_cf_init_info: Serial does not have clock-frequency\n");
++              of_node_put(np);
++              return -1;
++      }
++      ccb_freq_hz = *u32ptr;
++      of_node_put(np);
++
++      np = of_find_node_by_type(NULL, "soc");
++      if (!np) {
++              printk(KERN_ERR "rbppc_cf_init_info: No soc node found\n");
++              return -1;
++      }
++      if (of_address_to_resource(np, 0, &res)) {
++              printk(KERN_ERR "rbppc_cf_init_info: soc does not have resource\n");
++              of_node_put(np);
++              return -1;
++      }
++      info->lbcfg_addr = res.start + IMMR_LBCFG_OFFSET;
++      of_node_put(np);
++
++      lbcfgBase = ioremap_nocache(info->lbcfg_addr, IMMR_LBCFG_SIZE);
++      lbcfg_lcrr = ((char*)lbcfgBase) + LOCAL_BUS_LCRR;
++      lb_div = (in_be32(lbcfg_lcrr) & LCRR_CLKDIV_MASK) * lbc_extra_divider;
++      iounmap(lbcfgBase);
++
++      lbc_clk_khz = ccb_freq_hz / (1000 * lb_div);
++      info->clk_time_ps = 1000000000 / lbc_clk_khz;
++      printk(KERN_INFO "rbppc_cf_init_info: Using Local-Bus clock %u kHz %u ps\n",
++             lbc_clk_khz, info->clk_time_ps);
++
++      u32ptr = of_get_property(pdev->node, "lb-timings", NULL);
++      if (u32ptr) {
++              memcpy(info->lb_timings, u32ptr, LBT_SIZE * sizeof(*u32ptr));
++#if DEBUG_UPM
++              printk(KERN_INFO "rbppc_cf_init_info: Got LB timings <%u %u %u %u %u>\n",
++                     u32ptr[0], u32ptr[1], u32ptr[2], u32ptr[3], u32ptr[4]);
++#endif
++      }
++      info->cur_mode = -1;
++      return 0;
++}
++
++static int rbppc_cf_probe(struct of_device *pdev,
++                        const struct of_device_id *match)
++{
++      struct ata_host *host;
++      struct ata_port *ap;
++      struct rbppc_cf_info *info = NULL;
++      struct resource res;
++      void *baddr;
++      const u32 *u32ptr;
++      int irq_level = 0;
++      int err = -ENOMEM;
++
++      printk(KERN_INFO "rbppc_cf_probe: MikroTik RouterBOARD 600 series Compact Flash PATA driver, version " DRV_VERSION "\n");
++
++      if (rbinfo == NULL) {
++              info = kmalloc(sizeof(*info), GFP_KERNEL);
++              if (info == NULL) {
++                      printk(KERN_ERR "rbppc_cf_probe: Out of memory\n");
++                      goto err_info;
++              }
++              memset(info, 0, sizeof(*info));
++
++              if (rbppc_cf_init_info(pdev, info)) {
++                      goto err_info;
++              }
++              rbinfo = info;
++      }
++
++      u32ptr = of_get_property(pdev->node, "interrupt-at-level", NULL);
++      if (u32ptr) {
++              irq_level = *u32ptr;
++              printk(KERN_INFO "rbppc_cf_probe: IRQ level %u\n", irq_level);
++      }
++
++      if (of_address_to_resource(pdev->node, 0, &res)) {
++          printk(KERN_ERR "rbppc_cf_probe: No reg property found\n");
++          goto err_info;
++      }
++
++      host = ata_host_alloc(&pdev->dev, 1);
++      if (!host)
++          goto err_info;
++
++      baddr = localbus_map(res.start, res.end - res.start + 1);
++      host->iomap = baddr;
++      host->private_data = rbinfo;
++
++      ap = host->ports[0];
++      ap->ops = &rbppc_cf_port_ops;
++      ap->pio_mask = 0x7F;    /* PIO modes 0-6 */
++      ap->flags = ATA_FLAG_NO_LEGACY;
++      ap->mwdma_mask = 0;
++
++      ap->ioaddr.cmd_addr = baddr;
++      ata_sff_std_ports(&ap->ioaddr);
++      ap->ioaddr.ctl_addr = ap->ioaddr.cmd_addr + 14;
++      ap->ioaddr.altstatus_addr = ap->ioaddr.ctl_addr;
++      ap->ioaddr.bmdma_addr = 0;
++
++      err = ata_host_activate(
++              host,
++              irq_of_parse_and_map(pdev->node, 0), ata_sff_interrupt,
++              irq_level ? IRQF_TRIGGER_HIGH : IRQF_TRIGGER_LOW,
++              &rbppc_cf_sht);
++      if (!err) return 0;
++
++      localbus_unmap(baddr);
++err_info:
++      if (info) {
++              kfree(info);
++              rbinfo = NULL;
++      }
++      return err;
++}
++
++static int rbppc_cf_remove(struct of_device *pdev)
++{
++      struct device *dev = &pdev->dev;
++      struct ata_host *host = dev_get_drvdata(dev);
++
++      if (host == NULL) return -1;
++
++      ata_host_detach(host);
++      return 0;
++}
++
++static struct of_device_id rbppc_cf_ids[] = {
++      { .name = "cf", },
++      { },
++};
++
++static struct of_platform_driver rbppc_cf_driver = {
++      .name = "cf",
++      .probe = rbppc_cf_probe,
++      .remove = rbppc_cf_remove,
++      .match_table = rbppc_cf_ids,
++      .driver = {
++              .name = "rbppc-cf",
++              .owner = THIS_MODULE,
++      },
++};
++
++static int __init rbppc_init(void)
++{
++      return of_register_platform_driver(&rbppc_cf_driver);
++}
++
++static void __exit rbppc_exit(void)
++{
++      of_unregister_platform_driver(&rbppc_cf_driver);
++}
++
++MODULE_AUTHOR("Mikrotikls SIA");
++MODULE_AUTHOR("Noah Fontes");
++MODULE_DESCRIPTION("MikroTik RouterBOARD 600 series Compact Flash PATA driver");
++MODULE_LICENSE("GPL");
++MODULE_VERSION(DRV_VERSION);
++
++module_init(rbppc_init);
++module_exit(rbppc_exit);
+--- a/drivers/mtd/nand/Kconfig
++++ b/drivers/mtd/nand/Kconfig
+@@ -380,6 +380,13 @@ config MTD_NAND_PLATFORM
+         devices. You will need to provide platform-specific functions
+         via platform_data.
++config MTD_NAND_RB_PPC
++      tristate "MikroTik RB600 NAND support"
++      depends on MTD_NAND && MTD_PARTITIONS && RB_PPC
++      help
++        This option enables support for the NAND device on MikroTik
++        RouterBOARD 600 series boards.
++
+ config MTD_ALAUDA
+       tristate "MTD driver for Olympus MAUSB-10 and Fujifilm DPC-R1"
+       depends on MTD_NAND && USB
+--- a/drivers/mtd/nand/Makefile
++++ b/drivers/mtd/nand/Makefile
+@@ -30,6 +30,7 @@ obj-$(CONFIG_MTD_NAND_BASLER_EXCITE) += 
+ obj-$(CONFIG_MTD_NAND_PXA3xx)         += pxa3xx_nand.o
+ obj-$(CONFIG_MTD_NAND_TMIO)           += tmio_nand.o
+ obj-$(CONFIG_MTD_NAND_PLATFORM)               += plat_nand.o
++obj-$(CONFIG_MTD_NAND_RB_PPC)         += rbppc_nand.o
+ obj-$(CONFIG_MTD_ALAUDA)              += alauda.o
+ obj-$(CONFIG_MTD_NAND_PASEMI)         += pasemi_nand.o
+ obj-$(CONFIG_MTD_NAND_ORION)          += orion_nand.o
+--- /dev/null
++++ b/drivers/mtd/nand/rbppc_nand.c
+@@ -0,0 +1,252 @@
++/*
++ * Copyright (C) 2008-2009 Noah Fontes <nfontes@transtruct.org>
++ * Copyright (C) 2009 Michael Guntsche <mike@it-loops.com>
++ * Copyright (C) Mikrotik 2007
++ *
++ * This program is free software; you can redistribute it and/or modify it
++ * under the terms of the GNU General Public License as published by the
++ * Free Software Foundation; either version 2 of the License, or (at your
++ * option) any later version.
++ */
++
++#include <linux/init.h>
++#include <linux/mtd/nand.h>
++#include <linux/mtd/mtd.h>
++#include <linux/mtd/partitions.h>
++#include <linux/of_platform.h>
++#include <asm/of_platform.h>
++#include <asm/of_device.h>
++#include <linux/delay.h>
++#include <asm/io.h>
++
++#define DRV_NAME      "rbppc_nand"
++#define DRV_VERSION   "0.0.2"
++
++static struct mtd_info rmtd;
++static struct nand_chip rnand;
++
++struct rbppc_nand_info {
++      void *gpi;
++      void *gpo;
++      void *localbus;
++
++      unsigned gpio_rdy;
++      unsigned gpio_nce;
++      unsigned gpio_cle;
++      unsigned gpio_ale;
++      unsigned gpio_ctrls;
++};
++
++/* We must use the OOB layout from yaffs 1 if we want this to be recognized
++ * properly. Borrowed from the OpenWRT patches for the RB532.
++ *
++ * See <https://dev.openwrt.org/browser/trunk/target/linux/rb532/
++ * patches-2.6.28/025-rb532_nand_fixup.patch> for more details.
++ */
++static struct nand_ecclayout rbppc_nand_oob_16 = {
++      .eccbytes = 6,
++      .eccpos = { 8, 9, 10, 13, 14, 15 },
++      .oobavail = 9,
++      .oobfree = { { 0, 4 }, { 6, 2 }, { 11, 2 }, { 4, 1 } }
++};
++
++static struct mtd_partition rbppc_nand_partition_info[] = {
++      {
++              name: "RouterBOARD NAND Boot",
++              offset: 0,
++              size: 4 * 1024 * 1024,
++      },
++      {
++              name: "RouterBOARD NAND Main",
++              offset: MTDPART_OFS_NXTBLK,
++              size: MTDPART_SIZ_FULL,
++      },
++};
++
++static int rbppc_nand_dev_ready(struct mtd_info *mtd) {
++      struct nand_chip *chip = mtd->priv;
++      struct rbppc_nand_info *priv = chip->priv;
++
++      return in_be32(priv->gpi) & priv->gpio_rdy;
++}
++
++static void rbppc_nand_cmd_ctrl(struct mtd_info *mtd, int cmd, unsigned int ctrl) {
++      struct nand_chip *chip = mtd->priv;
++      struct rbppc_nand_info *priv = chip->priv;
++
++      if (ctrl & NAND_CTRL_CHANGE) {
++              unsigned val = in_be32(priv->gpo);
++              if (!(val & priv->gpio_nce)) {
++                      /* make sure Local Bus has done NAND operations */
++                      readb(priv->localbus);
++              }
++
++              if (ctrl & NAND_CLE) {
++                      val |= priv->gpio_cle;
++              } else {
++                      val &= ~priv->gpio_cle;
++              }
++              if (ctrl & NAND_ALE) {
++                      val |= priv->gpio_ale;
++              } else {
++                      val &= ~priv->gpio_ale;
++              }
++              if (!(ctrl & NAND_NCE)) {
++                      val |= priv->gpio_nce;
++              } else {
++                      val &= ~priv->gpio_nce;
++              }
++              out_be32(priv->gpo, val);
++
++              /* make sure GPIO output has changed */
++              val ^= in_be32(priv->gpo);
++              if (val & priv->gpio_ctrls) {
++                      printk(KERN_ERR "rbppc_nand_hwcontrol: NAND GPO change failed 0x%08x\n", val);
++              }
++      }
++
++      if (cmd != NAND_CMD_NONE) writeb(cmd, chip->IO_ADDR_W);
++}
++
++static void rbppc_nand_read_buf(struct mtd_info *mtd, uint8_t *buf, int len)
++{
++      struct nand_chip *chip = mtd->priv;
++      memcpy(buf, chip->IO_ADDR_R, len);
++}
++
++static unsigned init_ok = 0;
++
++static int rbppc_nand_probe(struct of_device *pdev,
++                          const struct of_device_id *match)
++{
++      struct device_node *gpio;
++      struct device_node *nnand;
++      struct resource res;
++      struct rbppc_nand_info *info;
++      void *baddr;
++      const unsigned *rdy, *nce, *cle, *ale;
++
++      printk(KERN_INFO "rbppc_nand_probe: MikroTik RouterBOARD 600 series NAND driver, version " DRV_VERSION "\n");
++
++      info = kmalloc(sizeof(*info), GFP_KERNEL);
++
++      rdy = of_get_property(pdev->node, "rdy", NULL);
++      nce = of_get_property(pdev->node, "nce", NULL);
++      cle = of_get_property(pdev->node, "cle", NULL);
++      ale = of_get_property(pdev->node, "ale", NULL);
++
++      if (!rdy || !nce || !cle || !ale) {
++              printk(KERN_ERR "rbppc_nand_probe: GPIO properties are missing\n");
++              goto err;
++      }
++      if (rdy[0] != nce[0] || rdy[0] != cle[0] || rdy[0] != ale[0]) {
++              printk(KERN_ERR "rbppc_nand_probe: Different GPIOs are not supported\n");
++              goto err;
++      }
++
++      gpio = of_find_node_by_phandle(rdy[0]);
++      if (!gpio) {
++              printk(KERN_ERR "rbppc_nand_probe: No GPIO<%x> node found\n", *rdy);
++              goto err;
++      }
++      if (of_address_to_resource(gpio, 0, &res)) {
++              printk(KERN_ERR "rbppc_nand_probe: No reg property in GPIO found\n");
++              goto err;
++      }
++      info->gpo = ioremap_nocache(res.start, res.end - res.start + 1);
++
++      if (!of_address_to_resource(gpio, 1, &res)) {
++              info->gpi = ioremap_nocache(res.start, res.end - res.start + 1);
++      } else {
++              info->gpi = info->gpo;
++      }
++      of_node_put(gpio);
++
++      info->gpio_rdy = 1 << (31 - rdy[1]);
++      info->gpio_nce = 1 << (31 - nce[1]);
++      info->gpio_cle = 1 << (31 - cle[1]);
++      info->gpio_ale = 1 << (31 - ale[1]);
++      info->gpio_ctrls = info->gpio_nce | info->gpio_cle | info->gpio_ale;
++
++      nnand = of_find_node_by_name(NULL, "nnand");
++      if (!nnand) {
++              printk("rbppc_nand_probe: No nNAND found\n");
++              goto err;
++      }
++      if (of_address_to_resource(nnand, 0, &res)) {
++              printk("rbppc_nand_probe: No reg property in nNAND found\n");
++              goto err;
++      }
++      of_node_put(nnand);
++      info->localbus = ioremap_nocache(res.start, res.end - res.start + 1);
++
++      if (of_address_to_resource(pdev->node, 0, &res)) {
++          printk("rbppc_nand_probe: No reg property found\n");
++          goto err;
++      }
++      baddr = ioremap_nocache(res.start, res.end - res.start + 1);
++
++      memset(&rnand, 0, sizeof(rnand));
++      rnand.cmd_ctrl = rbppc_nand_cmd_ctrl;
++      rnand.dev_ready = rbppc_nand_dev_ready;
++      rnand.read_buf = rbppc_nand_read_buf;
++      rnand.IO_ADDR_W = baddr;
++      rnand.IO_ADDR_R = baddr;
++      rnand.priv = info;
++
++      memset(&rmtd, 0, sizeof(rmtd));
++      rnand.ecc.mode = NAND_ECC_SOFT;
++      rnand.ecc.layout = &rbppc_nand_oob_16;
++      rnand.chip_delay = 25;
++      rnand.options |= NAND_NO_AUTOINCR;
++      rmtd.priv = &rnand;
++      rmtd.owner = THIS_MODULE;
++
++      if (nand_scan(&rmtd, 1) && nand_scan(&rmtd, 1) && nand_scan(&rmtd, 1) && nand_scan(&rmtd, 1)) {
++              printk(KERN_ERR "rbppc_nand_probe: RouterBOARD NAND device not found\n");
++              return -ENXIO;
++      }
++
++      add_mtd_partitions(&rmtd, rbppc_nand_partition_info, 2);
++      init_ok = 1;
++      return 0;
++
++err:
++      kfree(info);
++      return -1;
++}
++
++static struct of_device_id rbppc_nand_ids[] = {
++      { .name = "nand", },
++      { },
++};
++
++static struct of_platform_driver rbppc_nand_driver = {
++      .name   = "nand",
++      .probe  = rbppc_nand_probe,
++      .match_table = rbppc_nand_ids,
++      .driver = {
++              .name = "rbppc-nand",
++              .owner = THIS_MODULE,
++      },
++};
++
++static int __init rbppc_nand_init(void)
++{
++      return of_register_platform_driver(&rbppc_nand_driver);
++}
++
++static void __exit rbppc_nand_exit(void)
++{
++      of_unregister_platform_driver(&rbppc_nand_driver);
++}
++
++MODULE_AUTHOR("Mikrotikls SIA");
++MODULE_AUTHOR("Noah Fontes");
++MODULE_AUTHOR("Michael Guntsche");
++MODULE_DESCRIPTION("MikroTik RouterBOARD 600 series NAND driver");
++MODULE_LICENSE("GPL");
++MODULE_VERSION(DRV_VERSION);
++
++module_init(rbppc_nand_init);
++module_exit(rbppc_nand_exit);