Mercurial > public > hwos_code

diff src/start.asm @ 359:2be48ccfa9de

Find changesets by keywords (author, files, the commit message), revision number or hash, or revset expression.
make AUTO SP available on OSTC2 hardware
author heinrichsweikamp
date Mon, 03 Aug 2015 17:27:05 +0200
parents 2811932b4e99
children a9e35c1327aa
line wrap: on
line diff
--- a/src/start.asm	Mon Aug 03 12:18:18 2015 +0200
+++ b/src/start.asm	Mon Aug 03 17:27:05 2015 +0200
@@ -351,6 +351,19 @@
     decfsz  lo,F
     bra     restart_set_modes_and_flags3
     ; CC Mode
+    btfsc   analog_o2_input                 ; cR?
+    bra     restart_set_modes_and_flags2b   ; Yes, skip mode check
+    btfsc   optical_input                   ; 3
+    bra     restart_set_modes_and_flags2b   ; Yes, skip mode check
+    ; Make sure Sensor is not selected
+    ; opt_ccr_mode must be <> 1 (=0: Fixed SP, =1: Sensor, =2: Auto SP)
+    banksel opt_ccr_mode
+    movlw   .1
+    cpfseq  opt_ccr_mode                    ; = Sensor?
+    bra     restart_set_modes_and_flags2b   ; No
+    clrf    opt_ccr_mode                    ; Yes, reset to Fixed SP
+restart_set_modes_and_flags2b:
+    banksel common
 	bsf     FLAG_ccr_mode               ; =1: CCR mode (Fixed SP, Auto SP or Sensor) active
     call    enable_ir_s8                ; Enable IR/S8-Port
     return