blob: eb8d04aa59cab8231a2c652998e041a6264b46d1 (
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
|
#pragma once
#include <cstdint>
#include <FreeRTOS.h>
#include "drivers/Bma421.h"
#include "components/ble/MotionService.h"
namespace Pinetime {
namespace Controllers {
class MotionController {
public:
enum class DeviceTypes {
Unknown,
BMA421,
BMA425,
};
void Update(int16_t x, int16_t y, int16_t z, uint32_t nbSteps);
int16_t X() const {
return x;
}
int16_t Y() const {
return y;
}
int16_t Z() const {
return z;
}
uint32_t NbSteps() const {
return nbSteps;
}
void ResetTrip() {
currentTripSteps = 0;
}
uint32_t GetTripSteps() const {
return currentTripSteps;
}
bool ShouldShakeWake(uint16_t thresh);
bool ShouldRaiseWake(bool isSleeping);
int32_t CurrentShakeSpeed() const {
return accumulatedSpeed;
}
void IsSensorOk(bool isOk) {
isSensorOk = isOk;
}
bool IsSensorOk() const {
return isSensorOk;
}
DeviceTypes DeviceType() const {
return deviceType;
}
void Init(Pinetime::Drivers::Bma421::DeviceTypes types);
void SetService(Pinetime::Controllers::MotionService* service) {
this->service = service;
}
private:
uint32_t nbSteps = 0;
uint32_t currentTripSteps = 0;
TickType_t lastTime = 0;
TickType_t time = 0;
int16_t x = 0;
int16_t lastYForRaiseWake = 0;
int16_t lastY = 0;
int16_t y = 0;
int16_t lastZ = 0;
int16_t z = 0;
int32_t accumulatedSpeed = 0;
bool isSensorOk = false;
DeviceTypes deviceType = DeviceTypes::Unknown;
Pinetime::Controllers::MotionService* service = nullptr;
};
}
}
|
