;------------------------------------------------------
;- motor-on.asm  (c) Juan Gonzalez. Marzo 2004
;------------------------------------------------------
; Ejemplo de activacion de los motores 1 y 2
; El sentido de giro depende de como se hayan conectado
; los cables.
;------------------------------------------------------
; El motor 1 se controla con los bits PTC1 y PTC2, y el
; motor 2 con los bits PTC3 y PT4
;
; La "tabla de verdad" es como la siguiente:
;   PTC2 PTC1 motor1
;   ---------------------
;     0    0   Parado
;     0    1   Un sentido
;     1    0   Otro sentido
;     1    1   NO USAR
;
;   PTC4 PTC3 motor2
;   ---------------------
;     0    0   Parado
;     0    1   Un sentido
;     1    0   Otro sentido
;     1    1   NO USAR
;
;------------------------------------------------------
; Licencia GPL
;------------------------------------------------------

;-- Incluir los registros del 6808
$include 'gpregs.inc'

;-- Incluir mapa de memoria de la GPBOT
$include 'gpmap.inc'

	;-- Zona de codigo
	org RomStart

main:
	;-- Inicializar la pila
	ldhx #InitStk
	txs

	;-- Deshabilitar el COP
	bset 0,CONFIG1

   	; Configurar pines PTC1,PTC2,PTC3 y PTC4 para salida
	lda	#$1E
	sta	DDRC

    ;-- Activar el motor 1 y 2
	lda	#$0A
	sta	PORTC

	;-- Bucle infinito
inf:	BRA inf

;---------------------------------------
;- Zona de vectores de interrupcion
;---------------------------------------
dummy_isr:
	RTI


	org VectorStart
	dw dummy_isr	;-- Vector TMB
	dw dummy_isr	;-- Vector DAC
	dw dummy_isr    ;-- Vector KBI
	dw dummy_isr	;-- Vector Transmision SCI
	dw dummy_isr	;-- Vector Receptor SCI
	dw dummy_isr	;-- Vector Error SCI
	dw dummy_isr	;-- Vector Tranmisor SPI
	dw dummy_isr	;-- Vector Receptor SPI
	dw dummy_isr	;-- Vector Overflow TIM2
	dw dummy_isr	;-- Vector Canal 1 TIM2
	dw dummy_isr	;-- Vector Canal 0 TIM2
	dw dummy_isr	;-- Vector Overflow TIM1
	dw dummy_isr	;-- Vector Canal 1  TIM1
	dw dummy_isr    ;-- Vector Canal 0  TIM1
	dw dummy_isr    ;-- Vector PLL
	dw dummy_isr    ;-- Vector IRQ
	dw dummy_isr    ;-- Vector SWI
	dw main	        ;-- Vector Reset