;-----------------------------------------------------------
;
;	MIDI --> Stepping Motor : July 2002
;
;		for MAF2002 Gun-Min
;
;-----------------------------------------------------------

;##### Port Defines #####
smr	.equ	h'0fffb0
brr	.equ	h'0fffb1
scr	.equ	h'0fffb2
tdr	.equ	h'0fffb3
ssr	.equ	h'0fffb4
rdr	.equ	h'0fffb5
p1ddr	.equ	h'0fffc0
p1dr	.equ	h'0fffc2
p2ddr	.equ	h'0fffc1
p2dr	.equ	h'0fffc3
p3ddr	.equ	h'0fffc4
p3dr	.equ	h'0fffc6
p4ddr	.equ	h'0fffc5
p4dr	.equ	h'0fffc7
p5ddr	.equ	h'0fffc8
p5dr	.equ	h'0fffca
p7dr	.equ	h'0fffce
paddr	.equ	h'0fffd1
padr	.equ	h'0fffd3
pbddr	.equ	h'0fffd4
pbdr	.equ	h'0fffd6
iprb	.equ	h'0ffff8
tstr	.equ	h'0fff60
tsnc	.equ	h'0fff61
tmdr	.equ	h'0fff62
tfcr	.equ	h'0fff63
toer	.equ	h'0fff90
tocr	.equ	h'0fff91
tcr0	.equ	h'0fff64
tior0	.equ	h'0fff65
tier0	.equ	h'0fff66
tsr0	.equ	h'0fff67
tcnt0	.equ	h'0fff68
gra0	.equ	h'0fff6a

;##### Vector Defines #####
	.section vector,data,locate=h'000000
	.data.l	start
	.org	h'000060
	.data.l	int_timer0
	.org	h'0000d0
	.data.l	int_rx_error
	.data.l	int_rx_full

;##### Work RAM Data Defines #####
	.section ram,data,locate=h'0fef10
timer1	.res.w	1
timer2	.res.w	1
timer3	.res.w	1
timer4	.res.w	1
timer5	.res.w	1
timer6	.res.w	1
timer7	.res.w	1
timer8	.res.w	1
timer9	.res.w	1
wait1	.res.w	1
wait2	.res.w	1
tx_top	.res.w	1
tx_end	.res.w	1
rx_top	.res.w	1
rx_end	.res.w	1
rsb	.res.b	1
channel	.res.b	1
dcb	.res.b	1
keyno	.res.b	1
data	.res.b	1
counter	.res.b	1
led	.res.b	1
old	.res.b	1
new	.res.b	1
flag	.res.b	1
pbdata	.res.b	1
nowdata	.res.b	1
olddata	.res.b	1
phase	.res.b	1
status	.res.b	1
on_bit	.res.b	1
current	.res.b	1
target	.res.b	1
	.org	h'0ff400
rx_fifo	.res.b	1024

;***** Reset --> Initialize --> Main Loop *****
	.section program,code,locate=h'001000
start:
	mov.l	#h'0fff0f,er7		; stack pointer set
	mov.l	#h'0fef10,er2
	mov.w	#h'0fe0,r1
	mov.b	#0,r0l
_ram_clear:
	mov.b	r0l,@er2
	inc.l	#1,er2
	dec.w	#1,r1
	bne	_ram_clear
	mov.b	#b'00100011,r0l
	mov.b	r0l,@tcr0		; Timer0 init : 2MHz clock
	bclr	#0,@tsr0		; Clear IMFA
	bset	#0,@tier0		; timer INT set
	mov.w	#2000,r0		; 1msec INT
	mov.w	r0,@gra0
	jsr	@sci0_init		; SCI initialize
	mov.b	#b'11111111,r0l
	mov.b	r0l,@p1ddr		; set : Port[1] all output
	mov.b	r0l,@p2ddr		; set : Port[2] all output
	mov.b	r0l,@pbddr		; set : Port[B] all output
	mov.b	#b'00000000,r0l
	mov.b	r0l,@p3ddr		; set : Port[3] all input
	mov.b	r0l,@paddr		; set : Port[A] all input
	mov.b	r0l,@p4dr
	mov.b	r0l,@p5dr
	mov.b	#b'00000011,r0l
	mov.b	r0l,@pbdata
	mov.b	r0l,@pbdr
	mov.b	#b'00000000,r0l
	mov.b	r0l,@p1dr		; motor off
	mov.b	r0l,@p2dr		; LED off
	jsr	@wait_500msec
	mov.b	#b'01110000,r0l		; tx/rx start !
	mov.b	r0l,@scr
	bset	#0,@tstr		; timer start !
	andc.b	#b'01111111,ccr		; interrupt enable
loop:
	jsr	@timer_check
	jsr	@rx_midi_check
	jmp	@loop

;***** SCI init / MIDI Transmit Routines *****
sci0_init:
	mov.b	#b'00000000,r0l
	mov.b	r0l,@scr
	mov.b	#b'00000000,r0l
	mov.b	r0l,@smr
	mov.b	#15,r0l
	mov.b	r0l,@brr
	mov.w	#500,r0
_sci0_wait:
	dec.w	#1,r0
	bne	_sci0_wait
	mov.b	@ssr,r0l		; (dummy read)
	mov.b	#0,r0l
	mov.b	r0l,@ssr
	mov.b	#b'00001000,r0l
	mov.b	r0l,@iprb		; SCI0-int priority UP !
	rts

;***** Timer / Counter Routines *****
wait_500msec:
	mov.l	#500,er1
_wait_1:
	jsr	@wait_1msec
	sub.l	#1,er1
	bne	_wait_1
	rts
wait_1msec:
	mov.l	#2048,er2
_wait_2:
	sub.l	#1,er2
	bne	_wait_2
	rts

int_timer0:
	push.w	r0
	mov.b	#1,r0l
	mov.b	r0l,@flag
	btst	#0,@tsr0
	bclr	#0,@tsr0		; Clear IMFA
	pop.w	r0
	rte
timer_check:
	mov.b	@flag,r0l
	cmp.b	#0,r0l
	bne	_timer_event
	rts
_timer_event:
	mov.b	#0,r0l
	mov.b	r0l,@flag
	jsr	@led_check
	jsr	@motor_1msec
	jsr	@release
	rts
release:
	mov.w	@timer6,r0
	cmp.w	#0,r0
	bne	_rel_1
	rts
_rel_1:
	dec.w	#1,r0
	mov.w	r0,@timer6
	cmp.w	#0,r0
	beq	_rel_2
	rts
_rel_2:
	mov.b	#b'00000000,r0l
	mov.b	r0l,@p1dr
	rts

motor_1msec:
	mov.w	@timer4,r0
	inc.w	#1,r0
	mov.w	r0,@timer4
	cmp.w	#45,r0			; speed (msec/step)
	beq	waiter
	rts
waiter:
	mov.w	#0,r0
	mov.w	r0,@timer4
	mov.b	@status,r0l
	cmp.b	#0,r0l
	bne	_motor_go
	rts
_motor_go:
	dec.b	r0l
	mov.b	r0l,@status
	cmp.b	#0,r0l
	bne	_motor_next
	mov.w	#2500,r0		; Release Timer (msec)
	mov.w	r0,@timer6
_motor_next:
	mov.b	@phase,r0l
	btst.b	#7,r0l
	bne	normal
reverse:
	inc.b	r0l
	and.b	#b'00000011,r0l
	mov.b	r0l,@phase
_mixmix:
	cmp.b	#0,r0l
	beq	_n_ph0
	cmp.b	#1,r0l
	beq	_n_ph1
	cmp.b	#2,r0l
	beq	_n_ph2
	cmp.b	#3,r0l
	beq	_n_ph3
_n_ph0:
	mov.b	#b'10011001,r0l
	mov.b	r0l,@p1dr
	rts
_n_ph1:
	mov.b	#b'00110011,r0l
	mov.b	r0l,@p1dr
	rts
_n_ph2:
	mov.b	#b'01100110,r0l
	mov.b	r0l,@p1dr
	rts
_n_ph3:
	mov.b	#b'11001100,r0l
	mov.b	r0l,@p1dr
	rts
normal:
	dec.b	r0l
	and.b	#b'00000011,r0l
	mov.b	r0l,r2l
	or.b	#b'10000000,r0l
	mov.b	r0l,@phase
	mov.b	r2l,r0l
	bra	_mixmix
led_check:
	mov.w	@timer1,r0
	inc.w	#1,r0
	mov.w	r0,@timer1
	cmp.w	#1000,r0
	beq	t1000msec
	rts
t1000msec:
	mov.w	#0,r0
	mov.w	r0,@timer1
	mov.w	@timer2,r0
	inc.w	#1,r0
	mov.w	r0,@timer2
	mov.b	@pbdata,r1l
	btst.b	#0,r0l
	beq	_led_on
	or.b	#b'10000000,r1l
	bra	_led_mix
_led_on:
	and.b	#b'01111111,r1l
_led_mix:
	mov.b	r1l,@pbdata
	mov.b	r1l,@pbdr
	rts

;***** Rx Interrupt / MIDI Receive Routines *****
int_rx_error:
	bclr	#5,@ssr
	bclr	#4,@ssr
	rte
int_rx_full:
	push.w	r0
	push.l	er5
	btst	#6,@ssr
	bclr	#6,@ssr
	mov.w	@rx_top,r5
	mov.w	#0,e5
	mov.b	@rdr,r0l
	mov.b	r0l,@(rx_fifo,er5)
	inc.w	#1,r5
	bclr	#2,r5h
	mov.w	r5,@rx_top
	pop.l	er5
	pop.w	r0
	rte
rx_midi_check:
	mov.w	@rx_top,r1
	mov.w	@rx_end,r5
	cmp.w	r1,r5
	bne	_rx_exist
	rts
_rx_exist:
	mov.w	#0,e5
	mov.b	@(rx_fifo,er5),r0h	; received data = [r0h]
	inc.w	#1,r5
	bclr	#2,r5h
	mov.w	r5,@rx_end
	btst	#7,r0h
	beq	running
	mov.b	r0h,r0l
	and.b	#b'11111000,r0l
	cmp.b	#b'11111000,r0l
	bne	_lower_f8
	rts
_lower_f8:
	and.b	#b'11110000,r0l
	cmp.b	#b'11110000,r0l
	bne	_lower_f0
	mov.b	#0,r0l
	mov.b	r0l,@rsb
	rts
_lower_f0
	mov.b	r0h,r0l
	and.b	#b'00001111,r0l
	mov.b	r0l,@channel
	mov.b	r0h,r0l
	and.b	#b'11110000,r0l
	mov.b	r0l,@rsb
	mov.b	#0,r0l
	mov.b	r0l,@dcb
	rts
running:
	mov.b	@rsb,r0l
	bne	_normal
	rts
_normal:
	cmp.b	#b'11000000,r0l
	beq	_2byte
	cmp.b	#b'11010000,r0l
	beq	_2byte
	mov.b	@dcb,r1l
	bne	_3byte
	inc.b	r1l
	mov.b	r1l,@dcb
	mov.b	r0h,@keyno
	rts
_2byte:
	rts
_3byte:
	mov.b	#0,r1h
	mov.b	r1h,@dcb
	mov.b	r0h,@data
	mov.b	@rsb,r0l
	cmp.b	#h'a0,r0l		; A* event ?
	beq	_hit_01
	rts
_hit_01:
	mov.b	#13,r0l
	mov.b	@channel,r1l
	cmp.b	r1l,r0l
	beq	_hit_02			; AD ?
	rts
_hit_02:
	mov.b	@keyno,r1l
	cmp.b	#0,r1l
	beq	_hit_03
	cmp.b	#1,r1l
	beq	_hit_04
	rts
_hit_03:
	mov.b	@data,r0l
	xor.b	#b'11111111,r0l
	or.b	r1l,r0l
	mov.b	r0l,@p2dr
	mov.b	@data,r0l
	mov.b	r0l,@status
	mov.b	@phase,r0l
	bset.b	#7,r0l
	mov.b	r0l,@phase
	rts
_hit_04:
	mov.b	@data,r0l
	xor.b	#b'11111111,r0l
	or.b	r1l,r0l
	mov.b	r0l,@p2dr
	mov.b	@data,r0l
	mov.b	r0l,@status
	mov.b	@phase,r0l
	bclr.b	#7,r0l
	mov.b	r0l,@phase
	rts

	.end