Easyelectronics.ru

;**********************************************************************************************
; Signed conversion procedure
;**********************************************************************************************
Muladdsh:   ld   var10, y+   
      ld   var11, y+
      ld   var12, y+
      ld   var13, y+
; Проверка будущего знака результата умножения
      eor   var21, var13   ; сравниваем знаковые биты
      bst   var21, 7   ; запоминаем во флаге T знак будущего частного
      eor   var21, var13   ; восстанавливаем var21
; получение модуля множителей
      sbrs   var21, 7   ; Проверка знака конвертируемого числа
      rjmp   _mas_v1pos   ; если конвертируемое отрицательно
      ldi   r16, 0      ; преобразуем его
      ldi   r17, 0      ; в положительное
      sub   r16, var20   ; методом вычитания
      sbc   r17, var21   ; из ноля
      movw   var20, r16
_mas_v1pos:   sbrs   var13, 7   ; Проверка знака коэффициента K
      rjmp   _mas_v2pos   ; Конверсия в положительный при необходимости
      ldi   r16, 0
      sub   r16, var10
      mov   var10, r16
      ldi   r16, 0
      sbc   r16, var11
      mov   var11, r16
      ldi   r16,0
      sbc   r16, var12
      mov   var12, r16
      ldi   r16,0
      sbc   r16, var13
      mov   var13, r16
_mas_v2pos:   rcall   Mul24x16uh   ; Var1{01234} = var1{012} * var2{01}
      rol   var11
      rcall   round24      ; Округление после деления
; Загрузка офсета      
      ld   var20, y+
      ld   var21, y+      
; Ветвление, исходя из знака результата умножения
; Возможны 4 случая:
; 1) положительный+положительный. возможно переполнение сверху при умножении или сложении
; 2) положительный+отрицательный. Возможно переполнение сверху при умножении, или переход через ноль при сложении
; 3) отрицательный+положительный. возможно переполнение снизу на этапе умножения, или переход через ноль при сложении
; 4) отрицательный+отрицательный. переполнение снизу при умножении или сложении.
      ldi   r16,0
      brtc   _mas_repos   ; проверка - должен ли результат быть отрицательным?
; здесь - результат умножения отрицательный
      sbrs   var21, 7
      rjmp   _mas_negpos
; здесь - отрицательный результат умножения и отрицательный офсет. Возможно переполнение снизу.
      clr   var10
      clr   var11
      sub   var10, var20   ; меняем знак офсета
      sbc   var11, var21
      add   var12, var10
      adc   var13, var11
      adc   var14, r16
      brcs   _sicon_max   ; перенос после сложения
_sicnchkovf:   tst   var14
      breq   _sicon_exit   ; проверка на переполнение
_sicon_max:   ldi   r16, 0xff   ; Ограничение сверху/снизу
      mov   var12, r16
      mov   var13, r16
      rjmp   _sicon_exit
; здесь - отрицательный результат умножения и положительный офсет. Возможно переполнение снизу(сверху по модулю) или изменение знака.
_mas_negpos:   sub   var12, var20
      sbc   var13, var21
      sbc   var14, r16
      brcc   _sicnchkovf   ; проверка перехода через 0, смена знака
; здесь - произошел переход через 0 при вычитании. результат имеет противоположный знак.
      clt         ; смена знакового флага
_sicnchsgn:   sub   r16, var12
      mov   var12, r16   ; смена знака результата
      ldi   r16, 0
      sbc   var13, r16
      mov   var13, r16
      rjmp   _sicon_exit
; Положительный результат умножения
_mas_repos:   sbrs   var21, 7   ; проверка знака офсета
      rjmp   _mas_pospos
; Здесь - положительное число после умночения и отрицательный офсет. Возможно переполнение, возможен переход через 0
      clr   var10
      clr   var11
      sub   var10, var20   ; меняем знак офсета
      sbc   var11, var21
      sub   var12, var10   ; отнимаем от произведения модуль офсета
      sbc   var13, var11
      sbc   var14, r16
      brcc   _sicnchkovf   ; нет займа, знак не сменился, проверяем на переполнение
; смена знака результата после сложения. Результат отрицательный, и ложно обозначен как положительный
      set         ; меняем знаковый флаг
      rjmp   _sicnchsgn   ; меняем знак результата   
_mas_pospos:   
; Здесь - положительное число после умночения и положительный офсет. Возможно только переполнение.
      add   var12, var20
      adc   var13, var21
      adc   var14, r16
      brcs   _sicon_max   ; перенос после сложения
      brne   _sicon_max   ; переполнение после сложения
_sicon_exit:   ret

;***************************************************************************
; Var1x{01234} = var1x{012} * var2x{01}
;***************************************************************************
Mul24x16uh:   ldi   r16,0
      mul   var12, var21   ; b*x
      mov   var13, r0
      mov   var14, r1

      mul   var12, var20   ; b*y
      MOV   var12, R0
      add   var13, R1
      adc   var14, r16   ; zero

      mul   var11, var21   ; c*x
      add   var12, R0
      adc   var13, R1
      adc   var14, r16   ; zero
      
      mul   var11,var20   ; c*y
      mov   var11,R0
      add   var12,R1
      adc   var13, r16   ; zero
      adc   var14, r16   ; zero

      mul   var10,var21   ; d*x
      add   var11,R0
      adc   var12,R1
      adc   var13, r16   ; zero
      adc   var14, r16   ; zero

      mul   var10, var20   ; d*y
      mov   var10, R0
      add   var11, R1
round24:   adc   var12, r16   ; zero   - и повторный вход для выполнения округления при необходимости
      adc   var13, r16   ; zero
      adc   var14, r16   ; zero
      ret