Zamiana kodu BCD na binarny

[Kmieciu]

Witam mam do was wielką prośbę musze napisać kruciutki program według założeń:
dana wejściowa dwucyfrowa zapisana w kodzia BCD znajduje się w R7.
Dana wyjściowa ma się znaleść w R6 w kodzia binarnym.
Dla was to pewnie łatwizna ale ja nieznam asamblera.
Dzięki za wszystkie odpowiedzi.

[gawel]

;
$mod51
;
$NODEBUG
$LIST
$OBJECT
;
;
CSEG
MOV R7 , # 58H ; jako przykład 58 w BCD
MOV A , R7
SWAP A
ANL A , # 0FH
RL A
MOV B , A
RL A
RL A
ADD A , B
MOV B , A
MOV A , R7
ANL A , # 0FH
ADD A , B
MOV R6 , A ; = 3A hex = 58 dec
SJMP $
;-----------------------------------------------------------------------------
;
END

[Kmieciu]

Wielkie dzięki