← Back to branch summary

~arcachofo/simulide/1.1.0

« back to all changes in this revision

Viewing changes to src/mcusim/mcuinterrupts.cpp

  • Committer: arcachofo
  • Date: 2021-01-01 14:23:42 UTC
  • Revision ID: arcachofo@simulide.com-20210101142342-ozfljnll44g5lbl3
Initial Commit 0.5.15-RC3

Show diffs side-by-side

added added

removed removed

Lines of Context:
src/mcusim/mcuinterrupts.cpp
 
1
/***************************************************************************
 
2
 *   Copyright (C) 2020 by santiago González                               *
 
3
 *   santigoro@gmail.com                                                   *
 
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
 
 
20
#include "mcuinterrupts.h"
 
21
#include "mcucore.h"
 
22
#include "e_mcu.h"
 
23
 
 
24
uint8_t Interrupt::m_enGlobal = 0;
 
25
Interrupt* Interrupt::m_active = 0l;
 
26
std::multimap<uint8_t, Interrupt*> Interrupt::m_running;
 
27
std::multimap<uint8_t, Interrupt*> Interrupt::m_pending;
 
28
QHash<QString, Interrupt*> Interrupt::m_interrupts;
 
29
 
 
30
Interrupt::Interrupt( QString name, uint16_t vector, eMcu* mcu )
 
31
{
 
32
    m_mcu = mcu;
 
33
    m_name = name;
 
34
    m_vector = vector;
 
35
    m_mode = 0;
 
36
 
 
37
    m_ram = mcu->getRam();
 
38
}
 
39
Interrupt::~Interrupt(){}
 
40
 
 
41
void Interrupt::reset()
 
42
{
 
43
    m_mode   = 0;
 
44
    m_raised = 0;
 
45
    m_enable = 0;
 
46
    m_priority = 0;
 
47
}
 
48
 
 
49
void Interrupt::clearFlag()
 
50
{
 
51
    m_ram[m_flagReg] &= ~m_flagMask; // Clear Interrupt flag
 
52
}
 
53
 
 
54
void Interrupt::enableFlag( uint8_t en )
 
55
{
 
56
    m_enable = en;
 
57
}
 
58
 
 
59
void Interrupt::setPriority( uint8_t p )
 
60
{
 
61
    m_priority = p;
 
62
}
 
63
 
 
64
void Interrupt::raise( uint8_t v )
 
65
{
 
66
    if( !m_enable ) return;
 
67
    m_ram[m_flagReg] |= m_flagMask; // Set Interrupt flag
 
68
    m_raised = true;
 
69
 
 
70
    // Interrupt are stored in static std::multimap
 
71
    // by priority order, highest at end
 
72
    m_pending.emplace( m_priority, this ); // Add to pending interrupts
 
73
}
 
74
 
 
75
void Interrupt::execute()
 
76
{
 
77
    m_mcu->cpu->CALL_ADDR( m_vector );
 
78
    m_active = this;
 
79
}
 
80
 
 
81
void Interrupt::exitInt() // Exit from this interrupt
 
82
{
 
83
    if( m_running.size() ) // There are interrupts interrupted
 
84
    {
 
85
        auto it = prev( m_running.end() );
 
86
        m_active = it->second; // Set interrupted Interrupt as active
 
87
        m_running.erase( it ); // Remove Interrupt from running list
 
88
    }
 
89
    else m_active = NULL;
 
90
}
 
91
 
 
92
//------------------------STATIC MEMBERS ------------------------
 
93
//---------------------------------------------------------------
 
94
 
 
95
void Interrupt::retI() // Static
 
96
{
 
97
    m_active->exitInt();
 
98
}
 
99
 
 
100
void Interrupt::enableGlobal( uint8_t en ) // Static
 
101
{
 
102
    m_enGlobal = en;
 
103
}
 
104
 
 
105
void Interrupt::runInterrupts() // Static
 
106
{
 
107
    if( !m_enGlobal ) return;       // Global Interrupts disabled
 
108
    if( m_pending.empty() ) return; // No Interrupts to run
 
109
 
 
110
    auto it = prev( m_pending.end() );
 
111
    uint8_t     priority = it->first;
 
112
    Interrupt* interrupt = it->second;
 
113
 
 
114
    if( m_active ) // Only interrupt other Interrupts with lower priority
 
115
    {
 
116
        if( priority <= m_active->priority() ) return;
 
117
 
 
118
        // An interrupt being interrupted, add to running list.
 
119
        m_running.emplace( m_active->priority(), m_active );
 
120
    }
 
121
    m_pending.erase( it ); // Remove Interrupt from pending list
 
122
    interrupt->execute();
 
123
}
 
124
 
 
125
void Interrupt::resetInts() // Static
 
126
{
 
127
    m_active = NULL;
 
128
    m_pending.clear();
 
129
    m_running.clear();
 
130
 
 
131
    for( QString  inte : m_interrupts.keys() )
 
132
        m_interrupts.value( inte )->reset();
 
133
}
 
134
 
 
135
void Interrupt::remove() // Static
 
136
{
 
137
    for( QString  inte : m_interrupts.keys() )
 
138
        delete m_interrupts.value( inte );
 
139
 
 
140
    m_interrupts.clear();
 
141
}
 
142
 
 
143