X-Git-Url: http://j8takagi.net/cgi-bin/gitweb.cgi?p=YACASL2.git;a=blobdiff_plain;f=as%2Fcasl2lib%2Fouta_q15.casl;fp=as%2Fcasl2lib%2Fouta_q15.casl;h=74b1e2d6dda054d3dc45e19ccba2c1c765413249;hp=7c0e01c534454b55c5994193b34ba5efcbcbcb49;hb=7ac339dcd755848e9820142422752fbdc8186b5c;hpb=03832f246ce06d0dae29f96c087b94c7086bb993

diff --git a/as/casl2lib/outa_q15.casl b/as/casl2lib/outa_q15.casl
index 7c0e01c..74b1e2d 100644
--- a/as/casl2lib/outa_q15.casl
+++ b/as/casl2lib/outa_q15.casl
@@ -44,3 +44,62 @@ STR     DS      20
 LEN     DS      1
         END
 
+;;; GR1を符号付き整数とみなし、絶対値に変換
+;;; 入力 GR1: -32768から32767の整数
+;;; 出力 GR1: 入力された整数の絶対値
+;;;       OF: 入力されたGR1が-32768の場合、1
+;;;       SF: 入力されたGR1が負数(-32767〜-1)の場合、1
+ABS     START
+        AND     GR1,GR1         ; GR1が0以上の場合は、FINへジャンプ
+        JPL     FIN             ; ↓
+        JZE     FIN             ; ↓
+        XOR     GR1,ALLON       ; GR1のビットを反転
+        ADDA    GR1,ONE         ; GR1に1を追加
+        JOV     FIN             ; 足し算でオーバーフローの場合は、OF:1を保持してFINへジャンプ
+        CPL     GR1,ALLON       ; SF:1を設定
+FIN     RET
+ONE     DC      1
+ALLON   DC      #FFFF
+        END
+;;; 0〜65535の範囲にある正数のかけ算（筆算方式）を行う
+;;; 入力 GR1:被乗数 GR2:乗数
+;;; 出力 GR0:積の下位WORD GR3:積の上位WORD
+;;; 積が65535より大きい場合は、オーバーフロー
+MULL    START
+        PUSH    0,GR4
+        PUSH    0,GR5
+        XOR     GR0,GR0         ; 積
+        XOR     GR3,GR3         ; 上位word
+        XOR     GR5,GR5         ; 上位wordの一時値
+        AND     GR1,GR1         ; (GR1 = 0)の場合、終了
+        JZE     CHKOV           ; ↓
+        AND     GR2,GR2         ; (GR2 = 0)の場合、終了
+        JZE     CHKOV           ; ↓
+        LAD     GR4,1           ; 対象ビット
+LOOP    PUSH    0,GR4           ; ループ先頭。GR2のビット中でGR4が示すビットが0の場合、NEXTへジャンプ
+        AND     GR4,GR2         ; ↓
+        POP     GR4             ; ↓
+        JZE     NEXT1           ; ↓
+        ADDL    GR3,GR5         ; GR3 <- GR3 + GR5
+        ADDL    GR0,GR1         ; GR0 <- GR0 + GR1
+        JOV     AHB1            ; GR0がオーバーフローした場合、AHB1へジャンプ
+        JUMP    NEXT1           ; ↓
+AHB1    LAD     GR3,1,GR3       ; GR3 <- GR3 + 1
+NEXT1   SLL     GR4,1           ; GR4を1回左シフト
+        JOV     CHKOV           ; ↓
+        SLL     GR5,1           ; GR5を1回左シフト
+        CPL     GR4,GR2         ; (GR4 > GR2)の場合、CHKOVへジャンプ
+        JPL     CHKOV           ; ↓
+        SLL     GR1,1           ; GR1を1回左シフト
+        JOV     AHB2            ; GR1がオーバーフローした場合、AHBへジャンプ
+        JUMP    NEXT2           ; ↓
+AHB2    LAD     GR5,1,GR5       ; GR5 <- GR5 + 1
+NEXT2   JUMP    LOOP            ; ループ終端
+CHKOV   AND     GR3,GR3         ; GR3 = 0の場合、終了
+        JZE     FIN             ; ↓
+        LAD     GR4,#FFFF       ; GR3 <> 0の場合、オーバーフロー
+        SLL     GR4,1           ; ↓
+FIN     POP     GR5
+        POP     GR4
+        RET
+        END