From 7b42f926a0c2358d1d74f94f8aec6aaccd87ec49 Mon Sep 17 00:00:00 2001 From: prife Date: Mon, 14 Jan 2013 14:14:40 +0800 Subject: [PATCH] re-write the rt_hw_interrupt_enable/disable --- libcpu/sim/posix/cpu_port.c | 165 +++++++++++++++++++----------------- 1 file changed, 89 insertions(+), 76 deletions(-) diff --git a/libcpu/sim/posix/cpu_port.c b/libcpu/sim/posix/cpu_port.c index ca25747c5a..e3dea83eee 100644 --- a/libcpu/sim/posix/cpu_port.c +++ b/libcpu/sim/posix/cpu_port.c @@ -1,6 +1,6 @@ /* * author : prife (goprife@gmail.com) - * date : 2013/01/14 01:18:50 + * date : 2013/01/14 01:18:50 * version: v 0.1.0 */ #include @@ -186,28 +186,96 @@ rt_uint8_t *rt_hw_stack_init( return (rt_uint8_t *) thread; } -static int dis_count; -static int en_count; - -/* TODO: 此函数还没有真正实现 */ rt_base_t rt_hw_interrupt_disable(void) { long back; + if (ptr_int_mutex == NULL) + { + return 0; + } + + pthread_mutex_lock(ptr_int_mutex); back = interrupt_disable_flag; interrupt_disable_flag = INTERRUPT_DISABLE; /*TODO: It may need to unmask the signal */ - dis_count++; return back; } -/* TODO: 此函数还没有真正实现 */ void rt_hw_interrupt_enable(rt_base_t level) { + struct rt_thread * tid; + pthread_t pid; + thread_t *thread_from; + thread_t *thread_to; + + if (ptr_int_mutex == NULL) + return; + interrupt_disable_flag = level; - en_count++; + pthread_mutex_unlock(ptr_int_mutex); + /* 如果已经中断仍然关闭 */ + if (interrupt_disable_flag) + { + return; + } + + /* 表示当前中断打开, 检查是否有挂起的中断 */ + pthread_mutex_lock(ptr_int_mutex); + if (!cpu_pending_interrupts) + { + pthread_mutex_unlock(ptr_int_mutex); + return; + } + + thread_from = (thread_t *) rt_interrupt_from_thread; + thread_to = (thread_t *) rt_interrupt_to_thread; + tid = rt_thread_self(); + pid = pthread_self(); + + if (pid != mainthread_pid) + { + /* 注意这段代码是在RTT普通线程函数总函数中执行的, + * from线程就是当前rtt线程 */ + /* 需要检查是否有挂起的中断需要处理 */ + TRACE("conswitch: P in pid<%x> ,suspend <%s>, resume <%s>!\n", + (unsigned int)pid, + thread_from->rtthread->name, + thread_to->rtthread->name); + + /* 确定一下,这两个值一定是相等的! */ + RT_ASSERT(thread_from->pthread == pid); + + /* 唤醒被挂起的线程 */ + sem_post(& thread_to ->sem); + cpu_pending_interrupts --; + + pthread_mutex_unlock(ptr_int_mutex); + + /* 挂起当前的线程 */ + sem_wait(& thread_from->sem); + } + else + { + /* 注意这段代码是在system tick 函数中执行的, + * 即此时位于主线程的SIGALRM信号处理函数中 + */ + TRACE("conswitch: S in pid<%x> ,suspend <%s>, resume <%s>!\n", + (unsigned int)pid, + thread_from->rtthread->name, + thread_to->rtthread->name); + /* 挂起from线程 */ + pthread_kill(thread_from->pthread, MSG_SUSPEND); + cpu_pending_interrupts --; + + pthread_mutex_unlock(ptr_int_mutex); + + /* 唤醒to线程 */ + sem_post(& thread_to->sem); + + } /*TODO: It may need to unmask the signal */ } @@ -240,66 +308,12 @@ void rt_hw_context_switch(rt_uint32_t from, rt_interrupt_from_thread = *((rt_uint32_t *)from); rt_interrupt_to_thread = *((rt_uint32_t *)to); - thread_from = (thread_t *) rt_interrupt_from_thread; - thread_to = (thread_t *) rt_interrupt_to_thread; - - /* FIXME note: now, rt_current_thread is the thread_to! scheduler.c:272 */ - tid = rt_thread_self(); - pid = pthread_self(); - - /* - * FIXME: 这段代码应该删除,因为rt_schedule函数中是先关闭中断,然后再开启的 - * 开启就会出发PendSV(以stm32为例)中断,cpu_port.c的win32版本可以模拟这种 - * 情形,因为它的中断是在主线程代码实现的,而本设计中,切换分为两种情况, - * 1) 普通rtt线程调用rt_thread_delay/rt_sem_take等主动挂起时,即刻实现切换 - * 2) 当rt_thread_delay定时到期时,主线程的SIGALRM信号处理函数中实现线程切换 - * - * 在第一种情况下,如果添加打开如下代码,由于if中语句为真,会导致失败退出。 - * - if (interrupt_disable_flag != 0) - { - printf("dis_count=%d, en_count=%d\n", dis_count, en_count); - printf("interrupt_disable_flag = %d\n", interrupt_disable_flag); - printf("bug! interrupt is disabled! You may forget enable interrupt\n"); - exit(EXIT_FAILURE); - } - */ - - if (pid != mainthread_pid) - { - /* FIXME: 注意这段代码是在RTT普通线程函数总函数中执行的, - * from线程就是当前rtt线程 */ - TRACE("conswitch: P in pid<%x> ,suspend <%s>, resume <%s>!\n", - (unsigned int)pid, - thread_from->rtthread->name, - thread_to->rtthread->name); - - /* 确定一下,这两个值一定是相等的! */ - RT_ASSERT(thread_from->pthread == pid); - - /* 唤醒to线程 */ - sem_post(& thread_to->sem); - - /* 挂起from线程, 既然from线程就是当前线程,所以应该直接 - * 挂起在这里 */ - sem_wait(& thread_from->sem); - } - else - { - /* FIXME: 注意这段代码是在system tick 函数中执行的, - * 即此时位于主线程的SIGALRM信号处理函数中 - */ - TRACE("conswitch: S in pid<%x> ,suspend <%s>, resume <%s>!\n", - (unsigned int)pid, - thread_from->rtthread->name, - thread_to->rtthread->name); - - /* 挂起from线程 */ - pthread_kill(thread_from->pthread, MSG_SUSPEND); - - /* 唤醒to线程 */ - sem_post(& thread_to->sem); - } + /* 这个函数只是并不会真正执行中断处理函数,而只是简单的 + * 设置一下中断挂起标志位 + */ + pthread_mutex_lock(ptr_int_mutex); + cpu_pending_interrupts ++; + pthread_mutex_unlock(ptr_int_mutex); } void rt_hw_context_switch_to(rt_uint32_t to) @@ -331,7 +345,6 @@ static int mainthread_scheduler(void) thread_t *thread_to; pthread_mutex_t mutex; pthread_mutexattr_t mutexattr; - unsigned int contex_switch_mask; /* save the main thread id */ mainthread_pid = pthread_self(); @@ -342,14 +355,11 @@ static int mainthread_scheduler(void) /* install signal handler used to suspend itself */ signal_install(MSG_SUSPEND, thread_switch_handler); -#if 0 /* create a mutex and condition val, used to indicate interrupts occrue */ ptr_int_mutex = &mutex; pthread_mutexattr_init(&mutexattr); pthread_mutexattr_settype(&mutexattr, PTHREAD_MUTEX_RECURSIVE); pthread_mutex_init(ptr_int_mutex, &mutexattr); - pthread_cond_init(&cond_int_hit, NULL); -#endif /* start timer */ start_sys_timer(); @@ -405,17 +415,20 @@ static void start_sys_timer(void) static void mthread_signal_tick(int sig) { + int res; pthread_t pid = pthread_self(); if (sig == SIGALRM) { TRACE("pid <%x> signal: SIGALRM enter!\n", (unsigned int)pid); - /* FIXME: 下面这条语句不能打开,打开就会导致失败tick_interrupt_isry - * 永远无法执行 - */ - /* if (! interrupt_disable_flag) */ + if (pthread_mutex_trylock(ptr_int_mutex) != 0) + { + TRACE("try lock failed.\n"); + return; + } tick_interrupt_isr(); + pthread_mutex_unlock(ptr_int_mutex); TRACE("pid <%x> signal: SIGALRM leave!\n", (unsigned int)pid); }