' Sendesyntax to GROUND: §GROUND#quittierung#zellspannung1#zellspannung2#gpshoehe#nn#
'
' Sendesyntax to KAPRIG: %KAPRIG#commands#nn#nn#nn#nn#
$regfile = "m8def.dat"
$crystal = 7372800 ' 7,3728 Mhz Quarzoszillator an PB6 / XTAL 1
$hwstack = 32
$swstack = 32
$framesize = 32
$baud = 9600
'Alias
Pwr_all Alias Portb.1 'Abschaltung der Servos und LM2675 (5V für GPS, Video 5,8 GHz Tx)
Pwr_video Alias Portb.2 ' Abschaltung für 5,8 GHz Tx
Pwr_gps Alias Portb.3 ' Abschaltung für GPS
Usb Alias Portb.4 ' Remote für Canon G11 -> Script für CHDK
'Variablen
Dim Spannung1 As Word
Dim Spannung2 As Word
Dim Zellspannung1_orig As Single
Dim Zellspannung2_orig As Single
Dim Zellspannung1 As String * 5
Dim Zellspannung2 As String * 5
Dim Quittierung As String * 21
Dim Gpshoehe As String * 5
Dim Gps_zeichen As Byte
Dim Gpsdaten As String * 98
Dim Gps_header As String * 6
Dim Gps_anzahl As Byte
Dim Gps_teilstring(14) As String * 12
Dim Gps_hoehenteilstring(2) As String * 5
Dim Befehls_zeichen As Byte
Dim Befehlsdaten As String * 101
Dim Befehls_header As String * 7
Dim Befehls_anzahl As Byte
Dim Befehls_teilstring(6) As String * 21
Const Adc_multi = 0.0048828125 ' = 5.0 / 1024.0 -> ADC auflösen
Pwr_all = 1 ' bei Systemstart Peripherie auf ON
Pwr_video = 1
Pwr_gps = 1
'Portkonfiguration / Initialisierung
Config Pwr_all = Output
Config Pwr_video = Output
Config Pwr_gps = Output
Config Usb = Output
Config Lcdpin = Pin , Db4 = Portd.4 , Db5 = Portd.5 , Db6 = Portd.6 , Db7 = Portd.7 , E = Portd.3 , Rs = Portd.2
Config Lcd = 20 * 4
Cls
Cursor Off
Config Adc = Single , Prescaler = Auto , Reference = Avcc 'ADC Wandler definieren
Start Adc 'ADC starten
Config Servos = 2 , Servo1 = Portb.5 , Servo2 = Portb.7 , Reload = 10 ' Servos definieren
Open "COMD.7:9600,8,N,1" For Input As #1 'PB.1 = RxD SoftUART
Declare Sub Xbee ' Senderoutine, um $GROUND#... permanent zu senden
Enable Interrupts
Print "KaprigPRINT"
Locate 1 , 1
Lcd "KaprigControlRxZ1"
Locate 2 , 1
Lcd "KaprigControlRxZ2"
Locate 3 , 1
Lcd "KaprigControlRxZ3"
Locate 4 , 1
Lcd "KaprigControlRxZ3"
Wait 1
Cls
Do
'==========Überwachung von Zelle1 und Zelle2===============================
Spannung1 = Getadc(0) ' Zelle1 messen und berechnen
Zellspannung1_orig = Spannung1 * Adc_multi
Zellspannung1 = Fusing(zellspannung1_orig , "#.#")
Spannung2 = Getadc(1) ' Zelle2 messen und berechnen
Zellspannung2_orig = Spannung2 * Adc_multi
Zellspannung2 = Fusing(zellspannung2_orig , "#.#")
If Zellspannung1_orig <= 3.2 Then ' Zellspannung1 unter/gleich 3,2 Volt dann...
Gosub Lipo_saver
End If
If Zellspannung2_orig <= 3.2 Then ' Zellspannung2 unter/gleich 3,2 Volt dann...
Gosub Lipo_saver
End If
Start Adc ' möglicherweise gstoppten ADC ("Lipo_saver") wieder starten
'==========LCD-Darstellung================================================
Locate 1 , 1
Lcd "Z1: " ; Zellspannung1 ; " V"
Locate 1 , 1
Lcd "Z2: " ; Zellspannung2 ; " V"
'==========Rx Prüfen auf Befehlseingänge==================================
Befehls_zeichen = Inkey() ' Zeichen einlesen
If Befehls_zeichen = 37 Then Input , Befehlsdaten Noecho ' ist "%" vorhanden, dann Daten/HardUART einlesen >> Befehlsdaten
Befehls_header = Mid(befehlsdaten , 1 , 6) 'ersten 6 Zeichen nach Befehls_header einlesen
If Befehls_header = "KAPRIG" Then 'wenn KAPRIG Befehlssatz, dann
Befehls_anzahl = Split(befehlsdaten , Befehls_teilstring(1) , "#") 'aus Befehlsdaten in 6 Teilstrings/Arrays, getrennt durch "#", aufteilen
Befehlsdaten = "" 'befehlsdaten leeren
Gosub Commands ' Auswertung der Befehle/Teilstrings in Subroutine "commands"
End If
'==========GPS-Auswertung (NL-504ETT)=====================================
Gps_zeichen = Inkey(#1) ' Zeichen einlesen
If Gps_zeichen = 36 Then Input #1 , Gpsdaten Noecho ' ist "$" vorhanden, dann Daten/SoftUART #1 einlesen >> Gpsdaten
Gps_header = Mid(gpsdaten , 1 , 5) 'ersten 5 Zeichen nach Gps_header einlesen
If Gps_header = "GPGGA" Then 'wenn GPGGA Befehlssatz, dann
Cls
Gps_anzahl = Split(gpsdaten , Gps_teilstring(1) , ",") 'aus Gpsdaten in 14 Teilstrings/Arrays, getrennt durch ",", aufteilen
Gps_anzahl = Split(gps_teilstring(10) , Gps_hoehenteilstring(1) , ".") 'Teilstring 10, Höhe xxx.xx, aufteilen in Wert vor dem "."
Gpsdaten = "" 'gpsdaten leeren
Gpshoehe = Gps_hoehenteilstring(1) 'gpshoehe = Höhe in Metern vor dem Komma über Meeresspiegel
Locate 1 , 9
Lcd Gpshoehe
End If
Call Xbee ' kontinuierliches Senden der Parameter
Loop
End
'----------------Befehlsbibliothek "Commands"-----------------------------------
Commands:
Select Case Befehls_teilstring(2)
Case "TAKEPHOTO" ' Teilstring(2) auswerten auf "TAKEPHOTO"
Locate 2 , 1
Lcd Befehls_teilstring(2)
Pwr_all = 0
Waitms 500
Pwr_all = 1
Quittierung = "Photo is taken"
Waitms 500
Quittierung = ""
Cls
Case ""
Case ""
End Select
Select Case Befehls_teilstring(3) ' hier optionale Auswertung von weiteren Teilstrings
Case ""
Locate 2 , 1
Lcd Befehls_teilstring(3) ""
End Select
Return
'----------------LiPo-Saver/Abschaltung "Lipo_saver"----------------------------
Lipo_saver:
Quittierung = "LiPo-Saver!" ' Quittierung an Bodenstation
Stop Adc ' ADC abschalten um Strom zu sparen
Stop Ac ' AC abschalten um Strom zu sparen
Pwr_all = 0 ' testweise Ausgabe PWR_all = 0 --> hier: LED an!
Locate 2 , 1
Lcd "LiPo-Saver!"
Waitms 500
Quittierung = "" 'Quittierung löschen
Cls
Return
'----------------Sonstiges------------------------------------------------------
Sub Xbee
Print "§GROUND#" ; Quittierung ; "#" ; Zellspannung1 ; "#" ; Zellspannung2 ; "#" ; Gpshoehe ; "#" ; "#"
End Sub