mirror of
https://github.com/edk2-porting/linux-next.git
synced 2024-12-25 21:54:06 +08:00
43659222e7
It's no good setting vga_base after the VGA console has been
initialised, because if we do that we get this:
Unable to handle kernel paging request at virtual address 000b8000
pgd = c0004000
[000b8000] *pgd=07ffc831, *pte=00000000, *ppte=00000000
0Internal error: Oops: 5017 [#1] ARM
Modules linked in:
CPU: 0 PID: 0 Comm: swapper Not tainted 3.12.0+ #49
task: c03e2974 ti: c03d8000 task.ti: c03d8000
PC is at vgacon_startup+0x258/0x39c
LR is at request_resource+0x10/0x1c
pc : [<c01725d0>] lr : [<c0022b50>] psr: 60000053
sp : c03d9f68 ip : 000b8000 fp : c03d9f8c
r10: 000055aa r9 : 4401a103 r8 : ffffaa55
r7 : c03e357c r6 : c051b460 r5 : 000000ff r4 : 000c0000
r3 : 000b8000 r2 : c03e0514 r1 : 00000000 r0 : c0304971
Flags: nZCv IRQs on FIQs off Mode SVC_32 ISA ARM Segment kernel
which is an access to the 0xb8000 without the PCI offset required to
make it work.
Fixes: cc22b4c185
("ARM: set vga memory base at run-time")
Signed-off-by: Russell King <rmk+kernel@arm.linux.org.uk>
Cc: <stable@vger.kernel.org>
274 lines
6.4 KiB
C
274 lines
6.4 KiB
C
/*
|
|
* linux/arch/arm/mach-footbridge/common.c
|
|
*
|
|
* Copyright (C) 1998-2000 Russell King, Dave Gilbert.
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License version 2 as
|
|
* published by the Free Software Foundation.
|
|
*/
|
|
#include <linux/module.h>
|
|
#include <linux/types.h>
|
|
#include <linux/mm.h>
|
|
#include <linux/ioport.h>
|
|
#include <linux/list.h>
|
|
#include <linux/init.h>
|
|
#include <linux/io.h>
|
|
#include <linux/spinlock.h>
|
|
#include <video/vga.h>
|
|
|
|
#include <asm/pgtable.h>
|
|
#include <asm/page.h>
|
|
#include <asm/irq.h>
|
|
#include <asm/mach-types.h>
|
|
#include <asm/setup.h>
|
|
#include <asm/system_misc.h>
|
|
#include <asm/hardware/dec21285.h>
|
|
|
|
#include <asm/mach/irq.h>
|
|
#include <asm/mach/map.h>
|
|
#include <asm/mach/pci.h>
|
|
|
|
#include "common.h"
|
|
|
|
unsigned int mem_fclk_21285 = 50000000;
|
|
|
|
EXPORT_SYMBOL(mem_fclk_21285);
|
|
|
|
static int __init early_fclk(char *arg)
|
|
{
|
|
mem_fclk_21285 = simple_strtoul(arg, NULL, 0);
|
|
return 0;
|
|
}
|
|
|
|
early_param("mem_fclk_21285", early_fclk);
|
|
|
|
static int __init parse_tag_memclk(const struct tag *tag)
|
|
{
|
|
mem_fclk_21285 = tag->u.memclk.fmemclk;
|
|
return 0;
|
|
}
|
|
|
|
__tagtable(ATAG_MEMCLK, parse_tag_memclk);
|
|
|
|
/*
|
|
* Footbridge IRQ translation table
|
|
* Converts from our IRQ numbers into FootBridge masks
|
|
*/
|
|
static const int fb_irq_mask[] = {
|
|
IRQ_MASK_UART_RX, /* 0 */
|
|
IRQ_MASK_UART_TX, /* 1 */
|
|
IRQ_MASK_TIMER1, /* 2 */
|
|
IRQ_MASK_TIMER2, /* 3 */
|
|
IRQ_MASK_TIMER3, /* 4 */
|
|
IRQ_MASK_IN0, /* 5 */
|
|
IRQ_MASK_IN1, /* 6 */
|
|
IRQ_MASK_IN2, /* 7 */
|
|
IRQ_MASK_IN3, /* 8 */
|
|
IRQ_MASK_DOORBELLHOST, /* 9 */
|
|
IRQ_MASK_DMA1, /* 10 */
|
|
IRQ_MASK_DMA2, /* 11 */
|
|
IRQ_MASK_PCI, /* 12 */
|
|
IRQ_MASK_SDRAMPARITY, /* 13 */
|
|
IRQ_MASK_I2OINPOST, /* 14 */
|
|
IRQ_MASK_PCI_ABORT, /* 15 */
|
|
IRQ_MASK_PCI_SERR, /* 16 */
|
|
IRQ_MASK_DISCARD_TIMER, /* 17 */
|
|
IRQ_MASK_PCI_DPERR, /* 18 */
|
|
IRQ_MASK_PCI_PERR, /* 19 */
|
|
};
|
|
|
|
static void fb_mask_irq(struct irq_data *d)
|
|
{
|
|
*CSR_IRQ_DISABLE = fb_irq_mask[_DC21285_INR(d->irq)];
|
|
}
|
|
|
|
static void fb_unmask_irq(struct irq_data *d)
|
|
{
|
|
*CSR_IRQ_ENABLE = fb_irq_mask[_DC21285_INR(d->irq)];
|
|
}
|
|
|
|
static struct irq_chip fb_chip = {
|
|
.irq_ack = fb_mask_irq,
|
|
.irq_mask = fb_mask_irq,
|
|
.irq_unmask = fb_unmask_irq,
|
|
};
|
|
|
|
static void __init __fb_init_irq(void)
|
|
{
|
|
unsigned int irq;
|
|
|
|
/*
|
|
* setup DC21285 IRQs
|
|
*/
|
|
*CSR_IRQ_DISABLE = -1;
|
|
*CSR_FIQ_DISABLE = -1;
|
|
|
|
for (irq = _DC21285_IRQ(0); irq < _DC21285_IRQ(20); irq++) {
|
|
irq_set_chip_and_handler(irq, &fb_chip, handle_level_irq);
|
|
set_irq_flags(irq, IRQF_VALID | IRQF_PROBE);
|
|
}
|
|
}
|
|
|
|
void __init footbridge_init_irq(void)
|
|
{
|
|
__fb_init_irq();
|
|
|
|
if (!footbridge_cfn_mode())
|
|
return;
|
|
|
|
if (machine_is_ebsa285())
|
|
/* The following is dependent on which slot
|
|
* you plug the Southbridge card into. We
|
|
* currently assume that you plug it into
|
|
* the right-hand most slot.
|
|
*/
|
|
isa_init_irq(IRQ_PCI);
|
|
|
|
if (machine_is_cats())
|
|
isa_init_irq(IRQ_IN2);
|
|
|
|
if (machine_is_netwinder())
|
|
isa_init_irq(IRQ_IN3);
|
|
}
|
|
|
|
/*
|
|
* Common mapping for all systems. Note that the outbound write flush is
|
|
* commented out since there is a "No Fix" problem with it. Not mapping
|
|
* it means that we have extra bullet protection on our feet.
|
|
*/
|
|
static struct map_desc fb_common_io_desc[] __initdata = {
|
|
{
|
|
.virtual = ARMCSR_BASE,
|
|
.pfn = __phys_to_pfn(DC21285_ARMCSR_BASE),
|
|
.length = ARMCSR_SIZE,
|
|
.type = MT_DEVICE,
|
|
}, {
|
|
.virtual = XBUS_BASE,
|
|
.pfn = __phys_to_pfn(0x40000000),
|
|
.length = XBUS_SIZE,
|
|
.type = MT_DEVICE,
|
|
}
|
|
};
|
|
|
|
/*
|
|
* The mapping when the footbridge is in host mode. We don't map any of
|
|
* this when we are in add-in mode.
|
|
*/
|
|
static struct map_desc ebsa285_host_io_desc[] __initdata = {
|
|
#if defined(CONFIG_ARCH_FOOTBRIDGE) && defined(CONFIG_FOOTBRIDGE_HOST)
|
|
{
|
|
.virtual = PCIMEM_BASE,
|
|
.pfn = __phys_to_pfn(DC21285_PCI_MEM),
|
|
.length = PCIMEM_SIZE,
|
|
.type = MT_DEVICE,
|
|
}, {
|
|
.virtual = PCICFG0_BASE,
|
|
.pfn = __phys_to_pfn(DC21285_PCI_TYPE_0_CONFIG),
|
|
.length = PCICFG0_SIZE,
|
|
.type = MT_DEVICE,
|
|
}, {
|
|
.virtual = PCICFG1_BASE,
|
|
.pfn = __phys_to_pfn(DC21285_PCI_TYPE_1_CONFIG),
|
|
.length = PCICFG1_SIZE,
|
|
.type = MT_DEVICE,
|
|
}, {
|
|
.virtual = PCIIACK_BASE,
|
|
.pfn = __phys_to_pfn(DC21285_PCI_IACK),
|
|
.length = PCIIACK_SIZE,
|
|
.type = MT_DEVICE,
|
|
},
|
|
#endif
|
|
};
|
|
|
|
void __init footbridge_map_io(void)
|
|
{
|
|
/*
|
|
* Set up the common mapping first; we need this to
|
|
* determine whether we're in host mode or not.
|
|
*/
|
|
iotable_init(fb_common_io_desc, ARRAY_SIZE(fb_common_io_desc));
|
|
|
|
/*
|
|
* Now, work out what we've got to map in addition on this
|
|
* platform.
|
|
*/
|
|
if (footbridge_cfn_mode()) {
|
|
iotable_init(ebsa285_host_io_desc, ARRAY_SIZE(ebsa285_host_io_desc));
|
|
pci_map_io_early(__phys_to_pfn(DC21285_PCI_IO));
|
|
}
|
|
|
|
vga_base = PCIMEM_BASE;
|
|
}
|
|
|
|
void footbridge_restart(enum reboot_mode mode, const char *cmd)
|
|
{
|
|
if (mode == REBOOT_SOFT) {
|
|
/* Jump into the ROM */
|
|
soft_restart(0x41000000);
|
|
} else {
|
|
/*
|
|
* Force the watchdog to do a CPU reset.
|
|
*
|
|
* After making sure that the watchdog is disabled
|
|
* (so we can change the timer registers) we first
|
|
* enable the timer to autoreload itself. Next, the
|
|
* timer interval is set really short and any
|
|
* current interrupt request is cleared (so we can
|
|
* see an edge transition). Finally, TIMER4 is
|
|
* enabled as the watchdog.
|
|
*/
|
|
*CSR_SA110_CNTL &= ~(1 << 13);
|
|
*CSR_TIMER4_CNTL = TIMER_CNTL_ENABLE |
|
|
TIMER_CNTL_AUTORELOAD |
|
|
TIMER_CNTL_DIV16;
|
|
*CSR_TIMER4_LOAD = 0x2;
|
|
*CSR_TIMER4_CLR = 0;
|
|
*CSR_SA110_CNTL |= (1 << 13);
|
|
}
|
|
}
|
|
|
|
#ifdef CONFIG_FOOTBRIDGE_ADDIN
|
|
|
|
static inline unsigned long fb_bus_sdram_offset(void)
|
|
{
|
|
return *CSR_PCISDRAMBASE & 0xfffffff0;
|
|
}
|
|
|
|
/*
|
|
* These two functions convert virtual addresses to PCI addresses and PCI
|
|
* addresses to virtual addresses. Note that it is only legal to use these
|
|
* on memory obtained via get_zeroed_page or kmalloc.
|
|
*/
|
|
unsigned long __virt_to_bus(unsigned long res)
|
|
{
|
|
WARN_ON(res < PAGE_OFFSET || res >= (unsigned long)high_memory);
|
|
|
|
return res + (fb_bus_sdram_offset() - PAGE_OFFSET);
|
|
}
|
|
EXPORT_SYMBOL(__virt_to_bus);
|
|
|
|
unsigned long __bus_to_virt(unsigned long res)
|
|
{
|
|
res = res - (fb_bus_sdram_offset() - PAGE_OFFSET);
|
|
|
|
WARN_ON(res < PAGE_OFFSET || res >= (unsigned long)high_memory);
|
|
|
|
return res;
|
|
}
|
|
EXPORT_SYMBOL(__bus_to_virt);
|
|
|
|
unsigned long __pfn_to_bus(unsigned long pfn)
|
|
{
|
|
return __pfn_to_phys(pfn) + (fb_bus_sdram_offset() - PHYS_OFFSET);
|
|
}
|
|
EXPORT_SYMBOL(__pfn_to_bus);
|
|
|
|
unsigned long __bus_to_pfn(unsigned long bus)
|
|
{
|
|
return __phys_to_pfn(bus - (fb_bus_sdram_offset() - PHYS_OFFSET));
|
|
}
|
|
EXPORT_SYMBOL(__bus_to_pfn);
|
|
|
|
#endif
|