' ///////////////////////////////////////////////////////////////////////////////\
'| :.:.:::::::::::.:.:Position Finder :.:.:::::::::::.:.: ||
'| Designed By Navid Emad ||
'| Version 1.0 ||
'| ndsoftco@yahoo.com ||
'| ndsoftco@gmail.com ||
' \\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\/
$regfile = "m16def.dat"
$crystal = 8000000
$baud = 9600
' ///////////////////////////////////////////////////////////////////////////////
'| SUBs ----------------------------------------------------------->>>>>>>>>>>>>>
' \\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\
Declare Sub Anim
' ///////////////////////////////////////////////////////////////////////////////
'| CONFIGURATIONs ------------------------------------------------->>>>>>>>>>>>>>
' \\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\
Config Timer1 = Timer , Prescale = 8
Start Timer1
Config Lcd = 16 * 2
Config Lcdpin = Pin , Rs = Porta.5 , E = Porta.4 , Db4 = Porta.0 , Db5 = Porta.1 , Db6 = Porta.2 , Db7 = Porta.3
Cursor Off Noblink
Cls
Config Single = Scientific , Digits = 2
Config Portd.2 = Input
Config Portd.3 = Input : Set Portd.3
Config Portd.4 = Input : Set Portd.4
Config Portd.5 = Input : Set Portd.5
Config Portd.6 = Output : Reset Portd.6
Wave Alias Pind.2
Key_2 Alias Pind.3
Key_3 Alias Pind.4
Key_4 Alias Pind.5
' ///////////////////////////////////////////////////////////////////////////////
'| INTRRUPTs ------------------------------------------------------>>>>>>>>>>>>>>
' \\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\
Enable Interrupts
Enable Timer1
Enable Urxc
On Timer1 Check_pos
On Urxc Serial_data
' ///////////////////////////////////////////////////////////////////////////////
'| LCD CHAR ------------------------------------------------------->>>>>>>>>>>>>>
' \\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\
Deflcdchar 0 , 12 , 18 , 18 , 12 , 32 , 32 , 32 , 32 ' degree
Deflcdchar 1 , 8 , 20 , 8 , 32 , 9 , 13 , 11 , 9 ' north
Deflcdchar 2 , 8 , 20 , 8 , 7 , 8 , 15 , 8 , 15 ' east
Deflcdchar 3 , 32 , 14 , 27 , 21 , 21 , 27 , 14 , 32
' ///////////////////////////////////////////////////////////////////////////////
'| DIMANSIONs ----------------------------------------------------->>>>>>>>>>>>>>
' \\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\
Dim Char As String * 1
Dim Gps_data As String * 100
Dim Gps As String * 100
Dim A As Bit , B As Bit , C As Bit , D As Bit , E As Bit , F As Bit , G As Bit , Cl1 As Bit , Cl2 As Bit
Dim Utc As String * 10
Dim Lat As String * 9 , North As String * 20
Dim Lon As String * 10 , East As String * 20
Dim Rn As String * 20 , Ln As String * 20
Dim Re As String * 20 , Le As String * 20
Dim Rpn As Word , Lpn As Long
Dim Rpe As Word , Lpe As Long
Dim Nn As String * 15
Dim Ee As String * 15
Dim N_var As Long
Dim E_var As Long
Dim Check As Byte
Dim Pos As Byte
Dim Latitude(50) As Eram Long
Dim Longitude(50) As Eram Long
Dim Sat As String * 4
Dim Sats As Byte
Dim I As Byte , Ii As Byte , Acc As Bit
Dim W As String * 17
Dim Send As Byte , Ins1 As Bit , Ins2 As Bit , Wel As Bit
Dim Rsend As Byte
Dim X As Bit , Y As Bit
Dim Chk As Bit , True As Byte
Dim Cc As Bit
Ins1 = 0
Ins2 = 0
Dim Check_np As Long
Dim Check_nn As Long
Dim Check_ep As Long
Dim Check_en As Long
' ///////////////////////////////////////////////////////////////////////////////
'| MACROS --------------------------------------------------------->>>>>>>>>>>>>>
' \\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\
Macro Split_data
Utc = Mid(gps , 2 , 9)
Lat = Mid(gps , 14 , 9)
Lon = Mid(gps , 26 , 10)
Sat = Mid(gps , 41 , 2 ) : Sats = Val(sat)
Rn = Left(lat , 2) : Ln = Mid(lat , 3 , 2) + Right(lat , 4) : Rpn = Val(rn) : Lpn = Val(ln) : Nn = Rn + Left(ln , 6) : N_var = Val(nn)
Re = Left(lon , 3) : Le = Mid(lon , 4 , 2) + Right(lon , 4) : Rpe = Val(re) : Lpe = Val(le) : Ee = Re + Left(le , 6) : E_var = Val(ee)
End Macro
' ///////////////////////////////////////////////////////////////////////////////
'| MAIN ----------------------------------------------------------->>>>>>>>>>>>>>
' \\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\
Do : Split_data
If Sats > 3 Then : I = 0
If Key_2 = 0 And Acc = 0 Then
Acc = 0
Incr Pos
If Pos > 50 Then Pos = 50
Latitude(pos) = N_var
Longitude(pos) = E_var
End If
If Key_2 = 1 And Acc = 1 Then Acc = 0
If Ins1 = 0 Then : Printbin 255 : Ins1 = 1 : End If : Ins2 = 0
If Cl2 = 0 Then : Cls : Cl1 = 0 : Cl2 = 1 : End If
Home
Lcd Rpn ; Chr(1) ; Lpn ; "," ; True
Lowerline
Lcd Rpe ; Chr(2) ; Lpe ; "," ; Pos
Elseif Sats = 0 Then
If Ins2 = 0 Then : Printbin 254 : Ins2 = 1 : End If : Ins1 = 0
If Cl1 = 0 Then : Cls : Cl1 = 1 : Cl2 = 0 : End If
Home : Lcd "WAIT FOR SATS..."
End If
Loop
End
' ///////////////////////////////////////////////////////////////////////////////
'| SUB ROUTINE ---------------------------------------------------->>>>>>>>>>>>>>
' \\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\
'----------------=============== CHECK POSITION ===============-----------------
Check_pos:
Incr Check
If Check > Pos Then Check = 0
Check_np = N_var + 10
Check_nn = N_var - 10
Check_ep = E_var + 10
Check_en = E_var - 10
'--------- check latitude
If Latitude(check) < Check_np And Latitude(check) > Check_nn Then
Set X
Else
Reset X
End If
'--------- check longitude
If Longitude(check) < Check_ep And Longitude(check) > Check_en Then
Set Y
Else
Reset Y
End If
'-----------------------------------
If X = 1 And Y = 1 And Chk = 0 And Pos > 0 Then
Chk = 1
Incr True
If Wave = 1 Then Printbin Check
End If
'--------------------------------------------------
If X = 1 And Y = 0 And Chk = 1 Or X = 0 And Y = 1 And Chk = 1 Then Chk = 0
Return
'--------================= GET $GPGGA DATA FROM MODULE =================--------
Serial_data:
Char = Chr(udr)
If Char <> "" Then
If A = 0 And Char = "$" Then A = 1
If A = 1 And Char = "G" Then B = 1
If B = 1 And Char = "P" Then C = 1
If C = 1 And Char = "G" Then D = 1
If D = 1 And Char = "G" Then E = 1
If E = 1 And Char = "A" Then F = 1
If A = 1 And B = 1 And C = 1 And D = 1 And E = 1 And F = 1 Then
If Len(gps_data) < 72 Then
Gps_data = Gps_data + Char
Elseif Len(gps_data) = 72 Then
Gps = Left(gps_data , 71)
End If
End If
End If
If F = 1 And Udr = 13 Then
A = 0 : B = 0 : C = 0 : D = 0 : E = 0 : F = 0 : Gps_data = ""
End If
Return
دیدگاه