Binario de 8 bits a BCD

.include “m16def.inc”
.def bin= r16;binario
.def bcd= r17;bcd
.def bcd1= r18
.def cont= r19
.def aux= r20
.org 0×00
inicio:
ldi bin,0xae ;0xae es el número en binario se puede ingresar cualquier valor desde un puerto
sub bcd1,bcd1
ldi cont,8
clr bcd
clr bcd1
inicio1:
clc
rol bin
rol bcd
rol bcd1
dec cont
breq inicio
mov aux,bcd
andi aux,0×0f
cpi aux,5
brsh sumar
dos:
mov aux,bcd
swap aux
andi aux,0×0f
cpi aux,5
brsh sumar2
tres:
cpi bcd1,5
brsh sumar3
rjmp inicio1
sumar:
subi bcd,-0×03
rjmp dos
sumar2:
subi bcd,-0×30
rjmp tres
sumar3:
subi bcd1,-0×03
rjmp inicio1