summaryrefstree
path: root/kernel/drivers/trace/exynos-condbg-ringbuf.h
blob: 3613e3c741218bcbe32a7dc9665933bb5d677016 (plain)
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
/*
 * drivers/trace/exynos-condbg-ringbuf.h
 * simple lockless ringbuffer
 *
 * Copyright (c) 2016 Samsung Electronics Co., Ltd.
 *		http://www.samsung.com
 
 * Exynos-Console-Debugger for Exynos SoC
 * This codes are based on fiq_debugger of google
 * /driver/staging/android/fiq_debugger
 *
 * Author: Hosung Kim <hosung0.kim@samsung.com>
 *         Changki Kim <changki.kim@samsung.com>
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License version 2 as
 * published by the Free Software Foundation.
 */

#include <linux/kernel.h>
#include <linux/slab.h>

struct ecd_ringbuf {
	int len;
	int head;
	int tail;
	u8 buf[];
};


static inline struct ecd_ringbuf *ecd_ringbuf_alloc(int len)
{
	struct ecd_ringbuf *rbuf;

	rbuf = kzalloc(sizeof(*rbuf) + len, GFP_KERNEL);
	if (rbuf == NULL)
		return NULL;

	rbuf->len = len;
	rbuf->head = 0;
	rbuf->tail = 0;
	smp_mb();

	return rbuf;
}

static inline void ecd_ringbuf_free(struct ecd_ringbuf *rbuf)
{
	kfree(rbuf);
}

static inline int ecd_ringbuf_level(struct ecd_ringbuf *rbuf)
{
	int level = rbuf->head - rbuf->tail;

	if (level < 0)
		level = rbuf->len + level;

	return level;
}

static inline int ecd_ringbuf_room(struct ecd_ringbuf *rbuf)
{
	return rbuf->len - ecd_ringbuf_level(rbuf) - 1;
}

static inline u8
ecd_ringbuf_peek(struct ecd_ringbuf *rbuf, int i)
{
	return rbuf->buf[(rbuf->tail + i) % rbuf->len];
}

static inline int
ecd_ringbuf_consume(struct ecd_ringbuf *rbuf, int count)
{
	count = min(count, ecd_ringbuf_level(rbuf));

	rbuf->tail = (rbuf->tail + count) % rbuf->len;
	smp_mb();

	return count;
}

static inline int
ecd_ringbuf_push(struct ecd_ringbuf *rbuf, u8 datum)
{
	if (ecd_ringbuf_room(rbuf) == 0)
		return 0;

	rbuf->buf[rbuf->head] = datum;
	smp_mb();
	rbuf->head = (rbuf->head + 1) % rbuf->len;
	smp_mb();

	return 1;
}