WIP FMUL for BK0010

Author: nzeemin

runtime-BK0010.tmac

@@ -864,7 +864,7 @@ GRIZT:	MOV	(SP)+,R3	; 
 ;#####################################################################
 ;## FADD
 ;## Need ERRR
-; Сложение для плавающих чисел, эмуляция FIS, параметры B и A на стеке.
+; Сложение для плавающих чисел, параметры B и A на стеке.
 ; На основе кода процедуры ADR из реализации Бейсик Вильнюс для БК-0010.
 ; На входе: (SP) - адрес возврата
 ;           (SP+2)(SP+4) - плавающее число B (старшее, младшее слово)
@@ -891,16 +891,16 @@ FADD:
 	ROR	6(SP)
 	MOV	4(SP),10(SP)
 	MOV	6(SP),12(SP)
-	BR	50$		; X=0 => РЕЗУЛЬТАТ - B
+	BR	50$		; X=0 => результат - B
 ;A1:
 1$:	ROLB	1(SP)		; запомнить знак A
 	MOVB	#1,11(SP)
 	MOVB	#1,5(SP)
-	SUB	R3,R2		; РАЗНОСТЬ ПОРЯДКОВ ЧИСЕЛ А И B => R2
+	SUB	R3,R2		; разность порядков чисел А И B => R2
 	BGT	2$
 ;
-	MOV	10(SP),R0	; В R0,R1 - МАНТИССА ЧИСЛА
-	MOV	12(SP),R1	; С МЕНЬШИМ ПОРЯДКОМ
+	MOV	10(SP),R0	; в R0,R1 - мантисса числа
+	MOV	12(SP),R1	; с меньшим порядком
 	BR	20$
 ;A2:
 2$:	ADD	R2,R3
@@ -911,22 +911,22 @@ FADD:
 	SWAB	(SP)
 	NEG	R2
 ;CMZ:
-20$:	CMPB	1(SP),(SP)	; ЕСЛИ ЗНАКИ ЧИСЕЛ НЕ=
-	BEQ	21$		; ИЗМЕНИТЬ ЗНАК МЕНЬШЕГО ЧИСЛА
+20$:	CMPB	1(SP),(SP)	; если знаки чисел не равны
+	BEQ	21$		; изменить знак меньшего числа
 	NEG	R1
 	ADC	R0
 	NEG	R0
 ;Z1:
-21$:	TST	R2		; ЕСЛИ R2 = 0 - выполнить сложение
+21$:	TST	R2		; если R2 = 0 - выполнить сложение
 	BEQ	30$
-	CMP	#-31,R2		; ЕСЛИ R2 > 31 => REZ=ЧИСЛО С БОЛЬШИМ ПОРЯДКОМ
+	CMP	#-31,R2		; если R2 > 31 => REZ=ЧИСЛО С БОЛЬШИМ ПОРЯДКОМ
 	BLE	22$
 	MOV	4(SP),R0
 	MOV	6(SP),R1
 	BR	7$
 ;Z2
-22$:	CMP	#-10,R2		; ПРИВЕСТИ СЛАГАЕМЫЕ К ОДИНАКОВОМУ
-	BLE	6$		;     ПОРЯДКУ
+22$:	CMP	#-10,R2		; привести слагаемые к одинаковому порядку
+	BLE	6$
 	CLR	R4
 	TST	R0
 	BPL	3$
@@ -955,13 +955,13 @@ FADD:
 	INC	R2
 	BLT	6$
 ;SUM:
-30$:	ADD	4(SP),R0	;  СЛОЖИТЬ ЧИСЛА
+30$:	ADD	4(SP),R0	; сложить числа
 	ADD	6(SP),R1
 	ADC	R0
 ;
-	CMPB	1(SP),(SP)	; ЗНАКИ СЛАГАЕМЫХ РАЗЛИЧНЫ ?
+	CMPB	1(SP),(SP)	; знаки слагаемых различны?
 	BNE	8$
-	BIT	R0,#1000	; РЕЗУЛЬТАТ НОРМАЛИЗОВАН?
+	BIT	R0,#1000	; результат нормализован?
 	BEQ	7$
 	ASR	R0
 	ROR	R1
@@ -970,8 +970,8 @@ FADD:
 	BNE	FADD$O		; переполнение порядка
 ;
 	BISB	R0,R3
-	ROR	(SP)		; СФОРМИРОВАТЬ РЕЗ-Т В ВИДЕ ЧИСЛА
-	ROR	R3		; С ПЛАВАЮЩЕЙ ЗАПЯТОЙ
+	ROR	(SP)		; сформировать результат в виде числа с плавающей запятой
+	ROR	R3
 	ROR	R1
 	ADC	R1
 	ADC	R3
@@ -988,12 +988,12 @@ FADD:
 8$:	TST	R0
 	BGT	9$
 	BEQ	10$
-	NEG	R0		; ИЗМЕНИТЬ ЗНАК РЕЗУЛЬТАТА
+	NEG	R0		; изменить знак результата
 	NEG	R1
 	SBC	R0
 	SWAB	(SP)
 ;A9:
-9$:	BIT	R0,#400		; НОРМАЛИЗОВАТЬ МАНТИССУ РЕЗУЛЬТАТА
+9$:	BIT	R0,#400		; нормализовать мантиссу результата
 	BNE	11$
 	DEC	R3
 	ASL	R1
@@ -1002,7 +1002,7 @@ FADD:
 ;A10:
 10$:	TST	R1
 	BEQ	12$
-	SWAB	R1		; НОРМАЛИЗОВАТЬ МАНТИССУ РЕЗУЛЬТАТА
+	SWAB	R1		; нормализовать мантиссу результата
 	BISB	R1,R0
 	CLRB	R1
 	SUB	#10,R3
@@ -1022,23 +1022,144 @@ FADD$O:	MOV	(SP), R5	; 
 ;#####################################################################
 ;## FSUB
 ;## Need FADD
-; Вычитание для float, эмуляция FIS, параметры B и A на стеке.
+; Вычитание для float, параметры B и A на стеке.
 ; На входе: (SP) - адрес возврата
 ;           (SP+2)(SP+4) - плавающее число B (старшее, младшее слово)
 ;           (SP+6)(SP+10) - плавающее число A (старшее, младшее слово)
 ; Результат: (SP)(SP+2) - плавающее число (старшее слово, младшее слово)
 FSUB:
-	TST	2(SP)		; проверяем старше слово
+	TST	2(SP)		; проверяем старше слово B
 	BEQ	1$		; ноль =>
 	ADD	#100000,2(SP)	; изменить знак операнда
 1$:	JMP	FADD		; идём на сложение: A-B = A+(-B)
 
 ;#####################################################################
 ;## FMUL
-; Умножение для float, эмуляция FIS, параметры B и A на стеке
+; Умножение для плавающих чисел, параметры B и A на стеке
+; На основе кода процедуры MLR из реализации Бейсик Вильнюс для БК-0010.
+; На входе: (SP) - адрес возврата
+;           (SP+2)(SP+4) - плавающее число B (старшее, младшее слово)
+;           (SP+6)(SP+10) - плавающее число A (старшее, младшее слово)
+; Результат: (SP)(SP+2) - плавающее число (старшее слово, младшее слово)
 FMUL:
-;TODO
-	RETURN ;STUB
+	MOV	(SP)+, FMUL$X+2	; снимаем и подставляем адрес возврата
+; На стеке: ст.B мл.B, ст.A мл.A
+	MOV	R5,-(SP)	; Сохраняем регистры
+	MOV	R4,-(SP)
+	;MOV	R3,-(SP)
+; Подготовительные действия
+; На стеке: R4, R5, ст.B мл.B, ст.A мл.A
+	MOV	4(SP),R2	; R2 <- порядок числа B
+	ASL	R2
+	ROL	-(SP)		; запомнить знак числа B
+	CLR	-(SP)
+; На стеке: 0, знак, R4, R5, (SP+10)ст.B мл.B, (SP+14)ст.A мл.A
+	SWAB	R2
+	MOVB	R2,(SP)		; запомнить порядок числа B
+	BEQ	FMUL$0		; B = 0 => результат - 0
+	SEC
+	ROR	R2		; формирование мантиссы
+	CLRB	R2		; числа B в регистрах R2/R3
+	BISB	13(SP),R2
+	CLR	R3
+	BISB	12(SP),R3
+	SWAB	R3
+	ASL	14(SP)		; формирование в нулевом бите
+	ADC	2(SP)		; знака мантисы результата
+	TSTB	15(SP)
+	BEQ	FMUL$0		; A = 0 => результат - 0
+	ROR	14(SP)		; восстановление мантиссы A
+; Умножение мантисс
+	CLR	R0		; подготовка R0/R1
+	CLR	R1		; для резултата умножения
+	MOV	16(SP),R4	; выделить младшую часть мантиссы A
+	BEQ	1$		; если 0 - умножать не надо
+	MOV	#17,R5		; умножение B на
+	CALL	FMUL$P		; младшую часть
+	CALL	FMUL$D		; мантиссы A
+;
+1$:	MOV	14(SP),R4
+	MOV	#7,R5		; умножение на
+	CALL	FMUL$D		; старшую часть
+	CALL	FMUL$E		; мантиссы A
+; Сложение порядков
+	ADD	(SP)+,R4
+; На стеке: знак, R4, R5, (SP+6)ст.B мл.B, (SP+12)ст.A мл.A
+; Нормализация мантиссы
+	ROL	R1
+	ROL	R0
+	BCS	2$
+	ROL	R1
+	ROL	R0
+	DEC	R4
+; Формирование и контроль порядка
+2$:	SUB	#200,R4
+	BLE	FMUL$N		; исчезновение порядка
+	CMP	#377,R4
+	BLT	FMUL$O		; переполнение порядка
+; Формирование результата
+	CLRB	R1		; формирование мантиссы
+	BISB	R0,R1
+	SWAB	R1
+	CLRB	R0
+	BISB	R4,R0		; присоединение порядка
+	SWAB	R0
+	ROR	(SP)+		; присоединение знака
+	ROR	R0
+	ROR	R1
+	ADC	R1		; округление
+	ADC	R0
+	BCS	FMUL$O		; контроль переполнения
+	BVS	FMUL$O		; порядка
+; На стеке: R4, R5, (SP+4)ст.B мл.B, (SP+10)ст.A мл.A
+;MEND:
+FMUL$M:	MOV	R0,10(SP)	; пересылка в стек на место числа A
+	MOV	R1,12(SP)	; младшее слово
+;ENDM: Завершение
+	;MOV	(SP)+,R3	; восстановление регистров
+	MOV	(SP)+,R4
+	MOV	(SP)+,R5
+	CMP	(SP)+,(SP)+	; удаление числа B из стека
+FMUL$X:	JMP	@#000000	; возврат
+;
+;MREZ0: Формирование нулевого результата
+FMUL$0:	TST	(SP)+		; очистка стека
+; Обработка исчезновения порядка
+FMUL$N:	TST	(SP)+		; очистка стека
+	CLR	R0		; формирование результата 0
+	CLR	R1
+	BR	FMUL$M
+;
+; Ошибка: переполнение порядка
+FMUL$O:	MOV	FMUL$X+2, R5	; откуда вызвали
+	MOV	#3006., R0	; Ошибка: переполнение
+	JMP	ERRR
+;
+;DAUGYB: Подпрограмма умножения
+FMUL$D:	ASR	R4
+	BCC	FMUL$F		; если 0 - сдвинуть
+FMUL$E:	ADD	R3,R1		; если 1 - сложить
+	ADC	R0
+	BCS	FMUL$G		; перенос
+	ADD	R2,R0
+FMUL$F:	ROR	R0		; сдвиг
+	ROR	R1
+	DEC	R5		; на все ли биты
+	BGT	FMUL$D		; перемножено?
+	RETURN
+FMUL$G:	ADD	R2,R0		; сложение при переносе
+	SEC
+	BR	FMUL$F
+;
+;DAUGP: Подпрограмма умножения старших байтов
+FMUL$P:	ASR	R4
+	BCC	2$		; если 0 - сдвинуть
+	ADD	R2,R0		; если 1 - сложить
+2$:	ROR	R0		; сдвиг
+	ROR	R1
+	DEC	R5		; на все ли биты
+	BGT	FMUL$P		; перемножено?
+	RETURN
 
 ;#####################################################################
 ;## FDIV