3c_disasm/instr/ldb.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 Cldb : public Iinstr {
  26         public:
  27                 Cldb();
  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 Cldb();
  43 }
  44
  45 Iinstr* Cldb::getNew()
  46 {
  47     return new Cldb();
  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 Cldb::Cldb()
  62 {
  63         opcode = B5(10010);
  64         name = "ldb";
  65 }
  66
  67 void Cldb::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 Cldb::execInstr()
  86 {
  87         //cout << "should exec " << this->toString() << endl;
  88         CDat val = this->m_cpu->getRegister(this->m_ra);
  89         val += m_imm;
  90         MEMORY_ADDRESS temp = (val & (~(BYTE_COUNT-1)));
  91         CDat offset = val-temp;
  92         val = this->m_cpu->getRAM(temp);
  93         val = (val >> (offset*8)) & ( ((1<<8)-1));
  94         CDat dest = this->m_cpu->getRegister(this->m_rd);
  95         dest = dest & (~((1<<8)-1));
  96         dest = dest | val;
  97         this->m_cpu->setRegister(this->m_rd,dest);
  98 }
  99
 100 std::string Cldb::toString()
 101 {
 102         stringstream op;
 103         op << this->getName();
 104
 105         op << this->getConditionFlag() << " r" << m_rd << ", " << m_imm << "(r" <<  m_ra << ")";
 106
 107         return op.str();
 108 }