VNet-Card/queue.h at master · WorkRoutine/VNet-Card · GitHub

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
#ifndef _QUEUE_H_
#define _QUEUE_H_

#include <stdint.h>

#define QUE_FLAG	0x00
#define QUE_FLAGS_CLR	0x04
#define SCR_PAD		0x1C
#define QUE_DATA	0x40

#define QUE_WR_CNT	0x0C
#define QUE_WR_LOCK	0x10

#define QUE_RD_CNT	0x08
#define QUE_RD_LOCK	0x14

#define QUEUE_SIZE	0x2000
#define QUEUE_MASK	(QUEUE_SIZE - 1)

#define QUEUE_RESERVED  0x10
#ifdef CONFIG_QUEUE_64B
#define QUEUE_WIDTH	0x8
#define QUEUE_HEAD_MAGIC	0xEFABCD22ABCDDEEF
typedef uint64_t	queue_t;
#else
#define QUEUE_WIDTH	0x4
#define QUEUE_HEAD_MAGIC	0xFEDCAB78
typedef uint32_t	queue_t;
#endif

struct queue_node {
	const char *name;
	unsigned long Rqueue_base;	/* Read Queue */
	unsigned long Wqueue_base;	/* Write Queue */
	unsigned long Rqueue_size;
	unsigned long Wqueue_size;
	unsigned long Rqueue;		/* Read Queue virtual address */
	unsigned long Wqueue;		/* Write Queue virtual address */
};

struct queue_head {
	uint32_t msg_head;
	uint32_t index;
	uint32_t count;
};

static inline uint64_t queue_reg_read_64b(uint64_t reg)
{
        return *(uint64_t *)(reg);
}

static inline uint64_t queue_data_read_64b(struct queue_node *node)
{
        return queue_reg_read_64b(node->Rqueue + QUE_DATA);
}

static inline uint32_t queue_reg_read(uint64_t reg)
{
	return *(uint32_t *)(reg);
}

static inline void queue_reg_write(uint64_t reg, uint32_t data)
{
	*(uint32_t *)(reg) = data;
}

static inline uint32_t queue_data_read(struct queue_node *node)
{
	return queue_reg_read(node->Rqueue + QUE_DATA);
}

static inline void queue_data_write(struct queue_node *node, uint32_t data)
{
	queue_reg_write(node->Wqueue + QUE_DATA, data);
}

static inline int queue_flag_read(unsigned long base)
{
	return queue_reg_read(base + QUE_FLAG);
}

static inline int queueW_cnt_get(struct queue_node *node)
{
	return queue_reg_read(node->Wqueue + QUE_WR_CNT) &QUEUE_MASK;
}

static inline int queue_cnt_read(unsigned long base)
{
	return queue_reg_read(base +  QUE_RD_CNT) & QUEUE_MASK;
}

static inline int queue_lock(unsigned long base)
{
	queue_reg_write(base + QUE_RD_LOCK, 1);
}

static inline int queue_unlock(unsigned long base)
{
	queue_reg_write(base + QUE_RD_LOCK, 0);
}

static inline int queue_read_lock(unsigned long base)
{
	return queue_reg_read(base + QUE_RD_LOCK);
}

#define queueR_flag_get(node)	queue_flag_read(node->Rqueue)
#define queueW_flag_get(node)	queue_flag_read(node->Wqueue)
#define queueR_cnt_get(node)	queue_cnt_read(node->Rqueue)
#define queueR_lock(node)	queue_lock(node->Rqueue)
#define queueW_lock(node)	queue_lock(node->Wqueue)
#define queueR_unlock(node)	queue_unlock(node->Rqueue)
#define queueW_unlock(node)	queue_unlock(node->Wqueue)
#define queueR_read_lock(node)	queue_read_lock(node->Rqueue)
#define queueW_read_lock(node)	queue_read_lock(node->Wqueue)

static inline void queue_clear(struct queue_node *node)
{
	queue_reg_write(node->Wqueue + QUE_FLAGS_CLR, 1);
}

extern struct queue_node *queue_init(void);
extern void queue_exit(struct queue_node *node);
extern int queue_recv_msg(struct queue_node *node, unsigned long *index,
                                                unsigned long *count);
extern int queue_send_msg(struct queue_node *node, unsigned long index,
                                                unsigned long count);

#endif