| 1 | /* | 
|---|
| 2 | Copyright (c) 2012, Broadcom Europe Ltd | 
|---|
| 3 | All rights reserved. | 
|---|
| 4 |  | 
|---|
| 5 | Redistribution and use in source and binary forms, with or without | 
|---|
| 6 | modification, are permitted provided that the following conditions are met: | 
|---|
| 7 | * Redistributions of source code must retain the above copyright | 
|---|
| 8 | notice, this list of conditions and the following disclaimer. | 
|---|
| 9 | * Redistributions in binary form must reproduce the above copyright | 
|---|
| 10 | notice, this list of conditions and the following disclaimer in the | 
|---|
| 11 | documentation and/or other materials provided with the distribution. | 
|---|
| 12 | * Neither the name of the copyright holder nor the | 
|---|
| 13 | names of its contributors may be used to endorse or promote products | 
|---|
| 14 | derived from this software without specific prior written permission. | 
|---|
| 15 |  | 
|---|
| 16 | THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" AND | 
|---|
| 17 | ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED | 
|---|
| 18 | WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE | 
|---|
| 19 | DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE FOR ANY | 
|---|
| 20 | DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES | 
|---|
| 21 | (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; | 
|---|
| 22 | LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND | 
|---|
| 23 | ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT | 
|---|
| 24 | (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS | 
|---|
| 25 | SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. | 
|---|
| 26 | */ | 
|---|
| 27 |  | 
|---|
| 28 | #include "interface/vcos/vcos.h" | 
|---|
| 29 | #include "interface/vcos/vcos_reentrant_mutex.h" | 
|---|
| 30 |  | 
|---|
| 31 | VCOS_STATUS_T vcos_generic_reentrant_mutex_create(VCOS_REENTRANT_MUTEX_T *m, const char *name) | 
|---|
| 32 | { | 
|---|
| 33 | m->count = 0; | 
|---|
| 34 | m->owner = 0; | 
|---|
| 35 | return vcos_mutex_create(&m->mutex, name); | 
|---|
| 36 | } | 
|---|
| 37 |  | 
|---|
| 38 | void vcos_generic_reentrant_mutex_delete(VCOS_REENTRANT_MUTEX_T *m) | 
|---|
| 39 | { | 
|---|
| 40 | vcos_assert(m->count == 0); | 
|---|
| 41 | vcos_mutex_delete(&m->mutex); | 
|---|
| 42 | } | 
|---|
| 43 |  | 
|---|
| 44 | void vcos_generic_reentrant_mutex_lock(VCOS_REENTRANT_MUTEX_T *m) | 
|---|
| 45 | { | 
|---|
| 46 | VCOS_THREAD_T *thread = vcos_thread_current(); | 
|---|
| 47 | vcos_assert(m); | 
|---|
| 48 |  | 
|---|
| 49 | vcos_assert(thread != 0); | 
|---|
| 50 |  | 
|---|
| 51 | if (m->owner != thread) | 
|---|
| 52 | { | 
|---|
| 53 | vcos_mutex_lock(&m->mutex); | 
|---|
| 54 | m->owner = thread; | 
|---|
| 55 | vcos_assert(m->count == 0); | 
|---|
| 56 | } | 
|---|
| 57 | m->count++; | 
|---|
| 58 | } | 
|---|
| 59 |  | 
|---|
| 60 | void vcos_generic_reentrant_mutex_unlock(VCOS_REENTRANT_MUTEX_T *m) | 
|---|
| 61 | { | 
|---|
| 62 | vcos_assert(m->count != 0); | 
|---|
| 63 | vcos_assert(m->owner == vcos_thread_current()); | 
|---|
| 64 | m->count--; | 
|---|
| 65 | if (m->count == 0) | 
|---|
| 66 | { | 
|---|
| 67 | m->owner = 0; | 
|---|
| 68 | vcos_mutex_unlock(&m->mutex); | 
|---|
| 69 | } | 
|---|
| 70 | } | 
|---|
| 71 |  | 
|---|
| 72 |  | 
|---|
| 73 |  | 
|---|
| 74 |  | 
|---|
| 75 |  | 
|---|
| 76 |  | 
|---|
| 77 |  | 
|---|