Velocity.cxx

Go to the documentation of this file.

 
#include "openlcb/Velocity.hxx"
 
namespace openlcb
{
    
uint8_t Velocity::get_dcc_128()
{
    uint8_t result;
    uint32_t tmp = mph() + 0.5;
    
    if (tmp == 0)
    {
        result = 0;
    }
    else if (tmp > 126)
    {
        result = 127;
    }
    else
    {
        result = (uint8_t)(tmp + 1);
    }
    
    result |= std::signbit(velocity) ? 0x00 : 0x80;
    return result;
}
 
void Velocity::set_dcc_128(uint8_t value)
{
    if ((value & 0x7F) <= 1)
    {
        velocity = 0;
    }
    else
    {
        velocity = (value & 0x07F) - 1;
        velocity *= MPH_FACTOR;
    }
    
    if ((value & 0x80) == 0)
    {
        velocity = -velocity;
    }
}
 
uint8_t Velocity::get_dcc_28()
{
    uint8_t result;
    uint32_t tmp = ((speed() * MPH_FACTOR * 28) / 128) + 0.5;
    
    if (tmp == 0)
    {
        result = 0;
    }
    else if (tmp > 28)
    {
        result = 31;
    }
    else
    {
        result = (uint8_t)(tmp + 3);
    }
    
    result |= result & 0x01 ? 0xA0 : 0x80;
    
    result >>= 1;
 
    result |= std::signbit(velocity) ? 0x00 : 0x20;
    return result;
}
 
void Velocity::set_dcc_28(uint8_t value)
{
    value <<= 1;
    
    value |= value & 0x20 ? 0x01 : 0x00;
    
    if ((value & 0x1F) <= 3)
    {
        velocity = 0;
    }
    else
    {
        velocity = (value & 0x01F) - 3;
        velocity *= 128;
        velocity /= (28 * MPH_FACTOR);
    }
    
    if ((value & 0x40) == 0)
    {
        velocity = -velocity;
    }
}
 
uint8_t Velocity::get_dcc_14()
{
    uint8_t result;
    uint32_t tmp = ((speed() * MPH_FACTOR * 14) / 128) + 0.5;
    
    if (tmp == 0)
    {
        result = 0;
    }
    else if (tmp > 14)
    {
        result = 15;
    }
    else
    {
        result = (uint8_t)(tmp + 1);
    }
    
    result |= 0x40;
 
    result |= std::signbit(velocity) ? 0x00 : 0x20;
    return result;
}
 
void Velocity::set_dcc_14(uint8_t value)
{
    if ((value & 0x0F) <= 1)
    {
        velocity = 0;
    }
    else
    {
        velocity = (value & 0x0F) - 1;
        velocity *= 128;
        velocity /= (14 * MPH_FACTOR);
    }
    
    if ((value & 0x20) == 0)
    {
        velocity = -velocity;
    }
}
    
}; /* namespace openlcb */