will/InfiniTime
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

Merge pull request #876 from yehoshuapw/hrs-driver-changes

Browse Source 
Hrs driver changes
This commit is contained in:
JF 2022-01-26 21:39:58 +01:00 committed by GitHub
commit 9e9010c725
No known key found for this signature in database
GPG Key ID: 4AEE18F83AFDEB23
3 changed files with 7 additions and 8 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

8
src/drivers/Hrs3300.cpp
View File

@ -54,18 +54,18 @@ void Hrs3300::Disable() {
WriteRegister(static_cast<uint8_t>(Registers::Enable), value); WriteRegister(static_cast<uint8_t>(Registers::Enable), value);
} }
uint16_t Hrs3300::ReadHrs() { uint32_t Hrs3300::ReadHrs() {
auto m = ReadRegister(static_cast<uint8_t>(Registers::C0DataM)); auto m = ReadRegister(static_cast<uint8_t>(Registers::C0DataM));
auto h = ReadRegister(static_cast<uint8_t>(Registers::C0DataH)); auto h = ReadRegister(static_cast<uint8_t>(Registers::C0DataH));
auto l = ReadRegister(static_cast<uint8_t>(Registers::C0dataL)); auto l = ReadRegister(static_cast<uint8_t>(Registers::C0dataL));
return (m << 8) | ((h & 0x0f) << 4) | (l & 0x0f) | ((l & 0x30) << 12); return ((l & 0x30) << 12) | (m << 8) | ((h & 0x0f) << 4) | (l & 0x0f);
} }
uint16_t Hrs3300::ReadAls() { uint32_t Hrs3300::ReadAls() {
auto m = ReadRegister(static_cast<uint8_t>(Registers::C1dataM)); auto m = ReadRegister(static_cast<uint8_t>(Registers::C1dataM));
auto h = ReadRegister(static_cast<uint8_t>(Registers::C1dataH)); auto h = ReadRegister(static_cast<uint8_t>(Registers::C1dataH));
auto l = ReadRegister(static_cast<uint8_t>(Registers::C1dataL)); auto l = ReadRegister(static_cast<uint8_t>(Registers::C1dataL));
return (m << 3) | ((h & 0x3f) << 11) | (l & 0x07); return ((h & 0x3f) << 11) | (m << 3) | (l & 0x07);
} }
void Hrs3300::SetGain(uint8_t gain) { void Hrs3300::SetGain(uint8_t gain) {

4
src/drivers/Hrs3300.h
View File

@ -30,8 +30,8 @@ namespace Pinetime {
void Init(); void Init();
void Enable(); void Enable();
void Disable(); void Disable();
uint16_t ReadHrs(); uint32_t ReadHrs();
uint16_t ReadAls(); uint32_t ReadAls();
void SetGain(uint8_t gain); void SetGain(uint8_t gain);
void SetDrive(uint8_t drive); void SetDrive(uint8_t drive);

3
src/heartratetask/HeartRateTask.cpp
View File

@ -65,8 +65,7 @@ void HeartRateTask::Work() {
} }
if (measurementStarted) { if (measurementStarted) {
auto hrs = heartRateSensor.ReadHrs(); ppg.Preprocess(static_cast<float>(heartRateSensor.ReadHrs()));
ppg.Preprocess(hrs);
auto bpm = ppg.HeartRate(); auto bpm = ppg.HeartRate();
if (lastBpm == 0 && bpm == 0) if (lastBpm == 0 && bpm == 0)