96 lines
2.2 KiB
C
96 lines
2.2 KiB
C
/*
|
|
* Copyright (c) XMEDIA. All rights reserved.
|
|
*/
|
|
#include "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_printk("%s - parameter invalid!\n", __FUNCTION__);
|
|
return -1;
|
|
}
|
|
p = kmalloc(sizeof(struct semaphore), GFP_KERNEL);
|
|
if (p == NULL) {
|
|
osal_printk("%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) {
|
|
osal_printk("%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) {
|
|
osal_printk("%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) {
|
|
osal_printk("%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;
|
|
p = (struct semaphore *)(sem->sem);
|
|
up(p);
|
|
}
|
|
EXPORT_SYMBOL(osal_up);
|
|
|
|
void osal_sema_destory(osal_semaphore_t *sem)
|
|
{
|
|
if((sem != NULL) && (sem->sem != NULL)) {
|
|
kfree((struct semaphore *)(sem->sem));
|
|
sem->sem = NULL;
|
|
} else {
|
|
osal_printk("%s - parameter invalid!\n", __FUNCTION__);
|
|
}
|
|
}
|
|
EXPORT_SYMBOL(osal_sema_destory);
|
|
|
|
void osal_sema_destroy(osal_semaphore_t *sem)
|
|
{
|
|
if((sem != NULL) && (sem->sem != NULL)) {
|
|
kfree((struct semaphore *)(sem->sem));
|
|
sem->sem = NULL;
|
|
} else {
|
|
osal_printk("%s - parameter invalid!\n", __FUNCTION__);
|
|
}
|
|
}
|
|
EXPORT_SYMBOL(osal_sema_destroy);
|
|
|