-
Notifications
You must be signed in to change notification settings - Fork 0
/
evqueue.c
64 lines (58 loc) · 1.82 KB
/
evqueue.c
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
// Smart Toybox Event Queue implementation
//
// Copyright(C) 2016. Nebojsa Sumrak and Jelena (Petra) Markovic
//
// This program is free software; you can redistribute it and / or modify
// it under the terms of the GNU General Public License as published by
// the Free Software Foundation; either version 2 of the License, or
// (at your option) any later version.
//
// 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.
//
// You should have received a copy of the GNU General Public License along
// with this program; if not, write to the Free Software Foundation, Inc.,
// 51 Franklin Street, Fifth Floor, Boston, MA 02110 - 1301 USA.
#include "platform.h"
#include "string.h"
#include "mstime.h"
#include "debug.h"
#include "evqueue.h"
#define EVQUEUE_SIZE 32 // must be power of 2
static struct event evqueue[EVQUEUE_SIZE];
static unsigned char nextread = 0, nextwrite = 0;
static BOOL empty = 1;
void evqueue_init()
{
nextread = nextwrite = 0;
empty = 1;
}
BOOL evqueue_read(struct event *ev)
{
if (empty) return 0;
if (ev) *ev = *(evqueue + nextread);
int_disable_all();
nextread++; nextread &= EVQUEUE_SIZE - 1;
if (nextread == nextwrite) empty = 1;
int_enable_all();
return 1;
}
BOOL evqueue_write(unsigned char id, unsigned short arg1, unsigned long arg2)
{
ASSERT(id < EV_LAST);
int_disable_all();
if (!empty && nextread == nextwrite) { // queue is full
int_enable_all();
return 0;
}
(evqueue + nextwrite)->id = id;
(evqueue + nextwrite)->arg1 = arg1;
(evqueue + nextwrite)->arg2 = arg2;
(evqueue + nextwrite)->time = time_get();
nextwrite++; nextwrite &= EVQUEUE_SIZE - 1;
empty = 0;
int_enable_all();
return 1;
}