Bonito3aserver irq add wdt process.

Change-Id: I5a66cf5b231551b6979e8a39196742928663f6f7
Signed-off-by: QiaoChong <qiaochong@loongson.cn>

Targets/Bonito3aserver/dev/irq.c

@@ -8,6 +8,45 @@
 #define CAUSEF_IP4      ( 1 << 12)                                                                                                                     
 #define CAUSEF_IP3      ( 1 << 11)
 #define CAUSEF_IP2      ( 1 << 10)
+
+static int wdt_enable()
+{
+int d = *(volatile int *)0xbfe0011c;
+int oe= *(volatile int *)0xbfe00120;
+d=(d&~0x2000)|0x38;
+oe=oe&~0x2038;
+*(volatile int *)0xbfe0011c = d;
+*(volatile int *)0xbfe00120 = oe;
+return 0;
+}
+
+static int wdt_disable()
+{
+int d = *(volatile int *)0xbfe0011c;
+int oe= *(volatile int *)0xbfe00120;
+d=(d|0x2008)&~0x30;
+oe=oe&~0x2038;
+
+*(volatile int *)0xbfe0011c = d;
+*(volatile int *)0xbfe00120 = oe;
+return 0;
+}
+
+static int wdt_feed()
+{
+int d = *(volatile int *)0xbfe0011c;
+int oe= *(volatile int *)0xbfe00120;
+int d0, d1;
+oe=oe&~0x2038;
+d0=d&~(1<<14);
+d1=d|(1<<14);
+*(volatile int *)0xbfe0011c = d0;
+*(volatile int *)0xbfe00120 = oe;
+*(volatile int *)0xbfe0011c = d1;
+}
+
+#define IRQ_HZ 4
+
 void plat_irq_dispatch(struct trapframe *frame)
 {
         unsigned int cause = read_c0_cause() & ST0_IM;
@@ -16,8 +55,10 @@ void plat_irq_dispatch(struct trapframe *frame)
         if(pending & CAUSEF_IP7)
         {
 		static int cnt=0;
-		printf("cnt %d\n",cnt++);
-		write_c0_compare(read_c0_count()+100000000/100);
+		//tgt_printf("cnt %d\n",cnt++);
+		write_c0_compare(read_c0_count()+400000000/IRQ_HZ);
+		if(cnt<60*IRQ_HZ)
+			wdt_feed();
         }
         else
         {
@@ -29,8 +70,15 @@ void plat_irq_dispatch(struct trapframe *frame)
 
 void init_IRQ()
 {
-	write_c0_compare(100000000/100);
+	write_c0_compare(400000000/4);
 	write_c0_count(0);
 	set_c0_status(0x8001);
+	wdt_enable();
+}
+
+void uninit_IRQ()
+{
+	clear_c0_status(0x8001);
+	wdt_disable();
 }