*/
#include <linux/platform_device.h>
-#include <linux/mtd/mtd.h>
-#include <linux/mtd/partitions.h>
#include <linux/delay.h>
#include <linux/rtl8366.h>
#define DIR825B1_KEYS_POLL_INTERVAL 20 /* msecs */
#define DIR825B1_KEYS_DEBOUNCE_INTERVAL (3 * DIR825B1_KEYS_POLL_INTERVAL)
-#define DIR825B1_CAL_LOCATION_0 0x1f661000
-#define DIR825B1_CAL_LOCATION_1 0x1f665000
+#define DIR825B1_CAL0_OFFSET 0x1000
+#define DIR825B1_CAL1_OFFSET 0x5000
+#define DIR825B1_MAC0_OFFSET 0xffa0
+#define DIR825B1_MAC1_OFFSET 0xffb4
-#define DIR825B1_MAC_LOCATION_0 0x1f66ffa0
-#define DIR825B1_MAC_LOCATION_1 0x1f66ffb4
-
-static struct mtd_partition dir825b1_partitions[] = {
- {
- .name = "uboot",
- .offset = 0,
- .size = 0x040000,
- .mask_flags = MTD_WRITEABLE,
- }, {
- .name = "config",
- .offset = 0x040000,
- .size = 0x010000,
- .mask_flags = MTD_WRITEABLE,
- }, {
- .name = "firmware",
- .offset = 0x050000,
- .size = 0x610000,
- }, {
- .name = "caldata",
- .offset = 0x660000,
- .size = 0x010000,
- .mask_flags = MTD_WRITEABLE,
- }, {
- .name = "unknown",
- .offset = 0x670000,
- .size = 0x190000,
- .mask_flags = MTD_WRITEABLE,
- }
-};
-
-static struct flash_platform_data dir825b1_flash_data = {
- .parts = dir825b1_partitions,
- .nr_parts = ARRAY_SIZE(dir825b1_partitions),
-};
+#define DIR825B1_CAL_LOCATION_0 0x1f660000
+#define DIR825B1_CAL_LOCATION_1 0x1f7f0000
static struct gpio_led dir825b1_leds_gpio[] __initdata = {
{
}
};
-static void dir825b1_read_ascii_mac(u8 *dest, unsigned int src_addr)
+static void dir825b1_read_ascii_mac(u8 *dest, u8 *src)
{
int ret;
- u8 *src = (u8 *)KSEG1ADDR(src_addr);
ret = sscanf(src, "%02hhx:%02hhx:%02hhx:%02hhx:%02hhx:%02hhx",
&dest[0], &dest[1], &dest[2],
memset(dest, 0, ETH_ALEN);
}
-static void __init dir825b1_setup(void)
+static bool __init dir825b1_is_caldata_valid(u8 *p)
{
+ u16 *magic0, *magic1;
+
+ magic0 = (u16 *)(p + DIR825B1_CAL0_OFFSET);
+ magic1 = (u16 *)(p + DIR825B1_CAL1_OFFSET);
+
+ return (*magic0 == 0xa55a && *magic1 == 0xa55a);
+}
+
+static void __init dir825b1_wlan_init(void)
+{
+ u8 *caldata;
u8 mac1[ETH_ALEN], mac2[ETH_ALEN];
- dir825b1_read_ascii_mac(mac1, DIR825B1_MAC_LOCATION_0);
- dir825b1_read_ascii_mac(mac2, DIR825B1_MAC_LOCATION_1);
+ caldata = (u8 *) KSEG1ADDR(DIR825B1_CAL_LOCATION_0);
+ if (!dir825b1_is_caldata_valid(caldata)) {
+ caldata = (u8 *)KSEG1ADDR(DIR825B1_CAL_LOCATION_1);
+ if (!dir825b1_is_caldata_valid(caldata)) {
+ pr_err("no calibration data found\n");
+ return;
+ }
+ }
- ath79_register_mdio(0, 0x0);
+ dir825b1_read_ascii_mac(mac1, caldata + DIR825B1_MAC0_OFFSET);
+ dir825b1_read_ascii_mac(mac2, caldata + DIR825B1_MAC1_OFFSET);
ath79_init_mac(ath79_eth0_data.mac_addr, mac1, 2);
+ ath79_init_mac(ath79_eth1_data.mac_addr, mac1, 3);
+
+ ap9x_pci_setup_wmac_led_pin(0, 5);
+ ap9x_pci_setup_wmac_led_pin(1, 5);
+
+ ap94_pci_init(caldata + DIR825B1_CAL0_OFFSET, mac1,
+ caldata + DIR825B1_CAL1_OFFSET, mac2);
+}
+
+static void __init dir825b1_setup(void)
+{
+ dir825b1_wlan_init();
+
+ ath79_register_mdio(0, 0x0);
+
ath79_eth0_data.mii_bus_dev = &dir825b1_rtl8366s_device.dev;
ath79_eth0_data.phy_if_mode = PHY_INTERFACE_MODE_RGMII;
ath79_eth0_data.speed = SPEED_1000;
ath79_eth0_data.duplex = DUPLEX_FULL;
ath79_eth0_pll_data.pll_1000 = 0x11110000;
- ath79_init_mac(ath79_eth1_data.mac_addr, mac1, 3);
ath79_eth1_data.mii_bus_dev = &dir825b1_rtl8366s_device.dev;
ath79_eth1_data.phy_if_mode = PHY_INTERFACE_MODE_RGMII;
ath79_eth1_data.phy_mask = 0x10;
ath79_register_eth(0);
ath79_register_eth(1);
- ath79_register_m25p80(&dir825b1_flash_data);
+ ath79_register_m25p80(NULL);
ath79_register_leds_gpio(-1, ARRAY_SIZE(dir825b1_leds_gpio),
dir825b1_leds_gpio);
ath79_register_usb();
platform_device_register(&dir825b1_rtl8366s_device);
-
- ap9x_pci_setup_wmac_led_pin(0, 5);
- ap9x_pci_setup_wmac_led_pin(1, 5);
-
- ap94_pci_init((u8 *) KSEG1ADDR(DIR825B1_CAL_LOCATION_0), mac1,
- (u8 *) KSEG1ADDR(DIR825B1_CAL_LOCATION_1), mac2);
}
MIPS_MACHINE(ATH79_MACH_DIR_825_B1, "DIR-825-B1", "D-Link DIR-825 rev. B1",