102 lines
2.3 KiB
NASM
102 lines
2.3 KiB
NASM
|
/**
|
||
|
|
* Pinephone Keyboard Firmware
|
||
|
|
*
|
||
|
|
* Copyright (C) 2021 Ondřej Jirman <megi@xff.cz>
|
||
|
|
*
|
||
|
|
* This program is free software: you can redistribute it and/or modify
|
||
|
|
* it under the terms of the GNU General Public License as published by
|
||
|
|
* the Free Software Foundation, either version 3 of the License, or
|
||
|
|
* (at your option) any later version.
|
||
|
|
*
|
||
|
|
* This program is distributed in the hope that it will be useful,
|
||
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||
|
|
* GNU General Public License for more details.
|
||
|
|
*
|
||
|
|
* You should have received a copy of the GNU General Public License
|
||
|
|
* along with this program. If not, see <http://www.gnu.org/licenses/>.
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include "em85f684a.h"
|
||
|
|
|
||
|
|
.area RSEG (ABS,DATA)
|
||
|
|
.org 0x0000
|
||
|
|
ar0 = 0x00
|
||
|
|
psw0 = 0xd0
|
||
|
|
|
||
|
|
.macro irq_user irq
|
||
|
|
. = (ivct_start + irq * 8 + 3)
|
||
|
|
ljmp (irq * 8 + 0x4003)
|
||
|
|
.ds 5
|
||
|
|
.endm
|
||
|
|
|
||
|
|
.macro irq_ignore irq
|
||
|
|
. = (ivct_start + irq * 8 + 3)
|
||
|
|
reti
|
||
|
|
.ds 7
|
||
|
|
.endm
|
||
|
|
|
||
|
|
.macro irq_stock irq, name
|
||
|
|
. = (ivct_start + irq * 8 + 3)
|
||
|
|
push psw0
|
||
|
|
push ar0
|
||
|
|
mov r0, #_stock_flag
|
||
|
|
ajmp name
|
||
|
|
.endm
|
||
|
|
|
||
|
|
.macro irq_stock_fwd irq, name
|
||
|
|
name'_fwd:
|
||
|
|
cjne @r0, #1, 001$
|
||
|
|
pop ar0
|
||
|
|
pop psw0
|
||
|
|
ljmp name
|
||
|
|
001$:
|
||
|
|
pop ar0
|
||
|
|
pop psw0
|
||
|
|
ljmp (irq * 8 + 0x4003)
|
||
|
|
.endm
|
||
|
|
|
||
|
|
.module ivect
|
||
|
|
.area IVECT (REL)
|
||
|
|
|
||
|
|
ivct_start = .
|
||
|
|
|
||
|
|
ljmp __sdcc_gsinit_startup
|
||
|
|
|
||
|
|
irq_ignore 5
|
||
|
|
irq_ignore 9
|
||
|
|
irq_ignore 13
|
||
|
|
irq_ignore 19
|
||
|
|
irq_ignore 21
|
||
|
|
irq_ignore 22
|
||
|
|
irq_ignore 25
|
||
|
|
irq_ignore 26
|
||
|
|
irq_ignore 27
|
||
|
|
|
||
|
|
irq_user IRQ_EINT0
|
||
|
|
irq_user IRQ_TIMER0
|
||
|
|
irq_user IRQ_EINT1
|
||
|
|
irq_stock IRQ_TIMER1, _timer1_interrupt_fwd
|
||
|
|
irq_user IRQ_UART0
|
||
|
|
irq_stock IRQ_PINCHANGE, _pinchange_interrupt_fwd
|
||
|
|
irq_user IRQ_LVD
|
||
|
|
irq_user IRQ_SYSTEMHOLD
|
||
|
|
irq_user IRQ_INT2_3
|
||
|
|
irq_user IRQ_SPI
|
||
|
|
irq_user IRQ_PWMD
|
||
|
|
irq_user IRQ_PWME
|
||
|
|
irq_user IRQ_PWMF
|
||
|
|
irq_user IRQ_TIMER3
|
||
|
|
irq_user IRQ_PWMA
|
||
|
|
irq_user IRQ_USB
|
||
|
|
irq_stock IRQ_USB _usb_interrupt_fwd
|
||
|
|
irq_user IRQ_I2CA
|
||
|
|
irq_user IRQ_PWMB
|
||
|
|
irq_user IRQ_PWMC
|
||
|
|
irq_stock IRQ_I2CB _i2c_b_interrupt_fwd
|
||
|
|
|
||
|
|
irq_stock_fwd IRQ_TIMER1, _timer1_interrupt
|
||
|
|
irq_stock_fwd IRQ_PINCHANGE, _pinchange_interrupt
|
||
|
|
irq_stock_fwd IRQ_I2CB, _i2c_b_interrupt
|
||
|
|
irq_stock_fwd IRQ_USB, _usb_interrupt
|