sim_dae2_card.cpp

Go to the documentation of this file.

#include "stdafx.h"

#include "sim_dae2_card.h"
#include "isisvme.h"

// fw32 means 32bit firmware reg - now all are 32 bit
template <class DAECardPolicy>
SIMDAE2Card<DAECardPolicy>::SIMDAE2Card(int position, VMESimulationIface* vme, isisU32_t firmware, bool fw32, FaultMode fault_mode, DAEstatus& status) : Base(), m_position(position), m_type(UnknownCard), m_vme(vme), m_veto_raised(false), m_is_running(true), m_firmware(firmware)
{
        m_firmware = firmware;
        addMapping(ISISVME::TransferIORegisterSpace, FIRMVERS, 1, &m_firmware, "", true, false, NULL, 0, false, false, fault_mode);
}

template <class DAECardPolicy>
void SIMDAE2Card<DAECardPolicy>::printStatus(std::ostream& os)
{
        os << "SIMDAE2 card at position " << m_position;
}

template <class DAECardPolicy>
int SIMDAE2Card<DAECardPolicy>::addMapping(ISISVME::TransferProps props, isisU32_t address, int n, isisU32_t* var, const char* name, bool readable,
                                bool writable, isisU32_t* access_reg, unsigned access_bit, bool wrap, 
                                bool sixteen_bit_access, FaultMode fault_mode)
{
        if (n > 0)
        {
                m_mapping.push_back(sim_mapping(props, address, n, sizeof(isisU32_t), var, name, readable, writable, access_reg, access_bit, wrap, sixteen_bit_access, fault_mode));
        }
        return 0;
}

template <class DAECardPolicy>
int SIMDAE2Card<DAECardPolicy>::addMapping(ISISVME::TransferProps props, isisU32_t address, int n, uint64_t* var, const char* name, bool readable,
                                bool writable, isisU32_t* access_reg, unsigned access_bit, bool wrap, 
                                bool sixteen_bit_access, FaultMode fault_mode)
{
        if (n > 0)
        {
                m_mapping.push_back(sim_mapping(props, address, n, sizeof(uint64_t), var, name, readable, writable, access_reg, access_bit, wrap, sixteen_bit_access, fault_mode));
        }
        return 0;
}

template <class __type, class DAECardPolicy>
static int simulateRead(SIMDAE2Card<DAECardPolicy>* d2card, ISISVME::TransferProps props, unsigned long address, __type *data, long nitems, DAEstatus& status)
{
        int i, j, card;
        int ts = sizeof(__type);
        bool access_reg_ok;
        card = DAECardPolicy::cardFromAddress(address);
        bool done = false;
        if (card != d2card->position())
        {
                return ISISVME::Error;
        }
        std::vector<sim_mapping>& mapping = d2card->mapping();
        address = DAECardPolicy::baseAddress(address); // clear card number bit
        __type *var;
        for(i=0; i<mapping.size() && !done; i++)
        {
                access_reg_ok = ( (mapping[i].access_reg == NULL) || ((*(mapping[i].access_reg) & mapping[i].access_bit) != 0) );
                if ( access_reg_ok && (address >= mapping[i].address) && (props & mapping[i].props) )
                {
                        if (mapping[i].fault_mode != Working)
                        {
                                continue;
                        }
                        else if ( (address + ts * nitems) <= (mapping[i].address + ts * mapping[i].n) )
                        {
                                address -= mapping[i].address;
                                var = mapping[i].var<__type>();
                                for(j=0; j<nitems; j++)
                                {
                                        data[j] = var[j + address/4];
                                }
                                done = true;
                        }
                        else if (mapping[i].wrap)
                        {
                                address -= mapping[i].address;
                                var = mapping[i].var<__type>();
                                for(j=0; j<nitems; j++)
                                {
                                        data[j] = var[(j + address/ts) % mapping[i].n];
                                }
                                done = true;
                        }
                }
        }
        if (done)
        {
                return ISISVME::Success;
        }
        else
        {
                return ISISVME::Error;
        }
}

template <class __type, class DAECardPolicy>
static int simulateWrite(SIMDAE2Card<DAECardPolicy>* d2card, ISISVME::TransferProps props, unsigned long address, __type *data, long nitems, DAEstatus& status)
{
        int i, j, card;
        int ts = sizeof(__type);
        card = DAECardPolicy::cardFromAddress(address);
        bool done = false;
        if (card != d2card->position())
        {
                return ISISVME::Error;
        }
        std::vector<sim_mapping>& mapping = d2card->mapping();
        address = DAECardPolicy::baseAddress(address); // clear card number bit
        for(i=0; i<mapping.size() && !done; i++)
        {
                if ( (address >= mapping[i].address) && (props & mapping[i].props) &&
                     ( (mapping[i].access_reg == NULL) || ((*(mapping[i].access_reg) & mapping[i].access_bit) != 0) ) )
                {
                        if (mapping[i].fault_mode != Working)
                        {
                                continue;
                        }
                        else if (address + ts * nitems <= mapping[i].address + mapping[i].ws * mapping[i].n)
                        {
                                address -= mapping[i].address;
                                for(j=0; j<nitems; j++)
                                {
                                        (mapping[i].var<__type>())[j + address/ts] = data[j];
                                }
                                done = true;
                        }
                        else if (mapping[i].wrap)
                        {
                                address -= mapping[i].address;
                                for(j=0; j<nitems; j++)
                                {
                                        (mapping[i].var<__type>())[(j + address/ts) % mapping[i].n] = data[j];
                                }
                                done = true;
                        }
                }
        }
        if (done)
        {
                return ISISVME::Success;
        }
        else
        {
                return ISISVME::Error;
        }
}


template <class DAECardPolicy>
int SIMDAE2Card<DAECardPolicy>::read16(ISISVME::TransferProps props, unsigned long address, isisU16_t* data16, long nitems, DAEstatus& status)
{
        return simulateRead<isisU16_t>(this, props, address, data16, nitems, status);
}

template <class DAECardPolicy>
int SIMDAE2Card<DAECardPolicy>::read32(ISISVME::TransferProps props, unsigned long address, isisU32_t* data32, long nitems, DAEstatus& status)
{
    return simulateRead<isisU32_t>(this, props, address, data32, nitems, status);
}

template <class DAECardPolicy>
int SIMDAE2Card<DAECardPolicy>::write16(ISISVME::TransferProps props, unsigned long address, isisU16_t* data16, long nitems, DAEstatus& status)
{
    return simulateWrite<isisU16_t>(this, props, address, data16, nitems, status);
}

template <class DAECardPolicy>
int SIMDAE2Card<DAECardPolicy>::write32(ISISVME::TransferProps props, unsigned long address, isisU32_t* data32, long nitems, DAEstatus& status)
{
        return simulateWrite<isisU32_t>(this, props, address, data32, nitems, status);
}


template <class DAECardPolicy>
void SIMDAE2Card<DAECardPolicy>::increment(int value, isisU32_t& low)
{
        low += value;
}


template <class DAECardPolicy>
void SIMDAE2Card<DAECardPolicy>::increment2(int value, isisU32_t& low, isisU32_t& high)
{
        low += value;
        while(low > 0xffff)
        {
                low -= 65536;
                ++high;
        }
}

template <class DAECardPolicy>
void SIMDAE2Card<DAECardPolicy>::increment32(int value, isisU32_t& low, isisU32_t& high)
{
        if ((low + (isisU32_t)value) < low)
        {
                ++high;
        }
        low += (isisU32_t)value;
}

template <class DAECardPolicy>
void SIMDAE2Card<DAECardPolicy>::increment32(int value, uint64_t& low, isisU32_t& high)
{
        if ((low + (uint64_t)value) < low)
        {
                ++high;
        }
        low += (uint64_t)value;
}

template <class DAECardPolicy>
void SIMDAE2Card<DAECardPolicy>::increment3(int value, isisU32_t& low, isisU32_t& middle, isisU32_t& high)
{
        low += value;
        while (low > 0xffff)
        {
                low -= 65536;
                if (++middle > 0xffff)
                {
                        middle = 0;
                        ++high;
                }
        }
}

template class SIMDAE2Card<DAE2CardPolicy>;
template class SIMDAE2Card<DAE2EnvPeriodPolicy>;
template class SIMDAE2Card<DAE2DetCardPolicy>;

template class SIMDAE2Card<DAE3CardPolicy>;
template class SIMDAE2Card<DAE3EnvPeriodPolicy>;
template class SIMDAE2Card<DAE3DetCardPolicy>;