forked from iNavFlight/inav-configurator
-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathsafehomeCollection.js
104 lines (84 loc) · 2.86 KB
/
safehomeCollection.js
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
'use strict';
const BitHelper = require('./bitHelper');
var SafehomeCollection = function () {
let self = {},
data = [],
maxSafehomeCount = 8;
self.setMaxSafehomeCount = function (value) {
maxSafehomeCount = value;
};
self.getMaxSafehomeCount = function () {
return maxSafehomeCount;
}
self.put = function (element) {
element.setNumber(data.length);
data.push(element);
};
self.get = function () {
return data;
};
self.clean = function (index){
data[index].cleanup();
};
self.flush = function () {
data = [];
};
self.isEmpty = () => {
return data.length == 0;
};
self.safehomeCount = () => {
return data.length;
}
self.drop = (idx) => {
data.forEach(safehome => {
if (safehome.getNumber() >= idx) {
safehome.setNumber(safehome.getNumber() - 1);
}
});
data.splice(idx, 1);
}
self.insert = (safehome, idx) => {
data.forEach(s => {
if (s.getNumber() >= idx) {
s.setNumber(s.getNumber() + 1);
}
});
data.splice(idx, 0, safehome);
}
self.updateSafehome = function(newSafehome) {
data[newSafehome.getNumber()] = newSafehome;
};
self.extractBuffer = function(safehomeId) {
let buffer = [];
let safehome = data[safehomeId];
if (safehomeId < self.safehomeCount()) {
buffer.push(safehome.getNumber()); // sbufReadU8(src); // number
buffer.push(1);
buffer.push(BitHelper.specificByte(safehome.getLat(), 0)); // sbufReadU32(src); // lat
buffer.push(BitHelper.specificByte(safehome.getLat(), 1));
buffer.push(BitHelper.specificByte(safehome.getLat(), 2));
buffer.push(BitHelper.specificByte(safehome.getLat(), 3));
buffer.push(BitHelper.specificByte(safehome.getLon(), 0)); // sbufReadU32(src); // lon
buffer.push(BitHelper.specificByte(safehome.getLon(), 1));
buffer.push(BitHelper.specificByte(safehome.getLon(), 2));
buffer.push(BitHelper.specificByte(safehome.getLon(), 3));
} else {
buffer = Array(10).fill(0);
buffer[0] = safehomeId;
}
return buffer;
}
self.safehomeDisplayDebug = function() {
if (data && data.length != 0) {
data.forEach(function (element) {
console.log("N° : ", element.getNumber(),
"Enabled : ", element.getEnabled(),
"Lon : ", element.getLon(),
"Lat : ", element.getLat(),
);
});
}
}
return self;
};
module.exports = SafehomeCollection;