CCF_100/InfiniTime
1
0
Fork 0
Code Issues Pull Requests Releases Wiki Activity

Better Sensitivity UI, Calibration button added

Browse Source
This commit is contained in:
Tim Keller
2021-09-28 03:50:08 +00:00
parent 6d74820698
commit d2510d7926
6 changed files with 89 additions and 69 deletions
Download Patch File Download Diff File Expand all files Collapse all files

13
src/components/motion/MotionController.cpp
View File

@@ -1,6 +1,5 @@
#include "components/motion/MotionController.h"
#include "os/os_cputime.h"
using namespace Pinetime::Controllers;
void MotionController::Update(int16_t x, int16_t y, int16_t z, uint32_t nbSteps) {
@@ -49,18 +48,22 @@ bool MotionController::Should_ShakeWake(uint16_t thresh) {
bool wake = false;
auto diff = xTaskGetTickCount() - lastShakeTime;
lastShakeTime = xTaskGetTickCount();
int32_t speed = std::abs(y + z - lastYForShake - lastZForShake) / diff * 10;
int32_t speed = std::abs(z + (y/2) + (x/4)- lastYForShake - lastZForShake) / diff * 100;
//(.2 * speed) + ((1 - .2) * accumulatedspeed);
//implemented without floats as .25Alpha
accumulatedspeed = (speed/4) + ((accumulatedspeed/4)*3);
accumulatedspeed = (speed/5) + ((accumulatedspeed/5)*4);
if (accumulatedspeed > thresh) {
wake = true;
}
lastXForShake = x;
lastYForShake = y;
lastXForShake = x/4;
lastYForShake = y/2;
lastZForShake = z;
return wake;
}
int32_t MotionController::currentShakeSpeed(){
return accumulatedspeed;
}
void MotionController::IsSensorOk(bool isOk) {
isSensorOk = isOk;