mirror of https://github.com/rusefi/ChibiOS.git
git-svn-id: svn://svn.code.sf.net/p/chibios/svn/trunk@8928 35acf78f-673a-0410-8e92-d51de3d6d3f4
This commit is contained in:
Giovanni Di Sirio
parent
45e44e7328
commit
e50143cb73
|
|
@ -241,7 +241,7 @@ int32 OS_Milli2Ticks(uint32 milli_seconds) {
|
|||
|
||||
/*-- Queues API -------------------------------------------------------------*/
|
||||
|
||||
/*-- Semaphore and Mutex API ------------------------------------------------*/
|
||||
/*-- Binary Semaphore API ---------------------------------------------------*/
|
||||
|
||||
/**
|
||||
* @brief Binary semaphore creation.
|
||||
|
|
@ -314,7 +314,7 @@ int32 OS_BinSemDelete(uint32 sem_id) {
|
|||
bsp->sem.queue.prev = NULL;
|
||||
chPoolFreeI(&osal.binary_semaphores_pool, (void *)bsp);
|
||||
|
||||
/* Required because some thready could have been made ready.*/
|
||||
/* Required because some thread could have been made ready.*/
|
||||
chSchRescheduleS();
|
||||
|
||||
chSysUnlock();
|
||||
|
|
@ -513,6 +513,435 @@ int32 OS_BinSemGetInfo(uint32 sem_id, OS_bin_sem_prop_t *bin_prop) {
|
|||
return OS_ERR_NOT_IMPLEMENTED;
|
||||
}
|
||||
|
||||
/*-- Counter Semaphore API --------------------------------------------------*/
|
||||
|
||||
/**
|
||||
* @brief Counter semaphore creation.
|
||||
*
|
||||
* @param[out] sem_id pointer to a counter semaphore id variable
|
||||
* @param[in] sem_name the counter semaphore name
|
||||
* @param[in] sem_initial_value semaphore intial value
|
||||
* @param[in] options semaphore options
|
||||
* @return An error code.
|
||||
*
|
||||
* @api
|
||||
*/
|
||||
int32 OS_CountSemCreate (uint32 *sem_id, const char *sem_name,
|
||||
uint32 sem_initial_value, uint32 options) {
|
||||
semaphore_t *sp;
|
||||
|
||||
(void)options;
|
||||
|
||||
/* NULL pointer checks.*/
|
||||
if ((sem_id == NULL) || (sem_name == NULL)) {
|
||||
return OS_INVALID_POINTER;
|
||||
}
|
||||
|
||||
/* Checking semaphore name length.*/
|
||||
if (strlen(sem_name) >= OS_MAX_API_NAME) {
|
||||
return OS_ERR_NAME_TOO_LONG;
|
||||
}
|
||||
|
||||
/* Semaphore counter check, it must be non-negative.*/
|
||||
if ((int32)sem_initial_value < 0) {
|
||||
return OS_INVALID_INT_NUM;
|
||||
}
|
||||
|
||||
sp = chPoolAlloc(&osal.count_semaphores_pool);
|
||||
|
||||
if (sp == 0) {
|
||||
return OS_SEM_FAILURE;
|
||||
}
|
||||
|
||||
/* Semaphore is initialized.*/
|
||||
chSemObjectInit(sp, (cnt_t)sem_initial_value);
|
||||
|
||||
*sem_id = (uint32)sp;
|
||||
|
||||
return OS_SUCCESS;
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief Counter semaphore deletion.
|
||||
*
|
||||
* @param[in] sem_id counter semaphore id variable
|
||||
* @return An error code.
|
||||
*
|
||||
* @api
|
||||
*/
|
||||
int32 OS_CountSemDelete(uint32 sem_id) {
|
||||
semaphore_t *sp = (semaphore_t *)sem_id;
|
||||
|
||||
if ((sp < &osal.count_semaphores[0]) ||
|
||||
(sp >= &osal.count_semaphores[OS_MAX_COUNT_SEMAPHORES])) {
|
||||
return OS_ERR_INVALID_ID;
|
||||
}
|
||||
|
||||
chSysLock();
|
||||
|
||||
/* Resetting the semaphore, no threads in queue.*/
|
||||
chSemResetI(sp, 0);
|
||||
|
||||
/* Flagging it as unused and returning it to the pool.*/
|
||||
sp->queue.prev = NULL;
|
||||
chPoolFreeI(&osal.count_semaphores_pool, (void *)sp);
|
||||
|
||||
/* Required because some thread could have been made ready.*/
|
||||
chSchRescheduleS();
|
||||
|
||||
chSysUnlock();
|
||||
|
||||
return OS_SUCCESS;
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief Counter semaphore give.
|
||||
*
|
||||
* @param[in] sem_id counter semaphore id variable
|
||||
* @return An error code.
|
||||
*
|
||||
* @api
|
||||
*/
|
||||
int32 OS_CountSemGive(uint32 sem_id) {
|
||||
semaphore_t *sp = (semaphore_t *)sem_id;
|
||||
|
||||
if ((sp < &osal.count_semaphores[0]) ||
|
||||
(sp >= &osal.count_semaphores[OS_MAX_COUNT_SEMAPHORES])) {
|
||||
return OS_ERR_INVALID_ID;
|
||||
}
|
||||
|
||||
chSysLock();
|
||||
|
||||
/* If the semaphore is not in use then error.*/
|
||||
if (sp->queue.prev == NULL) {
|
||||
chSysUnlock();
|
||||
return OS_SEM_FAILURE;
|
||||
}
|
||||
|
||||
chSemSignalI(sp);
|
||||
chSchRescheduleS();
|
||||
|
||||
chSysUnlock();
|
||||
|
||||
return OS_SUCCESS;
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief Counter semaphore take.
|
||||
*
|
||||
* @param[in] sem_id counter semaphore id variable
|
||||
* @return An error code.
|
||||
*
|
||||
* @api
|
||||
*/
|
||||
int32 OS_CountSemTake(uint32 sem_id) {
|
||||
semaphore_t *sp = (semaphore_t *)sem_id;
|
||||
|
||||
if ((sp < &osal.count_semaphores[0]) ||
|
||||
(sp >= &osal.count_semaphores[OS_MAX_COUNT_SEMAPHORES])) {
|
||||
return OS_ERR_INVALID_ID;
|
||||
}
|
||||
|
||||
chSysLock();
|
||||
|
||||
/* If the semaphore is not in use then error.*/
|
||||
if (sp->queue.prev == NULL) {
|
||||
chSysUnlock();
|
||||
return OS_SEM_FAILURE;
|
||||
}
|
||||
|
||||
(void) chSemWaitS(sp);
|
||||
|
||||
chSysUnlock();
|
||||
|
||||
return OS_SUCCESS;
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief Counter semaphore take with timeout.
|
||||
*
|
||||
* @param[in] sem_id counter semaphore id variable
|
||||
* @param[in] msecs timeout in milliseconds
|
||||
* @return An error code.
|
||||
*
|
||||
* @api
|
||||
*/
|
||||
int32 OS_CountSemTimedWait(uint32 sem_id, uint32 msecs) {
|
||||
semaphore_t *sp = (semaphore_t *)sem_id;
|
||||
msg_t msg;
|
||||
|
||||
if ((sp < &osal.count_semaphores[0]) ||
|
||||
(sp >= &osal.count_semaphores[OS_MAX_COUNT_SEMAPHORES])) {
|
||||
return OS_ERR_INVALID_ID;
|
||||
}
|
||||
|
||||
/* Timeouts of zero not allowed.*/
|
||||
if (msecs == 0) {
|
||||
return OS_INVALID_INT_NUM;
|
||||
}
|
||||
|
||||
chSysLock();
|
||||
|
||||
/* If the semaphore is not in use then error.*/
|
||||
if (sp->queue.prev == NULL) {
|
||||
chSysUnlock();
|
||||
return OS_SEM_FAILURE;
|
||||
}
|
||||
|
||||
msg = chSemWaitTimeoutS(sp, MS2ST(msecs));
|
||||
|
||||
chSysUnlock();
|
||||
|
||||
return msg == MSG_TIMEOUT ? OS_SEM_TIMEOUT : OS_SUCCESS;
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief Retrieves a counter semaphore id by name.
|
||||
* @note It is not currently implemented.
|
||||
*
|
||||
* @param[out] sem_id pointer to a counter semaphore id variable
|
||||
* @param[in] sem_name the counter semaphore name
|
||||
* @return An error code.
|
||||
*
|
||||
* @api
|
||||
*/
|
||||
int32 OS_CountSemGetIdByName(uint32 *sem_id, const char *sem_name) {
|
||||
|
||||
/* NULL pointer checks.*/
|
||||
if ((sem_id == NULL) || (sem_name == NULL)) {
|
||||
return OS_INVALID_POINTER;
|
||||
}
|
||||
|
||||
return OS_ERR_NOT_IMPLEMENTED;
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief Returns counter semaphore information.
|
||||
*
|
||||
* @param[in] sem_id counter semaphore id variable
|
||||
* @param[in] sem_prop counter semaphore properties
|
||||
* @return An error code.
|
||||
*
|
||||
* @api
|
||||
*/
|
||||
int32 OS_CountSemGetInfo(uint32 sem_id, OS_count_sem_prop_t *sem_prop) {
|
||||
semaphore_t *sp = (semaphore_t *)sem_id;
|
||||
|
||||
/* NULL pointer checks.*/
|
||||
if (sem_prop == NULL) {
|
||||
return OS_INVALID_POINTER;
|
||||
}
|
||||
|
||||
if ((sp < &osal.count_semaphores[0]) ||
|
||||
(sp >= &osal.count_semaphores[OS_MAX_BIN_SEMAPHORES])) {
|
||||
return OS_ERR_INVALID_ID;
|
||||
}
|
||||
|
||||
chSysLock();
|
||||
|
||||
/* If the semaphore is not in use then error.*/
|
||||
if (sp->queue.prev == NULL) {
|
||||
chSysUnlock();
|
||||
return OS_SEM_FAILURE;
|
||||
}
|
||||
|
||||
chSysUnlock();
|
||||
|
||||
return OS_ERR_NOT_IMPLEMENTED;
|
||||
}
|
||||
|
||||
/*-- Mutex API --------------------------------------------------------------*/
|
||||
|
||||
/**
|
||||
* @brief Mutex creation.
|
||||
*
|
||||
* @param[out] sem_id pointer to a mutex id variable
|
||||
* @param[in] sem_name the mutex name
|
||||
* @param[in] options mutex options
|
||||
* @return An error code.
|
||||
*
|
||||
* @api
|
||||
*/
|
||||
int32 OS_MutSemCreate (uint32 *sem_id, const char *sem_name, uint32 options) {
|
||||
mutex_t *mp;
|
||||
|
||||
(void)options;
|
||||
|
||||
/* NULL pointer checks.*/
|
||||
if ((sem_id == NULL) || (sem_name == NULL)) {
|
||||
return OS_INVALID_POINTER;
|
||||
}
|
||||
|
||||
/* Checking semaphore name length.*/
|
||||
if (strlen(sem_name) >= OS_MAX_API_NAME) {
|
||||
return OS_ERR_NAME_TOO_LONG;
|
||||
}
|
||||
|
||||
mp = chPoolAlloc(&osal.mutexes_pool);
|
||||
|
||||
if (mp == 0) {
|
||||
return OS_SEM_FAILURE;
|
||||
}
|
||||
|
||||
/* Semaphore is initialized.*/
|
||||
chMtxObjectInit(mp);
|
||||
|
||||
*sem_id = (uint32)mp;
|
||||
|
||||
return OS_SUCCESS;
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief Mutex deletion.
|
||||
*
|
||||
* @param[in] sem_id mutex id variable
|
||||
* @return An error code.
|
||||
*
|
||||
* @api
|
||||
*/
|
||||
int32 OS_MutSemDelete(uint32 sem_id) {
|
||||
mutex_t *mp = (mutex_t *)sem_id;
|
||||
|
||||
if ((mp < &osal.mutexes[0]) ||
|
||||
(mp >= &osal.mutexes[OS_MAX_MUTEXES])) {
|
||||
return OS_ERR_INVALID_ID;
|
||||
}
|
||||
|
||||
chSysLock();
|
||||
|
||||
/* Resetting the mutex, no threads in queue.*/
|
||||
chMtxUnlockAllS();
|
||||
|
||||
/* Flagging it as unused and returning it to the pool.*/
|
||||
mp->queue.prev = NULL;
|
||||
chPoolFreeI(&osal.mutexes_pool, (void *)mp);
|
||||
|
||||
/* Required because some thread could have been made ready.*/
|
||||
chSchRescheduleS();
|
||||
|
||||
chSysUnlock();
|
||||
|
||||
return OS_SUCCESS;
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief Mutex give.
|
||||
*
|
||||
* @param[in] sem_id mutex id variable
|
||||
* @return An error code.
|
||||
*
|
||||
* @api
|
||||
*/
|
||||
int32 OS_MutSemGive(uint32 sem_id) {
|
||||
mutex_t *mp = (mutex_t *)sem_id;
|
||||
|
||||
if ((mp < &osal.mutexes[0]) ||
|
||||
(mp >= &osal.mutexes[OS_MAX_COUNT_SEMAPHORES])) {
|
||||
return OS_ERR_INVALID_ID;
|
||||
}
|
||||
|
||||
chSysLock();
|
||||
|
||||
/* If the mutex is not in use then error.*/
|
||||
if (mp->queue.prev == NULL) {
|
||||
chSysUnlock();
|
||||
return OS_SEM_FAILURE;
|
||||
}
|
||||
|
||||
chMtxUnlockS(mp);
|
||||
chSchRescheduleS();
|
||||
|
||||
chSysUnlock();
|
||||
|
||||
return OS_SUCCESS;
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief Mutex take.
|
||||
*
|
||||
* @param[in] sem_id mutex id variable
|
||||
* @return An error code.
|
||||
*
|
||||
* @api
|
||||
*/
|
||||
int32 OS_MutSemTake(uint32 sem_id) {
|
||||
mutex_t *mp = (mutex_t *)sem_id;
|
||||
|
||||
if ((mp < &osal.mutexes[0]) ||
|
||||
(mp >= &osal.mutexes[OS_MAX_COUNT_SEMAPHORES])) {
|
||||
return OS_ERR_INVALID_ID;
|
||||
}
|
||||
|
||||
chSysLock();
|
||||
|
||||
/* If the mutex is not in use then error.*/
|
||||
if (mp->queue.prev == NULL) {
|
||||
chSysUnlock();
|
||||
return OS_SEM_FAILURE;
|
||||
}
|
||||
|
||||
chMtxLockS(mp);
|
||||
|
||||
chSysUnlock();
|
||||
|
||||
return OS_SUCCESS;
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief Retrieves a mutex id by name.
|
||||
* @note It is not currently implemented.
|
||||
*
|
||||
* @param[out] sem_id pointer to a mutex id variable
|
||||
* @param[in] sem_name the mutex name
|
||||
* @return An error code.
|
||||
*
|
||||
* @api
|
||||
*/
|
||||
int32 OSMutSemGetIdByName(uint32 *sem_id, const char *sem_name) {
|
||||
|
||||
/* NULL pointer checks.*/
|
||||
if ((sem_id == NULL) || (sem_name == NULL)) {
|
||||
return OS_INVALID_POINTER;
|
||||
}
|
||||
|
||||
return OS_ERR_NOT_IMPLEMENTED;
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief Returns mutex information.
|
||||
*
|
||||
* @param[in] sem_id mutex id variable
|
||||
* @param[in] sem_prop mutex properties
|
||||
* @return An error code.
|
||||
*
|
||||
* @api
|
||||
*/
|
||||
int32 OS_MutSemGetInfo(uint32 sem_id, OS_mut_sem_prop_t *sem_prop) {
|
||||
mutex_t *mp = (mutex_t *)sem_id;
|
||||
|
||||
/* NULL pointer checks.*/
|
||||
if (sem_prop == NULL) {
|
||||
return OS_INVALID_POINTER;
|
||||
}
|
||||
|
||||
if ((mp < &osal.mutexes[0]) ||
|
||||
(mp >= &osal.mutexes[OS_MAX_BIN_SEMAPHORES])) {
|
||||
return OS_ERR_INVALID_ID;
|
||||
}
|
||||
|
||||
chSysLock();
|
||||
|
||||
/* If the mutex is not in use then error.*/
|
||||
if (mp->queue.prev == NULL) {
|
||||
chSysUnlock();
|
||||
return OS_SEM_FAILURE;
|
||||
}
|
||||
|
||||
chSysUnlock();
|
||||
|
||||
return OS_ERR_NOT_IMPLEMENTED;
|
||||
}
|
||||
|
||||
/*-- Task Control API -------------------------------------------------------*/
|
||||
|
||||
/**
|
||||
|
|
@ -771,7 +1200,7 @@ int32 OS_TaskGetIdByName (uint32 *task_id, const char *task_name) {
|
|||
/**
|
||||
* @brief Returns task information.
|
||||
*
|
||||
* @param[in] sem_id binary semaphore id variable
|
||||
* @param[in] task_id the task id
|
||||
* @param[in] task_prop task properties
|
||||
* @return An error code.
|
||||
*
|
||||
|
|
|
|||
Loading…
Reference in New Issue