93 lines
2.2 KiB
C
93 lines
2.2 KiB
C
/*
|
|
Copyright (c), 2001-2022, Shenshu Tech. Co., Ltd.
|
|
*/
|
|
|
|
#include "ot_osal.h"
|
|
#include <linux/module.h>
|
|
#include <linux/kernel.h>
|
|
#include <linux/printk.h>
|
|
#include <linux/semaphore.h>
|
|
#include <linux/slab.h>
|
|
|
|
int osal_sema_init(osal_semaphore_t *sem, int val)
|
|
{
|
|
struct semaphore *p = NULL;
|
|
|
|
if (sem == NULL) {
|
|
osal_trace("%s - parameter invalid!\n", __FUNCTION__);
|
|
return -1;
|
|
}
|
|
p = kmalloc(sizeof(struct semaphore), GFP_KERNEL);
|
|
if (p == NULL) {
|
|
osal_trace("%s - kmalloc error!\n", __FUNCTION__);
|
|
return -1;
|
|
}
|
|
sema_init(p, val);
|
|
sem->sem = p;
|
|
return 0;
|
|
}
|
|
EXPORT_SYMBOL(osal_sema_init);
|
|
int osal_down(osal_semaphore_t *sem)
|
|
{
|
|
struct semaphore *p = NULL;
|
|
|
|
if ((sem == NULL) || (sem->sem == NULL)) {
|
|
osal_trace("%s - parameter invalid!\n", __FUNCTION__);
|
|
return -1;
|
|
}
|
|
p = (struct semaphore *)(sem->sem);
|
|
down(p);
|
|
return 0;
|
|
}
|
|
EXPORT_SYMBOL(osal_down);
|
|
int osal_down_interruptible(osal_semaphore_t *sem)
|
|
{
|
|
struct semaphore *p = NULL;
|
|
|
|
if ((sem == NULL) || (sem->sem == NULL)) {
|
|
osal_trace("%s - parameter invalid!\n", __FUNCTION__);
|
|
return -1;
|
|
}
|
|
p = (struct semaphore *)(sem->sem);
|
|
return down_interruptible(p);
|
|
}
|
|
EXPORT_SYMBOL(osal_down_interruptible);
|
|
int osal_down_trylock(osal_semaphore_t *sem)
|
|
{
|
|
struct semaphore *p = NULL;
|
|
|
|
if ((sem == NULL) || (sem->sem == NULL)) {
|
|
osal_trace("%s - parameter invalid!\n", __FUNCTION__);
|
|
return -1;
|
|
}
|
|
p = (struct semaphore *)(sem->sem);
|
|
return down_trylock(p);
|
|
}
|
|
EXPORT_SYMBOL(osal_down_trylock);
|
|
void osal_up(osal_semaphore_t *sem)
|
|
{
|
|
struct semaphore *p = NULL;
|
|
|
|
if ((sem == NULL) || (sem->sem == NULL)) {
|
|
osal_trace("%s - parameter invalid!\n", __FUNCTION__);
|
|
return;
|
|
}
|
|
p = (struct semaphore *)(sem->sem);
|
|
up(p);
|
|
}
|
|
EXPORT_SYMBOL(osal_up);
|
|
void osal_sema_destroy(osal_semaphore_t *sem)
|
|
{
|
|
struct semaphore *p = NULL;
|
|
|
|
if ((sem == NULL) || (sem->sem == NULL)) {
|
|
osal_trace("%s - parameter invalid!\n", __FUNCTION__);
|
|
return;
|
|
}
|
|
p = (struct semaphore *)(sem->sem);
|
|
kfree(p);
|
|
p = NULL;
|
|
sem->sem = NULL;
|
|
}
|
|
EXPORT_SYMBOL(osal_sema_destroy);
|