Signed-off-by: Florian Fainelli <f.fainelli@gmail.com>master
Florian Fainelli
8 years ago
committed by
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 |
|
||||||
Loading…
Reference in new issue