Merge branch 'master' of git://git.denx.de/u-boot-imx

[karo-tx-uboot.git] / board / eNET / eNET.c

diff --git a/board/eNET/eNET.c b/board/eNET/eNET.c
index 62f99ce94dbcd5be00e33846e4027300d6dfbafe..7f0e2577f1bf1d4537cddb0cdd39c8cef17b21e3 100644 (file)
--- a/board/eNET/eNET.c
+++ b/board/eNET/eNET.c
@@ -45,6 +45,9 @@ DECLARE_GLOBAL_DATA_PTR;
 
 unsigned long monitor_flash_len = CONFIG_SYS_MONITOR_LEN;
 
+static void enet_timer_isr(void);
+static void enet_toggle_run_led(void);
+
 void init_sc520_enet (void)
 {
        /* Set CPU Speed to 100MHz */
@@ -160,6 +163,10 @@ int last_stage_init(void)
 
        major = minor = 0;
 
+       outb(0x00, LED_LATCH_ADDRESS);
+
+       register_timer_isr (enet_timer_isr);
+
        printf("Serck Controls eNET\n");
 
        return 0;
@@ -180,3 +187,79 @@ int board_eth_init(bd_t *bis)
 {
        return pci_eth_init(bis);
 }
+
+void setup_pcat_compatibility()
+{
+       /* disable global interrupt mode */
+       writeb(0x40, &sc520_mmcr->picicr);
+
+       /* set all irqs to edge */
+       writeb(0x00, &sc520_mmcr->pic_mode[0]);
+       writeb(0x00, &sc520_mmcr->pic_mode[1]);
+       writeb(0x00, &sc520_mmcr->pic_mode[2]);
+
+       /*
+        *  active low polarity on PIC interrupt pins,
+        *  active high polarity on all other irq pins
+        */
+       writew(0x0000,&sc520_mmcr->intpinpol);
+
+       /* Set PIT 0 -> IRQ0, RTC -> IRQ8, FP error -> IRQ13 */
+       writeb(SC520_IRQ0, &sc520_mmcr->pit_int_map[0]);
+       writeb(SC520_IRQ8, &sc520_mmcr->rtcmap);
+       writeb(SC520_IRQ13, &sc520_mmcr->ferrmap);
+
+       /* Disable all other interrupt sources */
+       writeb(SC520_IRQ_DISABLED, &sc520_mmcr->gp_tmr_int_map[0]);
+       writeb(SC520_IRQ_DISABLED, &sc520_mmcr->gp_tmr_int_map[1]);
+       writeb(SC520_IRQ_DISABLED, &sc520_mmcr->gp_tmr_int_map[2]);
+       writeb(SC520_IRQ_DISABLED, &sc520_mmcr->pit_int_map[1]);
+       writeb(SC520_IRQ_DISABLED, &sc520_mmcr->pit_int_map[2]);
+       writeb(SC520_IRQ_DISABLED, &sc520_mmcr->pci_int_map[0]);        /* disable PCI INT A */
+       writeb(SC520_IRQ_DISABLED, &sc520_mmcr->pci_int_map[1]);        /* disable PCI INT B */
+       writeb(SC520_IRQ_DISABLED, &sc520_mmcr->pci_int_map[2]);        /* disable PCI INT C */
+       writeb(SC520_IRQ_DISABLED, &sc520_mmcr->pci_int_map[3]);        /* disable PCI INT D */
+       writeb(SC520_IRQ_DISABLED, &sc520_mmcr->dmabcintmap);           /* disable DMA INT */
+       writeb(SC520_IRQ_DISABLED, &sc520_mmcr->ssimap);
+       writeb(SC520_IRQ_DISABLED, &sc520_mmcr->wdtmap);
+       writeb(SC520_IRQ_DISABLED, &sc520_mmcr->wpvmap);
+       writeb(SC520_IRQ_DISABLED, &sc520_mmcr->icemap);
+}
+
+void enet_timer_isr(void)
+{
+       static long enet_ticks = 0;
+
+       enet_ticks++;
+
+       /* Toggle Watchdog every 100ms */
+       if ((enet_ticks % 100) == 0)
+               hw_watchdog_reset();
+
+       /* Toggle Run LED every 500ms */
+       if ((enet_ticks % 500) == 0)
+               enet_toggle_run_led();
+}
+
+void hw_watchdog_reset(void)
+{
+       /* Watchdog Reset must be atomic */
+       long flag = disable_interrupts();
+
+       if (sc520_mmcr->piodata15_0 & WATCHDOG_PIO_BIT)
+               sc520_mmcr->pioclr15_0 = WATCHDOG_PIO_BIT;
+       else
+               sc520_mmcr->pioset15_0 = WATCHDOG_PIO_BIT;
+
+       if (flag)
+               enable_interrupts();
+}
+
+void enet_toggle_run_led(void)
+{
+       unsigned char leds_state= inb(LED_LATCH_ADDRESS);
+       if (leds_state & LED_RUN_BITMASK)
+               outb(leds_state &~ LED_RUN_BITMASK, LED_LATCH_ADDRESS);
+       else
+               outb(leds_state | LED_RUN_BITMASK, LED_LATCH_ADDRESS);
+}