AXP517Pwron.cpp

Go to the documentation of this file.

 
#include "../../../SensorBuildOpt.h"
#if !SENSORLIB_EXCLUDE_PMIC_AXP517
 
#include "AXP517Pwron.hpp"
#include "AXP517Regs.hpp"
 
 
AXP517Pwron::AXP517Pwron(AXP517Core &core)
    : _core(core)
{
}
 
bool AXP517Pwron::updateBits(uint8_t mask, uint8_t value)
{
    int v = _core.readReg(axp517_regs::ctrl::PWRON_CFG);
    if (v < 0) return false;
    uint8_t cur = (uint8_t)v;
    uint8_t next = (uint8_t)((cur & ~mask) | (value & mask));
    if (next == cur) return true;
    return _core.writeReg(axp517_regs::ctrl::PWRON_CFG, next) >= 0;
}
 
 
bool AXP517Pwron::setOnDurationMs(uint16_t ms)
{
    uint8_t idx = (ms >= 2000) ? 3 :
                  (ms >= 1000) ? 2 :
                  (ms >= 512)  ? 1 : 0;
    return updateBits(0x03, idx);
}
 
bool AXP517Pwron::getOnDurationMs(uint16_t &ms) const
{
    // ONLEVEL: 00=128ms, 01=512ms, 10=1000ms, 11=2000ms
    const uint16_t kOnLevelMs[] = {128, 512, 1000, 2000};
    int v = _core.readReg(axp517_regs::ctrl::PWRON_CFG);
    if (v < 0) return false;
    ms = kOnLevelMs[((uint8_t)v) & 0x03];
    return true;
}
 
bool AXP517Pwron::setOffDurationMs(uint16_t ms)
{
    uint8_t idx = (ms >= 10000) ? 3 :
                  (ms >= 8000)  ? 2 :
                  (ms >= 6000)  ? 1 : 0;
    return updateBits(0x0C, idx << 2);
}
 
bool AXP517Pwron::getOffDurationMs(uint16_t &ms) const
{
    // OFFLEVEL: 00=4000ms, 01=6000ms, 10=8000ms, 11=10000ms
    const uint16_t kOffLevelMs[] = {4000, 6000, 8000, 10000};
    int v = _core.readReg(axp517_regs::ctrl::PWRON_CFG);
    if (v < 0) return false;
    ms = kOffLevelMs[(((uint8_t)v) >> 2) & 0x03];
    return true;
}
 
 
bool AXP517Pwron::setIrqDurationMs(uint16_t ms)
{
    uint8_t idx = (ms >= 2500) ? 3 :
                  (ms >= 2000) ? 2 :
                  (ms >= 1500) ? 1 : 0;
    return updateBits(0x30, idx << 4);
}
 
bool AXP517Pwron::getIrqDurationMs(uint16_t &ms) const
{
    // IRQLEVEL: 00=1000ms, 01=1500ms, 10=2000ms, 11=2500ms
    const uint16_t kIrqLevelMs[] = {1000, 1500, 2000, 2500};
    int v = _core.readReg(axp517_regs::ctrl::PWRON_CFG);
    if (v < 0) return false;
    ms = kIrqLevelMs[(((uint8_t)v) >> 4) & 0x03];
    return true;
}
 
#endif