mutex.c 5.63 KB
Newer Older
1
/*
Marcus Winter committed
2
 * Copyright (c) 2014-2016, 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
  assert(NULL != mutex);
73 74 75
  DeleteCriticalSection(mutex);
}

76
#endif /* EMBB_PLATFORM_THREADING_WINTHREADS */
77

78
#ifdef EMBB_PLATFORM_THREADING_POSIXTHREADS
79 80

int embb_mutex_init(embb_mutex_t* mutex, int type) {
81 82 83
  if (NULL == mutex) {
    return EMBB_ERROR;
  }
84 85 86 87 88 89 90
  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) {
91 92 93 94 95
      pthread_mutexattr_destroy(&attributes);
      return EMBB_ERROR;
    }
    if (pthread_mutex_init(mutex, &attributes) != 0) {
      pthread_mutexattr_destroy(&attributes);
96 97 98 99 100 101 102 103
      return EMBB_ERROR;
    }
    if (pthread_mutexattr_destroy(&attributes) != 0) return EMBB_ERROR;
  }
  return EMBB_SUCCESS;
}

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

int embb_mutex_try_lock(embb_mutex_t* mutex) {
115 116 117
  if (NULL == mutex) {
    return EMBB_ERROR;
  }
118 119 120 121 122 123 124 125 126 127 128
  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) {
129 130 131
  if (NULL == mutex) {
    return EMBB_ERROR;
  }
132 133 134 135 136 137 138 139
  int result = pthread_mutex_unlock(mutex);
  if (result != 0) {
    return EMBB_ERROR;
  }
  return EMBB_SUCCESS;
}

void embb_mutex_destroy(embb_mutex_t* mutex) {
140
  assert(NULL != mutex);
141 142 143
  pthread_mutex_destroy(mutex);
}

144
#endif /* EMBB_PLATFORM_THREADING_POSIXTHREADS */
145 146

int embb_spin_init(embb_spinlock_t* spinlock) {
147 148 149
  if (NULL == spinlock) {
    return EMBB_ERROR;
  }
Christian Kern committed
150 151 152
  // 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);
153
  return EMBB_SUCCESS;
154 155 156
}

int embb_spin_lock(embb_spinlock_t* spinlock) {
157 158 159
  if (NULL == spinlock) {
    return EMBB_ERROR;
  }
160
  int expected = 0;
161
  int spins = 1;
162 163 164 165

  // try to swap the
  while (0 == embb_atomic_compare_and_swap_int(
    &spinlock->atomic_spin_variable_, &expected, 1)) {
166 167 168 169
    if (0 == (spins & 1023)) {
      embb_thread_yield();
    }
    spins++;
170 171 172 173 174 175 176 177
    // 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) {
178 179 180
  if (NULL == spinlock) {
    return EMBB_ERROR;
  }
Christian Kern committed
181 182 183
  if (max_number_spins == 0)
    return EMBB_BUSY;

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

  return EMBB_SUCCESS;
}

int embb_spin_unlock(embb_spinlock_t* spinlock) {
199 200 201
  if (NULL == spinlock) {
    return EMBB_ERROR;
  }
202 203 204 205 206 207 208
  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) {
209
  assert(NULL != spinlock);
210 211
  // for now, doing nothing here... in future, will call the respective
  // destroy function for atomics...
212
  EMBB_UNUSED(spinlock);
213
}