From 587e50dc1cfa87ec9e972055ef396cf0cdbd60b3 Mon Sep 17 00:00:00 2001
From: bigmagic <zhaofujin@rt-thread.com>
Date: Wed, 3 Jun 2020 23:58:34 +0800
Subject: [PATCH] fix raspi2 timer

---
 bsp/raspberry-pi/raspi2/cpu/cp15.h      | 1 +
 bsp/raspberry-pi/raspi2/cpu/interrupt.c | 6 ++++++
 bsp/raspberry-pi/raspi2/driver/board.c  | 5 +++--
 3 files changed, 10 insertions(+), 2 deletions(-)

diff --git a/bsp/raspberry-pi/raspi2/cpu/cp15.h b/bsp/raspberry-pi/raspi2/cpu/cp15.h
index ebea3f0fe3..141a22a675 100644
--- a/bsp/raspberry-pi/raspi2/cpu/cp15.h
+++ b/bsp/raspberry-pi/raspi2/cpu/cp15.h
@@ -6,6 +6,7 @@ unsigned long rt_cpu_get_smp_id(void);
 void rt_cpu_mmu_disable(void);
 void rt_cpu_mmu_enable(void);
 void rt_cpu_tlb_set(volatile unsigned long*);
+void rt_hw_vector_init(void);
 
 void rt_cpu_vector_set_base(unsigned int addr);
 
diff --git a/bsp/raspberry-pi/raspi2/cpu/interrupt.c b/bsp/raspberry-pi/raspi2/cpu/interrupt.c
index d502977c3e..93513f3da3 100644
--- a/bsp/raspberry-pi/raspi2/cpu/interrupt.c
+++ b/bsp/raspberry-pi/raspi2/cpu/interrupt.c
@@ -29,8 +29,14 @@ rt_uint32_t rt_interrupt_from_thread;
 rt_uint32_t rt_interrupt_to_thread;
 rt_uint32_t rt_thread_switch_interrupt_flag;
 
+extern void rt_cpu_vector_set_base(unsigned int addr);
 extern int system_vectors;
 
+void rt_hw_vector_init(void)
+{
+    rt_cpu_vector_set_base((unsigned int)&system_vectors);
+}
+
 static void default_isr_handler(int vector, void *param)
 {
     rt_kprintf("unhandled irq: %d\n", vector);
diff --git a/bsp/raspberry-pi/raspi2/driver/board.c b/bsp/raspberry-pi/raspi2/driver/board.c
index 30f8cd93a1..78cac6ba4d 100644
--- a/bsp/raspberry-pi/raspi2/driver/board.c
+++ b/bsp/raspberry-pi/raspi2/driver/board.c
@@ -26,6 +26,7 @@
 
 #include "board.h"
 #include "drv_uart.h"
+#include "cp15.h"
 
 void rt_hw_timer_isr(int vector, void *parameter)
 {
@@ -65,7 +66,7 @@ void rt_hw_board_init(void)
 {
     /* initialize hardware interrupt */
     rt_hw_interrupt_init();
-    vector_copy();
+    rt_hw_vector_init();
 
     /* initialize uart */
     rt_hw_uart_init();
@@ -82,7 +83,7 @@ void rt_hw_board_init(void)
 #endif
 
     /* initialize timer for os tick */
-    // rt_hw_timer_init();
+    rt_hw_timer_init();
 
 #ifdef RT_USING_COMPONENTS_INIT
     rt_components_board_init();
-- 
GitLab