annotate code_part1/OSTC_code_asm_part1/simulator.asm @ 38:8ece4837a642

test & debugging new deco code...
author heinrichsweikamp
date Mon, 31 May 2010 19:14:09 +0200
parents d4f0c097a7fa
children 92001c045088
Ignore whitespace changes - Everywhere: Within whitespace: At end of lines:
rev   line source
0
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
2 ; OSTC - diving computer code
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
3 ; Copyright (C) 2008 HeinrichsWeikamp GbR
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
4
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
5 ; This program is free software: you can redistribute it and/or modify
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
6 ; it under the terms of the GNU General Public License as published by
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
7 ; the Free Software Foundation, either version 3 of the License, or
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
8 ; (at your option) any later version.
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
9
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
10 ; This program is distributed in the hope that it will be useful,
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
11 ; but WITHOUT ANY WARRANTY; without even the implied warranty of
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
12 ; MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
13 ; GNU General Public License for more details.
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
14
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
15 ; You should have received a copy of the GNU General Public License
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
16 ; along with this program. If not, see <http://www.gnu.org/licenses/>.
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
17
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
18
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
19 ; menu "Simulator"
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
20 ; written by: Matthias Heinrichs, info@heinrichsweikamp.com
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
21 ; written: 081210
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
22 ; last updated: 081210
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
23 ; known bugs:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
24 ; ToDo:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
25
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
26 menu_simulator:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
27 movlw d'1'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
28 movwf logbook_temp1 ; Bottom time
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
29 movlw d'15'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
30 movwf logbook_temp2 ; Max. Depth
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
31 movlw d'1'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
32 movwf menupos
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
33
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
34 menu_simulator1:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
35 clrf timeout_counter2
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
36 bsf menubit
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
37 bsf cursor
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
38 call PLED_ClearScreen
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
39 call PLED_simulator_mask
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
40
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
41 menu_simulator2:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
42 bcf switch_left
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
43 bcf switch_right
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
44 bcf menubit2
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
45 bcf menubit3
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
46 call PLED_simulator_data
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
47 call PLED_menu_cursor
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
48
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
49 menu_simulator_loop:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
50 call check_switches_menu
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
51 menu_simulator_loop2:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
52 btfss onesecupdate
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
53 bra menu_simulator_loop3
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
54
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
55 call timeout_surfmode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
56 call set_dive_modes
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
57 call test_charger ; check if charger IC is active
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
58 call get_battery_voltage ; get battery voltage
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
59
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
60 bcf onesecupdate ; End of one second tasks
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
61
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
62 menu_simulator_loop3:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
63 btfsc menubit2
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
64 goto menu_simulator_do ; call submenu
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
65
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
66 btfss menubit
35
d4f0c097a7fa preparations for new gaslist
heinrichsweikamp
parents: 34
diff changeset
67 goto menu_simulator_exit
0
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
68
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
69 btfsc sleepmode
35
d4f0c097a7fa preparations for new gaslist
heinrichsweikamp
parents: 34
diff changeset
70 goto menu_simulator_exit
0
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
71
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
72 btfsc divemode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
73 goto restart ; exit menu, restart and enter divemode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
74
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
75 bra menu_simulator_loop
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
76
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
77 menu_simulator_do: ; calls submenu
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
78 dcfsnz menupos,F
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
79 bra simulator_startdive
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
80 dcfsnz menupos,F
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
81 bra simulator_inc_bottomtime
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
82 dcfsnz menupos,F
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
83 bra simulator_inc_maxdepth
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
84 dcfsnz menupos,F
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
85 bra simulator_calc_deco
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
86 dcfsnz menupos,F
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
87 bra simulator_show_decoplan
35
d4f0c097a7fa preparations for new gaslist
heinrichsweikamp
parents: 34
diff changeset
88 menu_simulator_exit:
0
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
89 movlw d'4'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
90 movwf menupos
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
91 goto more_menu2 ; exit...
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
92
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
93 simulator_inc_bottomtime:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
94 movlw d'2'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
95 addwf logbook_temp1,F ; Here: Bottomtime in m
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
96 movlw d'199'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
97 cpfslt logbook_temp1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
98 movwf logbook_temp1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
99 movlw d'2'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
100 movwf menupos
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
101 bra menu_simulator2
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
102
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
103 simulator_inc_maxdepth:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
104 movlw d'3'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
105 addwf logbook_temp2,F ; Here: Maxdepth in m
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
106 movlw d'99'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
107 cpfslt logbook_temp2
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
108 movwf logbook_temp2
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
109 movlw d'3'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
110 movwf menupos
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
111 bra menu_simulator2
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
112
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
113 simulator_startdive:
33
6e5db85382a2 Speedy simulator! New Deco code test 1
heinrichsweikamp
parents: 32
diff changeset
114 ; Descent to -15m depth
0
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
115 ; Set standalone_simulator flag (Displays Simulator menu during simulation by pressing ENTER button)
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
116 ; Clear standalone_simulator after (any) dive
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
117 bsf simulatormode_active ; normal simulator mode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
118 bsf standalone_simulator ; Standalone Simulator active
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
119
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
120 movff logbook_temp2,xA+0
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
121 clrf xA+1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
122 movlw d'100'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
123 movwf xB+0
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
124 clrf xB+1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
125 call mult16x16 ;xA*xB=xC ; Depth in m*100
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
126
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
127 movlw LOW d'1000'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
128 addwf xC+0,F
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
129 movlw HIGH d'1000'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
130 addwfc xC+1,F ; Add 1000mBar
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
131
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
132 movff xC+0,sim_pressure+0
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
133 movff xC+1,sim_pressure+1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
134
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
135 movff sim_pressure+0,amb_pressure+0 ; override readings with simulator values
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
136 movff sim_pressure+1,amb_pressure+1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
137
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
138 bcf menubit2
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
139 bcf menubit3
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
140 bcf menubit
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
141 bcf switch_left
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
142 bcf switch_right
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
143
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
144 call simulator_save_tissue_data ; Stores 32 floats "pre_tissue" into bank3
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
145
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
146 bsf divemode ; Set divemode flag
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
147 ostc_debug 'P' ; Sends debug-information to screen if debugmode active
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
148 goto diveloop ; Start Divemode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
149
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
150 simulator_save_tissue_data:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
151 bsf restore_deco_data ; Set restore flag
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
152 ostc_debug 'S' ; Sends debug-information to screen if debugmode active
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
153 call main_push_tissues_to_vault
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
154 movlb 0x01 ; Back to RAM Bank1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
155 ostc_debug 'T' ; Sends debug-information to screen if debugmode active
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
156 return
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
157
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
158 simulator_restore_tissue_data:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
159 bcf restore_deco_data ; clear restore flag
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
160 ostc_debug 'S' ; Sends debug-information to screen if debugmode active
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
161 call main_pull_tissues_from_vault
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
162 movlb 0x01 ; Back to RAM Bank1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
163 ostc_debug 'T' ; Sends debug-information to screen if debugmode active
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
164
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
165 ostc_debug 'G' ; Sends debug-information to screen if debugmode active
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
166 call deco_main_calc_desaturation_time ; calculate desaturation time
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
167 movlb b'00000001' ; select ram bank 1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
168 call calculate_noflytime ; Calc NoFly time
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
169 ostc_debug 'H' ; Sends debug-information to screen if debugmode active
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
170 return
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
171
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
172 simulator_show_decoplan:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
173 call PLED_ClearScreen
34
5dbdc08e5460 New Simulator results screen
heinrichsweikamp
parents: 33
diff changeset
174 call PLED_simdata_screen
0
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
175 call divemenu_see_decoplan
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
176
34
5dbdc08e5460 New Simulator results screen
heinrichsweikamp
parents: 33
diff changeset
177 WIN_INVERT .1 ; Init new Wordprocessor
5dbdc08e5460 New Simulator results screen
heinrichsweikamp
parents: 33
diff changeset
178 DISPLAYTEXT .188 ; Sim. Results:
5dbdc08e5460 New Simulator results screen
heinrichsweikamp
parents: 33
diff changeset
179 WIN_INVERT .0 ; Init new Wordprocessor
5dbdc08e5460 New Simulator results screen
heinrichsweikamp
parents: 33
diff changeset
180
0
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
181 bcf switch_left
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
182 bcf switch_right
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
183
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
184 simulator_show_decoplan2:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
185 btfss onesecupdate
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
186 bra simulator_show_decoplan3
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
187
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
188 call timeout_surfmode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
189 call set_dive_modes
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
190 call test_charger ; check if charger IC is active
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
191 call get_battery_voltage ; get battery voltage
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
192
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
193 bcf onesecupdate ; End of one second tasks
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
194
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
195 simulator_show_decoplan3:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
196 btfsc switch_left
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
197 bra simulator_show_decoplan4 ; Quit display
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
198
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
199 btfsc switch_right
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
200 bra simulator_show_decoplan4 ; Quit display
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
201
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
202 btfsc sleepmode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
203 goto more_menu
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
204
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
205 btfsc divemode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
206 goto restart ; exit menu, restart and enter divemode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
207
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
208 bra simulator_show_decoplan2
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
209
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
210 simulator_show_decoplan4:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
211 movlw d'5'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
212 movwf menupos
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
213 bra menu_simulator1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
214
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
215
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
216 simulator_calc_deco:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
217 call diveloop_boot ; configure gases, etc.
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
218
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
219 bsf simulatormode_active ; normal simulator mode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
220 bsf standalone_simulator ; Standalone Simulator active
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
221
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
222
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
223 movff logbook_temp2,xA+0
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
224 clrf xA+1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
225 movlw d'100'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
226 movwf xB+0
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
227 clrf xB+1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
228 call mult16x16 ;xA*xB=xC ; Depth in m*100
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
229
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
230 movlw LOW d'1000'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
231 addwf xC+0,F
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
232 movlw HIGH d'1000'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
233 addwfc xC+1,F ; Add 1000mBar
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
234
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
235 movff xC+0,sim_pressure+0
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
236 movff xC+1,sim_pressure+1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
237
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
238 movff sim_pressure+0,amb_pressure+0 ; override readings with simulator values
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
239 movff sim_pressure+1,amb_pressure+1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
240
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
241 call simulator_save_tissue_data ; Stores 32 floats "pre_tissue" into bank3
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
242
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
243 WIN_INVERT .1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
244 DISPLAYTEXT .12 ;" Wait.."
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
245 WIN_INVERT .0
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
246
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
247 simulator_calc_deco_loop1:
32
a776039bda63 simulator-speed increased
heinrichsweikamp
parents: 31
diff changeset
248
0
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
249 ; movlw .011
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
250 ; call PLED_SetColumn
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
251 ; movlw .009
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
252 ; call PLED_SetRow
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
253 ; lfsr FSR2,letter
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
254 ; movff char_O_array_decodepth+0,lo ; Get Depth
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
255 ; bsf leftbind
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
256 ; output_8
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
257 ; bcf leftbind
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
258 ; movlw ' '
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
259 ; movwf POSTINC2
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
260 ;call word_processor
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
261
33
6e5db85382a2 Speedy simulator! New Deco code test 1
heinrichsweikamp
parents: 32
diff changeset
262
32
a776039bda63 simulator-speed increased
heinrichsweikamp
parents: 31
diff changeset
263 call divemode_check_decogases ; Checks for decogases and sets the gases
a776039bda63 simulator-speed increased
heinrichsweikamp
parents: 31
diff changeset
264 call divemode_prepare_flags_for_deco
a776039bda63 simulator-speed increased
heinrichsweikamp
parents: 31
diff changeset
265
a776039bda63 simulator-speed increased
heinrichsweikamp
parents: 31
diff changeset
266 call deco_main_calc_hauptroutine ; calc_tissue
a776039bda63 simulator-speed increased
heinrichsweikamp
parents: 31
diff changeset
267 movlb b'00000001' ; rambank 1 selected
a776039bda63 simulator-speed increased
heinrichsweikamp
parents: 31
diff changeset
268
a776039bda63 simulator-speed increased
heinrichsweikamp
parents: 31
diff changeset
269 movff char_O_deco_status,deco_status ;
a776039bda63 simulator-speed increased
heinrichsweikamp
parents: 31
diff changeset
270 tstfsz deco_status ; deco_status=0 if decompression calculation done
a776039bda63 simulator-speed increased
heinrichsweikamp
parents: 31
diff changeset
271 bra simulator_calc_deco_loop1 ; Not finished
0
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
272
31
2b52a4a7dce6 preparations for new deco code...
heinrichsweikamp
parents: 21
diff changeset
273 movlw d'1'
2b52a4a7dce6 preparations for new deco code...
heinrichsweikamp
parents: 21
diff changeset
274 movff WREG,char_I_step_is_1min ; 1 minute mode
32
a776039bda63 simulator-speed increased
heinrichsweikamp
parents: 31
diff changeset
275
a776039bda63 simulator-speed increased
heinrichsweikamp
parents: 31
diff changeset
276 movlw d'255'
a776039bda63 simulator-speed increased
heinrichsweikamp
parents: 31
diff changeset
277 movff WREG,char_O_deco_status ; Reset Deco module
a776039bda63 simulator-speed increased
heinrichsweikamp
parents: 31
diff changeset
278
a776039bda63 simulator-speed increased
heinrichsweikamp
parents: 31
diff changeset
279 simulator_calc_deco_loop2:
a776039bda63 simulator-speed increased
heinrichsweikamp
parents: 31
diff changeset
280 call PLED_simulator_data
a776039bda63 simulator-speed increased
heinrichsweikamp
parents: 31
diff changeset
281
a776039bda63 simulator-speed increased
heinrichsweikamp
parents: 31
diff changeset
282 btg LED_red
31
2b52a4a7dce6 preparations for new deco code...
heinrichsweikamp
parents: 21
diff changeset
283
0
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
284 call divemode_check_decogases ; Checks for decogases and sets the gases
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
285 call divemode_prepare_flags_for_deco
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
286
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
287 call deco_main_calc_hauptroutine ; calc_tissue
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
288 movlb b'00000001' ; rambank 1 selected
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
289 ostc_debug 'C' ; Sends debug-information to screen if debugmode active
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
290
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
291 decfsz logbook_temp1,F
32
a776039bda63 simulator-speed increased
heinrichsweikamp
parents: 31
diff changeset
292 bra simulator_calc_deco_loop2
a776039bda63 simulator-speed increased
heinrichsweikamp
parents: 31
diff changeset
293
a776039bda63 simulator-speed increased
heinrichsweikamp
parents: 31
diff changeset
294 movlw d'0'
a776039bda63 simulator-speed increased
heinrichsweikamp
parents: 31
diff changeset
295 movff WREG,char_I_step_is_1min ; 2 second deco mode
33
6e5db85382a2 Speedy simulator! New Deco code test 1
heinrichsweikamp
parents: 32
diff changeset
296 ; movff WREG,unused_x24B
32
a776039bda63 simulator-speed increased
heinrichsweikamp
parents: 31
diff changeset
297
a776039bda63 simulator-speed increased
heinrichsweikamp
parents: 31
diff changeset
298 movlw d'255'
a776039bda63 simulator-speed increased
heinrichsweikamp
parents: 31
diff changeset
299 movff WREG,char_O_deco_status ; Reset Deco module
0
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
300
33
6e5db85382a2 Speedy simulator! New Deco code test 1
heinrichsweikamp
parents: 32
diff changeset
301 ; movff char_O_deco_status,deco_status ;
6e5db85382a2 Speedy simulator! New Deco code test 1
heinrichsweikamp
parents: 32
diff changeset
302 ; tstfsz deco_status ; deco_status=0 if decompression calculation done
0
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
303 bra simulator_calc_deco2 ; Not finished
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
304
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
305 simulator_calc_deco3:
21
73014f788032 1.60 stable rc1
heinrichsweikamp
parents: 0
diff changeset
306 bsf LED_red
0
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
307
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
308 call simulator_restore_tissue_data ; Restore 32 floats "pre_tissue" from bank3
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
309
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
310 bcf simulatormode_active ; normal simulator mode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
311 bcf standalone_simulator ; Standalone Simulator active
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
312
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
313 WAITMS d'250'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
314 WAITMS d'250'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
315 WAITMS d'250' ; Wait for Pressure Sensor to get real pressure again...
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
316
21
73014f788032 1.60 stable rc1
heinrichsweikamp
parents: 0
diff changeset
317 bcf LED_red
0
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
318
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
319 movlw d'1'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
320 movwf logbook_temp1 ; Bottom time>0!
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
321
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
322 movlw d'5' ; Pre-Set Cursor to "Show Decoplan"
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
323 movwf menupos
31
2b52a4a7dce6 preparations for new deco code...
heinrichsweikamp
parents: 21
diff changeset
324
0
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
325 bra menu_simulator1 ; Done.
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
326
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
327 simulator_calc_deco2:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
328 call divemode_check_decogases ; Checks for decogases and sets the gases
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
329 call divemode_prepare_flags_for_deco
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
330
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
331 call deco_main_calc_hauptroutine ; calc_tissue
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
332 movlb b'00000001' ; rambank 1 selected
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
333
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
334 movff char_O_deco_status,deco_status ;
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
335 tstfsz deco_status ; deco_status=0 if decompression calculation done
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
336 bra simulator_calc_deco2 ; Not finished
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
337 bra simulator_calc_deco3 ; finished!