\\OHARARP-PC\Users\ohararp\Documents\PICBASIC\18F25K20\GM862\GM862_D.bas

Size: px

Start display at page:

Download "\\OHARARP-PC\Users\ohararp\Documents\PICBASIC\18F25K20\GM862\GM862_D.bas"

Estella Sullivan
6 years ago
Views:

1 Device = 18F25K20 Xtal = 16 'Declare PLL_REQ = On 'OPTIMISER_LEVEL = 6 Clear All_Digital = TRUE 'Device Fuse configuration Config_Start FOSC = HS ; HS oscillator FCMEN = OFF ; Fail-Safe Clock Monitor disabled IESO = OFF ; Oscillator Switchover mode disabled PWRT = OFF ; PWRT disabled BOREN = OFF ; Brown-out Reset disabled in hardware and software BORV = 30 ; VBOR set to 3.0 V nominal WDTEN = OFF ; WDT is controlled by SWDTEN bit of the WDTCON register MCLRE = On ; MCLR pin enabled, RE3 input pin disabled LVP = OFF ; Single-Supply ICSP disabled Config_End 'HSERIAL = 9600 BAUD RCSTA = $90 ' Enable serial port & continuous receive TXSTA = $24 ' Enable transmit, BRGH = 1 SPBRG = 160 ' MHz, -0.08% SPBRGH = 1 ' BRGH =1 Option in SPRBG Calculator BAUDCON.3 = 1 ' Enable 16 bit baudrate generator 'Extract the Value Variables Dim GM862_BLOOP As Byte ' \ Dim GM862_EXTRACT_ITEM As Byte ' \ Dim GM862_COMMA_COUNT As Byte ' General purpose variables Dim GM862_CHARPOS As Byte ' / Dim GM862_CHAR As Byte ' / Dim GM862_LEN As Byte Dim GPSACP_TEST As Byte 'HARDWARE PINS Dim ON_OFF_PIN As PORTC.0 Dim RESET_PIN As PORTC.1 ' LED VARIABLES Dim BLINKM_BLU As PORTB.2 Dim BLINKM_GRN As PORTB.3 Dim BLINKM_RED As PORTB.4 Dim BLINKM_NUM As Byte'# of blinks Dim BLINKM_DEL As Byte 'Blink Delay Value Dim BLINKM_VAR As Byte 'Control LED Color bit.4=r, bit.3=g, bit.2=b Dim BLINKM_IDX As Byte 'GM862_PARSE Variables Dim GM862_DATA_STRING[20] As Byte ' Temp buffer Symbol GM862_RXBUFFER_LENGTH = 100 Dim GM862_RXBUFF[GM862_RXBUFFER_LENGTH] As Byte ' Serial buffer for NMEA sentences Dim GPSACP_STR[GM862_RXBUFFER_LENGTH] As Byte 'String to Float Variables Dim N As Byte Dim STF_STRING_IN[20] As Byte 'String to Float Variables Dim STF_POWER_10 Page 1 of 9

2 Dim STF_RESULT Dim STF_SIGN As Byte Dim STF_CHAR As Byte Dim STF_CHARPOS As Byte Dim STF_TEMP Dim TEST_CHAR As Byte Dim TEST_CHAR_IDX As Byte 'String to Float Variables Dim DDMM_STRING_IN[20] As Byte 'String to Float Variables Dim DDMM_POWER_10 Dim DDMM_RESULT Dim DDMM_SIGN As Byte Dim DDMM_CHAR As Byte Dim DDMM_CHARPOS As Byte Dim DDMM_CHARPOS_LOW As Byte Dim DDMM_TEMP Dim DDMM_TEMP_STR[6] As Byte 'GPS Varibles Dim LAT Dim SIGN_LAT Dim LON Dim SIGN_LON Dim FIX As Byte Dim SAT As Byte Dim ALT Dim SPD Dim HDG 'Position of Dilution Precision Variables Dim PDOP Dim HDOP Dim VDOP 'GENERIC VARIABLES Dim IDX_MAIN0 As Byte Dim IDX_MAIN1 As Byte Dim IDX_SEND_TEXT As Byte Dim IDX_GPSACP As Byte IDX_SEND_TEXT = 0 Dim CZ_TEST As Byte DelayMS INIT: SerOut PORTB.7,84,["BEGIN INIT",13,10] High BLINKM_BLU High BLINKM_GRN High BLINKM_RED BLINKM_VAR = %111 BLINKM_NUM = 10 High ON_OFF_PIN SerOut PORTB.7,84,["PULLING ON_OFF PIN HIGH",13,10] Page 2 of 9

3 DelayMS 2500 Low ON_OFF_PIN Low RESET_PIN SerOut PORTB.7,84,["PULLING ON_OFF PIN LOW",13,10] DelayMS 5000 MAIN: SerOut PORTB.7,84,["SENDING AT#BND=1",13,10] HSerOut ["AT#BND=1",13,10] GoSub RECEIVE_OK DelayMS 1000 IDX_GPSACP = 0 Clear GM862_CHARPOS For IDX_GPSACP = 0 To 24 'Setup reasonable # of tries to get a GPS Fix SerOut PORTB.7,84,["GETTING GPS LOCATION - ",Dec IDX_GPSACP,13,10] GoSub GPSACP_EXTRACT GoSub GPSACP_PROCESS If Len (GM862_RXBUFF) > 54 Then Break 'Breakout of loop when reasonable gps fix is received Next GoSub SEND_TEXT SerOut PORTB.7,84,["ENTERING WAIT LOOP",13,10] For IDX_MAIN0 = 1 To 1 For IDX_MAIN1 = 0 To 59 DelayMS 1000 BLINKM_VAR = %101 BLINKM_DEL = 10 BLINKM_NUM = 5 SerOut PORTB.7,84,["WAIT LOOP TIME - ",Dec IDX_MAIN0,":",Dec2 IDX_MAIN1," MIN",13,10] Next Next GoTo MAIN RECEIVE_OK: HSerIn 1000, TOUT0, [Wait("OK")] SerOut PORTB.7,84,["OK FOUND",13,10] BLINKM_VAR = %010 TOUT0: SerOut PORTB.7,84,["OK NOT FOUND",13,10] BLINKM_VAR = %100 GoTo INIT Page 3 of 9

4 BLINKM: For BLINKM_IDX = 0 To BLINKM_NUM If BLINKM_VAR.0 = 1 Then Low BLINKM_BLU If BLINKM_VAR.1 = 1 Then Low BLINKM_GRN If BLINKM_VAR.2 = 1 Then Low BLINKM_RED DelayMS BLINKM_DEL High BLINKM_BLU High BLINKM_GRN High BLINKM_RED DelayMS BLINKM_DEL Next SEND_TEXT: IDX_SEND_TEXT = 0 SEND_TEXT_RESTART: SerOut PORTB.7,84,["SENDING AT#BND=1",13,10] HSerOut ["AT#BND=1",13,10] GoSub RECEIVE_OK SerOut PORTB.7,84,["SENDING AT+CSCA= ,145",13,10] HSerOut["AT+CSCA= ,145",13,10] DelayMS 1000 SerOut PORTB.7,84,["SENDING AT+CMGF=1",13,10] HSerOut["AT+CMGF=1",13,10] DelayMS 1000 SerOut PORTB.7,84,["SENDING AT+CMGS=40404",13,10] HSerOut["AT+CMGS=40404",13,10] CZ_TEST = 1 HSerIn 2500,SEND_TEXT_TIMEOUT,[Wait(">")] SEND_TEXT_TIMEOUT_RETURN: Select CZ_TEST Case 1 SerOut PORTB.7,84,["> FOUND ",13,10] SerOut PORTB.7,84,[" LAT,44,Dec8 LON,13,10] HSerOut[" LAT,44,Dec8 LON,$1A,13, 10] BLINKM_VAR = %010 Case 0 SerOut PORTB.7,84,["SEND TEXT ERROR - ",Dec IDX_SEND_TEXT,13,10] If IDX_SEND_TEXT < 5 Then DelayMS SerOut PORTB.7,84,["RESENDING TEXT - ",Dec IDX_SEND_TEXT,13,10] Inc IDX_SEND_TEXT GoTo SEND_TEXT_RESTART Page 4 of 9

5 EndSelect SEND_TEXT_TIMEOUT: SerOut PORTB.7,84,["> NOT FOUND",13,10] BLINKM_VAR = %100 CZ_TEST = 0 GoTo SEND_TEXT_TIMEOUT_RETURN GPSACP_EXTRACT: GPSACP_TEST = 1 SerOut PORTB.7,84,["SENDING AT$GPSACP",13,10] HSerOut["AT$GPSACP",13,10] HSerIn 2500,GPSACP_TIMEOUT,[Wait("$GPSACP: ")] GPSACP_TIMEOUT_RETURN: Select GPSACP_TEST Case 1 GoSub RECEIVE_GP_SENTENCE BLINKM_VAR = %010 If Len (GM862_RXBUFF) < 54 Then BLINKM_VAR = %110 Case 0 SerOut PORTB.7,84,["GPSACP ELSE IF",13,10] EndSelect GPSACP_TIMEOUT: SerOut PORTB.7,84,["$GPSACP: NOT FOUND",13,10] BLINKM_VAR = %110 GPSACP_TEST = 0 GoTo GPSACP_TIMEOUT_RETURN RECEIVE_GP_SENTENCE: Clear GM862_CHARPOS Clear GM862_RXBUFF Repeat ' Create a loop to receive the serial string HSerIn [GM862_CHAR] ' Receive a character serially If GM862_CHAR = 13 Then Break ' Exit the loop if the string reaches the end GM862_RXBUFF[GM862_CHARPOS] = GM862_CHAR ' Convert ASCII to INT and load array GM862_RXBUFF Inc GM862_CHARPOS ' Increment Character Position Until GM862_CHARPOS > GM862_RXBUFFER_LENGTH ' Repeat the loop until the buffer runs out SerOut PORTB.7,84,["MESSAGE RECEIVED - ",Str GM862_RXBUFF," CHARPOS - ",Dec GM862_CHARPOS,13,10] Page 5 of 9

6 GPSACP_PROCESS: 'GET LAT GM862_EXTRACT_ITEM = 1 GoSub EXTRACT_THE_VALUE GM862_LEN = Len (GM862_DATA_STRING) 'SerOut PORTB.7,84,["GM862_DATA_STRING:",Str GM862_DATA_STRING,":LEN = ", Dec GM862_LEN,13,10] If GM862_LEN > 0 Then If GM862_DATA_STRING[GM862_LEN-1] = "N" Then SIGN_LAT = 1 If GM862_DATA_STRING[GM862_LEN-1] = "S" Then SIGN_LAT = -1 'SerOut PORTB.7,84,["SIGN_TEST:",GM862_DATA_STRING[GM862_LEN-1], ":SIGN_LAT = ",Dec SIGN_LAT,13,10] GM862_DATA_STRING[GM862_LEN-1] = 0 'Null Terminate This Value Str STF_STRING_IN = Str GM862_DATA_STRING GoSub STRING_TO_FLOAT LAT = STF_RESULT / 100 StrN DDMM_STRING_IN = Str$(Dec8 LAT) GoSub DDMM_TO_FLOAT LAT = DDMM_RESULT * SIGN_LAT 'SerOut PORTB.7,84,["LAT:",Dec8 LAT,13,10] 'GET LON GM862_EXTRACT_ITEM = 2 GoSub EXTRACT_THE_VALUE GM862_LEN = Len (GM862_DATA_STRING) 'SerOut PORTB.7,84,["GM862_DATA_STRING:",Str GM862_DATA_STRING,":LEN = ", Dec GM862_LEN,13,10] If GM862_LEN > 0 Then If GM862_DATA_STRING[GM862_LEN-1] = "E" Then SIGN_LON = 1 If GM862_DATA_STRING[GM862_LEN-1] = "W" Then SIGN_LON = -1 'SerOut PORTB.7,84,["SIGN_TEST:",GM862_DATA_STRING[GM862_LEN-1], ":SIGN_LON = ",Dec SIGN_LAT,13,10] GM862_DATA_STRING[GM862_LEN-1] = 0 'Null Terminate This Value Str STF_STRING_IN = Str GM862_DATA_STRING GoSub STRING_TO_FLOAT LON = STF_RESULT / 100 StrN DDMM_STRING_IN = Str$(Dec8 LON) GoSub DDMM_TO_FLOAT LON = DDMM_RESULT * SIGN_LON 'SerOut PORTB.7,84,["LON:",Dec8 LON,13,10] EXTRACT_THE_VALUE : Clear GM862_DATA_STRING GM862_COMMA_COUNT = 0 ' Reset the comma counting variable GM862_CHARPOS = 0 ' Start at the beginning of the array Repeat GM862_CHAR = GM862_RXBUFF[GM862_CHARPOS] ' Scan the array to parse Page 6 of 9

7 If GM862_CHAR = "," Then Inc GM862_COMMA_COUNT GM862_COMMA_COUNT if a comma is found If GM862_COMMA_COUNT = GM862_EXTRACT_ITEM Then the correct comma? GM862_BLOOP = 0 ' Increment ' Have we found ' Yes. So... Repeat ' Form a loop Inc GM862_CHARPOS ' Skip over the comma and keep scanning the array GM862_CHAR = GM862_RXBUFF[GM862_CHARPOS] ' Extract the pieces of the value into GM862_CHAR If GM862_CHAR = 0 Then If GM862_CHAR = "," Then GM862_DATA_STRING[GM862_BLOOP] = GM862_CHAR'- 48 ' Fill GM862_DATA_STRING with the value, (converted into integers) Inc GM862_BLOOP ' Point to the next data piece Until GM862_CHARPOS > GM862_RXBUFFER_LENGTH ' Keep looping until a terminator is found, or the array runs out Inc GM862_CHARPOS Until GM862_CHARPOS > GM862_RXBUFFER_LENGTH STRING_TO_FLOAT: STF_POWER_10 = 1 STF_RESULT = 0 STF_SIGN = 0 STF_CHARPOS = 0 STF_CHAR = STF_STRING_IN[STF_CHARPOS] ' \ Get a character from the String Inc STF_CHARPOS ' / If STF_CHAR = "-" Then ' Have we found a "-" character? STF_CHAR = STF_STRING_IN[STF_CHARPOS] ' \ Yes. So Discard the "-" character Inc STF_CHARPOS ' / STF_SIGN = 1 ' Indicate that the value is negative Else If STF_CHAR = "+" Then ' Have we found a "+" character? STF_CHAR = STF_STRING_IN[STF_CHARPOS] ' \ Yes. So Discard the "+" character Inc STF_CHARPOS ' / While 1 = 1 ' Scan the digits before the decimal point (if included) If STF_CHAR < "0" Then Break ' \ If STF_CHAR > "9" Then Break ' / Exit the loop if non numeric characters found STF_RESULT = STF_RESULT * 10 ' \ STF_RESULT = STF_RESULT + STF_CHAR ' Calculate the whole part of the floating point value STF_RESULT = STF_RESULT - "0" ' / string Wend STF_CHAR = STF_STRING_IN[STF_CHARPOS] ' \ Inc STF_CHARPOS ' / Get another character from the If STF_CHAR == "." Then ' Have we found a "." character? STF_CHAR = STF_STRING_IN[STF_CHARPOS] ' \ Yes. So Discard the "." character Inc STF_CHARPOS ' / While 1 = 1 included) ' Scan the digits after the decimal point (if Page 7 of 9

8 If STF_CHAR < "0" Then Break ' \ If STF_CHAR > "9" Then Break ' / Exit the loop if non numeric characters found STF_POWER_10 = STF_POWER_10 * 10 ' \ STF_TEMP = (STF_CHAR - "0") / STF_POWER_10 ' Calculate the fractional part of the floating point value STF_RESULT = STF_RESULT + STF_TEMP ' / STF_CHAR = STF_STRING_IN[STF_CHARPOS] ' \ Inc STF_CHARPOS ' / Get another character from the string Wend If STF_SIGN = 1 Then STF_RESULT = -STF_RESULT ' Convert to negative if required ' 'Convert from DD.MMSS to Decimal Degrees DDMM_TO_FLOAT: DDMM_POWER_10 = 1 DDMM_RESULT = 0 DDMM_SIGN = 0 DDMM_CHARPOS = 0 DDMM_CHARPOS_LOW = 0 DDMM_CHAR = DDMM_STRING_IN[DDMM_CHARPOS] ' \ Get a character from the String Inc DDMM_CHARPOS ' / If DDMM_CHAR = "-" Then ' Have we found a "-" character? DDMM_CHAR = DDMM_STRING_IN[DDMM_CHARPOS] ' \ Yes. So Discard the "-" character Inc DDMM_CHARPOS ' / DDMM_SIGN = 1 ' Indicate that the value is negative Else If DDMM_CHAR = "+" Then ' Have we found a "+" character? DDMM_CHAR = DDMM_STRING_IN[DDMM_CHARPOS] ' \ Yes. So Discard the "+" character Inc DDMM_CHARPOS ' / While 1 = 1 ' Scan the digits before the decimal point (if included) If DDMM_CHAR < "0" Then Break ' \ If DDMM_CHAR > "9" Then Break ' / Exit the loop if non numeric characters found DDMM_RESULT = DDMM_RESULT * 10 ' \ DDMM_RESULT = DDMM_RESULT + DDMM_CHAR ' Calculate the whole part of the floating point value DDMM_RESULT = DDMM_RESULT - "0" ' / DDMM_CHAR = DDMM_STRING_IN[DDMM_CHARPOS] ' \ Inc DDMM_CHARPOS ' / Get another character from the string Wend If DDMM_CHAR == "." Then ' Have we found a "." character? DDMM_CHAR = DDMM_STRING_IN[DDMM_CHARPOS] ' \ Yes. So Discard the "." character Inc DDMM_CHARPOS ' / While 1 = 1 ' Scan the digits after the decimal point (if included) If DDMM_CHAR < "0" Then Break ' \ If DDMM_CHAR > "9" Then Break ' / Exit the loop if non numeric characters found DDMM_TEMP_STR[DDMM_CHARPOS_LOW] = DDMM_CHAR Page 8 of 9

9 DDMM_CHAR = DDMM_STRING_IN[DDMM_CHARPOS] ' \ Inc DDMM_CHARPOS ' / Get another character from the string Inc DDMM_CHARPOS_LOW If DDMM_CHARPOS_LOW = 5 Then Break 'Quit at DEC6 Wend DDMM_TEMP = Val(DDMM_TEMP_STR,Dec) ' Convert String to Decimal DDMM_TEMP = DDMM_TEMP / ' Convert.MMMMM to.dddd DDMM_RESULT = DDMM_RESULT + DDMM_TEMP If DDMM_SIGN = 1 Then DDMM_RESULT = -DDMM_RESULT ' Convert to negative if required Page 9 of 9

#pragma config Usage. #pragma config Settings. #pragma config <setting>=<named value>

#pragma config Usage. #pragma config Settings. #pragma config <setting>=<named value> 1 z 6 27.3.2015 17:21 #pragma config Usage #pragma config = // Oscillator Selection bits: 11XX External RC oscillator, CLKO function on RA6 // Fail-Safe Clock Monitor Enable bit: