trunk/src/emu/cpu/avr8/avr8.c
| r18789 | r18790 | |
| 1 | 1 | /* |
| 2 | | Atmel 8-bit AVR emulator |
| 2 | Atmel 8-bit AVR simulator |
| 3 | 3 | |
| 4 | | (Skeleton) |
| 4 | - Notes - |
| 5 | Cycle counts are generally considered to be 100% accurate per-instruction, does not support mid-instruction |
| 6 | interrupts although no software has been countered yet that requires it. Evidence of cycle accuracy is given |
| 7 | in the form of the demoscene 'wild' demo, Craft, by [lft], which uses an ATmega88 to write video out a 6-bit |
| 8 | RGB DAC pixel-by-pixel, synchronously with the frame timing. Intentionally modifying the timing of any of |
| 9 | the existing opcodes has been shown to wildly corrupt the video output in Craft, so one can assume that the |
| 10 | existing timing is 100% correct. |
| 5 | 11 | |
| 6 | | DONE: |
| 7 | | - Disassembler |
| 8 | | - [lft]'s "Craft" depends on on-chip device support now instead of opcodes (it requires unusually few in order to boot) |
| 12 | Unimplemented opcodes: CPSR, LD Z+, ST Z+, ST -Z/-Y/-X, ELPM, SPM, SPM Z+, EIJMP, SLEEP, BREAK, WDR, ICALL, |
| 13 | EICALL, JMP, CALL, SBIW |
| 9 | 14 | |
| 10 | | TODO: |
| 11 | | - Everything else |
| 12 | | * Finish opcode implementation |
| 13 | | * Add proper cycle timing |
| 14 | | * Add Interrupts |
| 15 | | * Add on-chip hardware (machine driver) |
| 15 | - Changelist - |
| 16 | 30 Oct. 2012 |
| 17 | - Added FMUL, FMULS, FMULSU opcodes [MooglyGuy] |
| 18 | - Fixed incorrect flag calculation in ROR opcode [MooglyGuy] |
| 19 | - Fixed incorrect bit testing in SBIC/SBIS opcodes [MooglyGuy] |
| 16 | 20 | |
| 17 | | Written by MooglyGuy |
| 21 | 25 Oct. 2012 |
| 22 | - Added MULS, ANDI, STI Z+, LD -Z, LD -Y, LD -X, LD Y+q, LD Z+q, SWAP, ASR, ROR and SBIS opcodes [MooglyGuy] |
| 23 | - Corrected cycle counts for LD and ST opcodes [MooglyGuy] |
| 24 | - Moved opcycles init into inner while loop, fixes 2-cycle and 3-cycle opcodes effectively forcing |
| 25 | all subsequent 1-cycle opcodes to be 2 or 3 cycles [MooglyGuy] |
| 26 | - Fixed register behavior in MULSU, LD -Z, and LD -Y opcodes [MooglyGuy] |
| 27 | |
| 28 | 18 Oct. 2012 |
| 29 | - Added OR, SBCI, ORI, ST Y+, ADIQ opcodes [MooglyGuy] |
| 30 | - Fixed COM, NEG, LSR opcodes [MooglyGuy] |
| 31 | |
| 18 | 32 | */ |
| 19 | 33 | |
| 20 | 34 | #include "emu.h" |
| r18789 | r18790 | |
| 42 | 56 | #define verboselog(x,y,z,...) |
| 43 | 57 | #endif |
| 44 | 58 | |
| 59 | //************************************************************************** |
| 60 | // ENUMS AND MACROS |
| 61 | //************************************************************************** |
| 62 | |
| 45 | 63 | enum |
| 46 | 64 | { |
| 47 | 65 | AVR8_SREG_C = 0, |
| r18789 | r18790 | |
| 89 | 107 | |
| 90 | 108 | static const char avr8_reg_name[4] = { 'A', 'B', 'C', 'D' }; |
| 91 | 109 | |
| 92 | | #define SREG_R(b) ((cpustate->status & (1 << (b))) >> (b)) |
| 93 | | #define SREG_W(b,v) cpustate->status = (cpustate->status & ~(1 << (b))) | ((v) << (b)) |
| 110 | #define SREG_R(b) ((m_status & (1 << (b))) >> (b)) |
| 111 | #define SREG_W(b,v) m_status = (m_status & ~(1 << (b))) | ((v) << (b)) |
| 94 | 112 | #define NOT(x) (1 - (x)) |
| 95 | 113 | |
| 96 | 114 | // Opcode-Parsing Defines |
| r18789 | r18790 | |
| 112 | 130 | #define MULCONST2(op) ((((op) >> 6) & 0x0002) | (((op) >> 3) & 0x0001)) |
| 113 | 131 | |
| 114 | 132 | // Register Defines |
| 115 | | #define XREG ((cpustate->r[27] << 8) | cpustate->r[26]) |
| 116 | | #define YREG ((cpustate->r[29] << 8) | cpustate->r[28]) |
| 117 | | #define ZREG ((cpustate->r[31] << 8) | cpustate->r[30]) |
| 118 | | #define SPREG ((cpustate->r[AVR8_REGIDX_SPH] << 8) | cpustate->r[AVR8_REGIDX_SPL]) |
| 133 | #define XREG ((m_r[27] << 8) | m_r[26]) |
| 134 | #define YREG ((m_r[29] << 8) | m_r[28]) |
| 135 | #define ZREG ((m_r[31] << 8) | m_r[30]) |
| 136 | #define SPREG ((m_r[AVR8_REGIDX_SPH] << 8) | m_r[AVR8_REGIDX_SPL]) |
| 119 | 137 | |
| 120 | 138 | // I/O Defines |
| 121 | | #define AVR8_OCR1BH (cpustate->r[AVR8_REGIDX_OCR1BH]) |
| 122 | | #define AVR8_OCR1BL (cpustate->r[AVR8_REGIDX_OCR1BL]) |
| 123 | | #define AVR8_OCR1AH (cpustate->r[AVR8_REGIDX_OCR1AH]) |
| 124 | | #define AVR8_OCR1AL (cpustate->r[AVR8_REGIDX_OCR1AL]) |
| 125 | | #define AVR8_ICR1H (cpustate->r[AVR8_REGIDX_ICR1H]) |
| 126 | | #define AVR8_ICR1L (cpustate->r[AVR8_REGIDX_ICR1L]) |
| 127 | | #define AVR8_TCNT1H (cpustate->r[AVR8_REGIDX_TCNT1H]) |
| 128 | | #define AVR8_TCNT1L (cpustate->r[AVR8_REGIDX_TCNT1L]) |
| 139 | #define AVR8_OCR1BH (m_r[AVR8_REGIDX_OCR1BH]) |
| 140 | #define AVR8_OCR1BL (m_r[AVR8_REGIDX_OCR1BL]) |
| 141 | #define AVR8_OCR1AH (m_r[AVR8_REGIDX_OCR1AH]) |
| 142 | #define AVR8_OCR1AL (m_r[AVR8_REGIDX_OCR1AL]) |
| 143 | #define AVR8_ICR1H (m_r[AVR8_REGIDX_ICR1H]) |
| 144 | #define AVR8_ICR1L (m_r[AVR8_REGIDX_ICR1L]) |
| 145 | #define AVR8_TCNT1H (m_r[AVR8_REGIDX_TCNT1H]) |
| 146 | #define AVR8_TCNT1L (m_r[AVR8_REGIDX_TCNT1L]) |
| 129 | 147 | |
| 130 | | #define AVR8_TCCR1B (cpustate->r[AVR8_REGIDX_TCCR1B]) |
| 148 | #define AVR8_TCCR1B (m_r[AVR8_REGIDX_TCCR1B]) |
| 131 | 149 | #define AVR8_TCCR1B_ICNC1_MASK 0x80 |
| 132 | 150 | #define AVR8_TCCR1B_ICNC1_SHIFT 7 |
| 133 | 151 | #define AVR8_TCCR1B_ICES1_MASK 0x40 |
| r18789 | r18790 | |
| 138 | 156 | #define AVR8_TCCR1B_CS_SHIFT 0 |
| 139 | 157 | #define AVR8_TIMER1_CLOCK_SELECT (AVR8_TCCR1B & AVR8_TCCR1B_CS_MASK) |
| 140 | 158 | |
| 141 | | #define AVR8_TCCR1A (cpustate->r[AVR8_REGIDX_TCCR1A]) |
| 159 | #define AVR8_TCCR1A (m_r[AVR8_REGIDX_TCCR1A]) |
| 142 | 160 | #define AVR8_TCCR1A_COM1A_MASK 0xc0 |
| 143 | 161 | #define AVR8_TCCR1A_COM1A_SHIFT 6 |
| 144 | 162 | #define AVR8_TCCR1A_COM1B_MASK 0x30 |
| r18789 | r18790 | |
| 149 | 167 | #define AVR8_TCCR1A_COM1B ((AVR8_TCCR1A & AVR8_TCCR1A_COM1B_MASK) >> AVR8_TCCR1A_COM1B_SHIFT) |
| 150 | 168 | #define AVR8_TCCR1A_WGM1_10 (AVR8_TCCR1A & AVR8_TCCR1A_WGM1_10_MASK) |
| 151 | 169 | |
| 152 | | #define AVR8_TIMSK1 (cpustate->r[AVR8_REGIDX_TIMSK1]) |
| 170 | #define AVR8_TIMSK1 (m_r[AVR8_REGIDX_TIMSK1]) |
| 153 | 171 | #define AVR8_TIMSK1_ICIE1_MASK 0x20 |
| 154 | 172 | #define AVR8_TIMSK1_OCIE1B_MASK 0x04 |
| 155 | 173 | #define AVR8_TIMSK1_OCIE1A_MASK 0x02 |
| r18789 | r18790 | |
| 159 | 177 | #define AVR8_TIMSK1_OCIE1A ((AVR8_TIMSK1 & AVR8_TIMSK1_OCIE1A_MASK) >> 1) |
| 160 | 178 | #define AVR8_TIMSK1_TOIE1 (AVR8_TIMSK1 & AVR8_TIMSK1_TOIE1_MASK) |
| 161 | 179 | |
| 162 | | #define AVR8_TIFR1 (cpustate->r[AVR8_REGIDX_TIFR1]) |
| 180 | #define AVR8_TIFR1 (m_r[AVR8_REGIDX_TIFR1]) |
| 163 | 181 | #define AVR8_TIFR1_ICF1_MASK 0x20 |
| 164 | 182 | #define AVR8_TIFR1_ICF1_SHIFT 5 |
| 165 | 183 | #define AVR8_TIFR1_OCF1B_MASK 0x04 |
| r18789 | r18790 | |
| 171 | 189 | #define AVR8_TIFR1_MASK (AVR8_TIFR1_ICF1_MASK | AVR8_TIFR1_TOV1_MASK | \ |
| 172 | 190 | AVR8_TIFR1_OCF1B_MASK | AVR8_TIFR1_OCF1A_MASK) |
| 173 | 191 | |
| 174 | | #define AVR8_TCCR2B (cpustate->r[AVR8_REGIDX_TCCR1B]) |
| 192 | #define AVR8_TCCR2B (m_r[AVR8_REGIDX_TCCR1B]) |
| 175 | 193 | #define AVR8_TCCR2B_FOC2A_MASK 0x80 |
| 176 | 194 | #define AVR8_TCCR2B_FOC2A_SHIFT 7 |
| 177 | 195 | #define AVR8_TCCR2B_FOC2B_MASK 0x40 |
| r18789 | r18790 | |
| 182 | 200 | #define AVR8_TCCR2B_CS_SHIFT 0 |
| 183 | 201 | #define AVR8_TIMER2_CLOCK_SELECT (AVR8_TCCR2B & AVR8_TCCR2B_CS_MASK) |
| 184 | 202 | |
| 185 | | #define AVR8_TCCR2A (cpustate->r[AVR8_REGIDX_TCCR1A]) |
| 203 | #define AVR8_TCCR2A (m_r[AVR8_REGIDX_TCCR1A]) |
| 186 | 204 | #define AVR8_TCCR2A_COM2A_MASK 0xc0 |
| 187 | 205 | #define AVR8_TCCR2A_COM2A_SHIFT 6 |
| 188 | 206 | #define AVR8_TCCR2A_COM2B_MASK 0x30 |
| r18789 | r18790 | |
| 193 | 211 | #define AVR8_TCCR2A_COM2B ((AVR8_TCCR2A & AVR8_TCCR2A_COM2B_MASK) >> AVR8_TCCR2A_COM2B_SHIFT) |
| 194 | 212 | #define AVR8_TCCR2A_WGM2_10 (AVR8_TCCR2A & AVR8_TCCR1A_WGM2_10_MASK) |
| 195 | 213 | |
| 196 | | #define AVR8_TIMSK2 (cpustate->r[AVR8_REGIDX_TIMSK2]) |
| 214 | #define AVR8_TIMSK2 (m_r[AVR8_REGIDX_TIMSK2]) |
| 197 | 215 | #define AVR8_TIMSK2_OCIE2B_MASK 0x04 |
| 198 | 216 | #define AVR8_TIMSK2_OCIE2A_MASK 0x02 |
| 199 | 217 | #define AVR8_TIMSK2_TOIE2_MASK 0x01 |
| r18789 | r18790 | |
| 201 | 219 | #define AVR8_TIMSK2_OCIE2A ((AVR8_TIMSK2 & AVR8_TIMSK1_OCIE2A_MASK) >> 1) |
| 202 | 220 | #define AVR8_TIMSK2_TOIE2 (AVR8_TIMSK2 & AVR8_TIMSK1_TOIE2_MASK) |
| 203 | 221 | |
| 204 | | #define AVR8_TIFR2 (cpustate->r[AVR8_REGIDX_TIFR2]) |
| 222 | #define AVR8_TIFR2 (m_r[AVR8_REGIDX_TIFR2]) |
| 205 | 223 | #define AVR8_TIFR2_OCF2B_MASK 0x04 |
| 206 | 224 | #define AVR8_TIFR2_OCF2B_SHIFT 2 |
| 207 | 225 | #define AVR8_TIFR2_OCF2A_MASK 0x02 |
| r18789 | r18790 | |
| 217 | 235 | #define AVR8_WGM1 (((AVR8_TCCR1B & 0x18) >> 1) | (AVR8_TCCR1A & 0x03)) |
| 218 | 236 | #define AVR8_TCNT1_DIR (state->m_tcnt1_direction) |
| 219 | 237 | |
| 220 | | #define AVR8_OCR2B cpustate->r[AVR8_REGIDX_OCR2B] |
| 221 | | #define AVR8_OCR2A cpustate->r[AVR8_REGIDX_OCR2A] |
| 222 | | #define AVR8_TCNT2 cpustate->r[AVR8_REGIDX_TCNT2] |
| 238 | #define AVR8_OCR2B m_r[AVR8_REGIDX_OCR2B] |
| 239 | #define AVR8_OCR2A m_r[AVR8_REGIDX_OCR2A] |
| 240 | #define AVR8_TCNT2 m_r[AVR8_REGIDX_TCNT2] |
| 223 | 241 | #define AVR8_WGM2 (((AVR8_TCCR2B & 0x08) >> 1) | (AVR8_TCCR2A & 0x03)) |
| 224 | 242 | |
| 225 | 243 | #define AVR8_GTCCR_PSRASY_MASK 0x02 |
| 226 | 244 | #define AVR8_GTCCR_PSRASY_SHIFT 1 |
| 227 | 245 | |
| 228 | | INLINE avr8_state *get_safe_token(device_t *device) |
| 229 | | { |
| 230 | | assert(device != NULL); |
| 231 | | assert(device->type() == ATMEGA88 || device->type() == ATMEGA644); |
| 232 | | return (avr8_state *)downcast<legacy_cpu_device *>(device)->token(); |
| 233 | | } |
| 246 | //************************************************************************** |
| 247 | // DEVICE INTERFACE |
| 248 | //************************************************************************** |
| 234 | 249 | |
| 235 | | /*****************************************************************************/ |
| 236 | | // Prototypes |
| 250 | const device_type ATMEGA88 = &device_creator<atmega88_device>; |
| 251 | const device_type ATMEGA644 = &device_creator<atmega644_device>; |
| 237 | 252 | |
| 238 | | // - Utility |
| 239 | | static void unimplemented_opcode(avr8_state *cpustate, UINT32 op); |
| 253 | //------------------------------------------------- |
| 254 | // atmega8_device - constructor |
| 255 | //------------------------------------------------- |
| 240 | 256 | |
| 241 | | // - Interrupts |
| 242 | | static void avr8_set_irq_line(avr8_state *cpustate, UINT16 vector, int state); |
| 243 | | static void avr8_update_interrupt_internal(avr8_state *cpustate, int source); |
| 244 | | //static void avr8_poll_interrupt(avr8_state *cpustate); |
| 257 | avr8_device::avr8_device(const machine_config &mconfig, const char *tag, device_t *owner, UINT32 clock, const device_type type, UINT32 addr_mask) |
| 258 | : cpu_device(mconfig, type, "AVR8", tag, owner, clock), |
| 259 | m_program_config("program", ENDIANNESS_LITTLE, 8, 22), |
| 260 | m_io_config("io", ENDIANNESS_LITTLE, 8, 16), |
| 261 | m_pc(0), |
| 262 | m_debugger_pc(0), |
| 263 | m_status(0), |
| 264 | m_timer0_top(0), |
| 265 | m_timer0_increment(1), |
| 266 | m_timer0_prescale(0), |
| 267 | m_timer0_prescale_count(0), |
| 268 | m_timer1_top(0), |
| 269 | m_timer1_increment(1), |
| 270 | m_timer1_prescale(0), |
| 271 | m_timer1_prescale_count(0), |
| 272 | m_timer2_top(0), |
| 273 | m_timer2_increment(1), |
| 274 | m_timer2_prescale(0), |
| 275 | m_timer2_prescale_count(0), |
| 276 | m_addr_mask(addr_mask), |
| 277 | m_interrupt_pending(false), |
| 278 | m_icount(0), |
| 279 | m_elapsed_cycles(0) |
| 280 | { |
| 281 | // Allocate & setup |
| 282 | } |
| 245 | 283 | |
| 246 | | // - Timers |
| 247 | | static void avr8_timer_tick(avr8_state *cpustate, int cycles); |
| 248 | 284 | |
| 249 | | // - Timer 0 |
| 250 | | static void avr8_timer0_tick(avr8_state *cpustate); |
| 285 | //------------------------------------------------- |
| 286 | // static_set_config - set the configuration |
| 287 | // structure |
| 288 | //------------------------------------------------- |
| 251 | 289 | |
| 252 | | // - Timer 1 |
| 253 | | static void avr8_timer1_tick(avr8_state *cpustate); |
| 254 | | static void avr8_change_timsk1(avr8_state *cpustate, UINT8 data); |
| 255 | | static void avr8_update_timer1_waveform_gen_mode(avr8_state *cpustate); |
| 256 | | static void avr8_changed_tccr1a(avr8_state *cpustate, UINT8 data); |
| 257 | | static void avr8_update_timer1_input_noise_canceler(avr8_state *cpustate); |
| 258 | | static void avr8_update_timer1_input_edge_select(avr8_state *cpustate); |
| 259 | | static void avr8_update_timer1_clock_source(avr8_state *cpustate); |
| 260 | | static void avr8_changed_tccr1b(avr8_state *cpustate, UINT8 data); |
| 261 | | static void avr8_update_ocr1(avr8_state *cpustate, UINT16 newval, UINT8 reg); |
| 290 | void avr8_device::static_set_config(device_t &device, const avr8_config &config) |
| 291 | { |
| 292 | avr8_device &avr8 = downcast<avr8_device &>(device); |
| 293 | static_cast<avr8_config &>(avr8) = config; |
| 294 | } |
| 262 | 295 | |
| 263 | | // - Timer 2 |
| 264 | | static void avr8_timer2_tick(avr8_state *cpustate); |
| 265 | | static void avr8_update_timer2_waveform_gen_mode(avr8_state *cpustate); |
| 266 | | static void avr8_changed_tccr2a(avr8_state *cpustate, UINT8 data); |
| 267 | | static void avr8_update_timer2_clock_source(avr8_state *cpustate); |
| 268 | | static void avr8_timer2_force_output_compare(avr8_state *cpustate, int reg); |
| 269 | | static void avr8_changed_tccr2b(avr8_state *cpustate, UINT8 data); |
| 270 | | static void avr8_update_ocr2(avr8_state *cpustate, UINT8 newval, UINT8 reg); |
| 271 | 296 | |
| 272 | | // - Register Handling |
| 273 | | static bool avr8_io_reg_write(avr8_state *cpustate, UINT16 offset, UINT8 data); |
| 274 | | static bool avr8_io_reg_read(avr8_state *cpustate, UINT16 offset, UINT8 *data); |
| 297 | //------------------------------------------------- |
| 298 | // unimplemented_opcode - bail on unspuported |
| 299 | // instruction |
| 300 | //------------------------------------------------- |
| 275 | 301 | |
| 276 | | /*****************************************************************************/ |
| 277 | | // Utility Functions |
| 278 | | |
| 279 | | static void unimplemented_opcode(avr8_state *cpustate, UINT32 op) |
| 302 | void avr8_device::unimplemented_opcode(UINT32 op) |
| 280 | 303 | { |
| 281 | | fatalerror("AVR8: unknown opcode (%08x) at %08x\n", op, cpustate->pc); |
| 304 | fatalerror("AVR8: unknown opcode (%08x) at %08x\n", op, m_pc); |
| 282 | 305 | } |
| 283 | 306 | |
| 284 | | INLINE bool avr8_is_long_opcode(UINT16 op) |
| 307 | |
| 308 | //------------------------------------------------- |
| 309 | // is_long_opcode - returns true if opcode is 4 |
| 310 | // bytes long |
| 311 | //------------------------------------------------- |
| 312 | |
| 313 | inline bool avr8_device::is_long_opcode(UINT16 op) |
| 285 | 314 | { |
| 286 | 315 | if((op & 0xf000) == 0x9000) |
| 287 | 316 | { |
| r18789 | r18790 | |
| 303 | 332 | return false; |
| 304 | 333 | } |
| 305 | 334 | |
| 306 | | INLINE UINT8 READ_PRG_8(avr8_state *cpustate, UINT32 address) |
| 335 | //------------------------------------------------- |
| 336 | // device_start - start up the device |
| 337 | //------------------------------------------------- |
| 338 | |
| 339 | void avr8_device::device_start() |
| 307 | 340 | { |
| 308 | | return cpustate->program->read_byte(address); |
| 341 | m_pc = 0; |
| 342 | |
| 343 | m_program = &space(AS_PROGRAM); |
| 344 | m_io = &space(AS_IO); |
| 345 | |
| 346 | // register our state for the debugger |
| 347 | astring tempstr; |
| 348 | state_add(STATE_GENPC, "GENPC", m_pc).noshow(); |
| 349 | state_add(STATE_GENFLAGS, "GENFLAGS", m_status).callimport().callexport().formatstr("%8s").noshow(); |
| 350 | state_add(AVR8_SREG, "STATUS", m_r[AVR8_REGIDX_SREG]).mask(0xff); |
| 351 | state_add(AVR8_PC, "PC", m_debugger_pc).mask(0xffff); |
| 352 | state_add(AVR8_R0, "R0", m_r[ 0]).mask(0xff); |
| 353 | state_add(AVR8_R1, "R1", m_r[ 1]).mask(0xff); |
| 354 | state_add(AVR8_R2, "R2", m_r[ 2]).mask(0xff); |
| 355 | state_add(AVR8_R3, "R3", m_r[ 3]).mask(0xff); |
| 356 | state_add(AVR8_R4, "R4", m_r[ 4]).mask(0xff); |
| 357 | state_add(AVR8_R5, "R5", m_r[ 5]).mask(0xff); |
| 358 | state_add(AVR8_R6, "R6", m_r[ 6]).mask(0xff); |
| 359 | state_add(AVR8_R7, "R7", m_r[ 7]).mask(0xff); |
| 360 | state_add(AVR8_R8, "R8", m_r[ 8]).mask(0xff); |
| 361 | state_add(AVR8_R9, "R9", m_r[ 9]).mask(0xff); |
| 362 | state_add(AVR8_R10, "R10", m_r[10]).mask(0xff); |
| 363 | state_add(AVR8_R11, "R11", m_r[11]).mask(0xff); |
| 364 | state_add(AVR8_R12, "R12", m_r[12]).mask(0xff); |
| 365 | state_add(AVR8_R13, "R13", m_r[13]).mask(0xff); |
| 366 | state_add(AVR8_R14, "R14", m_r[14]).mask(0xff); |
| 367 | state_add(AVR8_R15, "R15", m_r[15]).mask(0xff); |
| 368 | state_add(AVR8_R16, "R16", m_r[16]).mask(0xff); |
| 369 | state_add(AVR8_R17, "R17", m_r[17]).mask(0xff); |
| 370 | state_add(AVR8_R18, "R18", m_r[18]).mask(0xff); |
| 371 | state_add(AVR8_R19, "R19", m_r[19]).mask(0xff); |
| 372 | state_add(AVR8_R20, "R20", m_r[20]).mask(0xff); |
| 373 | state_add(AVR8_R21, "R21", m_r[21]).mask(0xff); |
| 374 | state_add(AVR8_R22, "R22", m_r[22]).mask(0xff); |
| 375 | state_add(AVR8_R23, "R23", m_r[23]).mask(0xff); |
| 376 | state_add(AVR8_R24, "R24", m_r[24]).mask(0xff); |
| 377 | state_add(AVR8_R25, "R25", m_r[25]).mask(0xff); |
| 378 | state_add(AVR8_R26, "R26", m_r[26]).mask(0xff); |
| 379 | state_add(AVR8_R27, "R27", m_r[27]).mask(0xff); |
| 380 | state_add(AVR8_R28, "R28", m_r[28]).mask(0xff); |
| 381 | state_add(AVR8_R29, "R29", m_r[29]).mask(0xff); |
| 382 | state_add(AVR8_R30, "R30", m_r[30]).mask(0xff); |
| 383 | state_add(AVR8_R31, "R31", m_r[31]).mask(0xff); |
| 384 | |
| 385 | // register our state for saving |
| 386 | save_item(NAME(m_pc)); |
| 387 | save_item(NAME(m_status)); |
| 388 | save_item(NAME(m_r)); |
| 389 | save_item(NAME(m_timer0_top)); |
| 390 | save_item(NAME(m_timer0_increment)); |
| 391 | save_item(NAME(m_timer0_prescale)); |
| 392 | save_item(NAME(m_timer0_prescale_count)); |
| 393 | save_item(NAME(m_timer1_top)); |
| 394 | save_item(NAME(m_timer1_increment)); |
| 395 | save_item(NAME(m_timer1_prescale)); |
| 396 | save_item(NAME(m_timer1_prescale_count)); |
| 397 | save_item(NAME(m_timer2_top)); |
| 398 | save_item(NAME(m_timer2_increment)); |
| 399 | save_item(NAME(m_timer2_prescale)); |
| 400 | save_item(NAME(m_timer2_prescale_count)); |
| 401 | save_item(NAME(m_addr_mask)); |
| 402 | save_item(NAME(m_interrupt_pending)); |
| 403 | save_item(NAME(m_icount)); |
| 404 | save_item(NAME(m_elapsed_cycles)); |
| 405 | |
| 406 | // set our instruction counter |
| 407 | m_icountptr = &m_icount; |
| 309 | 408 | } |
| 310 | 409 | |
| 311 | | INLINE UINT16 READ_PRG_16(avr8_state *cpustate, UINT32 address) |
| 410 | //------------------------------------------------- |
| 411 | // device_reset - reset the device |
| 412 | //------------------------------------------------- |
| 413 | |
| 414 | void avr8_device::device_reset() |
| 312 | 415 | { |
| 313 | | return cpustate->program->read_word(address << 1); |
| 416 | m_status = 0; |
| 417 | io_write8(AVR8_REGIDX_SPL, 0); |
| 418 | io_write8(AVR8_REGIDX_SPH, 0); |
| 419 | |
| 420 | for (int i = 0; i < 32; i++) |
| 421 | { |
| 422 | m_r[i] = 0; |
| 423 | } |
| 424 | |
| 425 | m_timer0_top = 0; |
| 426 | m_timer0_increment = 1; |
| 427 | m_timer0_prescale = 0; |
| 428 | m_timer0_prescale_count = 0; |
| 429 | |
| 430 | m_timer1_top = 0; |
| 431 | m_timer1_increment = 1; |
| 432 | m_timer1_prescale = 0; |
| 433 | m_timer1_prescale_count = 0; |
| 434 | |
| 435 | m_timer2_top = 0; |
| 436 | m_timer2_increment = 1; |
| 437 | m_timer2_prescale = 0; |
| 438 | m_timer2_prescale_count = 0; |
| 439 | |
| 440 | AVR8_TIMSK1 = 0; |
| 441 | AVR8_OCR1AH = 0; |
| 442 | AVR8_OCR1AL = 0; |
| 443 | AVR8_OCR1BH = 0; |
| 444 | AVR8_OCR1BL = 0; |
| 445 | AVR8_ICR1H = 0; |
| 446 | AVR8_ICR1L = 0; |
| 447 | AVR8_TCNT1H = 0; |
| 448 | AVR8_TCNT1L = 0; |
| 449 | AVR8_TCNT2 = 0; |
| 450 | |
| 451 | m_interrupt_pending = false; |
| 452 | |
| 453 | m_elapsed_cycles = 0; |
| 314 | 454 | } |
| 315 | 455 | |
| 316 | | INLINE void WRITE_PRG_8(avr8_state *cpustate, UINT32 address, UINT8 data) |
| 456 | //------------------------------------------------- |
| 457 | // memory_space_config - return the configuration |
| 458 | // of the specified address space, or NULL if |
| 459 | // the space doesn't exist |
| 460 | //------------------------------------------------- |
| 461 | |
| 462 | const address_space_config *avr8_device::memory_space_config(address_spacenum spacenum) const |
| 317 | 463 | { |
| 318 | | cpustate->program->write_byte(address, data); |
| 464 | if (spacenum == AS_PROGRAM) |
| 465 | { |
| 466 | return &m_program_config; |
| 467 | } |
| 468 | else if (spacenum == AS_IO) |
| 469 | { |
| 470 | return &m_io_config; |
| 471 | } |
| 472 | return NULL; |
| 319 | 473 | } |
| 320 | 474 | |
| 321 | | INLINE void WRITE_PRG_16(avr8_state *cpustate, UINT32 address, UINT16 data) |
| 475 | |
| 476 | //------------------------------------------------- |
| 477 | // state_string_export - export state as a string |
| 478 | // for the debugger |
| 479 | //------------------------------------------------- |
| 480 | |
| 481 | void avr8_device::state_string_export(const device_state_entry &entry, astring &string) |
| 322 | 482 | { |
| 323 | | cpustate->program->write_word(address, data); |
| 483 | switch (entry.index()) |
| 484 | { |
| 485 | case STATE_GENFLAGS: |
| 486 | string.printf("%c%c%c%c%c%c%c%c", |
| 487 | (m_status & 0x80) ? 'I' : '-', |
| 488 | (m_status & 0x40) ? 'T' : '-', |
| 489 | (m_status & 0x20) ? 'H' : '-', |
| 490 | (m_status & 0x10) ? 'S' : '-', |
| 491 | (m_status & 0x08) ? 'V' : '-', |
| 492 | (m_status & 0x04) ? 'N' : '-', |
| 493 | (m_status & 0x02) ? 'Z' : '-', |
| 494 | (m_status & 0x01) ? 'C' : '-'); |
| 495 | break; |
| 496 | } |
| 324 | 497 | } |
| 325 | 498 | |
| 326 | | INLINE UINT8 READ_IO_8(avr8_state *cpustate, UINT16 address) |
| 499 | |
| 500 | //------------------------------------------------- |
| 501 | // disasm_min_opcode_bytes - return the length |
| 502 | // of the shortest instruction, in bytes |
| 503 | //------------------------------------------------- |
| 504 | |
| 505 | UINT32 avr8_device::disasm_min_opcode_bytes() const |
| 327 | 506 | { |
| 507 | return 2; |
| 508 | } |
| 509 | |
| 510 | |
| 511 | //------------------------------------------------- |
| 512 | // disasm_max_opcode_bytes - return the length |
| 513 | // of the longest instruction, in bytes |
| 514 | //------------------------------------------------- |
| 515 | |
| 516 | UINT32 avr8_device::disasm_max_opcode_bytes() const |
| 517 | { |
| 518 | return 4; |
| 519 | } |
| 520 | |
| 521 | |
| 522 | //------------------------------------------------- |
| 523 | // disasm_disassemble - call the disassembly |
| 524 | // helper function |
| 525 | //------------------------------------------------- |
| 526 | |
| 527 | offs_t avr8_device::disasm_disassemble(char *buffer, offs_t pc, const UINT8 *oprom, const UINT8 *opram, UINT32 options) |
| 528 | { |
| 529 | extern CPU_DISASSEMBLE( avr8 ); |
| 530 | return CPU_DISASSEMBLE_NAME(avr8)(NULL, buffer, pc, oprom, opram, 0); |
| 531 | } |
| 532 | |
| 533 | |
| 534 | //************************************************************************** |
| 535 | // MEMORY ACCESSORS |
| 536 | //************************************************************************** |
| 537 | |
| 538 | inline UINT8 avr8_device::program_read8(UINT32 address) |
| 539 | { |
| 540 | return m_program->read_byte(address); |
| 541 | } |
| 542 | |
| 543 | inline UINT16 avr8_device::program_read16(UINT32 address) |
| 544 | { |
| 545 | return m_program->read_word(address << 1); |
| 546 | } |
| 547 | |
| 548 | inline void avr8_device::program_write8(UINT32 address, UINT8 data) |
| 549 | { |
| 550 | m_program->write_byte(address, data); |
| 551 | } |
| 552 | |
| 553 | inline void avr8_device::program_write16(UINT32 address, UINT16 data) |
| 554 | { |
| 555 | m_program->write_word(address, data); |
| 556 | } |
| 557 | |
| 558 | inline UINT8 avr8_device::io_read8(UINT16 address) |
| 559 | { |
| 328 | 560 | if (address < 0x100) |
| 329 | 561 | { |
| 330 | 562 | // Allow unhandled internal registers to be handled by external driver |
| 331 | 563 | UINT8 data; |
| 332 | | if (avr8_io_reg_read(cpustate, address, &data)) |
| 564 | if (io_reg_read(address, &data)) |
| 333 | 565 | { |
| 334 | 566 | return data; |
| 335 | 567 | } |
| 336 | 568 | } |
| 337 | | return cpustate->io->read_byte(address); |
| 569 | return m_io->read_byte(address); |
| 338 | 570 | } |
| 339 | 571 | |
| 340 | | INLINE void WRITE_IO_8(avr8_state *cpustate, UINT16 address, UINT8 data) |
| 572 | inline void avr8_device::io_write8(UINT16 address, UINT8 data) |
| 341 | 573 | { |
| 342 | 574 | if (address < 0x100) |
| 343 | 575 | { |
| 344 | 576 | // Allow unhandled internal registers to be handled by external driver |
| 345 | | if (avr8_io_reg_write(cpustate, address, data)) |
| 577 | if (io_reg_write(address, data)) |
| 346 | 578 | { |
| 347 | 579 | return; |
| 348 | 580 | } |
| 349 | 581 | } |
| 350 | | cpustate->io->write_byte(address, data); |
| 582 | m_io->write_byte(address, data); |
| 351 | 583 | } |
| 352 | 584 | |
| 353 | | INLINE void PUSH(avr8_state *cpustate, UINT8 val) |
| 585 | inline void avr8_device::push(UINT8 val) |
| 354 | 586 | { |
| 355 | 587 | UINT16 sp = SPREG; |
| 356 | | WRITE_IO_8(cpustate, sp, val); |
| 588 | io_write8(sp, val); |
| 357 | 589 | sp--; |
| 358 | | WRITE_IO_8(cpustate, AVR8_REGIDX_SPL, sp & 0x00ff); |
| 359 | | WRITE_IO_8(cpustate, AVR8_REGIDX_SPH, (sp >> 8) & 0x00ff); |
| 590 | io_write8(AVR8_REGIDX_SPL, sp & 0x00ff); |
| 591 | io_write8(AVR8_REGIDX_SPH, (sp >> 8) & 0x00ff); |
| 360 | 592 | } |
| 361 | 593 | |
| 362 | | INLINE UINT8 POP(avr8_state *cpustate) |
| 594 | inline UINT8 avr8_device::pop() |
| 363 | 595 | { |
| 364 | 596 | UINT16 sp = SPREG; |
| 365 | 597 | sp++; |
| 366 | | WRITE_IO_8(cpustate, AVR8_REGIDX_SPL, sp & 0x00ff); |
| 367 | | WRITE_IO_8(cpustate, AVR8_REGIDX_SPH, (sp >> 8) & 0x00ff); |
| 368 | | return READ_IO_8(cpustate, sp); |
| 598 | io_write8(AVR8_REGIDX_SPL, sp & 0x00ff); |
| 599 | io_write8(AVR8_REGIDX_SPH, (sp >> 8) & 0x00ff); |
| 600 | return io_read8(sp); |
| 369 | 601 | } |
| 370 | 602 | |
| 371 | | UINT64 avr8_get_elapsed_cycles(device_t *device) |
| 372 | | { |
| 373 | | return get_safe_token(device)->elapsed_cycles; |
| 374 | | } |
| 603 | //************************************************************************** |
| 604 | // IRQ HANDLING |
| 605 | //************************************************************************** |
| 375 | 606 | |
| 376 | | /*****************************************************************************/ |
| 377 | | // Interrupts |
| 378 | | |
| 379 | | static void avr8_set_irq_line(avr8_state *cpustate, UINT16 vector, int state) |
| 607 | void avr8_device::set_irq_line(UINT16 vector, int state) |
| 380 | 608 | { |
| 381 | 609 | // Horrible hack, not accurate |
| 382 | 610 | if(state) |
| r18789 | r18790 | |
| 384 | 612 | if(SREG_R(AVR8_SREG_I)) |
| 385 | 613 | { |
| 386 | 614 | SREG_W(AVR8_SREG_I, 0); |
| 387 | | //printf("Push: %04x\n", cpustate->pc); |
| 388 | | PUSH(cpustate, (cpustate->pc >> 8) & 0x00ff); |
| 389 | | PUSH(cpustate, cpustate->pc & 0x00ff); |
| 390 | | cpustate->pc = vector; |
| 391 | | |
| 392 | | //avr8_timer_tick(cpustate, 3); |
| 615 | push((m_pc >> 8) & 0x00ff); |
| 616 | push(m_pc & 0x00ff); |
| 617 | m_pc = vector; |
| 393 | 618 | } |
| 394 | 619 | else |
| 395 | 620 | { |
| 396 | | cpustate->interrupt_pending = true; |
| 621 | m_interrupt_pending = true; |
| 397 | 622 | } |
| 398 | 623 | } |
| 399 | 624 | } |
| r18789 | r18790 | |
| 420 | 645 | { AVR8_INT_T2OVF, AVR8_REGIDX_TIMSK2, AVR8_TIMSK2_TOIE2_MASK, AVR8_REGIDX_TIFR2, AVR8_TIFR2_TOV2_MASK } |
| 421 | 646 | }; |
| 422 | 647 | |
| 423 | | static void avr8_update_interrupt_internal(avr8_state *cpustate, int source) |
| 648 | void avr8_device::update_interrupt(int source) |
| 424 | 649 | { |
| 425 | 650 | CInterruptCondition condition = s_int_conditions[source]; |
| 426 | 651 | |
| 427 | | int intstate = (cpustate->r[condition.m_regindex] & condition.m_regmask) ? 1 : 0; |
| 428 | | intstate = (cpustate->r[condition.m_intreg] & condition.m_intmask) ? intstate : 0; |
| 652 | int intstate = (m_r[condition.m_regindex] & condition.m_regmask) ? 1 : 0; |
| 653 | intstate = (m_r[condition.m_intreg] & condition.m_intmask) ? intstate : 0; |
| 429 | 654 | |
| 430 | | avr8_set_irq_line(cpustate, condition.m_intindex, intstate); |
| 655 | set_irq_line(condition.m_intindex, intstate); |
| 431 | 656 | |
| 432 | 657 | if (intstate) |
| 433 | 658 | { |
| 434 | | cpustate->r[condition.m_regindex] &= ~condition.m_regmask; |
| 659 | m_r[condition.m_regindex] &= ~condition.m_regmask; |
| 435 | 660 | } |
| 436 | 661 | } |
| 437 | 662 | |
| 438 | | void avr8_update_interrupt(device_t *device, int source) |
| 439 | | { |
| 440 | | avr8_state *cpustate = get_safe_token(device); |
| 441 | | avr8_update_interrupt_internal(cpustate, source); |
| 442 | | } |
| 443 | 663 | |
| 444 | | /*****************************************************************************/ |
| 445 | | // Timers |
| 446 | | |
| 447 | | static void avr8_timer_tick(avr8_state *cpustate, int cycles) |
| 664 | //************************************************************************** |
| 665 | // REGISTER HANDLING |
| 666 | //************************************************************************** |
| 667 | void avr8_device::timer_tick(int cycles) |
| 448 | 668 | { |
| 449 | | if (cpustate->timer0_prescale != 0) |
| 669 | if (m_timer0_prescale != 0) |
| 450 | 670 | { |
| 451 | | cpustate->timer0_prescale_count += cycles; |
| 452 | | while(cpustate->timer0_prescale_count >= cpustate->timer0_prescale) |
| 671 | m_timer0_prescale_count += cycles; |
| 672 | while(m_timer0_prescale_count >= m_timer0_prescale) |
| 453 | 673 | { |
| 454 | | avr8_timer0_tick(cpustate); |
| 455 | | cpustate->timer0_prescale_count -= cpustate->timer0_prescale; |
| 674 | timer0_tick(); |
| 675 | m_timer0_prescale_count -= m_timer0_prescale; |
| 456 | 676 | } |
| 457 | 677 | } |
| 458 | 678 | |
| 459 | | if (cpustate->timer1_prescale != 0) |
| 679 | if (m_timer1_prescale != 0) |
| 460 | 680 | { |
| 461 | | cpustate->timer1_prescale_count += cycles; |
| 462 | | while(cpustate->timer1_prescale_count >= cpustate->timer1_prescale) |
| 681 | m_timer1_prescale_count += cycles; |
| 682 | while(m_timer1_prescale_count >= m_timer1_prescale) |
| 463 | 683 | { |
| 464 | | avr8_timer1_tick(cpustate); |
| 465 | | cpustate->timer1_prescale_count -= cpustate->timer1_prescale; |
| 684 | timer1_tick(); |
| 685 | m_timer1_prescale_count -= m_timer1_prescale; |
| 466 | 686 | } |
| 467 | 687 | } |
| 468 | 688 | |
| 469 | | if (cpustate->timer2_prescale != 0) |
| 689 | if (m_timer2_prescale != 0) |
| 470 | 690 | { |
| 471 | | cpustate->timer2_prescale_count += cycles; |
| 472 | | while(cpustate->timer2_prescale_count >= (cpustate->timer2_prescale)) |
| 691 | m_timer2_prescale_count += cycles; |
| 692 | while(m_timer2_prescale_count >= (m_timer2_prescale)) |
| 473 | 693 | { |
| 474 | | avr8_timer2_tick(cpustate); |
| 475 | | cpustate->timer2_prescale_count -= (cpustate->timer2_prescale); |
| 694 | timer2_tick(); |
| 695 | m_timer2_prescale_count -= (m_timer2_prescale); |
| 476 | 696 | } |
| 477 | 697 | } |
| 478 | 698 | } |
| 479 | 699 | |
| 480 | 700 | // Timer 0 Handling |
| 481 | | static void avr8_timer0_tick(avr8_state *cpustate) |
| 701 | void avr8_device::timer0_tick() |
| 482 | 702 | { |
| 483 | 703 | // TODO |
| 484 | 704 | } |
| 485 | 705 | |
| 486 | 706 | // Timer 1 Handling |
| 487 | 707 | |
| 488 | | static void avr8_timer1_tick(avr8_state *cpustate) |
| 708 | void avr8_device::timer1_tick() |
| 489 | 709 | { |
| 490 | 710 | /* TODO: Handle comparison, setting OC1x pins, detection of BOTTOM and TOP */ |
| 491 | 711 | |
| 492 | | UINT16 count = (cpustate->r[AVR8_REGIDX_TCNT1H] << 8) | cpustate->r[AVR8_REGIDX_TCNT1L]; |
| 493 | | INT32 wgm1 = ((cpustate->r[AVR8_REGIDX_TCCR1B] & AVR8_TCCR1B_WGM1_32_MASK) >> 1) | |
| 494 | | (cpustate->r[AVR8_REGIDX_TCCR1A] & AVR8_TCCR1A_WGM1_10_MASK); |
| 712 | UINT16 count = (m_r[AVR8_REGIDX_TCNT1H] << 8) | m_r[AVR8_REGIDX_TCNT1L]; |
| 713 | INT32 wgm1 = ((m_r[AVR8_REGIDX_TCCR1B] & AVR8_TCCR1B_WGM1_32_MASK) >> 1) | |
| 714 | (m_r[AVR8_REGIDX_TCCR1A] & AVR8_TCCR1A_WGM1_10_MASK); |
| 495 | 715 | |
| 496 | 716 | // Cache things in array form to avoid a compare+branch inside a potentially high-frequency timer |
| 497 | | //UINT8 compare_mode[2] = { (cpustate->r[AVR8_REGIDX_TCCR1A] & AVR8_TCCR1A_COM1A_MASK) >> AVR8_TCCR1A_COM1A_SHIFT, |
| 498 | | //(cpustate->r[AVR8_REGIDX_TCCR1A] & AVR8_TCCR1A_COM1B_MASK) >> AVR8_TCCR1A_COM1B_SHIFT }; |
| 499 | | UINT16 ocr1[2] = { (cpustate->r[AVR8_REGIDX_OCR1AH] << 8) | cpustate->r[AVR8_REGIDX_OCR1AL], |
| 500 | | (cpustate->r[AVR8_REGIDX_OCR1BH] << 8) | cpustate->r[AVR8_REGIDX_OCR1BL] }; |
| 717 | //UINT8 compare_mode[2] = { (m_r[AVR8_REGIDX_TCCR1A] & AVR8_TCCR1A_COM1A_MASK) >> AVR8_TCCR1A_COM1A_SHIFT, |
| 718 | //(m_r[AVR8_REGIDX_TCCR1A] & AVR8_TCCR1A_COM1B_MASK) >> AVR8_TCCR1A_COM1B_SHIFT }; |
| 719 | UINT16 ocr1[2] = { (m_r[AVR8_REGIDX_OCR1AH] << 8) | m_r[AVR8_REGIDX_OCR1AL], |
| 720 | (m_r[AVR8_REGIDX_OCR1BH] << 8) | m_r[AVR8_REGIDX_OCR1BL] }; |
| 501 | 721 | UINT8 ocf1[2] = { (1 << AVR8_TIFR1_OCF1A_SHIFT), (1 << AVR8_TIFR1_OCF1B_SHIFT) }; |
| 502 | 722 | UINT8 int1[2] = { AVR8_INTIDX_OCF1A, AVR8_INTIDX_OCF1B }; |
| 503 | | INT32 increment = cpustate->timer1_increment; |
| 723 | INT32 increment = m_timer1_increment; |
| 504 | 724 | |
| 505 | 725 | for(INT32 reg = AVR8_REG_A; reg <= AVR8_REG_B; reg++) |
| 506 | 726 | { |
| r18789 | r18790 | |
| 511 | 731 | { |
| 512 | 732 | if (reg == 0) |
| 513 | 733 | { |
| 514 | | cpustate->r[AVR8_REGIDX_TIFR1] |= AVR8_TIFR1_TOV1_MASK; |
| 515 | | avr8_update_interrupt_internal(cpustate, AVR8_INTIDX_TOV1); |
| 734 | m_r[AVR8_REGIDX_TIFR1] |= AVR8_TIFR1_TOV1_MASK; |
| 735 | update_interrupt(AVR8_INTIDX_TOV1); |
| 516 | 736 | count = 0; |
| 517 | 737 | increment = 0; |
| 518 | 738 | } |
| 519 | 739 | |
| 520 | | cpustate->r[AVR8_REGIDX_TIFR1] |= ocf1[reg]; |
| 521 | | avr8_update_interrupt_internal(cpustate, int1[reg]); |
| 740 | m_r[AVR8_REGIDX_TIFR1] |= ocf1[reg]; |
| 741 | update_interrupt(int1[reg]); |
| 522 | 742 | } |
| 523 | 743 | else if(count == 0) |
| 524 | 744 | { |
| 525 | 745 | if (reg == 0) |
| 526 | 746 | { |
| 527 | | cpustate->r[AVR8_REGIDX_TIFR1] &= ~AVR8_TIFR1_TOV1_MASK; |
| 528 | | avr8_update_interrupt_internal(cpustate, AVR8_INTIDX_TOV1); |
| 747 | m_r[AVR8_REGIDX_TIFR1] &= ~AVR8_TIFR1_TOV1_MASK; |
| 748 | update_interrupt(AVR8_INTIDX_TOV1); |
| 529 | 749 | } |
| 530 | 750 | |
| 531 | | cpustate->r[AVR8_REGIDX_TIFR1] &= ~ocf1[reg]; |
| 532 | | avr8_update_interrupt_internal(cpustate, int1[reg]); |
| 751 | m_r[AVR8_REGIDX_TIFR1] &= ~ocf1[reg]; |
| 752 | update_interrupt(int1[reg]); |
| 533 | 753 | } |
| 534 | 754 | break; |
| 535 | 755 | |
| r18789 | r18790 | |
| 541 | 761 | switch(compare_mode[reg]) |
| 542 | 762 | { |
| 543 | 763 | case 0: |
| 544 | | //verboselog(cpustate->pc, 0, "avr8_update_timer1_compare_mode: Normal port operation (OC1 disconnected)\n"); |
| 764 | //verboselog(m_pc, 0, "update_timer1_compare_mode: Normal port operation (OC1 disconnected)\n"); |
| 545 | 765 | break; |
| 546 | 766 | |
| 547 | 767 | case 1: |
| r18789 | r18790 | |
| 556 | 776 | } |
| 557 | 777 | |
| 558 | 778 | count += increment; |
| 559 | | cpustate->r[AVR8_REGIDX_TCNT1H] = (count >> 8) & 0xff; |
| 560 | | cpustate->r[AVR8_REGIDX_TCNT1L] = count & 0xff; |
| 779 | m_r[AVR8_REGIDX_TCNT1H] = (count >> 8) & 0xff; |
| 780 | m_r[AVR8_REGIDX_TCNT1L] = count & 0xff; |
| 561 | 781 | } |
| 562 | 782 | |
| 563 | | static void avr8_change_timsk1(avr8_state *cpustate, UINT8 data) |
| 783 | void avr8_device::change_timsk1(UINT8 data) |
| 564 | 784 | { |
| 565 | 785 | UINT8 oldtimsk = AVR8_TIMSK1; |
| 566 | 786 | UINT8 newtimsk = data; |
| r18789 | r18790 | |
| 571 | 791 | if(changed & AVR8_TIMSK1_ICIE1_MASK) |
| 572 | 792 | { |
| 573 | 793 | // Check for Input Capture Interrupt interrupt condition |
| 574 | | avr8_update_interrupt_internal(cpustate, AVR8_INTIDX_ICF1); |
| 794 | update_interrupt(AVR8_INTIDX_ICF1); |
| 575 | 795 | } |
| 576 | 796 | |
| 577 | 797 | if(changed & AVR8_TIMSK1_OCIE1B_MASK) |
| 578 | 798 | { |
| 579 | 799 | // Check for Output Compare B Interrupt interrupt condition |
| 580 | | avr8_update_interrupt_internal(cpustate, AVR8_INTIDX_OCF1B); |
| 800 | update_interrupt(AVR8_INTIDX_OCF1B); |
| 581 | 801 | } |
| 582 | 802 | |
| 583 | 803 | if(changed & AVR8_TIMSK1_OCIE1A_MASK) |
| 584 | 804 | { |
| 585 | 805 | // Check for Output Compare A Interrupt interrupt condition |
| 586 | | avr8_update_interrupt_internal(cpustate, AVR8_INTIDX_OCF1A); |
| 806 | update_interrupt(AVR8_INTIDX_OCF1A); |
| 587 | 807 | } |
| 588 | 808 | |
| 589 | 809 | if(changed & AVR8_TIMSK1_TOIE1_MASK) |
| 590 | 810 | { |
| 591 | 811 | // Check for Output Compare A Interrupt interrupt condition |
| 592 | | avr8_update_interrupt_internal(cpustate, AVR8_INTIDX_TOV1); |
| 812 | update_interrupt(AVR8_INTIDX_TOV1); |
| 593 | 813 | } |
| 594 | 814 | } |
| 595 | 815 | |
| 596 | | static void avr8_update_timer1_waveform_gen_mode(avr8_state *cpustate) |
| 816 | void avr8_device::update_timer1_waveform_gen_mode() |
| 597 | 817 | { |
| 598 | 818 | // TODO |
| 599 | | cpustate->timer1_top = 0; |
| 600 | | verboselog(cpustate->pc, 0, "avr8_update_timer1_waveform_gen_mode: TODO; WGM1 is %d\n", AVR8_WGM1 ); |
| 819 | m_timer1_top = 0; |
| 820 | verboselog(m_pc, 0, "update_timer1_waveform_gen_mode: TODO; WGM1 is %d\n", AVR8_WGM1 ); |
| 601 | 821 | switch(AVR8_WGM1) |
| 602 | 822 | { |
| 603 | 823 | case WGM1_NORMAL: |
| 604 | | cpustate->timer1_top = 0xffff; |
| 824 | m_timer1_top = 0xffff; |
| 605 | 825 | break; |
| 606 | 826 | |
| 607 | 827 | case WGM1_PWM_8_PC: |
| 608 | 828 | case WGM1_FAST_PWM_8: |
| 609 | | cpustate->timer1_top = 0x00ff; |
| 829 | m_timer1_top = 0x00ff; |
| 610 | 830 | break; |
| 611 | 831 | |
| 612 | 832 | case WGM1_PWM_9_PC: |
| 613 | 833 | case WGM1_FAST_PWM_9: |
| 614 | | cpustate->timer1_top = 0x01ff; |
| 834 | m_timer1_top = 0x01ff; |
| 615 | 835 | break; |
| 616 | 836 | |
| 617 | 837 | case WGM1_PWM_10_PC: |
| 618 | 838 | case WGM1_FAST_PWM_10: |
| 619 | | cpustate->timer1_top = 0x03ff; |
| 839 | m_timer1_top = 0x03ff; |
| 620 | 840 | break; |
| 621 | 841 | |
| 622 | 842 | case WGM1_PWM_PFC_ICR: |
| 623 | 843 | case WGM1_PWM_PC_ICR: |
| 624 | 844 | case WGM1_CTC_ICR: |
| 625 | 845 | case WGM1_FAST_PWM_ICR: |
| 626 | | cpustate->timer1_top = AVR8_ICR1; |
| 846 | m_timer1_top = AVR8_ICR1; |
| 627 | 847 | break; |
| 628 | 848 | |
| 629 | 849 | case WGM1_PWM_PFC_OCR: |
| 630 | 850 | case WGM1_PWM_PC_OCR: |
| 631 | 851 | case WGM1_CTC_OCR: |
| 632 | 852 | case WGM1_FAST_PWM_OCR: |
| 633 | | cpustate->timer1_top = AVR8_OCR1A; |
| 853 | m_timer1_top = AVR8_OCR1A; |
| 634 | 854 | break; |
| 635 | 855 | |
| 636 | 856 | default: |
| 637 | | verboselog(cpustate->pc, 0, "avr8_update_timer1_waveform_gen_mode: Unsupported waveform generation type: %d\n", AVR8_WGM1); |
| 857 | verboselog(m_pc, 0, "update_timer1_waveform_gen_mode: Unsupported waveform generation type: %d\n", AVR8_WGM1); |
| 638 | 858 | break; |
| 639 | 859 | } |
| 640 | 860 | } |
| 641 | 861 | |
| 642 | | static void avr8_changed_tccr1a(avr8_state *cpustate, UINT8 data) |
| 862 | void avr8_device::changed_tccr1a(UINT8 data) |
| 643 | 863 | { |
| 644 | 864 | UINT8 oldtccr = AVR8_TCCR1A; |
| 645 | 865 | UINT8 newtccr = data; |
| 646 | 866 | UINT8 changed = newtccr ^ oldtccr; |
| 647 | 867 | |
| 648 | | cpustate->r[AVR8_REGIDX_TCCR1A] = newtccr; |
| 868 | m_r[AVR8_REGIDX_TCCR1A] = newtccr; |
| 649 | 869 | |
| 650 | 870 | if(changed & AVR8_TCCR1A_WGM1_10_MASK) |
| 651 | 871 | { |
| 652 | 872 | // TODO |
| 653 | | avr8_update_timer1_waveform_gen_mode(cpustate); |
| 873 | update_timer1_waveform_gen_mode(); |
| 654 | 874 | } |
| 655 | 875 | } |
| 656 | 876 | |
| 657 | | static void avr8_update_timer1_input_noise_canceler(avr8_state *cpustate) |
| 877 | void avr8_device::update_timer1_input_noise_canceler() |
| 658 | 878 | { |
| 659 | 879 | // TODO |
| 660 | 880 | } |
| 661 | 881 | |
| 662 | | static void avr8_update_timer1_input_edge_select(avr8_state *cpustate) |
| 882 | void avr8_device::update_timer1_input_edge_select() |
| 663 | 883 | { |
| 664 | 884 | // TODO |
| 665 | | //verboselog(cpustate->pc, 0, "avr8_update_timer1_input_edge_select: TODO; Clocking edge is %s\n", "test"); |
| 885 | //verboselog(m_pc, 0, "update_timer1_input_edge_select: TODO; Clocking edge is %s\n", "test"); |
| 666 | 886 | } |
| 667 | 887 | |
| 668 | | static void avr8_update_timer1_clock_source(avr8_state *cpustate) |
| 888 | void avr8_device::update_timer1_clock_source() |
| 669 | 889 | { |
| 670 | 890 | switch(AVR8_TIMER1_CLOCK_SELECT) |
| 671 | 891 | { |
| 672 | 892 | case 0: // Counter stopped |
| 673 | | cpustate->timer1_prescale = 0; |
| 893 | m_timer1_prescale = 0; |
| 674 | 894 | break; |
| 675 | 895 | case 1: // Clk/1; no prescaling |
| 676 | | cpustate->timer1_prescale = 1; |
| 896 | m_timer1_prescale = 1; |
| 677 | 897 | break; |
| 678 | 898 | case 2: // Clk/8 |
| 679 | | cpustate->timer1_prescale = 8; |
| 899 | m_timer1_prescale = 8; |
| 680 | 900 | break; |
| 681 | 901 | case 3: // Clk/32 |
| 682 | | cpustate->timer1_prescale = 32; |
| 902 | m_timer1_prescale = 32; |
| 683 | 903 | break; |
| 684 | 904 | case 4: // Clk/64 |
| 685 | | cpustate->timer1_prescale = 64; |
| 905 | m_timer1_prescale = 64; |
| 686 | 906 | break; |
| 687 | 907 | case 5: // Clk/128 |
| 688 | | cpustate->timer1_prescale = 128; |
| 908 | m_timer1_prescale = 128; |
| 689 | 909 | break; |
| 690 | 910 | case 6: // T1 trigger, falling edge |
| 691 | 911 | case 7: // T1 trigger, rising edge |
| 692 | | cpustate->timer1_prescale = 0; |
| 693 | | verboselog(cpustate->pc, 0, "avr8_update_timer1_clock_source: T1 Trigger mode not implemented yet\n"); |
| 912 | m_timer1_prescale = 0; |
| 913 | verboselog(m_pc, 0, "update_timer1_clock_source: T1 Trigger mode not implemented yet\n"); |
| 694 | 914 | break; |
| 695 | 915 | } |
| 696 | 916 | |
| 697 | | if (cpustate->timer1_prescale_count > cpustate->timer1_prescale) |
| 917 | if (m_timer1_prescale_count > m_timer1_prescale) |
| 698 | 918 | { |
| 699 | | cpustate->timer1_prescale_count = cpustate->timer1_prescale - 1; |
| 919 | m_timer1_prescale_count = m_timer1_prescale - 1; |
| 700 | 920 | } |
| 701 | 921 | } |
| 702 | 922 | |
| 703 | | static void avr8_changed_tccr1b(avr8_state *cpustate, UINT8 data) |
| 923 | void avr8_device::changed_tccr1b(UINT8 data) |
| 704 | 924 | { |
| 705 | 925 | UINT8 oldtccr = AVR8_TCCR1B; |
| 706 | 926 | UINT8 newtccr = data; |
| 707 | 927 | UINT8 changed = newtccr ^ oldtccr; |
| 708 | 928 | |
| 709 | | cpustate->r[AVR8_REGIDX_TCCR1B] = newtccr; |
| 929 | m_r[AVR8_REGIDX_TCCR1B] = newtccr; |
| 710 | 930 | |
| 711 | 931 | if(changed & AVR8_TCCR1B_ICNC1_MASK) |
| 712 | 932 | { |
| 713 | 933 | // TODO |
| 714 | | avr8_update_timer1_input_noise_canceler(cpustate); |
| 934 | update_timer1_input_noise_canceler(); |
| 715 | 935 | } |
| 716 | 936 | |
| 717 | 937 | if(changed & AVR8_TCCR1B_ICES1_MASK) |
| 718 | 938 | { |
| 719 | 939 | // TODO |
| 720 | | avr8_update_timer1_input_edge_select(cpustate); |
| 940 | update_timer1_input_edge_select(); |
| 721 | 941 | } |
| 722 | 942 | |
| 723 | 943 | if(changed & AVR8_TCCR1B_WGM1_32_MASK) |
| 724 | 944 | { |
| 725 | 945 | // TODO |
| 726 | | avr8_update_timer1_waveform_gen_mode(cpustate); |
| 946 | update_timer1_waveform_gen_mode(); |
| 727 | 947 | } |
| 728 | 948 | |
| 729 | 949 | if(changed & AVR8_TCCR1B_CS_MASK) |
| 730 | 950 | { |
| 731 | | avr8_update_timer1_clock_source(cpustate); |
| 951 | update_timer1_clock_source(); |
| 732 | 952 | } |
| 733 | 953 | } |
| 734 | 954 | |
| 735 | | static void avr8_update_ocr1(avr8_state *cpustate, UINT16 newval, UINT8 reg) |
| 955 | void avr8_device::update_ocr1(UINT16 newval, UINT8 reg) |
| 736 | 956 | { |
| 737 | | UINT8 *p_reg_h = (reg == AVR8_REG_A) ? &cpustate->r[AVR8_REGIDX_OCR1AH] : &cpustate->r[AVR8_REGIDX_OCR1BH]; |
| 738 | | UINT8 *p_reg_l = (reg == AVR8_REG_A) ? &cpustate->r[AVR8_REGIDX_OCR1AL] : &cpustate->r[AVR8_REGIDX_OCR1BL]; |
| 957 | UINT8 *p_reg_h = (reg == AVR8_REG_A) ? &m_r[AVR8_REGIDX_OCR1AH] : &m_r[AVR8_REGIDX_OCR1BH]; |
| 958 | UINT8 *p_reg_l = (reg == AVR8_REG_A) ? &m_r[AVR8_REGIDX_OCR1AL] : &m_r[AVR8_REGIDX_OCR1BL]; |
| 739 | 959 | *p_reg_h = (UINT8)(newval >> 8); |
| 740 | 960 | *p_reg_l = (UINT8)newval; |
| 741 | 961 | |
| r18789 | r18790 | |
| 744 | 964 | |
| 745 | 965 | // Timer 2 Handling |
| 746 | 966 | |
| 747 | | static void avr8_timer2_tick(avr8_state *cpustate) |
| 967 | void avr8_device::timer2_tick() |
| 748 | 968 | { |
| 749 | | UINT16 count = cpustate->r[AVR8_REGIDX_TCNT2]; |
| 750 | | INT32 wgm2 = ((cpustate->r[AVR8_REGIDX_TCCR2B] & AVR8_TCCR2B_WGM2_2_MASK) >> 1) | |
| 751 | | (cpustate->r[AVR8_REGIDX_TCCR2A] & AVR8_TCCR2A_WGM2_10_MASK); |
| 969 | UINT16 count = m_r[AVR8_REGIDX_TCNT2]; |
| 970 | INT32 wgm2 = ((m_r[AVR8_REGIDX_TCCR2B] & AVR8_TCCR2B_WGM2_2_MASK) >> 1) | |
| 971 | (m_r[AVR8_REGIDX_TCCR2A] & AVR8_TCCR2A_WGM2_10_MASK); |
| 752 | 972 | |
| 753 | 973 | // Cache things in array form to avoid a compare+branch inside a potentially high-frequency timer |
| 754 | | //UINT8 compare_mode[2] = { (cpustate->r[AVR8_REGIDX_TCCR2A] & AVR8_TCCR2A_COM2A_MASK) >> AVR8_TCCR2A_COM2A_SHIFT, |
| 755 | | //(cpustate->r[AVR8_REGIDX_TCCR2A] & AVR8_TCCR2A_COM2B_MASK) >> AVR8_TCCR2A_COM2B_SHIFT }; |
| 756 | | UINT8 ocr2[2] = { cpustate->r[AVR8_REGIDX_OCR2A], cpustate->r[AVR8_REGIDX_OCR2B] }; |
| 974 | //UINT8 compare_mode[2] = { (m_r[AVR8_REGIDX_TCCR2A] & AVR8_TCCR2A_COM2A_MASK) >> AVR8_TCCR2A_COM2A_SHIFT, |
| 975 | //(m_r[AVR8_REGIDX_TCCR2A] & AVR8_TCCR2A_COM2B_MASK) >> AVR8_TCCR2A_COM2B_SHIFT }; |
| 976 | UINT8 ocr2[2] = { m_r[AVR8_REGIDX_OCR2A], m_r[AVR8_REGIDX_OCR2B] }; |
| 757 | 977 | UINT8 ocf2[2] = { (1 << AVR8_TIFR2_OCF2A_SHIFT), (1 << AVR8_TIFR2_OCF2B_SHIFT) }; |
| 758 | | INT32 increment = cpustate->timer2_increment; |
| 978 | INT32 increment = m_timer2_increment; |
| 759 | 979 | |
| 760 | 980 | for(INT32 reg = AVR8_REG_A; reg <= AVR8_REG_B; reg++) |
| 761 | 981 | { |
| r18789 | r18790 | |
| 766 | 986 | { |
| 767 | 987 | if (reg == 0) |
| 768 | 988 | { |
| 769 | | cpustate->r[AVR8_REGIDX_TIFR2] |= AVR8_TIFR2_TOV2_MASK; |
| 989 | m_r[AVR8_REGIDX_TIFR2] |= AVR8_TIFR2_TOV2_MASK; |
| 770 | 990 | count = 0; |
| 771 | 991 | increment = 0; |
| 772 | 992 | } |
| 773 | 993 | |
| 774 | | cpustate->r[AVR8_REGIDX_TIFR2] |= ocf2[reg]; |
| 994 | m_r[AVR8_REGIDX_TIFR2] |= ocf2[reg]; |
| 775 | 995 | } |
| 776 | 996 | else if(count == 0) |
| 777 | 997 | { |
| 778 | 998 | if (reg == 0) |
| 779 | 999 | { |
| 780 | | cpustate->r[AVR8_REGIDX_TIFR2] &= ~AVR8_TIFR2_TOV2_MASK; |
| 1000 | m_r[AVR8_REGIDX_TIFR2] &= ~AVR8_TIFR2_TOV2_MASK; |
| 781 | 1001 | } |
| 782 | 1002 | } |
| 783 | 1003 | break; |
| r18789 | r18790 | |
| 790 | 1010 | switch(compare_mode[reg]) |
| 791 | 1011 | { |
| 792 | 1012 | case 0: |
| 793 | | //verboselog(cpustate->pc, 0, "avr8_update_timer2_compare_mode: Normal port operation (OC2 disconnected)\n"); |
| 1013 | //verboselog(m_pc, 0, "update_timer2_compare_mode: Normal port operation (OC2 disconnected)\n"); |
| 794 | 1014 | break; |
| 795 | 1015 | |
| 796 | 1016 | case 1: |
| r18789 | r18790 | |
| 804 | 1024 | */ |
| 805 | 1025 | } |
| 806 | 1026 | |
| 807 | | cpustate->r[AVR8_REGIDX_TCNT2] = count + increment; |
| 1027 | m_r[AVR8_REGIDX_TCNT2] = count + increment; |
| 808 | 1028 | |
| 809 | | avr8_update_interrupt_internal(cpustate, AVR8_INTIDX_OCF2A); |
| 810 | | avr8_update_interrupt_internal(cpustate, AVR8_INTIDX_OCF2B); |
| 811 | | avr8_update_interrupt_internal(cpustate, AVR8_INTIDX_TOV2); |
| 1029 | update_interrupt(AVR8_INTIDX_OCF2A); |
| 1030 | update_interrupt(AVR8_INTIDX_OCF2B); |
| 1031 | update_interrupt(AVR8_INTIDX_TOV2); |
| 812 | 1032 | } |
| 813 | 1033 | |
| 814 | | static void avr8_update_timer2_waveform_gen_mode(avr8_state *cpustate) |
| 1034 | void avr8_device::update_timer2_waveform_gen_mode() |
| 815 | 1035 | { |
| 816 | | cpustate->timer2_top = 0; |
| 1036 | m_timer2_top = 0; |
| 817 | 1037 | switch(AVR8_WGM2) |
| 818 | 1038 | { |
| 819 | 1039 | case WGM2_NORMAL: |
| 820 | 1040 | case WGM2_PWM_PC: |
| 821 | 1041 | case WGM2_FAST_PWM: |
| 822 | | cpustate->timer2_top = 0x00ff; |
| 1042 | m_timer2_top = 0x00ff; |
| 823 | 1043 | break; |
| 824 | 1044 | |
| 825 | 1045 | case WGM2_CTC_CMP: |
| 826 | 1046 | case WGM2_PWM_PC_CMP: |
| 827 | 1047 | case WGM2_FAST_PWM_CMP: |
| 828 | | cpustate->timer2_top = AVR8_OCR2A; |
| 1048 | m_timer2_top = AVR8_OCR2A; |
| 829 | 1049 | break; |
| 830 | 1050 | |
| 831 | 1051 | default: |
| 832 | | verboselog(cpustate->pc, 0, "avr8_update_timer2_waveform_gen_mode: Unsupported waveform generation type: %d\n", AVR8_WGM2); |
| 1052 | verboselog(m_pc, 0, "update_timer2_waveform_gen_mode: Unsupported waveform generation type: %d\n", AVR8_WGM2); |
| 833 | 1053 | break; |
| 834 | 1054 | } |
| 835 | 1055 | } |
| 836 | 1056 | |
| 837 | | static void avr8_changed_tccr2a(avr8_state *cpustate, UINT8 data) |
| 1057 | void avr8_device::changed_tccr2a(UINT8 data) |
| 838 | 1058 | { |
| 839 | 1059 | UINT8 oldtccr = AVR8_TCCR2A; |
| 840 | 1060 | UINT8 newtccr = data; |
| r18789 | r18790 | |
| 843 | 1063 | if(changed & AVR8_TCCR2A_WGM2_10_MASK) |
| 844 | 1064 | { |
| 845 | 1065 | // TODO |
| 846 | | avr8_update_timer2_waveform_gen_mode(cpustate); |
| 1066 | update_timer2_waveform_gen_mode(); |
| 847 | 1067 | } |
| 848 | 1068 | } |
| 849 | 1069 | |
| 850 | | static void avr8_update_timer2_clock_source(avr8_state *cpustate) |
| 1070 | void avr8_device::update_timer2_clock_source() |
| 851 | 1071 | { |
| 852 | 1072 | switch(AVR8_TIMER2_CLOCK_SELECT) |
| 853 | 1073 | { |
| 854 | 1074 | case 0: // Counter stopped |
| 855 | | cpustate->timer2_prescale = 0; |
| 1075 | m_timer2_prescale = 0; |
| 856 | 1076 | break; |
| 857 | 1077 | case 1: // Clk/1; no prescaling |
| 858 | | cpustate->timer2_prescale = 1; |
| 1078 | m_timer2_prescale = 1; |
| 859 | 1079 | break; |
| 860 | 1080 | case 2: // Clk/8 |
| 861 | | cpustate->timer2_prescale = 8; |
| 1081 | m_timer2_prescale = 8; |
| 862 | 1082 | break; |
| 863 | 1083 | case 3: // Clk/32 |
| 864 | | cpustate->timer2_prescale = 32; |
| 1084 | m_timer2_prescale = 32; |
| 865 | 1085 | break; |
| 866 | 1086 | case 4: // Clk/64 |
| 867 | | cpustate->timer2_prescale = 64; |
| 1087 | m_timer2_prescale = 64; |
| 868 | 1088 | break; |
| 869 | 1089 | case 5: // Clk/128 |
| 870 | | cpustate->timer2_prescale = 128; |
| 1090 | m_timer2_prescale = 128; |
| 871 | 1091 | break; |
| 872 | 1092 | case 6: // Clk/256 |
| 873 | | cpustate->timer2_prescale = 256; |
| 1093 | m_timer2_prescale = 256; |
| 874 | 1094 | break; |
| 875 | 1095 | case 7: // Clk/1024 |
| 876 | | cpustate->timer2_prescale = 1024; |
| 1096 | m_timer2_prescale = 1024; |
| 877 | 1097 | break; |
| 878 | 1098 | } |
| 879 | 1099 | |
| 880 | | if (cpustate->timer2_prescale_count > cpustate->timer2_prescale) |
| 1100 | if (m_timer2_prescale_count > m_timer2_prescale) |
| 881 | 1101 | { |
| 882 | | cpustate->timer2_prescale_count = cpustate->timer2_prescale - 1; |
| 1102 | m_timer2_prescale_count = m_timer2_prescale - 1; |
| 883 | 1103 | } |
| 884 | 1104 | } |
| 885 | 1105 | |
| 886 | | static void avr8_timer2_force_output_compare(avr8_state *cpustate, int reg) |
| 1106 | void avr8_device::timer2_force_output_compare(int reg) |
| 887 | 1107 | { |
| 888 | 1108 | // TODO |
| 889 | | verboselog(cpustate->pc, 0, "avr8_force_output_compare: TODO; should be forcing OC2%c\n", avr8_reg_name[reg]); |
| 1109 | verboselog(m_pc, 0, "force_output_compare: TODO; should be forcing OC2%c\n", avr8_reg_name[reg]); |
| 890 | 1110 | } |
| 891 | 1111 | |
| 892 | | static void avr8_changed_tccr2b(avr8_state *cpustate, UINT8 data) |
| 1112 | void avr8_device::changed_tccr2b(UINT8 data) |
| 893 | 1113 | { |
| 894 | 1114 | UINT8 oldtccr = AVR8_TCCR2B; |
| 895 | 1115 | UINT8 newtccr = data; |
| r18789 | r18790 | |
| 898 | 1118 | if(changed & AVR8_TCCR2B_FOC2A_MASK) |
| 899 | 1119 | { |
| 900 | 1120 | // TODO |
| 901 | | avr8_timer2_force_output_compare(cpustate, AVR8_REG_A); |
| 1121 | timer2_force_output_compare(AVR8_REG_A); |
| 902 | 1122 | } |
| 903 | 1123 | |
| 904 | 1124 | if(changed & AVR8_TCCR2B_FOC2B_MASK) |
| 905 | 1125 | { |
| 906 | 1126 | // TODO |
| 907 | | avr8_timer2_force_output_compare(cpustate, AVR8_REG_B); |
| 1127 | timer2_force_output_compare(AVR8_REG_B); |
| 908 | 1128 | } |
| 909 | 1129 | |
| 910 | 1130 | if(changed & AVR8_TCCR2B_WGM2_2_MASK) |
| 911 | 1131 | { |
| 912 | 1132 | // TODO |
| 913 | | avr8_update_timer2_waveform_gen_mode(cpustate); |
| 1133 | update_timer2_waveform_gen_mode(); |
| 914 | 1134 | } |
| 915 | 1135 | |
| 916 | 1136 | if(changed & AVR8_TCCR2B_CS_MASK) |
| 917 | 1137 | { |
| 918 | | avr8_update_timer2_clock_source(cpustate); |
| 1138 | update_timer2_clock_source(); |
| 919 | 1139 | } |
| 920 | 1140 | } |
| 921 | 1141 | |
| 922 | | static void avr8_update_ocr2(avr8_state *cpustate, UINT8 newval, UINT8 reg) |
| 1142 | void avr8_device::update_ocr2(UINT8 newval, UINT8 reg) |
| 923 | 1143 | { |
| 924 | | cpustate->r[(reg == AVR8_REG_A) ? AVR8_REGIDX_OCR2A : AVR8_REGIDX_OCR2B] = newval; |
| 1144 | m_r[(reg == AVR8_REG_A) ? AVR8_REGIDX_OCR2A : AVR8_REGIDX_OCR2B] = newval; |
| 925 | 1145 | |
| 926 | 1146 | // Nothing needs to be done? All handled in timer callback |
| 927 | 1147 | } |
| 928 | 1148 | |
| 929 | 1149 | /*****************************************************************************/ |
| 930 | 1150 | |
| 931 | | static bool avr8_io_reg_write(avr8_state *cpustate, UINT16 offset, UINT8 data) |
| 1151 | bool avr8_device::io_reg_write(UINT16 offset, UINT8 data) |
| 932 | 1152 | { |
| 933 | 1153 | switch( offset ) |
| 934 | 1154 | { |
| 935 | 1155 | case AVR8_REGIDX_OCR1BH: |
| 936 | | verboselog(cpustate->pc, 0, "AVR8: OCR1BH = %02x\n", data ); |
| 937 | | avr8_update_ocr1(cpustate, (AVR8_OCR1B & 0x00ff) | (data << 8), AVR8_REG_B); |
| 1156 | verboselog(m_pc, 0, "AVR8: OCR1BH = %02x\n", data ); |
| 1157 | update_ocr1((AVR8_OCR1B & 0x00ff) | (data << 8), AVR8_REG_B); |
| 938 | 1158 | return true; |
| 939 | 1159 | |
| 940 | 1160 | case AVR8_REGIDX_OCR1BL: |
| 941 | | verboselog(cpustate->pc, 0, "AVR8: OCR1BL = %02x\n", data ); |
| 942 | | avr8_update_ocr1(cpustate, (AVR8_OCR1B & 0xff00) | data, AVR8_REG_B); |
| 1161 | verboselog(m_pc, 0, "AVR8: OCR1BL = %02x\n", data ); |
| 1162 | update_ocr1((AVR8_OCR1B & 0xff00) | data, AVR8_REG_B); |
| 943 | 1163 | return true; |
| 944 | 1164 | |
| 945 | 1165 | case AVR8_REGIDX_OCR1AH: |
| 946 | | verboselog(cpustate->pc, 0, "AVR8: OCR1AH = %02x\n", data ); |
| 947 | | avr8_update_ocr1(cpustate, (AVR8_OCR1A & 0x00ff) | (data << 8), AVR8_REG_A); |
| 1166 | verboselog(m_pc, 0, "AVR8: OCR1AH = %02x\n", data ); |
| 1167 | update_ocr1((AVR8_OCR1A & 0x00ff) | (data << 8), AVR8_REG_A); |
| 948 | 1168 | return true; |
| 949 | 1169 | |
| 950 | 1170 | case AVR8_REGIDX_OCR1AL: |
| 951 | | verboselog(cpustate->pc, 0, "AVR8: OCR1AL = %02x\n", data ); |
| 952 | | avr8_update_ocr1(cpustate, (AVR8_OCR1A & 0xff00) | data, AVR8_REG_A); |
| 1171 | verboselog(m_pc, 0, "AVR8: OCR1AL = %02x\n", data ); |
| 1172 | update_ocr1((AVR8_OCR1A & 0xff00) | data, AVR8_REG_A); |
| 953 | 1173 | return true; |
| 954 | 1174 | |
| 955 | 1175 | case AVR8_REGIDX_TCCR1B: |
| 956 | | verboselog(cpustate->pc, 0, "AVR8: TCCR1B = %02x\n", data ); |
| 957 | | avr8_changed_tccr1b(cpustate, data); |
| 1176 | verboselog(m_pc, 0, "AVR8: TCCR1B = %02x\n", data ); |
| 1177 | changed_tccr1b(data); |
| 958 | 1178 | return true; |
| 959 | 1179 | |
| 960 | 1180 | case AVR8_REGIDX_TCCR1A: |
| 961 | | verboselog(cpustate->pc, 0, "AVR8: TCCR1A = %02x\n", data ); |
| 962 | | avr8_changed_tccr1a(cpustate, data); |
| 1181 | verboselog(m_pc, 0, "AVR8: TCCR1A = %02x\n", data ); |
| 1182 | changed_tccr1a(data); |
| 963 | 1183 | return true; |
| 964 | 1184 | |
| 965 | 1185 | case AVR8_REGIDX_TIMSK1: |
| 966 | | verboselog(cpustate->pc, 0, "AVR8: TIMSK1 = %02x\n", data ); |
| 967 | | avr8_change_timsk1(cpustate, data); |
| 1186 | verboselog(m_pc, 0, "AVR8: TIMSK1 = %02x\n", data ); |
| 1187 | change_timsk1(data); |
| 968 | 1188 | return true; |
| 969 | 1189 | |
| 970 | 1190 | case AVR8_REGIDX_TIFR1: |
| 971 | | verboselog(cpustate->pc, 0, "AVR8: TIFR1 = %02x\n", data ); |
| 972 | | cpustate->r[AVR8_REGIDX_TIFR1] &= ~(data & AVR8_TIFR1_MASK); |
| 973 | | avr8_update_interrupt_internal(cpustate, AVR8_INTIDX_ICF1); |
| 974 | | avr8_update_interrupt_internal(cpustate, AVR8_INTIDX_OCF1A); |
| 975 | | avr8_update_interrupt_internal(cpustate, AVR8_INTIDX_OCF1B); |
| 976 | | avr8_update_interrupt_internal(cpustate, AVR8_INTIDX_TOV1); |
| 1191 | verboselog(m_pc, 0, "AVR8: TIFR1 = %02x\n", data ); |
| 1192 | m_r[AVR8_REGIDX_TIFR1] &= ~(data & AVR8_TIFR1_MASK); |
| 1193 | update_interrupt(AVR8_INTIDX_ICF1); |
| 1194 | update_interrupt(AVR8_INTIDX_OCF1A); |
| 1195 | update_interrupt(AVR8_INTIDX_OCF1B); |
| 1196 | update_interrupt(AVR8_INTIDX_TOV1); |
| 977 | 1197 | return true; |
| 978 | 1198 | |
| 979 | 1199 | case AVR8_REGIDX_TCCR2B: |
| 980 | | verboselog(cpustate->pc, 0, "AVR8: TCCR2B = %02x\n", data ); |
| 981 | | avr8_changed_tccr2b(cpustate, data); |
| 1200 | verboselog(m_pc, 0, "AVR8: TCCR2B = %02x\n", data ); |
| 1201 | changed_tccr2b(data); |
| 982 | 1202 | return true; |
| 983 | 1203 | |
| 984 | 1204 | case AVR8_REGIDX_TCCR2A: |
| 985 | | verboselog(cpustate->pc, 0, "AVR8: TCCR2A = %02x\n", data ); |
| 986 | | avr8_changed_tccr2a(cpustate, data); |
| 1205 | verboselog(m_pc, 0, "AVR8: TCCR2A = %02x\n", data ); |
| 1206 | changed_tccr2a(data); |
| 987 | 1207 | return true; |
| 988 | 1208 | |
| 989 | 1209 | case AVR8_REGIDX_OCR2A: |
| 990 | | avr8_update_ocr2(cpustate, data, AVR8_REG_A); |
| 1210 | update_ocr2(data, AVR8_REG_A); |
| 991 | 1211 | return true; |
| 992 | 1212 | |
| 993 | 1213 | case AVR8_REGIDX_OCR2B: |
| 994 | | avr8_update_ocr2(cpustate, data, AVR8_REG_B); |
| 1214 | update_ocr2(data, AVR8_REG_B); |
| 995 | 1215 | return true; |
| 996 | 1216 | |
| 997 | 1217 | case AVR8_REGIDX_TCNT2: |
| r18789 | r18790 | |
| 1002 | 1222 | if (data & AVR8_GTCCR_PSRASY_MASK) |
| 1003 | 1223 | { |
| 1004 | 1224 | data &= ~AVR8_GTCCR_PSRASY_MASK; |
| 1005 | | cpustate->timer2_prescale_count = 0; |
| 1225 | m_timer2_prescale_count = 0; |
| 1006 | 1226 | } |
| 1007 | | //verboselog(cpustate->pc, 0, "AVR8: GTCCR = %02x\n", data ); |
| 1227 | //verboselog(m_pc, 0, "AVR8: GTCCR = %02x\n", data ); |
| 1008 | 1228 | // TODO |
| 1009 | 1229 | return true; |
| 1010 | 1230 | |
| 1011 | 1231 | case AVR8_REGIDX_SPL: |
| 1012 | 1232 | case AVR8_REGIDX_SPH: |
| 1013 | | cpustate->r[offset] = data; |
| 1233 | m_r[offset] = data; |
| 1014 | 1234 | return true; |
| 1015 | 1235 | |
| 1016 | 1236 | case AVR8_REGIDX_GPIOR0: |
| 1017 | | verboselog(cpustate->pc, 0, "AVR8: GPIOR0 Write: %02x\n", data); |
| 1018 | | cpustate->r[offset] = data; |
| 1237 | verboselog(m_pc, 0, "AVR8: GPIOR0 Write: %02x\n", data); |
| 1238 | m_r[offset] = data; |
| 1019 | 1239 | return true; |
| 1020 | 1240 | |
| 1021 | 1241 | case AVR8_REGIDX_SREG: |
| 1022 | | cpustate->status = data; |
| 1242 | m_status = data; |
| 1023 | 1243 | return true; |
| 1024 | 1244 | |
| 1245 | case AVR8_REGIDX_PORTB: |
| 1246 | if (m_portb_changed) |
| 1247 | { |
| 1248 | UINT8 changed = m_r[AVR8_REGIDX_PORTB] ^ data; |
| 1249 | (*m_portb_changed)(*this, data, changed); |
| 1250 | m_r[AVR8_REGIDX_PORTB] = data; |
| 1251 | } |
| 1252 | break; |
| 1253 | |
| 1254 | case AVR8_REGIDX_PORTC: |
| 1255 | if (m_portc_changed) |
| 1256 | { |
| 1257 | UINT8 changed = m_r[AVR8_REGIDX_PORTC] ^ data; |
| 1258 | (*m_portc_changed)(*this, data, changed); |
| 1259 | m_r[AVR8_REGIDX_PORTC] = data; |
| 1260 | } |
| 1261 | break; |
| 1262 | |
| 1263 | case AVR8_REGIDX_PORTD: |
| 1264 | if (m_portd_changed) |
| 1265 | { |
| 1266 | UINT8 changed = m_r[AVR8_REGIDX_PORTD] ^ data; |
| 1267 | (*m_portd_changed)(*this, data, changed); |
| 1268 | m_r[AVR8_REGIDX_PORTD] = data; |
| 1269 | } |
| 1270 | break; |
| 1271 | |
| 1025 | 1272 | default: |
| 1026 | 1273 | return false; |
| 1027 | 1274 | } |
| 1028 | 1275 | return false; |
| 1029 | 1276 | } |
| 1030 | 1277 | |
| 1031 | | static bool avr8_io_reg_read(avr8_state *cpustate, UINT16 offset, UINT8 *data) |
| 1278 | bool avr8_device::io_reg_read(UINT16 offset, UINT8 *data) |
| 1032 | 1279 | { |
| 1033 | 1280 | switch( offset ) |
| 1034 | 1281 | { |
| r18789 | r18790 | |
| 1037 | 1284 | case AVR8_REGIDX_TCNT1L: |
| 1038 | 1285 | case AVR8_REGIDX_TCNT1H: |
| 1039 | 1286 | case AVR8_REGIDX_TCNT2: |
| 1040 | | *data = cpustate->r[offset]; |
| 1287 | case AVR8_REGIDX_PORTB: |
| 1288 | case AVR8_REGIDX_PORTC: |
| 1289 | case AVR8_REGIDX_PORTD: |
| 1290 | *data = m_r[offset]; |
| 1041 | 1291 | return true; |
| 1042 | 1292 | |
| 1043 | 1293 | case AVR8_REGIDX_GPIOR0: |
| 1044 | | *data = cpustate->r[offset]; |
| 1045 | | verboselog(cpustate->pc, 0, "AVR8: GPIOR0 Read: %02x\n", *data); |
| 1294 | *data = m_r[offset]; |
| 1295 | verboselog(m_pc, 0, "AVR8: GPIOR0 Read: %02x\n", *data); |
| 1046 | 1296 | return true; |
| 1047 | 1297 | |
| 1048 | 1298 | case AVR8_REGIDX_SREG: |
| 1049 | | *data = cpustate->status; |
| 1299 | *data = m_status; |
| 1050 | 1300 | return true; |
| 1051 | 1301 | |
| 1052 | 1302 | default: |
| r18789 | r18790 | |
| 1056 | 1306 | return false; |
| 1057 | 1307 | } |
| 1058 | 1308 | |
| 1059 | | /*****************************************************************************/ |
| 1060 | 1309 | |
| 1061 | | static CPU_INIT( avr8 ) |
| 1062 | | { |
| 1063 | | avr8_state *cpustate = get_safe_token(device); |
| 1310 | //************************************************************************** |
| 1311 | // CORE EXECUTION LOOP |
| 1312 | //************************************************************************** |
| 1064 | 1313 | |
| 1065 | | cpustate->pc = 0; |
| 1314 | //------------------------------------------------- |
| 1315 | // execute_min_cycles - return minimum number of |
| 1316 | // cycles it takes for one instruction to execute |
| 1317 | //------------------------------------------------- |
| 1066 | 1318 | |
| 1067 | | cpustate->device = device; |
| 1068 | | cpustate->program = &device->space(AS_PROGRAM); |
| 1069 | | cpustate->io = &device->space(AS_IO); |
| 1319 | UINT32 avr8_device::execute_min_cycles() const |
| 1320 | { |
| 1321 | return 1; |
| 1322 | } |
| 1070 | 1323 | |
| 1071 | | cpustate->status = 0; |
| 1072 | | WRITE_IO_8(cpustate, AVR8_REGIDX_SPL, 0); |
| 1073 | | WRITE_IO_8(cpustate, AVR8_REGIDX_SPH, 0); |
| 1074 | 1324 | |
| 1075 | | for (int i = 0; i < 32; i++) |
| 1076 | | { |
| 1077 | | cpustate->r[i] = 0; |
| 1078 | | } |
| 1325 | //------------------------------------------------- |
| 1326 | // execute_max_cycles - return maximum number of |
| 1327 | // cycles it takes for one instruction to execute |
| 1328 | //------------------------------------------------- |
| 1079 | 1329 | |
| 1080 | | cpustate->timer0_top = 0; |
| 1081 | | cpustate->timer0_increment = 1; |
| 1082 | | cpustate->timer0_prescale = 0; |
| 1083 | | cpustate->timer0_prescale_count = 0; |
| 1330 | UINT32 avr8_device::execute_max_cycles() const |
| 1331 | { |
| 1332 | return 4; |
| 1333 | } |
| 1084 | 1334 | |
| 1085 | | cpustate->timer1_top = 0; |
| 1086 | | cpustate->timer1_increment = 1; |
| 1087 | | cpustate->timer1_prescale = 0; |
| 1088 | | cpustate->timer1_prescale_count = 0; |
| 1089 | 1335 | |
| 1090 | | cpustate->timer2_top = 0; |
| 1091 | | cpustate->timer2_increment = 1; |
| 1092 | | cpustate->timer2_prescale = 0; |
| 1093 | | cpustate->timer2_prescale_count = 0; |
| 1336 | //------------------------------------------------- |
| 1337 | // execute_input_lines - return the number of |
| 1338 | // input/interrupt lines |
| 1339 | //------------------------------------------------- |
| 1094 | 1340 | |
| 1095 | | AVR8_TIMSK1 = 0; |
| 1096 | | AVR8_OCR1AH = 0; |
| 1097 | | AVR8_OCR1AL = 0; |
| 1098 | | AVR8_OCR1BH = 0; |
| 1099 | | AVR8_OCR1BL = 0; |
| 1100 | | AVR8_ICR1H = 0; |
| 1101 | | AVR8_ICR1L = 0; |
| 1102 | | AVR8_TCNT1H = 0; |
| 1103 | | AVR8_TCNT1L = 0; |
| 1104 | | AVR8_TCNT2 = 0; |
| 1341 | UINT32 avr8_device::execute_input_lines() const |
| 1342 | { |
| 1343 | return 0; |
| 1344 | } |
| 1105 | 1345 | |
| 1106 | | cpustate->interrupt_pending = false; |
| 1107 | 1346 | |
| 1108 | | cpustate->elapsed_cycles = 0; |
| 1109 | | |
| 1110 | | device->save_item(NAME(cpustate->pc)); |
| 1111 | | } |
| 1112 | | |
| 1113 | | static CPU_EXIT( avr8 ) |
| 1347 | void avr8_device::execute_set_input(int inputnum, int state) |
| 1114 | 1348 | { |
| 1115 | 1349 | } |
| 1116 | 1350 | |
| 1117 | | static CPU_RESET( avr8 ) |
| 1118 | | { |
| 1119 | | avr8_state *cpustate = get_safe_token(device); |
| 1120 | 1351 | |
| 1121 | | cpustate->status = 0; |
| 1122 | | cpustate->pc = 0; |
| 1123 | | cpustate->elapsed_cycles = 0; |
| 1352 | //------------------------------------------------- |
| 1353 | // execute_run - execute a timeslice's worth of |
| 1354 | // opcodes |
| 1355 | //------------------------------------------------- |
| 1124 | 1356 | |
| 1125 | | cpustate->interrupt_pending = false; |
| 1126 | | } |
| 1127 | | |
| 1128 | | static CPU_EXECUTE( avr8 ) |
| 1357 | void avr8_device::execute_run() |
| 1129 | 1358 | { |
| 1130 | 1359 | UINT32 op = 0; |
| 1131 | 1360 | INT32 offs = 0; |
| r18789 | r18790 | |
| 1135 | 1364 | UINT16 pd = 0; |
| 1136 | 1365 | INT16 sd = 0; |
| 1137 | 1366 | INT32 opcycles = 1; |
| 1138 | | //UINT16 pr = 0; |
| 1139 | | avr8_state *cpustate = get_safe_token(device); |
| 1140 | 1367 | |
| 1141 | | while (cpustate->icount > 0) |
| 1368 | while (m_icount > 0) |
| 1142 | 1369 | { |
| 1143 | 1370 | opcycles = 1; |
| 1144 | 1371 | |
| 1145 | | cpustate->pc &= cpustate->addr_mask; |
| 1372 | m_pc &= m_addr_mask; |
| 1146 | 1373 | |
| 1147 | | debugger_instruction_hook(device, cpustate->pc << 1); |
| 1374 | debugger_instruction_hook(this, m_debugger_pc); |
| 1148 | 1375 | |
| 1149 | | op = (UINT32)READ_PRG_16(cpustate, cpustate->pc); |
| 1376 | op = (UINT32)program_read16(m_pc); |
| 1150 | 1377 | |
| 1151 | 1378 | switch(op & 0xf000) |
| 1152 | 1379 | { |
| r18789 | r18790 | |
| 1156 | 1383 | case 0x0000: // NOP |
| 1157 | 1384 | break; |
| 1158 | 1385 | case 0x0100: // MOVW Rd+1:Rd,Rr+1:Rd |
| 1159 | | cpustate->r[(RD4(op) << 1) + 1] = cpustate->r[(RR4(op) << 1) + 1]; |
| 1160 | | cpustate->r[RD4(op) << 1] = cpustate->r[RR4(op) << 1]; |
| 1386 | m_r[(RD4(op) << 1) + 1] = m_r[(RR4(op) << 1) + 1]; |
| 1387 | m_r[RD4(op) << 1] = m_r[RR4(op) << 1]; |
| 1161 | 1388 | break; |
| 1162 | 1389 | case 0x0200: // MULS Rd,Rr |
| 1163 | | sd = (INT8)cpustate->r[16 + RD4(op)] * (INT8)cpustate->r[16 + RR4(op)]; |
| 1164 | | cpustate->r[1] = (sd >> 8) & 0x00ff; |
| 1165 | | cpustate->r[0] = sd & 0x00ff; |
| 1390 | sd = (INT8)m_r[16 + RD4(op)] * (INT8)m_r[16 + RR4(op)]; |
| 1391 | m_r[1] = (sd >> 8) & 0x00ff; |
| 1392 | m_r[0] = sd & 0x00ff; |
| 1166 | 1393 | SREG_W(AVR8_SREG_C, (sd & 0x8000) ? 1 : 0); |
| 1167 | 1394 | SREG_W(AVR8_SREG_Z, (sd == 0) ? 1 : 0); |
| 1168 | 1395 | opcycles = 2; |
| r18789 | r18790 | |
| 1171 | 1398 | switch(MULCONST2(op)) |
| 1172 | 1399 | { |
| 1173 | 1400 | case 0x0000: // MULSU Rd,Rr |
| 1174 | | sd = (INT8)cpustate->r[16 + RD3(op)] * (UINT8)cpustate->r[16 + RR3(op)]; |
| 1175 | | cpustate->r[1] = (sd >> 8) & 0x00ff; |
| 1176 | | cpustate->r[0] = sd & 0x00ff; |
| 1401 | sd = (INT8)m_r[16 + RD3(op)] * (UINT8)m_r[16 + RR3(op)]; |
| 1402 | m_r[1] = (sd >> 8) & 0x00ff; |
| 1403 | m_r[0] = sd & 0x00ff; |
| 1177 | 1404 | SREG_W(AVR8_SREG_C, (sd & 0x8000) ? 1 : 0); |
| 1178 | 1405 | SREG_W(AVR8_SREG_Z, (sd == 0) ? 1 : 0); |
| 1179 | 1406 | opcycles = 2; |
| 1180 | 1407 | break; |
| 1181 | 1408 | case 0x0001: // FMUL Rd,Rr |
| 1182 | | sd = (UINT8)cpustate->r[16 + RD3(op)] * (UINT8)cpustate->r[16 + RR3(op)]; |
| 1409 | sd = (UINT8)m_r[16 + RD3(op)] * (UINT8)m_r[16 + RR3(op)]; |
| 1183 | 1410 | sd <<= 1; |
| 1184 | | cpustate->r[1] = (sd >> 8) & 0x00ff; |
| 1185 | | cpustate->r[0] = sd & 0x00ff; |
| 1411 | m_r[1] = (sd >> 8) & 0x00ff; |
| 1412 | m_r[0] = sd & 0x00ff; |
| 1186 | 1413 | SREG_W(AVR8_SREG_C, (sd & 0x8000) ? 1 : 0); |
| 1187 | 1414 | SREG_W(AVR8_SREG_Z, (sd == 0) ? 1 : 0); |
| 1188 | 1415 | opcycles = 2; |
| 1189 | 1416 | break; |
| 1190 | 1417 | case 0x0002: // FMULS Rd,Rr |
| 1191 | | sd = (INT8)cpustate->r[16 + RD3(op)] * (INT8)cpustate->r[16 + RR3(op)]; |
| 1418 | sd = (INT8)m_r[16 + RD3(op)] * (INT8)m_r[16 + RR3(op)]; |
| 1192 | 1419 | sd <<= 1; |
| 1193 | | cpustate->r[1] = (sd >> 8) & 0x00ff; |
| 1194 | | cpustate->r[0] = sd & 0x00ff; |
| 1420 | m_r[1] = (sd >> 8) & 0x00ff; |
| 1421 | m_r[0] = sd & 0x00ff; |
| 1195 | 1422 | SREG_W(AVR8_SREG_C, (sd & 0x8000) ? 1 : 0); |
| 1196 | 1423 | SREG_W(AVR8_SREG_Z, (sd == 0) ? 1 : 0); |
| 1197 | 1424 | opcycles = 2; |
| 1198 | 1425 | break; |
| 1199 | 1426 | case 0x0003: // FMULSU Rd,Rr |
| 1200 | | sd = (INT8)cpustate->r[16 + RD3(op)] * (UINT8)cpustate->r[16 + RR3(op)]; |
| 1427 | sd = (INT8)m_r[16 + RD3(op)] * (UINT8)m_r[16 + RR3(op)]; |
| 1201 | 1428 | sd <<= 1; |
| 1202 | | cpustate->r[1] = (sd >> 8) & 0x00ff; |
| 1203 | | cpustate->r[0] = sd & 0x00ff; |
| 1429 | m_r[1] = (sd >> 8) & 0x00ff; |
| 1430 | m_r[0] = sd & 0x00ff; |
| 1204 | 1431 | SREG_W(AVR8_SREG_C, (sd & 0x8000) ? 1 : 0); |
| 1205 | 1432 | SREG_W(AVR8_SREG_Z, (sd == 0) ? 1 : 0); |
| 1206 | 1433 | opcycles = 2; |
| r18789 | r18790 | |
| 1211 | 1438 | case 0x0500: |
| 1212 | 1439 | case 0x0600: |
| 1213 | 1440 | case 0x0700: // CPC Rd,Rr |
| 1214 | | rd = cpustate->r[RD5(op)]; |
| 1215 | | rr = cpustate->r[RR5(op)]; |
| 1441 | rd = m_r[RD5(op)]; |
| 1442 | rr = m_r[RR5(op)]; |
| 1216 | 1443 | res = rd - (rr + SREG_R(AVR8_SREG_C)); |
| 1217 | 1444 | SREG_W(AVR8_SREG_H, (NOT(BIT(rd,3)) & BIT(rr,3)) | (BIT(rr,3) & BIT(res,3)) | (BIT(res,3) & NOT(BIT(rd,3)))); |
| 1218 | 1445 | SREG_W(AVR8_SREG_V, (BIT(rd,7) & NOT(BIT(rr,7)) & NOT(BIT(res,7))) | (NOT(BIT(rd,7)) & BIT(rr,7) & BIT(res,7))); |
| r18789 | r18790 | |
| 1225 | 1452 | case 0x0900: |
| 1226 | 1453 | case 0x0a00: |
| 1227 | 1454 | case 0x0b00: // SBC Rd,Rr |
| 1228 | | rd = cpustate->r[RD5(op)]; |
| 1229 | | rr = cpustate->r[RR5(op)]; |
| 1455 | rd = m_r[RD5(op)]; |
| 1456 | rr = m_r[RR5(op)]; |
| 1230 | 1457 | res = rd - (rr + SREG_R(AVR8_SREG_C)); |
| 1231 | | cpustate->r[RD5(op)] = res; |
| 1458 | m_r[RD5(op)] = res; |
| 1232 | 1459 | SREG_W(AVR8_SREG_H, (NOT(BIT(rd,3)) & BIT(rr,3)) | (BIT(rr,3) & BIT(res,3)) | (BIT(res,3) & NOT(BIT(rd,3)))); |
| 1233 | 1460 | SREG_W(AVR8_SREG_V, (BIT(rd,7) & NOT(BIT(rr,7)) & NOT(BIT(res,7))) | (NOT(BIT(rd,7)) & BIT(rr,7) & BIT(res,7))); |
| 1234 | 1461 | SREG_W(AVR8_SREG_N, BIT(res,7)); |
| r18789 | r18790 | |
| 1240 | 1467 | case 0x0d00: |
| 1241 | 1468 | case 0x0e00: |
| 1242 | 1469 | case 0x0f00: // ADD Rd,Rr |
| 1243 | | rd = cpustate->r[RD5(op)]; |
| 1244 | | rr = cpustate->r[RR5(op)]; |
| 1470 | rd = m_r[RD5(op)]; |
| 1471 | rr = m_r[RR5(op)]; |
| 1245 | 1472 | res = rd + rr; |
| 1246 | | cpustate->r[RD5(op)] = res; |
| 1473 | m_r[RD5(op)] = res; |
| 1247 | 1474 | SREG_W(AVR8_SREG_H, (BIT(rd,3) & BIT(rr,3)) | (BIT(rr,3) & NOT(BIT(res,3))) | (NOT(BIT(res,3)) & BIT(rd,3))); |
| 1248 | 1475 | SREG_W(AVR8_SREG_V, (BIT(rd,7) & BIT(rr,7) & NOT(BIT(res,7))) | (NOT(BIT(rd,7)) & NOT(BIT(rr,7)) & BIT(res,7))); |
| 1249 | 1476 | SREG_W(AVR8_SREG_N, BIT(res,7)); |
| r18789 | r18790 | |
| 1258 | 1485 | { |
| 1259 | 1486 | case 0x0000: // CPSR Rd,Rr |
| 1260 | 1487 | //output += sprintf( output, "CPSE R%d, R%d", RD5(op), RR5(op) ); |
| 1261 | | unimplemented_opcode(cpustate, op); |
| 1488 | unimplemented_opcode(op); |
| 1262 | 1489 | break; |
| 1263 | 1490 | case 0x0400: // CP Rd,Rr |
| 1264 | | rd = cpustate->r[RD5(op)]; |
| 1265 | | rr = cpustate->r[RR5(op)]; |
| 1491 | rd = m_r[RD5(op)]; |
| 1492 | rr = m_r[RR5(op)]; |
| 1266 | 1493 | res = rd - rr; |
| 1267 | 1494 | SREG_W(AVR8_SREG_H, (NOT(BIT(rd,3)) & BIT(rr,3)) | (BIT(rr,3) & BIT(res,3)) | (BIT(res,3) & NOT(BIT(rd,3)))); |
| 1268 | 1495 | SREG_W(AVR8_SREG_V, (BIT(rd,7) & NOT(BIT(rr,7)) & NOT(BIT(res,7))) | (NOT(BIT(rd,7)) & BIT(rr,7) & BIT(res,7))); |
| r18789 | r18790 | |
| 1272 | 1499 | SREG_W(AVR8_SREG_C, (NOT(BIT(rd,7)) & BIT(rr,7)) | (BIT(rr,7) & BIT(res,7)) | (BIT(res,7) & NOT(BIT(rd,7)))); |
| 1273 | 1500 | break; |
| 1274 | 1501 | case 0x0800: // SUB Rd,Rr |
| 1275 | | rd = cpustate->r[RD5(op)]; |
| 1276 | | rr = cpustate->r[RR5(op)]; |
| 1502 | rd = m_r[RD5(op)]; |
| 1503 | rr = m_r[RR5(op)]; |
| 1277 | 1504 | res = rd - rr; |
| 1278 | | cpustate->r[RD5(op)] = res; |
| 1505 | m_r[RD5(op)] = res; |
| 1279 | 1506 | SREG_W(AVR8_SREG_H, (NOT(BIT(rd,3)) & BIT(rr,3)) | (BIT(rr,3) & BIT(res,3)) | (BIT(res,3) & NOT(BIT(rd,3)))); |
| 1280 | 1507 | SREG_W(AVR8_SREG_V, (BIT(rd,7) & NOT(BIT(rr,7)) & NOT(BIT(res,7))) | (NOT(BIT(rd,7)) & BIT(rr,7) & BIT(res,7))); |
| 1281 | 1508 | SREG_W(AVR8_SREG_N, BIT(res,7)); |
| r18789 | r18790 | |
| 1284 | 1511 | SREG_W(AVR8_SREG_C, (NOT(BIT(rd,7)) & BIT(rr,7)) | (BIT(rr,7) & BIT(res,7)) | (BIT(res,7) & NOT(BIT(rd,7)))); |
| 1285 | 1512 | break; |
| 1286 | 1513 | case 0x0c00: // ADC Rd,Rr |
| 1287 | | rd = cpustate->r[RD5(op)]; |
| 1288 | | rr = cpustate->r[RR5(op)]; |
| 1514 | rd = m_r[RD5(op)]; |
| 1515 | rr = m_r[RR5(op)]; |
| 1289 | 1516 | res = rd + rr + SREG_R(AVR8_SREG_C); |
| 1290 | | cpustate->r[RD5(op)] = res; |
| 1517 | m_r[RD5(op)] = res; |
| 1291 | 1518 | SREG_W(AVR8_SREG_H, (BIT(rd,3) & BIT(rr,3)) | (BIT(rr,3) & NOT(BIT(res,3))) | (NOT(BIT(res,3)) & BIT(rd,3))); |
| 1292 | 1519 | SREG_W(AVR8_SREG_V, (BIT(rd,7) & BIT(rr,7) & NOT(BIT(res,7))) | (NOT(BIT(rd,7)) & NOT(BIT(rr,7)) & BIT(res,7))); |
| 1293 | 1520 | SREG_W(AVR8_SREG_N, BIT(res,7)); |
| r18789 | r18790 | |
| 1301 | 1528 | switch(op & 0x0c00) |
| 1302 | 1529 | { |
| 1303 | 1530 | case 0x0000: // AND Rd,Rr |
| 1304 | | rd = cpustate->r[RD5(op)]; |
| 1305 | | rr = cpustate->r[RR5(op)]; |
| 1531 | rd = m_r[RD5(op)]; |
| 1532 | rr = m_r[RR5(op)]; |
| 1306 | 1533 | rd &= rr; |
| 1307 | 1534 | SREG_W(AVR8_SREG_V, 0); |
| 1308 | 1535 | SREG_W(AVR8_SREG_N, BIT(rd,7)); |
| 1309 | 1536 | SREG_W(AVR8_SREG_S, SREG_R(AVR8_SREG_N) ^ SREG_R(AVR8_SREG_V)); |
| 1310 | 1537 | SREG_W(AVR8_SREG_Z, (rd == 0) ? 1 : 0); |
| 1311 | | cpustate->r[RD5(op)] = rd; |
| 1538 | m_r[RD5(op)] = rd; |
| 1312 | 1539 | break; |
| 1313 | 1540 | case 0x0400: // EOR Rd,Rr |
| 1314 | | rd = cpustate->r[RD5(op)]; |
| 1315 | | rr = cpustate->r[RR5(op)]; |
| 1541 | rd = m_r[RD5(op)]; |
| 1542 | rr = m_r[RR5(op)]; |
| 1316 | 1543 | rd ^= rr; |
| 1317 | 1544 | SREG_W(AVR8_SREG_V, 0); |
| 1318 | 1545 | SREG_W(AVR8_SREG_N, BIT(rd,7)); |
| 1319 | 1546 | SREG_W(AVR8_SREG_S, SREG_R(AVR8_SREG_N) ^ SREG_R(AVR8_SREG_V)); |
| 1320 | 1547 | SREG_W(AVR8_SREG_Z, (rd == 0) ? 1 : 0); |
| 1321 | | cpustate->r[RD5(op)] = rd; |
| 1548 | m_r[RD5(op)] = rd; |
| 1322 | 1549 | break; |
| 1323 | 1550 | case 0x0800: // OR Rd,Rr |
| 1324 | | rd = cpustate->r[RD5(op)]; |
| 1325 | | rr = cpustate->r[RR5(op)]; |
| 1551 | rd = m_r[RD5(op)]; |
| 1552 | rr = m_r[RR5(op)]; |
| 1326 | 1553 | rd |= rr; |
| 1327 | 1554 | SREG_W(AVR8_SREG_V, 0); |
| 1328 | 1555 | SREG_W(AVR8_SREG_N, BIT(rd,7)); |
| 1329 | 1556 | SREG_W(AVR8_SREG_S, SREG_R(AVR8_SREG_N) ^ SREG_R(AVR8_SREG_V)); |
| 1330 | 1557 | SREG_W(AVR8_SREG_Z, (rd == 0) ? 1 : 0); |
| 1331 | | cpustate->r[RD5(op)] = rd; |
| 1558 | m_r[RD5(op)] = rd; |
| 1332 | 1559 | break; |
| 1333 | 1560 | case 0x0c00: // MOV Rd,Rr |
| 1334 | | cpustate->r[RD5(op)] = cpustate->r[RR5(op)]; |
| 1561 | m_r[RD5(op)] = m_r[RR5(op)]; |
| 1335 | 1562 | break; |
| 1336 | 1563 | } |
| 1337 | 1564 | break; |
| 1338 | 1565 | case 0x3000: // CPI Rd,K |
| 1339 | | rd = cpustate->r[16 + RD4(op)]; |
| 1566 | rd = m_r[16 + RD4(op)]; |
| 1340 | 1567 | rr = KCONST8(op); |
| 1341 | 1568 | res = rd - rr; |
| 1342 | 1569 | SREG_W(AVR8_SREG_H, (NOT(BIT(rd,3)) & BIT(rr,3)) | (BIT(rr,3) & BIT(res,3)) | (BIT(res,3) & NOT(BIT(rd,3)))); |
| r18789 | r18790 | |
| 1347 | 1574 | SREG_W(AVR8_SREG_C, (NOT(BIT(rd,7)) & BIT(rr,7)) | (BIT(rr,7) & BIT(res,7)) | (BIT(res,7) & NOT(BIT(rd,7)))); |
| 1348 | 1575 | break; |
| 1349 | 1576 | case 0x4000: // SBCI Rd,K |
| 1350 | | rd = cpustate->r[16 + RD4(op)]; |
| 1577 | rd = m_r[16 + RD4(op)]; |
| 1351 | 1578 | rr = KCONST8(op); |
| 1352 | 1579 | res = rd - (rr + SREG_R(AVR8_SREG_C)); |
| 1353 | | cpustate->r[16 + RD4(op)] = res; |
| 1580 | m_r[16 + RD4(op)] = res; |
| 1354 | 1581 | SREG_W(AVR8_SREG_H, (NOT(BIT(rd,3)) & BIT(rr,3)) | (BIT(rr,3) & BIT(res,3)) | (BIT(res,3) & NOT(BIT(rd,3)))); |
| 1355 | 1582 | SREG_W(AVR8_SREG_V, (BIT(rd,7) & NOT(BIT(rr,7)) & NOT(BIT(res,7))) | (NOT(BIT(rd,7)) & BIT(rr,7) & BIT(res,7))); |
| 1356 | 1583 | SREG_W(AVR8_SREG_N, BIT(res,7)); |
| r18789 | r18790 | |
| 1359 | 1586 | SREG_W(AVR8_SREG_C, (NOT(BIT(rd,7)) & BIT(rr,7)) | (BIT(rr,7) & BIT(res,7)) | (BIT(res,7) & NOT(BIT(rd,7)))); |
| 1360 | 1587 | break; |
| 1361 | 1588 | case 0x5000: // SUBI Rd,K |
| 1362 | | rd = cpustate->r[16 + RD4(op)]; |
| 1589 | rd = m_r[16 + RD4(op)]; |
| 1363 | 1590 | rr = KCONST8(op); |
| 1364 | 1591 | res = rd - rr; |
| 1365 | | cpustate->r[16 + RD4(op)] = res; |
| 1592 | m_r[16 + RD4(op)] = res; |
| 1366 | 1593 | SREG_W(AVR8_SREG_H, (NOT(BIT(rd,3)) & BIT(rr,3)) | (BIT(rr,3) & BIT(res,3)) | (BIT(res,3) & NOT(BIT(rd,3)))); |
| 1367 | 1594 | SREG_W(AVR8_SREG_V, (BIT(rd,7) & NOT(BIT(rr,7)) & NOT(BIT(res,7))) | (NOT(BIT(rd,7)) & BIT(rr,7) & BIT(res,7))); |
| 1368 | 1595 | SREG_W(AVR8_SREG_N, BIT(res,7)); |
| r18789 | r18790 | |
| 1371 | 1598 | SREG_W(AVR8_SREG_C, (NOT(BIT(rd,7)) & BIT(rr,7)) | (BIT(rr,7) & BIT(res,7)) | (BIT(res,7) & NOT(BIT(rd,7)))); |
| 1372 | 1599 | break; |
| 1373 | 1600 | case 0x6000: // ORI Rd,K |
| 1374 | | rd = cpustate->r[16 + RD4(op)]; |
| 1601 | rd = m_r[16 + RD4(op)]; |
| 1375 | 1602 | rr = KCONST8(op); |
| 1376 | 1603 | rd |= rr; |
| 1377 | 1604 | SREG_W(AVR8_SREG_V, 0); |
| 1378 | 1605 | SREG_W(AVR8_SREG_N, BIT(rd,7)); |
| 1379 | 1606 | SREG_W(AVR8_SREG_S, SREG_R(AVR8_SREG_N) ^ SREG_R(AVR8_SREG_V)); |
| 1380 | 1607 | SREG_W(AVR8_SREG_Z, (rd == 0) ? 1 : 0); |
| 1381 | | cpustate->r[16 + RD4(op)] = rd; |
| 1608 | m_r[16 + RD4(op)] = rd; |
| 1382 | 1609 | break; |
| 1383 | 1610 | case 0x7000: // ANDI Rd,K |
| 1384 | | rd = cpustate->r[16 + RD4(op)]; |
| 1611 | rd = m_r[16 + RD4(op)]; |
| 1385 | 1612 | rr = KCONST8(op); |
| 1386 | 1613 | rd &= rr; |
| 1387 | 1614 | SREG_W(AVR8_SREG_V, 0); |
| 1388 | 1615 | SREG_W(AVR8_SREG_N, BIT(rd,7)); |
| 1389 | 1616 | SREG_W(AVR8_SREG_S, SREG_R(AVR8_SREG_N) ^ SREG_R(AVR8_SREG_V)); |
| 1390 | 1617 | SREG_W(AVR8_SREG_Z, (rd == 0) ? 1 : 0); |
| 1391 | | cpustate->r[16 + RD4(op)] = rd; |
| 1618 | m_r[16 + RD4(op)] = rd; |
| 1392 | 1619 | break; |
| 1393 | 1620 | case 0x8000: |
| 1394 | 1621 | case 0xa000: |
| 1395 | 1622 | switch(op & 0x0208) |
| 1396 | 1623 | { |
| 1397 | 1624 | case 0x0000: // LDD Rd,Z+q |
| 1398 | | cpustate->r[RD5(op)] = READ_IO_8(cpustate, ZREG + QCONST6(op)); |
| 1625 | m_r[RD5(op)] = io_read8(ZREG + QCONST6(op)); |
| 1399 | 1626 | opcycles = 2; |
| 1400 | 1627 | break; |
| 1401 | 1628 | case 0x0008: // LDD Rd,Y+q |
| 1402 | | cpustate->r[RD5(op)] = READ_IO_8(cpustate, YREG + QCONST6(op)); |
| 1629 | m_r[RD5(op)] = io_read8(YREG + QCONST6(op)); |
| 1403 | 1630 | opcycles = 2; |
| 1404 | 1631 | break; |
| 1405 | 1632 | case 0x0200: // STD Z+q,Rr |
| 1406 | | WRITE_IO_8(cpustate, ZREG + QCONST6(op), cpustate->r[RD5(op)]); |
| 1633 | io_write8(ZREG + QCONST6(op), m_r[RD5(op)]); |
| 1407 | 1634 | opcycles = 2; |
| 1408 | 1635 | break; |
| 1409 | 1636 | case 0x0208: // STD Y+q,Rr |
| 1410 | | WRITE_IO_8(cpustate, YREG + QCONST6(op), cpustate->r[RD5(op)]); |
| 1637 | io_write8(YREG + QCONST6(op), m_r[RD5(op)]); |
| 1411 | 1638 | opcycles = 2; |
| 1412 | 1639 | break; |
| 1413 | 1640 | } |
| r18789 | r18790 | |
| 1421 | 1648 | { |
| 1422 | 1649 | case 0x0000: // LDS Rd,k |
| 1423 | 1650 | op <<= 16; |
| 1424 | | cpustate->pc++; |
| 1425 | | op |= READ_PRG_16(cpustate, cpustate->pc); |
| 1426 | | cpustate->r[RD5(op >> 16)] = READ_IO_8(cpustate, op & 0x0000ffff); |
| 1651 | m_pc++; |
| 1652 | op |= program_read16(m_pc); |
| 1653 | m_r[RD5(op >> 16)] = io_read8(op & 0x0000ffff); |
| 1427 | 1654 | opcycles = 2; |
| 1428 | 1655 | break; |
| 1429 | 1656 | case 0x0001: // LD Rd,Z+ |
| 1430 | | unimplemented_opcode(cpustate, op); |
| 1657 | unimplemented_opcode(op); |
| 1431 | 1658 | break; |
| 1432 | 1659 | case 0x0002: // LD Rd,-Z |
| 1433 | 1660 | pd = ZREG; |
| 1434 | 1661 | pd--; |
| 1435 | | cpustate->r[RD5(op)] = READ_IO_8(cpustate, pd); |
| 1436 | | cpustate->r[31] = (pd >> 8) & 0x00ff; |
| 1437 | | cpustate->r[30] = pd & 0x00ff; |
| 1662 | m_r[RD5(op)] = io_read8(pd); |
| 1663 | m_r[31] = (pd >> 8) & 0x00ff; |
| 1664 | m_r[30] = pd & 0x00ff; |
| 1438 | 1665 | opcycles = 2; |
| 1439 | 1666 | break; |
| 1440 | 1667 | case 0x0004: // LPM Rd,Z |
| 1441 | | cpustate->r[RD5(op)] = READ_PRG_8(cpustate, ZREG); |
| 1668 | m_r[RD5(op)] = program_read8(ZREG); |
| 1442 | 1669 | opcycles = 3; |
| 1443 | 1670 | break; |
| 1444 | 1671 | case 0x0005: // LPM Rd,Z+ |
| 1445 | 1672 | pd = ZREG; |
| 1446 | | cpustate->r[RD5(op)] = READ_PRG_8(cpustate, pd); |
| 1673 | m_r[RD5(op)] = program_read8(pd); |
| 1447 | 1674 | pd++; |
| 1448 | | cpustate->r[31] = (pd >> 8) & 0x00ff; |
| 1449 | | cpustate->r[30] = pd & 0x00ff; |
| 1675 | m_r[31] = (pd >> 8) & 0x00ff; |
| 1676 | m_r[30] = pd & 0x00ff; |
| 1450 | 1677 | opcycles = 3; |
| 1451 | 1678 | break; |
| 1452 | 1679 | case 0x0006: // ELPM Rd,Z |
| 1453 | 1680 | //output += sprintf( output, "ELPM R%d, Z", RD5(op) ); |
| 1454 | | unimplemented_opcode(cpustate, op); |
| 1681 | unimplemented_opcode(op); |
| 1455 | 1682 | break; |
| 1456 | 1683 | case 0x0007: // ELPM Rd,Z+ |
| 1457 | 1684 | //output += sprintf( output, "ELPM R%d, Z+", RD5(op) ); |
| 1458 | | unimplemented_opcode(cpustate, op); |
| 1685 | unimplemented_opcode(op); |
| 1459 | 1686 | break; |
| 1460 | 1687 | case 0x0009: // LD Rd,Y+ |
| 1461 | 1688 | pd = YREG; |
| 1462 | | cpustate->r[RD5(op)] = READ_IO_8(cpustate, pd); |
| 1689 | m_r[RD5(op)] = io_read8(pd); |
| 1463 | 1690 | pd++; |
| 1464 | | cpustate->r[29] = (pd >> 8) & 0x00ff; |
| 1465 | | cpustate->r[28] = pd & 0x00ff; |
| 1691 | m_r[29] = (pd >> 8) & 0x00ff; |
| 1692 | m_r[28] = pd & 0x00ff; |
| 1466 | 1693 | opcycles = 2; |
| 1467 | 1694 | break; |
| 1468 | 1695 | case 0x000a: // LD Rd,-Y |
| 1469 | 1696 | pd = YREG; |
| 1470 | 1697 | pd--; |
| 1471 | | cpustate->r[RD5(op)] = READ_IO_8(cpustate, pd); |
| 1472 | | cpustate->r[29] = (pd >> 8) & 0x00ff; |
| 1473 | | cpustate->r[28] = pd & 0x00ff; |
| 1698 | m_r[RD5(op)] = io_read8(pd); |
| 1699 | m_r[29] = (pd >> 8) & 0x00ff; |
| 1700 | m_r[28] = pd & 0x00ff; |
| 1474 | 1701 | opcycles = 2; |
| 1475 | 1702 | break; |
| 1476 | 1703 | case 0x000c: // LD Rd,X |
| 1477 | | cpustate->r[RD5(op)] = READ_IO_8(cpustate, XREG); |
| 1704 | m_r[RD5(op)] = io_read8(XREG); |
| 1478 | 1705 | opcycles = 2; |
| 1479 | 1706 | break; |
| 1480 | 1707 | case 0x000d: // LD Rd,X+ |
| 1481 | 1708 | pd = XREG; |
| 1482 | | cpustate->r[RD5(op)] = READ_IO_8(cpustate, pd); |
| 1709 | m_r[RD5(op)] = io_read8(pd); |
| 1483 | 1710 | pd++; |
| 1484 | | cpustate->r[27] = (pd >> 8) & 0x00ff; |
| 1485 | | cpustate->r[26] = pd & 0x00ff; |
| 1711 | m_r[27] = (pd >> 8) & 0x00ff; |
| 1712 | m_r[26] = pd & 0x00ff; |
| 1486 | 1713 | opcycles = 2; |
| 1487 | 1714 | break; |
| 1488 | 1715 | case 0x000e: // LD Rd,-X |
| 1489 | 1716 | pd = XREG; |
| 1490 | 1717 | pd--; |
| 1491 | | cpustate->r[RD5(op)] = READ_IO_8(cpustate, pd); |
| 1492 | | cpustate->r[27] = (pd >> 8) & 0x00ff; |
| 1493 | | cpustate->r[26] = pd & 0x00ff; |
| 1718 | m_r[RD5(op)] = io_read8(pd); |
| 1719 | m_r[27] = (pd >> 8) & 0x00ff; |
| 1720 | m_r[26] = pd & 0x00ff; |
| 1494 | 1721 | opcycles = 2; |
| 1495 | 1722 | break; |
| 1496 | 1723 | case 0x000f: // POP Rd |
| 1497 | | cpustate->r[RD5(op)] = POP(cpustate); |
| 1724 | m_r[RD5(op)] = pop(); |
| 1498 | 1725 | opcycles = 2; |
| 1499 | 1726 | break; |
| 1500 | 1727 | default: |
| 1501 | | unimplemented_opcode(cpustate, op); |
| 1728 | unimplemented_opcode(op); |
| 1502 | 1729 | //output += sprintf( output, "Undefined (%04x)", op ); |
| 1503 | 1730 | break; |
| 1504 | 1731 | } |
| r18789 | r18790 | |
| 1509 | 1736 | { |
| 1510 | 1737 | case 0x0000: // STS k,Rr |
| 1511 | 1738 | op <<= 16; |
| 1512 | | cpustate->pc++; |
| 1513 | | op |= READ_PRG_16(cpustate, cpustate->pc); |
| 1514 | | WRITE_IO_8(cpustate, op & 0x0000ffff, cpustate->r[RD5(op >> 16)]); |
| 1739 | m_pc++; |
| 1740 | op |= program_read16(m_pc); |
| 1741 | io_write8(op & 0x0000ffff, m_r[RD5(op >> 16)]); |
| 1515 | 1742 | opcycles = 2; |
| 1516 | 1743 | break; |
| 1517 | 1744 | case 0x0001: // ST Z+,Rd |
| 1518 | 1745 | //output += sprintf( output, "ST Z+, R%d", RD5(op) ); |
| 1519 | | unimplemented_opcode(cpustate, op); |
| 1746 | unimplemented_opcode(op); |
| 1520 | 1747 | break; |
| 1521 | 1748 | case 0x0002: // ST -Z,Rd |
| 1522 | 1749 | //output += sprintf( output, "ST -Z , R%d", RD5(op) ); |
| 1523 | | unimplemented_opcode(cpustate, op); |
| 1750 | unimplemented_opcode(op); |
| 1524 | 1751 | break; |
| 1525 | 1752 | case 0x0009: // ST Y+,Rd |
| 1526 | 1753 | pd = YREG; |
| 1527 | | WRITE_IO_8(cpustate, pd, cpustate->r[RD5(op)]); |
| 1754 | io_write8(pd, m_r[RD5(op)]); |
| 1528 | 1755 | pd++; |
| 1529 | | cpustate->r[29] = (pd >> 8) & 0x00ff; |
| 1530 | | cpustate->r[28] = pd & 0x00ff; |
| 1756 | m_r[29] = (pd >> 8) & 0x00ff; |
| 1757 | m_r[28] = pd & 0x00ff; |
| 1531 | 1758 | opcycles = 2; |
| 1532 | 1759 | break; |
| 1533 | | case 0x000a: // ST -Z,Rd |
| 1760 | case 0x000a: // ST -Y,Rd |
| 1534 | 1761 | //output += sprintf( output, "ST -Y , R%d", RD5(op) ); |
| 1535 | | unimplemented_opcode(cpustate, op); |
| 1762 | unimplemented_opcode(op); |
| 1536 | 1763 | break; |
| 1537 | 1764 | case 0x000c: // ST X,Rd |
| 1538 | | WRITE_IO_8(cpustate, XREG, cpustate->r[RD5(op)]); |
| 1765 | io_write8(XREG, m_r[RD5(op)]); |
| 1539 | 1766 | break; |
| 1540 | 1767 | case 0x000d: // ST X+,Rd |
| 1541 | 1768 | pd = XREG; |
| 1542 | | WRITE_IO_8(cpustate, pd, cpustate->r[RD5(op)]); |
| 1769 | io_write8(pd, m_r[RD5(op)]); |
| 1543 | 1770 | pd++; |
| 1544 | | cpustate->r[27] = (pd >> 8) & 0x00ff; |
| 1545 | | cpustate->r[26] = pd & 0x00ff; |
| 1771 | m_r[27] = (pd >> 8) & 0x00ff; |
| 1772 | m_r[26] = pd & 0x00ff; |
| 1546 | 1773 | opcycles = 2; |
| 1547 | 1774 | break; |
| 1548 | 1775 | case 0x000e: // ST -X,Rd |
| 1549 | 1776 | //output += sprintf( output, "ST -X , R%d", RD5(op) ); |
| 1550 | | unimplemented_opcode(cpustate, op); |
| 1777 | unimplemented_opcode(op); |
| 1551 | 1778 | break; |
| 1552 | 1779 | case 0x000f: // PUSH Rd |
| 1553 | | PUSH(cpustate, cpustate->r[RD5(op)]); |
| 1780 | push(m_r[RD5(op)]); |
| 1554 | 1781 | opcycles = 2; |
| 1555 | 1782 | break; |
| 1556 | 1783 | default: |
| 1557 | | unimplemented_opcode(cpustate, op); |
| 1784 | unimplemented_opcode(op); |
| 1558 | 1785 | //output += sprintf( output, "Undefined (%04x)", op ); |
| 1559 | 1786 | break; |
| 1560 | 1787 | } |
| r18789 | r18790 | |
| 1563 | 1790 | switch(op & 0x000f) |
| 1564 | 1791 | { |
| 1565 | 1792 | case 0x0000: // COM Rd |
| 1566 | | rd = cpustate->r[RD5(op)]; |
| 1793 | rd = m_r[RD5(op)]; |
| 1567 | 1794 | res = ~rd; |
| 1568 | 1795 | SREG_W(AVR8_SREG_C, 1); |
| 1569 | 1796 | SREG_W(AVR8_SREG_Z, (res == 0) ? 1 : 0); |
| 1570 | 1797 | SREG_W(AVR8_SREG_N, BIT(res,7)); |
| 1571 | 1798 | SREG_W(AVR8_SREG_V, 0); |
| 1572 | 1799 | SREG_W(AVR8_SREG_S, SREG_R(AVR8_SREG_N) ^ SREG_R(AVR8_SREG_V)); |
| 1573 | | cpustate->r[RD5(op)] = res; |
| 1800 | m_r[RD5(op)] = res; |
| 1574 | 1801 | break; |
| 1575 | 1802 | case 0x0001: // NEG Rd |
| 1576 | | rd = cpustate->r[RD5(op)]; |
| 1803 | rd = m_r[RD5(op)]; |
| 1577 | 1804 | res = 0 - rd; |
| 1578 | 1805 | SREG_W(AVR8_SREG_C, (res == 0) ? 0 : 1); |
| 1579 | 1806 | SREG_W(AVR8_SREG_Z, (res == 0) ? 1 : 0); |
| r18789 | r18790 | |
| 1581 | 1808 | SREG_W(AVR8_SREG_V, (res == 0x80) ? 1 : 0); |
| 1582 | 1809 | SREG_W(AVR8_SREG_S, SREG_R(AVR8_SREG_N) ^ SREG_R(AVR8_SREG_V)); |
| 1583 | 1810 | SREG_W(AVR8_SREG_H, BIT(res,3) | BIT(rd,3)); |
| 1584 | | cpustate->r[RD5(op)] = res; |
| 1811 | m_r[RD5(op)] = res; |
| 1585 | 1812 | break; |
| 1586 | 1813 | case 0x0002: // SWAP Rd |
| 1587 | | rd = cpustate->r[RD5(op)]; |
| 1588 | | cpustate->r[RD5(op)] = (rd >> 4) | (rd << 4); |
| 1814 | rd = m_r[RD5(op)]; |
| 1815 | m_r[RD5(op)] = (rd >> 4) | (rd << 4); |
| 1589 | 1816 | break; |
| 1590 | 1817 | case 0x0003: // INC Rd |
| 1591 | | rd = cpustate->r[RD5(op)]; |
| 1818 | rd = m_r[RD5(op)]; |
| 1592 | 1819 | res = rd + 1; |
| 1593 | 1820 | SREG_W(AVR8_SREG_V, (rd == 0x7f) ? 1 : 0); |
| 1594 | 1821 | SREG_W(AVR8_SREG_N, BIT(res,7)); |
| 1595 | 1822 | SREG_W(AVR8_SREG_S, SREG_R(AVR8_SREG_N) ^ SREG_R(AVR8_SREG_V)); |
| 1596 | 1823 | SREG_W(AVR8_SREG_Z, (res == 0) ? 1 : 0); |
| 1597 | | cpustate->r[RD5(op)] = res; |
| 1824 | m_r[RD5(op)] = res; |
| 1598 | 1825 | break; |
| 1599 | 1826 | case 0x0005: // ASR Rd |
| 1600 | | rd = cpustate->r[RD5(op)]; |
| 1827 | rd = m_r[RD5(op)]; |
| 1601 | 1828 | res = (rd & 0x80) | (rd >> 1); |
| 1602 | 1829 | SREG_W(AVR8_SREG_C, BIT(rd,0)); |
| 1603 | 1830 | SREG_W(AVR8_SREG_Z, (res == 0) ? 1 : 0); |
| 1604 | 1831 | SREG_W(AVR8_SREG_N, BIT(rd,7)); |
| 1605 | 1832 | SREG_W(AVR8_SREG_V, SREG_R(AVR8_SREG_N) ^ SREG_R(AVR8_SREG_C)); |
| 1606 | 1833 | SREG_W(AVR8_SREG_S, SREG_R(AVR8_SREG_N) ^ SREG_R(AVR8_SREG_V)); |
| 1607 | | cpustate->r[RD5(op)] = res; |
| 1834 | m_r[RD5(op)] = res; |
| 1608 | 1835 | break; |
| 1609 | 1836 | case 0x0006: // LSR Rd |
| 1610 | | rd = cpustate->r[RD5(op)]; |
| 1837 | rd = m_r[RD5(op)]; |
| 1611 | 1838 | res = rd >> 1; |
| 1612 | 1839 | SREG_W(AVR8_SREG_C, BIT(rd,0)); |
| 1613 | 1840 | SREG_W(AVR8_SREG_Z, (res == 0) ? 1 :0); |
| 1614 | 1841 | SREG_W(AVR8_SREG_N, 0); |
| 1615 | 1842 | SREG_W(AVR8_SREG_V, SREG_R(AVR8_SREG_N) ^ SREG_R(AVR8_SREG_C)); |
| 1616 | 1843 | SREG_W(AVR8_SREG_S, SREG_R(AVR8_SREG_N) ^ SREG_R(AVR8_SREG_V)); |
| 1617 | | cpustate->r[RD5(op)] = res; |
| 1844 | m_r[RD5(op)] = res; |
| 1618 | 1845 | break; |
| 1619 | 1846 | case 0x0007: // ROR Rd |
| 1620 | | rd = cpustate->r[RD5(op)]; |
| 1847 | rd = m_r[RD5(op)]; |
| 1621 | 1848 | res = rd >> 1; |
| 1622 | 1849 | res |= (SREG_R(AVR8_SREG_C) << 7); |
| 1623 | 1850 | SREG_W(AVR8_SREG_C, BIT(rd,0)); |
| r18789 | r18790 | |
| 1625 | 1852 | SREG_W(AVR8_SREG_N, BIT(res,7)); |
| 1626 | 1853 | SREG_W(AVR8_SREG_V, SREG_R(AVR8_SREG_N) ^ SREG_R(AVR8_SREG_C)); |
| 1627 | 1854 | SREG_W(AVR8_SREG_S, SREG_R(AVR8_SREG_N) ^ SREG_R(AVR8_SREG_V)); |
| 1628 | | cpustate->r[RD5(op)] = res; |
| 1855 | m_r[RD5(op)] = res; |
| 1629 | 1856 | break; |
| 1630 | 1857 | case 0x0008: |
| 1631 | 1858 | switch(op & 0x00f0) |
| r18789 | r18790 | |
| 1656 | 1883 | switch(op & 0x00f0) |
| 1657 | 1884 | { |
| 1658 | 1885 | case 0x0000: // IJMP |
| 1659 | | cpustate->pc = ZREG - 1; |
| 1886 | m_pc = ZREG - 1; |
| 1660 | 1887 | opcycles = 2; |
| 1661 | 1888 | break; |
| 1662 | 1889 | case 0x0010: // EIJMP |
| 1663 | 1890 | //output += sprintf( output, "EIJMP" ); |
| 1664 | | unimplemented_opcode(cpustate, op); |
| 1891 | unimplemented_opcode(op); |
| 1665 | 1892 | break; |
| 1666 | 1893 | default: |
| 1667 | 1894 | //output += sprintf( output, "Undefined (%04x)", op ); |
| 1668 | | unimplemented_opcode(cpustate, op); |
| 1895 | unimplemented_opcode(op); |
| 1669 | 1896 | break; |
| 1670 | 1897 | } |
| 1671 | 1898 | break; |
| 1672 | 1899 | case 0x000a: // DEC Rd |
| 1673 | | rd = cpustate->r[RD5(op)]; |
| 1900 | rd = m_r[RD5(op)]; |
| 1674 | 1901 | res = rd - 1; |
| 1675 | 1902 | SREG_W(AVR8_SREG_V, (rd == 0x7f) ? 1 : 0); |
| 1676 | 1903 | SREG_W(AVR8_SREG_N, BIT(res,7)); |
| 1677 | 1904 | SREG_W(AVR8_SREG_S, SREG_R(AVR8_SREG_N) ^ SREG_R(AVR8_SREG_V)); |
| 1678 | 1905 | SREG_W(AVR8_SREG_Z, (res == 0) ? 1 : 0); |
| 1679 | | cpustate->r[RD5(op)] = res; |
| 1906 | m_r[RD5(op)] = res; |
| 1680 | 1907 | break; |
| 1681 | 1908 | case 0x000c: |
| 1682 | 1909 | case 0x000d: // JMP k |
| 1683 | 1910 | offs = KCONST22(op) << 16; |
| 1684 | | cpustate->pc++; |
| 1685 | | offs |= READ_PRG_16(cpustate, cpustate->pc); |
| 1686 | | cpustate->pc = offs; |
| 1687 | | cpustate->pc--; |
| 1911 | m_pc++; |
| 1912 | offs |= program_read16(m_pc); |
| 1913 | m_pc = offs; |
| 1914 | m_pc--; |
| 1688 | 1915 | opcycles = 3; |
| 1689 | 1916 | break; |
| 1690 | 1917 | case 0x000e: // CALL k |
| 1691 | 1918 | case 0x000f: |
| 1692 | | PUSH(cpustate, ((cpustate->pc + 1) >> 8) & 0x00ff); |
| 1693 | | PUSH(cpustate, (cpustate->pc + 1) & 0x00ff); |
| 1919 | push(((m_pc + 1) >> 8) & 0x00ff); |
| 1920 | push((m_pc + 1) & 0x00ff); |
| 1694 | 1921 | offs = KCONST22(op) << 16; |
| 1695 | | cpustate->pc++; |
| 1696 | | offs |= READ_PRG_16(cpustate, cpustate->pc); |
| 1697 | | cpustate->pc = offs; |
| 1698 | | cpustate->pc--; |
| 1922 | m_pc++; |
| 1923 | offs |= program_read16(m_pc); |
| 1924 | m_pc = offs; |
| 1925 | m_pc--; |
| 1699 | 1926 | opcycles = 4; |
| 1700 | 1927 | break; |
| 1701 | 1928 | default: |
| 1702 | | unimplemented_opcode(cpustate, op); |
| 1929 | unimplemented_opcode(op); |
| 1703 | 1930 | //output += sprintf( output, "Undefined (%04x)", op ); |
| 1704 | 1931 | break; |
| 1705 | 1932 | } |
| r18789 | r18790 | |
| 1708 | 1935 | switch(op & 0x000f) |
| 1709 | 1936 | { |
| 1710 | 1937 | case 0x0000: // COM Rd |
| 1711 | | rd = cpustate->r[RD5(op)]; |
| 1938 | rd = m_r[RD5(op)]; |
| 1712 | 1939 | res = ~rd; |
| 1713 | 1940 | SREG_W(AVR8_SREG_C, 1); |
| 1714 | 1941 | SREG_W(AVR8_SREG_Z, (res == 0) ? 1 : 0); |
| 1715 | 1942 | SREG_W(AVR8_SREG_N, BIT(res,7)); |
| 1716 | 1943 | SREG_W(AVR8_SREG_V, 0); |
| 1717 | 1944 | SREG_W(AVR8_SREG_S, SREG_R(AVR8_SREG_N) ^ SREG_R(AVR8_SREG_V)); |
| 1718 | | cpustate->r[RD5(op)] = res; |
| 1945 | m_r[RD5(op)] = res; |
| 1719 | 1946 | break; |
| 1720 | 1947 | case 0x0001: // NEG Rd |
| 1721 | | rd = cpustate->r[RD5(op)]; |
| 1948 | rd = m_r[RD5(op)]; |
| 1722 | 1949 | res = 0 - rd; |
| 1723 | 1950 | SREG_W(AVR8_SREG_C, (res == 0) ? 0 : 1); |
| 1724 | 1951 | SREG_W(AVR8_SREG_Z, (res == 0) ? 1 : 0); |
| r18789 | r18790 | |
| 1726 | 1953 | SREG_W(AVR8_SREG_V, (res == 0x80) ? 1 : 0); |
| 1727 | 1954 | SREG_W(AVR8_SREG_S, SREG_R(AVR8_SREG_N) ^ SREG_R(AVR8_SREG_V)); |
| 1728 | 1955 | SREG_W(AVR8_SREG_H, BIT(res,3) | BIT(rd,3)); |
| 1729 | | cpustate->r[RD5(op)] = res; |
| 1956 | m_r[RD5(op)] = res; |
| 1730 | 1957 | break; |
| 1731 | 1958 | case 0x0002: // SWAP Rd |
| 1732 | | rd = cpustate->r[RD5(op)]; |
| 1733 | | cpustate->r[RD5(op)] = (rd >> 4) | (rd << 4); |
| 1959 | rd = m_r[RD5(op)]; |
| 1960 | m_r[RD5(op)] = (rd >> 4) | (rd << 4); |
| 1734 | 1961 | break; |
| 1735 | 1962 | case 0x0003: // INC Rd |
| 1736 | | rd = cpustate->r[RD5(op)]; |
| 1963 | rd = m_r[RD5(op)]; |
| 1737 | 1964 | res = rd + 1; |
| 1738 | 1965 | SREG_W(AVR8_SREG_V, (rd == 0x7f) ? 1 : 0); |
| 1739 | 1966 | SREG_W(AVR8_SREG_N, BIT(res,7)); |
| 1740 | 1967 | SREG_W(AVR8_SREG_S, SREG_R(AVR8_SREG_N) ^ SREG_R(AVR8_SREG_V)); |
| 1741 | 1968 | SREG_W(AVR8_SREG_Z, (res == 0) ? 1 : 0); |
| 1742 | | cpustate->r[RD5(op)] = res; |
| 1969 | m_r[RD5(op)] = res; |
| 1743 | 1970 | break; |
| 1744 | 1971 | case 0x0005: // ASR Rd |
| 1745 | | rd = cpustate->r[RD5(op)]; |
| 1972 | rd = m_r[RD5(op)]; |
| 1746 | 1973 | res = (rd & 0x80) | (rd >> 1); |
| 1747 | 1974 | SREG_W(AVR8_SREG_C, BIT(rd,0)); |
| 1748 | 1975 | SREG_W(AVR8_SREG_Z, (res == 0) ? 1 : 0); |
| 1749 | 1976 | SREG_W(AVR8_SREG_N, BIT(rd,7)); |
| 1750 | 1977 | SREG_W(AVR8_SREG_V, SREG_R(AVR8_SREG_N) ^ SREG_R(AVR8_SREG_C)); |
| 1751 | 1978 | SREG_W(AVR8_SREG_S, SREG_R(AVR8_SREG_N) ^ SREG_R(AVR8_SREG_V)); |
| 1752 | | cpustate->r[RD5(op)] = res; |
| 1979 | m_r[RD5(op)] = res; |
| 1753 | 1980 | break; |
| 1754 | 1981 | case 0x0006: // LSR Rd |
| 1755 | | rd = cpustate->r[RD5(op)]; |
| 1982 | rd = m_r[RD5(op)]; |
| 1756 | 1983 | res = rd >> 1; |
| 1757 | 1984 | SREG_W(AVR8_SREG_C, BIT(rd,0)); |
| 1758 | 1985 | SREG_W(AVR8_SREG_Z, (res == 0) ? 1 :0); |
| 1759 | 1986 | SREG_W(AVR8_SREG_N, 0); |
| 1760 | 1987 | SREG_W(AVR8_SREG_V, SREG_R(AVR8_SREG_N) ^ SREG_R(AVR8_SREG_C)); |
| 1761 | 1988 | SREG_W(AVR8_SREG_S, SREG_R(AVR8_SREG_N) ^ SREG_R(AVR8_SREG_V)); |
| 1762 | | cpustate->r[RD5(op)] = res; |
| 1989 | m_r[RD5(op)] = res; |
| 1763 | 1990 | break; |
| 1764 | 1991 | case 0x0007: // ROR Rd |
| 1765 | | rd = cpustate->r[RD5(op)]; |
| 1992 | rd = m_r[RD5(op)]; |
| 1766 | 1993 | res = rd >> 1; |
| 1767 | 1994 | res |= (SREG_R(AVR8_SREG_C) << 7); |
| 1768 | 1995 | SREG_W(AVR8_SREG_C, BIT(rd,0)); |
| r18789 | r18790 | |
| 1770 | 1997 | SREG_W(AVR8_SREG_N, BIT(res,7)); |
| 1771 | 1998 | SREG_W(AVR8_SREG_V, SREG_R(AVR8_SREG_N) ^ SREG_R(AVR8_SREG_C)); |
| 1772 | 1999 | SREG_W(AVR8_SREG_S, SREG_R(AVR8_SREG_N) ^ SREG_R(AVR8_SREG_V)); |
| 1773 | | cpustate->r[RD5(op)] = res; |
| 2000 | m_r[RD5(op)] = res; |
| 1774 | 2001 | break; |
| 1775 | 2002 | case 0x0008: |
| 1776 | 2003 | switch(op & 0x00f0) |
| 1777 | 2004 | { |
| 1778 | 2005 | case 0x0000: // RET |
| 1779 | | cpustate->pc = POP(cpustate); |
| 1780 | | cpustate->pc |= POP(cpustate) << 8; |
| 1781 | | cpustate->pc--; |
| 2006 | m_pc = pop(); |
| 2007 | m_pc |= pop() << 8; |
| 2008 | m_pc--; |
| 1782 | 2009 | opcycles = 4; |
| 1783 | 2010 | break; |
| 1784 | 2011 | case 0x0010: // RETI |
| 1785 | | cpustate->pc = POP(cpustate); |
| 1786 | | cpustate->pc |= POP(cpustate) << 8; |
| 1787 | | //printf("Pop: %04x\n", cpustate->pc); |
| 1788 | | cpustate->pc--; |
| 2012 | m_pc = pop(); |
| 2013 | m_pc |= pop() << 8; |
| 2014 | m_pc--; |
| 1789 | 2015 | SREG_W(AVR8_SREG_I, 1); |
| 1790 | | /*if (cpustate->interrupt_pending) |
| 1791 | | { |
| 1792 | | avr8_poll_interrupt(cpustate); |
| 1793 | | cpustate->interrupt_pending = false; |
| 1794 | | }*/ |
| 1795 | 2016 | opcycles = 4; |
| 1796 | 2017 | break; |
| 1797 | 2018 | case 0x0080: // SLEEP |
| 1798 | 2019 | //output += sprintf( output, "SLEEP" ); |
| 1799 | | unimplemented_opcode(cpustate, op); |
| 2020 | unimplemented_opcode(op); |
| 1800 | 2021 | break; |
| 1801 | 2022 | case 0x0090: // BREAK |
| 1802 | 2023 | //output += sprintf( output, "BREAK" ); |
| 1803 | | unimplemented_opcode(cpustate, op); |
| 2024 | unimplemented_opcode(op); |
| 1804 | 2025 | break; |
| 1805 | 2026 | case 0x00a0: // WDR |
| 1806 | 2027 | //output += sprintf( output, "WDR" ); |
| 1807 | | unimplemented_opcode(cpustate, op); |
| 2028 | unimplemented_opcode(op); |
| 1808 | 2029 | break; |
| 1809 | 2030 | case 0x00c0: // LPM |
| 1810 | | cpustate->r[0] = READ_PRG_8(cpustate, ZREG); |
| 2031 | m_r[0] = program_read8(ZREG); |
| 1811 | 2032 | opcycles = 3; |
| 1812 | 2033 | break; |
| 1813 | 2034 | case 0x00d0: // ELPM |
| 1814 | 2035 | //output += sprintf( output, "ELPM" ); |
| 1815 | | unimplemented_opcode(cpustate, op); |
| 2036 | unimplemented_opcode(op); |
| 1816 | 2037 | break; |
| 1817 | 2038 | case 0x00e0: // SPM |
| 1818 | 2039 | //output += sprintf( output, "SPM" ); |
| 1819 | | unimplemented_opcode(cpustate, op); |
| 2040 | unimplemented_opcode(op); |
| 1820 | 2041 | break; |
| 1821 | 2042 | case 0x00f0: // SPM Z+ |
| 1822 | 2043 | //output += sprintf( output, "SPM Z+" ); |
| 1823 | | unimplemented_opcode(cpustate, op); |
| 2044 | unimplemented_opcode(op); |
| 1824 | 2045 | break; |
| 1825 | 2046 | default: |
| 1826 | | unimplemented_opcode(cpustate, op); |
| 2047 | unimplemented_opcode(op); |
| 1827 | 2048 | //output += sprintf( output, "Undefined (%04x)", op ); |
| 1828 | 2049 | break; |
| 1829 | 2050 | } |
| r18789 | r18790 | |
| 1833 | 2054 | { |
| 1834 | 2055 | case 0x0000: // ICALL |
| 1835 | 2056 | //output += sprintf( output, "ICALL" ); |
| 1836 | | unimplemented_opcode(cpustate, op); |
| 2057 | unimplemented_opcode(op); |
| 1837 | 2058 | break; |
| 1838 | 2059 | case 0x0010: // EICALL |
| 1839 | 2060 | //output += sprintf( output, "EICALL" ); |
| 1840 | | unimplemented_opcode(cpustate, op); |
| 2061 | unimplemented_opcode(op); |
| 1841 | 2062 | break; |
| 1842 | 2063 | default: |
| 1843 | | unimplemented_opcode(cpustate, op); |
| 2064 | unimplemented_opcode(op); |
| 1844 | 2065 | //output += sprintf( output, "Undefined (%04x)", op ); |
| 1845 | 2066 | break; |
| 1846 | 2067 | } |
| 1847 | 2068 | break; |
| 1848 | 2069 | case 0x000a: // DEC Rd |
| 1849 | | rd = cpustate->r[RD5(op)]; |
| 2070 | rd = m_r[RD5(op)]; |
| 1850 | 2071 | res = rd - 1; |
| 1851 | 2072 | SREG_W(AVR8_SREG_V, (rd == 0x7f) ? 1 : 0); |
| 1852 | 2073 | SREG_W(AVR8_SREG_N, BIT(res,7)); |
| 1853 | 2074 | SREG_W(AVR8_SREG_S, SREG_R(AVR8_SREG_N) ^ SREG_R(AVR8_SREG_V)); |
| 1854 | 2075 | SREG_W(AVR8_SREG_Z, (res == 0) ? 1 : 0); |
| 1855 | | cpustate->r[RD5(op)] = res; |
| 2076 | m_r[RD5(op)] = res; |
| 1856 | 2077 | break; |
| 1857 | 2078 | case 0x000c: |
| 1858 | 2079 | case 0x000d: // JMP k |
| r18789 | r18790 | |
| 1861 | 2082 | //op <<= 8; |
| 1862 | 2083 | //op |= oprom[pos++]; |
| 1863 | 2084 | //output += sprintf( output, "JMP 0x%06x", KCONST22(op) ); |
| 1864 | | unimplemented_opcode(cpustate, op); |
| 2085 | unimplemented_opcode(op); |
| 1865 | 2086 | break; |
| 1866 | 2087 | case 0x000e: |
| 1867 | 2088 | case 0x000f: // CALL k |
| r18789 | r18790 | |
| 1870 | 2091 | //op <<= 8; |
| 1871 | 2092 | //op |= oprom[pos++]; |
| 1872 | 2093 | //output += sprintf( output, "CALL 0x%06x", KCONST22(op) ); |
| 1873 | | unimplemented_opcode(cpustate, op); |
| 2094 | unimplemented_opcode(op); |
| 1874 | 2095 | break; |
| 1875 | 2096 | } |
| 1876 | 2097 | break; |
| 1877 | 2098 | case 0x0600: // ADIW Rd+1:Rd,K |
| 1878 | | rd = cpustate->r[24 + (DCONST(op) << 1)]; |
| 1879 | | rr = cpustate->r[25 + (DCONST(op) << 1)]; |
| 2099 | rd = m_r[24 + (DCONST(op) << 1)]; |
| 2100 | rr = m_r[25 + (DCONST(op) << 1)]; |
| 1880 | 2101 | pd = rd; |
| 1881 | 2102 | pd |= rr << 8; |
| 1882 | 2103 | pd += KCONST6(op); |
| r18789 | r18790 | |
| 1885 | 2106 | SREG_W(AVR8_SREG_S, SREG_R(AVR8_SREG_N) ^ SREG_R(AVR8_SREG_V)); |
| 1886 | 2107 | SREG_W(AVR8_SREG_Z, (pd == 0) ? 1 : 0); |
| 1887 | 2108 | SREG_W(AVR8_SREG_C, NOT(BIT(pd,15)) & BIT(rr,7)); |
| 1888 | | cpustate->r[24 + (DCONST(op) << 1)] = pd & 0x00ff; |
| 1889 | | cpustate->r[25 + (DCONST(op) << 1)] = (pd >> 8) & 0x00ff; |
| 2109 | m_r[24 + (DCONST(op) << 1)] = pd & 0x00ff; |
| 2110 | m_r[25 + (DCONST(op) << 1)] = (pd >> 8) & 0x00ff; |
| 1890 | 2111 | opcycles = 2; |
| 1891 | 2112 | break; |
| 1892 | 2113 | case 0x0700: // SBIW Rd+1:Rd,K |
| 1893 | 2114 | //output += sprintf( output, "SBIW R%d:R%d, 0x%02x", 24+(RD2(op) << 1)+1, 24+(RD2(op) << 1), KCONST6(op) ); |
| 1894 | | unimplemented_opcode(cpustate, op); |
| 2115 | unimplemented_opcode(op); |
| 1895 | 2116 | break; |
| 1896 | 2117 | case 0x0800: // CBI A,b |
| 1897 | 2118 | //output += sprintf( output, "CBI 0x%02x, %d", ACONST5(op), RR3(op) ); |
| 1898 | | WRITE_IO_8(cpustate, 32 + ACONST5(op), READ_IO_8(cpustate, 32 + ACONST5(op)) &~ (1 << RR3(op))); |
| 2119 | io_write8(32 + ACONST5(op), io_read8(32 + ACONST5(op)) &~ (1 << RR3(op))); |
| 1899 | 2120 | opcycles = 2; |
| 1900 | 2121 | break; |
| 1901 | 2122 | case 0x0900: // SBIC A,b |
| 1902 | | if(NOT(BIT(READ_IO_8(cpustate, 32 + ACONST5(op)), RR3(op)))) |
| 2123 | if(NOT(BIT(io_read8(32 + ACONST5(op)), RR3(op)))) |
| 1903 | 2124 | { |
| 1904 | | op = (UINT32)READ_PRG_16(cpustate, cpustate->pc + 1); |
| 1905 | | opcycles = avr8_is_long_opcode(op) ? 3 : 2; |
| 1906 | | cpustate->pc += avr8_is_long_opcode(op) ? 2 : 1; |
| 2125 | op = (UINT32)program_read16(m_pc + 1); |
| 2126 | opcycles = is_long_opcode(op) ? 3 : 2; |
| 2127 | m_pc += is_long_opcode(op) ? 2 : 1; |
| 1907 | 2128 | } |
| 1908 | 2129 | break; |
| 1909 | 2130 | case 0x0a00: // SBI A,b |
| 1910 | | WRITE_IO_8(cpustate, 32 + ACONST5(op), READ_IO_8(cpustate, 32 + ACONST5(op)) | (1 << RR3(op))); |
| 2131 | io_write8(32 + ACONST5(op), io_read8(32 + ACONST5(op)) | (1 << RR3(op))); |
| 1911 | 2132 | opcycles = 2; |
| 1912 | 2133 | break; |
| 1913 | 2134 | case 0x0b00: // SBIS A,b |
| 1914 | | if(BIT(READ_IO_8(cpustate, 32 + ACONST5(op)), RR3(op))) |
| 2135 | if(BIT(io_read8(32 + ACONST5(op)), RR3(op))) |
| 1915 | 2136 | { |
| 1916 | | op = (UINT32)READ_PRG_16(cpustate, cpustate->pc + 1); |
| 1917 | | opcycles = avr8_is_long_opcode(op) ? 3 : 2; |
| 1918 | | cpustate->pc += avr8_is_long_opcode(op) ? 2 : 1; |
| 2137 | op = (UINT32)program_read16(m_pc + 1); |
| 2138 | opcycles = is_long_opcode(op) ? 3 : 2; |
| 2139 | m_pc += is_long_opcode(op) ? 2 : 1; |
| 1919 | 2140 | } |
| 1920 | 2141 | break; |
| 1921 | 2142 | case 0x0c00: |
| 1922 | 2143 | case 0x0d00: |
| 1923 | 2144 | case 0x0e00: |
| 1924 | 2145 | case 0x0f00: // MUL Rd,Rr |
| 1925 | | sd = (UINT8)cpustate->r[RD5(op)] * (UINT8)cpustate->r[RR5(op)]; |
| 1926 | | cpustate->r[1] = (sd >> 8) & 0x00ff; |
| 1927 | | cpustate->r[0] = sd & 0x00ff; |
| 2146 | sd = (UINT8)m_r[RD5(op)] * (UINT8)m_r[RR5(op)]; |
| 2147 | m_r[1] = (sd >> 8) & 0x00ff; |
| 2148 | m_r[0] = sd & 0x00ff; |
| 1928 | 2149 | SREG_W(AVR8_SREG_C, (sd & 0x8000) ? 1 : 0); |
| 1929 | 2150 | SREG_W(AVR8_SREG_Z, (sd == 0) ? 1 : 0); |
| 1930 | 2151 | opcycles = 2; |
| r18789 | r18790 | |
| 1934 | 2155 | case 0xb000: |
| 1935 | 2156 | if(op & 0x0800) // OUT A,Rr |
| 1936 | 2157 | { |
| 1937 | | WRITE_IO_8(cpustate, 32 + ACONST6(op), cpustate->r[RD5(op)]); |
| 2158 | io_write8(32 + ACONST6(op), m_r[RD5(op)]); |
| 1938 | 2159 | } |
| 1939 | 2160 | else // IN Rd,A |
| 1940 | 2161 | { |
| 1941 | | cpustate->r[RD5(op)] = READ_IO_8(cpustate, 0x20 + ACONST6(op)); |
| 2162 | m_r[RD5(op)] = io_read8(0x20 + ACONST6(op)); |
| 1942 | 2163 | } |
| 1943 | 2164 | break; |
| 1944 | 2165 | case 0xc000: // RJMP k |
| 1945 | 2166 | offs = (INT32)((op & 0x0800) ? ((op & 0x0fff) | 0xfffff000) : (op & 0x0fff)); |
| 1946 | | cpustate->pc += offs; |
| 2167 | m_pc += offs; |
| 1947 | 2168 | opcycles = 2; |
| 1948 | 2169 | break; |
| 1949 | 2170 | case 0xd000: // RCALL k |
| 1950 | 2171 | offs = (INT32)((op & 0x0800) ? ((op & 0x0fff) | 0xfffff000) : (op & 0x0fff)); |
| 1951 | | PUSH(cpustate, ((cpustate->pc + 1) >> 8) & 0x00ff); |
| 1952 | | PUSH(cpustate, (cpustate->pc + 1) & 0x00ff); |
| 1953 | | cpustate->pc += offs; |
| 2172 | push(((m_pc + 1) >> 8) & 0x00ff); |
| 2173 | push((m_pc + 1) & 0x00ff); |
| 2174 | m_pc += offs; |
| 1954 | 2175 | opcycles = 3; |
| 1955 | 2176 | break; |
| 1956 | 2177 | case 0xe000: // LDI Rd,K |
| 1957 | | cpustate->r[16 + RD4(op)] = KCONST8(op); |
| 2178 | m_r[16 + RD4(op)] = KCONST8(op); |
| 1958 | 2179 | break; |
| 1959 | 2180 | case 0xf000: |
| 1960 | 2181 | switch(op & 0x0c00) |
| r18789 | r18790 | |
| 1967 | 2188 | { |
| 1968 | 2189 | offs |= 0xffffff80; |
| 1969 | 2190 | } |
| 1970 | | cpustate->pc += offs; |
| 2191 | m_pc += offs; |
| 1971 | 2192 | opcycles = 2; |
| 1972 | 2193 | } |
| 1973 | 2194 | break; |
| r18789 | r18790 | |
| 1979 | 2200 | { |
| 1980 | 2201 | offs |= 0xffffff80; |
| 1981 | 2202 | } |
| 1982 | | cpustate->pc += offs; |
| 2203 | m_pc += offs; |
| 1983 | 2204 | opcycles = 2; |
| 1984 | 2205 | } |
| 1985 | 2206 | break; |
| 1986 | 2207 | case 0x0800: |
| 1987 | 2208 | if(op & 0x0200) // BST Rd, b |
| 1988 | 2209 | { |
| 1989 | | SREG_W(AVR8_SREG_T, (BIT(cpustate->r[RD5(op)], RR3(op))) ? 1 : 0); |
| 2210 | SREG_W(AVR8_SREG_T, (BIT(m_r[RD5(op)], RR3(op))) ? 1 : 0); |
| 1990 | 2211 | } |
| 1991 | 2212 | else // BLD Rd, b |
| 1992 | 2213 | { |
| 1993 | 2214 | if(SREG_R(AVR8_SREG_T)) |
| 1994 | 2215 | { |
| 1995 | | cpustate->r[RD5(op)] |= (1 << RR3(op)); |
| 2216 | m_r[RD5(op)] |= (1 << RR3(op)); |
| 1996 | 2217 | } |
| 1997 | 2218 | else |
| 1998 | 2219 | { |
| 1999 | | cpustate->r[RD5(op)] &= ~(1 << RR3(op)); |
| 2220 | m_r[RD5(op)] &= ~(1 << RR3(op)); |
| 2000 | 2221 | } |
| 2001 | 2222 | } |
| 2002 | 2223 | break; |
| 2003 | 2224 | case 0x0c00: |
| 2004 | 2225 | if(op & 0x0200) // SBRS Rd, b |
| 2005 | 2226 | { |
| 2006 | | if(BIT(cpustate->r[RD5(op)], RR3(op))) |
| 2227 | if(BIT(m_r[RD5(op)], RR3(op))) |
| 2007 | 2228 | { |
| 2008 | | op = (UINT32)READ_PRG_16(cpustate, cpustate->pc++); |
| 2009 | | cpustate->pc += avr8_is_long_opcode(op) ? 1 : 0; |
| 2010 | | opcycles = avr8_is_long_opcode(op) ? 3 : 2; |
| 2229 | op = (UINT32)program_read16(m_pc++); |
| 2230 | m_pc += is_long_opcode(op) ? 1 : 0; |
| 2231 | opcycles = is_long_opcode(op) ? 3 : 2; |
| 2011 | 2232 | } |
| 2012 | 2233 | } |
| 2013 | 2234 | else // SBRC Rd, b |
| 2014 | 2235 | { |
| 2015 | | if(NOT(BIT(cpustate->r[RD5(op)], RR3(op)))) |
| 2236 | if(NOT(BIT(m_r[RD5(op)], RR3(op)))) |
| 2016 | 2237 | { |
| 2017 | | op = (UINT32)READ_PRG_16(cpustate, cpustate->pc++); |
| 2018 | | cpustate->pc += avr8_is_long_opcode(op) ? 1 : 0; |
| 2019 | | opcycles = avr8_is_long_opcode(op) ? 3 : 2; |
| 2238 | op = (UINT32)program_read16(m_pc++); |
| 2239 | m_pc += is_long_opcode(op) ? 1 : 0; |
| 2240 | opcycles = is_long_opcode(op) ? 3 : 2; |
| 2020 | 2241 | } |
| 2021 | 2242 | } |
| 2022 | 2243 | break; |
| r18789 | r18790 | |
| 2024 | 2245 | break; |
| 2025 | 2246 | } |
| 2026 | 2247 | |
| 2027 | | cpustate->pc++; |
| 2248 | m_pc++; |
| 2028 | 2249 | |
| 2029 | | cpustate->icount -= opcycles; |
| 2250 | m_debugger_pc = m_pc << 1; |
| 2030 | 2251 | |
| 2031 | | cpustate->elapsed_cycles += opcycles; |
| 2252 | m_icount -= opcycles; |
| 2032 | 2253 | |
| 2033 | | avr8_timer_tick(cpustate, opcycles); |
| 2034 | | } |
| 2035 | | } |
| 2254 | m_elapsed_cycles += opcycles; |
| 2036 | 2255 | |
| 2037 | | /*****************************************************************************/ |
| 2038 | | |
| 2039 | | static CPU_SET_INFO( avr8 ) |
| 2040 | | { |
| 2041 | | avr8_state *cpustate = get_safe_token(device); |
| 2042 | | |
| 2043 | | switch (state) |
| 2044 | | { |
| 2045 | | /* interrupt lines/exceptions */ |
| 2046 | | case CPUINFO_INT_INPUT_STATE + AVR8_INT_RESET: avr8_set_irq_line(cpustate, AVR8_INT_RESET, info->i); break; |
| 2047 | | case CPUINFO_INT_INPUT_STATE + AVR8_INT_INT0: avr8_set_irq_line(cpustate, AVR8_INT_INT0, info->i); break; |
| 2048 | | case CPUINFO_INT_INPUT_STATE + AVR8_INT_INT1: avr8_set_irq_line(cpustate, AVR8_INT_INT1, info->i); break; |
| 2049 | | case CPUINFO_INT_INPUT_STATE + AVR8_INT_PCINT0: avr8_set_irq_line(cpustate, AVR8_INT_PCINT0, info->i); break; |
| 2050 | | case CPUINFO_INT_INPUT_STATE + AVR8_INT_PCINT1: avr8_set_irq_line(cpustate, AVR8_INT_PCINT1, info->i); break; |
| 2051 | | case CPUINFO_INT_INPUT_STATE + AVR8_INT_PCINT2: avr8_set_irq_line(cpustate, AVR8_INT_PCINT2, info->i); break; |
| 2052 | | case CPUINFO_INT_INPUT_STATE + AVR8_INT_WDT: avr8_set_irq_line(cpustate, AVR8_INT_WDT, info->i); break; |
| 2053 | | case CPUINFO_INT_INPUT_STATE + AVR8_INT_T2COMPA: avr8_set_irq_line(cpustate, AVR8_INT_T2COMPA, info->i); break; |
| 2054 | | case CPUINFO_INT_INPUT_STATE + AVR8_INT_T2COMPB: avr8_set_irq_line(cpustate, AVR8_INT_T2COMPB, info->i); break; |
| 2055 | | case CPUINFO_INT_INPUT_STATE + AVR8_INT_T2OVF: avr8_set_irq_line(cpustate, AVR8_INT_T2OVF, info->i); break; |
| 2056 | | case CPUINFO_INT_INPUT_STATE + AVR8_INT_T1CAPT: avr8_set_irq_line(cpustate, AVR8_INT_T1CAPT, info->i); break; |
| 2057 | | case CPUINFO_INT_INPUT_STATE + AVR8_INT_T1COMPA: avr8_set_irq_line(cpustate, AVR8_INT_T1COMPA, info->i); break; |
| 2058 | | case CPUINFO_INT_INPUT_STATE + AVR8_INT_T1COMPB: avr8_set_irq_line(cpustate, AVR8_INT_T1COMPB, info->i); break; |
| 2059 | | case CPUINFO_INT_INPUT_STATE + AVR8_INT_T1OVF: avr8_set_irq_line(cpustate, AVR8_INT_T1OVF, info->i); break; |
| 2060 | | case CPUINFO_INT_INPUT_STATE + AVR8_INT_T0COMPA: avr8_set_irq_line(cpustate, AVR8_INT_T0COMPA, info->i); break; |
| 2061 | | case CPUINFO_INT_INPUT_STATE + AVR8_INT_T0COMPB: avr8_set_irq_line(cpustate, AVR8_INT_T0COMPB, info->i); break; |
| 2062 | | case CPUINFO_INT_INPUT_STATE + AVR8_INT_T0OVF: avr8_set_irq_line(cpustate, AVR8_INT_T0OVF, info->i); break; |
| 2063 | | case CPUINFO_INT_INPUT_STATE + AVR8_INT_SPI_STC: avr8_set_irq_line(cpustate, AVR8_INT_SPI_STC, info->i); break; |
| 2064 | | case CPUINFO_INT_INPUT_STATE + AVR8_INT_USART_RX: avr8_set_irq_line(cpustate, AVR8_INT_USART_RX, info->i); break; |
| 2065 | | case CPUINFO_INT_INPUT_STATE + AVR8_INT_USART_UDRE: avr8_set_irq_line(cpustate, AVR8_INT_USART_UDRE, info->i); break; |
| 2066 | | case CPUINFO_INT_INPUT_STATE + AVR8_INT_USART_TX: avr8_set_irq_line(cpustate, AVR8_INT_USART_TX, info->i); break; |
| 2067 | | case CPUINFO_INT_INPUT_STATE + AVR8_INT_ADC: avr8_set_irq_line(cpustate, AVR8_INT_ADC, info->i); break; |
| 2068 | | case CPUINFO_INT_INPUT_STATE + AVR8_INT_EE_RDY: avr8_set_irq_line(cpustate, AVR8_INT_EE_RDY, info->i); break; |
| 2069 | | case CPUINFO_INT_INPUT_STATE + AVR8_INT_ANALOG_COMP: avr8_set_irq_line(cpustate, AVR8_INT_ANALOG_COMP, info->i); break; |
| 2070 | | case CPUINFO_INT_INPUT_STATE + AVR8_INT_TWI: avr8_set_irq_line(cpustate, AVR8_INT_TWI, info->i); break; |
| 2071 | | case CPUINFO_INT_INPUT_STATE + AVR8_INT_SPM_RDY: avr8_set_irq_line(cpustate, AVR8_INT_SPM_RDY, info->i); break; |
| 2072 | | |
| 2073 | | /* --- the following bits of info are set as 64-bit signed integers --- */ |
| 2074 | | case CPUINFO_INT_PC: /* intentional fallthrough */ |
| 2075 | | case CPUINFO_INT_REGISTER + AVR8_PC: cpustate->pc = info->i; break; |
| 2076 | | case CPUINFO_INT_REGISTER + AVR8_SREG: cpustate->status = info->i; break; |
| 2077 | | case CPUINFO_INT_REGISTER + AVR8_R0: cpustate->r[ 0] = info->i; break; |
| 2078 | | case CPUINFO_INT_REGISTER + AVR8_R1: cpustate->r[ 1] = info->i; break; |
| 2079 | | case CPUINFO_INT_REGISTER + AVR8_R2: cpustate->r[ 2] = info->i; break; |
| 2080 | | case CPUINFO_INT_REGISTER + AVR8_R3: cpustate->r[ 3] = info->i; break; |
| 2081 | | case CPUINFO_INT_REGISTER + AVR8_R4: cpustate->r[ 4] = info->i; break; |
| 2082 | | case CPUINFO_INT_REGISTER + AVR8_R5: cpustate->r[ 5] = info->i; break; |
| 2083 | | case CPUINFO_INT_REGISTER + AVR8_R6: cpustate->r[ 6] = info->i; break; |
| 2084 | | case CPUINFO_INT_REGISTER + AVR8_R7: cpustate->r[ 7] = info->i; break; |
| 2085 | | case CPUINFO_INT_REGISTER + AVR8_R8: cpustate->r[ 8] = info->i; break; |
| 2086 | | case CPUINFO_INT_REGISTER + AVR8_R9: cpustate->r[ 9] = info->i; break; |
| 2087 | | case CPUINFO_INT_REGISTER + AVR8_R10: cpustate->r[10] = info->i; break; |
| 2088 | | case CPUINFO_INT_REGISTER + AVR8_R11: cpustate->r[11] = info->i; break; |
| 2089 | | case CPUINFO_INT_REGISTER + AVR8_R12: cpustate->r[12] = info->i; break; |
| 2090 | | case CPUINFO_INT_REGISTER + AVR8_R13: cpustate->r[13] = info->i; break; |
| 2091 | | case CPUINFO_INT_REGISTER + AVR8_R14: cpustate->r[14] = info->i; break; |
| 2092 | | case CPUINFO_INT_REGISTER + AVR8_R15: cpustate->r[15] = info->i; break; |
| 2093 | | case CPUINFO_INT_REGISTER + AVR8_R16: cpustate->r[16] = info->i; break; |
| 2094 | | case CPUINFO_INT_REGISTER + AVR8_R17: cpustate->r[17] = info->i; break; |
| 2095 | | case CPUINFO_INT_REGISTER + AVR8_R18: cpustate->r[18] = info->i; break; |
| 2096 | | case CPUINFO_INT_REGISTER + AVR8_R19: cpustate->r[19] = info->i; break; |
| 2097 | | case CPUINFO_INT_REGISTER + AVR8_R20: cpustate->r[20] = info->i; break; |
| 2098 | | case CPUINFO_INT_REGISTER + AVR8_R21: cpustate->r[21] = info->i; break; |
| 2099 | | case CPUINFO_INT_REGISTER + AVR8_R22: cpustate->r[22] = info->i; break; |
| 2100 | | case CPUINFO_INT_REGISTER + AVR8_R23: cpustate->r[23] = info->i; break; |
| 2101 | | case CPUINFO_INT_REGISTER + AVR8_R24: cpustate->r[24] = info->i; break; |
| 2102 | | case CPUINFO_INT_REGISTER + AVR8_R25: cpustate->r[25] = info->i; break; |
| 2103 | | case CPUINFO_INT_REGISTER + AVR8_R26: cpustate->r[26] = info->i; break; |
| 2104 | | case CPUINFO_INT_REGISTER + AVR8_R27: cpustate->r[27] = info->i; break; |
| 2105 | | case CPUINFO_INT_REGISTER + AVR8_R28: cpustate->r[28] = info->i; break; |
| 2106 | | case CPUINFO_INT_REGISTER + AVR8_R29: cpustate->r[29] = info->i; break; |
| 2107 | | case CPUINFO_INT_REGISTER + AVR8_R30: cpustate->r[30] = info->i; break; |
| 2108 | | case CPUINFO_INT_REGISTER + AVR8_R31: cpustate->r[31] = info->i; break; |
| 2256 | timer_tick(opcycles); |
| 2109 | 2257 | } |
| 2110 | 2258 | } |
| 2111 | | |
| 2112 | | CPU_GET_INFO( avr8 ) |
| 2113 | | { |
| 2114 | | avr8_state *cpustate = (device != NULL && device->token() != NULL) ? get_safe_token(device) : NULL; |
| 2115 | | |
| 2116 | | switch(state) |
| 2117 | | { |
| 2118 | | /* --- the following bits of info are returned as 64-bit signed integers --- */ |
| 2119 | | case CPUINFO_INT_CONTEXT_SIZE: info->i = sizeof(avr8_state); break; |
| 2120 | | case CPUINFO_INT_INPUT_LINES: info->i = 0; break; |
| 2121 | | case CPUINFO_INT_DEFAULT_IRQ_VECTOR: info->i = 0; break; |
| 2122 | | case CPUINFO_INT_ENDIANNESS: info->i = ENDIANNESS_LITTLE; break; |
| 2123 | | case CPUINFO_INT_CLOCK_MULTIPLIER: info->i = 1; break; |
| 2124 | | case CPUINFO_INT_CLOCK_DIVIDER: info->i = 1; break; |
| 2125 | | case CPUINFO_INT_MIN_INSTRUCTION_BYTES: info->i = 2; break; |
| 2126 | | case CPUINFO_INT_MAX_INSTRUCTION_BYTES: info->i = 4; break; |
| 2127 | | case CPUINFO_INT_MIN_CYCLES: info->i = 1; break; |
| 2128 | | case CPUINFO_INT_MAX_CYCLES: info->i = 4; break; |
| 2129 | | |
| 2130 | | case CPUINFO_INT_DATABUS_WIDTH + AS_PROGRAM: info->i = 8; break; |
| 2131 | | case CPUINFO_INT_ADDRBUS_WIDTH + AS_PROGRAM: info->i = 22; break; |
| 2132 | | case CPUINFO_INT_ADDRBUS_SHIFT + AS_PROGRAM: info->i = 0; break; |
| 2133 | | case CPUINFO_INT_DATABUS_WIDTH + AS_DATA: info->i = 0; break; |
| 2134 | | case CPUINFO_INT_ADDRBUS_WIDTH + AS_DATA: info->i = 0; break; |
| 2135 | | case CPUINFO_INT_ADDRBUS_SHIFT + AS_DATA: info->i = 0; break; |
| 2136 | | case CPUINFO_INT_DATABUS_WIDTH + AS_IO: info->i = 8; break; |
| 2137 | | case CPUINFO_INT_ADDRBUS_WIDTH + AS_IO: info->i = 11; break; |
| 2138 | | case CPUINFO_INT_ADDRBUS_SHIFT + AS_IO: info->i = 0; break; |
| 2139 | | |
| 2140 | | case CPUINFO_INT_PC: /* intentional fallthrough */ |
| 2141 | | case CPUINFO_INT_REGISTER + AVR8_PC: info->i = cpustate->pc << 1; break; |
| 2142 | | case CPUINFO_INT_REGISTER + AVR8_SREG: info->i = cpustate->status; break; |
| 2143 | | |
| 2144 | | /* --- the following bits of info are returned as pointers to data or functions --- */ |
| 2145 | | case CPUINFO_FCT_SET_INFO: info->setinfo = CPU_SET_INFO_NAME(avr8); break; |
| 2146 | | case CPUINFO_FCT_INIT: info->init = CPU_INIT_NAME(avr8); break; |
| 2147 | | case CPUINFO_FCT_RESET: info->reset = CPU_RESET_NAME(avr8); break; |
| 2148 | | case CPUINFO_FCT_EXIT: info->exit = CPU_EXIT_NAME(avr8); break; |
| 2149 | | case CPUINFO_FCT_EXECUTE: info->execute = CPU_EXECUTE_NAME(avr8); break; |
| 2150 | | case CPUINFO_FCT_BURN: info->burn = NULL; break; |
| 2151 | | case CPUINFO_FCT_DISASSEMBLE: info->disassemble = CPU_DISASSEMBLE_NAME(avr8); break; |
| 2152 | | case CPUINFO_PTR_INSTRUCTION_COUNTER: info->icount = &cpustate->icount; break; |
| 2153 | | |
| 2154 | | /* --- the following bits of info are returned as NULL-terminated strings --- */ |
| 2155 | | case CPUINFO_STR_NAME: strcpy(info->s, "Atmel 8-bit AVR"); break; |
| 2156 | | case CPUINFO_STR_FAMILY: strcpy(info->s, "AVR8"); break; |
| 2157 | | case CPUINFO_STR_VERSION: strcpy(info->s, "1.0"); break; |
| 2158 | | case CPUINFO_STR_SOURCE_FILE: strcpy(info->s, __FILE__); break; |
| 2159 | | case CPUINFO_STR_CREDITS: strcpy(info->s, "Copyright Nicola Salmoria and the MAME Team"); break; |
| 2160 | | |
| 2161 | | case CPUINFO_STR_FLAGS: strcpy(info->s, " "); break; |
| 2162 | | |
| 2163 | | case CPUINFO_STR_REGISTER + AVR8_SREG: sprintf(info->s, "SREG: %c%c%c%c%c%c%c%c", (cpustate->status & 0x80) ? 'I' : '-', (cpustate->status & 0x40) ? 'T' : '-', (cpustate->status & 0x20) ? 'H' : '-', (cpustate->status & 0x10) ? 'S' : '-', (cpustate->status & 0x08) ? 'V' : '-', (cpustate->status & 0x04) ? 'N' : '-', (cpustate->status & 0x02) ? 'Z' : '-', (cpustate->status & 0x01) ? 'C' : '-'); break; |
| 2164 | | case CPUINFO_STR_REGISTER + AVR8_R0: sprintf(info->s, "R0: %02x", cpustate->r[ 0] ); break; |
| 2165 | | case CPUINFO_STR_REGISTER + AVR8_R1: sprintf(info->s, "R1: %02x", cpustate->r[ 1] ); break; |
| 2166 | | case CPUINFO_STR_REGISTER + AVR8_R2: sprintf(info->s, "R2: %02x", cpustate->r[ 2] ); break; |
| 2167 | | case CPUINFO_STR_REGISTER + AVR8_R3: sprintf(info->s, "R3: %02x", cpustate->r[ 3] ); break; |
| 2168 | | case CPUINFO_STR_REGISTER + AVR8_R4: sprintf(info->s, "R4: %02x", cpustate->r[ 4] ); break; |
| 2169 | | case CPUINFO_STR_REGISTER + AVR8_R5: sprintf(info->s, "R5: %02x", cpustate->r[ 5] ); break; |
| 2170 | | case CPUINFO_STR_REGISTER + AVR8_R6: sprintf(info->s, "R6: %02x", cpustate->r[ 6] ); break; |
| 2171 | | case CPUINFO_STR_REGISTER + AVR8_R7: sprintf(info->s, "R7: %02x", cpustate->r[ 7] ); break; |
| 2172 | | case CPUINFO_STR_REGISTER + AVR8_R8: sprintf(info->s, "R8: %02x", cpustate->r[ 8] ); break; |
| 2173 | | case CPUINFO_STR_REGISTER + AVR8_R9: sprintf(info->s, "R9: %02x", cpustate->r[ 9] ); break; |
| 2174 | | case CPUINFO_STR_REGISTER + AVR8_R10: sprintf(info->s, "R10: %02x", cpustate->r[10] ); break; |
| 2175 | | case CPUINFO_STR_REGISTER + AVR8_R11: sprintf(info->s, "R11: %02x", cpustate->r[11] ); break; |
| 2176 | | case CPUINFO_STR_REGISTER + AVR8_R12: sprintf(info->s, "R12: %02x", cpustate->r[12] ); break; |
| 2177 | | case CPUINFO_STR_REGISTER + AVR8_R13: sprintf(info->s, "R13: %02x", cpustate->r[13] ); break; |
| 2178 | | case CPUINFO_STR_REGISTER + AVR8_R14: sprintf(info->s, "R14: %02x", cpustate->r[14] ); break; |
| 2179 | | case CPUINFO_STR_REGISTER + AVR8_R15: sprintf(info->s, "R15: %02x", cpustate->r[15] ); break; |
| 2180 | | case CPUINFO_STR_REGISTER + AVR8_R16: sprintf(info->s, "R16: %02x", cpustate->r[16] ); break; |
| 2181 | | case CPUINFO_STR_REGISTER + AVR8_R17: sprintf(info->s, "R17: %02x", cpustate->r[17] ); break; |
| 2182 | | case CPUINFO_STR_REGISTER + AVR8_R18: sprintf(info->s, "R18: %02x", cpustate->r[18] ); break; |
| 2183 | | case CPUINFO_STR_REGISTER + AVR8_R19: sprintf(info->s, "R19: %02x", cpustate->r[19] ); break; |
| 2184 | | case CPUINFO_STR_REGISTER + AVR8_R20: sprintf(info->s, "R20: %02x", cpustate->r[20] ); break; |
| 2185 | | case CPUINFO_STR_REGISTER + AVR8_R21: sprintf(info->s, "R21: %02x", cpustate->r[21] ); break; |
| 2186 | | case CPUINFO_STR_REGISTER + AVR8_R22: sprintf(info->s, "R22: %02x", cpustate->r[22] ); break; |
| 2187 | | case CPUINFO_STR_REGISTER + AVR8_R23: sprintf(info->s, "R23: %02x", cpustate->r[23] ); break; |
| 2188 | | case CPUINFO_STR_REGISTER + AVR8_R24: sprintf(info->s, "R24: %02x", cpustate->r[24] ); break; |
| 2189 | | case CPUINFO_STR_REGISTER + AVR8_R25: sprintf(info->s, "R25: %02x", cpustate->r[25] ); break; |
| 2190 | | case CPUINFO_STR_REGISTER + AVR8_R26: sprintf(info->s, "R26: %02x", cpustate->r[26] ); break; |
| 2191 | | case CPUINFO_STR_REGISTER + AVR8_R27: sprintf(info->s, "R27: %02x", cpustate->r[27] ); break; |
| 2192 | | case CPUINFO_STR_REGISTER + AVR8_R28: sprintf(info->s, "R28: %02x", cpustate->r[28] ); break; |
| 2193 | | case CPUINFO_STR_REGISTER + AVR8_R29: sprintf(info->s, "R29: %02x", cpustate->r[29] ); break; |
| 2194 | | case CPUINFO_STR_REGISTER + AVR8_R30: sprintf(info->s, "R30: %02x", cpustate->r[30] ); break; |
| 2195 | | case CPUINFO_STR_REGISTER + AVR8_R31: sprintf(info->s, "R31: %02x", cpustate->r[31] ); break; |
| 2196 | | case CPUINFO_STR_REGISTER + AVR8_X: sprintf(info->s, "X: %04x", XREG ); break; |
| 2197 | | case CPUINFO_STR_REGISTER + AVR8_Y: sprintf(info->s, "Y: %04x", YREG ); break; |
| 2198 | | case CPUINFO_STR_REGISTER + AVR8_Z: sprintf(info->s, "Z: %04x", ZREG ); break; |
| 2199 | | case CPUINFO_STR_REGISTER + AVR8_SP: sprintf(info->s, "SP: %04x", SPREG ); break; |
| 2200 | | } |
| 2201 | | } |
| 2202 | | |
| 2203 | | static CPU_INIT( atmega88 ) |
| 2204 | | { |
| 2205 | | CPU_INIT_CALL(avr8); |
| 2206 | | avr8_state *cpustate = get_safe_token(device); |
| 2207 | | cpustate->addr_mask = 0x0fff; |
| 2208 | | } |
| 2209 | | |
| 2210 | | static CPU_INIT( atmega644 ) |
| 2211 | | { |
| 2212 | | CPU_INIT_CALL(avr8); |
| 2213 | | avr8_state *cpustate = get_safe_token(device); |
| 2214 | | cpustate->addr_mask = 0xffff; |
| 2215 | | } |
| 2216 | | |
| 2217 | | CPU_GET_INFO( atmega88 ) |
| 2218 | | { |
| 2219 | | switch (state) |
| 2220 | | { |
| 2221 | | /* --- the following bits of info are returned as pointers to functions --- */ |
| 2222 | | case CPUINFO_FCT_INIT: info->init = CPU_INIT_NAME(atmega88); break; |
| 2223 | | |
| 2224 | | /* --- the following bits of info are returned as NULL-terminated strings --- */ |
| 2225 | | case CPUINFO_STR_NAME: strcpy(info->s, "ATmega88"); break; |
| 2226 | | |
| 2227 | | default: CPU_GET_INFO_CALL(avr8); break; |
| 2228 | | } |
| 2229 | | } |
| 2230 | | |
| 2231 | | CPU_GET_INFO( atmega644 ) |
| 2232 | | { |
| 2233 | | switch (state) |
| 2234 | | { |
| 2235 | | /* --- the following bits of info are returned as pointers to functions --- */ |
| 2236 | | case CPUINFO_FCT_INIT: info->init = CPU_INIT_NAME(atmega644); break; |
| 2237 | | |
| 2238 | | /* --- the following bits of info are returned as NULL-terminated strings --- */ |
| 2239 | | case CPUINFO_STR_NAME: strcpy(info->s, "ATmega644"); break; |
| 2240 | | |
| 2241 | | default: CPU_GET_INFO_CALL(avr8); break; |
| 2242 | | } |
| 2243 | | } |
| 2244 | | |
| 2245 | | DEFINE_LEGACY_CPU_DEVICE(ATMEGA88, atmega88); |
| 2246 | | DEFINE_LEGACY_CPU_DEVICE(ATMEGA644, atmega644); |