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
|
#include "Navigation.h"
#include <string.h>
void CNavigation::saveposn(size_t posn)
{
// qDebug("Saved:%u [%u,%u,%u]", posn, historystart, historycurrent, historyend);
historycurrent = historyend = (historycurrent+1)%NAVIGATION_HISTORY_SIZE;
history[historycurrent] = posn;
if (historystart == historyend) historystart = (historystart+1)%NAVIGATION_HISTORY_SIZE;
// qDebug("Saved:%u [%u,%u,%u]", posn, historystart, historycurrent, historyend);
}
bool CNavigation::forward(size_t& loc)
{
if (historycurrent != historyend)
{
historycurrent = (historycurrent + 1)%NAVIGATION_HISTORY_SIZE;
loc = history[historycurrent];
// qDebug("Forward:%u [%u,%u,%u]", loc, historystart, historycurrent, historyend);
return true;
}
else
{
return false;
}
}
bool CNavigation::back(size_t& loc)
{
if (historyend != historystart)
{
// qDebug("Back:%u [%u,%u,%u]", loc, historystart, historycurrent, historyend);
if (historycurrent == historyend && history[historycurrent] != loc)
{
historyend = (historyend+1) % NAVIGATION_HISTORY_SIZE;
history[historyend] = loc;
}
else
{
size_t sv = historycurrent;
historycurrent = (historycurrent + NAVIGATION_HISTORY_SIZE - 1) % NAVIGATION_HISTORY_SIZE;
if (historycurrent == historystart)
{
historycurrent = sv;
return false;
}
}
loc = history[historycurrent];
// qDebug("Back:%u [%u,%u,%u]", loc, historystart, historycurrent, historyend);
return true;
}
else
{
return false;
}
}
#include <stdio.h>
void CNavigation::setSaveData(unsigned char*& data, unsigned short& len, unsigned char* src, unsigned short srclen)
{
len = srclen+sizeof(size_t)*(3+NAVIGATION_HISTORY_SIZE);
data = new unsigned char[len];
unsigned char* p = data;
memcpy(p, src, srclen);
p += srclen;
memcpy(p, &historystart, sizeof(size_t));
p += sizeof(size_t);
memcpy(p, &historyend, sizeof(size_t));
p += sizeof(size_t);
memcpy(p, &historycurrent, sizeof(size_t));
p += sizeof(size_t);
memcpy(p, history, sizeof(size_t)*NAVIGATION_HISTORY_SIZE);
printf("<%u,%u,%u>\n", historystart, historyend, historycurrent);
for (int i = historystart; i <= historyend; i++)
printf("<%u> ", history[i]);
printf("\n");
}
void CNavigation::putSaveData(unsigned char*& src, unsigned short& srclen)
{
if (srclen >= sizeof(size_t)*(3+NAVIGATION_HISTORY_SIZE))
{
unsigned char* p = src;
memcpy(&historystart, p, sizeof(size_t));
p += sizeof(size_t);
memcpy(&historyend, p, sizeof(size_t));
p += sizeof(size_t);
memcpy(&historycurrent, p, sizeof(size_t));
p += sizeof(size_t);
memcpy(history, p, sizeof(size_t)*NAVIGATION_HISTORY_SIZE);
src = p + sizeof(size_t)*NAVIGATION_HISTORY_SIZE;
srclen -= sizeof(size_t)*(3+NAVIGATION_HISTORY_SIZE);
}
printf("<%u,%u,%u>\n", historystart, historyend, historycurrent);
for (int i = historystart; i <= historyend; i++)
printf("<%u> ", history[i]);
printf("\n");
}
|