annotate code_part1/OSTC_code_asm_part1/simulator.asm @ 9:395230c28023

Added CF36: Divemask color
author heinrichsweikamp
date Tue, 09 Mar 2010 13:06:26 +0100
parents 96a35aeda5f2
children 73014f788032
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
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
67 goto menu ; exit setup menu and return to main menu
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
68
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
69 btfsc sleepmode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
70 goto more_menu
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
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
88 movlw d'4'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
89 movwf menupos
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
90 goto more_menu2 ; exit...
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
91
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
92 simulator_inc_bottomtime:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
93 movlw d'2'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
94 addwf logbook_temp1,F ; Here: Bottomtime in m
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
95 movlw d'199'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
96 cpfslt logbook_temp1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
97 movwf logbook_temp1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
98 movlw d'2'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
99 movwf menupos
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
100 bra menu_simulator2
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
101
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
102 simulator_inc_maxdepth:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
103 movlw d'3'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
104 addwf logbook_temp2,F ; Here: Maxdepth in m
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
105 movlw d'99'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
106 cpfslt logbook_temp2
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
107 movwf logbook_temp2
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
108 movlw d'3'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
109 movwf menupos
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
110 bra menu_simulator2
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
111
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
112 simulator_startdive:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
113 ; Descent to -3m depth
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
114 ; Set standalone_simulator flag (Displays Simulator menu during simulation by pressing ENTER button)
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
115 ; Clear standalone_simulator after (any) dive
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
116 bsf simulatormode_active ; normal simulator mode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
117 bsf standalone_simulator ; Standalone Simulator active
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
118
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
119 movff logbook_temp2,xA+0
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
120 clrf xA+1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
121 movlw d'100'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
122 movwf xB+0
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
123 clrf xB+1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
124 call mult16x16 ;xA*xB=xC ; Depth in m*100
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
125
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
126 movlw LOW d'1000'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
127 addwf xC+0,F
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
128 movlw HIGH d'1000'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
129 addwfc xC+1,F ; Add 1000mBar
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
130
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
131 movff xC+0,sim_pressure+0
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
132 movff xC+1,sim_pressure+1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
133
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
134 movff sim_pressure+0,amb_pressure+0 ; override readings with simulator values
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
135 movff sim_pressure+1,amb_pressure+1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
136
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
137 bcf menubit2
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
138 bcf menubit3
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
139 bcf menubit
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
140 bcf switch_left
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
141 bcf switch_right
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
142
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
143 call simulator_save_tissue_data ; Stores 32 floats "pre_tissue" into bank3
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
144
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
145 bsf divemode ; Set divemode flag
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
146 ostc_debug 'P' ; Sends debug-information to screen if debugmode active
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
147 goto diveloop ; Start Divemode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
148
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
149 simulator_save_tissue_data:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
150 bsf restore_deco_data ; Set restore flag
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
151 ostc_debug 'S' ; Sends debug-information to screen if debugmode active
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
152 call main_push_tissues_to_vault
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
153 movlb 0x01 ; Back to RAM Bank1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
154 ostc_debug 'T' ; Sends debug-information to screen if debugmode active
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
155 return
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
156
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
157 simulator_restore_tissue_data:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
158 bcf restore_deco_data ; clear restore flag
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
159 ostc_debug 'S' ; Sends debug-information to screen if debugmode active
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
160 call main_pull_tissues_from_vault
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
161 movlb 0x01 ; Back to RAM Bank1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
162 ostc_debug 'T' ; Sends debug-information to screen if debugmode active
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
163
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
164 ostc_debug 'G' ; Sends debug-information to screen if debugmode active
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
165 call deco_main_calc_desaturation_time ; calculate desaturation time
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
166 movlb b'00000001' ; select ram bank 1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
167 call calculate_noflytime ; Calc NoFly time
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
168 ostc_debug 'H' ; Sends debug-information to screen if debugmode active
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
169 return
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
170
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
171 simulator_show_decoplan:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
172 call PLED_ClearScreen
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
173 call divemenu_see_decoplan
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
174
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
175 bcf switch_left
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
176 bcf switch_right
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
177
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
178 simulator_show_decoplan2:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
179 btfss onesecupdate
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
180 bra simulator_show_decoplan3
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
181
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
182 call timeout_surfmode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
183 call set_dive_modes
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
184 call test_charger ; check if charger IC is active
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
185 call get_battery_voltage ; get battery voltage
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
186
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
187 bcf onesecupdate ; End of one second tasks
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
188
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
189 simulator_show_decoplan3:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
190 btfsc switch_left
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
191 bra simulator_show_decoplan4 ; Quit display
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
192
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
193 btfsc switch_right
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
194 bra simulator_show_decoplan4 ; Quit display
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
195
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
196 btfsc sleepmode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
197 goto more_menu
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
198
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
199 btfsc divemode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
200 goto restart ; exit menu, restart and enter divemode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
201
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
202 bra simulator_show_decoplan2
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
203
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
204 simulator_show_decoplan4:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
205 movlw d'5'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
206 movwf menupos
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
207 bra menu_simulator1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
208
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
209
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
210 simulator_calc_deco:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
211 call diveloop_boot ; configure gases, etc.
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
212
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
213 bsf simulatormode_active ; normal simulator mode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
214 bsf standalone_simulator ; Standalone Simulator active
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
215
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
216
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
217 movff logbook_temp2,xA+0
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
218 clrf xA+1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
219 movlw d'100'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
220 movwf xB+0
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
221 clrf xB+1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
222 call mult16x16 ;xA*xB=xC ; Depth in m*100
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
223
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
224 movlw LOW d'1000'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
225 addwf xC+0,F
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
226 movlw HIGH d'1000'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
227 addwfc xC+1,F ; Add 1000mBar
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
228
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
229 movff xC+0,sim_pressure+0
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
230 movff xC+1,sim_pressure+1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
231
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
232 movff sim_pressure+0,amb_pressure+0 ; override readings with simulator values
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
233 movff sim_pressure+1,amb_pressure+1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
234
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
235 call simulator_save_tissue_data ; Stores 32 floats "pre_tissue" into bank3
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
236
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
237 WIN_INVERT .1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
238 DISPLAYTEXT .12 ;" Wait.."
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
239 WIN_INVERT .0
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
240
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
241 simulator_calc_deco_loop1:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
242 movlw d'30'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
243 movwf logbook_temp3 ; 30x/Minute
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
244 call PLED_simulator_data
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
245
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
246 ; movlw .011
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
247 ; call PLED_SetColumn
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
248 ; movlw .009
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
249 ; call PLED_SetRow
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
250 ; lfsr FSR2,letter
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
251 ; movff char_O_array_decodepth+0,lo ; Get Depth
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
252 ; bsf leftbind
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
253 ; output_8
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
254 ; bcf leftbind
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
255 ; movlw ' '
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
256 ; movwf POSTINC2
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
257 ;call word_processor
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
258
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
259
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
260 simulator_calc_deco_loop2:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
261 call toggle_LEDr
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
262
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
263 call divemode_check_decogases ; Checks for decogases and sets the gases
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
264 call divemode_prepare_flags_for_deco
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
265
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
266 call deco_main_calc_hauptroutine ; calc_tissue
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
267 movlb b'00000001' ; rambank 1 selected
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
268 ostc_debug 'C' ; Sends debug-information to screen if debugmode active
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
269
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
270 decfsz logbook_temp3,F
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
271 bra simulator_calc_deco_loop2
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
272 decfsz logbook_temp1,F
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
273 bra simulator_calc_deco_loop1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
274
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
275 movff char_O_deco_status,deco_status ;
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
276 tstfsz deco_status ; deco_status=0 if decompression calculation done
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
277 bra simulator_calc_deco2 ; Not finished
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
278
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
279 simulator_calc_deco3:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
280 call set_LEDr
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
281
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
282 call simulator_restore_tissue_data ; Restore 32 floats "pre_tissue" from bank3
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
283
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
284 bcf simulatormode_active ; normal simulator mode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
285 bcf standalone_simulator ; Standalone Simulator active
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
286
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
287 WAITMS d'250'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
288 WAITMS d'250'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
289 WAITMS d'250' ; Wait for Pressure Sensor to get real pressure again...
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
290
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
291 call clear_LEDr
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
292
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
293 movlw d'1'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
294 movwf logbook_temp1 ; Bottom time>0!
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
295
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
296 movlw d'5' ; Pre-Set Cursor to "Show Decoplan"
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
297 movwf menupos
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
298 bra menu_simulator1 ; Done.
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
299
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
300 simulator_calc_deco2:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
301 call divemode_check_decogases ; Checks for decogases and sets the gases
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
302 call divemode_prepare_flags_for_deco
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
303
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
304 call deco_main_calc_hauptroutine ; calc_tissue
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
305 movlb b'00000001' ; rambank 1 selected
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
306
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
307 movff char_O_deco_status,deco_status ;
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
308 tstfsz deco_status ; deco_status=0 if decompression calculation done
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
309 bra simulator_calc_deco2 ; Not finished
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
310 bra simulator_calc_deco3 ; finished!