File tree 1 file changed +22
-0
lines changed
1 file changed +22
-0
lines changed Original file line number Diff line number Diff line change @@ -98,6 +98,12 @@ default_header_handlers_end:
98
98
ioRegisterHandler:
99
99
push hl
100
100
push de
101
+ push bc
102
+ ld c , a
103
+ ld a , i
104
+ push af
105
+ ld a , c
106
+ di
101
107
push af
102
108
push bc
103
109
push ix
@@ -123,6 +129,11 @@ ioRegisterHandler:
123
129
ld (hl) , b \ dec hl
124
130
pop af
125
131
ld (hl) , a
132
+ pop af
133
+ jp po , _
134
+ ei
135
+ _:
136
+ pop bc
126
137
pop de
127
138
pop hl
128
139
ret
@@ -150,6 +161,9 @@ ioRegisterHandler:
150
161
;; will end in tears.
151
162
ioSendPacket:
152
163
push bc
164
+ push af
165
+ ld a , i
166
+ di
153
167
push af
154
168
; io_tx_header_ix is 0xFF when ready to send
155
169
ld a , (io_tx_header_ix)
@@ -185,11 +199,19 @@ _: ld (io_tx_header), de
185
199
out (PORT_LINK_ASSIST_ENABLE) , a
186
200
pop de
187
201
pop hl
202
+ pop af
203
+ jp po , _
204
+ ei
205
+ _:
188
206
pop af
189
207
pop bc
190
208
cp a
191
209
ret
192
210
.abort:
211
+ pop af
212
+ jp po , _
213
+ ei
214
+ _:
193
215
pop af \ ld b , a \ or 1 \ ld a , b
194
216
pop bc \ ret ; Packet in progress, GTFO
195
217
You can’t perform that action at this time.
0 commit comments