Add realtek target files

Signed-off-by: Roman Yeryomin <roman@advem.lv>

1 files changed, 187 insertions, 0 deletions

diff --git a/target/linux/realtek/files/arch/mips/kernel/cevt-rtl819x.c b/target/linux/realtek/files/arch/mips/kernel/cevt-rtl819x.c
new file mode 100644
index 000000000..102eb6dbd
--- /dev/null
+++ b/target/linux/realtek/files/arch/mips/kernel/cevt-rtl819x.c
@@ -0,0 +1,187 @@
+#include <linux/clockchips.h>

+#include <linux/init.h>

+#include <linux/interrupt.h>

+

+#include <asm/time.h>

+#include <platform.h>

+

+#if defined(CONFIG_RTL_WTDOG)

+	int is_fault=0; // kernel fault flag

+#endif

+

+#ifdef CONFIG_RTL_TIMER_ADJUSTMENT

+#define TIMER0_ADJUSTMENT_THRESHOLD 20

+

+

+//static unsigned long tuRemainder=0;   /* unit is the same as TC0DATA, say "timer unit". */

+static unsigned long tuRemainder=0;

+static unsigned long previousTC1CNT=0xFFFFFF00; /* Previous value of Timer 1 */

+static u64 timer0AccJiffies=0;

+static u64 timer1AccJiffies=0; /* accumulated jiffies, unit is the same as jiffies, 1/HZ. */

+static unsigned int timer0IntCnt=0;

+#define TICK_SIZE	(tick_nsec / 1000)

+

+unsigned long rtl865x_getTimer1PassedJiffies(void)

+{

+	unsigned long jifPassed=0;

+	unsigned long currTC1CNT;

+	unsigned long tc0data;

+

+	//tc0data = READ_MEM32(TC0DATA)>>TCD_OFFSET;

+	tc0data =((MHZ * 250) / HZ);

+	/* compute passed time since last time executed this function */

+	currTC1CNT = READ_MEM32(TC1CNT);

+

+#if defined(CONFIG_RTL_819X)

+	/*

+		In RTL865xC, timer / counter is incremental

+	*/

+	if ( previousTC1CNT <= currTC1CNT )

+	{

+		/* No wrap happend. */

+		tuRemainder += (currTC1CNT-previousTC1CNT)>>TCD_OFFSET; /* how many units are passed since last check? */

+	}

+	else

+	{

+		/* Timer1 wrapped!! */

+		tuRemainder += (currTC1CNT+(0xffffff00-previousTC1CNT)+(0x1<<TCD_OFFSET))>>TCD_OFFSET; /* how many units are passed since last check? */

+	}

+#endif

+	previousTC1CNT = currTC1CNT; /* keep TC1CNT value for next time check */

+

+	/* If tc0data is zero, it means 'time is frozen.' */

+	if ( tc0data == 0 )

+	{

+		jifPassed = 0;

+	}

+	else

+	{

+		jifPassed = tuRemainder / tc0data;

+		tuRemainder = tuRemainder % tc0data;

+	}

+	

+	timer1AccJiffies += jifPassed;

+ 	return jifPassed;

+}

+#endif

+

+int rlx_timer_state(void)

+{

+  return 0;

+}

+

+int rlx_timer_set_base_clock(unsigned int hz)

+{

+  return 0;

+}

+

+static int rtl_timer_set_next_event(unsigned long delta,

+				 struct clock_event_device *evt)

+{

+  return -EINVAL;

+}

+

+static void rtl_timer_set_mode(enum clock_event_mode mode,

+			    struct clock_event_device *evt)

+{

+  return;

+}

+

+static void rtl_timer_event_handler(struct clock_event_device *dev)

+{

+}

+

+static void rtl_timer_ack(void)

+{
+   REG32(TCIR) |= TC0IP;
+}

+

+static struct clock_event_device rtl819x_clockevent = {

+	.name		= "rtl819x timer",

+	.features	= CLOCK_EVT_FEAT_PERIODIC,

+	.set_next_event	= rtl_timer_set_next_event,

+	.set_mode	= rtl_timer_set_mode,

+	.event_handler	= rtl_timer_event_handler,

+};

+

+static irqreturn_t rtl_timer_interrupt(int irq, void *dev_id)

+{

+	struct clock_event_device *cd = &rtl819x_clockevent;

+

+#if defined(CONFIG_RTL_WTDOG)

+	if (!is_fault) {

+  #ifdef CONFIG_RTK_VOIP

+		extern int bBspWatchdog;

+		

+		if( bBspWatchdog )

+			*(volatile unsigned long *)(0xB800311c) |=  1 << 23;

+		else

+			*(volatile unsigned long *)(0xB800311c) |=  ( ( 1 << 23 ) | ( 0xA5 << 24 ) );

+  #else

+		*(volatile unsigned long *)(0xB800311c) |=  1 << 23;

+  #endif

+	} else {

+		// quick fix for warn reboot fail issue

+		local_irq_disable();	

+		*(volatile unsigned long *)(0xB800311c)=0; /*this is to enable 865xc watch dog reset*/

+		for(;;);

+	}

+#endif

+

+#if defined(CONFIG_RTL_TIMER_ADJUSTMENT)

+	timer0AccJiffies++;

+	timer0IntCnt++;

+	if((timer0IntCnt%TIMER0_ADJUSTMENT_THRESHOLD)==0)

+	{

+		rtl865x_getTimer1PassedJiffies();

+		if(timer1AccJiffies>timer0AccJiffies)

+		{

+			/*to compensate system jiffied, because timer0's interrupt may be disabled by nic driver*/

+			do_timer((timer1AccJiffies-timer0AccJiffies)+1);

+			timer0AccJiffies=timer1AccJiffies;

+		}

+		else

+		{

+			/*for timer1 start later than timer0*/		

+			if(timer1AccJiffies<timer0AccJiffies)

+			{

+				timer1AccJiffies=timer0AccJiffies;

+			}

+			do_timer(1);

+		}

+	}

+	else

+	{

+		do_timer(1);

+	}

+#endif

+

+	/* Ack the RTC interrupt. */

+//printk("====%s(%d),jiffes(%lu)\n",__FUNCTION__,__LINE__,jiffies);

+    	rtl_timer_ack();

+	cd->event_handler(cd);

+	return IRQ_HANDLED;

+}

+

+static struct irqaction rtl_irqaction = {

+	.handler	= rtl_timer_interrupt,

+	.flags		= IRQF_DISABLED | IRQF_PERCPU,

+	.name		= "rtl timer",

+};

+

+int __init rtl_clockevent_init(int irq)

+{

+	struct clock_event_device *cd;

+

+	cd = &rtl819x_clockevent;

+	cd->rating = 100;

+	cd->irq = irq;

+	clockevent_set_clock(cd, 32768);

+	cd->max_delta_ns = clockevent_delta2ns(0x7fffffff, cd);

+	cd->min_delta_ns = clockevent_delta2ns(0x300, cd);

+	cd->cpumask = cpumask_of(0);

+

+	clockevents_register_device(&rtl819x_clockevent);

+

+	return setup_irq(irq, &rtl_irqaction);

+}