You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
464 lines
11 KiB
464 lines
11 KiB
/*
|
|
* Copyright(C) 2010 Fuzhou Rockchip Electronics Co., Ltd. All rights reserved
|
|
* BY DOWNLOADING, INSTALLING, COPYING, SAVING OR OTHERWISE USING THIS
|
|
* SOFTWARE, YOU ACKNOWLEDGE THAT YOU AGREE THE SOFTWARE RECEIVED FORM ROCKCHIP
|
|
* IS PROVIDED TO YOU ON AN "AS IS" BASIS and ROCKCHIP DISCLAIMS ANY AND ALL
|
|
* WARRANTIES AND REPRESENTATIONS WITH RESPECT TO SUCH FILE, WHETHER EXPRESS,
|
|
* IMPLIED, STATUTORY OR OTHERWISE, INCLUDING WITHOUT LIMITATION, ANY IMPLIED
|
|
* WARRANTIES OF TITLE, NON-INFRINGEMENT, MERCHANTABILITY, SATISFACTROY QUALITY,
|
|
* ACCURACY OR FITNESS FOR A PARTICULAR PURPOSE
|
|
* Rockchip hereby grants to you a limited, non-exclusive, non-sublicensable and
|
|
* non-transferable license
|
|
* (a) to install, save and use the Software;
|
|
* (b) to * copy and distribute the Software in binary code format only
|
|
* Except as expressively authorized by Rockchip in writing, you may NOT:
|
|
* (a) distribute the Software in source code;
|
|
* (b) distribute on a standalone basis but you may distribute the Software in
|
|
* conjunction with platforms incorporating Rockchip integrated circuits;
|
|
* (c) modify the Software in whole or part;
|
|
* (d) decompile, reverse-engineer, dissemble, or attempt to derive any source
|
|
* code from the Software;
|
|
* (e) remove or obscure any copyright, patent, or trademark statement or
|
|
* notices contained in the Software
|
|
*/
|
|
|
|
#define ALOG_TAG "RK_LIST"
|
|
#include "rk_list.h"
|
|
#include <utils/Log.h>
|
|
#include <errno.h>
|
|
#include <string.h>
|
|
#include <malloc.h>
|
|
#ifdef AVS40
|
|
#undef ALOGV
|
|
#define ALOGV LOGV
|
|
|
|
#undef ALOGD
|
|
#define ALOGD LOGD
|
|
|
|
#undef ALOGI
|
|
#define ALOGI LOGI
|
|
|
|
#undef ALOGW
|
|
#define ALOGW LOGW
|
|
|
|
#undef ALOGE
|
|
#define ALOGE LOGE
|
|
|
|
#endif
|
|
|
|
//#define _RK_LIST_DEUBG
|
|
#define _RK_LIST_ERROR
|
|
|
|
#ifdef _RK_LIST_DEUBG
|
|
#define LIST_DEBUG(fmt, args...) ALOGD(fmt, ## args)
|
|
#else
|
|
#define LIST_DEBUG(fmt, args...) /* not debugging: nothing */
|
|
#endif
|
|
|
|
#ifdef _RK_LIST_ERROR
|
|
#define LIST_ERROR(fmt, args...) ALOGE(fmt, ## args)
|
|
#else
|
|
#define LIST_ERROR(fmt, args...)
|
|
#endif
|
|
|
|
typedef struct rk_list_node {
|
|
rk_list_node* prev;
|
|
rk_list_node* next;
|
|
uint32_t key;
|
|
int32_t size;
|
|
} rk_list_node;
|
|
|
|
static inline void list_node_init(rk_list_node *node)
|
|
{
|
|
node->prev = node->next = node;
|
|
}
|
|
|
|
static inline void list_node_init_with_key_and_size(rk_list_node *node, uint32_t key, int32_t size)
|
|
{
|
|
list_node_init(node);
|
|
node->key = key;
|
|
node->size = size;
|
|
}
|
|
|
|
static rk_list_node* create_list(void *data, int32_t size, uint32_t key)
|
|
{
|
|
rk_list_node *node = (rk_list_node*)malloc(sizeof(rk_list_node)+size);
|
|
if (node) {
|
|
void *dst = (void*)(node + 1);
|
|
list_node_init_with_key_and_size(node, key, size);
|
|
memcpy(dst, data, size);
|
|
} else {
|
|
LIST_ERROR("failed to allocate list node");
|
|
}
|
|
return node;
|
|
}
|
|
|
|
static inline void _rk_list_add(rk_list_node * _new, rk_list_node * prev, rk_list_node * next)
|
|
{
|
|
next->prev = _new;
|
|
_new->next = next;
|
|
_new->prev = prev;
|
|
prev->next = _new;
|
|
}
|
|
|
|
static __inline__ void rk_list_add(rk_list_node *_new, rk_list_node *head)
|
|
{
|
|
_rk_list_add(_new, head, head->next);
|
|
}
|
|
|
|
static __inline__ void rk_list_add_tail(rk_list_node *_new, rk_list_node *head)
|
|
{
|
|
_rk_list_add(_new, head->prev, head);
|
|
}
|
|
|
|
int32_t rk_list::add_at_head(void *data, int32_t size)
|
|
{
|
|
int32_t ret = -EINVAL;
|
|
pthread_mutex_lock(&mutex);
|
|
if (head) {
|
|
rk_list_node *node = create_list(data, size, 0);
|
|
if (node) {
|
|
rk_list_add(node, head);
|
|
count++;
|
|
ret = 0;
|
|
} else {
|
|
ret = -ENOMEM;
|
|
}
|
|
}
|
|
pthread_mutex_unlock(&mutex);
|
|
return ret;
|
|
}
|
|
|
|
int32_t rk_list::add_at_tail(void *data, int32_t size)
|
|
{
|
|
int32_t ret = -EINVAL;
|
|
pthread_mutex_lock(&mutex);
|
|
if (head) {
|
|
rk_list_node *node = create_list(data, size, 0);
|
|
if (node) {
|
|
rk_list_add_tail(node, head);
|
|
count++;
|
|
ret = 0;
|
|
} else {
|
|
ret = -ENOMEM;
|
|
}
|
|
}
|
|
pthread_mutex_unlock(&mutex);
|
|
return ret;
|
|
}
|
|
|
|
static void release_list(rk_list_node*node, void *data, int32_t size)
|
|
{
|
|
void *src = (void*)(node + 1);
|
|
if (node->size == size) {
|
|
memcpy(data, src, size);
|
|
} else {
|
|
LIST_ERROR("node size check failed when release_list");
|
|
size = (size < node->size) ? (size) : (node->size);
|
|
memcpy(data, src, size);
|
|
}
|
|
free(node);
|
|
}
|
|
|
|
static inline void _rk_list_del(rk_list_node *prev, rk_list_node *next)
|
|
{
|
|
next->prev = prev;
|
|
prev->next = next;
|
|
}
|
|
|
|
static __inline__ void rk_list_del_init(rk_list_node *node)
|
|
{
|
|
_rk_list_del(node->prev, node->next);
|
|
list_node_init(node);
|
|
}
|
|
|
|
static __inline__ int list_is_last(const rk_list_node *list, const rk_list_node *head)
|
|
{
|
|
return list->next == head;
|
|
}
|
|
|
|
static inline void _list_del_node_no_lock(rk_list_node *node, void *data, int32_t size)
|
|
{
|
|
rk_list_del_init(node);
|
|
release_list(node, data, size);
|
|
}
|
|
|
|
int32_t rk_list::del_at_head(void *data, int32_t size)
|
|
{
|
|
int32_t ret = -EINVAL;
|
|
pthread_mutex_lock(&mutex);
|
|
if (head && count) {
|
|
_list_del_node_no_lock(head->next, data, size);
|
|
count--;
|
|
ret = 0;
|
|
}
|
|
pthread_mutex_unlock(&mutex);
|
|
return ret;
|
|
}
|
|
|
|
int32_t rk_list::del_at_tail(void *data, int32_t size)
|
|
{
|
|
int32_t ret = -EINVAL;
|
|
pthread_mutex_lock(&mutex);
|
|
if (head && count) {
|
|
_list_del_node_no_lock(head->prev, data, size);
|
|
count--;
|
|
pthread_mutex_unlock(&mutex);
|
|
ret = 0;
|
|
}
|
|
pthread_mutex_unlock(&mutex);
|
|
return ret;
|
|
}
|
|
|
|
int32_t rk_list::list_is_empty()
|
|
{
|
|
pthread_mutex_lock(&mutex);
|
|
int32_t ret = (count == 0);
|
|
pthread_mutex_unlock(&mutex);
|
|
return ret;
|
|
}
|
|
|
|
int32_t rk_list::list_size()
|
|
{
|
|
pthread_mutex_lock(&mutex);
|
|
int32_t ret = count;
|
|
pthread_mutex_unlock(&mutex);
|
|
return ret;
|
|
}
|
|
|
|
int32_t rk_list::add_by_key(void *data, int32_t size, uint32_t *key)
|
|
{
|
|
int32_t ret = 0;
|
|
return ret;
|
|
}
|
|
|
|
int32_t rk_list::del_by_key(void *data, int32_t size, uint32_t key)
|
|
{
|
|
int32_t ret = 0;
|
|
return ret;
|
|
}
|
|
|
|
|
|
int32_t rk_list::show_by_key(void *data, uint32_t key)
|
|
{
|
|
int32_t ret = 0;
|
|
return ret;
|
|
}
|
|
|
|
int32_t rk_list::flush()
|
|
{
|
|
pthread_mutex_lock(&mutex);
|
|
if (head) {
|
|
while (count) {
|
|
rk_list_node* node = head->next;
|
|
rk_list_del_init(node);
|
|
if (destroy) {
|
|
destroy((void*)(node + 1));
|
|
}
|
|
free(node);
|
|
count--;
|
|
}
|
|
}
|
|
pthread_mutex_unlock(&mutex);
|
|
return 0;
|
|
}
|
|
|
|
rk_list::rk_list(node_destructor func)
|
|
: destroy(NULL),
|
|
head(NULL),
|
|
count(0)
|
|
{
|
|
pthread_mutexattr_t attr;
|
|
pthread_mutexattr_init(&attr);
|
|
pthread_mutexattr_settype(&attr, PTHREAD_MUTEX_RECURSIVE);
|
|
pthread_mutex_init(&mutex, &attr);
|
|
pthread_mutexattr_destroy(&attr);
|
|
destroy = func;
|
|
head = (rk_list_node*)malloc(sizeof(rk_list_node));
|
|
if (NULL == head) {
|
|
LIST_ERROR("failed to allocate list header");
|
|
} else {
|
|
list_node_init_with_key_and_size(head, 0, 0);
|
|
}
|
|
}
|
|
|
|
rk_list::~rk_list()
|
|
{
|
|
flush();
|
|
if (head) free(head);
|
|
head = NULL;
|
|
destroy = NULL;
|
|
pthread_mutex_destroy(&mutex);
|
|
}
|
|
|
|
#if BUILD_RK_LIST_TEST
|
|
#include "vpu_mem.h"
|
|
#include <stdio.h>
|
|
#include <stdlib.h>
|
|
#include <string.h>
|
|
|
|
#define LOOP_RK_LIST 600
|
|
|
|
#define COUNT_ADD 100
|
|
#define COUNT_DEL 99
|
|
|
|
volatile int err = 0;
|
|
|
|
static int rk_list_fifo_test(rk_list *list_0)
|
|
{
|
|
int count;
|
|
VPUMemLinear_t m;
|
|
for (count = 0; count < COUNT_ADD; count++) {
|
|
err |= VPUMallocLinear(&m, 100);
|
|
if (err) {
|
|
printf("VPUMallocLinear in rk_list_fifo_test\n");
|
|
break;
|
|
}
|
|
err |= list_0->add_at_head(&m, sizeof(m));
|
|
if (err) {
|
|
printf("add_at_head in rk_list_fifo_test\n");
|
|
break;
|
|
}
|
|
}
|
|
|
|
if (!err) {
|
|
for (count = 0; count < COUNT_DEL; count++) {
|
|
err |= list_0->del_at_tail(&m, sizeof(m));
|
|
if (err) {
|
|
printf("del_at_tail in rk_list_fifo_test\n");
|
|
break;
|
|
}
|
|
err |= VPUFreeLinear(&m);
|
|
if (err) {
|
|
printf("VPUFreeLinear in rk_list_fifo_test\n");
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
return err;
|
|
}
|
|
|
|
static int rk_list_filo_test(rk_list *list_0)
|
|
{
|
|
int count;
|
|
VPUMemLinear_t m;
|
|
for (count = 0; count < COUNT_ADD + COUNT_DEL; count++) {
|
|
if (count & 1) {
|
|
err |= list_0->del_at_head(&m, sizeof(m));
|
|
if (err) {
|
|
printf("del_at_head in rk_list_filo_test\n");
|
|
break;
|
|
}
|
|
err |= VPUFreeLinear(&m);
|
|
if (err) {
|
|
printf("VPUFreeLinear in rk_list_fifo_test\n");
|
|
break;
|
|
}
|
|
} else {
|
|
err |= VPUMallocLinear(&m, 100);
|
|
if (err) {
|
|
printf("VPUMallocLinear in rk_list_filo_test\n");
|
|
break;
|
|
}
|
|
err |= list_0->add_at_head(&m, sizeof(m));
|
|
if (err) {
|
|
printf("add_at_head in rk_list_fifo_test\n");
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
|
|
return err;
|
|
}
|
|
|
|
|
|
void *rk_list_test_loop_0(void *pdata)
|
|
{
|
|
int i;
|
|
rk_list *list_0 = (rk_list *)pdata;
|
|
|
|
printf("rk_list test 0 loop start\n");
|
|
for (i = 0; i < LOOP_RK_LIST; i++) {
|
|
err |= rk_list_filo_test(list_0);
|
|
if (err) break;
|
|
}
|
|
|
|
if (err) {
|
|
printf("thread: found vpu mem operation err %d\n", err);
|
|
} else {
|
|
printf("thread: test done and found no err\n");
|
|
}
|
|
return NULL;
|
|
}
|
|
|
|
int rk_list_test_0()
|
|
{
|
|
int i, err = 0;
|
|
printf("rk_list test 0 FIFO start\n");
|
|
|
|
rk_list *list_0 = new rk_list((node_destructor)VPUFreeLinear);
|
|
|
|
pthread_t mThread;
|
|
pthread_attr_t attr;
|
|
pthread_attr_init(&attr);
|
|
pthread_attr_setdetachstate(&attr, PTHREAD_CREATE_JOINABLE);
|
|
|
|
pthread_create(&mThread, &attr, rk_list_test_loop_0, (void*)list_0);
|
|
pthread_attr_destroy(&attr);
|
|
|
|
for (i = 0; i < LOOP_RK_LIST; i++) {
|
|
err |= rk_list_fifo_test(list_0);
|
|
if (err) break;
|
|
}
|
|
if (err) {
|
|
printf("main : found rk_list operation err %d\n", err);
|
|
} else {
|
|
printf("main : test done and found no err\n");
|
|
}
|
|
|
|
void *dummy;
|
|
pthread_join(mThread, &dummy);
|
|
|
|
printf("rk_list test 0 end size %d\n", list_0->list_size());
|
|
delete list_0;
|
|
return err;
|
|
}
|
|
|
|
#define TOTAL_RK_LIST_TEST_COUNT 1
|
|
|
|
typedef int (*RK_LIST_TEST_FUNC)(void);
|
|
RK_LIST_TEST_FUNC test_func[TOTAL_RK_LIST_TEST_COUNT] = {
|
|
rk_list_test_0,
|
|
};
|
|
|
|
int main(int argc, char *argv[])
|
|
{
|
|
int i, start = 0, end = 0;
|
|
if (argc < 2) {
|
|
end = TOTAL_RK_LIST_TEST_COUNT;
|
|
} else if (argc == 2) {
|
|
start = atoi(argv[1]);
|
|
end = start + 1;
|
|
} else if (argc == 3) {
|
|
start = atoi(argv[1]);
|
|
end = atoi(argv[2]);
|
|
} else {
|
|
printf("too many argc %d\n", argc);
|
|
return -1;
|
|
}
|
|
if (start < 0 || start > TOTAL_RK_LIST_TEST_COUNT || end < 0 || end > TOTAL_RK_LIST_TEST_COUNT) {
|
|
printf("invalid input: start %d end %d\n", start, end);
|
|
return -1;
|
|
}
|
|
for (i = start; i < end; i++) {
|
|
int err = test_func[i]();
|
|
if (err) {
|
|
printf("test case %d return err %d\n", i, err);
|
|
break;
|
|
}
|
|
}
|
|
return 0;
|
|
}
|
|
#endif
|
|
|