kernel_5.10 no rt

hc

2023-12-11 6778948f9de86c3cfaf36725a7c87dcff9ba247f

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
/*
 * drivers/staging/android/fiq_debugger/fiq_debugger_ringbuf.h
 *
 * simple lockless ringbuffer
 *
 * Copyright (C) 2010 Google, Inc.
 *
 * This software is licensed under the terms of the GNU General Public
 * License version 2, as published by the Free Software Foundation, and
 * may be copied, distributed, and modified under those terms.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 */
 
#include <linux/kernel.h>
#include <linux/slab.h>
 
struct fiq_debugger_ringbuf {
    int len;
    int head;
    int tail;
    u8 buf[];
};
 
 
static inline struct fiq_debugger_ringbuf *fiq_debugger_ringbuf_alloc(int len)
{
    struct fiq_debugger_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 fiq_debugger_ringbuf_free(struct fiq_debugger_ringbuf *rbuf)
{
    kfree(rbuf);
}
 
static inline int fiq_debugger_ringbuf_level(struct fiq_debugger_ringbuf *rbuf)
{
    int level = rbuf->head - rbuf->tail;
 
    if (level < 0)
        level = rbuf->len + level;
 
    return level;
}
 
static inline int fiq_debugger_ringbuf_room(struct fiq_debugger_ringbuf *rbuf)
{
    return rbuf->len - fiq_debugger_ringbuf_level(rbuf) - 1;
}
 
static inline u8
fiq_debugger_ringbuf_peek(struct fiq_debugger_ringbuf *rbuf, int i)
{
    return rbuf->buf[(rbuf->tail + i) % rbuf->len];
}
 
static inline int
fiq_debugger_ringbuf_consume(struct fiq_debugger_ringbuf *rbuf, int count)
{
    count = min(count, fiq_debugger_ringbuf_level(rbuf));
 
    rbuf->tail = (rbuf->tail + count) % rbuf->len;
    smp_mb();
 
    return count;
}
 
static inline int
fiq_debugger_ringbuf_push(struct fiq_debugger_ringbuf *rbuf, u8 datum)
{
    if (fiq_debugger_ringbuf_room(rbuf) == 0)
        return 0;
 
    rbuf->buf[rbuf->head] = datum;
    smp_mb();
    rbuf->head = (rbuf->head + 1) % rbuf->len;
    smp_mb();
 
    return 1;
}