moved IRQ service handler for PSC3 interrupt to the BaS ISR dispatcher
This commit is contained in:
@@ -185,27 +185,27 @@
|
||||
.equ MCD_TT_FLAGS_RL, 0x1
|
||||
.equ MCD_TT_FLAGS_SP, 0x4
|
||||
.equ DMA_ALWAYS, 0
|
||||
//---------------------------------------------------
|
||||
/*********************************************************************
|
||||
*
|
||||
* General Purpose Timers (GPT)
|
||||
*
|
||||
*********************************************************************/
|
||||
|
||||
/*
|
||||
*
|
||||
* General Purpose Timers (GPT)
|
||||
*
|
||||
*/
|
||||
|
||||
/* Register read/write macros */
|
||||
#define MCF_GPT0_GMS __MBAR+0x800
|
||||
|
||||
/*********************************************************************
|
||||
*
|
||||
* Slice Timers (SLT)
|
||||
*
|
||||
*********************************************************************/
|
||||
/*
|
||||
*
|
||||
* Slice Timers (SLT)
|
||||
*
|
||||
*/
|
||||
|
||||
#define MCF_SLT0_SCNT __MBAR+0x908
|
||||
|
||||
/**********************************************************/
|
||||
// macros
|
||||
/**********************************************************/
|
||||
/*
|
||||
* macros
|
||||
*/
|
||||
.altmacro
|
||||
.macro irq vector,int_mask,clr_int
|
||||
//move.w #0x2700,sr // disable interrupt
|
||||
@@ -292,7 +292,7 @@ init_vec_loop:
|
||||
move.l a1,0x11c(a0)
|
||||
|
||||
// install PSC vectors (used for PIC communication on the FireBee)
|
||||
lea handler_psc3(pc),a1
|
||||
lea _lowlevel_isr_handler(pc),a1
|
||||
// PSC3 interrupt source = 32
|
||||
move.l a1,(INT_SOURCE_PSC3 + 64) * 4(a0)
|
||||
|
||||
@@ -817,41 +817,6 @@ irq7:
|
||||
move.l (sp)+,a0
|
||||
rts // Forward to the Access Error handler
|
||||
|
||||
/*
|
||||
* psc3 com PIC MCF
|
||||
*/
|
||||
handler_psc3:
|
||||
move.w #0x2700,sr // disable interrupt
|
||||
lea -20(a7),a7
|
||||
movem.l d0-d2/a0/a3,(a7)
|
||||
lea MCF_PSC3_PSCRB_8BIT,a3
|
||||
move.b (a3),d1
|
||||
cmp.b #2,d1 // anforderung rtc daten?
|
||||
bne psc3_fertig
|
||||
|
||||
lea MCF_PSC0_PSCTB_8BIT,a0 // ++ vr
|
||||
mchar move.l,'\P,'\I,'C,' ,(a0)
|
||||
mchar move.l,'I,'N,'T,'\ ,(a0)
|
||||
mchar move.l,'R,'T,'C,'!,(a0)
|
||||
mchar move.l,0x0d,0x0a,0,0,(a0)
|
||||
|
||||
lea 0xffff8961,a0
|
||||
lea MCF_PSC3_PSCTB_8BIT,a3
|
||||
clr.l d1
|
||||
moveq #64,d2
|
||||
move.b #0x82,(a3) // header: rtcd mcf->pic
|
||||
loop_sr2:
|
||||
move.b d1,(a0)
|
||||
move.b 2(a0),d0
|
||||
move.b d0,(a3)
|
||||
addq.l #1,d1
|
||||
cmp.b d1,d2
|
||||
bne loop_sr2
|
||||
psc3_fertig:
|
||||
movem.l (a7),d0-d2/a0/a3 // restore saved registers
|
||||
lea 20(a7),a7
|
||||
RTE
|
||||
|
||||
/*
|
||||
* general purpose timer 0 (GPT0): video change, later also others. GPT0 is used as
|
||||
* input trigger. It is connected to the TIN0 signal of the FPGA and triggers everytime
|
||||
@@ -996,17 +961,17 @@ video_chg_end:
|
||||
|
||||
_lowlevel_isr_handler:
|
||||
move.w #0x2700,sr
|
||||
lea -5 * 4(sp),sp // make room for
|
||||
movem.l d0-d1/a0-a2,(sp) // gcc scratch registers and save them,
|
||||
link a6,#-4 * 4 // make room for
|
||||
movem.l d0-d1/a0-a1,(sp) // gcc scratch registers and save them,
|
||||
// other registers will be handled by gcc itself
|
||||
|
||||
move.w 5 * 4(sp),d0 // fetch vector number from stack
|
||||
move.w 4(a6),d0 // fetch vector number from stack
|
||||
lsr.l #2,d0 // move it in place
|
||||
andi.l #0x000000ff,d0 // mask it out
|
||||
andi.l #0xff,d0 // mask it out
|
||||
move.l d0,-(sp) // push it
|
||||
jsr _isr_execute_handler // call the C handler
|
||||
addq.l #4,sp // adjust stack
|
||||
|
||||
movem.l (sp),d0-d1/a0-a2 // restore registers
|
||||
lea 5 * 4(sp),sp
|
||||
movem.l (sp),d0-d1/a0-a1 // restore registers
|
||||
unlk a6
|
||||
rte
|
||||
|
||||
@@ -209,7 +209,7 @@ bool isr_execute_handler(int vector)
|
||||
/*
|
||||
* PIC interrupt handler for Firebee
|
||||
*/
|
||||
void pic_interrupt_handler(void)
|
||||
int pic_interrupt_handler(void *arg1, void *arg2)
|
||||
{
|
||||
uint8_t rcv_byte;
|
||||
|
||||
@@ -229,6 +229,7 @@ void pic_interrupt_handler(void)
|
||||
MCF_PSC3_PSCTB_8BIT = *rtc_data;
|
||||
} while (index++ < 64);
|
||||
}
|
||||
return 1;
|
||||
}
|
||||
|
||||
extern int32_t video_sbt;
|
||||
|
||||
Reference in New Issue
Block a user