12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003200420052006200720082009201020112012201320142015201620172018201920202021202220232024202520262027202820292030203120322033203420352036203720382039204020412042204320442045204620472048204920502051205220532054205520562057205820592060206120622063206420652066206720682069207020712072207320742075207620772078207920802081208220832084208520862087208820892090209120922093209420952096209720982099210021012102210321042105 |
- /*
- * File : ipc.c
- * This file is part of RT-Thread RTOS
- * COPYRIGHT (C) 2006 - 2009, RT-Thread Development Team
- *
- * The license and distribution terms for this file may be
- * found in the file LICENSE in this distribution or at
- * http://www.rt-thread.org/license/LICENSE
- *
- * Change Logs:
- * Date Author Notes
- * 2006-03-14 Bernard the first version
- * 2006-04-25 Bernard implement semaphore
- * 2006-05-03 Bernard add RT_IPC_DEBUG
- * modify the type of IPC waiting time to rt_int32_t
- * 2006-05-10 Bernard fix the semaphore take bug and add IPC object
- * 2006-05-12 Bernard implement mailbox and message queue
- * 2006-05-20 Bernard implement mutex
- * 2006-05-23 Bernard implement fast event
- * 2006-05-24 Bernard implement event
- * 2006-06-03 Bernard fix the thread timer init bug
- * 2006-06-05 Bernard fix the mutex release bug
- * 2006-06-07 Bernard fix the message queue send bug
- * 2006-08-04 Bernard add hook support
- * 2009-05-21 Yi.qiu fix the sem release bug
- * 2009-07-18 Bernard fix the event clear bug
- * 2009-09-09 Bernard remove fast event and fix ipc release bug
- * 2009-10-10 Bernard change semaphore and mutex value to unsigned value
- * 2009-10-25 Bernard change the mb/mq receive timeout to 0 if the
- * re-calculated delta tick is a negative number.
- * 2009-12-16 Bernard fix the rt_ipc_object_suspend issue when IPC flag
- * is RT_IPC_FLAG_PRIO
- * 2010-01-20 mbbill remove rt_ipc_object_decrease function.
- * 2010-04-20 Bernard move memcpy outside interrupt disable in mq
- * 2010-10-26 yi.qiu add module support in rt_mp_delete and rt_mq_delete
- * 2010-11-10 Bernard add IPC reset command implementation.
- */
- #include <rtthread.h>
- #include <rthw.h>
- #include "kservice.h"
- /* #define RT_IPC_DEBUG */
- #ifdef RT_USING_HOOK
- extern void (*rt_object_trytake_hook)(struct rt_object* object);
- extern void (*rt_object_take_hook)(struct rt_object* object);
- extern void (*rt_object_put_hook)(struct rt_object* object);
- #endif
- /**
- * @addtogroup IPC
- */
- /*@{*/
- /**
- * This function will initialize an IPC object
- *
- * @param ipc the IPC object
- *
- * @return the operation status, RT_EOK on successful
- */
- rt_inline rt_err_t rt_ipc_object_init(struct rt_ipc_object *ipc)
- {
- /* init ipc object */
- rt_list_init(&(ipc->suspend_thread));
- return RT_EOK;
- }
- /**
- * This function will suspend a thread to a specified list. IPC object or some double-queue
- * object (mailbox etc.) contains this kind of list.
- *
- * @param ipc the IPC object
- * @param thread the thread object to be suspended
- *
- * @return the operation status, RT_EOK on successful
- */
- rt_inline rt_err_t rt_ipc_list_suspend(rt_list_t *list, struct rt_thread *thread, rt_uint8_t flag)
- {
- /* suspend thread */
- rt_thread_suspend(thread);
- switch (flag)
- {
- case RT_IPC_FLAG_FIFO:
- rt_list_insert_before(list, &(thread->tlist));
- break;
- case RT_IPC_FLAG_PRIO:
- {
- struct rt_list_node* n;
- struct rt_thread* sthread;
- /* find a suitable position */
- for (n = list->next; n != list; n = n->next)
- {
- sthread = rt_list_entry(n, struct rt_thread, tlist);
- /* find out */
- if (thread->current_priority < sthread->current_priority)
- {
- /* insert this thread before the sthread */
- rt_list_insert_before(&(sthread->tlist), &(thread->tlist));
- break;
- }
- }
- /* not found a suitable position, append to the end of suspend_thread list */
- if (n == list)
- rt_list_insert_before(list, &(thread->tlist));
- }
- break;
- }
- return RT_EOK;
- }
- /**
- * This function will resume the first thread in the list of a IPC object:
- * - remove the thread from suspend queue of IPC object
- * - put the thread into system ready queue
- *
- * @param list the thread list
- *
- * @return the operation status, RT_EOK on successful
- */
- rt_inline rt_err_t rt_ipc_list_resume(rt_list_t *list)
- {
- struct rt_thread *thread;
- /* get thread entry */
- thread = rt_list_entry(list->next, struct rt_thread, tlist);
- #ifdef RT_IPC_DEBUG
- rt_kprintf("resume thread:%s\n", thread->name);
- #endif
- /* resume it */
- rt_thread_resume(thread);
- return RT_EOK;
- }
- /**
- * This function will resume all suspended threads in a list, including
- * suspend list of IPC object and private list of mailbox etc.
- *
- * @param list of the threads to resume
- *
- * @return the operation status, RT_EOK on successful
- */
- rt_inline rt_err_t rt_ipc_list_resume_all(rt_list_t *list)
- {
- struct rt_thread* thread;
- register rt_ubase_t temp;
- /* wakeup all suspend threads */
- while (!rt_list_isempty(list))
- {
- /* disable interrupt */
- temp = rt_hw_interrupt_disable();
- /* get next suspend thread */
- thread = rt_list_entry(list->next, struct rt_thread, tlist);
- /* set error code to RT_ERROR */
- thread->error = -RT_ERROR;
- /*
- * resume thread
- * In rt_thread_resume function, it will remove current thread from
- * suspend list
- */
- rt_thread_resume(thread);
- /* enable interrupt */
- rt_hw_interrupt_enable(temp);
- }
- return RT_EOK;
- }
- #ifdef RT_USING_SEMAPHORE
- /**
- * This function will initialize a semaphore and put it under control of resource
- * management.
- *
- * @param sem the semaphore object
- * @param name the name of semaphore
- * @param value the init value of semaphore
- * @param flag the flag of semaphore
- *
- * @return the operation status, RT_EOK on successful
- */
- rt_err_t rt_sem_init (rt_sem_t sem, const char* name, rt_uint32_t value, rt_uint8_t flag)
- {
- RT_ASSERT(sem != RT_NULL);
- /* init object */
- rt_object_init(&(sem->parent.parent), RT_Object_Class_Semaphore, name);
- /* init ipc object */
- rt_ipc_object_init(&(sem->parent));
- /* set init value */
- sem->value = value;
- /* set parent */
- sem->parent.parent.flag = flag;
- return RT_EOK;
- }
- /**
- * This function will detach a semaphore from resource management
- *
- * @param sem the semaphore object
- *
- * @return the operation status, RT_EOK on successful
- *
- * @see rt_sem_delete
- */
- rt_err_t rt_sem_detach (rt_sem_t sem)
- {
- RT_ASSERT(sem != RT_NULL);
- /* wakeup all suspend threads */
- rt_ipc_list_resume_all(&(sem->parent.suspend_thread));
- /* detach semaphore object */
- rt_object_detach(&(sem->parent.parent));
- return RT_EOK;
- }
- #ifdef RT_USING_HEAP
- /**
- * This function will create a semaphore from system resource
- *
- * @param name the name of semaphore
- * @param value the init value of semaphore
- * @param flag the flag of semaphore
- *
- * @return the created semaphore, RT_NULL on error happen
- *
- * @see rt_sem_init
- */
- rt_sem_t rt_sem_create (const char* name, rt_uint32_t value, rt_uint8_t flag)
- {
- rt_sem_t sem;
- /* allocate object */
- sem = (rt_sem_t) rt_object_allocate(RT_Object_Class_Semaphore, name);
- if (sem == RT_NULL) return sem;
- /* init ipc object */
- rt_ipc_object_init(&(sem->parent));
- /* set init value */
- sem->value = value;
- /* set parent */
- sem->parent.parent.flag = flag;
- return sem;
- }
- /**
- * This function will delete a semaphore object and release the memory
- *
- * @param sem the semaphore object
- *
- * @return the error code
- *
- * @see rt_sem_detach
- */
- rt_err_t rt_sem_delete (rt_sem_t sem)
- {
- RT_ASSERT(sem != RT_NULL);
- /* wakeup all suspend threads */
- rt_ipc_list_resume_all(&(sem->parent.suspend_thread));
- /* delete semaphore object */
- rt_object_delete(&(sem->parent.parent));
- return RT_EOK;
- }
- #endif
- /**
- * This function will take a semaphore, if the semaphore is unavailable, the
- * thread shall wait for a specified time.
- *
- * @param sem the semaphore object
- * @param time the waiting time
- *
- * @return the error code
- */
- rt_err_t rt_sem_take (rt_sem_t sem, rt_int32_t time)
- {
- register rt_base_t temp;
- struct rt_thread* thread;
- RT_ASSERT(sem != RT_NULL);
- #ifdef RT_USING_HOOK
- if (rt_object_trytake_hook != RT_NULL) rt_object_trytake_hook(&(sem->parent.parent));
- #endif
- /* disable interrupt */
- temp = rt_hw_interrupt_disable();
- #ifdef RT_IPC_DEBU
- rt_kprintf("thread %s take sem:%s, which value is: %d\n", rt_thread_self()->name,
- ((struct rt_object*)sem)->name, sem->value);
- #endif
- if (sem->value > 0)
- {
- /* semaphore is available */
- sem->value --;
- /* enable interrupt */
- rt_hw_interrupt_enable(temp);
- }
- else
- {
- /* no waiting, return with timeout */
- if (time == 0 )
- {
- rt_hw_interrupt_enable(temp);
- return -RT_ETIMEOUT;
- }
- else
- {
- /* semaphore is unavailable, push to suspend list */
- /* get current thread */
- thread = rt_thread_self();
- /* reset thread error number */
- thread->error = RT_EOK;
- #ifdef RT_IPC_DEBUG
- rt_kprintf("sem take: suspend thread - %s\n", thread->name);
- #endif
- /* suspend thread */
- rt_ipc_list_suspend(&(sem->parent.suspend_thread),
- thread, sem->parent.parent.flag);
- /* has waiting time, start thread timer */
- if (time > 0)
- {
- #ifdef RT_IPC_DEBUG
- rt_kprintf("set thread:%s to timer list\n", thread->name);
- #endif
- /* reset the timeout of thread timer and start it */
- rt_timer_control(&(thread->thread_timer), RT_TIMER_CTRL_SET_TIME, &time);
- rt_timer_start(&(thread->thread_timer));
- }
- /* enable interrupt */
- rt_hw_interrupt_enable(temp);
- /* do schedule */
- rt_schedule();
- if (thread->error != RT_EOK)
- {
- return thread->error;
- }
- }
- }
- #ifdef RT_USING_HOOK
- if (rt_object_take_hook != RT_NULL) rt_object_take_hook(&(sem->parent.parent));
- #endif
- return RT_EOK;
- }
- /**
- * This function will try to take a semaphore and immediately return
- *
- * @param sem the semaphore object
- *
- * @return the error code
- */
- rt_err_t rt_sem_trytake(rt_sem_t sem)
- {
- return rt_sem_take(sem, 0);
- }
- /**
- * This function will release a semaphore, if there are threads suspended on
- * semaphore, it will be waked up.
- *
- * @param sem the semaphore object
- *
- * @return the error code
- */
- rt_err_t rt_sem_release(rt_sem_t sem)
- {
- register rt_base_t temp;
- register rt_bool_t need_schedule;
- #ifdef RT_USING_HOOK
- if (rt_object_put_hook != RT_NULL) rt_object_put_hook(&(sem->parent.parent));
- #endif
- need_schedule = RT_FALSE;
- /* disable interrupt */
- temp = rt_hw_interrupt_disable();
- #ifdef RT_IPC_DEBUG
- rt_kprintf("thread %s releases sem:%s, which value is: %d\n", rt_thread_self()->name,
- ((struct rt_object*)sem)->name, sem->value);
- #endif
- if ( !rt_list_isempty(&sem->parent.suspend_thread) )
- {
- /* resume the suspended thread */
- rt_ipc_list_resume(&(sem->parent.suspend_thread));
- need_schedule = RT_TRUE;
- }
- else sem->value ++; /* increase value */
- /* enable interrupt */
- rt_hw_interrupt_enable(temp);
- /* resume a thread, re-schedule */
- if (need_schedule == RT_TRUE) rt_schedule();
- return RT_EOK;
- }
- /**
- * This function can get or set some extra attributions of a semaphore object.
- *
- * @param sem the semaphore object
- * @param cmd the execution command
- * @param arg the execution argument
- *
- * @return the error code
- */
- rt_err_t rt_sem_control(rt_sem_t sem, rt_uint8_t cmd, void* arg)
- {
- rt_ubase_t level;
- RT_ASSERT(sem != RT_NULL);
- if (cmd == RT_IPC_CMD_RESET)
- {
- rt_uint32_t value;
- /* get value */
- value = (rt_uint32_t)arg;
- /* disable interrupt */
- level = rt_hw_interrupt_disable();
- /* resume all waiting thread */
- rt_ipc_list_resume_all(&sem->parent.suspend_thread);
- /* set new value */
- sem->value = (rt_uint16_t)value;
- /* enable interrupt */
- rt_hw_interrupt_enable(level);
- return RT_EOK;
- }
- return -RT_ERROR;
- }
- #endif /* end of RT_USING_SEMAPHORE */
- #ifdef RT_USING_MUTEX
- /**
- * This function will initialize a mutex and put it under control of resource
- * management.
- *
- * @param mutex the mutex object
- * @param name the name of mutex
- * @param flag the flag of mutex
- *
- * @return the operation status, RT_EOK on successful
- */
- rt_err_t rt_mutex_init (rt_mutex_t mutex, const char* name, rt_uint8_t flag)
- {
- RT_ASSERT(mutex != RT_NULL);
- /* init object */
- rt_object_init(&(mutex->parent.parent), RT_Object_Class_Mutex, name);
- /* init ipc object */
- rt_ipc_object_init(&(mutex->parent));
- mutex->value = 1;
- mutex->owner = RT_NULL;
- mutex->original_priority = 0xFF;
- mutex->hold = 0;
- /* set flag */
- mutex->parent.parent.flag = flag;
- return RT_EOK;
- }
- /**
- * This function will detach a mutex from resource management
- *
- * @param mutex the mutex object
- *
- * @return the operation status, RT_EOK on successful
- *
- * @see rt_mutex_delete
- */
- rt_err_t rt_mutex_detach (rt_mutex_t mutex)
- {
- RT_ASSERT(mutex != RT_NULL);
- /* wakeup all suspend threads */
- rt_ipc_list_resume_all(&(mutex->parent.suspend_thread));
- /* detach semaphore object */
- rt_object_detach(&(mutex->parent.parent));
- return RT_EOK;
- }
- #ifdef RT_USING_HEAP
- /**
- * This function will create a mutex from system resource
- *
- * @param name the name of mutex
- * @param flag the flag of mutex
- *
- * @return the created mutex, RT_NULL on error happen
- *
- * @see rt_mutex_init
- */
- rt_mutex_t rt_mutex_create (const char* name, rt_uint8_t flag)
- {
- struct rt_mutex *mutex;
- /* allocate object */
- mutex = (rt_mutex_t) rt_object_allocate(RT_Object_Class_Mutex, name);
- if (mutex == RT_NULL) return mutex;
- /* init ipc object */
- rt_ipc_object_init(&(mutex->parent));
- mutex->value = 1;
- mutex->owner = RT_NULL;
- mutex->original_priority = 0xFF;
- mutex->hold = 0;
- /* set flag */
- mutex->parent.parent.flag = flag;
- return mutex;
- }
- /**
- * This function will delete a mutex object and release the memory
- *
- * @param mutex the mutex object
- *
- * @return the error code
- *
- * @see rt_mutex_detach
- */
- rt_err_t rt_mutex_delete (rt_mutex_t mutex)
- {
- RT_ASSERT(mutex != RT_NULL);
- /* wakeup all suspend threads */
- rt_ipc_list_resume_all(&(mutex->parent.suspend_thread));
- /* delete semaphore object */
- rt_object_delete(&(mutex->parent.parent));
- return RT_EOK;
- }
- #endif
- /**
- * This function will take a mutex, if the mutex is unavailable, the
- * thread shall wait for a specified time.
- *
- * @param mutex the mutex object
- * @param time the waiting time
- *
- * @return the error code
- */
- rt_err_t rt_mutex_take (rt_mutex_t mutex, rt_int32_t time)
- {
- register rt_base_t temp;
- struct rt_thread* thread;
- RT_ASSERT(mutex != RT_NULL);
- /* disable interrupt */
- temp = rt_hw_interrupt_disable();
- /* get current thread */
- thread = rt_thread_self();
- #ifdef RT_USING_HOOK
- if (rt_object_trytake_hook != RT_NULL) rt_object_trytake_hook(&(mutex->parent.parent));
- #endif
- #ifdef RT_IPC_DEBUG
- rt_kprintf("mutex_take: current thread %s, mutex value: %d, hold: %d\n",
- thread->name, mutex->value, mutex->hold);
- #endif
- /* reset thread error */
- thread->error = RT_EOK;
- if (mutex->owner == thread)
- {
- /* it's the same thread */
- mutex->hold ++;
- }
- else
- {
- /* in initialization status, the value is 1. Therefore, if the
- * value is great than 1, which indicates the mutex is avaible.
- */
- if (mutex->value > 0)
- {
- /* mutex is available */
- mutex->value --;
- /* set mutex owner and original priority */
- mutex->owner = thread;
- mutex->original_priority = thread->current_priority;
- mutex->hold ++;
- }
- else
- {
- /* no waiting, return with timeout */
- if (time == 0 )
- {
- /* set error as timeout */
- thread->error = -RT_ETIMEOUT;
- /* enable interrupt */
- rt_hw_interrupt_enable(temp);
- return -RT_ETIMEOUT;
- }
- else
- {
- /* mutex is unavailable, push to suspend list */
- #ifdef RT_IPC_DEBUG
- rt_kprintf("mutex_take: suspend thread: %s\n", thread->name);
- #endif
- /* change the owner thread priority of mutex */
- if (thread->current_priority < mutex->owner->current_priority)
- {
- /* change the owner thread priority */
- rt_thread_control(mutex->owner, RT_THREAD_CTRL_CHANGE_PRIORITY,
- &thread->current_priority);
- }
- /* suspend current thread */
- rt_ipc_list_suspend(&(mutex->parent.suspend_thread),
- thread, mutex->parent.parent.flag);
- /* has waiting time, start thread timer */
- if (time > 0)
- {
- #ifdef RT_IPC_DEBUG
- rt_kprintf("mutex_take: start the timer of thread:%s\n", thread->name);
- #endif
- /* reset the timeout of thread timer and start it */
- rt_timer_control(&(thread->thread_timer), RT_TIMER_CTRL_SET_TIME, &time);
- rt_timer_start(&(thread->thread_timer));
- }
- /* enable interrupt */
- rt_hw_interrupt_enable(temp);
- /* do schedule */
- rt_schedule();
- if (thread->error != RT_EOK)
- {
- /* return error */
- return thread->error;
- }
- else
- {
- /* the mutex is taken successfully. */
- /* disable interrupt */
- temp = rt_hw_interrupt_disable();
- }
- }
- }
- }
- /* enable interrupt */
- rt_hw_interrupt_enable(temp);
- #ifdef RT_USING_HOOK
- if (rt_object_take_hook != RT_NULL) rt_object_take_hook(&(mutex->parent.parent));
- #endif
- return RT_EOK;
- }
- /**
- * This function will release a mutex, if there are threads suspended on mutex,
- * it will be waked up.
- *
- * @param mutex the mutex object
- *
- * @return the error code
- */
- rt_err_t rt_mutex_release(rt_mutex_t mutex)
- {
- register rt_base_t temp;
- struct rt_thread* thread;
- rt_bool_t need_schedule;
- need_schedule = RT_FALSE;
- /* get current thread */
- thread = rt_thread_self();
- /* disable interrupt */
- temp = rt_hw_interrupt_disable();
- #ifdef RT_IPC_DEBUG
- rt_kprintf("mutex_release:current thread %s, mutex value: %d, hold: %d\n",
- thread->name, mutex->value, mutex->hold);
- #endif
- #ifdef RT_USING_HOOK
- if (rt_object_put_hook != RT_NULL) rt_object_put_hook(&(mutex->parent.parent));
- #endif
- /* mutex only can be released by owner */
- if (thread != mutex->owner)
- {
- thread->error = -RT_ERROR;
- /* enable interrupt */
- rt_hw_interrupt_enable(temp);
- return -RT_ERROR;
- }
- /* decrease hold */
- mutex->hold --;
- /* if no hold */
- if (mutex->hold == 0)
- {
- /* change the owner thread to original priority */
- if (mutex->original_priority != mutex->owner->current_priority)
- {
- rt_thread_control(mutex->owner, RT_THREAD_CTRL_CHANGE_PRIORITY,
- &(mutex->original_priority));
- }
- /* wakeup suspended thread */
- if( !rt_list_isempty(&mutex->parent.suspend_thread) )
- {
- /* get suspended thread */
- thread = rt_list_entry(mutex->parent.suspend_thread.next, struct rt_thread, tlist);
- #ifdef RT_IPC_DEBUG
- rt_kprintf("mutex_release: resume thread: %s\n", thread->name);
- #endif
- /* set new owner and priority */
- mutex->owner = thread;
- mutex->original_priority = thread->current_priority;
- mutex->hold ++;
- /* resume thread */
- rt_ipc_list_resume(&(mutex->parent.suspend_thread));
- need_schedule = RT_TRUE;
- }
- else
- {
- /* increase value */
- mutex->value ++;
- /* clear owner */
- mutex->owner = RT_NULL;
- mutex->original_priority = 0xff;
- }
- }
- /* enable interrupt */
- rt_hw_interrupt_enable(temp);
- /* perform a schedule */
- if (need_schedule == RT_TRUE) rt_schedule();
- return RT_EOK;
- }
- /**
- * This function can get or set some extra attributions of a mutex object.
- *
- * @param mutex the mutex object
- * @param cmd the execution command
- * @param arg the execution argument
- *
- * @return the error code
- */
- rt_err_t rt_mutex_control(rt_mutex_t mutex, rt_uint8_t cmd, void* arg)
- {
- return -RT_ERROR;
- }
- #endif /* end of RT_USING_MUTEX */
- #ifdef RT_USING_EVENT
- /**
- * This function will initialize an event and put it under control of resource
- * management.
- *
- * @param event the event object
- * @param name the name of event
- * @param flag the flag of event
- *
- * @return the operation status, RT_EOK on successful
- */
- rt_err_t rt_event_init(rt_event_t event, const char* name, rt_uint8_t flag)
- {
- RT_ASSERT(event != RT_NULL);
- /* init object */
- rt_object_init(&(event->parent.parent), RT_Object_Class_Event, name);
- /* set parent flag */
- event->parent.parent.flag = flag;
- /* init ipc object */
- rt_ipc_object_init(&(event->parent));
- /* init event */
- event->set = 0;
- return RT_EOK;
- }
- /**
- * This function will detach an event object from resource management
- *
- * @param event the event object
- *
- * @return the operation status, RT_EOK on successful
- */
- rt_err_t rt_event_detach(rt_event_t event)
- {
- /* parameter check */
- RT_ASSERT(event != RT_NULL);
- /* resume all suspended thread */
- rt_ipc_list_resume_all(&(event->parent.suspend_thread));
- /* detach event object */
- rt_object_detach(&(event->parent.parent));
- return RT_EOK;
- }
- #ifdef RT_USING_HEAP
- /**
- * This function will create an event object from system resource
- *
- * @param name the name of event
- * @param flag the flag of event
- *
- * @return the created event, RT_NULL on error happen
- */
- rt_event_t rt_event_create (const char* name, rt_uint8_t flag)
- {
- rt_event_t event;
- /* allocate object */
- event = (rt_event_t) rt_object_allocate(RT_Object_Class_Event, name);
- if (event == RT_NULL) return event;
- /* set parent */
- event->parent.parent.flag = flag;
- /* init ipc object */
- rt_ipc_object_init(&(event->parent));
- /* init event */
- event->set = 0;
- return event;
- }
- /**
- * This function will delete an event object and release the memory
- *
- * @param event the event object
- *
- * @return the error code
- */
- rt_err_t rt_event_delete (rt_event_t event)
- {
- /* parameter check */
- RT_ASSERT(event != RT_NULL);
- /* resume all suspended thread */
- rt_ipc_list_resume_all(&(event->parent.suspend_thread));
- /* delete event object */
- rt_object_delete(&(event->parent.parent));
- return RT_EOK;
- }
- #endif
- /**
- * This function will send an event to the event object, if there are threads
- * suspended on event object, it will be waked up.
- *
- * @param event the event object
- * @param set the event set
- *
- * @return the error code
- */
- rt_err_t rt_event_send(rt_event_t event, rt_uint32_t set)
- {
- struct rt_list_node *n;
- struct rt_thread *thread;
- register rt_ubase_t level;
- register rt_base_t status;
- rt_bool_t need_schedule;
- /* parameter check */
- RT_ASSERT(event != RT_NULL);
- if (set == 0) return -RT_ERROR;
- need_schedule = RT_FALSE;
- #ifdef RT_USING_HOOK
- if (rt_object_put_hook != RT_NULL) rt_object_put_hook(&(event->parent.parent));
- #endif
- /* disable interrupt */
- level = rt_hw_interrupt_disable();
- /* set event */
- event->set |= set;
- if( !rt_list_isempty(&event->parent.suspend_thread) )
- {
- /* search thread list to resume thread */
- n = event->parent.suspend_thread.next;
- while (n != &(event->parent.suspend_thread))
- {
- /* get thread */
- thread = rt_list_entry(n, struct rt_thread, tlist);
- status = -RT_ERROR;
- if (thread->event_info & RT_EVENT_FLAG_AND)
- {
- if ((thread->event_set & event->set) == thread->event_set)
- {
- /* received an AND event */
- status = RT_EOK;
- }
- }
- else if (thread->event_info & RT_EVENT_FLAG_OR)
- {
- if (thread->event_set & event->set)
- {
- /* save recieved event set */
- thread->event_set = thread->event_set & event->set;
- /* received an OR event */
- status = RT_EOK;
- }
- }
- /* move node to the next */
- n = n->next;
- /* condition is satisfied, resume thread */
- if (status == RT_EOK)
- {
- /* clear event */
- if (thread->event_info & RT_EVENT_FLAG_CLEAR)
- event->set &= ~thread->event_set;
- /* resume thread, and thread list breaks out */
- rt_thread_resume(thread);
- /* need do a scheduling */
- need_schedule = RT_TRUE;
- }
- }
- }
- /* enable interrupt */
- rt_hw_interrupt_enable(level);
- /* do a schedule */
- if (need_schedule == RT_TRUE)
- rt_schedule();
- return RT_EOK;
- }
- /**
- * This function will receive an event from event object, if the event is unavailable,
- * the thread shall wait for a specified time.
- *
- * @param event the fast event object
- * @param set the interested event set
- * @param option the receive option
- * @param timeout the waiting time
- * @param recved the received event
- *
- * @return the error code
- */
- rt_err_t rt_event_recv(rt_event_t event, rt_uint32_t set, rt_uint8_t option, rt_int32_t timeout, rt_uint32_t* recved)
- {
- struct rt_thread *thread;
- register rt_ubase_t level;
- register rt_base_t status;
- /* parameter check */
- RT_ASSERT(event != RT_NULL);
- if (set == 0) return -RT_ERROR;
- /* init status */
- status = -RT_ERROR;
- /* get current thread */
- thread = rt_thread_self();
- /* reset thread error */
- thread->error = RT_EOK;
- #ifdef RT_USING_HOOK
- if (rt_object_trytake_hook != RT_NULL) rt_object_trytake_hook(&(event->parent.parent));
- #endif
- /* disable interrupt */
- level = rt_hw_interrupt_disable();
- /* check event set */
- if (option & RT_EVENT_FLAG_AND)
- {
- if ((event->set & set) == set) status = RT_EOK;
- }
- else if (option & RT_EVENT_FLAG_OR)
- {
- if (event->set & set) status = RT_EOK;
- }
- if (status == RT_EOK)
- {
- /* set received event */
- *recved = (event->set & set);
- /* received event */
- if (option & RT_EVENT_FLAG_CLEAR) event->set &= ~set;
- }
- else if (timeout == 0)
- {
- /* no waiting */
- thread->error = -RT_ETIMEOUT;
- }
- else
- {
- /* fill thread event info */
- thread->event_set = set;
- thread->event_info = option;
- /* put thread to suspended thread list */
- rt_ipc_list_suspend(&(event->parent.suspend_thread),
- thread, event->parent.parent.flag);
- /* if there is a waiting timeout, active thread timer */
- if (timeout > 0)
- {
- /* reset the timeout of thread timer and start it */
- rt_timer_control(&(thread->thread_timer), RT_TIMER_CTRL_SET_TIME, &timeout);
- rt_timer_start(&(thread->thread_timer));
- }
- /* enable interrupt */
- rt_hw_interrupt_enable(level);
- /* do a schedule */
- rt_schedule();
- if (thread->error != RT_EOK)
- {
- /* return error */
- return thread->error;
- }
- /* received an event, disable interrupt to protect */
- level = rt_hw_interrupt_disable();
- /* set received event */
- *recved = thread->event_set;
- }
- /* enable interrupt */
- rt_hw_interrupt_enable(level);
- #ifdef RT_USING_HOOK
- if (rt_object_take_hook != RT_NULL) rt_object_take_hook(&(event->parent.parent));
- #endif
- return thread->error;
- }
- /**
- * This function can get or set some extra attributions of an event object.
- *
- * @param event the event object
- * @param cmd the execution command
- * @param arg the execution argument
- *
- * @return the error code
- */
- rt_err_t rt_event_control (rt_event_t event, rt_uint8_t cmd, void* arg)
- {
- rt_ubase_t level;
- RT_ASSERT(event != RT_NULL);
- if (cmd == RT_IPC_CMD_RESET)
- {
- /* disable interrupt */
- level = rt_hw_interrupt_disable();
- /* resume all waiting thread */
- rt_ipc_list_resume_all(&event->parent.suspend_thread);
- /* init event set */
- event->set = 0;
- /* enable interrupt */
- rt_hw_interrupt_enable(level);
- return RT_EOK;
- }
- return -RT_ERROR;
- }
- #endif /* end of RT_USING_EVENT */
- #ifdef RT_USING_MAILBOX
- /**
- * This function will initialize a mailbox and put it under control of resource
- * management.
- *
- * @param mb the mailbox object
- * @param name the name of mailbox
- * @param msgpool the begin address of buffer to save received mail
- * @param size the size of mailbox
- * @param flag the flag of mailbox
- *
- * @return the operation status, RT_EOK on successful
- */
- rt_err_t rt_mb_init(rt_mailbox_t mb, const char* name, void* msgpool, rt_size_t size, rt_uint8_t flag)
- {
- RT_ASSERT(mb != RT_NULL);
- /* init object */
- rt_object_init(&(mb->parent.parent), RT_Object_Class_MailBox, name);
- /* set parent flag */
- mb->parent.parent.flag = flag;
- /* init ipc object */
- rt_ipc_object_init(&(mb->parent));
- /* init mailbox */
- mb->msg_pool = msgpool;
- mb->size = size;
- mb->entry = 0;
- mb->in_offset = 0;
- mb->out_offset = 0;
- rt_list_init(&(mb->suspend_sender_thread));
- return RT_EOK;
- }
- /**
- * This function will detach a mailbox from resource management
- *
- * @param mb the mailbox object
- *
- * @return the operation status, RT_EOK on successful
- */
- rt_err_t rt_mb_detach(rt_mailbox_t mb)
- {
- /* parameter check */
- RT_ASSERT(mb != RT_NULL);
- /* resume all suspended thread */
- rt_ipc_list_resume_all(&(mb->parent.suspend_thread));
- /* also resume all mailbox private suspended thread */
- rt_ipc_list_resume_all(&(mb->suspend_sender_thread));
- /* detach mailbox object */
- rt_object_detach(&(mb->parent.parent));
- return RT_EOK;
- }
- #ifdef RT_USING_HEAP
- /**
- * This function will create a mailbox object from system resource
- *
- * @param name the name of mailbox
- * @param size the size of mailbox
- * @param flag the flag of mailbox
- *
- * @return the created mailbox, RT_NULL on error happen
- */
- rt_mailbox_t rt_mb_create (const char* name, rt_size_t size, rt_uint8_t flag)
- {
- rt_mailbox_t mb;
- /* allocate object */
- mb = (rt_mailbox_t) rt_object_allocate(RT_Object_Class_MailBox, name);
- if (mb == RT_NULL) return mb;
- /* set parent */
- mb->parent.parent.flag = flag;
- /* init ipc object */
- rt_ipc_object_init(&(mb->parent));
- /* init mailbox */
- mb->size = size;
- mb->msg_pool = rt_malloc(mb->size * sizeof(rt_uint32_t));
- if (mb->msg_pool == RT_NULL)
- {
- /* delete mailbox object */
- rt_object_delete(&(mb->parent.parent));
- return RT_NULL;
- }
- mb->entry = 0;
- mb->in_offset = 0;
- mb->out_offset = 0;
- return mb;
- }
- /**
- * This function will delete a mailbox object and release the memory
- *
- * @param mb the mailbox object
- *
- * @return the error code
- */
- rt_err_t rt_mb_delete (rt_mailbox_t mb)
- {
- /* parameter check */
- RT_ASSERT(mb != RT_NULL);
- /* resume all suspended thread */
- rt_ipc_list_resume_all(&(mb->parent.suspend_thread));
- /* also resume all mailbox private suspended thread */
- rt_ipc_list_resume_all(&(mb->suspend_sender_thread));
- #ifdef RT_USING_MODULE
- /* the mb object belongs to an application module */
- if(mb->parent.parent.flag & RT_OBJECT_FLAG_MODULE)
- rt_module_free(mb->parent.parent.module_id, mb->msg_pool);
- else
- #endif
- /* free mailbox pool */
- rt_free(mb->msg_pool);
- /* delete mailbox object */
- rt_object_delete(&(mb->parent.parent));
- return RT_EOK;
- }
- #endif
- /**
- * This function will send a mail to mailbox object. If the mailbox is full,
- * current thread will be suspended until timeout.
- *
- * @param mb the mailbox object
- * @param value the mail
- * @param timeout the waiting time
- *
- * @return the error code
- */
- rt_err_t rt_mb_send_wait (rt_mailbox_t mb, rt_uint32_t value, rt_int32_t timeout)
- {
- struct rt_thread *thread;
- register rt_ubase_t temp;
- rt_uint32_t tick_delta;
- /* parameter check */
- RT_ASSERT(mb != RT_NULL);
- #ifdef RT_USING_HOOK
- if (rt_object_put_hook != RT_NULL) rt_object_put_hook(&(mb->parent.parent));
- #endif
- /* disable interrupt */
- temp = rt_hw_interrupt_disable();
- /* get current thread */
- thread = rt_thread_self();
- /* mailbox is full */
- while (mb->entry == mb->size)
- {
- /* reset error number in thread */
- thread->error = RT_EOK;
- /* no waiting, return timeout */
- if (timeout == 0)
- {
- /* enable interrupt */
- rt_hw_interrupt_enable(temp);
- thread->error = -RT_EFULL;
- return -RT_EFULL;
- }
- /* suspend current thread */
- rt_ipc_list_suspend(&(mb->suspend_sender_thread),
- thread, mb->parent.parent.flag);
- /* has waiting time, start thread timer */
- if (timeout > 0)
- {
- /* get the start tick of timer */
- tick_delta = rt_tick_get();
- #ifdef RT_IPC_DEBUG
- rt_kprintf("mb_send_wait: start timer of thread:%s\n", thread->name);
- #endif
- /* reset the timeout of thread timer and start it */
- rt_timer_control(&(thread->thread_timer), RT_TIMER_CTRL_SET_TIME, &timeout);
- rt_timer_start(&(thread->thread_timer));
- }
- /* enable interrupt */
- rt_hw_interrupt_enable(temp);
- /* re-schedule */
- rt_schedule();
- /* resume from suspend state */
- if (thread->error != RT_EOK)
- {
- /* return error */
- return thread->error;
- }
- /* disable interrupt */
- temp = rt_hw_interrupt_disable();
- /* re-calculate timeout tick */
- if (timeout > 0)
- {
- tick_delta = rt_tick_get() - tick_delta;
- timeout -= tick_delta;
- if (timeout < 0) timeout = 0;
- }
- }
- /* set ptr */
- mb->msg_pool[mb->in_offset] = value;
- /* increase input offset */
- ++ mb->in_offset;
- mb->in_offset %= mb->size;
- /* increase message entry */
- mb->entry ++;
- /* resume suspended thread */
- if( !rt_list_isempty(&mb->parent.suspend_thread) )
- {
- rt_ipc_list_resume(&(mb->parent.suspend_thread));
- /* enable interrupt */
- rt_hw_interrupt_enable(temp);
- rt_schedule();
- return RT_EOK;
- }
- /* enable interrupt */
- rt_hw_interrupt_enable(temp);
- return RT_EOK;
- }
- /**
- * This function will send a mail to mailbox object, if there are threads suspended
- * on mailbox object, it will be waked up. This function will return immediately, if
- * you want blocking send, use rt_mb_send_wait instead.
- *
- * @param mb the mailbox object
- * @param value the mail
- *
- * @return the error code
- */
- rt_err_t rt_mb_send (rt_mailbox_t mb, rt_uint32_t value)
- {
- return rt_mb_send_wait(mb,value,0);
- }
- /**
- * This function will receive a mail from mailbox object, if there is no mail in
- * mailbox object, the thread shall wait for a specified time.
- *
- * @param mb the mailbox object
- * @param value the received mail will be saved in
- * @param timeout the waiting time
- *
- * @return the error code
- */
- rt_err_t rt_mb_recv (rt_mailbox_t mb, rt_uint32_t* value, rt_int32_t timeout)
- {
- struct rt_thread *thread;
- register rt_ubase_t temp;
- rt_uint32_t tick_delta;
- /* parameter check */
- RT_ASSERT(mb != RT_NULL);
- tick_delta = 0;
- #ifdef RT_USING_HOOK
- if (rt_object_trytake_hook != RT_NULL) rt_object_trytake_hook(&(mb->parent.parent));
- #endif
- /* disable interrupt */
- temp = rt_hw_interrupt_disable();
- /* get current thread */
- thread = rt_thread_self();
- /* mailbox is empty */
- while (mb->entry == 0)
- {
- /* reset error number in thread */
- thread->error = RT_EOK;
- /* no waiting, return timeout */
- if (timeout == 0)
- {
- /* enable interrupt */
- rt_hw_interrupt_enable(temp);
- thread->error = -RT_ETIMEOUT;
- return -RT_ETIMEOUT;
- }
- /* suspend current thread */
- rt_ipc_list_suspend(&(mb->parent.suspend_thread),
- thread, mb->parent.parent.flag);
- /* has waiting time, start thread timer */
- if (timeout > 0)
- {
- /* get the start tick of timer */
- tick_delta = rt_tick_get();
- #ifdef RT_IPC_DEBUG
- rt_kprintf("mb_recv: start timer of thread:%s\n", thread->name);
- #endif
- /* reset the timeout of thread timer and start it */
- rt_timer_control(&(thread->thread_timer), RT_TIMER_CTRL_SET_TIME, &timeout);
- rt_timer_start(&(thread->thread_timer));
- }
- /* enable interrupt */
- rt_hw_interrupt_enable(temp);
- /* re-schedule */
- rt_schedule();
- /* resume from suspend state */
- if (thread->error != RT_EOK)
- {
- /* return error */
- return thread->error;
- }
- /* disable interrupt */
- temp = rt_hw_interrupt_disable();
- /* re-calculate timeout tick */
- if (timeout > 0)
- {
- tick_delta = rt_tick_get() - tick_delta;
- timeout -= tick_delta;
- if (timeout < 0) timeout = 0;
- }
- }
- /* fill ptr */
- *value = mb->msg_pool[mb->out_offset];
- /* increase output offset */
- ++mb->out_offset;
- mb->out_offset %= mb->size;
- /* decrease message entry */
- mb->entry --;
- /* resume suspended thread */
- if( !rt_list_isempty(&(mb->suspend_sender_thread)) )
- {
- rt_ipc_list_resume(&(mb->suspend_sender_thread));
- /* enable interrupt */
- rt_hw_interrupt_enable(temp);
- #ifdef RT_USING_HOOK
- if (rt_object_take_hook != RT_NULL) rt_object_take_hook(&(mb->parent.parent));
- #endif
- rt_schedule();
- return RT_EOK;
- }
- /* enable interrupt */
- rt_hw_interrupt_enable(temp);
- #ifdef RT_USING_HOOK
- if (rt_object_take_hook != RT_NULL) rt_object_take_hook(&(mb->parent.parent));
- #endif
- return RT_EOK;
- }
- /**
- * This function can get or set some extra attributions of a mailbox object.
- *
- * @param mb the mailbox object
- * @param cmd the execution command
- * @param arg the execution argument
- *
- * @return the error code
- */
- rt_err_t rt_mb_control(rt_mailbox_t mb, rt_uint8_t cmd, void* arg)
- {
- rt_ubase_t level;
- RT_ASSERT(mb != RT_NULL);
- if (cmd == RT_IPC_CMD_RESET)
- {
- /* disable interrupt */
- level = rt_hw_interrupt_disable();
- /* resume all waiting thread */
- rt_ipc_list_resume_all(&(mb->parent.suspend_thread));
- /* re-init mailbox */
- mb->entry = 0;
- mb->in_offset = 0;
- mb->out_offset = 0;
- /* enable interrupt */
- rt_hw_interrupt_enable(level);
- return RT_EOK;
- }
- return -RT_ERROR;
- }
- #endif /* end of RT_USING_MAILBOX */
- #ifdef RT_USING_MESSAGEQUEUE
- struct rt_mq_message
- {
- struct rt_mq_message* next;
- };
- /**
- * This function will initialize a message queue and put it under control of resource
- * management.
- *
- * @param mq the message object
- * @param name the name of message queue
- * @param msgpool the beginning address of buffer to save messages
- * @param msg_size the maximum size of message
- * @param pool_size the size of buffer to save messages
- * @param flag the flag of message queue
- *
- * @return the operation status, RT_EOK on successful
- */
- rt_err_t rt_mq_init(rt_mq_t mq, const char* name, void *msgpool, rt_size_t msg_size, rt_size_t pool_size, rt_uint8_t flag)
- {
- struct rt_mq_message* head;
- register rt_base_t temp;
- /* parameter check */
- RT_ASSERT(mq != RT_NULL);
- /* init object */
- rt_object_init(&(mq->parent.parent), RT_Object_Class_MessageQueue, name);
- /* set parent flag */
- mq->parent.parent.flag = flag;
- /* init ipc object */
- rt_ipc_object_init(&(mq->parent));
- /* set messasge pool */
- mq->msg_pool = msgpool;
- /* get correct message size */
- mq->msg_size = RT_ALIGN(msg_size, RT_ALIGN_SIZE);
- mq->max_msgs = pool_size / (mq->msg_size + sizeof(struct rt_mq_message));
- /* init message list */
- mq->msg_queue_head = RT_NULL;
- mq->msg_queue_tail = RT_NULL;
- /* init message empty list */
- mq->msg_queue_free = RT_NULL;
- for (temp = 0; temp < mq->max_msgs; temp ++)
- {
- head = (struct rt_mq_message*)((rt_uint8_t*)mq->msg_pool +
- temp * (mq->msg_size + sizeof(struct rt_mq_message)));
- head->next = mq->msg_queue_free;
- mq->msg_queue_free = head;
- }
- /* the initial entry is zero */
- mq->entry = 0;
- return RT_EOK;
- }
- /**
- * This function will detach a message queue object from resource management
- *
- * @param mq the message queue object
- *
- * @return the operation status, RT_EOK on successful
- */
- rt_err_t rt_mq_detach(rt_mq_t mq)
- {
- /* parameter check */
- RT_ASSERT(mq != RT_NULL);
- /* resume all suspended thread */
- rt_ipc_list_resume_all(&mq->parent.suspend_thread);
- /* detach message queue object */
- rt_object_detach(&(mq->parent.parent));
- return RT_EOK;
- }
- #ifdef RT_USING_HEAP
- /**
- * This function will create a message queue object from system resource
- *
- * @param name the name of message queue
- * @param msg_size the size of message
- * @param max_msgs the maximum number of message in queue
- * @param flag the flag of message queue
- *
- * @return the created message queue, RT_NULL on error happen
- */
- rt_mq_t rt_mq_create (const char* name, rt_size_t msg_size, rt_size_t max_msgs, rt_uint8_t flag)
- {
- struct rt_messagequeue* mq;
- struct rt_mq_message* head;
- register rt_base_t temp;
- /* allocate object */
- mq = (rt_mq_t) rt_object_allocate(RT_Object_Class_MessageQueue, name);
- if (mq == RT_NULL) return mq;
- /* set parent */
- mq->parent.parent.flag = flag;
- /* init ipc object */
- rt_ipc_object_init(&(mq->parent));
- /* init message queue */
- /* get correct message size */
- mq->msg_size = RT_ALIGN(msg_size, RT_ALIGN_SIZE);
- mq->max_msgs = max_msgs;
- /* allocate message pool */
- mq->msg_pool = rt_malloc((mq->msg_size + sizeof(struct rt_mq_message))* mq->max_msgs);
- if (mq->msg_pool == RT_NULL)
- {
- rt_mq_delete(mq);
- return RT_NULL;
- }
- /* init message list */
- mq->msg_queue_head = RT_NULL;
- mq->msg_queue_tail = RT_NULL;
- /* init message empty list */
- mq->msg_queue_free = RT_NULL;
- for (temp = 0; temp < mq->max_msgs; temp ++)
- {
- head = (struct rt_mq_message*)((rt_uint8_t*)mq->msg_pool +
- temp * (mq->msg_size + sizeof(struct rt_mq_message)));
- head->next = mq->msg_queue_free;
- mq->msg_queue_free = head;
- }
- /* the initial entry is zero */
- mq->entry = 0;
- return mq;
- }
- /**
- * This function will delete a message queue object and release the memory
- *
- * @param mq the message queue object
- *
- * @return the error code
- */
- rt_err_t rt_mq_delete (rt_mq_t mq)
- {
- /* parameter check */
- RT_ASSERT(mq != RT_NULL);
- /* resume all suspended thread */
- rt_ipc_list_resume_all(&(mq->parent.suspend_thread));
- #ifdef RT_USING_MODULE
- /* the mq object belongs to an application module */
- if(mq->parent.parent.flag & RT_OBJECT_FLAG_MODULE)
- rt_module_free(mq->parent.parent.module_id, mq->msg_pool);
- else
- #endif
- /* free message queue pool */
- rt_free(mq->msg_pool);
- /* delete message queue object */
- rt_object_delete(&(mq->parent.parent));
- return RT_EOK;
- }
- #endif
- /**
- * This function will send a message to message queue object, if there are threads
- * suspended on message queue object, it will be waked up.
- *
- * @param mq the message queue object
- * @param buffer the message
- * @param size the size of buffer
- *
- * @return the error code
- */
- rt_err_t rt_mq_send (rt_mq_t mq, void* buffer, rt_size_t size)
- {
- register rt_ubase_t temp;
- struct rt_mq_message *msg;
- /* greater than one message size */
- if (size > mq->msg_size) return -RT_ERROR;
- #ifdef RT_USING_HOOK
- if (rt_object_put_hook != RT_NULL) rt_object_put_hook(&(mq->parent.parent));
- #endif
- /* disable interrupt */
- temp = rt_hw_interrupt_disable();
- /* get a free list, there must be an empty item */
- msg = (struct rt_mq_message*)mq->msg_queue_free;
- /* message queue is full */
- if (msg == RT_NULL)
- {
- /* enable interrupt */
- rt_hw_interrupt_enable(temp);
- return -RT_EFULL;
- }
- /* move free list pointer */
- mq->msg_queue_free = msg->next;
- /* enable interrupt */
- rt_hw_interrupt_enable(temp);
- /* the msg is the new tailer of list, the next shall be NULL */
- msg->next = RT_NULL;
- /* copy buffer */
- rt_memcpy(msg + 1, buffer, size);
- /* disable interrupt */
- temp = rt_hw_interrupt_disable();
- /* link msg to message queue */
- if (mq->msg_queue_tail != RT_NULL)
- {
- /* if the tail exists, */
- ((struct rt_mq_message*)mq->msg_queue_tail)->next = msg;
- }
- /* set new tail */
- mq->msg_queue_tail = msg;
- /* if the head is empty, set head */
- if (mq->msg_queue_head == RT_NULL)mq->msg_queue_head = msg;
- /* increase message entry */
- mq->entry ++;
- /* resume suspended thread */
- if( !rt_list_isempty(&mq->parent.suspend_thread) )
- {
- rt_ipc_list_resume(&(mq->parent.suspend_thread));
- /* enable interrupt */
- rt_hw_interrupt_enable(temp);
- rt_schedule();
- return RT_EOK;
- }
- /* enable interrupt */
- rt_hw_interrupt_enable(temp);
- return RT_EOK;
- }
- /**
- * This function will send urgently a message to message queue object, which means
- * the message will be inserted to the head of message queue. If there are threads
- * suspended on message queue object, it will be waked up.
- *
- * @param mq the message queue object
- * @param buffer the message
- * @param size the size of buffer
- *
- * @return the error code
- */
- rt_err_t rt_mq_urgent(rt_mq_t mq, void* buffer, rt_size_t size)
- {
- register rt_ubase_t temp;
- struct rt_mq_message *msg;
- /* greater than one message size */
- if (size > mq->msg_size) return -RT_ERROR;
- #ifdef RT_USING_HOOK
- if (rt_object_put_hook != RT_NULL) rt_object_put_hook(&(mq->parent.parent));
- #endif
- /* disable interrupt */
- temp = rt_hw_interrupt_disable();
- /* get a free list, there must be an empty item */
- msg = (struct rt_mq_message*)mq->msg_queue_free;
- /* message queue is full */
- if (msg == RT_NULL)
- {
- /* enable interrupt */
- rt_hw_interrupt_enable(temp);
- return -RT_EFULL;
- }
- /* move free list pointer */
- mq->msg_queue_free = msg->next;
- /* enable interrupt */
- rt_hw_interrupt_enable(temp);
- /* copy buffer */
- rt_memcpy(msg + 1, buffer, size);
- /* disable interrupt */
- temp = rt_hw_interrupt_disable();
- /* link msg to the beginning of message queue */
- msg->next = mq->msg_queue_head;
- mq->msg_queue_head = msg;
- /* if there is no tail */
- if (mq->msg_queue_tail == RT_NULL) mq->msg_queue_tail = msg;
- /* increase message entry */
- mq->entry ++;
- /* resume suspended thread */
- if( !rt_list_isempty(&mq->parent.suspend_thread) )
- {
- rt_ipc_list_resume(&(mq->parent.suspend_thread));
- /* enable interrupt */
- rt_hw_interrupt_enable(temp);
- rt_schedule();
- return RT_EOK;
- }
- /* enable interrupt */
- rt_hw_interrupt_enable(temp);
- return RT_EOK;
- }
- /**
- * This function will receive a message from message queue object, if there is no
- * message in message queue object, the thread shall wait for a specified time.
- *
- * @param mq the message queue object
- * @param buffer the received message will be saved in
- * @param size the size of buffer
- * @param timeout the waiting time
- *
- * @return the error code
- */
- rt_err_t rt_mq_recv (rt_mq_t mq, void* buffer, rt_size_t size, rt_int32_t timeout)
- {
- struct rt_thread *thread;
- register rt_ubase_t temp;
- struct rt_mq_message *msg;
- rt_uint32_t tick_delta;
- #ifdef RT_USING_HOOK
- if (rt_object_trytake_hook != RT_NULL) rt_object_trytake_hook(&(mq->parent.parent));
- #endif
- tick_delta = 0;
- /* get current thread */
- thread = rt_thread_self();
- /* disable interrupt */
- temp = rt_hw_interrupt_disable();
- /* message queue is empty */
- while (mq->entry == 0)
- {
- /* reset error number in thread */
- thread->error = RT_EOK;
- /* no waiting, return timeout */
- if (timeout == 0)
- {
- /* enable interrupt */
- rt_hw_interrupt_enable(temp);
- thread->error = -RT_ETIMEOUT;
- return -RT_ETIMEOUT;
- }
- /* suspend current thread */
- rt_ipc_list_suspend(&(mq->parent.suspend_thread),
- thread, mq->parent.parent.flag);
- /* has waiting time, start thread timer */
- if (timeout > 0)
- {
- /* get the start tick of timer */
- tick_delta = rt_tick_get();
- #ifdef RT_IPC_DEBUG
- rt_kprintf("set thread:%s to timer list\n", thread->name);
- #endif
- /* reset the timeout of thread timer and start it */
- rt_timer_control(&(thread->thread_timer), RT_TIMER_CTRL_SET_TIME, &timeout);
- rt_timer_start(&(thread->thread_timer));
- }
- /* enable interrupt */
- rt_hw_interrupt_enable(temp);
- /* re-schedule */
- rt_schedule();
- /* recv message */
- if (thread->error != RT_EOK)
- {
- /* return error */
- return thread->error;
- }
- /* disable interrupt */
- temp = rt_hw_interrupt_disable();
- /* re-calculate timeout tick */
- if (timeout > 0)
- {
- tick_delta = rt_tick_get() - tick_delta;
- timeout -= tick_delta;
- if (timeout < 0) timeout = 0;
- }
- }
- /* get message from queue */
- msg = (struct rt_mq_message*) mq->msg_queue_head;
- /* move message queue head */
- mq->msg_queue_head = msg->next;
- /* reach queue tail, set to NULL */
- if (mq->msg_queue_tail == msg) mq->msg_queue_tail = RT_NULL;
- /* decrease message entry */
- mq->entry --;
- /* enable interrupt */
- rt_hw_interrupt_enable(temp);
- /* copy message */
- rt_memcpy(buffer, msg + 1,
- size > mq->msg_size? mq->msg_size : size);
- /* disable interrupt */
- temp = rt_hw_interrupt_disable();
- /* put message to free list */
- msg->next = (struct rt_mq_message*)mq->msg_queue_free;
- mq->msg_queue_free = msg;
- /* enable interrupt */
- rt_hw_interrupt_enable(temp);
- #ifdef RT_USING_HOOK
- if (rt_object_take_hook != RT_NULL) rt_object_take_hook(&(mq->parent.parent));
- #endif
- return RT_EOK;
- }
- /**
- * This function can get or set some extra attributions of a message queue object.
- *
- * @param mq the message queue object
- * @param cmd the execution command
- * @param arg the execution argument
- *
- * @return the error code
- */
- rt_err_t rt_mq_control(rt_mq_t mq, rt_uint8_t cmd, void* arg)
- {
- rt_ubase_t level;
- struct rt_mq_message *msg;
- RT_ASSERT(mq != RT_NULL);
- if (cmd == RT_IPC_CMD_RESET)
- {
- /* disable interrupt */
- level = rt_hw_interrupt_disable();
- /* resume all waiting thread */
- rt_ipc_list_resume_all(&mq->parent.suspend_thread);
- /* release all message in the queue */
- while (mq->msg_queue_head != RT_NULL)
- {
- /* get message from queue */
- msg = (struct rt_mq_message*) mq->msg_queue_head;
- /* move message queue head */
- mq->msg_queue_head = msg->next;
- /* reach queue tail, set to NULL */
- if (mq->msg_queue_tail == msg) mq->msg_queue_tail = RT_NULL;
- /* put message to free list */
- msg->next = (struct rt_mq_message*)mq->msg_queue_free;
- mq->msg_queue_free = msg;
- }
- /* clean entry */
- mq->entry = 0;
- /* enable interrupt */
- rt_hw_interrupt_enable(level);
- return RT_EOK;
- }
- return -RT_ERROR;
- }
- #endif /* end of RT_USING_MESSAGEQUEUE */
- /*@}*/
|