1 files changed, 234 insertions, 0 deletions

diff --git a/arch/mips/ath25/board.c b/arch/mips/ath25/board.c
new file mode 100644
index 000000000000..b8bb78282d6a
--- /dev/null
+++ b/arch/mips/ath25/board.c
@@ -0,0 +1,234 @@
+/*
+ * This file is subject to the terms and conditions of the GNU General Public
+ * License.  See the file "COPYING" in the main directory of this archive
+ * for more details.
+ *
+ * Copyright (C) 2003 Atheros Communications, Inc.,  All Rights Reserved.
+ * Copyright (C) 2006 FON Technology, SL.
+ * Copyright (C) 2006 Imre Kaloz <kaloz@openwrt.org>
+ * Copyright (C) 2006-2009 Felix Fietkau <nbd@openwrt.org>
+ */
+
+#include <linux/init.h>
+#include <linux/interrupt.h>
+#include <asm/irq_cpu.h>
+#include <asm/reboot.h>
+#include <asm/bootinfo.h>
+#include <asm/time.h>
+
+#include <ath25_platform.h>
+#include "devices.h"
+#include "ar5312.h"
+#include "ar2315.h"
+
+void (*ath25_irq_dispatch)(void);
+
+static inline bool check_radio_magic(const void __iomem *addr)
+{
+        addr += 0x7a; /* offset for flash magic */
+        return (__raw_readb(addr) == 0x5a) && (__raw_readb(addr + 1) == 0xa5);
+}
+
+static inline bool check_notempty(const void __iomem *addr)
+{
+        return __raw_readl(addr) != 0xffffffff;
+}
+
+static inline bool check_board_data(const void __iomem *addr, bool broken)
+{
+        /* config magic found */
+        if (__raw_readl(addr) == ATH25_BD_MAGIC)
+                return true;
+
+        if (!broken)
+                return false;
+
+        /* broken board data detected, use radio data to find the
+         * offset, user will fix this */
+
+        if (check_radio_magic(addr + 0x1000))
+                return true;
+        if (check_radio_magic(addr + 0xf8))
+                return true;
+
+        return false;
+}
+
+static const void __iomem * __init find_board_config(const void __iomem *limit,
+                                                     const bool broken)
+{
+        const void __iomem *addr;
+        const void __iomem *begin = limit - 0x1000;
+        const void __iomem *end = limit - 0x30000;
+
+        for (addr = begin; addr >= end; addr -= 0x1000)
+                if (check_board_data(addr, broken))
+                        return addr;
+
+        return NULL;
+}
+
+static const void __iomem * __init find_radio_config(const void __iomem *limit,
+                                                     const void __iomem *bcfg)
+{
+        const void __iomem *rcfg, *begin, *end;
+
+        /*
+         * Now find the start of Radio Configuration data, using heuristics:
+         * Search forward from Board Configuration data by 0x1000 bytes
+         * at a time until we find non-0xffffffff.
+         */
+        begin = bcfg + 0x1000;
+        end = limit;
+        for (rcfg = begin; rcfg < end; rcfg += 0x1000)
+                if (check_notempty(rcfg) && check_radio_magic(rcfg))
+                        return rcfg;
+
+        /* AR2316 relocates radio config to new location */
+        begin = bcfg + 0xf8;
+        end = limit - 0x1000 + 0xf8;
+        for (rcfg = begin; rcfg < end; rcfg += 0x1000)
+                if (check_notempty(rcfg) && check_radio_magic(rcfg))
+                        return rcfg;
+
+        return NULL;
+}
+
+/*
+ * NB: Search region size could be larger than the actual flash size,
+ * but this shouldn't be a problem here, because the flash
+ * will simply be mapped multiple times.
+ */
+int __init ath25_find_config(phys_addr_t base, unsigned long size)
+{
+        const void __iomem *flash_base, *flash_limit;
+        struct ath25_boarddata *config;
+        unsigned int rcfg_size;
+        int broken_boarddata = 0;
+        const void __iomem *bcfg, *rcfg;
+        u8 *board_data;
+        u8 *radio_data;
+        u8 *mac_addr;
+        u32 offset;
+
+        flash_base = ioremap_nocache(base, size);
+        flash_limit = flash_base + size;
+
+        ath25_board.config = NULL;
+        ath25_board.radio = NULL;
+
+        /* Copy the board and radio data to RAM, because accessing the mapped
+         * memory of the flash directly after booting is not safe */
+
+        /* Try to find valid board and radio data */
+        bcfg = find_board_config(flash_limit, false);
+
+        /* If that fails, try to at least find valid radio data */
+        if (!bcfg) {
+                bcfg = find_board_config(flash_limit, true);
+                broken_boarddata = 1;
+        }
+
+        if (!bcfg) {
+                pr_warn("WARNING: No board configuration data found!\n");
+                goto error;
+        }
+
+        board_data = kzalloc(BOARD_CONFIG_BUFSZ, GFP_KERNEL);
+        ath25_board.config = (struct ath25_boarddata *)board_data;
+        memcpy_fromio(board_data, bcfg, 0x100);
+        if (broken_boarddata) {
+                pr_warn("WARNING: broken board data detected\n");
+                config = ath25_board.config;
+                if (is_zero_ether_addr(config->enet0_mac)) {
+                        pr_info("Fixing up empty mac addresses\n");
+                        config->reset_config_gpio = 0xffff;
+                        config->sys_led_gpio = 0xffff;
+                        random_ether_addr(config->wlan0_mac);
+                        config->wlan0_mac[0] &= ~0x06;
+                        random_ether_addr(config->enet0_mac);
+                        random_ether_addr(config->enet1_mac);
+                }
+        }
+
+        /* Radio config starts 0x100 bytes after board config, regardless
+         * of what the physical layout on the flash chip looks like */
+
+        rcfg = find_radio_config(flash_limit, bcfg);
+        if (!rcfg) {
+                pr_warn("WARNING: Could not find Radio Configuration data\n");
+                goto error;
+        }
+
+        radio_data = board_data + 0x100 + ((rcfg - bcfg) & 0xfff);
+        ath25_board.radio = radio_data;
+        offset = radio_data - board_data;
+        pr_info("Radio config found at offset 0x%x (0x%x)\n", rcfg - bcfg,
+                offset);
+        rcfg_size = BOARD_CONFIG_BUFSZ - offset;
+        memcpy_fromio(radio_data, rcfg, rcfg_size);
+
+        mac_addr = &radio_data[0x1d * 2];
+        if (is_broadcast_ether_addr(mac_addr)) {
+                pr_info("Radio MAC is blank; using board-data\n");
+                ether_addr_copy(mac_addr, ath25_board.config->wlan0_mac);
+        }
+
+        iounmap(flash_base);
+
+        return 0;
+
+error:
+        iounmap(flash_base);
+        return -ENODEV;
+}
+
+static void ath25_halt(void)
+{
+        local_irq_disable();
+        unreachable();
+}
+
+void __init plat_mem_setup(void)
+{
+        _machine_halt = ath25_halt;
+        pm_power_off = ath25_halt;
+
+        if (is_ar5312())
+                ar5312_plat_mem_setup();
+        else
+                ar2315_plat_mem_setup();
+
+        /* Disable data watchpoints */
+        write_c0_watchlo0(0);
+}
+
+asmlinkage void plat_irq_dispatch(void)
+{
+        ath25_irq_dispatch();
+}
+
+void __init plat_time_init(void)
+{
+        if (is_ar5312())
+                ar5312_plat_time_init();
+        else
+                ar2315_plat_time_init();
+}
+
+unsigned int __cpuinit get_c0_compare_int(void)
+{
+        return CP0_LEGACY_COMPARE_IRQ;
+}
+
+void __init arch_init_irq(void)
+{
+        clear_c0_status(ST0_IM);
+        mips_cpu_irq_init();
+
+        /* Initialize interrupt controllers */
+        if (is_ar5312())
+                ar5312_arch_init_irq();
+        else
+                ar2315_arch_init_irq();
+}