AXP2101Pwron.cpp

Go to the documentation of this file.

 
#include "../../../SensorBuildOpt.h"
#if !SENSORLIB_EXCLUDE_PMIC_AXP2101
 
#include "AXP2101Pwron.hpp"
#include "AXP2101Regs.hpp"
 
 
AXP2101Pwron::AXP2101Pwron(AXP2101Core &core) : _core(core)
{
}
 
bool AXP2101Pwron::updateBits(uint8_t mask, uint8_t value)
{
    int v = _core.readReg(axp2101_regs::pmu::IRQ_OFF_ON_LEVEL);
    if (v < 0) return false;
    uint8_t cur = static_cast<uint8_t>(v);
    uint8_t next = (cur & ~mask) | (value & mask);
    if (next == cur) return true;
    return _core.writeReg(axp2101_regs::pmu::IRQ_OFF_ON_LEVEL, next) >= 0;
}
 
bool AXP2101Pwron::setOnDurationMs(uint16_t ms)
{
    uint8_t idx = (ms >= 2000) ? 3 :
                  (ms >= 1000) ? 2 :
                  (ms >= 512)  ? 1 : 0;
    return updateBits(0x03, idx);
}
 
bool AXP2101Pwron::getOnDurationMs(uint16_t &ms) const
{
    const uint16_t kOnLevelMs[] = {128, 512, 1000, 2000};
    int v = _core.readReg(axp2101_regs::pmu::IRQ_OFF_ON_LEVEL);
    if (v < 0) return false;
    ms = kOnLevelMs[static_cast<uint8_t>(v) & 0x03];
    return true;
}
 
bool AXP2101Pwron::setOffDurationMs(uint16_t ms)
{
    uint8_t idx = (ms >= 10000) ? 3 :
                  (ms >= 8000)  ? 2 :
                  (ms >= 6000)  ? 1 : 0;
    return updateBits(0x0C, idx << 2);
}
 
bool AXP2101Pwron::getOffDurationMs(uint16_t &ms) const
{
    const uint16_t kOffLevelMs[] = {4000, 6000, 8000, 10000};
    int v = _core.readReg(axp2101_regs::pmu::IRQ_OFF_ON_LEVEL);
    if (v < 0) return false;
    ms = kOffLevelMs[(static_cast<uint8_t>(v) >> 2) & 0x03];
    return true;
}
 
bool AXP2101Pwron::setIrqDurationMs(uint16_t ms)
{
    uint8_t idx = (ms >= 2500) ? 3 :
                  (ms >= 2000) ? 2 :
                  (ms >= 1500) ? 1 : 0;
    return updateBits(0x30, idx << 4);
}
 
bool AXP2101Pwron::getIrqDurationMs(uint16_t &ms) const
{
    const uint16_t kIrqLevelMs[] = {1000, 1500, 2000, 2500};
    int v = _core.readReg(axp2101_regs::pmu::IRQ_OFF_ON_LEVEL);
    if (v < 0) return false;
    ms = kIrqLevelMs[(static_cast<uint8_t>(v) >> 4) & 0x03];
    return true;
}
 
#endif