ipc.c 69.0 KB
Newer Older
1
/*
mysterywolf's avatar
mysterywolf 已提交
2
 * Copyright (c) 2006-2021, RT-Thread Development Team
B
Bernard Xiong 已提交
3
 *
4
 * SPDX-License-Identifier: Apache-2.0
5 6 7 8 9
 *
 * Change Logs:
 * Date           Author       Notes
 * 2006-03-14     Bernard      the first version
 * 2006-04-25     Bernard      implement semaphore
10
 * 2006-05-03     Bernard      add RT_IPC_DEBUG
11 12 13 14 15 16 17 18 19 20
 *                             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
B
bernard.xiong 已提交
21
 * 2009-05-21     Yi.qiu       fix the sem release bug
22 23
 * 2009-07-18     Bernard      fix the event clear bug
 * 2009-09-09     Bernard      remove fast event and fix ipc release bug
24
 * 2009-10-10     Bernard      change semaphore and mutex value to unsigned value
B
bernard.xiong 已提交
25
 * 2009-10-25     Bernard      change the mb/mq receive timeout to 0 if the
26
 *                             re-calculated delta tick is a negative number.
B
bernard.xiong 已提交
27
 * 2009-12-16     Bernard      fix the rt_ipc_object_suspend issue when IPC flag
28
 *                             is RT_IPC_FLAG_PRIO
29
 * 2010-01-20     mbbill       remove rt_ipc_object_decrease function.
30
 * 2010-04-20     Bernard      move memcpy outside interrupt disable in mq
qiuyiuestc's avatar
qiuyiuestc 已提交
31
 * 2010-10-26     yi.qiu       add module support in rt_mp_delete and rt_mq_delete
32
 * 2010-11-10     Bernard      add IPC reset command implementation.
33
 * 2011-12-18     Bernard      add more parameter checking in message queue
34
 * 2013-09-14     Grissiom     add an option check in rt_event_recv
B
Bernard Xiong 已提交
35
 * 2018-10-02     Bernard      add 64bit support for mailbox
36
 * 2019-09-16     tyx          add send wait support for message queue
mysterywolf's avatar
mysterywolf 已提交
37
 * 2020-07-29     Meco Man     fix thread->event_set/event_info when received an
mysterywolf's avatar
mysterywolf 已提交
38
 *                             event without pending
39
 * 2020-10-11     Meco Man     add value overflow-check code
mysterywolf's avatar
mysterywolf 已提交
40 41
 * 2021-01-03     Meco Man     implement rt_mb_urgent()
 * 2021-05-30     Meco Man     implement rt_mutex_trytake()
42 43 44 45 46 47
 */

#include <rtthread.h>
#include <rthw.h>

#ifdef RT_USING_HOOK
D
dzzxzz 已提交
48 49 50
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);
51
#endif /* RT_USING_HOOK */
52 53 54 55 56

/**
 * @addtogroup IPC
 */

D
dogandog 已提交
57
/**@{*/
58 59 60 61 62 63 64 65 66 67

/**
 * 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)
{
B
Bernard Xiong 已提交
68
    /* initialize ipc object */
D
dzzxzz@gmail.com 已提交
69
    rt_list_init(&(ipc->suspend_thread));
70

D
dzzxzz@gmail.com 已提交
71
    return RT_EOK;
72 73 74
}

/**
D
dzzxzz@gmail.com 已提交
75 76
 * This function will suspend a thread to a specified list. IPC object or some
 * double-queue object (mailbox etc.) contains this kind of list.
77
 *
B
bernard.xiong@gmail.com 已提交
78
 * @param list the IPC suspended thread list
79
 * @param thread the thread object to be suspended
D
dzzxzz@gmail.com 已提交
80 81
 * @param flag the IPC object flag,
 *        which shall be RT_IPC_FLAG_FIFO/RT_IPC_FLAG_PRIO.
82 83 84
 *
 * @return the operation status, RT_EOK on successful
 */
D
dzzxzz@gmail.com 已提交
85 86 87
rt_inline rt_err_t rt_ipc_list_suspend(rt_list_t        *list,
                                       struct rt_thread *thread,
                                       rt_uint8_t        flag)
88
{
D
dzzxzz@gmail.com 已提交
89 90 91 92 93 94 95
    /* suspend thread */
    rt_thread_suspend(thread);

    switch (flag)
    {
    case RT_IPC_FLAG_FIFO:
        rt_list_insert_before(list, &(thread->tlist));
96
        break; /* RT_IPC_FLAG_FIFO */
D
dzzxzz@gmail.com 已提交
97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123

    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));
        }
124
        break;/* RT_IPC_FLAG_PRIO */
C
chenchaoqun 已提交
125 126

    default:
T
tangyuxin 已提交
127
        RT_ASSERT(0);
mysterywolf's avatar
mysterywolf 已提交
128
        break;
D
dzzxzz@gmail.com 已提交
129 130 131
    }

    return RT_EOK;
132 133 134
}

/**
135
 * This function will resume the first thread in the list of a IPC object:
136 137 138
 * - remove the thread from suspend queue of IPC object
 * - put the thread into system ready queue
 *
139
 * @param list the thread list
140 141 142
 *
 * @return the operation status, RT_EOK on successful
 */
D
dzzxzz 已提交
143
rt_inline rt_err_t rt_ipc_list_resume(rt_list_t *list)
144
{
D
dzzxzz@gmail.com 已提交
145
    struct rt_thread *thread;
146

D
dzzxzz@gmail.com 已提交
147 148
    /* get thread entry */
    thread = rt_list_entry(list->next, struct rt_thread, tlist);
149

D
dzzxzz@gmail.com 已提交
150
    RT_DEBUG_LOG(RT_DEBUG_IPC, ("resume thread:%s\n", thread->name));
151

D
dzzxzz@gmail.com 已提交
152 153
    /* resume it */
    rt_thread_resume(thread);
154

D
dzzxzz@gmail.com 已提交
155
    return RT_EOK;
156 157 158
}

/**
159 160
 * This function will resume all suspended threads in a list, including
 * suspend list of IPC object and private list of mailbox etc.
161
 *
162
 * @param list of the threads to resume
163 164 165
 *
 * @return the operation status, RT_EOK on successful
 */
D
dzzxzz 已提交
166
rt_inline rt_err_t rt_ipc_list_resume_all(rt_list_t *list)
167
{
D
dzzxzz@gmail.com 已提交
168 169 170
    struct rt_thread *thread;
    register rt_ubase_t temp;

B
Bernard Xiong 已提交
171
    /* wakeup all suspended threads */
D
dzzxzz@gmail.com 已提交
172 173 174 175 176
    while (!rt_list_isempty(list))
    {
        /* disable interrupt */
        temp = rt_hw_interrupt_disable();

B
Bernard Xiong 已提交
177
        /* get next suspended thread */
D
dzzxzz@gmail.com 已提交
178 179 180 181 182 183 184
        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
B
Bernard Xiong 已提交
185
         * suspended list
D
dzzxzz@gmail.com 已提交
186 187 188 189 190 191 192 193
         */
        rt_thread_resume(thread);

        /* enable interrupt */
        rt_hw_interrupt_enable(temp);
    }

    return RT_EOK;
194 195 196 197
}

#ifdef RT_USING_SEMAPHORE
/**
D
dzzxzz@gmail.com 已提交
198 199
 * This function will initialize a semaphore and put it under control of
 * resource management.
200 201 202
 *
 * @param sem the semaphore object
 * @param name the name of semaphore
B
Bernard Xiong 已提交
203
 * @param value the initial value of semaphore
204 205 206 207
 * @param flag the flag of semaphore
 *
 * @return the operation status, RT_EOK on successful
 */
D
dzzxzz@gmail.com 已提交
208 209 210 211
rt_err_t rt_sem_init(rt_sem_t    sem,
                     const char *name,
                     rt_uint32_t value,
                     rt_uint8_t  flag)
212
{
D
dzzxzz@gmail.com 已提交
213
    RT_ASSERT(sem != RT_NULL);
214
    RT_ASSERT(value < 0x10000U);
215

B
Bernard Xiong 已提交
216
    /* initialize object */
D
dzzxzz@gmail.com 已提交
217
    rt_object_init(&(sem->parent.parent), RT_Object_Class_Semaphore, name);
218

B
Bernard Xiong 已提交
219
    /* initialize ipc object */
D
dzzxzz@gmail.com 已提交
220
    rt_ipc_object_init(&(sem->parent));
221

B
Bernard Xiong 已提交
222
    /* set initial value */
223
    sem->value = (rt_uint16_t)value;
224

D
dzzxzz@gmail.com 已提交
225 226
    /* set parent */
    sem->parent.parent.flag = flag;
227

D
dzzxzz@gmail.com 已提交
228
    return RT_EOK;
229
}
230
RTM_EXPORT(rt_sem_init);
231 232 233 234 235 236 237 238 239 240

/**
 * 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
 */
D
dzzxzz 已提交
241
rt_err_t rt_sem_detach(rt_sem_t sem)
242
{
243
    /* parameter check */
D
dzzxzz@gmail.com 已提交
244
    RT_ASSERT(sem != RT_NULL);
245 246
    RT_ASSERT(rt_object_get_type(&sem->parent.parent) == RT_Object_Class_Semaphore);
    RT_ASSERT(rt_object_is_systemobject(&sem->parent.parent));
247

B
Bernard Xiong 已提交
248
    /* wakeup all suspended threads */
D
dzzxzz@gmail.com 已提交
249
    rt_ipc_list_resume_all(&(sem->parent.suspend_thread));
250

D
dzzxzz@gmail.com 已提交
251 252
    /* detach semaphore object */
    rt_object_detach(&(sem->parent.parent));
253

D
dzzxzz@gmail.com 已提交
254
    return RT_EOK;
255
}
256
RTM_EXPORT(rt_sem_detach);
257 258 259 260 261 262

#ifdef RT_USING_HEAP
/**
 * This function will create a semaphore from system resource
 *
 * @param name the name of semaphore
B
Bernard Xiong 已提交
263
 * @param value the initial value of semaphore
264 265 266 267 268 269
 * @param flag the flag of semaphore
 *
 * @return the created semaphore, RT_NULL on error happen
 *
 * @see rt_sem_init
 */
D
dzzxzz 已提交
270
rt_sem_t rt_sem_create(const char *name, rt_uint32_t value, rt_uint8_t flag)
271
{
D
dzzxzz@gmail.com 已提交
272
    rt_sem_t sem;
273

D
dzzxzz@gmail.com 已提交
274
    RT_DEBUG_NOT_IN_INTERRUPT;
275
    RT_ASSERT(value < 0x10000U);
276

D
dzzxzz@gmail.com 已提交
277 278 279 280
    /* allocate object */
    sem = (rt_sem_t)rt_object_allocate(RT_Object_Class_Semaphore, name);
    if (sem == RT_NULL)
        return sem;
281

B
Bernard Xiong 已提交
282
    /* initialize ipc object */
D
dzzxzz@gmail.com 已提交
283
    rt_ipc_object_init(&(sem->parent));
284

B
Bernard Xiong 已提交
285
    /* set initial value */
D
dzzxzz@gmail.com 已提交
286
    sem->value = value;
287

D
dzzxzz@gmail.com 已提交
288 289
    /* set parent */
    sem->parent.parent.flag = flag;
290

D
dzzxzz@gmail.com 已提交
291
    return sem;
292
}
293
RTM_EXPORT(rt_sem_create);
294 295 296 297 298 299 300 301 302 303

/**
 * This function will delete a semaphore object and release the memory
 *
 * @param sem the semaphore object
 *
 * @return the error code
 *
 * @see rt_sem_detach
 */
D
dzzxzz 已提交
304
rt_err_t rt_sem_delete(rt_sem_t sem)
305
{
D
dzzxzz@gmail.com 已提交
306
    RT_DEBUG_NOT_IN_INTERRUPT;
307

308
    /* parameter check */
D
dzzxzz@gmail.com 已提交
309
    RT_ASSERT(sem != RT_NULL);
310 311
    RT_ASSERT(rt_object_get_type(&sem->parent.parent) == RT_Object_Class_Semaphore);
    RT_ASSERT(rt_object_is_systemobject(&sem->parent.parent) == RT_FALSE);
312

B
Bernard Xiong 已提交
313
    /* wakeup all suspended threads */
D
dzzxzz@gmail.com 已提交
314
    rt_ipc_list_resume_all(&(sem->parent.suspend_thread));
315

D
dzzxzz@gmail.com 已提交
316 317
    /* delete semaphore object */
    rt_object_delete(&(sem->parent.parent));
318

D
dzzxzz@gmail.com 已提交
319
    return RT_EOK;
320
}
321
RTM_EXPORT(rt_sem_delete);
322
#endif /* RT_USING_HEAP */
323 324 325 326 327 328 329 330 331 332

/**
 * 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
 */
D
dzzxzz 已提交
333
rt_err_t rt_sem_take(rt_sem_t sem, rt_int32_t time)
334
{
D
dzzxzz@gmail.com 已提交
335 336
    register rt_base_t temp;
    struct rt_thread *thread;
337

338
    /* parameter check */
D
dzzxzz@gmail.com 已提交
339
    RT_ASSERT(sem != RT_NULL);
340
    RT_ASSERT(rt_object_get_type(&sem->parent.parent) == RT_Object_Class_Semaphore);
341

D
dzzxzz@gmail.com 已提交
342
    RT_OBJECT_HOOK_CALL(rt_object_trytake_hook, (&(sem->parent.parent)));
343

D
dzzxzz@gmail.com 已提交
344 345
    /* disable interrupt */
    temp = rt_hw_interrupt_disable();
346

D
dzzxzz@gmail.com 已提交
347
    RT_DEBUG_LOG(RT_DEBUG_IPC, ("thread %s take sem:%s, which value is: %d\n",
348 349 350
                                rt_thread_self()->name,
                                ((struct rt_object *)sem)->name,
                                sem->value));
351

D
dzzxzz@gmail.com 已提交
352 353 354 355 356 357 358 359 360 361 362 363 364 365 366 367 368 369 370 371
    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
        {
            /* current context checking */
G
Grissiom 已提交
372
            RT_DEBUG_IN_THREAD_CONTEXT;
D
dzzxzz@gmail.com 已提交
373 374 375 376 377 378 379 380 381

            /* semaphore is unavailable, push to suspend list */
            /* get current thread */
            thread = rt_thread_self();

            /* reset thread error number */
            thread->error = RT_EOK;

            RT_DEBUG_LOG(RT_DEBUG_IPC, ("sem take: suspend thread - %s\n",
382
                                        thread->name));
383

D
dzzxzz@gmail.com 已提交
384 385 386 387
            /* suspend thread */
            rt_ipc_list_suspend(&(sem->parent.suspend_thread),
                                thread,
                                sem->parent.parent.flag);
388

D
dzzxzz@gmail.com 已提交
389 390 391 392
            /* has waiting time, start thread timer */
            if (time > 0)
            {
                RT_DEBUG_LOG(RT_DEBUG_IPC, ("set thread:%s to timer list\n",
393
                                            thread->name));
394

D
dzzxzz@gmail.com 已提交
395 396 397 398 399 400
                /* 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));
            }
401

D
dzzxzz@gmail.com 已提交
402 403
            /* enable interrupt */
            rt_hw_interrupt_enable(temp);
404

D
dzzxzz@gmail.com 已提交
405 406
            /* do schedule */
            rt_schedule();
407

D
dzzxzz@gmail.com 已提交
408 409 410 411 412 413
            if (thread->error != RT_EOK)
            {
                return thread->error;
            }
        }
    }
414

D
dzzxzz@gmail.com 已提交
415
    RT_OBJECT_HOOK_CALL(rt_object_take_hook, (&(sem->parent.parent)));
416

D
dzzxzz@gmail.com 已提交
417
    return RT_EOK;
418
}
419
RTM_EXPORT(rt_sem_take);
420 421 422 423 424 425 426 427 428 429

/**
 * 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)
{
mysterywolf's avatar
mysterywolf 已提交
430
    return rt_sem_take(sem, RT_WAITING_NO);
431
}
432
RTM_EXPORT(rt_sem_trytake);
433 434 435 436 437 438 439 440 441 442 443

/**
 * 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)
{
D
dzzxzz@gmail.com 已提交
444 445
    register rt_base_t temp;
    register rt_bool_t need_schedule;
446

447 448 449 450
    /* parameter check */
    RT_ASSERT(sem != RT_NULL);
    RT_ASSERT(rt_object_get_type(&sem->parent.parent) == RT_Object_Class_Semaphore);

D
dzzxzz@gmail.com 已提交
451
    RT_OBJECT_HOOK_CALL(rt_object_put_hook, (&(sem->parent.parent)));
452

D
dzzxzz@gmail.com 已提交
453
    need_schedule = RT_FALSE;
454

D
dzzxzz@gmail.com 已提交
455 456
    /* disable interrupt */
    temp = rt_hw_interrupt_disable();
457

D
dzzxzz@gmail.com 已提交
458
    RT_DEBUG_LOG(RT_DEBUG_IPC, ("thread %s releases sem:%s, which value is: %d\n",
459 460 461
                                rt_thread_self()->name,
                                ((struct rt_object *)sem)->name,
                                sem->value));
462

D
dzzxzz@gmail.com 已提交
463 464 465 466 467 468 469
    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
mysterywolf's avatar
mysterywolf 已提交
470
    {
mysterywolf's avatar
mysterywolf 已提交
471
        if(sem->value < RT_SEM_VALUE_MAX)
mysterywolf's avatar
mysterywolf 已提交
472 473 474 475 476 477 478 479 480
        {
            sem->value ++; /* increase value */
        }
        else
        {
            rt_hw_interrupt_enable(temp); /* enable interrupt */
            return -RT_EFULL; /* value overflowed */
        }
    }
481

D
dzzxzz@gmail.com 已提交
482 483
    /* enable interrupt */
    rt_hw_interrupt_enable(temp);
484

D
dzzxzz@gmail.com 已提交
485 486 487
    /* resume a thread, re-schedule */
    if (need_schedule == RT_TRUE)
        rt_schedule();
488

D
dzzxzz@gmail.com 已提交
489
    return RT_EOK;
490
}
491
RTM_EXPORT(rt_sem_release);
492 493 494 495 496 497 498 499 500 501

/**
 * 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
 */
B
bernard 已提交
502
rt_err_t rt_sem_control(rt_sem_t sem, int cmd, void *arg)
503
{
D
dzzxzz@gmail.com 已提交
504
    rt_ubase_t level;
505 506

    /* parameter check */
D
dzzxzz@gmail.com 已提交
507
    RT_ASSERT(sem != RT_NULL);
508
    RT_ASSERT(rt_object_get_type(&sem->parent.parent) == RT_Object_Class_Semaphore);
509

D
dzzxzz@gmail.com 已提交
510 511
    if (cmd == RT_IPC_CMD_RESET)
    {
B
Bernard Xiong 已提交
512
        rt_ubase_t value;
513

D
dzzxzz@gmail.com 已提交
514
        /* get value */
B
Bernard Xiong 已提交
515
        value = (rt_ubase_t)arg;
D
dzzxzz@gmail.com 已提交
516 517
        /* disable interrupt */
        level = rt_hw_interrupt_disable();
518

D
dzzxzz@gmail.com 已提交
519 520
        /* resume all waiting thread */
        rt_ipc_list_resume_all(&sem->parent.suspend_thread);
521

D
dzzxzz@gmail.com 已提交
522 523
        /* set new value */
        sem->value = (rt_uint16_t)value;
524

D
dzzxzz@gmail.com 已提交
525 526
        /* enable interrupt */
        rt_hw_interrupt_enable(level);
527

D
dzzxzz@gmail.com 已提交
528
        rt_schedule();
529

D
dzzxzz@gmail.com 已提交
530 531
        return RT_EOK;
    }
532

D
dzzxzz@gmail.com 已提交
533
    return -RT_ERROR;
534
}
535
RTM_EXPORT(rt_sem_control);
536
#endif /* RT_USING_SEMAPHORE */
537 538 539 540 541 542 543 544 545 546 547 548

#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
 */
D
dzzxzz 已提交
549
rt_err_t rt_mutex_init(rt_mutex_t mutex, const char *name, rt_uint8_t flag)
550
{
551
    /* parameter check */
D
dzzxzz@gmail.com 已提交
552
    RT_ASSERT(mutex != RT_NULL);
553

B
Bernard Xiong 已提交
554
    /* initialize object */
D
dzzxzz@gmail.com 已提交
555
    rt_object_init(&(mutex->parent.parent), RT_Object_Class_Mutex, name);
556

B
Bernard Xiong 已提交
557
    /* initialize ipc object */
D
dzzxzz@gmail.com 已提交
558
    rt_ipc_object_init(&(mutex->parent));
559

D
dzzxzz@gmail.com 已提交
560 561 562 563
    mutex->value = 1;
    mutex->owner = RT_NULL;
    mutex->original_priority = 0xFF;
    mutex->hold  = 0;
564

D
dzzxzz@gmail.com 已提交
565 566
    /* set flag */
    mutex->parent.parent.flag = flag;
567

D
dzzxzz@gmail.com 已提交
568
    return RT_EOK;
569
}
570
RTM_EXPORT(rt_mutex_init);
571 572 573 574 575 576 577 578 579 580

/**
 * 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
 */
D
dzzxzz 已提交
581
rt_err_t rt_mutex_detach(rt_mutex_t mutex)
582
{
583
    /* parameter check */
D
dzzxzz@gmail.com 已提交
584
    RT_ASSERT(mutex != RT_NULL);
585 586
    RT_ASSERT(rt_object_get_type(&mutex->parent.parent) == RT_Object_Class_Mutex);
    RT_ASSERT(rt_object_is_systemobject(&mutex->parent.parent));
587

B
Bernard Xiong 已提交
588
    /* wakeup all suspended threads */
D
dzzxzz@gmail.com 已提交
589
    rt_ipc_list_resume_all(&(mutex->parent.suspend_thread));
590

591
    /* detach mutex object */
D
dzzxzz@gmail.com 已提交
592
    rt_object_detach(&(mutex->parent.parent));
593

D
dzzxzz@gmail.com 已提交
594
    return RT_EOK;
595
}
596
RTM_EXPORT(rt_mutex_detach);
597 598 599 600 601 602 603 604 605 606 607 608

#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
 */
D
dzzxzz 已提交
609
rt_mutex_t rt_mutex_create(const char *name, rt_uint8_t flag)
610
{
D
dzzxzz@gmail.com 已提交
611
    struct rt_mutex *mutex;
612

D
dzzxzz@gmail.com 已提交
613
    RT_DEBUG_NOT_IN_INTERRUPT;
614

D
dzzxzz@gmail.com 已提交
615 616 617 618
    /* allocate object */
    mutex = (rt_mutex_t)rt_object_allocate(RT_Object_Class_Mutex, name);
    if (mutex == RT_NULL)
        return mutex;
619

B
Bernard Xiong 已提交
620
    /* initialize ipc object */
D
dzzxzz@gmail.com 已提交
621
    rt_ipc_object_init(&(mutex->parent));
622

D
dzzxzz@gmail.com 已提交
623 624 625 626
    mutex->value              = 1;
    mutex->owner              = RT_NULL;
    mutex->original_priority  = 0xFF;
    mutex->hold               = 0;
627

D
dzzxzz@gmail.com 已提交
628 629
    /* set flag */
    mutex->parent.parent.flag = flag;
630

D
dzzxzz@gmail.com 已提交
631
    return mutex;
632
}
633
RTM_EXPORT(rt_mutex_create);
634 635 636 637 638 639 640 641 642 643

/**
 * This function will delete a mutex object and release the memory
 *
 * @param mutex the mutex object
 *
 * @return the error code
 *
 * @see rt_mutex_detach
 */
D
dzzxzz 已提交
644
rt_err_t rt_mutex_delete(rt_mutex_t mutex)
645
{
D
dzzxzz@gmail.com 已提交
646
    RT_DEBUG_NOT_IN_INTERRUPT;
647

648
    /* parameter check */
D
dzzxzz@gmail.com 已提交
649
    RT_ASSERT(mutex != RT_NULL);
650 651
    RT_ASSERT(rt_object_get_type(&mutex->parent.parent) == RT_Object_Class_Mutex);
    RT_ASSERT(rt_object_is_systemobject(&mutex->parent.parent) == RT_FALSE);
652

B
Bernard Xiong 已提交
653
    /* wakeup all suspended threads */
D
dzzxzz@gmail.com 已提交
654
    rt_ipc_list_resume_all(&(mutex->parent.suspend_thread));
655

I
iglencao 已提交
656
    /* delete mutex object */
D
dzzxzz@gmail.com 已提交
657
    rt_object_delete(&(mutex->parent.parent));
658

D
dzzxzz@gmail.com 已提交
659
    return RT_EOK;
660
}
661
RTM_EXPORT(rt_mutex_delete);
662
#endif /* RT_USING_HEAP */
663 664 665 666 667 668 669 670 671 672

/**
 * 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
 */
D
dzzxzz 已提交
673
rt_err_t rt_mutex_take(rt_mutex_t mutex, rt_int32_t time)
674
{
D
dzzxzz@gmail.com 已提交
675 676
    register rt_base_t temp;
    struct rt_thread *thread;
677

B
bernard 已提交
678 679 680
    /* this function must not be used in interrupt even if time = 0 */
    RT_DEBUG_IN_THREAD_CONTEXT;

681
    /* parameter check */
682
    RT_ASSERT(mutex != RT_NULL);
683
    RT_ASSERT(rt_object_get_type(&mutex->parent.parent) == RT_Object_Class_Mutex);
684 685 686

    /* get current thread */
    thread = rt_thread_self();
687

D
dzzxzz@gmail.com 已提交
688 689
    /* disable interrupt */
    temp = rt_hw_interrupt_disable();
690

D
dzzxzz@gmail.com 已提交
691
    RT_OBJECT_HOOK_CALL(rt_object_trytake_hook, (&(mutex->parent.parent)));
692

D
dzzxzz@gmail.com 已提交
693
    RT_DEBUG_LOG(RT_DEBUG_IPC,
694 695
                 ("mutex_take: current thread %s, mutex value: %d, hold: %d\n",
                  thread->name, mutex->value, mutex->hold));
696

D
dzzxzz@gmail.com 已提交
697 698 699 700 701
    /* reset thread error */
    thread->error = RT_EOK;

    if (mutex->owner == thread)
    {
mysterywolf's avatar
mysterywolf 已提交
702
        if(mutex->hold < RT_MUTEX_HOLD_MAX)
703 704 705 706 707 708 709 710 711
        {
            /* it's the same thread */
            mutex->hold ++;
        }
        else
        {
            rt_hw_interrupt_enable(temp); /* enable interrupt */
            return -RT_EFULL; /* value overflowed */
        }
D
dzzxzz@gmail.com 已提交
712 713 714
    }
    else
    {
715
#ifdef RT_USING_SIGNALS
B
bernard 已提交
716
__again:
717
#endif /* RT_USING_SIGNALS */
D
dzzxzz@gmail.com 已提交
718 719 720 721 722 723 724 725 726 727 728
        /* The value of mutex is 1 in initial status. Therefore, if the
         * value is great than 0, it 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;
mysterywolf's avatar
mysterywolf 已提交
729
            if(mutex->hold < RT_MUTEX_HOLD_MAX)
730 731 732 733 734 735 736 737
            {
                mutex->hold ++;
            }
            else
            {
                rt_hw_interrupt_enable(temp); /* enable interrupt */
                return -RT_EFULL; /* value overflowed */
            }
D
dzzxzz@gmail.com 已提交
738 739 740 741 742 743 744 745 746 747 748 749 750 751 752 753 754 755
        }
        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 */
                RT_DEBUG_LOG(RT_DEBUG_IPC, ("mutex_take: suspend thread: %s\n",
756
                                            thread->name));
757

D
dzzxzz@gmail.com 已提交
758 759 760 761 762 763 764 765 766 767 768 769 770 771 772 773 774 775
                /* 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)
                {
                    RT_DEBUG_LOG(RT_DEBUG_IPC,
776 777
                                 ("mutex_take: start the timer of thread:%s\n",
                                  thread->name));
778

D
dzzxzz@gmail.com 已提交
779 780 781 782 783 784 785 786 787 788 789 790 791 792 793
                    /* 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)
                {
794
#ifdef RT_USING_SIGNALS
795 796
                    /* interrupt by signal, try it again */
                    if (thread->error == -RT_EINTR) goto __again;
797
#endif /* RT_USING_SIGNALS */
B
bernard 已提交
798

D
dzzxzz@gmail.com 已提交
799 800 801 802 803 804 805 806 807 808 809 810 811 812 813 814 815 816 817
                    /* 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);

    RT_OBJECT_HOOK_CALL(rt_object_take_hook, (&(mutex->parent.parent)));

    return RT_EOK;
818
}
819
RTM_EXPORT(rt_mutex_take);
820

mysterywolf's avatar
mysterywolf 已提交
821 822 823 824 825 826 827 828 829 830 831 832 833
/**
 * This function will try to take a mutex and immediately return
 *
 * @param mutex the mutex object
 *
 * @return the error code
 */
rt_err_t rt_mutex_trytake(rt_mutex_t mutex)
{
    return rt_mutex_take(mutex, RT_WAITING_NO);
}
RTM_EXPORT(rt_mutex_trytake);

834 835 836 837 838 839 840 841 842 843
/**
 * 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)
{
D
dzzxzz@gmail.com 已提交
844 845 846
    register rt_base_t temp;
    struct rt_thread *thread;
    rt_bool_t need_schedule;
847

848 849 850 851
    /* parameter check */
    RT_ASSERT(mutex != RT_NULL);
    RT_ASSERT(rt_object_get_type(&mutex->parent.parent) == RT_Object_Class_Mutex);

D
dzzxzz@gmail.com 已提交
852
    need_schedule = RT_FALSE;
853

854 855
    /* only thread could release mutex because we need test the ownership */
    RT_DEBUG_IN_THREAD_CONTEXT;
856

B
bernard 已提交
857 858 859
    /* get current thread */
    thread = rt_thread_self();

D
dzzxzz@gmail.com 已提交
860 861
    /* disable interrupt */
    temp = rt_hw_interrupt_disable();
862

D
dzzxzz@gmail.com 已提交
863
    RT_DEBUG_LOG(RT_DEBUG_IPC,
864 865
                 ("mutex_release:current thread %s, mutex value: %d, hold: %d\n",
                  thread->name, mutex->value, mutex->hold));
866

D
dzzxzz@gmail.com 已提交
867 868 869 870 871 872 873 874 875 876 877 878 879 880 881 882 883 884 885 886 887 888 889 890 891 892 893 894 895 896 897 898 899 900 901
    RT_OBJECT_HOOK_CALL(rt_object_put_hook, (&(mutex->parent.parent)));

    /* 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);

            RT_DEBUG_LOG(RT_DEBUG_IPC, ("mutex_release: resume thread: %s\n",
902
                                        thread->name));
903

D
dzzxzz@gmail.com 已提交
904 905 906
            /* set new owner and priority */
            mutex->owner             = thread;
            mutex->original_priority = thread->current_priority;
St0pH@CK's avatar
St0pH@CK 已提交
907

mysterywolf's avatar
mysterywolf 已提交
908
            if(mutex->hold < RT_MUTEX_HOLD_MAX)
909 910 911 912 913 914 915 916
            {
                mutex->hold ++;
            }
            else
            {
                rt_hw_interrupt_enable(temp); /* enable interrupt */
                return -RT_EFULL; /* value overflowed */
            }
917

D
dzzxzz@gmail.com 已提交
918 919
            /* resume thread */
            rt_ipc_list_resume(&(mutex->parent.suspend_thread));
920

D
dzzxzz@gmail.com 已提交
921 922 923 924
            need_schedule = RT_TRUE;
        }
        else
        {
mysterywolf's avatar
mysterywolf 已提交
925
            if(mutex->value < RT_MUTEX_VALUE_MAX)
926 927 928 929 930 931 932 933 934
            {
                /* increase value */
                mutex->value ++;
            }
            else
            {
                rt_hw_interrupt_enable(temp); /* enable interrupt */
                return -RT_EFULL; /* value overflowed */
            }
mysterywolf's avatar
mysterywolf 已提交
935

D
dzzxzz@gmail.com 已提交
936 937 938 939 940
            /* clear owner */
            mutex->owner             = RT_NULL;
            mutex->original_priority = 0xff;
        }
    }
941

D
dzzxzz@gmail.com 已提交
942 943
    /* enable interrupt */
    rt_hw_interrupt_enable(temp);
944

D
dzzxzz@gmail.com 已提交
945 946 947
    /* perform a schedule */
    if (need_schedule == RT_TRUE)
        rt_schedule();
B
bernard.xiong 已提交
948

D
dzzxzz@gmail.com 已提交
949
    return RT_EOK;
950
}
951
RTM_EXPORT(rt_mutex_release);
952 953 954 955 956 957 958 959 960 961

/**
 * 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
 */
B
bernard 已提交
962
rt_err_t rt_mutex_control(rt_mutex_t mutex, int cmd, void *arg)
963
{
964 965 966 967
    /* parameter check */
    RT_ASSERT(mutex != RT_NULL);
    RT_ASSERT(rt_object_get_type(&mutex->parent.parent) == RT_Object_Class_Mutex);

D
dzzxzz@gmail.com 已提交
968
    return -RT_ERROR;
969
}
970
RTM_EXPORT(rt_mutex_control);
971
#endif /* RT_USING_MUTEX */
972 973 974 975 976 977 978 979 980 981 982 983

#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
 */
D
dzzxzz 已提交
984
rt_err_t rt_event_init(rt_event_t event, const char *name, rt_uint8_t flag)
985
{
986
    /* parameter check */
D
dzzxzz@gmail.com 已提交
987
    RT_ASSERT(event != RT_NULL);
988

B
Bernard Xiong 已提交
989
    /* initialize object */
D
dzzxzz@gmail.com 已提交
990
    rt_object_init(&(event->parent.parent), RT_Object_Class_Event, name);
991

D
dzzxzz@gmail.com 已提交
992 993
    /* set parent flag */
    event->parent.parent.flag = flag;
994

B
Bernard Xiong 已提交
995
    /* initialize ipc object */
D
dzzxzz@gmail.com 已提交
996
    rt_ipc_object_init(&(event->parent));
997

B
Bernard Xiong 已提交
998
    /* initialize event */
D
dzzxzz@gmail.com 已提交
999
    event->set = 0;
1000

D
dzzxzz@gmail.com 已提交
1001
    return RT_EOK;
1002
}
1003
RTM_EXPORT(rt_event_init);
1004 1005 1006 1007 1008 1009 1010 1011 1012 1013

/**
 * 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)
{
D
dzzxzz@gmail.com 已提交
1014 1015
    /* parameter check */
    RT_ASSERT(event != RT_NULL);
1016 1017
    RT_ASSERT(rt_object_get_type(&event->parent.parent) == RT_Object_Class_Event);
    RT_ASSERT(rt_object_is_systemobject(&event->parent.parent));
1018

D
dzzxzz@gmail.com 已提交
1019 1020
    /* resume all suspended thread */
    rt_ipc_list_resume_all(&(event->parent.suspend_thread));
1021

D
dzzxzz@gmail.com 已提交
1022 1023
    /* detach event object */
    rt_object_detach(&(event->parent.parent));
1024

D
dzzxzz@gmail.com 已提交
1025
    return RT_EOK;
1026
}
1027
RTM_EXPORT(rt_event_detach);
1028 1029 1030 1031 1032 1033 1034 1035 1036 1037

#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
 */
D
dzzxzz 已提交
1038
rt_event_t rt_event_create(const char *name, rt_uint8_t flag)
1039
{
D
dzzxzz@gmail.com 已提交
1040
    rt_event_t event;
1041

D
dzzxzz@gmail.com 已提交
1042
    RT_DEBUG_NOT_IN_INTERRUPT;
1043

D
dzzxzz@gmail.com 已提交
1044 1045 1046 1047
    /* allocate object */
    event = (rt_event_t)rt_object_allocate(RT_Object_Class_Event, name);
    if (event == RT_NULL)
        return event;
1048

D
dzzxzz@gmail.com 已提交
1049 1050
    /* set parent */
    event->parent.parent.flag = flag;
1051

B
Bernard Xiong 已提交
1052
    /* initialize ipc object */
D
dzzxzz@gmail.com 已提交
1053
    rt_ipc_object_init(&(event->parent));
1054

B
Bernard Xiong 已提交
1055
    /* initialize event */
D
dzzxzz@gmail.com 已提交
1056
    event->set = 0;
1057

D
dzzxzz@gmail.com 已提交
1058
    return event;
1059
}
1060
RTM_EXPORT(rt_event_create);
1061 1062 1063 1064 1065 1066 1067 1068

/**
 * This function will delete an event object and release the memory
 *
 * @param event the event object
 *
 * @return the error code
 */
D
dzzxzz 已提交
1069
rt_err_t rt_event_delete(rt_event_t event)
1070
{
D
dzzxzz@gmail.com 已提交
1071 1072
    /* parameter check */
    RT_ASSERT(event != RT_NULL);
1073 1074
    RT_ASSERT(rt_object_get_type(&event->parent.parent) == RT_Object_Class_Event);
    RT_ASSERT(rt_object_is_systemobject(&event->parent.parent) == RT_FALSE);
1075

D
dzzxzz@gmail.com 已提交
1076
    RT_DEBUG_NOT_IN_INTERRUPT;
1077

D
dzzxzz@gmail.com 已提交
1078 1079
    /* resume all suspended thread */
    rt_ipc_list_resume_all(&(event->parent.suspend_thread));
1080

D
dzzxzz@gmail.com 已提交
1081 1082
    /* delete event object */
    rt_object_delete(&(event->parent.parent));
1083

D
dzzxzz@gmail.com 已提交
1084
    return RT_EOK;
1085
}
1086
RTM_EXPORT(rt_event_delete);
1087
#endif /* RT_USING_HEAP */
1088 1089 1090 1091 1092 1093 1094 1095 1096 1097 1098 1099

/**
 * 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)
{
D
dzzxzz@gmail.com 已提交
1100 1101 1102 1103 1104 1105 1106 1107
    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);
1108 1109
    RT_ASSERT(rt_object_get_type(&event->parent.parent) == RT_Object_Class_Event);

D
dzzxzz@gmail.com 已提交
1110 1111 1112 1113 1114 1115 1116 1117 1118 1119 1120
    if (set == 0)
        return -RT_ERROR;

    need_schedule = RT_FALSE;

    /* disable interrupt */
    level = rt_hw_interrupt_disable();

    /* set event */
    event->set |= set;

1121
    RT_OBJECT_HOOK_CALL(rt_object_put_hook, (&(event->parent.parent)));
B
Bernard Xiong 已提交
1122

D
dzzxzz@gmail.com 已提交
1123 1124 1125 1126 1127 1128 1129 1130 1131 1132 1133 1134 1135 1136 1137 1138 1139 1140 1141 1142 1143 1144
    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)
                {
B
Bernard Xiong 已提交
1145
                    /* save the received event set */
D
dzzxzz@gmail.com 已提交
1146 1147 1148 1149 1150 1151
                    thread->event_set = thread->event_set & event->set;

                    /* received an OR event */
                    status = RT_EOK;
                }
            }
1152 1153 1154 1155 1156 1157 1158
            else
            {
                /* enable interrupt */
                rt_hw_interrupt_enable(level);

                return -RT_EINVAL;
            }
D
dzzxzz@gmail.com 已提交
1159 1160 1161 1162 1163 1164 1165 1166 1167 1168 1169 1170 1171 1172 1173 1174 1175 1176 1177 1178 1179 1180 1181 1182 1183 1184 1185 1186

            /* 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;
1187
}
1188
RTM_EXPORT(rt_event_send);
1189 1190

/**
D
dzzxzz@gmail.com 已提交
1191 1192
 * This function will receive an event from event object, if the event is
 * unavailable, the thread shall wait for a specified time.
1193 1194 1195
 *
 * @param event the fast event object
 * @param set the interested event set
1196 1197
 * @param option the receive option, either RT_EVENT_FLAG_AND or
 *        RT_EVENT_FLAG_OR should be set.
1198
 * @param timeout the waiting time
P
pathletboy 已提交
1199
 * @param recved the received event, if you don't care, RT_NULL can be set.
1200 1201 1202
 *
 * @return the error code
 */
D
dzzxzz@gmail.com 已提交
1203 1204 1205 1206 1207
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)
1208
{
D
dzzxzz@gmail.com 已提交
1209 1210 1211 1212
    struct rt_thread *thread;
    register rt_ubase_t level;
    register rt_base_t status;

G
Grissiom 已提交
1213
    RT_DEBUG_IN_THREAD_CONTEXT;
D
dzzxzz@gmail.com 已提交
1214 1215 1216

    /* parameter check */
    RT_ASSERT(event != RT_NULL);
1217 1218
    RT_ASSERT(rt_object_get_type(&event->parent.parent) == RT_Object_Class_Event);

D
dzzxzz@gmail.com 已提交
1219 1220 1221
    if (set == 0)
        return -RT_ERROR;

B
Bernard Xiong 已提交
1222
    /* initialize status */
D
dzzxzz@gmail.com 已提交
1223 1224 1225 1226 1227 1228 1229 1230 1231 1232 1233 1234 1235 1236 1237 1238 1239 1240 1241 1242 1243 1244
    status = -RT_ERROR;
    /* get current thread */
    thread = rt_thread_self();
    /* reset thread error */
    thread->error = RT_EOK;

    RT_OBJECT_HOOK_CALL(rt_object_trytake_hook, (&(event->parent.parent)));

    /* 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;
    }
1245 1246 1247 1248 1249
    else
    {
        /* either RT_EVENT_FLAG_AND or RT_EVENT_FLAG_OR should be set */
        RT_ASSERT(0);
    }
D
dzzxzz@gmail.com 已提交
1250 1251 1252 1253

    if (status == RT_EOK)
    {
        /* set received event */
1254
        if (recved)
P
pathletboy 已提交
1255
            *recved = (event->set & set);
mysterywolf's avatar
mysterywolf 已提交
1256 1257

        /* fill thread event info */
1258 1259
        thread->event_set = (event->set & set);
        thread->event_info = option;
mysterywolf's avatar
mysterywolf 已提交
1260

D
dzzxzz@gmail.com 已提交
1261 1262 1263 1264 1265 1266 1267 1268
        /* received event */
        if (option & RT_EVENT_FLAG_CLEAR)
            event->set &= ~set;
    }
    else if (timeout == 0)
    {
        /* no waiting */
        thread->error = -RT_ETIMEOUT;
1269

G
greed-island 已提交
1270 1271
        /* enable interrupt */
        rt_hw_interrupt_enable(level);
1272

G
greed-island 已提交
1273
        return -RT_ETIMEOUT;
D
dzzxzz@gmail.com 已提交
1274 1275 1276 1277 1278 1279 1280 1281 1282 1283 1284 1285 1286 1287 1288 1289 1290 1291 1292 1293 1294 1295 1296 1297 1298 1299 1300 1301 1302 1303 1304 1305 1306 1307 1308 1309 1310 1311
    }
    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 */
P
pathletboy 已提交
1312 1313
        if (recved)
            *recved = thread->event_set;
D
dzzxzz@gmail.com 已提交
1314 1315 1316 1317 1318 1319 1320 1321
    }

    /* enable interrupt */
    rt_hw_interrupt_enable(level);

    RT_OBJECT_HOOK_CALL(rt_object_take_hook, (&(event->parent.parent)));

    return thread->error;
1322
}
1323
RTM_EXPORT(rt_event_recv);
1324 1325 1326 1327 1328 1329 1330 1331 1332 1333

/**
 * 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
 */
B
bernard 已提交
1334
rt_err_t rt_event_control(rt_event_t event, int cmd, void *arg)
1335
{
D
dzzxzz@gmail.com 已提交
1336
    rt_ubase_t level;
1337

1338 1339 1340
    /* parameter check */
    RT_ASSERT(event != RT_NULL);
    RT_ASSERT(rt_object_get_type(&event->parent.parent) == RT_Object_Class_Event);
B
Bernard Xiong 已提交
1341

D
dzzxzz@gmail.com 已提交
1342 1343 1344 1345
    if (cmd == RT_IPC_CMD_RESET)
    {
        /* disable interrupt */
        level = rt_hw_interrupt_disable();
1346

D
dzzxzz@gmail.com 已提交
1347 1348
        /* resume all waiting thread */
        rt_ipc_list_resume_all(&event->parent.suspend_thread);
1349

B
Bernard Xiong 已提交
1350
        /* initialize event set */
D
dzzxzz@gmail.com 已提交
1351
        event->set = 0;
1352

D
dzzxzz@gmail.com 已提交
1353 1354
        /* enable interrupt */
        rt_hw_interrupt_enable(level);
1355

D
dzzxzz@gmail.com 已提交
1356
        rt_schedule();
1357

D
dzzxzz@gmail.com 已提交
1358 1359
        return RT_EOK;
    }
1360

D
dzzxzz@gmail.com 已提交
1361
    return -RT_ERROR;
1362
}
B
Bernard Xiong 已提交
1363
RTM_EXPORT(rt_event_control);
1364
#endif /* RT_USING_EVENT */
1365 1366 1367 1368 1369 1370 1371 1372 1373 1374 1375 1376 1377 1378

#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
 */
D
dzzxzz@gmail.com 已提交
1379 1380 1381 1382 1383
rt_err_t rt_mb_init(rt_mailbox_t mb,
                    const char  *name,
                    void        *msgpool,
                    rt_size_t    size,
                    rt_uint8_t   flag)
1384
{
D
dzzxzz@gmail.com 已提交
1385
    RT_ASSERT(mb != RT_NULL);
1386

B
Bernard Xiong 已提交
1387
    /* initialize object */
D
dzzxzz@gmail.com 已提交
1388
    rt_object_init(&(mb->parent.parent), RT_Object_Class_MailBox, name);
1389

D
dzzxzz@gmail.com 已提交
1390 1391
    /* set parent flag */
    mb->parent.parent.flag = flag;
1392

B
Bernard Xiong 已提交
1393
    /* initialize ipc object */
D
dzzxzz@gmail.com 已提交
1394
    rt_ipc_object_init(&(mb->parent));
1395

B
Bernard Xiong 已提交
1396
    /* initialize mailbox */
1397
    mb->msg_pool   = (rt_ubase_t *)msgpool;
D
dzzxzz@gmail.com 已提交
1398 1399 1400 1401
    mb->size       = size;
    mb->entry      = 0;
    mb->in_offset  = 0;
    mb->out_offset = 0;
1402

B
Bernard Xiong 已提交
1403
    /* initialize an additional list of sender suspend thread */
D
dzzxzz@gmail.com 已提交
1404
    rt_list_init(&(mb->suspend_sender_thread));
1405

D
dzzxzz@gmail.com 已提交
1406
    return RT_EOK;
1407
}
1408
RTM_EXPORT(rt_mb_init);
1409 1410 1411 1412 1413 1414 1415 1416 1417 1418

/**
 * 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)
{
D
dzzxzz@gmail.com 已提交
1419 1420
    /* parameter check */
    RT_ASSERT(mb != RT_NULL);
1421 1422
    RT_ASSERT(rt_object_get_type(&mb->parent.parent) == RT_Object_Class_MailBox);
    RT_ASSERT(rt_object_is_systemobject(&mb->parent.parent));
1423

D
dzzxzz@gmail.com 已提交
1424 1425 1426 1427
    /* 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));
1428

D
dzzxzz@gmail.com 已提交
1429 1430
    /* detach mailbox object */
    rt_object_detach(&(mb->parent.parent));
1431

D
dzzxzz@gmail.com 已提交
1432
    return RT_EOK;
1433
}
1434
RTM_EXPORT(rt_mb_detach);
1435 1436 1437 1438 1439 1440 1441 1442 1443 1444 1445

#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
 */
D
dzzxzz 已提交
1446
rt_mailbox_t rt_mb_create(const char *name, rt_size_t size, rt_uint8_t flag)
1447
{
D
dzzxzz@gmail.com 已提交
1448
    rt_mailbox_t mb;
1449

D
dzzxzz@gmail.com 已提交
1450
    RT_DEBUG_NOT_IN_INTERRUPT;
1451

D
dzzxzz@gmail.com 已提交
1452 1453 1454 1455
    /* allocate object */
    mb = (rt_mailbox_t)rt_object_allocate(RT_Object_Class_MailBox, name);
    if (mb == RT_NULL)
        return mb;
1456

D
dzzxzz@gmail.com 已提交
1457 1458
    /* set parent */
    mb->parent.parent.flag = flag;
1459

B
Bernard Xiong 已提交
1460
    /* initialize ipc object */
D
dzzxzz@gmail.com 已提交
1461
    rt_ipc_object_init(&(mb->parent));
1462

B
Bernard Xiong 已提交
1463
    /* initialize mailbox */
D
dzzxzz@gmail.com 已提交
1464
    mb->size     = size;
1465
    mb->msg_pool = (rt_ubase_t *)RT_KERNEL_MALLOC(mb->size * sizeof(rt_ubase_t));
D
dzzxzz@gmail.com 已提交
1466 1467 1468 1469
    if (mb->msg_pool == RT_NULL)
    {
        /* delete mailbox object */
        rt_object_delete(&(mb->parent.parent));
1470

D
dzzxzz@gmail.com 已提交
1471 1472 1473 1474 1475
        return RT_NULL;
    }
    mb->entry      = 0;
    mb->in_offset  = 0;
    mb->out_offset = 0;
1476

B
Bernard Xiong 已提交
1477
    /* initialize an additional list of sender suspend thread */
D
dzzxzz@gmail.com 已提交
1478
    rt_list_init(&(mb->suspend_sender_thread));
1479

D
dzzxzz@gmail.com 已提交
1480
    return mb;
1481
}
1482
RTM_EXPORT(rt_mb_create);
1483 1484 1485 1486 1487 1488 1489 1490

/**
 * This function will delete a mailbox object and release the memory
 *
 * @param mb the mailbox object
 *
 * @return the error code
 */
D
dzzxzz 已提交
1491
rt_err_t rt_mb_delete(rt_mailbox_t mb)
M
mbbill@gmail.com 已提交
1492
{
D
dzzxzz@gmail.com 已提交
1493
    RT_DEBUG_NOT_IN_INTERRUPT;
1494

D
dzzxzz@gmail.com 已提交
1495 1496
    /* parameter check */
    RT_ASSERT(mb != RT_NULL);
1497 1498
    RT_ASSERT(rt_object_get_type(&mb->parent.parent) == RT_Object_Class_MailBox);
    RT_ASSERT(rt_object_is_systemobject(&mb->parent.parent) == RT_FALSE);
1499

D
dzzxzz@gmail.com 已提交
1500 1501
    /* resume all suspended thread */
    rt_ipc_list_resume_all(&(mb->parent.suspend_thread));
1502

D
dzzxzz@gmail.com 已提交
1503 1504
    /* also resume all mailbox private suspended thread */
    rt_ipc_list_resume_all(&(mb->suspend_sender_thread));
1505

1506 1507
    /* free mailbox pool */
    RT_KERNEL_FREE(mb->msg_pool);
1508

D
dzzxzz@gmail.com 已提交
1509 1510
    /* delete mailbox object */
    rt_object_delete(&(mb->parent.parent));
1511

D
dzzxzz@gmail.com 已提交
1512
    return RT_EOK;
1513
}
1514
RTM_EXPORT(rt_mb_delete);
1515
#endif /* RT_USING_HEAP */
1516 1517

/**
1518 1519
 * This function will send a mail to mailbox object. If the mailbox is full,
 * current thread will be suspended until timeout.
1520 1521 1522
 *
 * @param mb the mailbox object
 * @param value the mail
1523
 * @param timeout the waiting time
1524 1525 1526
 *
 * @return the error code
 */
D
dzzxzz@gmail.com 已提交
1527
rt_err_t rt_mb_send_wait(rt_mailbox_t mb,
B
Bernard Xiong 已提交
1528
                         rt_ubase_t   value,
D
dzzxzz@gmail.com 已提交
1529
                         rt_int32_t   timeout)
1530
{
D
dzzxzz@gmail.com 已提交
1531 1532 1533 1534 1535 1536
    struct rt_thread *thread;
    register rt_ubase_t temp;
    rt_uint32_t tick_delta;

    /* parameter check */
    RT_ASSERT(mb != RT_NULL);
1537
    RT_ASSERT(rt_object_get_type(&mb->parent.parent) == RT_Object_Class_MailBox);
D
dzzxzz@gmail.com 已提交
1538 1539 1540 1541 1542 1543 1544 1545 1546 1547 1548 1549 1550 1551 1552 1553 1554 1555 1556 1557 1558 1559 1560 1561 1562 1563 1564 1565 1566 1567 1568 1569 1570

    /* initialize delta tick */
    tick_delta = 0;
    /* get current thread */
    thread = rt_thread_self();

    RT_OBJECT_HOOK_CALL(rt_object_put_hook, (&(mb->parent.parent)));

    /* disable interrupt */
    temp = rt_hw_interrupt_disable();

    /* for non-blocking call */
    if (mb->entry == mb->size && timeout == 0)
    {
        rt_hw_interrupt_enable(temp);
        return -RT_EFULL;
    }

    /* 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);

            return -RT_EFULL;
        }

G
Grissiom 已提交
1571
        RT_DEBUG_IN_THREAD_CONTEXT;
D
dzzxzz@gmail.com 已提交
1572 1573 1574 1575 1576 1577 1578 1579 1580 1581 1582 1583
        /* 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();

            RT_DEBUG_LOG(RT_DEBUG_IPC, ("mb_send_wait: start timer of thread:%s\n",
1584
                                        thread->name));
1585

D
dzzxzz@gmail.com 已提交
1586 1587 1588 1589 1590 1591 1592 1593 1594 1595 1596 1597 1598 1599 1600 1601 1602 1603 1604 1605 1606 1607 1608 1609 1610 1611 1612 1613 1614 1615 1616 1617 1618 1619 1620 1621 1622 1623 1624
            /* 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();

        /* if it's not waiting forever and then 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;
    if (mb->in_offset >= mb->size)
        mb->in_offset = 0;
mysterywolf's avatar
mysterywolf 已提交
1625

mysterywolf's avatar
mysterywolf 已提交
1626
    if(mb->entry < RT_MB_ENTRY_MAX)
1627 1628 1629 1630 1631 1632 1633 1634 1635
    {
        /* increase message entry */
        mb->entry ++;
    }
    else
    {
        rt_hw_interrupt_enable(temp); /* enable interrupt */
        return -RT_EFULL; /* value overflowed */
    }
mysterywolf's avatar
mysterywolf 已提交
1636

D
dzzxzz@gmail.com 已提交
1637 1638 1639 1640 1641 1642 1643 1644 1645 1646 1647 1648 1649 1650 1651 1652 1653
    /* 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;
1654
}
1655
RTM_EXPORT(rt_mb_send_wait);
1656

1657
/**
D
dzzxzz@gmail.com 已提交
1658 1659 1660
 * 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.
1661 1662 1663 1664 1665 1666
 *
 * @param mb the mailbox object
 * @param value the mail
 *
 * @return the error code
 */
B
Bernard Xiong 已提交
1667
rt_err_t rt_mb_send(rt_mailbox_t mb, rt_ubase_t value)
1668
{
D
dzzxzz@gmail.com 已提交
1669
    return rt_mb_send_wait(mb, value, 0);
1670
}
1671
RTM_EXPORT(rt_mb_send);
1672

1673
/**
mysterywolf's avatar
update  
mysterywolf 已提交
1674 1675
 * This function will send an urgent mail to mailbox object, if there are threads
 * suspended on mailbox object, it will be waked up. This function will return
mysterywolf's avatar
update  
mysterywolf 已提交
1676
 * immediately.
1677 1678 1679 1680 1681 1682
 *
 * @param mb the mailbox object
 * @param value the mail
 *
 * @return the error code
 */
mysterywolf's avatar
update  
mysterywolf 已提交
1683
rt_err_t rt_mb_urgent(rt_mailbox_t mb, rt_ubase_t value)
1684 1685 1686 1687 1688 1689 1690 1691 1692 1693 1694 1695
{
    register rt_ubase_t temp;

    /* parameter check */
    RT_ASSERT(mb != RT_NULL);
    RT_ASSERT(rt_object_get_type(&mb->parent.parent) == RT_Object_Class_MailBox);

    RT_OBJECT_HOOK_CALL(rt_object_put_hook, (&(mb->parent.parent)));

    /* disable interrupt */
    temp = rt_hw_interrupt_disable();

mysterywolf's avatar
update  
mysterywolf 已提交
1696 1697 1698 1699 1700 1701
    if (mb->entry == mb->size)
    {
        rt_hw_interrupt_enable(temp);
        return -RT_EFULL;
    }

1702
    /* rewind to the previous position */
mysterywolf's avatar
update  
mysterywolf 已提交
1703
    if (mb->out_offset > 0)
1704 1705 1706 1707 1708 1709 1710 1711 1712 1713 1714
    {
        mb->out_offset --;
    }
    else
    {
        mb->out_offset = mb->size - 1;
    }

    /* set ptr */
    mb->msg_pool[mb->out_offset] = value;

mysterywolf's avatar
update  
mysterywolf 已提交
1715 1716
    /* increase message entry */
    mb->entry ++;
1717 1718 1719 1720 1721 1722 1723 1724 1725 1726 1727 1728 1729 1730 1731 1732 1733 1734 1735 1736 1737

    /* 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;
}
RTM_EXPORT(rt_mb_urgent);

1738
/**
D
dzzxzz@gmail.com 已提交
1739 1740
 * 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.
1741 1742 1743 1744 1745 1746 1747
 *
 * @param mb the mailbox object
 * @param value the received mail will be saved in
 * @param timeout the waiting time
 *
 * @return the error code
 */
B
Bernard Xiong 已提交
1748
rt_err_t rt_mb_recv(rt_mailbox_t mb, rt_ubase_t *value, rt_int32_t timeout)
1749
{
D
dzzxzz@gmail.com 已提交
1750 1751 1752 1753 1754 1755
    struct rt_thread *thread;
    register rt_ubase_t temp;
    rt_uint32_t tick_delta;

    /* parameter check */
    RT_ASSERT(mb != RT_NULL);
1756
    RT_ASSERT(rt_object_get_type(&mb->parent.parent) == RT_Object_Class_MailBox);
D
dzzxzz@gmail.com 已提交
1757 1758 1759 1760 1761 1762 1763 1764 1765 1766 1767 1768 1769 1770 1771 1772 1773 1774 1775 1776 1777 1778 1779 1780 1781 1782 1783 1784 1785 1786 1787 1788

    /* initialize delta tick */
    tick_delta = 0;
    /* get current thread */
    thread = rt_thread_self();

    RT_OBJECT_HOOK_CALL(rt_object_trytake_hook, (&(mb->parent.parent)));

    /* disable interrupt */
    temp = rt_hw_interrupt_disable();

    /* for non-blocking call */
    if (mb->entry == 0 && timeout == 0)
    {
        rt_hw_interrupt_enable(temp);

        return -RT_ETIMEOUT;
    }

    /* 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;
B
Bernard Xiong 已提交
1789

D
dzzxzz@gmail.com 已提交
1790 1791 1792
            return -RT_ETIMEOUT;
        }

G
Grissiom 已提交
1793
        RT_DEBUG_IN_THREAD_CONTEXT;
D
dzzxzz@gmail.com 已提交
1794 1795 1796 1797 1798 1799 1800 1801 1802 1803 1804 1805
        /* 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();

            RT_DEBUG_LOG(RT_DEBUG_IPC, ("mb_recv: start timer of thread:%s\n",
1806
                                        thread->name));
1807

D
dzzxzz@gmail.com 已提交
1808 1809 1810 1811 1812 1813
            /* 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));
        }
1814

D
dzzxzz@gmail.com 已提交
1815 1816
        /* enable interrupt */
        rt_hw_interrupt_enable(temp);
1817

D
dzzxzz@gmail.com 已提交
1818 1819
        /* re-schedule */
        rt_schedule();
1820

D
dzzxzz@gmail.com 已提交
1821 1822 1823 1824 1825 1826
        /* resume from suspend state */
        if (thread->error != RT_EOK)
        {
            /* return error */
            return thread->error;
        }
1827

D
dzzxzz@gmail.com 已提交
1828 1829
        /* disable interrupt */
        temp = rt_hw_interrupt_disable();
1830

D
dzzxzz@gmail.com 已提交
1831 1832 1833 1834 1835 1836 1837 1838 1839
        /* if it's not waiting forever and then re-calculate timeout tick */
        if (timeout > 0)
        {
            tick_delta = rt_tick_get() - tick_delta;
            timeout -= tick_delta;
            if (timeout < 0)
                timeout = 0;
        }
    }
1840

D
dzzxzz@gmail.com 已提交
1841 1842
    /* fill ptr */
    *value = mb->msg_pool[mb->out_offset];
1843

D
dzzxzz@gmail.com 已提交
1844 1845 1846 1847
    /* increase output offset */
    ++ mb->out_offset;
    if (mb->out_offset >= mb->size)
        mb->out_offset = 0;
1848

D
dzzxzz@gmail.com 已提交
1849
    /* decrease message entry */
1850 1851 1852 1853
    if(mb->entry > 0)
    {
        mb->entry --;
    }
1854

D
dzzxzz@gmail.com 已提交
1855 1856 1857 1858
    /* resume suspended thread */
    if (!rt_list_isempty(&(mb->suspend_sender_thread)))
    {
        rt_ipc_list_resume(&(mb->suspend_sender_thread));
1859

D
dzzxzz@gmail.com 已提交
1860 1861
        /* enable interrupt */
        rt_hw_interrupt_enable(temp);
1862

D
dzzxzz@gmail.com 已提交
1863
        RT_OBJECT_HOOK_CALL(rt_object_take_hook, (&(mb->parent.parent)));
1864

D
dzzxzz@gmail.com 已提交
1865
        rt_schedule();
1866

D
dzzxzz@gmail.com 已提交
1867 1868
        return RT_EOK;
    }
1869

D
dzzxzz@gmail.com 已提交
1870 1871
    /* enable interrupt */
    rt_hw_interrupt_enable(temp);
1872

D
dzzxzz@gmail.com 已提交
1873
    RT_OBJECT_HOOK_CALL(rt_object_take_hook, (&(mb->parent.parent)));
1874

D
dzzxzz@gmail.com 已提交
1875
    return RT_EOK;
1876
}
1877
RTM_EXPORT(rt_mb_recv);
1878 1879 1880 1881 1882 1883 1884 1885 1886 1887

/**
 * 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
 */
B
bernard 已提交
1888
rt_err_t rt_mb_control(rt_mailbox_t mb, int cmd, void *arg)
1889
{
D
dzzxzz@gmail.com 已提交
1890
    rt_ubase_t level;
1891 1892

    /* parameter check */
D
dzzxzz@gmail.com 已提交
1893
    RT_ASSERT(mb != RT_NULL);
1894
    RT_ASSERT(rt_object_get_type(&mb->parent.parent) == RT_Object_Class_MailBox);
1895

D
dzzxzz@gmail.com 已提交
1896 1897 1898 1899
    if (cmd == RT_IPC_CMD_RESET)
    {
        /* disable interrupt */
        level = rt_hw_interrupt_disable();
1900

D
dzzxzz@gmail.com 已提交
1901 1902 1903 1904
        /* resume all waiting 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));
1905

D
dzzxzz@gmail.com 已提交
1906 1907 1908 1909
        /* re-init mailbox */
        mb->entry      = 0;
        mb->in_offset  = 0;
        mb->out_offset = 0;
1910

D
dzzxzz@gmail.com 已提交
1911 1912
        /* enable interrupt */
        rt_hw_interrupt_enable(level);
1913

D
dzzxzz@gmail.com 已提交
1914
        rt_schedule();
1915

D
dzzxzz@gmail.com 已提交
1916 1917
        return RT_EOK;
    }
1918

D
dzzxzz@gmail.com 已提交
1919
    return -RT_ERROR;
1920
}
B
Bernard Xiong 已提交
1921
RTM_EXPORT(rt_mb_control);
1922
#endif /* RT_USING_MAILBOX */
1923 1924 1925 1926

#ifdef RT_USING_MESSAGEQUEUE
struct rt_mq_message
{
D
dzzxzz@gmail.com 已提交
1927
    struct rt_mq_message *next;
1928 1929 1930
};

/**
D
dzzxzz@gmail.com 已提交
1931 1932
 * This function will initialize a message queue and put it under control of
 * resource management.
1933 1934 1935 1936 1937 1938 1939 1940 1941 1942
 *
 * @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
 */
D
dzzxzz@gmail.com 已提交
1943 1944 1945 1946 1947 1948
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)
1949
{
D
dzzxzz@gmail.com 已提交
1950 1951
    struct rt_mq_message *head;
    register rt_base_t temp;
1952

D
dzzxzz@gmail.com 已提交
1953 1954
    /* parameter check */
    RT_ASSERT(mq != RT_NULL);
1955

B
Bernard Xiong 已提交
1956
    /* initialize object */
D
dzzxzz@gmail.com 已提交
1957
    rt_object_init(&(mq->parent.parent), RT_Object_Class_MessageQueue, name);
1958

D
dzzxzz@gmail.com 已提交
1959 1960
    /* set parent flag */
    mq->parent.parent.flag = flag;
1961

B
Bernard Xiong 已提交
1962
    /* initialize ipc object */
D
dzzxzz@gmail.com 已提交
1963
    rt_ipc_object_init(&(mq->parent));
1964

B
Bernard Xiong 已提交
1965
    /* set message pool */
D
dzzxzz@gmail.com 已提交
1966
    mq->msg_pool = msgpool;
1967

D
dzzxzz@gmail.com 已提交
1968 1969 1970
    /* 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));
1971

B
Bernard Xiong 已提交
1972
    /* initialize message list */
D
dzzxzz@gmail.com 已提交
1973 1974
    mq->msg_queue_head = RT_NULL;
    mq->msg_queue_tail = RT_NULL;
1975

B
Bernard Xiong 已提交
1976
    /* initialize message empty list */
D
dzzxzz@gmail.com 已提交
1977 1978 1979 1980
    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 +
1981
                                        temp * (mq->msg_size + sizeof(struct rt_mq_message)));
1982
        head->next = (struct rt_mq_message *)mq->msg_queue_free;
D
dzzxzz@gmail.com 已提交
1983 1984
        mq->msg_queue_free = head;
    }
1985

D
dzzxzz@gmail.com 已提交
1986 1987
    /* the initial entry is zero */
    mq->entry = 0;
1988

B
Bernard Xiong 已提交
1989
    /* initialize an additional list of sender suspend thread */
1990 1991
    rt_list_init(&(mq->suspend_sender_thread));

D
dzzxzz@gmail.com 已提交
1992
    return RT_EOK;
1993
}
1994
RTM_EXPORT(rt_mq_init);
1995 1996 1997 1998 1999 2000 2001 2002 2003 2004

/**
 * 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)
{
D
dzzxzz@gmail.com 已提交
2005 2006
    /* parameter check */
    RT_ASSERT(mq != RT_NULL);
2007 2008
    RT_ASSERT(rt_object_get_type(&mq->parent.parent) == RT_Object_Class_MessageQueue);
    RT_ASSERT(rt_object_is_systemobject(&mq->parent.parent));
2009

D
dzzxzz@gmail.com 已提交
2010 2011
    /* resume all suspended thread */
    rt_ipc_list_resume_all(&mq->parent.suspend_thread);
2012 2013
    /* also resume all message queue private suspended thread */
    rt_ipc_list_resume_all(&(mq->suspend_sender_thread));
2014

D
dzzxzz@gmail.com 已提交
2015 2016
    /* detach message queue object */
    rt_object_detach(&(mq->parent.parent));
2017

D
dzzxzz@gmail.com 已提交
2018
    return RT_EOK;
2019
}
2020
RTM_EXPORT(rt_mq_detach);
2021 2022 2023 2024 2025 2026 2027 2028 2029 2030 2031 2032

#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
 */
D
dzzxzz@gmail.com 已提交
2033 2034 2035 2036
rt_mq_t rt_mq_create(const char *name,
                     rt_size_t   msg_size,
                     rt_size_t   max_msgs,
                     rt_uint8_t  flag)
2037
{
D
dzzxzz@gmail.com 已提交
2038 2039 2040 2041 2042 2043 2044 2045 2046 2047 2048 2049 2050 2051
    struct rt_messagequeue *mq;
    struct rt_mq_message *head;
    register rt_base_t temp;

    RT_DEBUG_NOT_IN_INTERRUPT;

    /* 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;

B
Bernard Xiong 已提交
2052
    /* initialize ipc object */
D
dzzxzz@gmail.com 已提交
2053 2054
    rt_ipc_object_init(&(mq->parent));

B
Bernard Xiong 已提交
2055
    /* initialize message queue */
D
dzzxzz@gmail.com 已提交
2056 2057 2058 2059 2060 2061

    /* get correct message size */
    mq->msg_size = RT_ALIGN(msg_size, RT_ALIGN_SIZE);
    mq->max_msgs = max_msgs;

    /* allocate message pool */
2062
    mq->msg_pool = RT_KERNEL_MALLOC((mq->msg_size + sizeof(struct rt_mq_message)) * mq->max_msgs);
D
dzzxzz@gmail.com 已提交
2063 2064
    if (mq->msg_pool == RT_NULL)
    {
2065
        rt_object_delete(&(mq->parent.parent));
D
dzzxzz@gmail.com 已提交
2066 2067 2068 2069

        return RT_NULL;
    }

B
Bernard Xiong 已提交
2070
    /* initialize message list */
D
dzzxzz@gmail.com 已提交
2071 2072 2073
    mq->msg_queue_head = RT_NULL;
    mq->msg_queue_tail = RT_NULL;

B
Bernard Xiong 已提交
2074
    /* initialize message empty list */
D
dzzxzz@gmail.com 已提交
2075 2076 2077 2078
    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 +
2079
                                        temp * (mq->msg_size + sizeof(struct rt_mq_message)));
2080
        head->next = (struct rt_mq_message *)mq->msg_queue_free;
D
dzzxzz@gmail.com 已提交
2081 2082 2083 2084 2085 2086
        mq->msg_queue_free = head;
    }

    /* the initial entry is zero */
    mq->entry = 0;

B
Bernard Xiong 已提交
2087
    /* initialize an additional list of sender suspend thread */
2088 2089
    rt_list_init(&(mq->suspend_sender_thread));

D
dzzxzz@gmail.com 已提交
2090
    return mq;
2091
}
2092
RTM_EXPORT(rt_mq_create);
2093 2094 2095 2096 2097 2098 2099 2100

/**
 * This function will delete a message queue object and release the memory
 *
 * @param mq the message queue object
 *
 * @return the error code
 */
D
dzzxzz 已提交
2101
rt_err_t rt_mq_delete(rt_mq_t mq)
2102
{
D
dzzxzz@gmail.com 已提交
2103
    RT_DEBUG_NOT_IN_INTERRUPT;
2104

D
dzzxzz@gmail.com 已提交
2105 2106
    /* parameter check */
    RT_ASSERT(mq != RT_NULL);
2107 2108
    RT_ASSERT(rt_object_get_type(&mq->parent.parent) == RT_Object_Class_MessageQueue);
    RT_ASSERT(rt_object_is_systemobject(&mq->parent.parent) == RT_FALSE);
2109

D
dzzxzz@gmail.com 已提交
2110 2111
    /* resume all suspended thread */
    rt_ipc_list_resume_all(&(mq->parent.suspend_thread));
2112 2113
    /* also resume all message queue private suspended thread */
    rt_ipc_list_resume_all(&(mq->suspend_sender_thread));
2114

2115 2116
    /* free message queue pool */
    RT_KERNEL_FREE(mq->msg_pool);
2117

D
dzzxzz@gmail.com 已提交
2118 2119
    /* delete message queue object */
    rt_object_delete(&(mq->parent.parent));
2120

D
dzzxzz@gmail.com 已提交
2121
    return RT_EOK;
2122
}
2123
RTM_EXPORT(rt_mq_delete);
2124
#endif /* RT_USING_HEAP */
2125 2126

/**
2127 2128
 * This function will send a message to message queue object. If the message queue is full,
 * current thread will be suspended until timeout.
2129 2130 2131 2132
 *
 * @param mq the message queue object
 * @param buffer the message
 * @param size the size of buffer
2133
 * @param timeout the waiting time
2134 2135 2136
 *
 * @return the error code
 */
2137 2138 2139 2140
rt_err_t rt_mq_send_wait(rt_mq_t     mq,
                         const void *buffer,
                         rt_size_t   size,
                         rt_int32_t  timeout)
2141
{
D
dzzxzz@gmail.com 已提交
2142 2143
    register rt_ubase_t temp;
    struct rt_mq_message *msg;
2144 2145
    rt_uint32_t tick_delta;
    struct rt_thread *thread;
D
dzzxzz@gmail.com 已提交
2146

2147
    /* parameter check */
D
dzzxzz@gmail.com 已提交
2148
    RT_ASSERT(mq != RT_NULL);
2149
    RT_ASSERT(rt_object_get_type(&mq->parent.parent) == RT_Object_Class_MessageQueue);
D
dzzxzz@gmail.com 已提交
2150 2151 2152 2153 2154 2155 2156
    RT_ASSERT(buffer != RT_NULL);
    RT_ASSERT(size != 0);

    /* greater than one message size */
    if (size > mq->msg_size)
        return -RT_ERROR;

2157 2158 2159 2160 2161
    /* initialize delta tick */
    tick_delta = 0;
    /* get current thread */
    thread = rt_thread_self();

D
dzzxzz@gmail.com 已提交
2162 2163 2164 2165 2166 2167
    RT_OBJECT_HOOK_CALL(rt_object_put_hook, (&(mq->parent.parent)));

    /* disable interrupt */
    temp = rt_hw_interrupt_disable();

    /* get a free list, there must be an empty item */
2168
    msg = (struct rt_mq_message *)mq->msg_queue_free;
2169 2170
    /* for non-blocking call */
    if (msg == RT_NULL && timeout == 0)
D
dzzxzz@gmail.com 已提交
2171 2172 2173 2174 2175 2176
    {
        /* enable interrupt */
        rt_hw_interrupt_enable(temp);

        return -RT_EFULL;
    }
2177 2178

    /* message queue is full */
2179
    while ((msg = (struct rt_mq_message *)mq->msg_queue_free) == RT_NULL)
2180 2181 2182 2183 2184 2185 2186 2187 2188 2189 2190 2191 2192 2193 2194 2195 2196 2197 2198 2199 2200 2201 2202 2203 2204 2205 2206 2207 2208 2209 2210 2211 2212 2213 2214 2215 2216 2217 2218 2219 2220 2221 2222 2223 2224 2225 2226 2227 2228 2229 2230 2231 2232 2233 2234 2235 2236 2237 2238 2239 2240
    {
        /* reset error number in thread */
        thread->error = RT_EOK;

        /* no waiting, return timeout */
        if (timeout == 0)
        {
            /* enable interrupt */
            rt_hw_interrupt_enable(temp);

            return -RT_EFULL;
        }

        RT_DEBUG_IN_THREAD_CONTEXT;
        /* suspend current thread */
        rt_ipc_list_suspend(&(mq->suspend_sender_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();

            RT_DEBUG_LOG(RT_DEBUG_IPC, ("mq_send_wait: start timer of thread:%s\n",
                                        thread->name));

            /* 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();

        /* if it's not waiting forever and then re-calculate timeout tick */
        if (timeout > 0)
        {
            tick_delta = rt_tick_get() - tick_delta;
            timeout -= tick_delta;
            if (timeout < 0)
                timeout = 0;
        }
    }

D
dzzxzz@gmail.com 已提交
2241 2242 2243 2244 2245 2246 2247 2248 2249 2250 2251 2252 2253 2254 2255 2256 2257 2258 2259 2260 2261 2262 2263 2264 2265 2266
    /* 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;

mysterywolf's avatar
mysterywolf 已提交
2267
    if(mq->entry < RT_MQ_ENTRY_MAX)
2268 2269 2270 2271 2272 2273 2274 2275 2276
    {
        /* increase message entry */
        mq->entry ++;
    }
    else
    {
        rt_hw_interrupt_enable(temp); /* enable interrupt */
        return -RT_EFULL; /* value overflowed */
    }
D
dzzxzz@gmail.com 已提交
2277 2278 2279 2280 2281 2282 2283 2284 2285 2286 2287 2288 2289 2290 2291 2292 2293 2294

    /* 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;
2295
}
2296 2297 2298 2299 2300 2301 2302 2303 2304 2305 2306 2307 2308 2309 2310 2311
RTM_EXPORT(rt_mq_send_wait)

/**
 * 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, const void *buffer, rt_size_t size)
{
    return rt_mq_send_wait(mq, buffer, size, 0);
}
2312
RTM_EXPORT(rt_mq_send);
2313 2314

/**
D
dzzxzz@gmail.com 已提交
2315 2316 2317
 * This function will send an urgent 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.
2318 2319 2320 2321 2322 2323 2324
 *
 * @param mq the message queue object
 * @param buffer the message
 * @param size the size of buffer
 *
 * @return the error code
 */
2325
rt_err_t rt_mq_urgent(rt_mq_t mq, const void *buffer, rt_size_t size)
2326
{
D
dzzxzz@gmail.com 已提交
2327 2328
    register rt_ubase_t temp;
    struct rt_mq_message *msg;
2329

2330
    /* parameter check */
D
dzzxzz@gmail.com 已提交
2331
    RT_ASSERT(mq != RT_NULL);
2332
    RT_ASSERT(rt_object_get_type(&mq->parent.parent) == RT_Object_Class_MessageQueue);
D
dzzxzz@gmail.com 已提交
2333 2334
    RT_ASSERT(buffer != RT_NULL);
    RT_ASSERT(size != 0);
2335

D
dzzxzz@gmail.com 已提交
2336 2337 2338
    /* greater than one message size */
    if (size > mq->msg_size)
        return -RT_ERROR;
2339

D
dzzxzz@gmail.com 已提交
2340
    RT_OBJECT_HOOK_CALL(rt_object_put_hook, (&(mq->parent.parent)));
2341

D
dzzxzz@gmail.com 已提交
2342 2343
    /* disable interrupt */
    temp = rt_hw_interrupt_disable();
2344

D
dzzxzz@gmail.com 已提交
2345 2346 2347 2348 2349 2350 2351
    /* 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);
2352

D
dzzxzz@gmail.com 已提交
2353 2354 2355 2356
        return -RT_EFULL;
    }
    /* move free list pointer */
    mq->msg_queue_free = msg->next;
2357

D
dzzxzz@gmail.com 已提交
2358 2359
    /* enable interrupt */
    rt_hw_interrupt_enable(temp);
2360

D
dzzxzz@gmail.com 已提交
2361 2362
    /* copy buffer */
    rt_memcpy(msg + 1, buffer, size);
2363

D
dzzxzz@gmail.com 已提交
2364 2365
    /* disable interrupt */
    temp = rt_hw_interrupt_disable();
2366

D
dzzxzz@gmail.com 已提交
2367
    /* link msg to the beginning of message queue */
2368
    msg->next = (struct rt_mq_message *)mq->msg_queue_head;
D
dzzxzz@gmail.com 已提交
2369
    mq->msg_queue_head = msg;
2370

D
dzzxzz@gmail.com 已提交
2371 2372 2373
    /* if there is no tail */
    if (mq->msg_queue_tail == RT_NULL)
        mq->msg_queue_tail = msg;
2374

mysterywolf's avatar
mysterywolf 已提交
2375
    if(mq->entry < RT_MQ_ENTRY_MAX)
2376 2377 2378 2379 2380 2381 2382 2383 2384
    {
        /* increase message entry */
        mq->entry ++;
    }
    else
    {
        rt_hw_interrupt_enable(temp); /* enable interrupt */
        return -RT_EFULL; /* value overflowed */
    }
mysterywolf's avatar
mysterywolf 已提交
2385

D
dzzxzz@gmail.com 已提交
2386 2387 2388 2389
    /* resume suspended thread */
    if (!rt_list_isempty(&mq->parent.suspend_thread))
    {
        rt_ipc_list_resume(&(mq->parent.suspend_thread));
2390

D
dzzxzz@gmail.com 已提交
2391 2392
        /* enable interrupt */
        rt_hw_interrupt_enable(temp);
2393

D
dzzxzz@gmail.com 已提交
2394
        rt_schedule();
D
dzzxzz 已提交
2395

D
dzzxzz@gmail.com 已提交
2396 2397
        return RT_EOK;
    }
2398

D
dzzxzz@gmail.com 已提交
2399 2400
    /* enable interrupt */
    rt_hw_interrupt_enable(temp);
2401

D
dzzxzz@gmail.com 已提交
2402
    return RT_EOK;
2403
}
2404
RTM_EXPORT(rt_mq_urgent);
2405 2406

/**
D
dzzxzz@gmail.com 已提交
2407 2408 2409
 * 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.
2410 2411 2412 2413 2414 2415 2416 2417
 *
 * @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
 */
D
dzzxzz@gmail.com 已提交
2418 2419 2420 2421
rt_err_t rt_mq_recv(rt_mq_t    mq,
                    void      *buffer,
                    rt_size_t  size,
                    rt_int32_t timeout)
2422
{
D
dzzxzz@gmail.com 已提交
2423 2424 2425 2426 2427
    struct rt_thread *thread;
    register rt_ubase_t temp;
    struct rt_mq_message *msg;
    rt_uint32_t tick_delta;

2428
    /* parameter check */
D
dzzxzz@gmail.com 已提交
2429
    RT_ASSERT(mq != RT_NULL);
2430
    RT_ASSERT(rt_object_get_type(&mq->parent.parent) == RT_Object_Class_MessageQueue);
D
dzzxzz@gmail.com 已提交
2431 2432 2433 2434 2435 2436 2437 2438 2439 2440 2441 2442 2443 2444 2445 2446 2447 2448 2449 2450 2451 2452 2453
    RT_ASSERT(buffer != RT_NULL);
    RT_ASSERT(size != 0);

    /* initialize delta tick */
    tick_delta = 0;
    /* get current thread */
    thread = rt_thread_self();
    RT_OBJECT_HOOK_CALL(rt_object_trytake_hook, (&(mq->parent.parent)));

    /* disable interrupt */
    temp = rt_hw_interrupt_disable();

    /* for non-blocking call */
    if (mq->entry == 0 && timeout == 0)
    {
        rt_hw_interrupt_enable(temp);

        return -RT_ETIMEOUT;
    }

    /* message queue is empty */
    while (mq->entry == 0)
    {
G
Grissiom 已提交
2454
        RT_DEBUG_IN_THREAD_CONTEXT;
D
dzzxzz@gmail.com 已提交
2455 2456 2457 2458 2459 2460 2461 2462 2463 2464 2465 2466 2467 2468 2469 2470 2471 2472 2473 2474 2475 2476 2477 2478 2479 2480 2481

        /* 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();

            RT_DEBUG_LOG(RT_DEBUG_IPC, ("set thread:%s to timer list\n",
2482
                                        thread->name));
2483

D
dzzxzz@gmail.com 已提交
2484 2485 2486 2487 2488 2489 2490 2491 2492 2493 2494 2495 2496 2497 2498 2499 2500 2501 2502 2503 2504 2505 2506 2507 2508 2509 2510 2511 2512 2513 2514 2515 2516 2517 2518 2519 2520 2521 2522 2523 2524 2525 2526
            /* 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();

        /* if it's not waiting forever and then 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 */
2527 2528 2529 2530
    if(mq->entry > 0)
    {
        mq->entry --;
    }
D
dzzxzz@gmail.com 已提交
2531 2532 2533 2534 2535 2536 2537 2538 2539 2540 2541 2542

    /* 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;
2543 2544 2545 2546 2547 2548 2549 2550 2551 2552 2553 2554 2555 2556 2557 2558

    /* resume suspended thread */
    if (!rt_list_isempty(&(mq->suspend_sender_thread)))
    {
        rt_ipc_list_resume(&(mq->suspend_sender_thread));

        /* enable interrupt */
        rt_hw_interrupt_enable(temp);

        RT_OBJECT_HOOK_CALL(rt_object_take_hook, (&(mq->parent.parent)));

        rt_schedule();

        return RT_EOK;
    }

D
dzzxzz@gmail.com 已提交
2559 2560 2561 2562 2563 2564
    /* enable interrupt */
    rt_hw_interrupt_enable(temp);

    RT_OBJECT_HOOK_CALL(rt_object_take_hook, (&(mq->parent.parent)));

    return RT_EOK;
2565
}
B
Bernard Xiong 已提交
2566
RTM_EXPORT(rt_mq_recv);
2567 2568

/**
D
dzzxzz@gmail.com 已提交
2569 2570
 * This function can get or set some extra attributions of a message queue
 * object.
2571 2572 2573 2574 2575 2576 2577
 *
 * @param mq the message queue object
 * @param cmd the execution command
 * @param arg the execution argument
 *
 * @return the error code
 */
B
bernard 已提交
2578
rt_err_t rt_mq_control(rt_mq_t mq, int cmd, void *arg)
2579
{
D
dzzxzz@gmail.com 已提交
2580 2581
    rt_ubase_t level;
    struct rt_mq_message *msg;
2582

2583
    /* parameter check */
D
dzzxzz@gmail.com 已提交
2584
    RT_ASSERT(mq != RT_NULL);
2585
    RT_ASSERT(rt_object_get_type(&mq->parent.parent) == RT_Object_Class_MessageQueue);
2586

D
dzzxzz@gmail.com 已提交
2587 2588 2589 2590
    if (cmd == RT_IPC_CMD_RESET)
    {
        /* disable interrupt */
        level = rt_hw_interrupt_disable();
2591

D
dzzxzz@gmail.com 已提交
2592 2593
        /* resume all waiting thread */
        rt_ipc_list_resume_all(&mq->parent.suspend_thread);
2594 2595
        /* also resume all message queue private suspended thread */
        rt_ipc_list_resume_all(&(mq->suspend_sender_thread));
2596

D
dzzxzz@gmail.com 已提交
2597 2598 2599 2600 2601
        /* 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;
2602

D
dzzxzz@gmail.com 已提交
2603 2604 2605 2606 2607
            /* 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;
2608

D
dzzxzz@gmail.com 已提交
2609 2610 2611 2612
            /* put message to free list */
            msg->next = (struct rt_mq_message *)mq->msg_queue_free;
            mq->msg_queue_free = msg;
        }
2613

D
dzzxzz@gmail.com 已提交
2614 2615
        /* clean entry */
        mq->entry = 0;
2616

D
dzzxzz@gmail.com 已提交
2617 2618
        /* enable interrupt */
        rt_hw_interrupt_enable(level);
2619

D
dzzxzz@gmail.com 已提交
2620
        rt_schedule();
2621

D
dzzxzz@gmail.com 已提交
2622 2623
        return RT_EOK;
    }
2624

D
dzzxzz@gmail.com 已提交
2625
    return -RT_ERROR;
2626
}
D
dzzxzz@gmail.com 已提交
2627
RTM_EXPORT(rt_mq_control);
2628
#endif /* RT_USING_MESSAGEQUEUE */
D
dzzxzz 已提交
2629

D
dogandog 已提交
2630
/**@}*/