69 lines
2.0 KiB
C++
69 lines
2.0 KiB
C++
#include "LMS7002M_RegistersMap.h"
|
|
#include "LMS7002M_parameters.h"
|
|
|
|
LMS7002M_RegistersMap::LMS7002M_RegistersMap()
|
|
{
|
|
|
|
}
|
|
|
|
LMS7002M_RegistersMap::~LMS7002M_RegistersMap()
|
|
{
|
|
|
|
}
|
|
|
|
uint16_t LMS7002M_RegistersMap::GetDefaultValue(uint16_t address) const
|
|
{
|
|
std::map<uint16_t, Register>::const_iterator iter = mChannelA.find(address);
|
|
if( iter != mChannelA.end())
|
|
return iter->second.defaultValue;
|
|
else
|
|
return 0;
|
|
}
|
|
|
|
void LMS7002M_RegistersMap::InitializeDefaultValues(const std::vector<const LMS7Parameter*> parameterList)
|
|
{
|
|
for(auto parameter : parameterList)
|
|
{
|
|
uint16_t regValue = mChannelA[parameter->address].defaultValue;
|
|
mChannelA[parameter->address].defaultValue = regValue | (parameter->defaultValue << parameter->lsb);
|
|
mChannelA[parameter->address].value = mChannelA[parameter->address].defaultValue;
|
|
if(parameter->address >= 0x0100)
|
|
mChannelB[parameter->address].value = mChannelA[parameter->address].value;
|
|
}
|
|
}
|
|
|
|
void LMS7002M_RegistersMap::SetValue(uint8_t channel, const uint16_t address, const uint16_t value)
|
|
{
|
|
if(channel == 0)
|
|
mChannelA[address].value = value;
|
|
else if(channel == 1)
|
|
mChannelB[address].value = value;
|
|
}
|
|
|
|
uint16_t LMS7002M_RegistersMap::GetValue(uint8_t channel, uint16_t address) const
|
|
{
|
|
const std::map<const uint16_t, Register> *regMap;
|
|
if(channel == 0)
|
|
regMap = &mChannelA;
|
|
else if(channel == 1)
|
|
regMap = &mChannelB;
|
|
std::map<const uint16_t, Register>::const_iterator iter;
|
|
iter = regMap->find(address);
|
|
if (iter != regMap->end())
|
|
return iter->second.value;
|
|
else
|
|
return 0;
|
|
}
|
|
|
|
std::vector<uint16_t> LMS7002M_RegistersMap::GetUsedAddresses(const uint8_t channel) const
|
|
{
|
|
std::vector<uint16_t> addresses;
|
|
if(channel == 0)
|
|
for(auto iter : mChannelA)
|
|
addresses.push_back(iter.first);
|
|
else if(channel == 1)
|
|
for(auto iter : mChannelB)
|
|
addresses.push_back(iter.first);
|
|
return addresses;
|
|
}
|