3c_disasm/instr/stb.cpp

   1 /*   `Deep Thought', a softcore CPU implemented on a FPGA
   2
   3     Copyright (C) 2010 Markus Hofstaetter <markus.manrow@gmx.at>
   4     Copyright (C) 2010 Martin Perner <e0725782@student.tuwien.ac.at>
   5     Copyright (C) 2010 Stefan Rebernig <stefan.rebernig@gmail.com>
   6     Copyright (C) 2010 Manfred Schwarz <e0725898@student.tuwien.ac.at>
   7     Copyright (C) 2010 Bernhard Urban <lewurm@gmail.com>
   8
   9     This program is free software: you can redistribute it and/or modify
  10     it under the terms of the GNU General Public License as published by
  11     the Free Software Foundation, either version 3 of the License, or
  12     (at your option) any later version.
  13
  14     This program is distributed in the hope that it will be useful,
  15     but WITHOUT ANY WARRANTY; without even the implied warranty of
  16     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  17     GNU General Public License for more details.
  18
  19     You should have received a copy of the GNU General Public License
  20     along with this program.  If not, see <http://www.gnu.org/licenses/>. */
  21
  22 #include "../Iinstr.hpp"
  23
  24
  25 class Cstb : public Iinstr {
  26         public:
  27                 Cstb();
  28                 void evalInstr();
  29                 void execInstr();
  30                 std::string toString();
  31                 Iinstr* getNew();
  32 };
  33
  34 /**
  35  * Name:      create_instruction
  36  * Purpose:   if compiled as shared library, this functions creates the
  37               instruction object
  38
  39  * Returns:   pointer to instruction object
  40  */
  41 extern "C" Iinstr* create_instruction() {
  42     return new Cstb();
  43 }
  44
  45 Iinstr* Cstb::getNew()
  46 {
  47     return new Cstb();
  48 }
  49
  50 /**
  51  * Name:      destroy_instruction
  52  * Purpose:   if compiled as shared library, this functions destoys the
  53               instruction object
  54
  55  * Parameter: IInstruction - the instruction object to delete
  56  */
  57 extern "C" void destroy_instruction(Iinstr* p) {
  58     delete p;
  59 }
  60
  61 Cstb::Cstb()
  62 {
  63         opcode = B5(10011);
  64         name = "stb";
  65 }
  66
  67 void Cstb::evalInstr()
  68 {
  69         this->m_s = true;
  70
  71         dynamic_bitset<> immb = argbits;
  72         immb.resize(15);
  73         this->m_imm = this->generate15ImmSign(immb.to_ulong());
  74
  75         argbits >>= 15;
  76         m_ra = this->getRegister(argbits);
  77         argbits >>= 4;
  78         m_rd = this->getRegister(argbits);
  79
  80 }
  81
  82 #include <iomanip>
  83 #define AS_HEX std::hex << setw(8) << setfill('0')
  84
  85 void Cstb::execInstr()
  86 {
  87         //cout << "should exec " << this->toString() << endl;
  88         CDat addr = this->m_cpu->getRegister(this->m_ra);
  89         addr += m_imm;
  90         MEMORY_ADDRESS temp = (addr & (~(BYTE_COUNT-1)));
  91         CDat offset = addr-temp;
  92         CDat val = this->m_cpu->getRAM(temp);
  93
  94         val = val & ~( ((1<<8)-1) << (offset*8));
  95
  96         //data to insert
  97         CDat source = this->m_cpu->getRegister(this->m_rd);
  98         source = (source & (((1<<8)-1))) << (offset*8);
  99
 100         val += source;
 101
 102         this->m_cpu->setRAM(temp, val);
 103 }
 104
 105 std::string Cstb::toString()
 106 {
 107         stringstream op;
 108         op << this->getName();
 109
 110         op << this->getConditionFlag() << " r" << m_rd << ", " << m_imm << "(r" <<  m_ra << ")";
 111
 112         return op.str();
 113 }