mutex.c 5.63 KB
Newer Older
1
/*
2
 * Copyright (c) 2014-2015, Siemens AG. All rights reserved.
3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions are met:
 *
 * 1. Redistributions of source code must retain the above copyright notice,
 * this list of conditions and the following disclaimer.
 *
 * 2. Redistributions in binary form must reproduce the above copyright notice,
 * this list of conditions and the following disclaimer in the documentation
 * and/or other materials provided with the distribution.
 *
 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
 * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE
 * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
 * POSSIBILITY OF SUCH DAMAGE.
 */

#include <embb/base/c/mutex.h>
28
#include <embb/base/c/thread.h>
29 30 31 32
#include <assert.h>

#include <embb/base/c/internal/unused.h>

33
#ifdef EMBB_PLATFORM_THREADING_WINTHREADS
34 35

int embb_mutex_init(embb_mutex_t* mutex, int type) {
36 37 38
  if (NULL == mutex) {
    return EMBB_ERROR;
  }
39 40 41 42 43 44 45
  /* Critical sections in Windows are always recursive */
  InitializeCriticalSection(mutex);
  EMBB_UNUSED(type);
  return EMBB_SUCCESS;
}

int embb_mutex_lock(embb_mutex_t* mutex) {
46 47 48
  if (NULL == mutex) {
    return EMBB_ERROR;
  }
49 50 51 52 53
  EnterCriticalSection(mutex);
  return EMBB_SUCCESS;
}

int embb_mutex_try_lock(embb_mutex_t* mutex) {
54 55 56
  if (NULL == mutex) {
    return EMBB_ERROR;
  }
57 58 59 60 61 62 63
  BOOL success;
  success = TryEnterCriticalSection(mutex);
  if (success == FALSE) return EMBB_ERROR;
  return EMBB_SUCCESS;
}

int embb_mutex_unlock(embb_mutex_t* mutex) {
64 65 66
  if (NULL == mutex) {
    return EMBB_ERROR;
  }
67 68 69 70 71
  LeaveCriticalSection(mutex);
  return EMBB_SUCCESS;
}

void embb_mutex_destroy(embb_mutex_t* mutex) {
72 73 74
  if (NULL == mutex) {
    return;
  }
75 76 77
  DeleteCriticalSection(mutex);
}

78
#endif /* EMBB_PLATFORM_THREADING_WINTHREADS */
79

80
#ifdef EMBB_PLATFORM_THREADING_POSIXTHREADS
81 82

int embb_mutex_init(embb_mutex_t* mutex, int type) {
83 84 85
  if (NULL == mutex) {
    return EMBB_ERROR;
  }
86 87 88 89 90 91 92
  if (type == EMBB_MUTEX_PLAIN) {
    if (pthread_mutex_init(mutex, NULL) != 0) return EMBB_ERROR;
  } else {
    assert(type == EMBB_MUTEX_RECURSIVE);
    pthread_mutexattr_t attributes;
    if (pthread_mutexattr_init(&attributes) != 0) return EMBB_ERROR;
    if (pthread_mutexattr_settype(&attributes, PTHREAD_MUTEX_RECURSIVE) != 0) {
93 94 95 96 97
      pthread_mutexattr_destroy(&attributes);
      return EMBB_ERROR;
    }
    if (pthread_mutex_init(mutex, &attributes) != 0) {
      pthread_mutexattr_destroy(&attributes);
98 99 100 101 102 103 104 105
      return EMBB_ERROR;
    }
    if (pthread_mutexattr_destroy(&attributes) != 0) return EMBB_ERROR;
  }
  return EMBB_SUCCESS;
}

int embb_mutex_lock(embb_mutex_t* mutex) {
106 107 108
  if (NULL == mutex) {
    return EMBB_ERROR;
  }
109 110 111 112 113 114 115 116
  int result = pthread_mutex_lock(mutex);
  if (result != 0) {
    return EMBB_ERROR;
  }
  return EMBB_SUCCESS;
}

int embb_mutex_try_lock(embb_mutex_t* mutex) {
117 118 119
  if (NULL == mutex) {
    return EMBB_ERROR;
  }
120 121 122 123 124 125 126 127 128 129 130
  int result = pthread_mutex_trylock(mutex);
  if (result == 0) {
    return EMBB_SUCCESS;
  }
  if (result == EBUSY) {
    return EMBB_BUSY;
  }
  return EMBB_ERROR;
}

int embb_mutex_unlock(embb_mutex_t* mutex) {
131 132 133
  if (NULL == mutex) {
    return EMBB_ERROR;
  }
134 135 136 137 138 139 140 141
  int result = pthread_mutex_unlock(mutex);
  if (result != 0) {
    return EMBB_ERROR;
  }
  return EMBB_SUCCESS;
}

void embb_mutex_destroy(embb_mutex_t* mutex) {
142 143 144
  if (NULL == mutex) {
    return;
  }
145 146 147
  pthread_mutex_destroy(mutex);
}

148
#endif /* EMBB_PLATFORM_THREADING_POSIXTHREADS */
149 150

int embb_spin_init(embb_spinlock_t* spinlock) {
151 152 153
  if (NULL == spinlock) {
    return EMBB_ERROR;
  }
Christian Kern committed
154 155 156
  // For now, store the initial value. In the future will use atomic init
  // function (as soon as available).
  embb_atomic_store_int(&spinlock->atomic_spin_variable_, 0);
157
  return EMBB_SUCCESS;
158 159 160
}

int embb_spin_lock(embb_spinlock_t* spinlock) {
161 162 163
  if (NULL == spinlock) {
    return EMBB_ERROR;
  }
164
  int expected = 0;
165
  int spins = 1;
166 167 168 169

  // try to swap the
  while (0 == embb_atomic_compare_and_swap_int(
    &spinlock->atomic_spin_variable_, &expected, 1)) {
170 171 172 173
    if (0 == (spins & 1023)) {
      embb_thread_yield();
    }
    spins++;
174 175 176 177 178 179 180 181
    // reset expected, as CAS might change it...
    expected = 0;
  }
  return EMBB_SUCCESS;
}

int embb_spin_try_lock(embb_spinlock_t* spinlock,
  unsigned int max_number_spins) {
182 183 184
  if (NULL == spinlock) {
    return EMBB_ERROR;
  }
Christian Kern committed
185 186 187
  if (max_number_spins == 0)
    return EMBB_BUSY;

188 189 190 191
  int expected = 0;
  while (0 == embb_atomic_compare_and_swap_int(
    &spinlock->atomic_spin_variable_,
    &expected, 1)) {
Christian Kern committed
192 193
    max_number_spins--;
    if (0 == max_number_spins) {
194 195 196 197 198 199 200 201 202
      return EMBB_BUSY;
    }
    expected = 0;
  }

  return EMBB_SUCCESS;
}

int embb_spin_unlock(embb_spinlock_t* spinlock) {
203 204 205
  if (NULL == spinlock) {
    return EMBB_ERROR;
  }
206 207 208 209 210 211 212 213 214
  int expected = 1;
  return embb_atomic_compare_and_swap_int(&spinlock->atomic_spin_variable_,
    &expected, 0) ?
  EMBB_SUCCESS : EMBB_ERROR;
}

void embb_spin_destroy(embb_spinlock_t* spinlock) {
  // for now, doing nothing here... in future, will call the respective
  // destroy function for atomics...
215
  EMBB_UNUSED(spinlock);
216
}