vserver 1.9.5.x5

[linux-2.6.git] / arch / arm / mach-shark / core.c

diff --git a/arch/arm/mach-shark/core.c b/arch/arm/mach-shark/core.c
index fed8a03..a9bc5d0 100644 (file)
--- a/arch/arm/mach-shark/core.c
+++ b/arch/arm/mach-shark/core.c
@@ -5,13 +5,59 @@
  */
 #include <linux/kernel.h>
 #include <linux/init.h>
+#include <linux/interrupt.h>
+#include <linux/sched.h>
+#include <linux/serial_8250.h>
 
 #include <asm/setup.h>
 #include <asm/mach-types.h>
 #include <asm/io.h>
+#include <asm/leds.h>
+#include <asm/param.h>
 
 #include <asm/mach/map.h>
 #include <asm/mach/arch.h>
+#include <asm/mach/time.h>
+
+static struct plat_serial8250_port serial_platform_data[] = {
+       {
+               .iobase         = 0x3f8,
+               .irq            = 4,
+               .uartclk        = 1843200,
+               .regshift       = 2,
+               .iotype         = UPIO_PORT,
+               .flags          = UPF_BOOT_AUTOCONF | UPF_SKIP_TEST,
+       },
+       {
+               .iobase         = 0x2f8,
+               .irq            = 3,
+               .uartclk        = 1843200,
+               .regshift       = 2,
+               .iotype         = UPIO_PORT,
+               .flags          = UPF_BOOT_AUTOCONF | UPF_SKIP_TEST,
+       },
+       { },
+};
+
+static struct platform_device serial_device = {
+       .name                   = "serial8250",
+       .id                     = 0,
+       .dev                    = {
+               .platform_data  = serial_platform_data,
+       },
+};
+
+static int __init shark_init(void)
+{
+       int ret;
+
+       if (machine_is_shark())
+               ret = platform_device_register(&serial_device);
+
+       return ret;
+}
+
+arch_initcall(shark_init);
 
 extern void shark_init_irq(void);
 
@@ -24,10 +70,45 @@ static void __init shark_map_io(void)
        iotable_init(shark_io_desc, ARRAY_SIZE(shark_io_desc));
 }
 
+#define IRQ_TIMER 0
+#define HZ_TIME ((1193180 + HZ/2) / HZ)
+
+static irqreturn_t
+shark_timer_interrupt(int irq, void *dev_id, struct pt_regs *regs)
+{
+       write_seqlock(&xtime_lock);
+       timer_tick(regs);
+       write_sequnlock(&xtime_lock);
+       return IRQ_HANDLED;
+}
+
+static struct irqaction shark_timer_irq = {
+       .name           = "Shark Timer Tick",
+       .flags          = SA_INTERRUPT,
+       .handler        = shark_timer_interrupt
+};
+
+/*
+ * Set up timer interrupt, and return the current time in seconds.
+ */
+static void __init shark_timer_init(void)
+{
+       outb(0x34, 0x43);               /* binary, mode 0, LSB/MSB, Ch 0 */
+       outb(HZ_TIME & 0xff, 0x40);     /* LSB of count */
+       outb(HZ_TIME >> 8, 0x40);
+
+       setup_irq(IRQ_TIMER, &shark_timer_irq);
+}
+
+static struct sys_timer shark_timer = {
+       .init           = shark_timer_init,
+};
+
 MACHINE_START(SHARK, "Shark")
        MAINTAINER("Alexander Schulz")
        BOOT_MEM(0x08000000, 0x40000000, 0xe0000000)
        BOOT_PARAMS(0x08003000)
        MAPIO(shark_map_io)
        INITIRQ(shark_init_irq)
+       .timer          = &shark_timer,
 MACHINE_END