src/Registers.cpp

   1 /*
   2  *      avr-sim: An atmel AVR simulator
   3  *  Copyright (C) 2008  Tom Haber
   4  *
   5  *  This program is free software: you can redistribute it and/or modify
   6  *  it under the terms of the GNU General Public License as published by
   7  *  the Free Software Foundation, either version 3 of the License, or
   8  *  (at your option) any later version.
   9
  10  *  This program is distributed in the hope that it will be useful,
  11  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
  12  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  13  *  GNU General Public License for more details.
  14  *
  15  *  You should have received a copy of the GNU General Public License
  16  *  along with this program.  If not, see <http://www.gnu.org/licenses/>.
  17  */
  18
  19 #include "Registers.h"
  20 #include "Util.h"
  21 #include "Hardware.h"
  22 #include <algorithm>
  23
  24 #include "Format.h"
  25 #include "RuntimeException.h"
  26
  27 namespace avr {
  28
  29         IORegisters::IORegisters(unsigned int count) {
  30                 regs.resize( count );
  31                 setEach( regs.begin(), regs.end(), (IORegister *)0 );
  32         }
  33
  34         IORegisters::~IORegisters() {
  35                 std::for_each( regs.begin(), regs.end(), Delete<IORegister>() );
  36         }
  37
  38         void IORegisters::addReg( word addr, IORegister *reg ) {
  39                 if( regs[addr] != 0 )
  40                         throw util::RuntimeException(
  41                                         util::format("Register %s shares I/O location with %s")
  42                                                 % reg->getName() % regs[addr]->getName() );
  43
  44                 regs[ addr ] = reg;
  45         }
  46
  47         IORegister *IORegisters::getIoreg(const std::string & name, bool required) const {
  48                 std::vector<IORegister *>::const_iterator it;
  49                 for(it = regs.begin(); it != regs.end(); ++it) {
  50                         if( ((*it) != 0) && (*it)->getName() == name )
  51                                 break;
  52                 }
  53
  54                 if( it == regs.end() ) {
  55                         if( ! required )
  56                                 return 0;
  57
  58                         throw util::RuntimeException(
  59                                         util::format("Unable to find register %s") % name );
  60                 }
  61
  62                 return (*it);
  63         }
  64
  65         void IORegisters::reset() {
  66                 std::for_each( regs.begin(), regs.end(),
  67                                 MethodCall<IORegister>(&IORegister::reset) );
  68         }
  69
  70         IORegister::operator unsigned char() {
  71                 if( hw != 0 )
  72                         hw->regAccess( this );
  73
  74                 return val;
  75         }
  76
  77     unsigned char IORegister::operator =(unsigned char val) {
  78         unsigned char ret = Register::operator =(val);
  79         if( hw != 0 )
  80                 hw->regChanged( this );
  81         return ret;
  82     }
  83
  84     void IORegister::operator |=(unsigned char val) {
  85         this->val |= val;
  86         if( hw != 0 )
  87                 hw->regChanged( this );
  88     }
  89
  90     void IORegister::operator &=(unsigned char val) {
  91         this->val &= val;
  92         if( hw != 0 )
  93                 hw->regChanged( this );
  94     }
  95
  96 }