Desplazamiento De Motor Con Avr

Introducción.
En el primer ejercicio se podrá controlar el giro de un motor mediante los comandos

Objetivos.
Aprender a controlar el giro de unmotor de CD por medio de desplazamientos y tabla.
Desarrollo.
Giro de motor con desplazamiento.
stack .equ 1000h
mask .equ 03h
teclas .equ80h
motor .equ 81h
izq .equ 02h
der .equ 01h
run .equ 33h
mask_1 .equ 01h
mask_2 .equ 02h

ld sp, stack
ld b, run
otro: ina,(teclas)
and mask
cp mask
jp z, otro
next: cp izq
jp z, step_izq
cp der
jp z, step_der
jp next
step_izq: ld a, b
out (motor),a
in a,(teclas)
and mask_1
cp mask_1
jp z, step_der
rlc b
jp step_izq

step_der: ld a,b
out (motor), a
in a, (teclas)
and mask_2
cp mask_2jp z, step_izq
rrc b

Giro de motor con tabla.
stack .equ 1000h
mask .equ 03h
teclas .equ 80h
motor .equ 81h
izq .equ 02h
der .equ01h
mask_1 .equ 01h
mask_2 .equ 02h

ld sp, stack
ld hl, 1000h
otro: in a,(teclas)
and mask
cp mask
jp z, otro
next: cp izq
callz, step_izq
cp der
call z, step_der
jp next

step_der: ld a, (hl)
out (motor),a
in a, (teclas)
and mask_2
cp mask_2
ret z
ld a,03h
cp l
jp z, nueva
inc l
jp step_der
nueva: ld l,00h
jp step_der

step_izq: ld a, (hl)
out (motor),a
in a, (teclas)
and mask_1cp mask_1
ret z
ld a, 00h
cp l
jp z, nuevaa
dec l
jp step_izq
nuevaa: ld l,03h
jp step_izq

org 1000h
db 03h, 09h, 0ch, 06h