66 lines
1.5 KiB
C
66 lines
1.5 KiB
C
|
#include "typesdef.h"
|
||
|
|
#include "errno.h"
|
||
|
|
#include "list.h"
|
||
|
|
#include "osal/string.h"
|
||
|
|
#include "osal/msgqueue.h"
|
||
|
|
|
||
|
|
#ifdef CSKY_OS
|
||
|
|
#include "csi_kernel.h"
|
||
|
|
|
||
|
|
#define MSGQ_MAGIC (0x4a8b1c9d)
|
||
|
|
|
||
|
|
int32 os_msgq_init(os_msgqueue_t *msgq, int32 size)
|
||
|
|
{
|
||
|
|
if(msgq->magic == MSGQ_MAGIC){
|
||
|
|
os_printf(KERN_WARNING"msgq repeat initialization ????\r\n");
|
||
|
|
}
|
||
|
|
|
||
|
|
msgq->hdl = csi_kernel_msgq_new(size, sizeof(uint32));
|
||
|
|
if(msgq->hdl) msgq->magic = MSGQ_MAGIC;
|
||
|
|
return (msgq->hdl ? RET_OK : RET_ERR);
|
||
|
|
}
|
||
|
|
|
||
|
|
uint32 os_msgq_get(os_msgqueue_t *msgq, int32 tmo_ms)
|
||
|
|
{
|
||
|
|
uint32 val = 0;
|
||
|
|
ASSERT(msgq->hdl);
|
||
|
|
csi_kernel_msgq_get(msgq->hdl, &val, csi_kernel_ms2tick(tmo_ms));
|
||
|
|
return val;
|
||
|
|
}
|
||
|
|
|
||
|
|
uint32 os_msgq_get2(struct os_msgqueue *msgq, int32 tmo_ms, int32 *err)
|
||
|
|
{
|
||
|
|
uint32 val = 0;
|
||
|
|
k_status_t ret = csi_kernel_msgq_get(msgq->hdl, &val, csi_kernel_ms2tick(tmo_ms));
|
||
|
|
if(err) *err = ret;
|
||
|
|
return val;
|
||
|
|
}
|
||
|
|
|
||
|
|
int32 os_msgq_put(os_msgqueue_t *msgq, uint32 data, int32 tmo_ms)
|
||
|
|
{
|
||
|
|
ASSERT(msgq->hdl);
|
||
|
|
return csi_kernel_msgq_put(msgq->hdl, &data, 0, csi_kernel_ms2tick(tmo_ms));
|
||
|
|
}
|
||
|
|
|
||
|
|
int32 os_msgq_put_head(os_msgqueue_t *msgq, uint32 data, int32 tmo_ms)
|
||
|
|
{
|
||
|
|
ASSERT(msgq->hdl);
|
||
|
|
return csi_kernel_msgq_put(msgq->hdl, &data, 0, csi_kernel_ms2tick(tmo_ms));
|
||
|
|
}
|
||
|
|
|
||
|
|
int32 os_msgq_del(os_msgqueue_t *msgq)
|
||
|
|
{
|
||
|
|
ASSERT(msgq->hdl);
|
||
|
|
csi_kernel_msgq_del(msgq->hdl);
|
||
|
|
msgq->hdl = NULL;
|
||
|
|
msgq->magic = 0;
|
||
|
|
return RET_OK;
|
||
|
|
}
|
||
|
|
|
||
|
|
int32 os_msgq_cnt(os_msgqueue_t *msgq)
|
||
|
|
{
|
||
|
|
return csi_kernel_msgq_get_count(msgq->hdl);
|
||
|
|
}
|
||
|
|
|
||
|
|
#endif
|