i2cscanner.cpp

Go to the documentation of this file.

 
#include <semf/communication/i2cscanner.h>
#include <semf/utils/core/debug.h>
 
namespace semf
{
I2cScanner::I2cScanner(I2cMasterHardware& hardware)
: m_hardware(hardware)
{
}
 
void I2cScanner::startScan(uint16_t firstAddress, uint16_t lastAddress)
{
    SEMF_INFO("I2c Scanner - Start");
    if (m_hardware.isBusyWriting())
    {
        SEMF_ERROR("is busy");
        error(Error(kSemfClassId, static_cast<uint8_t>(ErrorCode::StartScan_IsBusy)));
        return;
    }
 
    m_addressBegin = firstAddress;
    m_addressEnd = lastAddress + 1;
    m_addressIterator = firstAddress;
 
    m_hardware.error.connect(m_onI2cNotAcknowledgeSlot);
    m_hardware.addressFound.connect(m_onI2cAcknowledgeSlot);
 
    testAddress();
}
 
void I2cScanner::testAddress()
{
    if (m_addressIterator >= m_addressEnd)
    {
        m_hardware.error.disconnect(m_onI2cNotAcknowledgeSlot);
        m_hardware.addressFound.disconnect(m_onI2cAcknowledgeSlot);
        SEMF_INFO("I2c Scanner - Finished\n");
        finished();
    }
    else
    {
        m_hardware.checkAddress(static_cast<uint8_t>(m_addressIterator));
    }
}
 
void I2cScanner::onI2cAcknowledge()
{
    SEMF_INFO("I2c device found on: 0x%02x\n", m_addressIterator);
    deviceFound(m_addressIterator++);
    testAddress();
}
 
void I2cScanner::onI2cNotAcknowledge(Error thrown)
{
    (void)thrown;
    m_addressIterator++;
    testAddress();
}
} /* namespace semf */