3c_disasm/instr/ldi.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 Cldi : public Iinstr {
  26         public:
  27                 Cldi();
  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 Cldi();
  43 }
  44
  45 Iinstr* Cldi::getNew()
  46 {
  47     return new Cldi();
  48 }
  49 /**
  50  * Name:      destroy_instruction
  51  * Purpose:   if compiled as shared library, this functions destoys the
  52               instruction object
  53
  54  * Parameter: IInstruction - the instruction object to delete
  55  */
  56 extern "C" void destroy_instruction(Iinstr* p) {
  57     delete p;
  58 }
  59
  60 Cldi::Cldi()
  61 {
  62         opcode = B5(11010);
  63         name = "ldi";
  64 }
  65
  66 void Cldi::evalInstr()
  67 {
  68         this->m_s = argbits[2];
  69         this->m_hl = argbits[1];
  70
  71         argbits >>= 3;
  72         dynamic_bitset<> immb = argbits;
  73         immb.resize(16);
  74         this->m_imm = this->generate16ImmSign(immb.to_ulong());
  75
  76         argbits >>= 16;
  77         m_rd = this->getRegister(argbits);
  78 }
  79
  80 void Cldi::execInstr()
  81 {
  82         //cout << "should exec " << this->toString() << endl;
  83         CDat val = this->m_cpu->getRegister(this->m_rd);
  84         if(this->m_s == false) {
  85                 if(this->m_hl == false) {
  86                         val &= 0xFFFF0000;
  87                 }
  88                 else {
  89                         val &= 0x0000FFFF;
  90                 }
  91                 this->m_cpu->setRegister(this->m_rd, val + this->m_imm);
  92         }
  93         else {
  94                 this->m_cpu->setRegister(this->m_rd, this->m_imm);
  95         }
  96 }
  97
  98 std::string Cldi::toString()
  99 {
 100         stringstream op;
 101         op << this->getName();
 102
 103         if(m_hl) op << 'H';
 104         if(m_s) op << 'S';
 105
 106         op << this->getConditionFlag() << " r" << m_rd << ", " << m_imm;
 107
 108         return op.str();
 109 }