+++ /dev/null
-/*
- * arch/arm/mach-orion5x/dt2-setup.c
- *
- * Freecom DataTank Gateway Setup
- *
- * Copyright (C) 2009 Zintis Petersons <Zintis.Petersons@abcsolutions.lv>
- *
- * This file is licensed under the terms of the GNU General Public
- * License version 2. This program is licensed "as is" without any
- * warranty of any kind, whether express or implied.
- */
-
-#include <linux/kernel.h>
-#include <linux/init.h>
-#include <linux/platform_device.h>
-#include <linux/pci.h>
-#include <linux/irq.h>
-#include <linux/mtd/physmap.h>
-#include <linux/mv643xx_eth.h>
-#include <linux/ethtool.h>
-#include <linux/if_ether.h>
-#include <net/dsa.h>
-#include <linux/ata_platform.h>
-#include <linux/i2c.h>
-#include <linux/reboot.h>
-#include <linux/interrupt.h>
-#include <asm/mach-types.h>
-#include <asm/gpio.h>
-#include <asm/mach/arch.h>
-#include <asm/mach/pci.h>
-#include <mach/orion5x.h>
-#include "common.h"
-#include "mpp.h"
-
-/*****************************************************************************
- * DT2 local
- ****************************************************************************/
-#include <asm/setup.h>
-#include "dt2-common.h"
-
-u32 mvUbootVer = 0;
-u32 mvTclk = 166666667;
-u32 mvSysclk = 200000000;
-u32 mvIsUsbHost = 1;
-u32 overEthAddr = 0;
-u32 gBoardId = -1;
-struct DT2_EEPROM_STRUCT dt2_eeprom;
-
-/*****************************************************************************
- * DT2 Info
- ****************************************************************************/
-/*
- * PCI
- */
-
-#define DT2_PCI_SLOT0_OFFS 7
-#define DT2_PCI_SLOT0_IRQ_A_PIN 3
-#define DT2_PCI_SLOT0_IRQ_B_PIN 2
-
-#define DT2_PIN_GPIO_SYNC 25
-#define DT2_PIN_GPIO_POWER 24
-#define DT2_PIN_GPIO_UNPLUG1 23
-#define DT2_PIN_GPIO_UNPLUG2 22
-#define DT2_PIN_GPIO_RESET 4
-
-#define DT2_NOR_BOOT_BASE 0xf4000000
-#define DT2_NOR_BOOT_SIZE SZ_512K
-
-#define DT2_LEDS_BASE 0xfa000000
-#define DT2_LEDS_SIZE SZ_1K
-
-/*****************************************************************************
- * 512K NOR Flash on Device bus Boot CS
- ****************************************************************************/
-
-static struct mtd_partition dt2_partitions[] = {
- {
- .name = "u-boot",
- .size = 0x00080000,
- .offset = 0,
- },
-};
-
-static struct physmap_flash_data dt2_nor_flash_data = {
- .width = 1, /* 8 bit bus width */
- .parts = dt2_partitions,
- .nr_parts = ARRAY_SIZE(dt2_partitions)
-};
-
-static struct resource dt2_nor_flash_resource = {
- .flags = IORESOURCE_MEM,
- .start = DT2_NOR_BOOT_BASE,
- .end = DT2_NOR_BOOT_BASE + DT2_NOR_BOOT_SIZE - 1,
-};
-
-static struct platform_device dt2_nor_flash = {
- .name = "physmap-flash",
- .id = 0,
- .dev = {
- .platform_data = &dt2_nor_flash_data,
- },
- .resource = &dt2_nor_flash_resource,
- .num_resources = 1,
-};
-
-/*****************************************************************************
- * PCI
- ****************************************************************************/
-
-void __init dt2_pci_preinit(void)
-{
- int pin, irq;
-
- /*
- * Configure PCI GPIO IRQ pins
- */
- pin = DT2_PCI_SLOT0_IRQ_A_PIN;
- if (gpio_request(pin, "PCI IntA") == 0) {
- if (gpio_direction_input(pin) == 0) {
- irq = gpio_to_irq(pin);
- irq_set_irq_type(irq, IRQ_TYPE_LEVEL_LOW);
- printk (KERN_INFO "PCI IntA IRQ: %d\n", irq);
- } else {
- printk(KERN_ERR "dt2_pci_preinit failed to "
- "irq_set_irq_type pin %d\n", pin);
- gpio_free(pin);
- }
- } else {
- printk(KERN_ERR "dt2_pci_preinit failed to request gpio %d\n", pin);
- }
-
- pin = DT2_PCI_SLOT0_IRQ_B_PIN;
- if (gpio_request(pin, "PCI IntB") == 0) {
- if (gpio_direction_input(pin) == 0) {
- irq = gpio_to_irq(pin);
- irq_set_irq_type(irq, IRQ_TYPE_LEVEL_LOW);
- printk (KERN_INFO "PCI IntB IRQ: %d\n", irq);
- } else {
- printk(KERN_ERR "dt2_pci_preinit failed to "
- "irq_set_irq_type pin %d\n", pin);
- gpio_free(pin);
- }
- } else {
- printk(KERN_ERR "dt2_pci_preinit failed to gpio_request %d\n", pin);
- }
-}
-
-static int __init dt2_pci_map_irq(const struct pci_dev *dev, u8 slot, u8 pin)
-{
- int irq;
-
- /*
- * Check for devices with hard-wired IRQs.
- */
- irq = orion5x_pci_map_irq(dev, slot, pin);
- if (irq != -1){
- printk(KERN_INFO "orion5x_pci_map_irq: %d\n", irq);
- return irq;
- }
-
- /*
- * PCI IRQs are connected via GPIOs
- */
- switch (slot - DT2_PCI_SLOT0_OFFS) {
- case 0:
- if (pin == 1){
- irq = gpio_to_irq(DT2_PCI_SLOT0_IRQ_A_PIN);
- printk(KERN_INFO "dt2_pci_map_irq DT2_PCI_SLOT0_IRQ_A_PIN: %d\n", irq);
- }
- else {
- irq = gpio_to_irq(DT2_PCI_SLOT0_IRQ_B_PIN);
- printk(KERN_INFO "dt2_pci_map_irq DT2_PCI_SLOT0_IRQ_B_PIN: %d\n", irq);
- }
- default:
- irq = -1;
- printk(KERN_INFO "dt2_pci_map_irq IRQ: %d\n", irq);
- }
-
- return irq;
-}
-
-static struct hw_pci dt2_pci __initdata = {
- .nr_controllers = 2,
- .preinit = dt2_pci_preinit,
- .setup = orion5x_pci_sys_setup,
- .scan = orion5x_pci_sys_scan_bus,
- .map_irq = dt2_pci_map_irq,
-};
-
-static int __init dt2_pci_init(void)
-{
- if (machine_is_dt2())
- pci_common_init(&dt2_pci);
-
- return 0;
-}
-
-subsys_initcall(dt2_pci_init);
-
-/*****************************************************************************
- * Ethernet
- ****************************************************************************/
-
-static struct mv643xx_eth_platform_data dt2_eth_data = {
- .phy_addr = MV643XX_ETH_PHY_NONE,
- .speed = SPEED_1000,
- .duplex = DUPLEX_FULL,
-};
-
-static struct dsa_chip_data dt2_switch_chip_data = {
- .port_names[0] = "wan",
- .port_names[1] = "lan1",
- .port_names[2] = "lan2",
- .port_names[3] = "cpu",
- .port_names[4] = "lan3",
- .port_names[5] = "lan4",
-};
-
-static struct dsa_platform_data dt2_switch_plat_data = {
- .nr_chips = 1,
- .chip = &dt2_switch_chip_data,
-};
-
-/*****************************************************************************
- * RTC ISL1208 on I2C bus
- ****************************************************************************/
-static struct i2c_board_info __initdata dt2_i2c_rtc = {
- I2C_BOARD_INFO("isl1208", 0x6F),
-};
-
-/*****************************************************************************
- * Sata
- ****************************************************************************/
-static struct mv_sata_platform_data dt2_sata_data = {
- .n_ports = 2,
-};
-
-/*****************************************************************************
- * General Setup
- ****************************************************************************/
-static unsigned int dt2_mpp_modes[] __initdata = {
- MPP0_GPIO, // RTC interrupt
- MPP1_GPIO, // 88e6131 interrupt
- MPP2_GPIO, // PCI_intB
- MPP3_GPIO, // PCI_intA
- MPP4_GPIO, // reset button switch
- MPP5_GPIO,
- MPP6_GPIO,
- MPP7_GPIO,
- MPP8_GPIO,
- MPP9_GIGE, /* GE_RXERR */
- MPP10_GPIO, // usb
- MPP11_GPIO, // usb
- MPP12_GIGE, // GE_TXD[4]
- MPP13_GIGE, // GE_TXD[5]
- MPP14_GIGE, // GE_TXD[6]
- MPP15_GIGE, // GE_TXD[7]
- MPP16_GIGE, // GE_RXD[4]
- MPP17_GIGE, // GE_RXD[5]
- MPP18_GIGE, // GE_RXD[6]
- MPP19_GIGE, // GE_RXD[7]
- 0,
-};
-
-/*****************************************************************************
- * LEDS
- ****************************************************************************/
-static struct platform_device dt2_leds = {
- .name = "dt2-led",
- .id = -1,
-};
-
-/****************************************************************************
- * GPIO key
- ****************************************************************************/
-static irqreturn_t dt2_reset_handler(int irq, void *dev_id)
-{
- /* This is the paper-clip reset which does an emergency reboot. */
- printk(KERN_INFO "Restarting system.\n");
- machine_restart(NULL);
-
- /* This should never be reached. */
- return IRQ_HANDLED;
-}
-
-static irqreturn_t dt2_power_handler(int irq, void *dev_id)
-{
- printk(KERN_INFO "Shutting down system.\n");
- machine_power_off();
- return IRQ_HANDLED;
-}
-
-static void __init dt2_init(void)
-{
- /*
- * Setup basic Orion functions. Need to be called early.
- */
- orion5x_init();
-
- orion5x_mpp_conf(dt2_mpp_modes);
-
- /*
- * Configure peripherals.
- */
-
- orion5x_uart0_init();
- orion5x_ehci0_init();
- orion5x_ehci1_init();
- orion5x_i2c_init();
- orion5x_sata_init(&dt2_sata_data);
- orion5x_xor_init();
-
- printk(KERN_INFO "U-Boot parameters:\n");
- printk(KERN_INFO "Sys Clk = %d, Tclk = %d, BoardID = 0x%02x\n", mvSysclk, mvTclk, gBoardId);
-
- printk(KERN_INFO "Serial: %s\n", dt2_eeprom.fc.dt2_serial_number);
- printk(KERN_INFO "Revision: %016x\n", dt2_eeprom.fc.dt2_revision);
- printk(KERN_INFO "DT2: Using MAC address %pM for port 0\n",
- dt2_eeprom.gw.mac_addr[0]);
- printk(KERN_INFO "DT2: Using MAC address %pM for port 1\n",
- dt2_eeprom.gw.mac_addr[1]);
-
- orion5x_eth_init(&dt2_eth_data);
- memcpy(dt2_eth_data.mac_addr, dt2_eeprom.gw.mac_addr[0], 6);
- orion5x_eth_switch_init(&dt2_switch_plat_data, NO_IRQ);
-
- i2c_register_board_info(0, &dt2_i2c_rtc, 1);
-
- mvebu_mbus_add_window("devbus-boot", DT2_NOR_BOOT_BASE,
- DT2_NOR_BOOT_SIZE);
-
- platform_device_register(&dt2_nor_flash);
-
- mvebu_mbus_add_window("devbus-cs0", DT2_LEDS_BASE, DT2_LEDS_SIZE);
- platform_device_register(&dt2_leds);
-
- if (request_irq(gpio_to_irq(DT2_PIN_GPIO_RESET), &dt2_reset_handler,
- IRQF_TRIGGER_LOW,
- "DT2: Reset button", NULL) < 0) {
-
- printk("DT2: Reset Button IRQ %d not available\n",
- gpio_to_irq(DT2_PIN_GPIO_RESET));
- }
-
- if (request_irq(gpio_to_irq(DT2_PIN_GPIO_POWER), &dt2_power_handler,
- IRQF_TRIGGER_LOW,
- "DT2: Power button", NULL) < 0) {
-
- printk(KERN_DEBUG "DT2: Power Button IRQ %d not available\n",
- gpio_to_irq(DT2_PIN_GPIO_POWER));
- }
-}
-
-static int __init parse_tag_dt2_uboot(const struct tag *t)
-{
- struct tag_mv_uboot *mv_uboot;
-
- // Get pointer to our block
- mv_uboot = (struct tag_mv_uboot*)&t->u;
- mvTclk = mv_uboot->tclk;
- mvSysclk = mv_uboot->sysclk;
- mvUbootVer = mv_uboot->uboot_version;
- mvIsUsbHost = mv_uboot->isUsbHost;
-
- // Some clock fixups
- if(mvTclk == 166000000) mvTclk = 166666667;
- else if(mvTclk == 133000000) mvTclk = 133333333;
- else if(mvSysclk == 166000000) mvSysclk = 166666667;
-
- gBoardId = (mvUbootVer & 0xff);
-
- //DT2 specific data
- memcpy(&dt2_eeprom, mv_uboot->dt2_eeprom, sizeof(struct DT2_EEPROM_STRUCT));
-
- return 0;
-}
-__tagtable(ATAG_MV_UBOOT, parse_tag_dt2_uboot);
-
-/*
- * This is OpenWrt specific fixup. It includes code from original "tag_fixup_mem32" to
- * fixup bogus memory tags and also fixes kernel cmdline by adding " init=/etc/preinit"
- * at the end. It is important to flash OpenWrt image from original Freecom firmware.
- *
- * Vanilla kernel should use "tag_fixup_mem32" function.
- */
-void __init openwrt_fixup(struct tag *t, char **from, struct meminfo *meminfo)
-{
- char *p = NULL;
- static char openwrt_init_tag[] __initdata = " init=/etc/preinit";
-
- for (; t->hdr.size; t = tag_next(t)){
- /* Locate the Freecom cmdline */
- if (t->hdr.tag == ATAG_CMDLINE) {
- p = t->u.cmdline.cmdline;
- printk("%s(%d): Found cmdline '%s' at 0x%0lx\n",
- __FUNCTION__, __LINE__, p, (unsigned long)p);
- }
- /*
- * Many orion-based systems have buggy bootloader implementations.
- * This is a common fixup for bogus memory tags.
- */
- if (t->hdr.tag == ATAG_MEM &&
- (!t->u.mem.size || t->u.mem.size & ~PAGE_MASK ||
- t->u.mem.start & ~PAGE_MASK)) {
- printk(KERN_WARNING
- "Clearing invalid memory bank %dKB@0x%08x\n",
- t->u.mem.size / 1024, t->u.mem.start);
- t->hdr.tag = 0;
- }
- }
-
- printk("%s(%d): End of table at 0x%0lx\n", __FUNCTION__, __LINE__, (unsigned long)t);
-
- /* Overwrite the end of the table with a new cmdline tag. */
- t->hdr.tag = ATAG_CMDLINE;
- t->hdr.size =
- (sizeof (struct tag_header) +
- strlen(p) + strlen(openwrt_init_tag) + 1 + 4) >> 2;
-
- strlcpy(t->u.cmdline.cmdline, p, COMMAND_LINE_SIZE);
- strlcpy(t->u.cmdline.cmdline + strlen(p), openwrt_init_tag,
- COMMAND_LINE_SIZE - strlen(p));
-
- printk("%s(%d): New cmdline '%s' at 0x%0lx\n",
- __FUNCTION__, __LINE__,
- t->u.cmdline.cmdline, (unsigned long)t->u.cmdline.cmdline);
-
- t = tag_next(t);
-
- printk("%s(%d): New end of table at 0x%0lx\n", __FUNCTION__, __LINE__, (unsigned long)t);
-
- t->hdr.tag = ATAG_NONE;
- t->hdr.size = 0;
-}
-
-/* Warning: Freecom uses their own custom bootloader with mach-type (=1500) */
-MACHINE_START(DT2, "Freecom DataTank Gateway")
- /* Maintainer: Zintis Petersons <Zintis.Petersons@abcsolutions.lv> */
- .atag_offset = 0x100,
- .init_machine = dt2_init,
- .map_io = orion5x_map_io,
- .init_irq = orion5x_init_irq,
- .init_time = orion5x_timer_init,
- .fixup = openwrt_fixup, //tag_fixup_mem32,
-MACHINE_END
---- a/arch/arm/mach-orion5x/Kconfig
-+++ b/arch/arm/mach-orion5x/Kconfig
+Index: linux-3.18.43/arch/arm/mach-orion5x/Kconfig
+===================================================================
+--- linux-3.18.43.orig/arch/arm/mach-orion5x/Kconfig
++++ linux-3.18.43/arch/arm/mach-orion5x/Kconfig
@@ -36,6 +36,13 @@ config MACH_RD88F5182_DT
- Say 'Y' here if you want your kernel to support the Marvell
- Orion-NAS (88F5182) RD2, Flattened Device Tree.
-
+ Say 'Y' here if you want your kernel to support the Marvell
+ Orion-NAS (88F5182) RD2, Flattened Device Tree.
+
+config MACH_DT2
+ bool "Freecom DataTank Gateway"
+ select I2C_BOARDINFO
+ Freecom DataTank Gateway
+
config MACH_KUROBOX_PRO
- bool "KuroBox Pro"
- select I2C_BOARDINFO
---- a/arch/arm/mach-orion5x/Makefile
-+++ b/arch/arm/mach-orion5x/Makefile
+ bool "KuroBox Pro"
+ select I2C_BOARDINFO
+Index: linux-3.18.43/arch/arm/mach-orion5x/Makefile
+===================================================================
+--- linux-3.18.43.orig/arch/arm/mach-orion5x/Makefile
++++ linux-3.18.43/arch/arm/mach-orion5x/Makefile
@@ -14,6 +14,7 @@ obj-$(CONFIG_MACH_TS78XX) += ts78xx-setu
obj-$(CONFIG_MACH_MV2120) += mv2120-setup.o
obj-$(CONFIG_MACH_NET2BIG) += net2big-setup.o
obj-$(CONFIG_MACH_RD88F5181L_GE) += rd88f5181l-ge-setup.o
obj-$(CONFIG_MACH_RD88F5181L_FXO) += rd88f5181l-fxo-setup.o
obj-$(CONFIG_MACH_RD88F6183AP_GE) += rd88f6183ap-ge-setup.o
+Index: linux-3.18.43/arch/arm/mach-orion5x/dt2-common.h
+===================================================================
+--- /dev/null
++++ linux-3.18.43/arch/arm/mach-orion5x/dt2-common.h
+@@ -0,0 +1,82 @@
++#ifndef __INC_DT2_COMMON_H
++#define __INC_DT2_COMMON_H
++
++#define ATAG_MV_UBOOT 0x41000403
++
++struct tag_mv_uboot {
++ u32 uboot_version;
++ u32 tclk;
++ u32 sysclk;
++ u32 isUsbHost;
++ u32 overEthAddr;
++ u8 dt2_eeprom[256];
++};
++
++#define DT2_EEPROM_ADDR 0x50
++#define DT2_EEPROM_OFFSET 0
++#define DT2_EEPROM_LENGTH 256
++
++#define DT2_SERIAL_NUMBER_DEFAULT "run on default\0"
++#define DT2_REVISION_DEFAULT_INIT 0xFF
++#define DT2_CONFIG_FLAGS_DEFAULT 0x00
++
++#define _PACKED_ __attribute__((packed))
++
++struct DT2_EEPROM_SD_CONFIG {
++ unsigned int ram_1;
++ unsigned int ram_2;
++ unsigned int ram_3;
++ unsigned int ram_4;
++ unsigned char ram_5;
++ unsigned char ram_6;
++ unsigned short ram_7;
++ unsigned int magic_id;
++ } _PACKED_; // 24 Bytes in total
++
++struct DT2_EEPROM_FC_CONFIG {
++ unsigned char rtc_sts_mask;
++ unsigned char rtc_sts_init;
++ unsigned char rtc_int_mask;
++ unsigned char rtc_int_init;
++ unsigned char rtc_atrim_init;
++ unsigned char rtc_dtrim_init;
++ unsigned char dummy1;
++ unsigned char dummy2;
++ unsigned char dt2_config_flags; /* 0x80 to load rtc_values to RTC */
++ unsigned char dt2_revision; /* upper nibble is HW, lower nibble is FW */
++ unsigned char dt2_serial_number[16]; /* Serial number of DT-2 */
++ } _PACKED_; // 26 Bytes in total
++
++#define CFG_LOAD_RTC_VALUES 0x80
++
++struct DT2_EEPROM_GW_CONFIG {
++ unsigned int dummy1;
++ unsigned int dummy2;
++ unsigned int dummy3;
++ unsigned char dummy4;
++ unsigned char tos_video_val1;
++ unsigned char tos_video_val2;
++ unsigned char tos_voip_val;
++ unsigned char qos_igmp_cfg;
++ unsigned char num_of_ifs;
++ unsigned short vlan_ports_if[3];
++ unsigned char mac_addr[3][6];
++ } _PACKED_; // 42 Bytes in total
++
++#define _SIZE_OF_ALL_STRUCTS_ (sizeof(struct DT2_EEPROM_SD_CONFIG) + sizeof(struct DT2_EEPROM_FC_CONFIG) + sizeof(struct DT2_EEPROM_GW_CONFIG))
++
++// MV = EEPROM - SD - FC - GW - CRC
++struct DT2_EEPROM_MV_CONFIG {
++ unsigned int reg_addr[(DT2_EEPROM_LENGTH - _SIZE_OF_ALL_STRUCTS_ - sizeof(unsigned int)) / (sizeof(unsigned int) * 2)];
++ unsigned int reg_data[(DT2_EEPROM_LENGTH - _SIZE_OF_ALL_STRUCTS_ - sizeof(unsigned int)) / (sizeof(unsigned int) * 2)];
++ } _PACKED_;
++
++struct DT2_EEPROM_STRUCT {
++ struct DT2_EEPROM_MV_CONFIG mv;
++ struct DT2_EEPROM_SD_CONFIG sd;
++ struct DT2_EEPROM_FC_CONFIG fc;
++ struct DT2_EEPROM_GW_CONFIG gw;
++ unsigned int crc;
++ } _PACKED_;
++
++#endif
+Index: linux-3.18.43/arch/arm/mach-orion5x/dt2-setup.c
+===================================================================
+--- /dev/null
++++ linux-3.18.43/arch/arm/mach-orion5x/dt2-setup.c
+@@ -0,0 +1,448 @@
++/*
++ * arch/arm/mach-orion5x/dt2-setup.c
++ *
++ * Freecom DataTank Gateway Setup
++ *
++ * Copyright (C) 2009 Zintis Petersons <Zintis.Petersons@abcsolutions.lv>
++ *
++ * This file is licensed under the terms of the GNU General Public
++ * License version 2. This program is licensed "as is" without any
++ * warranty of any kind, whether express or implied.
++ */
++
++#include <linux/kernel.h>
++#include <linux/init.h>
++#include <linux/platform_device.h>
++#include <linux/pci.h>
++#include <linux/irq.h>
++#include <linux/mtd/physmap.h>
++#include <linux/mv643xx_eth.h>
++#include <linux/ethtool.h>
++#include <linux/if_ether.h>
++#include <net/dsa.h>
++#include <linux/ata_platform.h>
++#include <linux/i2c.h>
++#include <linux/reboot.h>
++#include <linux/interrupt.h>
++#include <asm/mach-types.h>
++#include <asm/gpio.h>
++#include <asm/mach/arch.h>
++#include <asm/mach/pci.h>
++#include <mach/orion5x.h>
++#include "common.h"
++#include "mpp.h"
++
++/*****************************************************************************
++ * DT2 local
++ ****************************************************************************/
++#include <asm/setup.h>
++#include "dt2-common.h"
++
++u32 mvUbootVer = 0;
++u32 mvTclk = 166666667;
++u32 mvSysclk = 200000000;
++u32 mvIsUsbHost = 1;
++u32 overEthAddr = 0;
++u32 gBoardId = -1;
++struct DT2_EEPROM_STRUCT dt2_eeprom;
++
++/*****************************************************************************
++ * DT2 Info
++ ****************************************************************************/
++/*
++ * PCI
++ */
++
++#define DT2_PCI_SLOT0_OFFS 7
++#define DT2_PCI_SLOT0_IRQ_A_PIN 3
++#define DT2_PCI_SLOT0_IRQ_B_PIN 2
++
++#define DT2_PIN_GPIO_SYNC 25
++#define DT2_PIN_GPIO_POWER 24
++#define DT2_PIN_GPIO_UNPLUG1 23
++#define DT2_PIN_GPIO_UNPLUG2 22
++#define DT2_PIN_GPIO_RESET 4
++
++#define DT2_NOR_BOOT_BASE 0xf4000000
++#define DT2_NOR_BOOT_SIZE SZ_512K
++
++#define DT2_LEDS_BASE 0xfa000000
++#define DT2_LEDS_SIZE SZ_1K
++
++/*****************************************************************************
++ * 512K NOR Flash on Device bus Boot CS
++ ****************************************************************************/
++
++static struct mtd_partition dt2_partitions[] = {
++ {
++ .name = "u-boot",
++ .size = 0x00080000,
++ .offset = 0,
++ },
++};
++
++static struct physmap_flash_data dt2_nor_flash_data = {
++ .width = 1, /* 8 bit bus width */
++ .parts = dt2_partitions,
++ .nr_parts = ARRAY_SIZE(dt2_partitions)
++};
++
++static struct resource dt2_nor_flash_resource = {
++ .flags = IORESOURCE_MEM,
++ .start = DT2_NOR_BOOT_BASE,
++ .end = DT2_NOR_BOOT_BASE + DT2_NOR_BOOT_SIZE - 1,
++};
++
++static struct platform_device dt2_nor_flash = {
++ .name = "physmap-flash",
++ .id = 0,
++ .dev = {
++ .platform_data = &dt2_nor_flash_data,
++ },
++ .resource = &dt2_nor_flash_resource,
++ .num_resources = 1,
++};
++
++/*****************************************************************************
++ * PCI
++ ****************************************************************************/
++
++void __init dt2_pci_preinit(void)
++{
++ int pin, irq;
++
++ /*
++ * Configure PCI GPIO IRQ pins
++ */
++ pin = DT2_PCI_SLOT0_IRQ_A_PIN;
++ if (gpio_request(pin, "PCI IntA") == 0) {
++ if (gpio_direction_input(pin) == 0) {
++ irq = gpio_to_irq(pin);
++ irq_set_irq_type(irq, IRQ_TYPE_LEVEL_LOW);
++ printk (KERN_INFO "PCI IntA IRQ: %d\n", irq);
++ } else {
++ printk(KERN_ERR "dt2_pci_preinit failed to "
++ "irq_set_irq_type pin %d\n", pin);
++ gpio_free(pin);
++ }
++ } else {
++ printk(KERN_ERR "dt2_pci_preinit failed to request gpio %d\n", pin);
++ }
++
++ pin = DT2_PCI_SLOT0_IRQ_B_PIN;
++ if (gpio_request(pin, "PCI IntB") == 0) {
++ if (gpio_direction_input(pin) == 0) {
++ irq = gpio_to_irq(pin);
++ irq_set_irq_type(irq, IRQ_TYPE_LEVEL_LOW);
++ printk (KERN_INFO "PCI IntB IRQ: %d\n", irq);
++ } else {
++ printk(KERN_ERR "dt2_pci_preinit failed to "
++ "irq_set_irq_type pin %d\n", pin);
++ gpio_free(pin);
++ }
++ } else {
++ printk(KERN_ERR "dt2_pci_preinit failed to gpio_request %d\n", pin);
++ }
++}
++
++static int __init dt2_pci_map_irq(const struct pci_dev *dev, u8 slot, u8 pin)
++{
++ int irq;
++
++ /*
++ * Check for devices with hard-wired IRQs.
++ */
++ irq = orion5x_pci_map_irq(dev, slot, pin);
++ if (irq != -1){
++ printk(KERN_INFO "orion5x_pci_map_irq: %d\n", irq);
++ return irq;
++ }
++
++ /*
++ * PCI IRQs are connected via GPIOs
++ */
++ switch (slot - DT2_PCI_SLOT0_OFFS) {
++ case 0:
++ if (pin == 1){
++ irq = gpio_to_irq(DT2_PCI_SLOT0_IRQ_A_PIN);
++ printk(KERN_INFO "dt2_pci_map_irq DT2_PCI_SLOT0_IRQ_A_PIN: %d\n", irq);
++ }
++ else {
++ irq = gpio_to_irq(DT2_PCI_SLOT0_IRQ_B_PIN);
++ printk(KERN_INFO "dt2_pci_map_irq DT2_PCI_SLOT0_IRQ_B_PIN: %d\n", irq);
++ }
++ default:
++ irq = -1;
++ printk(KERN_INFO "dt2_pci_map_irq IRQ: %d\n", irq);
++ }
++
++ return irq;
++}
++
++static struct hw_pci dt2_pci __initdata = {
++ .nr_controllers = 2,
++ .preinit = dt2_pci_preinit,
++ .setup = orion5x_pci_sys_setup,
++ .scan = orion5x_pci_sys_scan_bus,
++ .map_irq = dt2_pci_map_irq,
++};
++
++static int __init dt2_pci_init(void)
++{
++ if (machine_is_dt2())
++ pci_common_init(&dt2_pci);
++
++ return 0;
++}
++
++subsys_initcall(dt2_pci_init);
++
++/*****************************************************************************
++ * Ethernet
++ ****************************************************************************/
++
++static struct mv643xx_eth_platform_data dt2_eth_data = {
++ .phy_addr = MV643XX_ETH_PHY_NONE,
++ .speed = SPEED_1000,
++ .duplex = DUPLEX_FULL,
++};
++
++static struct dsa_chip_data dt2_switch_chip_data = {
++ .port_names[0] = "wan",
++ .port_names[1] = "lan1",
++ .port_names[2] = "lan2",
++ .port_names[3] = "cpu",
++ .port_names[4] = "lan3",
++ .port_names[5] = "lan4",
++};
++
++static struct dsa_platform_data dt2_switch_plat_data = {
++ .nr_chips = 1,
++ .chip = &dt2_switch_chip_data,
++};
++
++/*****************************************************************************
++ * RTC ISL1208 on I2C bus
++ ****************************************************************************/
++static struct i2c_board_info __initdata dt2_i2c_rtc = {
++ I2C_BOARD_INFO("isl1208", 0x6F),
++};
++
++/*****************************************************************************
++ * Sata
++ ****************************************************************************/
++static struct mv_sata_platform_data dt2_sata_data = {
++ .n_ports = 2,
++};
++
++/*****************************************************************************
++ * General Setup
++ ****************************************************************************/
++static unsigned int dt2_mpp_modes[] __initdata = {
++ MPP0_GPIO, // RTC interrupt
++ MPP1_GPIO, // 88e6131 interrupt
++ MPP2_GPIO, // PCI_intB
++ MPP3_GPIO, // PCI_intA
++ MPP4_GPIO, // reset button switch
++ MPP5_GPIO,
++ MPP6_GPIO,
++ MPP7_GPIO,
++ MPP8_GPIO,
++ MPP9_GIGE, /* GE_RXERR */
++ MPP10_GPIO, // usb
++ MPP11_GPIO, // usb
++ MPP12_GIGE, // GE_TXD[4]
++ MPP13_GIGE, // GE_TXD[5]
++ MPP14_GIGE, // GE_TXD[6]
++ MPP15_GIGE, // GE_TXD[7]
++ MPP16_GIGE, // GE_RXD[4]
++ MPP17_GIGE, // GE_RXD[5]
++ MPP18_GIGE, // GE_RXD[6]
++ MPP19_GIGE, // GE_RXD[7]
++ 0,
++};
++
++/*****************************************************************************
++ * LEDS
++ ****************************************************************************/
++static struct platform_device dt2_leds = {
++ .name = "dt2-led",
++ .id = -1,
++};
++
++/****************************************************************************
++ * GPIO key
++ ****************************************************************************/
++static irqreturn_t dt2_reset_handler(int irq, void *dev_id)
++{
++ /* This is the paper-clip reset which does an emergency reboot. */
++ printk(KERN_INFO "Restarting system.\n");
++ machine_restart(NULL);
++
++ /* This should never be reached. */
++ return IRQ_HANDLED;
++}
++
++static irqreturn_t dt2_power_handler(int irq, void *dev_id)
++{
++ printk(KERN_INFO "Shutting down system.\n");
++ machine_power_off();
++ return IRQ_HANDLED;
++}
++
++static void __init dt2_init(void)
++{
++ /*
++ * Setup basic Orion functions. Need to be called early.
++ */
++ orion5x_init();
++
++ orion5x_mpp_conf(dt2_mpp_modes);
++
++ /*
++ * Configure peripherals.
++ */
++
++ orion5x_uart0_init();
++ orion5x_ehci0_init();
++ orion5x_ehci1_init();
++ orion5x_i2c_init();
++ orion5x_sata_init(&dt2_sata_data);
++ orion5x_xor_init();
++
++ printk(KERN_INFO "U-Boot parameters:\n");
++ printk(KERN_INFO "Sys Clk = %d, Tclk = %d, BoardID = 0x%02x\n", mvSysclk, mvTclk, gBoardId);
++
++ printk(KERN_INFO "Serial: %s\n", dt2_eeprom.fc.dt2_serial_number);
++ printk(KERN_INFO "Revision: %016x\n", dt2_eeprom.fc.dt2_revision);
++ printk(KERN_INFO "DT2: Using MAC address %pM for port 0\n",
++ dt2_eeprom.gw.mac_addr[0]);
++ printk(KERN_INFO "DT2: Using MAC address %pM for port 1\n",
++ dt2_eeprom.gw.mac_addr[1]);
++
++ orion5x_eth_init(&dt2_eth_data);
++ memcpy(dt2_eth_data.mac_addr, dt2_eeprom.gw.mac_addr[0], 6);
++ orion5x_eth_switch_init(&dt2_switch_plat_data, NO_IRQ);
++
++ i2c_register_board_info(0, &dt2_i2c_rtc, 1);
++
++ mvebu_mbus_add_window_by_id(ORION_MBUS_DEVBUS_BOOT_TARGET,
++ ORION_MBUS_DEVBUS_BOOT_ATTR,
++ DT2_NOR_BOOT_BASE, DT2_NOR_BOOT_SIZE);
++
++ platform_device_register(&dt2_nor_flash);
++
++ mvebu_mbus_add_window_by_id(ORION_MBUS_DEVBUS_TARGET(0),
++ ORION_MBUS_DEVBUS_ATTR(0),
++ DT2_LEDS_BASE, DT2_LEDS_SIZE);
++ platform_device_register(&dt2_leds);
++
++ if (request_irq(gpio_to_irq(DT2_PIN_GPIO_RESET), &dt2_reset_handler,
++ IRQF_TRIGGER_LOW,
++ "DT2: Reset button", NULL) < 0) {
++
++ printk("DT2: Reset Button IRQ %d not available\n",
++ gpio_to_irq(DT2_PIN_GPIO_RESET));
++ }
++
++ if (request_irq(gpio_to_irq(DT2_PIN_GPIO_POWER), &dt2_power_handler,
++ IRQF_TRIGGER_LOW,
++ "DT2: Power button", NULL) < 0) {
++
++ printk(KERN_DEBUG "DT2: Power Button IRQ %d not available\n",
++ gpio_to_irq(DT2_PIN_GPIO_POWER));
++ }
++}
++
++static int __init parse_tag_dt2_uboot(const struct tag *t)
++{
++ struct tag_mv_uboot *mv_uboot;
++
++ // Get pointer to our block
++ mv_uboot = (struct tag_mv_uboot*)&t->u;
++ mvTclk = mv_uboot->tclk;
++ mvSysclk = mv_uboot->sysclk;
++ mvUbootVer = mv_uboot->uboot_version;
++ mvIsUsbHost = mv_uboot->isUsbHost;
++
++ // Some clock fixups
++ if(mvTclk == 166000000) mvTclk = 166666667;
++ else if(mvTclk == 133000000) mvTclk = 133333333;
++ else if(mvSysclk == 166000000) mvSysclk = 166666667;
++
++ gBoardId = (mvUbootVer & 0xff);
++
++ //DT2 specific data
++ memcpy(&dt2_eeprom, mv_uboot->dt2_eeprom, sizeof(struct DT2_EEPROM_STRUCT));
++
++ return 0;
++}
++__tagtable(ATAG_MV_UBOOT, parse_tag_dt2_uboot);
++
++/*
++ * This is OpenWrt specific fixup. It includes code from original "tag_fixup_mem32" to
++ * fixup bogus memory tags and also fixes kernel cmdline by adding " init=/etc/preinit"
++ * at the end. It is important to flash OpenWrt image from original Freecom firmware.
++ *
++ * Vanilla kernel should use "tag_fixup_mem32" function.
++ */
++static void __init openwrt_fixup(struct tag *t, char **from)
++{
++ char *p = NULL;
++ static char openwrt_init_tag[] __initdata = " init=/etc/preinit";
++
++ for (; t->hdr.size; t = tag_next(t)){
++ /* Locate the Freecom cmdline */
++ if (t->hdr.tag == ATAG_CMDLINE) {
++ p = t->u.cmdline.cmdline;
++ printk("%s(%d): Found cmdline '%s' at 0x%0lx\n",
++ __FUNCTION__, __LINE__, p, (unsigned long)p);
++ }
++ /*
++ * Many orion-based systems have buggy bootloader implementations.
++ * This is a common fixup for bogus memory tags.
++ */
++ if (t->hdr.tag == ATAG_MEM &&
++ (!t->u.mem.size || t->u.mem.size & ~PAGE_MASK ||
++ t->u.mem.start & ~PAGE_MASK)) {
++ printk(KERN_WARNING
++ "Clearing invalid memory bank %dKB@0x%08x\n",
++ t->u.mem.size / 1024, t->u.mem.start);
++ t->hdr.tag = 0;
++ }
++ }
++
++ printk("%s(%d): End of table at 0x%0lx\n", __FUNCTION__, __LINE__, (unsigned long)t);
++
++ /* Overwrite the end of the table with a new cmdline tag. */
++ t->hdr.tag = ATAG_CMDLINE;
++ t->hdr.size =
++ (sizeof (struct tag_header) +
++ strlen(p) + strlen(openwrt_init_tag) + 1 + 4) >> 2;
++
++ strlcpy(t->u.cmdline.cmdline, p, COMMAND_LINE_SIZE);
++ strlcpy(t->u.cmdline.cmdline + strlen(p), openwrt_init_tag,
++ COMMAND_LINE_SIZE - strlen(p));
++
++ printk("%s(%d): New cmdline '%s' at 0x%0lx\n",
++ __FUNCTION__, __LINE__,
++ t->u.cmdline.cmdline, (unsigned long)t->u.cmdline.cmdline);
++
++ t = tag_next(t);
++
++ printk("%s(%d): New end of table at 0x%0lx\n", __FUNCTION__, __LINE__, (unsigned long)t);
++
++ t->hdr.tag = ATAG_NONE;
++ t->hdr.size = 0;
++}
++
++/* Warning: Freecom uses their own custom bootloader with mach-type (=1500) */
++MACHINE_START(DT2, "Freecom DataTank Gateway")
++ /* Maintainer: Zintis Petersons <Zintis.Petersons@abcsolutions.lv> */
++ .atag_offset = 0x100,
++ .init_machine = dt2_init,
++ .map_io = orion5x_map_io,
++ .init_irq = orion5x_init_irq,
++ .init_time = orion5x_timer_init,
++ .fixup = openwrt_fixup, //tag_fixup_mem32,
++MACHINE_END
projects / openwrt / openwrt.git / commitdiff