RegisterWizard.cpp

Go to the documentation of this file.

#include "robot_instance/RegisterWizard.h"

using namespace std;

RegisterWizard::RegisterWizard(RegisterPropertiesPtr registerProperties)
    : registerProperties(registerProperties)
{
}

RegisterWizard::~RegisterWizard()
{
}

string RegisterWizard::registerToString(const uint16_t& registerValue)
{
    stringstream retval;

    if (isRegisterCertified(registerValue))
    {
        retval << "============================================================" << endl
               << "Register:  "
               << "Value=" << "0x" << hex << setw(4) << setfill('0') << uppercase << registerValue << "  "
               << "Unmasked=" << "0x" << hex << setw(4) << uppercase << (registerValue & ~registerProperties->REGISTER_CERTIFICATE_VALUE) << endl
               << setfill(' ')
               << left << setw(19) << "Name"
               << left << setw(8)  << "Index"
               << left << setw(11) << "Size Mask"
               << left << setw(12) << "Value"
               << left << "Notes" << endl
               << "------------------------------------------------------------";

        for (unsigned int i = 0; i < registerProperties->registerPropertyVector.size(); i++)
        {
            retval
                    << endl
                    << left << setw(19) << registerProperties->registerPropertyVector[i]->name
                    << left << dec << setw(8)  << registerProperties->registerPropertyVector[i]->bitIndex
                    << "0x" << left << hex << setw(9) << registerProperties->registerPropertyVector[i]->sizeMask
                    << "0x" << left << setw(10) << bitWizard.getBits(registerProperties->registerPropertyVector[i]->bitIndex, registerProperties->registerPropertyVector[i]->sizeMask, registerValue)
                    << registerProperties->registerPropertyVector[i]->notes;
        }
    }
    else
    {
        retval << "Register is invalid.";
    }

    return retval.str();
}

vector< string > RegisterWizard::changedRegisterProperties(const uint16_t& registerValueBefore, const uint16_t& registerValueAfter, const uint16_t& bitsToCheckMask)
{
    vector<string> changedProperties;

    for (PropertyDefMap::iterator it = registerProperties->registerProperty.begin(); it != registerProperties->registerProperty.end(); ++it)
    {
        // XOR the registerValues to get changed bits
        // mask the result with the bits of the current property
        if (((registerValueBefore ^ registerValueAfter) & (it->second.sizeMask << it->second.bitIndex)) & bitsToCheckMask)
        {
            changedProperties.push_back(it->second.name);
        }
    }

    return changedProperties;
}

bool RegisterWizard::has(const std::string& prop)
{
    return (registerProperties->registerProperty.find(prop) != registerProperties->registerProperty.end());
}

std::vector< std::string> RegisterWizard::getRegisterProperties()
{
    std::vector< std::string > temp;

    for (PropertyDefVector::iterator it = registerProperties->registerPropertyVector.begin(); it != registerProperties->registerPropertyVector.end(); ++it)
    {
        temp.push_back((*it)->name);
    }

    return temp;
}

bool RegisterWizard::isWritable()
{
    return registerProperties->isWritable;
}