uart: swap status with config half word

[calu.git] / 3b_sim / cmem.cpp

diff --git a/3b_sim/cmem.cpp b/3b_sim/cmem.cpp
index 90886a23eb4e1fdc929f51f42d0af7b87925ec84..3b8010dcc6f6ef399a98dd3975600b51e078036f 100644 (file)
--- a/3b_sim/cmem.cpp
+++ b/3b_sim/cmem.cpp
@@ -2,8 +2,41 @@
 
 using namespace std;
 
-template <class T>
-void CMem<T>::set(const MEMORY_ADDRESS address, const T& data)
+template <typename T>
+void CMem<T>::set(const MEMORY_ADDRESS address, const T data)
+{
+       if(address >= MAX_MEMORY) {
+               stringstream error;
+               error << "memoryaddress " << address << " out of range";
+               throw out_of_range(error.str());
+       }
+
+       MEMORY_ADDRESS temp = (address & (~(BYTE_COUNT-1))) / BYTE_COUNT;
+       auto iter = m_memory.begin();
+       while(temp > 0) {
+               ++iter;
+               temp--;
+       }
+
+       iter = m_memory.insert(iter, data);
+       ++iter;
+       m_memory.erase(iter);
+}
+
+template <typename T>
+T CMem<T>::get(const MEMORY_ADDRESS address) const
+{
+       if(address >= MAX_MEMORY) {
+               stringstream error;
+               error << "memoryaddress " << address << " out of range";
+               throw out_of_range(error.str());
+       }
+       MEMORY_ADDRESS temp = (address & (~(BYTE_COUNT-1))) / BYTE_COUNT;
+       return m_memory[temp];
+}
+
+template <typename T>
+void CMem<T>::setDirect(const MEMORY_ADDRESS address, const T data)
 {
        if(address >= MAX_MEMORY) {
                stringstream error;
@@ -23,13 +56,16 @@ void CMem<T>::set(const MEMORY_ADDRESS address, const T& data)
        m_memory.erase(iter);
 }
 
-template <class T>
-void CMem<T>::get(const MEMORY_ADDRESS address, T& value) const
+template <typename T>
+T CMem<T>::getDirect(const MEMORY_ADDRESS address) const
 {
        if(address >= MAX_MEMORY) {
                stringstream error;
                error << "memoryaddress " << address << " out of range";
                throw out_of_range(error.str());
        }
-       value = m_memory[address];
+       return m_memory[address];
 }
+
+
+template class CMem<CDat>;