Mercurial > public > mk2
annotate code_part1/OSTC_code_asm_part1/menu_custom.asm @ 78:bd16d5830b06
testing patch
author | heinrichsweikamp |
---|---|
date | Tue, 07 Dec 2010 21:06:45 +0100 |
parents | c6cab044a338 |
children | 69c462400279 |
rev | line source |
---|---|
0 | 1 |
2 ; OSTC - diving computer code | |
3 ; Copyright (C) 2008 HeinrichsWeikamp GbR | |
4 | |
5 ; This program is free software: you can redistribute it and/or modify | |
6 ; it under the terms of the GNU General Public License as published by | |
7 ; the Free Software Foundation, either version 3 of the License, or | |
8 ; (at your option) any later version. | |
9 | |
10 ; This program is distributed in the hope that it will be useful, | |
11 ; but WITHOUT ANY WARRANTY; without even the implied warranty of | |
12 ; MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
13 ; GNU General Public License for more details. | |
14 | |
15 ; You should have received a copy of the GNU General Public License | |
16 ; along with this program. If not, see <http://www.gnu.org/licenses/>. | |
17 | |
18 | |
19 ; Menu "Custom Functions", Custom Functions checker (Displays permanent warning if critical custom functions are altered) | |
20 ; written by: Matthias Heinrichs, info@heinrichsweikamp.com | |
21 ; written: 05/10/30 | |
22 ; last updated: 08/08/31 | |
23 ; known bugs: | |
24 ; ToDo: | |
25 | |
26 ;First Bank of Custom Functions: | |
27 ; The custom functions are stored in the internal EEPROM after 0x80 | |
28 ; any custom function occupies 4 byte: | |
29 ; 2 byte (low:high) store the default value, reset from menu "reset" | |
30 ; if bit16=1 then the custrom function is 15bit value, if not it's a 8bit value | |
31 ; 2 byte (low:high) store the actual value | |
32 ; defaults for custom functions are in menu "reset" | |
33 ; get values with GETCUSTOM8 .x with x=0...32 for 8 Bit values (stored in WREG) | |
34 ; or with GETCUSTOM15 .x with x=0...32 for 15 Bit values (stored in lo and hi) | |
35 | |
36 ;Second Bank of Custom Functions: | |
37 ; The custom functions are stored in the internal EEPROM after 0x180 | |
38 ; any custom function occupies 4 byte: | |
39 ; 2 byte (low:high) store the default value, reset from menu "reset" | |
40 ; if bit16=1 then the custrom function is 15bit value, if not it's a 8bit value | |
41 ; 2 byte (low:high) store the actual value | |
42 ; defaults for custom functions are in menu "reset" | |
43 ; get values with GETCUSTOM8 .x with x=0...32 for 8 Bit values (stored in WREG) | |
44 ; or with GETCUSTOM15 .x with x=0...32 for 15 Bit values (stored in lo and hi) | |
45 | |
46 | |
47 GETCUSTOM8 macro custom8 | |
48 movlw custom8 | |
49 call getcustom8_1 | |
50 endm | |
51 | |
52 getcustom8_1: | |
53 ; # number of requested custom function in wreg | |
54 movwf customfunction_temp2 | |
55 | |
56 movlw d'31' | |
57 cpfsgt customfunction_temp2 | |
58 bra getcustom8_2 ; Lower bank | |
59 | |
60 movlw d'1' ; Upper Bank | |
61 movwf EEADRH | |
62 movlw d'32' | |
63 subwf customfunction_temp2,F | |
64 bra getcustom8_3 | |
65 | |
66 getcustom8_2: | |
67 clrf EEADRH | |
68 getcustom8_3: | |
69 movf customfunction_temp2,W | |
70 mullw d'4' | |
71 movf PRODL,W ; x4 for adress | |
72 addlw d'130' | |
73 movwf EEADR ; +130 for LOW Byte of value | |
74 call read_eeprom ; Lowbyte | |
75 movf EEDATA,W ; copied into wreg | |
76 clrf EEADRH | |
77 return ; return | |
78 | |
79 GETCUSTOM15 macro custom15 | |
80 movlw custom15 | |
81 call getcustom15_1 | |
82 endm | |
83 | |
84 getcustom15_1: | |
85 ; # number of requested custom function in wreg | |
86 movwf customfunction_temp2 | |
87 | |
88 movlw d'31' | |
89 cpfsgt customfunction_temp2 | |
90 bra getcustom15_2 ; Lower bank | |
91 | |
92 movlw d'1' ; Upper Bank | |
93 movwf EEADRH | |
94 movlw d'32' | |
95 subwf customfunction_temp2,F | |
96 bra getcustom15_3 | |
97 getcustom15_2: | |
98 clrf EEADRH | |
99 getcustom15_3: | |
100 movf customfunction_temp2,W | |
101 mullw d'4' | |
102 movf PRODL,W ; x4 for adress | |
103 addlw d'130' | |
104 movwf EEADR ; +130 for LOW Byte of value | |
105 call read_eeprom ; Lowbyte | |
106 movff EEDATA,lo | |
107 incf EEADR,F | |
108 call read_eeprom ; Highbyte | |
109 movff EEDATA,hi | |
110 clrf EEADRH | |
111 return ; return | |
112 | |
113 menu_custom_functions_page2: | |
114 movlw d'154' ; start of custom function descriptors | |
115 movwf customfunction_temp1 | |
7 | 116 bsf customfunction_page ; Use Page II... |
0 | 117 bra menu_custom_functions0 |
118 | |
119 menu_custom_functions: | |
120 movlw d'36' ; start of custom function descriptors | |
121 movwf customfunction_temp1 | |
122 bcf customfunction_page ; Use Page I... | |
123 | |
124 menu_custom_functions0: | |
125 bsf leftbind | |
126 call PLED_ClearScreen | |
127 movlw d'1' | |
128 movwf menupos | |
129 | |
130 bcf menubit4 | |
131 bcf cursor | |
132 bcf sleepmode | |
133 clrf decodata+0 ; here: # of CustomFunction | |
134 clrf divemins+0 ; here: # of CustomFunction*4 | |
135 bcf first_FA ; here: =1: -, =0: + | |
136 bcf second_FA ; here: =1: stepsize 1, =0: stepsize 10 | |
137 | |
138 call PLED_topline_box | |
139 WIN_INVERT .1 ; Init new Wordprocessor | |
140 | |
141 btfss customfunction_page ; | |
142 bra menu_custom_functions10 | |
143 DISPLAYTEXT .186 ; Custom FunctionsII | |
144 bra menu_custom_functions11 | |
145 | |
146 menu_custom_functions10: | |
147 DISPLAYTEXT .27 ; Custom FunctionsI | |
148 | |
149 menu_custom_functions11: | |
150 WIN_INVERT .0 ; Init new Wordprocessor | |
151 | |
152 menu_custom_functions1: | |
29 | 153 call PLED_standard_color |
154 | |
7 | 155 movlw d'1' |
156 btfss customfunction_page ; Use Page II... | |
157 movlw d'0' | |
158 movwf EEADRH | |
159 | |
0 | 160 clrf timeout_counter2 |
161 bcf menubit2 | |
162 bcf menubit3 | |
163 WIN_LEFT .20 | |
164 WIN_TOP .35 | |
165 lfsr FSR2,letter | |
166 movff decodata+0,lo | |
167 | |
168 movlw d'0' | |
169 btfsc customfunction_page ; Add offset for display | |
170 movlw d'32' | |
171 addwf lo,F | |
172 movff lo,apnoe_mins ; apnoe_mins used as temp for binary CFs | |
173 | |
174 output_99x | |
175 movlw ':' | |
176 movwf POSTINC2 | |
177 movlw ' ' | |
178 movwf POSTINC2 | |
179 call word_processor | |
180 | |
181 movf customfunction_temp1,W ; start of custom function descriptors | |
182 addwf decodata+0,W ; add # of current custom function, place result in wreg | |
183 call displaytext1 ; shows descriptor | |
184 | |
185 movlw binary_cf1 | |
186 subwf apnoe_mins,W ; Binary cf? | |
187 btfsc STATUS,Z | |
188 bra menu_custom_functions10c ; Yes | |
189 | |
190 movlw binary_cf2 | |
191 subwf apnoe_mins,W ; Binary cf? | |
192 btfsc STATUS,Z | |
193 bra menu_custom_functions10c ; Yes | |
194 | |
195 movlw binary_cf3 | |
196 subwf apnoe_mins,W ; Binary cf? | |
197 btfsc STATUS,Z | |
198 bra menu_custom_functions10c ; Yes | |
199 | |
200 movlw binary_cf4 | |
201 subwf apnoe_mins,W ; Binary cf? | |
202 btfsc STATUS,Z | |
203 bra menu_custom_functions10c ; Yes | |
204 | |
205 movlw binary_cf5 | |
206 subwf apnoe_mins,W ; Binary cf? | |
207 btfsc STATUS,Z | |
208 bra menu_custom_functions10c ; Yes | |
209 | |
17 | 210 movlw binary_cf6 |
211 subwf apnoe_mins,W ; Binary cf? | |
212 btfsc STATUS,Z | |
213 bra menu_custom_functions10c ; Yes | |
214 | |
0 | 215 |
216 bra menu_custom_functions10a ; Not a binary CF selected | |
217 | |
218 menu_custom_functions10c: | |
219 movlw d'1' | |
220 movwf apnoe_mins ; Yes, set apnoe_mins to "1" | |
221 bra menu_custom_functions10b | |
222 | |
223 menu_custom_functions10a: | |
224 clrf apnoe_mins ; Yes, clear apnoe_mins | |
225 menu_custom_functions10b: | |
226 WIN_LEFT .20 | |
227 WIN_TOP .65 | |
228 lfsr FSR2,letter | |
229 movlw '+' | |
230 movwf POSTINC2 | |
231 movlw '/' | |
232 movwf POSTINC2 | |
233 movlw '-' | |
234 movwf POSTINC2 | |
235 movlw ':' | |
236 movwf POSTINC2 | |
237 movlw ' ' | |
238 movwf POSTINC2 | |
239 movlw '+' | |
240 btfsc first_FA | |
241 movlw '-' | |
242 movwf POSTINC2 | |
243 call word_processor | |
244 | |
245 WIN_LEFT .20 | |
246 WIN_TOP .95 | |
247 lfsr FSR2,letter | |
248 movlw '1' | |
249 movwf POSTINC2 | |
250 movlw '/' | |
251 movwf POSTINC2 | |
252 movlw '1' | |
253 movwf POSTINC2 | |
254 movlw '0' | |
255 movwf POSTINC2 | |
256 movlw ':' | |
257 movwf POSTINC2 | |
258 movlw ' ' | |
259 movwf POSTINC2 | |
260 movlw '1' | |
261 movwf POSTINC2 | |
262 movlw '0' | |
263 btfsc second_FA | |
264 movwf POSTINC2 | |
265 movlw ' ' | |
266 movwf POSTINC2 | |
267 call word_processor | |
268 | |
269 WIN_LEFT .20 | |
270 WIN_TOP .125 | |
271 lfsr FSR2,letter | |
272 OUTPUTTEXT d'89' ;"Default:" | |
273 | |
274 movf divemins+0,W | |
275 addlw 0x80 | |
276 movwf EEADR | |
277 call read_eeprom ; Lowbyte | |
278 movff EEDATA,lo | |
279 movf divemins+0,W | |
280 addlw 0x81 | |
281 movwf EEADR | |
282 call read_eeprom ; Highbyte | |
283 movff EEDATA,hi | |
284 bcf hi,7 ; clear Bit 7 of value | |
285 output_16 | |
27
29341afd2060
NEW: Depth, CNS, GF, ppO2 and Velocity are Color-coded
heinrichsweikamp
parents:
25
diff
changeset
|
286 movlw ',' |
0 | 287 movwf POSTINC2 |
288 | |
289 movlw '1' | |
290 btfss EEDATA,7 ; 15Bit? | |
291 movlw '8' ; 8Bit! | |
292 tstfsz apnoe_mins ; apnoe_mins=0? | |
293 movlw '1' ; No, 1Bit! | |
294 movwf POSTINC2 | |
295 | |
296 movlw '5' | |
297 btfsc EEDATA,7 ; 15Bit? | |
298 movwf POSTINC2 | |
299 movlw 'B' | |
300 movwf POSTINC2 | |
301 movlw ' ' | |
302 movwf POSTINC2 | |
303 movlw ' ' | |
304 movwf POSTINC2 | |
305 movlw ' ' | |
306 movwf POSTINC2 | |
307 call word_processor | |
308 | |
309 WIN_LEFT .20 | |
310 WIN_TOP .155 | |
311 lfsr FSR2,letter | |
312 OUTPUTTEXT d'97' ; "Current:" | |
313 | |
314 movf divemins+0,W | |
315 addlw 0x82 | |
316 movwf EEADR | |
317 call read_eeprom ; Lowbyte | |
318 movff EEDATA,lo | |
319 movf divemins+0,W | |
320 addlw 0x83 | |
321 movwf EEADR | |
322 call read_eeprom ; Highbyte | |
323 movff EEDATA,hi | |
324 output_16 | |
325 movlw ' ' | |
326 movwf POSTINC2 | |
327 movlw ' ' | |
328 movwf POSTINC2 | |
329 movlw ' ' | |
330 movwf POSTINC2 | |
331 call word_processor | |
332 | |
333 menu_custom_functions1a: | |
334 DISPLAYTEXT .11 ; Exit | |
335 | |
336 call wait_switches ; Waits until switches are released, resets flag if button stays pressed! | |
337 call PLED_menu_cursor | |
338 | |
339 customfunctions_loop: | |
340 call check_switches_logbook | |
341 | |
342 btfsc menubit3 | |
343 bra customfunctions2 ; Move cursor or generate next page | |
344 | |
345 btfsc menubit2 | |
346 bra do_customfunction ; call subfunction | |
347 | |
348 btfsc divemode | |
349 goto restart ; dive started during cf menu | |
350 | |
351 btfsc onesecupdate | |
352 call timeout_surfmode | |
353 | |
354 btfsc onesecupdate | |
355 call set_dive_modes | |
356 | |
357 bcf onesecupdate ; end of 1sek. tasks | |
358 | |
359 btfsc sleepmode | |
360 bra exit_customfunctions | |
361 | |
362 bra customfunctions_loop | |
363 | |
364 customfunctions2: | |
365 incf menupos,F | |
366 movlw d'7' | |
367 cpfseq menupos ; =7? | |
368 bra customfunctions3 ; No | |
369 movlw d'1' | |
370 movwf menupos | |
371 | |
372 customfunctions3: | |
373 clrf timeout_counter2 | |
374 call PLED_menu_cursor | |
375 | |
376 call wait_switches ; Waits until switches are released, resets flag if button stays pressed! | |
377 | |
378 bcf menubit3 ; clear flag | |
379 bra customfunctions_loop | |
380 | |
381 | |
382 do_customfunction: | |
383 CLRF EEADRH | |
384 movlw d'1' | |
385 btfsc customfunction_page | |
386 movwf EEADRH ; Reset EEADRH correct (Was adjusted in check_timeout...) | |
387 | |
388 dcfsnz menupos,F | |
389 bra next_customfunction | |
390 dcfsnz menupos,F | |
391 bra toggle_plusminus | |
392 dcfsnz menupos,F | |
393 bra toggle_oneorten | |
394 dcfsnz menupos,F | |
395 bra restore_cfn_value | |
396 dcfsnz menupos,F | |
397 bra adjust_cfn_value | |
398 exit_customfunctions: | |
399 movlw d'2' ; Return to correct list entry | |
400 btfss customfunction_page | |
401 movlw d'1' | |
402 movwf menupos ; | |
403 clrf EEADRH ; Clear EEADRH ! | |
404 goto setup_menu2 ; exit... | |
405 | |
406 | |
407 next_customfunction: | |
408 incf decodata+0 | |
409 btfsc decodata+0,5 ;>31? | |
410 clrf decodata+0 ;Yes, so reset to zero | |
411 | |
412 movf decodata+0,W | |
413 mullw d'4' | |
414 movff PRODL, divemins+0 ;divemins+0 for correct addressing | |
415 | |
416 movlw d'1' | |
417 movwf menupos | |
418 bra menu_custom_functions1 ; also debounces switches | |
419 | |
420 toggle_plusminus: | |
421 btg first_FA | |
422 movlw d'2' | |
423 movwf menupos | |
424 bra menu_custom_functions1 ; also debounces switches | |
425 | |
426 toggle_oneorten: | |
427 btg second_FA | |
428 movlw d'3' | |
429 movwf menupos | |
430 bra menu_custom_functions1 ; also debounces switches | |
431 | |
432 restore_cfn_value: | |
433 movf divemins+0,W ; read default value | |
434 addlw 0x80 | |
435 movwf EEADR | |
436 call read_eeprom ; Lowbyte | |
437 movff EEDATA,lo | |
438 movf divemins+0,W | |
439 addlw 0x81 | |
440 movwf EEADR | |
441 call read_eeprom ; Highbyte | |
442 movff EEDATA,hi | |
443 bcf hi,7 ; clear bit 7 of value | |
444 | |
445 movf divemins+0,W ; store default value | |
446 addlw 0x82 | |
447 movwf EEADR | |
448 movff lo,EEDATA | |
449 call write_eeprom ; Lowbyte | |
450 movf divemins+0,W | |
451 addlw 0x83 | |
452 movwf EEADR | |
453 movff hi,EEDATA | |
454 call write_eeprom ; Highbyte | |
455 | |
456 movlw d'4' | |
457 movwf menupos | |
458 bra menu_custom_functions1 ; also debounces switches | |
459 | |
460 adjust_cfn_value: | |
461 movf divemins+0,W ; get current value | |
462 addlw 0x82 | |
463 movwf EEADR | |
464 call read_eeprom ; Lowbyte | |
465 movff EEDATA,lo | |
466 movf divemins+0,W | |
467 addlw 0x83 | |
468 movwf EEADR | |
469 call read_eeprom ; Highbyte | |
470 movff EEDATA,hi | |
471 | |
472 movf divemins+0,W | |
473 addlw 0x81 | |
474 movwf EEADR | |
475 call read_eeprom ; Highbyte | |
476 movff EEDATA,divemins+1 ; Highbyte of default value | |
477 | |
478 movlw d'1' | |
479 cpfseq apnoe_mins ; If apnoe_mins=1 then CF is binary | |
480 bra adjust_cfn_value1 ; Not Binary | |
481 | |
482 tstfsz lo ; =0? | |
483 setf lo ; No, Set to 255 | |
484 incf lo,F ; Increase by one | |
485 clrf hi ; Delete hi byte (Not required but to make sure...) | |
486 bra adjust_cfn_value3 ; Store result | |
487 | |
488 adjust_cfn_value1: | |
489 btfss first_FA ; Minus? | |
490 bra adjust_cfn_value2 ; No, Plus | |
491 | |
492 movlw d'1' | |
493 btfsc second_FA ; -10? | |
494 movlw d'10' | |
495 | |
496 subwf lo,F ; substract value | |
497 movlw d'0' | |
498 btfsc divemins+1,7 ; 8Bit value | |
499 subwfb hi,F | |
500 | |
501 movlw b'01111111' | |
502 btfsc hi,7 ; >32768? | |
503 movwf hi | |
504 | |
505 bra adjust_cfn_value3 | |
506 | |
507 adjust_cfn_value2: | |
508 movlw d'1' | |
509 btfsc second_FA ; +10? | |
510 movlw d'10' | |
511 | |
512 addwf lo,F ; add value | |
513 movlw d'0' | |
514 btfsc divemins+1,7 ; 8Bit value? | |
515 addwfc hi,F | |
516 | |
517 btfsc hi,7 ; >32768? | |
518 clrf hi | |
519 | |
520 adjust_cfn_value3: | |
521 movf divemins+0,W ; Store current value | |
522 addlw 0x82 | |
523 movwf EEADR | |
524 movff lo,EEDATA | |
525 call write_eeprom ; Lowbyte | |
526 movf divemins+0,W | |
527 addlw 0x83 | |
528 movwf EEADR | |
529 movff hi,EEDATA | |
530 call write_eeprom ; Highbyte | |
531 movlw d'5' | |
532 movwf menupos | |
533 bra menu_custom_functions1 ; also debounces switches | |
534 | |
535 getcustom15_default: | |
536 ; # number of requested custom function in wreg | |
537 movwf customfunction_temp2 | |
538 | |
539 movlw d'31' | |
540 cpfsgt customfunction_temp2 | |
541 bra getcustom15_d2 ; Lower bank | |
542 | |
543 movlw d'1' ; Upper Bank | |
544 movwf EEADRH | |
545 movlw d'32' | |
546 subwf customfunction_temp2,F | |
547 bra getcustom15_d3 | |
548 getcustom15_d2: | |
549 clrf EEADRH | |
550 getcustom15_d3: | |
551 movf customfunction_temp2,W | |
552 mullw d'4' | |
553 movf PRODL,W ; x4 for adress | |
554 addlw d'128' | |
555 movwf EEADR ; +130 for LOW Byte of value | |
556 call read_eeprom ; Lowbyte | |
557 movff EEDATA,lo | |
558 incf EEADR,F | |
559 call read_eeprom ; Highbyte | |
560 movff EEDATA,hi | |
561 clrf EEADRH | |
562 return ; return | |
563 | |
564 custom_functions_check_divemode: ;displays warning if a critical custom function is not set to default | |
565 dcfsnz cf_checker_counter,F ; counts custom functions to check for warning symbol | |
566 bra check_cf11 | |
567 dcfsnz cf_checker_counter,F ; counts custom functions to check for warning symbol | |
568 bra check_cf12 | |
569 return | |
570 | |
571 custom_functions_check_surfmode: ;displays warning if a critical custom function is not set to default | |
572 dcfsnz cf_checker_counter,F ; counts custom functions to check for warning symbol | |
573 bra check_cf11 | |
574 dcfsnz cf_checker_counter,F ; counts custom functions to check for warning symbol | |
575 bra check_cf12 | |
576 dcfsnz cf_checker_counter,F ; counts custom functions to check for warning symbol | |
577 bra check_cf17 | |
578 dcfsnz cf_checker_counter,F ; counts custom functions to check for warning symbol | |
579 bra check_cf18 | |
580 dcfsnz cf_checker_counter,F ; counts custom functions to check for warning symbol | |
581 bra check_cf19 | |
582 dcfsnz cf_checker_counter,F ; counts custom functions to check for warning symbol | |
583 bra check_cf29 | |
584 dcfsnz cf_checker_counter,F ; counts custom functions to check for warning symbol | |
585 bra check_cf32 | |
586 dcfsnz cf_checker_counter,F ; counts custom functions to check for warning symbol | |
587 bra check_cf33 | |
588 return | |
589 | |
590 check_cf11: | |
591 movlw d'11' ; saturation factor | |
592 rcall custom_function_check_low ; compares current with default value | |
593 call test_and_display_warning ; displays the warning if the custom function is not correct | |
594 movlw d'2' ; next in testing row | |
595 movwf cf_checker_counter ; | |
596 return | |
597 | |
598 check_cf12: | |
599 movlw d'12' ; desaturation factor | |
600 rcall custom_function_check_high ; compares current with default value | |
601 call test_and_display_warning ; displays the warning if the custom function is not correct | |
602 movlw d'3' ; next in testing row | |
603 movwf cf_checker_counter ; | |
604 return | |
605 | |
606 check_cf17: | |
607 movlw d'17' ; lower threshold ppO2 | |
608 rcall custom_function_check_low ; compares current with default value | |
609 call test_and_display_warning ; displays the warning if the custom function is not correct | |
610 movlw d'4' ; next in testing row | |
611 movwf cf_checker_counter ; | |
612 return | |
613 | |
614 check_cf18: | |
615 movlw d'18' ; upper threshold ppO2 | |
616 rcall custom_function_check_high ; compares current with default value | |
617 call test_and_display_warning ; displays the warning if the custom function is not correct | |
618 movlw d'5' ; next in testing row | |
619 movwf cf_checker_counter ; | |
620 return | |
621 | |
622 check_cf19: | |
623 movlw d'19' ; upper threshold ppO2 display | |
624 rcall custom_function_check_high ; compares current with default value | |
625 call test_and_display_warning ; displays the warning if the custom function is not correct | |
626 movlw d'6' ; next in testing row | |
627 movwf cf_checker_counter ; | |
628 return | |
629 | |
630 check_cf29: | |
631 movlw d'6' | |
632 movwf cf_checker_counter ; upper limit for CF29, here: used as a temp variable | |
633 movlw d'29' ; last deco stop in [m] | |
634 rcall custom_function_check_high_limit ; compares current with default value | |
635 call test_and_display_warning ; displays the warning if the custom function is not correct | |
636 movlw d'7' ; next in testing row | |
637 movwf cf_checker_counter ; | |
638 return | |
639 | |
640 check_cf32: | |
641 movlw d'32' ; GF LOW | |
642 rcall custom_function_check_high ; compares current with default value | |
643 call test_and_display_warning ; displays the warning if the custom function is not correct | |
644 movlw d'8' ; next in testing row | |
645 movwf cf_checker_counter ; | |
646 return | |
647 | |
648 check_cf33: | |
649 movlw d'33' ; GF HIGH | |
650 rcall custom_function_check_high ; compares current with default value | |
651 call test_and_display_warning ; displays the warning if the custom function is not correct | |
652 movlw d'1' ; next in testing row | |
653 movwf cf_checker_counter ; | |
654 return | |
655 | |
656 | |
657 test_and_display_warning: | |
658 movwf lo ; copy result | |
659 tstfsz lo | |
660 return ; CF OK | |
661 goto custom_warn_surfmode | |
662 | |
663 custom_function_check_low: ; Checks CF (#WREG) | |
664 ; Returns WREG=0 if CF is lower then default | |
665 movwf temp1 ; save for custom value | |
666 call getcustom15_1 ; Get Current Value stored in hi and lo | |
667 movff lo,sub_a+0 | |
668 movff hi,sub_a+1 ; save value | |
669 | |
670 movf temp1,w | |
671 call getcustom15_default ; Get Default value stored in hi and lo | |
672 movff lo,sub_b+0 | |
673 movff hi,sub_b+1 ; save value | |
674 call sub16 ; sub_c = sub_a - sub_b with "neg_flag" bit set if sub_b > sub_a | |
675 btfss neg_flag ; negative? | |
676 retlw .255 ; no | |
677 retlw .0 ; yes | |
678 | |
679 custom_function_check_high: ; Checks CF (#WREG) | |
680 ; Returns WREG=0 if CF is higher then default | |
681 movwf temp1 ; save for custom value | |
682 call getcustom15_1 ; Get Current Value stored in hi and lo | |
683 movff lo,sub_b+0 | |
684 movff hi,sub_b+1 ; save value | |
685 | |
686 movf temp1,w | |
687 call getcustom15_default ; Get Default value stored in hi and lo | |
688 movff lo,sub_a+0 | |
689 movff hi,sub_a+1 ; save value | |
690 call sub16 ; sub_c = sub_a - sub_b with "neg_flag" bit set if sub_b > sub_a | |
691 btfss neg_flag ; negative? | |
692 retlw .255 ; no | |
693 retlw .0 ; yes | |
694 | |
695 custom_function_check_high_limit: ; Checks if CF (#WREG) is lower then limit (#cf_checker_counter) | |
696 movwf temp1 ; save for custom value | |
697 call getcustom15_1 ; Get Current Value stored in hi and lo | |
698 movff lo,sub_b+0 | |
699 movff hi,sub_b+1 ; save value | |
700 movff cf_checker_counter, sub_a+0 | |
701 clrf sub_a+1 | |
702 call sub16 ; sub_c = sub_a - sub_b with "neg_flag" bit set if sub_b > sub_a | |
703 btfss neg_flag ; negative? | |
704 retlw .255 ; no | |
25 | 705 retlw .0 ; yes |