mirror of https://github.com/hak5/openwrt.git
orion: Fold DT2 setup files into patch
Signed-off-by: Florian Fainelli <f.fainelli@gmail.com>lede-17.01
Florian Fainelli
Felix Fietkau
parent
9a08c0ba80
commit
cec7e661e7
|
|
@ -1,82 +0,0 @@
|
|||
#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
|
||||
|
|
@ -1,445 +0,0 @@
|
|||
/*
|
||||
* 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
|
||||
|
|
@ -1,9 +1,11 @@
|
|||
--- 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
|
||||
|
|
@ -12,10 +14,12 @@
|
|||
+ 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
|
||||
|
|
@ -24,3 +28,543 @@
|
|||
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
|
||||
|
|
|
|||
Loading…
Reference in New Issue