This is a fork of the `events` subdirectory of https://github.com/ARMmbed/mbed-os
Dependents: HelloWorld_CCA01M1 HelloWorld_CCA02M1 CI-data-logger-server HelloWorld_CCA02M1 ... more
This is a fork of the events
subdirectory of https://github.com/ARMmbed/mbed-os.
Note, you must import this library with import name: events
!!!
equeue/equeue_posix.c@9832:b95afde9ef7e, 2017-09-05 (annotated)
- Committer:
- Wolfgang Betz
- Date:
- Tue Sep 05 09:09:24 2017 +0200
- Revision:
- 9832:b95afde9ef7e
- Parent:
- 2:a60d8117d0e0
Merge branch 'master' of hg::http://developer.mbed.org/teams/ST/code/ST_Events into events-split
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
Bogdan Marinescu |
0:a792d4bf36c2 | 1 | /* |
Bogdan Marinescu |
0:a792d4bf36c2 | 2 | * Implementation for Posix compliant platforms |
Bogdan Marinescu |
0:a792d4bf36c2 | 3 | * |
Bogdan Marinescu |
0:a792d4bf36c2 | 4 | * Copyright (c) 2016 Christopher Haster |
Bogdan Marinescu |
0:a792d4bf36c2 | 5 | * |
Bogdan Marinescu |
0:a792d4bf36c2 | 6 | * Licensed under the Apache License, Version 2.0 (the "License"); |
Bogdan Marinescu |
0:a792d4bf36c2 | 7 | * you may not use this file except in compliance with the License. |
Bogdan Marinescu |
0:a792d4bf36c2 | 8 | * You may obtain a copy of the License at |
Bogdan Marinescu |
0:a792d4bf36c2 | 9 | * |
Bogdan Marinescu |
0:a792d4bf36c2 | 10 | * http://www.apache.org/licenses/LICENSE-2.0 |
Bogdan Marinescu |
0:a792d4bf36c2 | 11 | * |
Bogdan Marinescu |
0:a792d4bf36c2 | 12 | * Unless required by applicable law or agreed to in writing, software |
Bogdan Marinescu |
0:a792d4bf36c2 | 13 | * distributed under the License is distributed on an "AS IS" BASIS, |
Bogdan Marinescu |
0:a792d4bf36c2 | 14 | * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. |
Bogdan Marinescu |
0:a792d4bf36c2 | 15 | * See the License for the specific language governing permissions and |
Bogdan Marinescu |
0:a792d4bf36c2 | 16 | * limitations under the License. |
Bogdan Marinescu |
0:a792d4bf36c2 | 17 | */ |
Sam Grove |
2:a60d8117d0e0 | 18 | #include "equeue/equeue_platform.h" |
Bogdan Marinescu |
0:a792d4bf36c2 | 19 | |
Bogdan Marinescu |
0:a792d4bf36c2 | 20 | #if defined(EQUEUE_PLATFORM_POSIX) |
Bogdan Marinescu |
0:a792d4bf36c2 | 21 | |
Bogdan Marinescu |
0:a792d4bf36c2 | 22 | #include <time.h> |
Bogdan Marinescu |
0:a792d4bf36c2 | 23 | #include <sys/time.h> |
Bogdan Marinescu |
0:a792d4bf36c2 | 24 | #include <errno.h> |
Bogdan Marinescu |
0:a792d4bf36c2 | 25 | |
Bogdan Marinescu |
0:a792d4bf36c2 | 26 | |
Bogdan Marinescu |
0:a792d4bf36c2 | 27 | // Tick operations |
Bogdan Marinescu |
0:a792d4bf36c2 | 28 | unsigned equeue_tick(void) { |
Bogdan Marinescu |
0:a792d4bf36c2 | 29 | struct timeval tv; |
Bogdan Marinescu |
0:a792d4bf36c2 | 30 | gettimeofday(&tv, 0); |
Bogdan Marinescu |
0:a792d4bf36c2 | 31 | return (unsigned)(tv.tv_sec*1000 + tv.tv_usec/1000); |
Bogdan Marinescu |
0:a792d4bf36c2 | 32 | } |
Bogdan Marinescu |
0:a792d4bf36c2 | 33 | |
Bogdan Marinescu |
0:a792d4bf36c2 | 34 | |
Bogdan Marinescu |
0:a792d4bf36c2 | 35 | // Mutex operations |
Bogdan Marinescu |
0:a792d4bf36c2 | 36 | int equeue_mutex_create(equeue_mutex_t *m) { |
Bogdan Marinescu |
0:a792d4bf36c2 | 37 | return pthread_mutex_init(m, 0); |
Bogdan Marinescu |
0:a792d4bf36c2 | 38 | } |
Bogdan Marinescu |
0:a792d4bf36c2 | 39 | |
Bogdan Marinescu |
0:a792d4bf36c2 | 40 | void equeue_mutex_destroy(equeue_mutex_t *m) { |
Bogdan Marinescu |
0:a792d4bf36c2 | 41 | pthread_mutex_destroy(m); |
Bogdan Marinescu |
0:a792d4bf36c2 | 42 | } |
Bogdan Marinescu |
0:a792d4bf36c2 | 43 | |
Bogdan Marinescu |
0:a792d4bf36c2 | 44 | void equeue_mutex_lock(equeue_mutex_t *m) { |
Bogdan Marinescu |
0:a792d4bf36c2 | 45 | pthread_mutex_lock(m); |
Bogdan Marinescu |
0:a792d4bf36c2 | 46 | } |
Bogdan Marinescu |
0:a792d4bf36c2 | 47 | |
Bogdan Marinescu |
0:a792d4bf36c2 | 48 | void equeue_mutex_unlock(equeue_mutex_t *m) { |
Bogdan Marinescu |
0:a792d4bf36c2 | 49 | pthread_mutex_unlock(m); |
Bogdan Marinescu |
0:a792d4bf36c2 | 50 | } |
Bogdan Marinescu |
0:a792d4bf36c2 | 51 | |
Bogdan Marinescu |
0:a792d4bf36c2 | 52 | |
Bogdan Marinescu |
0:a792d4bf36c2 | 53 | // Semaphore operations |
Bogdan Marinescu |
0:a792d4bf36c2 | 54 | int equeue_sema_create(equeue_sema_t *s) { |
Bogdan Marinescu |
0:a792d4bf36c2 | 55 | int err = pthread_mutex_init(&s->mutex, 0); |
Bogdan Marinescu |
0:a792d4bf36c2 | 56 | if (err) { |
Bogdan Marinescu |
0:a792d4bf36c2 | 57 | return err; |
Bogdan Marinescu |
0:a792d4bf36c2 | 58 | } |
Bogdan Marinescu |
0:a792d4bf36c2 | 59 | |
Bogdan Marinescu |
0:a792d4bf36c2 | 60 | err = pthread_cond_init(&s->cond, 0); |
Bogdan Marinescu |
0:a792d4bf36c2 | 61 | if (err) { |
Bogdan Marinescu |
0:a792d4bf36c2 | 62 | return err; |
Bogdan Marinescu |
0:a792d4bf36c2 | 63 | } |
Bogdan Marinescu |
0:a792d4bf36c2 | 64 | |
Bogdan Marinescu |
0:a792d4bf36c2 | 65 | s->signal = false; |
Bogdan Marinescu |
0:a792d4bf36c2 | 66 | return 0; |
Bogdan Marinescu |
0:a792d4bf36c2 | 67 | } |
Bogdan Marinescu |
0:a792d4bf36c2 | 68 | |
Bogdan Marinescu |
0:a792d4bf36c2 | 69 | void equeue_sema_destroy(equeue_sema_t *s) { |
Bogdan Marinescu |
0:a792d4bf36c2 | 70 | pthread_cond_destroy(&s->cond); |
Bogdan Marinescu |
0:a792d4bf36c2 | 71 | pthread_mutex_destroy(&s->mutex); |
Bogdan Marinescu |
0:a792d4bf36c2 | 72 | } |
Bogdan Marinescu |
0:a792d4bf36c2 | 73 | |
Bogdan Marinescu |
0:a792d4bf36c2 | 74 | void equeue_sema_signal(equeue_sema_t *s) { |
Bogdan Marinescu |
0:a792d4bf36c2 | 75 | pthread_mutex_lock(&s->mutex); |
Bogdan Marinescu |
0:a792d4bf36c2 | 76 | s->signal = true; |
Bogdan Marinescu |
0:a792d4bf36c2 | 77 | pthread_cond_signal(&s->cond); |
Bogdan Marinescu |
0:a792d4bf36c2 | 78 | pthread_mutex_unlock(&s->mutex); |
Bogdan Marinescu |
0:a792d4bf36c2 | 79 | } |
Bogdan Marinescu |
0:a792d4bf36c2 | 80 | |
Bogdan Marinescu |
0:a792d4bf36c2 | 81 | bool equeue_sema_wait(equeue_sema_t *s, int ms) { |
Bogdan Marinescu |
0:a792d4bf36c2 | 82 | pthread_mutex_lock(&s->mutex); |
Bogdan Marinescu |
0:a792d4bf36c2 | 83 | if (!s->signal) { |
Bogdan Marinescu |
0:a792d4bf36c2 | 84 | if (ms < 0) { |
Bogdan Marinescu |
0:a792d4bf36c2 | 85 | pthread_cond_wait(&s->cond, &s->mutex); |
Bogdan Marinescu |
0:a792d4bf36c2 | 86 | } else { |
Bogdan Marinescu |
0:a792d4bf36c2 | 87 | struct timeval tv; |
Bogdan Marinescu |
0:a792d4bf36c2 | 88 | gettimeofday(&tv, 0); |
Bogdan Marinescu |
0:a792d4bf36c2 | 89 | |
Bogdan Marinescu |
0:a792d4bf36c2 | 90 | struct timespec ts = { |
Bogdan Marinescu |
0:a792d4bf36c2 | 91 | .tv_sec = ms/1000 + tv.tv_sec, |
Bogdan Marinescu |
0:a792d4bf36c2 | 92 | .tv_nsec = ms*1000000 + tv.tv_usec*1000, |
Bogdan Marinescu |
0:a792d4bf36c2 | 93 | }; |
Bogdan Marinescu |
0:a792d4bf36c2 | 94 | |
Bogdan Marinescu |
0:a792d4bf36c2 | 95 | pthread_cond_timedwait(&s->cond, &s->mutex, &ts); |
Bogdan Marinescu |
0:a792d4bf36c2 | 96 | } |
Bogdan Marinescu |
0:a792d4bf36c2 | 97 | } |
Bogdan Marinescu |
0:a792d4bf36c2 | 98 | |
Bogdan Marinescu |
0:a792d4bf36c2 | 99 | bool signal = s->signal; |
Bogdan Marinescu |
0:a792d4bf36c2 | 100 | s->signal = false; |
Bogdan Marinescu |
0:a792d4bf36c2 | 101 | pthread_mutex_unlock(&s->mutex); |
Bogdan Marinescu |
0:a792d4bf36c2 | 102 | |
Bogdan Marinescu |
0:a792d4bf36c2 | 103 | return signal; |
Bogdan Marinescu |
0:a792d4bf36c2 | 104 | } |
Bogdan Marinescu |
0:a792d4bf36c2 | 105 | |
Bogdan Marinescu |
0:a792d4bf36c2 | 106 | #endif |