|  | /* | 
|  | * 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 Felix Fietkau <nbd@openwrt.org> | 
|  | * Copyright (C) 2012 Alexandros C. Couloumbis <alex@ozo.com> | 
|  | */ | 
|  |  | 
|  | /* | 
|  | * Platform devices for Atheros AR2315 SoCs | 
|  | */ | 
|  |  | 
|  | #include <linux/init.h> | 
|  | #include <linux/kernel.h> | 
|  | #include <linux/bitops.h> | 
|  | #include <linux/irqdomain.h> | 
|  | #include <linux/interrupt.h> | 
|  | #include <linux/memblock.h> | 
|  | #include <linux/platform_device.h> | 
|  | #include <linux/reboot.h> | 
|  | #include <asm/bootinfo.h> | 
|  | #include <asm/reboot.h> | 
|  | #include <asm/time.h> | 
|  |  | 
|  | #include <ath25_platform.h> | 
|  |  | 
|  | #include "devices.h" | 
|  | #include "ar2315.h" | 
|  | #include "ar2315_regs.h" | 
|  |  | 
|  | static void __iomem *ar2315_rst_base; | 
|  | static struct irq_domain *ar2315_misc_irq_domain; | 
|  |  | 
|  | static inline u32 ar2315_rst_reg_read(u32 reg) | 
|  | { | 
|  | return __raw_readl(ar2315_rst_base + reg); | 
|  | } | 
|  |  | 
|  | static inline void ar2315_rst_reg_write(u32 reg, u32 val) | 
|  | { | 
|  | __raw_writel(val, ar2315_rst_base + reg); | 
|  | } | 
|  |  | 
|  | static inline void ar2315_rst_reg_mask(u32 reg, u32 mask, u32 val) | 
|  | { | 
|  | u32 ret = ar2315_rst_reg_read(reg); | 
|  |  | 
|  | ret &= ~mask; | 
|  | ret |= val; | 
|  | ar2315_rst_reg_write(reg, ret); | 
|  | } | 
|  |  | 
|  | static irqreturn_t ar2315_ahb_err_handler(int cpl, void *dev_id) | 
|  | { | 
|  | ar2315_rst_reg_write(AR2315_AHB_ERR0, AR2315_AHB_ERROR_DET); | 
|  | ar2315_rst_reg_read(AR2315_AHB_ERR1); | 
|  |  | 
|  | pr_emerg("AHB fatal error\n"); | 
|  | machine_restart("AHB error"); /* Catastrophic failure */ | 
|  |  | 
|  | return IRQ_HANDLED; | 
|  | } | 
|  |  | 
|  | static void ar2315_misc_irq_handler(struct irq_desc *desc) | 
|  | { | 
|  | u32 pending = ar2315_rst_reg_read(AR2315_ISR) & | 
|  | ar2315_rst_reg_read(AR2315_IMR); | 
|  | unsigned nr; | 
|  | int ret = 0; | 
|  |  | 
|  | if (pending) { | 
|  | struct irq_domain *domain = irq_desc_get_handler_data(desc); | 
|  |  | 
|  | nr = __ffs(pending); | 
|  |  | 
|  | if (nr == AR2315_MISC_IRQ_GPIO) | 
|  | ar2315_rst_reg_write(AR2315_ISR, AR2315_ISR_GPIO); | 
|  | else if (nr == AR2315_MISC_IRQ_WATCHDOG) | 
|  | ar2315_rst_reg_write(AR2315_ISR, AR2315_ISR_WD); | 
|  |  | 
|  | ret = generic_handle_domain_irq(domain, nr); | 
|  | } | 
|  |  | 
|  | if (!pending || ret) | 
|  | spurious_interrupt(); | 
|  | } | 
|  |  | 
|  | static void ar2315_misc_irq_unmask(struct irq_data *d) | 
|  | { | 
|  | ar2315_rst_reg_mask(AR2315_IMR, 0, BIT(d->hwirq)); | 
|  | } | 
|  |  | 
|  | static void ar2315_misc_irq_mask(struct irq_data *d) | 
|  | { | 
|  | ar2315_rst_reg_mask(AR2315_IMR, BIT(d->hwirq), 0); | 
|  | } | 
|  |  | 
|  | static struct irq_chip ar2315_misc_irq_chip = { | 
|  | .name		= "ar2315-misc", | 
|  | .irq_unmask	= ar2315_misc_irq_unmask, | 
|  | .irq_mask	= ar2315_misc_irq_mask, | 
|  | }; | 
|  |  | 
|  | static int ar2315_misc_irq_map(struct irq_domain *d, unsigned irq, | 
|  | irq_hw_number_t hw) | 
|  | { | 
|  | irq_set_chip_and_handler(irq, &ar2315_misc_irq_chip, handle_level_irq); | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | static const struct irq_domain_ops ar2315_misc_irq_domain_ops = { | 
|  | .map = ar2315_misc_irq_map, | 
|  | }; | 
|  |  | 
|  | /* | 
|  | * Called when an interrupt is received, this function | 
|  | * determines exactly which interrupt it was, and it | 
|  | * invokes the appropriate handler. | 
|  | * | 
|  | * Implicitly, we also define interrupt priority by | 
|  | * choosing which to dispatch first. | 
|  | */ | 
|  | static void ar2315_irq_dispatch(void) | 
|  | { | 
|  | u32 pending = read_c0_status() & read_c0_cause(); | 
|  |  | 
|  | if (pending & CAUSEF_IP3) | 
|  | do_IRQ(AR2315_IRQ_WLAN0); | 
|  | #ifdef CONFIG_PCI_AR2315 | 
|  | else if (pending & CAUSEF_IP5) | 
|  | do_IRQ(AR2315_IRQ_LCBUS_PCI); | 
|  | #endif | 
|  | else if (pending & CAUSEF_IP2) | 
|  | do_IRQ(AR2315_IRQ_MISC); | 
|  | else if (pending & CAUSEF_IP7) | 
|  | do_IRQ(ATH25_IRQ_CPU_CLOCK); | 
|  | else | 
|  | spurious_interrupt(); | 
|  | } | 
|  |  | 
|  | void __init ar2315_arch_init_irq(void) | 
|  | { | 
|  | struct irq_domain *domain; | 
|  | unsigned irq; | 
|  |  | 
|  | ath25_irq_dispatch = ar2315_irq_dispatch; | 
|  |  | 
|  | domain = irq_domain_create_linear(NULL, AR2315_MISC_IRQ_COUNT, | 
|  | &ar2315_misc_irq_domain_ops, NULL); | 
|  | if (!domain) | 
|  | panic("Failed to add IRQ domain"); | 
|  |  | 
|  | irq = irq_create_mapping(domain, AR2315_MISC_IRQ_AHB); | 
|  | if (request_irq(irq, ar2315_ahb_err_handler, 0, "ar2315-ahb-error", | 
|  | NULL)) | 
|  | pr_err("Failed to register ar2315-ahb-error interrupt\n"); | 
|  |  | 
|  | irq_set_chained_handler_and_data(AR2315_IRQ_MISC, | 
|  | ar2315_misc_irq_handler, domain); | 
|  |  | 
|  | ar2315_misc_irq_domain = domain; | 
|  | } | 
|  |  | 
|  | void __init ar2315_init_devices(void) | 
|  | { | 
|  | /* Find board configuration */ | 
|  | ath25_find_config(AR2315_SPI_READ_BASE, AR2315_SPI_READ_SIZE); | 
|  |  | 
|  | ath25_add_wmac(0, AR2315_WLAN0_BASE, AR2315_IRQ_WLAN0); | 
|  | } | 
|  |  | 
|  | static void ar2315_restart(char *command) | 
|  | { | 
|  | void (*mips_reset_vec)(void) = (void *)0xbfc00000; | 
|  |  | 
|  | local_irq_disable(); | 
|  |  | 
|  | /* try reset the system via reset control */ | 
|  | ar2315_rst_reg_write(AR2315_COLD_RESET, AR2317_RESET_SYSTEM); | 
|  |  | 
|  | /* Cold reset does not work on the AR2315/6, use the GPIO reset bits | 
|  | * a workaround. Give it some time to attempt a gpio based hardware | 
|  | * reset (atheros reference design workaround) */ | 
|  |  | 
|  | /* TODO: implement the GPIO reset workaround */ | 
|  |  | 
|  | /* Some boards (e.g. Senao EOC-2610) don't implement the reset logic | 
|  | * workaround. Attempt to jump to the mips reset location - | 
|  | * the boot loader itself might be able to recover the system */ | 
|  | mips_reset_vec(); | 
|  | } | 
|  |  | 
|  | /* | 
|  | * This table is indexed by bits 5..4 of the CLOCKCTL1 register | 
|  | * to determine the predevisor value. | 
|  | */ | 
|  | static int clockctl1_predivide_table[4] __initdata = { 1, 2, 4, 5 }; | 
|  | static int pllc_divide_table[5] __initdata = { 2, 3, 4, 6, 3 }; | 
|  |  | 
|  | static unsigned __init ar2315_sys_clk(u32 clock_ctl) | 
|  | { | 
|  | unsigned int pllc_ctrl, cpu_div; | 
|  | unsigned int pllc_out, refdiv, fdiv, divby2; | 
|  | unsigned int clk_div; | 
|  |  | 
|  | pllc_ctrl = ar2315_rst_reg_read(AR2315_PLLC_CTL); | 
|  | refdiv = ATH25_REG_MS(pllc_ctrl, AR2315_PLLC_REF_DIV); | 
|  | refdiv = clockctl1_predivide_table[refdiv]; | 
|  | fdiv = ATH25_REG_MS(pllc_ctrl, AR2315_PLLC_FDBACK_DIV); | 
|  | divby2 = ATH25_REG_MS(pllc_ctrl, AR2315_PLLC_ADD_FDBACK_DIV) + 1; | 
|  | pllc_out = (40000000 / refdiv) * (2 * divby2) * fdiv; | 
|  |  | 
|  | /* clkm input selected */ | 
|  | switch (clock_ctl & AR2315_CPUCLK_CLK_SEL_M) { | 
|  | case 0: | 
|  | case 1: | 
|  | clk_div = ATH25_REG_MS(pllc_ctrl, AR2315_PLLC_CLKM_DIV); | 
|  | clk_div = pllc_divide_table[clk_div]; | 
|  | break; | 
|  | case 2: | 
|  | clk_div = ATH25_REG_MS(pllc_ctrl, AR2315_PLLC_CLKC_DIV); | 
|  | clk_div = pllc_divide_table[clk_div]; | 
|  | break; | 
|  | default: | 
|  | pllc_out = 40000000; | 
|  | clk_div = 1; | 
|  | break; | 
|  | } | 
|  |  | 
|  | cpu_div = ATH25_REG_MS(clock_ctl, AR2315_CPUCLK_CLK_DIV); | 
|  | cpu_div = cpu_div * 2 ?: 1; | 
|  |  | 
|  | return pllc_out / (clk_div * cpu_div); | 
|  | } | 
|  |  | 
|  | static inline unsigned ar2315_cpu_frequency(void) | 
|  | { | 
|  | return ar2315_sys_clk(ar2315_rst_reg_read(AR2315_CPUCLK)); | 
|  | } | 
|  |  | 
|  | static inline unsigned ar2315_apb_frequency(void) | 
|  | { | 
|  | return ar2315_sys_clk(ar2315_rst_reg_read(AR2315_AMBACLK)); | 
|  | } | 
|  |  | 
|  | void __init ar2315_plat_time_init(void) | 
|  | { | 
|  | mips_hpt_frequency = ar2315_cpu_frequency() / 2; | 
|  | } | 
|  |  | 
|  | void __init ar2315_plat_mem_setup(void) | 
|  | { | 
|  | void __iomem *sdram_base; | 
|  | u32 memsize, memcfg; | 
|  | u32 devid; | 
|  | u32 config; | 
|  |  | 
|  | /* Detect memory size */ | 
|  | sdram_base = ioremap(AR2315_SDRAMCTL_BASE, | 
|  | AR2315_SDRAMCTL_SIZE); | 
|  | memcfg = __raw_readl(sdram_base + AR2315_MEM_CFG); | 
|  | memsize   = 1 + ATH25_REG_MS(memcfg, AR2315_MEM_CFG_DATA_WIDTH); | 
|  | memsize <<= 1 + ATH25_REG_MS(memcfg, AR2315_MEM_CFG_COL_WIDTH); | 
|  | memsize <<= 1 + ATH25_REG_MS(memcfg, AR2315_MEM_CFG_ROW_WIDTH); | 
|  | memsize <<= 3; | 
|  | memblock_add(0, memsize); | 
|  | iounmap(sdram_base); | 
|  |  | 
|  | ar2315_rst_base = ioremap(AR2315_RST_BASE, AR2315_RST_SIZE); | 
|  |  | 
|  | /* Detect the hardware based on the device ID */ | 
|  | devid = ar2315_rst_reg_read(AR2315_SREV) & AR2315_REV_CHIP; | 
|  | switch (devid) { | 
|  | case 0x91:	/* Need to check */ | 
|  | ath25_soc = ATH25_SOC_AR2318; | 
|  | break; | 
|  | case 0x90: | 
|  | ath25_soc = ATH25_SOC_AR2317; | 
|  | break; | 
|  | case 0x87: | 
|  | ath25_soc = ATH25_SOC_AR2316; | 
|  | break; | 
|  | case 0x86: | 
|  | default: | 
|  | ath25_soc = ATH25_SOC_AR2315; | 
|  | break; | 
|  | } | 
|  | ath25_board.devid = devid; | 
|  |  | 
|  | /* Clear any lingering AHB errors */ | 
|  | config = read_c0_config(); | 
|  | write_c0_config(config & ~0x3); | 
|  | ar2315_rst_reg_write(AR2315_AHB_ERR0, AR2315_AHB_ERROR_DET); | 
|  | ar2315_rst_reg_read(AR2315_AHB_ERR1); | 
|  | ar2315_rst_reg_write(AR2315_WDT_CTRL, AR2315_WDT_CTRL_IGNORE); | 
|  |  | 
|  | _machine_restart = ar2315_restart; | 
|  | } | 
|  |  | 
|  | #ifdef CONFIG_PCI_AR2315 | 
|  | static struct resource ar2315_pci_res[] = { | 
|  | { | 
|  | .name = "ar2315-pci-ctrl", | 
|  | .flags = IORESOURCE_MEM, | 
|  | .start = AR2315_PCI_BASE, | 
|  | .end = AR2315_PCI_BASE + AR2315_PCI_SIZE - 1, | 
|  | }, | 
|  | { | 
|  | .name = "ar2315-pci-ext", | 
|  | .flags = IORESOURCE_MEM, | 
|  | .start = AR2315_PCI_EXT_BASE, | 
|  | .end = AR2315_PCI_EXT_BASE + AR2315_PCI_EXT_SIZE - 1, | 
|  | }, | 
|  | { | 
|  | .name = "ar2315-pci", | 
|  | .flags = IORESOURCE_IRQ, | 
|  | .start = AR2315_IRQ_LCBUS_PCI, | 
|  | .end = AR2315_IRQ_LCBUS_PCI, | 
|  | }, | 
|  | }; | 
|  | #endif | 
|  |  | 
|  | void __init ar2315_arch_init(void) | 
|  | { | 
|  | unsigned irq = irq_create_mapping(ar2315_misc_irq_domain, | 
|  | AR2315_MISC_IRQ_UART0); | 
|  |  | 
|  | ath25_serial_setup(AR2315_UART0_BASE, irq, ar2315_apb_frequency()); | 
|  |  | 
|  | #ifdef CONFIG_PCI_AR2315 | 
|  | if (ath25_soc == ATH25_SOC_AR2315) { | 
|  | /* Reset PCI DMA logic */ | 
|  | ar2315_rst_reg_mask(AR2315_RESET, 0, AR2315_RESET_PCIDMA); | 
|  | msleep(20); | 
|  | ar2315_rst_reg_mask(AR2315_RESET, AR2315_RESET_PCIDMA, 0); | 
|  | msleep(20); | 
|  |  | 
|  | /* Configure endians */ | 
|  | ar2315_rst_reg_mask(AR2315_ENDIAN_CTL, 0, AR2315_CONFIG_PCIAHB | | 
|  | AR2315_CONFIG_PCIAHB_BRIDGE); | 
|  |  | 
|  | /* Configure as PCI host with DMA */ | 
|  | ar2315_rst_reg_write(AR2315_PCICLK, AR2315_PCICLK_PLLC_CLKM | | 
|  | (AR2315_PCICLK_IN_FREQ_DIV_6 << | 
|  | AR2315_PCICLK_DIV_S)); | 
|  | ar2315_rst_reg_mask(AR2315_AHB_ARB_CTL, 0, AR2315_ARB_PCI); | 
|  | ar2315_rst_reg_mask(AR2315_IF_CTL, AR2315_IF_PCI_CLK_MASK | | 
|  | AR2315_IF_MASK, AR2315_IF_PCI | | 
|  | AR2315_IF_PCI_HOST | AR2315_IF_PCI_INTR | | 
|  | (AR2315_IF_PCI_CLK_OUTPUT_CLK << | 
|  | AR2315_IF_PCI_CLK_SHIFT)); | 
|  |  | 
|  | platform_device_register_simple("ar2315-pci", -1, | 
|  | ar2315_pci_res, | 
|  | ARRAY_SIZE(ar2315_pci_res)); | 
|  | } | 
|  | #endif | 
|  | } |