1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
|
;
; Ullrich von Bassewitz, 2004-06-30
;
; CC65 runtime: right shift support for unsigneds
;
; Note: The standard declares a shift count that is negative or >= the
; bitcount of the shifted type for undefined behaviour.
;
; Note^2: The compiler knowns about the register/zero page usage of this
; function, so you need to change the compiler source if you change it!
;
.export tosshrax, shraxy
.import popax
.importzp tmp1
tosshrax:
sta tmp1 ; Save shift count
jsr popax ; Get the left hand operand
ldy tmp1 ; Get shift count
; Run into shraxy
shraxy:
pha
tya
and #$0F
beq L2 ; Nothing to shift
sec
sbc #8 ; Shift count 8 or greater?
beq L3 ; Jump if exactly 8
bcc L4 ; Jump if less than 8
; Shift count is greater than 8.
tay ; Shift count into Y
pla ; Discard low byte
txa ; Get high byte
L1: lsr a
dey
bne L1
ldx #$00 ; High byte is zero
rts
; Shift count is zero
L2: pla
rts
; Shift count is exactly 8
L3: pla ; Drop low byte from stack ...
txa ; Move high byte to low
ldx #$00 ; Clear high byte
rts
; Shift count is less than 8
L4: adc #8 ; Correct counter
tay ; Shift count into Y
pla ; Restore low byte
stx tmp1 ; Save high byte of lhs
L5: lsr tmp1
ror a
dey
bne L5
; Done with shift
ldx tmp1
rts
|
