|
|
@@ -1,391 +0,0 @@
|
|
|
-<?php
|
|
|
-//////////////////////////////////////////////////////////////////////////////////////////////////////////////
|
|
|
-//class.nmea.parser.php
|
|
|
-///////////////////////////////////////////////////////////////////////////////////////////////////////////////
|
|
|
-// NmeaParser Class
|
|
|
-// Version: 1.0
|
|
|
-// Author: Terry Griffin
|
|
|
-// Based on Code written by: David Boardman
|
|
|
-// URL: http://cs.mwsu.edu/~griffin
|
|
|
-// Licensed: GNU General Public License (GNU GPL)
|
|
|
-//
|
|
|
-// Do what you want with the code.
|
|
|
-// Filtering not implemented yet....
|
|
|
-///////////////////////////////////////////////////////////////////////////////////////////////////////////////
|
|
|
-class NmeaParser{
|
|
|
- private $Nmea; //Nmea Array of data
|
|
|
- private $TimeStamp; //Unix time stamp
|
|
|
- private $maxHDOP; //max horizontal dilution of precision
|
|
|
- private $maxVDOP; //max horizontal dilution of precision
|
|
|
- private $CurrentUTC; //Current time stamp to coordinate sentences
|
|
|
-
|
|
|
- function __construct(){
|
|
|
- $this->Nmea = array();
|
|
|
- $this->TimeStamp= 0;
|
|
|
- $this->maxHDOP = 0.0;
|
|
|
- $this->maxVDOP = 0.0;
|
|
|
- $this->CurrentUTC = 0;
|
|
|
- $this->CurrentTime=0;
|
|
|
- }
|
|
|
-
|
|
|
- ///////////////////////////////////////////////////////////////////////////////////////////////////////////
|
|
|
- //SetMinSatellites - Set the minimum satellite parameter to remove / ignore sentences that don't have
|
|
|
- //enough satellites for a decent fix.
|
|
|
- //
|
|
|
- //@param - int $minSats - minimum satellites
|
|
|
- //@returns - void
|
|
|
- ///////////////////////////////////////////////////////////////////////////////////////////////////////////
|
|
|
- public function SetMinSatellites($minSats=4){
|
|
|
- $this->minSats = $minSats;
|
|
|
- }
|
|
|
-
|
|
|
- //Dilution of precision:
|
|
|
- //1 Ideal This is the highest possible confidence level to be used for applications demanding the highest possible precision at all times.
|
|
|
- //1-2 Excellent At this confidence level, positional measurements are considered accurate enough to meet all but the most sensitive applications.
|
|
|
- //2-5 Good Represents a level that marks the minimum appropriate for making business decisions. Positional measurements could be used to make reliable in-route navigation suggestions to the user.
|
|
|
- //5-10 Moderate Positional measurements could be used for calculations, but the fix quality could still be improved. A more open view of the sky is recommended.
|
|
|
- //10-20 Fair Represents a low confidence level. Positional measurements should be discarded or used only to indicate a very rough estimate of the current location.
|
|
|
- //>20 Poor At this level, measurements are inaccurate by as much as 300 meters with a 6 meter accurate device (50 DOP × 6 meters) and should be discarded.
|
|
|
-
|
|
|
-
|
|
|
- ///////////////////////////////////////////////////////////////////////////////////////////////////////////
|
|
|
- //SetMaxHdop -
|
|
|
- //Set the maximum (smaller value = better) horizontal dilution of precision parameter to
|
|
|
- //remove / ignore sentences that don't have enough satellites in the correct location in the sky for a
|
|
|
- //decent fix.
|
|
|
- //
|
|
|
- //@param - int $maxHDOP - Hdop value
|
|
|
- //@returns - void
|
|
|
- ///////////////////////////////////////////////////////////////////////////////////////////////////////////
|
|
|
- public function SetMaxHdop($maxHDOP=10){
|
|
|
- $this->maxHDOP = $maxHDOP;
|
|
|
- }
|
|
|
-
|
|
|
- ///////////////////////////////////////////////////////////////////////////////////////////////////////////
|
|
|
- //SetMaxVdop -
|
|
|
- //Set the maximum (smaller value = better) vertical dilution of precision parameter to
|
|
|
- //remove / ignore sentences that don't have enough satellites in the correct location in the sky for a
|
|
|
- //decent fix.
|
|
|
- //
|
|
|
- //@param - int $maxVDOP - Hdop value
|
|
|
- //@returns - void
|
|
|
- ///////////////////////////////////////////////////////////////////////////////////////////////////////////
|
|
|
- public function SetMaxVdop($maxVDOP=10){
|
|
|
- $this->maxVDOP = $maxVDOP;
|
|
|
- }
|
|
|
- ///////////////////////////////////////////////////////////////////////////////////////////////////////////
|
|
|
- //NMEAtoUnixTime - Convert Date and Time to Linux Timestamp
|
|
|
- //
|
|
|
- //@param - string $time - current utc(hhmmss)
|
|
|
- //@param - int $date - current date (mmddyy)
|
|
|
- //@returns - int - timestamp
|
|
|
- ///////////////////////////////////////////////////////////////////////////////////////////////////////////
|
|
|
- private function NMEAtoUnixTime($utc,$date){
|
|
|
- $h = substr($utc,0,2);
|
|
|
- $i = substr($utc,2,2);
|
|
|
- $s = substr($utc,4,2);
|
|
|
- $d = substr($date,0,2);
|
|
|
- $m = substr($date,2,2);
|
|
|
- $y = substr($date,4,2);
|
|
|
- //list($y,$m,$d) = explode('-',$date);
|
|
|
- return mktime($h,$i,$s,$m,$d,$y);
|
|
|
- }
|
|
|
-
|
|
|
- ///////////////////////////////////////////////////////////////////////////////////////////////////////////
|
|
|
- //ParseLine - Parse the current line
|
|
|
- //
|
|
|
- //@param - string $line - current nmea line
|
|
|
- //@returns - void
|
|
|
- ///////////////////////////////////////////////////////////////////////////////////////////////////////////
|
|
|
- public function ParseLine($line){
|
|
|
- $this->NmeaType = $this->SetNmeaType($line);
|
|
|
- switch($this->type){
|
|
|
- case "GPGGA": $this->GPGGA($line);break;
|
|
|
- case "GPGLL": $this->GPGLL($line);break;
|
|
|
- case "GPGSA": $this->GPGSA($line);break;
|
|
|
- case "GPGSV": $this->GPGSV($line);break;
|
|
|
- case "GPRMC": $this->GPRMC($line);break;
|
|
|
- case "GPVTG": $this->GPVTG($line);break;
|
|
|
- default: return;
|
|
|
- }
|
|
|
- }
|
|
|
- ///////////////////////////////////////////////////////////////////////////////////////////////////////////
|
|
|
- //DumpNmea - Returns current Nmea data
|
|
|
- //
|
|
|
- //@param - void
|
|
|
- //@returns - array - Nmea data
|
|
|
- ///////////////////////////////////////////////////////////////////////////////////////////////////////////
|
|
|
- public function DumpNmea(){
|
|
|
- return $this->Nmea;
|
|
|
- }
|
|
|
-
|
|
|
-
|
|
|
- function GoodEnough(){
|
|
|
- return isset($this->Nmea[$this->CurrentUTC]['date']) && isset($this->Nmea[$this->CurrentUTC]['utc']) && isset($this->Nmea[$this->CurrentUTC]['lat']) && isset($this->Nmea[$this->CurrentUTC]['long']);
|
|
|
-
|
|
|
- }
|
|
|
-
|
|
|
- ///////////////////////////////////////////////////////////////////////////////////////////////////////////
|
|
|
- //NmeaType - GPGGA,GPGLL,GPGSA,GPGSV,GPRMC,GPVTG
|
|
|
- //
|
|
|
- //@param - int $NmeaType - what type of nmea sentence is it currently
|
|
|
- //@returns - void
|
|
|
- ///////////////////////////////////////////////////////////////////////////////////////////////////////////
|
|
|
- private function SetNmeaType($line){
|
|
|
- $this->type = trim(strtoupper(substr($line,1,5)));
|
|
|
- return $this->type;
|
|
|
- }
|
|
|
- //////////////////////////////////////////////////////////////////////////////////////////////////////
|
|
|
- //GGA - essential fix data which provide 3D location and accuracy data.
|
|
|
- //
|
|
|
- // $GPGGA,123519,4807.038,N,01131.000,E,1,08,0.9,545.4,M,46.9,M,,*47
|
|
|
- //
|
|
|
- //Where:
|
|
|
- // GGA Global Positioning System Fix Data
|
|
|
- // 123519 Fix taken at 12:35:19 UTC
|
|
|
- // 4807.038,N Latitude 48 deg 07.038' N
|
|
|
- // 01131.000,E Longitude 11 deg 31.000' E
|
|
|
- // 1 Fix quality: 0 = invalid
|
|
|
- // 1 = GPS fix (SPS)
|
|
|
- // 2 = DGPS fix
|
|
|
- // 3 = PPS fix
|
|
|
- // 4 = Real Time Kinematic
|
|
|
- // 5 = Float RTK
|
|
|
- // 6 = estimated (dead reckoning) (2.3 feature)
|
|
|
- // 7 = Manual input mode
|
|
|
- // 8 = Simulation mode
|
|
|
- // 08 Number of satellites being tracked
|
|
|
- // 0.9 Horizontal dilution of position
|
|
|
- // 545.4,M Altitude, Meters, above mean sea level
|
|
|
- // 46.9,M Height of geoid (mean sea level) above WGS84
|
|
|
- // ellipsoid
|
|
|
- // (empty field) time in seconds since last DGPS update
|
|
|
- // (empty field) DGPS station ID number
|
|
|
- // *47 the checksum data, always begins with *
|
|
|
- //////////////////////////////////////////////////////////////////////////////////////////////////////
|
|
|
- private function GPGGA($geostr){
|
|
|
- $split=explode(",",$geostr);
|
|
|
- $this->CurrentUTC = $this->fixUTC($split[1]);
|
|
|
- $this->Nmea[$this->CurrentUTC]['type']['GPGGA']=true;
|
|
|
- $this->Nmea[$this->CurrentUTC]['utc']=$this->fixUTC($split[1]);
|
|
|
- $this->Nmea[$this->CurrentUTC]['lat']=$this->degree2decimal($split[2],$split[3]);
|
|
|
- $this->Nmea[$this->CurrentUTC]['ns']=$split[3];
|
|
|
- $this->Nmea[$this->CurrentUTC]['long']=$this->degree2decimal($split[4],$split[5]);
|
|
|
- $this->Nmea[$this->CurrentUTC]['ew']=$split[5];
|
|
|
- $this->Nmea[$this->CurrentUTC]['gpsqual']=$split[6];
|
|
|
- $this->Nmea[$this->CurrentUTC]['numsat']=$split[7];
|
|
|
- $this->Nmea[$this->CurrentUTC]['hdp']=$split[8];
|
|
|
- $this->Nmea[$this->CurrentUTC]['alt']=$split[9];
|
|
|
- $this->Nmea[$this->CurrentUTC]['un_alt']=$split[10];
|
|
|
- $this->Nmea[$this->CurrentUTC]['geoidal']=$split[11];
|
|
|
- $this->Nmea[$this->CurrentUTC]['un_geoidal']=$split[12];
|
|
|
- $this->Nmea[$this->CurrentUTC]['dgps']=$split[13];
|
|
|
- $this->Nmea[$this->CurrentUTC]['diffstat']=trim($split[14]);
|
|
|
- }
|
|
|
- //////////////////////////////////////////////////////////////////////////////////////////////////////
|
|
|
- // $GPGLL,4916.45,N,12311.12,W,225444,A,*1D
|
|
|
- //
|
|
|
- //Where:
|
|
|
- // GLL Geographic position, Latitude and Longitude
|
|
|
- // 4916.46,N Latitude 49 deg. 16.45 min. North
|
|
|
- // 12311.12,W Longitude 123 deg. 11.12 min. West
|
|
|
- // 225444 Fix taken at 22:54:44 UTC
|
|
|
- // A Data Active or V (void)
|
|
|
- // *iD checksum data
|
|
|
- //////////////////////////////////////////////////////////////////////////////////////////////////////
|
|
|
- private function GPGLL($geostr){
|
|
|
- $split=explode(",",$geostr);
|
|
|
- $this->Nmea[$this->CurrentUTC]['type']['GPGLL']=true;
|
|
|
- $this->CurrentUTC = $this->fixUTC($split[3]);
|
|
|
- $this->Nmea[$this->CurrentUTC]['utc']=$this->fixUTC($split[3]);
|
|
|
- $this->Nmea[$this->CurrentUTC]['status']=$this->dataStatus($split[4]);
|
|
|
- }
|
|
|
- //////////////////////////////////////////////////////////////////////////////////////////////////////
|
|
|
- // $GPGSA,A,3,04,05,,09,12,,,24,,,,,2.5,1.3,2.1*39
|
|
|
- //
|
|
|
- //Where:
|
|
|
- // GSA Satellite status
|
|
|
- // A Auto selection of 2D or 3D fix (M = manual)
|
|
|
- // 3 3D fix - values include: 1 = no fix
|
|
|
- // 2 = 2D fix
|
|
|
- // 3 = 3D fix
|
|
|
- // 04,05... PRNs of satellites used for fix (space for 12)
|
|
|
- // 2.5 PDOP (dilution of precision)
|
|
|
- // 1.3 Horizontal dilution of precision (HDOP)
|
|
|
- // 2.1 Vertical dilution of precision (VDOP)
|
|
|
- // *39 the checksum data, always begins with *
|
|
|
- //////////////////////////////////////////////////////////////////////////////////////////////////////
|
|
|
- private function GPGSA($geostr){
|
|
|
- $split=explode(",",$geostr);
|
|
|
- $this->Nmea[$this->CurrentUTC]['type']['GPGSA']=true;
|
|
|
- $this->Nmea[$this->CurrentUTC]['selectmode']=$split[1];
|
|
|
- $this->Nmea[$this->CurrentUTC]['mode']=$split[2];
|
|
|
- $this->Nmea[$this->CurrentUTC]['sat1']=$split[3];
|
|
|
- $this->Nmea[$this->CurrentUTC]['sat2']=$split[4];
|
|
|
- $this->Nmea[$this->CurrentUTC]['sat3']=$split[5];
|
|
|
- $this->Nmea[$this->CurrentUTC]['sat4']=$split[6];
|
|
|
- $this->Nmea[$this->CurrentUTC]['sat5']=$split[7];
|
|
|
- $this->Nmea[$this->CurrentUTC]['sat6']=$split[8];
|
|
|
- $this->Nmea[$this->CurrentUTC]['sat7']=$split[9];
|
|
|
- $this->Nmea[$this->CurrentUTC]['sat8']=$split[10];
|
|
|
- $this->Nmea[$this->CurrentUTC]['sat9']=$split[11];
|
|
|
- $this->Nmea[$this->CurrentUTC]['sat10']=$split[12];
|
|
|
- $this->Nmea[$this->CurrentUTC]['sat11']=$split[13];
|
|
|
- $this->Nmea[$this->CurrentUTC]['sat12']=$split[14];
|
|
|
- $this->Nmea[$this->CurrentUTC]['pdop']=$split[15];
|
|
|
- $this->Nmea[$this->CurrentUTC]['hdop']=$split[16];
|
|
|
- $this->Nmea[$this->CurrentUTC]['vdop']=$split[17];
|
|
|
- }
|
|
|
- //////////////////////////////////////////////////////////////////////////////////////////////////////
|
|
|
- // $GPGSV,2,1,08,01,40,083,46,02,17,308,41,12,07,344,39,14,22,228,45*75
|
|
|
- //
|
|
|
- //Where:
|
|
|
- // GSV Satellites in view
|
|
|
- // 2 Number of sentences for full data
|
|
|
- // 1 sentence 1 of 2
|
|
|
- // 08 Number of satellites in view
|
|
|
- //
|
|
|
- // 01 Satellite PRN number
|
|
|
- // 40 Elevation, degrees
|
|
|
- // 083 Azimuth, degrees
|
|
|
- // 46 SNR - higher is better
|
|
|
- // for up to 4 satellites per sentence
|
|
|
- // *75 the checksum data, always begins with *
|
|
|
- //////////////////////////////////////////////////////////////////////////////////////////////////////
|
|
|
- //*********needs fixing
|
|
|
- private function GPGSV($geostr){
|
|
|
- $split=explode(",",$geostr);
|
|
|
- $this->Nmea[$this->CurrentUTC]['type']['GPGSV']=true;
|
|
|
- $this->Nmea[$this->CurrentUTC]['satmessages']=$split[1];
|
|
|
- $this->Nmea[$this->CurrentUTC]['messnum']=$split[2];
|
|
|
- $this->Nmea[$this->CurrentUTC]['satview']=$split[3];
|
|
|
- $this->Nmea[$this->CurrentUTC]['satnum']=$split[4];
|
|
|
- $this->Nmea[$this->CurrentUTC]['elevdeg']=$split[5];
|
|
|
- $this->Nmea[$this->CurrentUTC]['azimuthdeg']=$split[6];
|
|
|
- $this->Nmea[$this->CurrentUTC]['snr']=$split[7];
|
|
|
- }
|
|
|
- //////////////////////////////////////////////////////////////////////////////////////////////////////
|
|
|
- //$GPRMC,123519,A,4807.038,N,01131.000,E,022.4,084.4,230394,003.1,W*6A
|
|
|
- //
|
|
|
- //Where:
|
|
|
- // RMC Recommended Minimum sentence C
|
|
|
- // 123519 Fix taken at 12:35:19 UTC
|
|
|
- // A Status A=active or V=Void.
|
|
|
- // 4807.038,N Latitude 48 deg 07.038' N
|
|
|
- // 01131.000,E Longitude 11 deg 31.000' E
|
|
|
- // 022.4 Speed over the ground in knots
|
|
|
- // 084.4 Track angle in degrees True
|
|
|
- // 230394 Date - 23rd of March 1994
|
|
|
- // 003.1,W Magnetic Variation
|
|
|
- // *6A The checksum data, always begins with *
|
|
|
- //////////////////////////////////////////////////////////////////////////////////////////////////////
|
|
|
- private function GPRMC($geostr){
|
|
|
- $split=explode(",",$geostr);
|
|
|
- $this->CurrentUTC = $this->fixUTC($split[1]);
|
|
|
- $this->Nmea[$this->CurrentUTC]['utc']=$this->fixUTC($split[1]);
|
|
|
- $this->Nmea[$this->CurrentUTC]['type']['GPRMC']=true;
|
|
|
- $this->Nmea[$this->CurrentUTC]['statusrmc']=$split[2];
|
|
|
- $this->Nmea[$this->CurrentUTC]['speed']=$split[7];
|
|
|
- $this->Nmea[$this->CurrentUTC]['track']=$split[8];
|
|
|
- $this->Nmea[$this->CurrentUTC]['date']=$split[9];
|
|
|
- $this->Nmea[$this->CurrentUTC]['magvar']=$split[10];
|
|
|
- $this->Nmea[$this->CurrentUTC]['mag_ew']=trim($split[11]);
|
|
|
- if($this->CurrentUTC && $split[9])
|
|
|
- $this->Nmea[$this->CurrentUTC]['Unix'] = $this->NMEAtoUnixTime($this->CurrentUTC,$split[9]);
|
|
|
- }
|
|
|
-
|
|
|
- //////////////////////////////////////////////////////////////////////////////////////////////////////
|
|
|
- //VTG - Velocity made good. The gps receiver may use the LC prefix instead of GP if it is emulating Loran output.
|
|
|
- //
|
|
|
- // $GPVTG,054.7,T,034.4,M,005.5,N,010.2,K*48
|
|
|
- //
|
|
|
- //where:
|
|
|
- // VTG Track made good and ground speed
|
|
|
- // 054.7,T True track made good (degrees)
|
|
|
- // 034.4,M Magnetic track made good
|
|
|
- // 005.5,N Ground speed, knots
|
|
|
- // 010.2,K Ground speed, Kilometers per hour
|
|
|
- // *48 Checksum
|
|
|
- //////////////////////////////////////////////////////////////////////////////////////////////////////
|
|
|
- private function GPVTG($geostr){
|
|
|
- $split=explode(",",$geostr);
|
|
|
- $this->Nmea[$this->CurrentUTC]['type']['GPVTG']=true;
|
|
|
- $this->Nmea[$this->CurrentUTC]['trkdeg1']=$split[1];
|
|
|
- $this->Nmea[$this->CurrentUTC]['t']=$split[2];
|
|
|
- $this->Nmea[$this->CurrentUTC]['trkdeg2']=$split[3];
|
|
|
- $this->Nmea[$this->CurrentUTC]['m']=$split[4];
|
|
|
- $this->Nmea[$this->CurrentUTC]['spdknots']=$spdk=$split[5];
|
|
|
- $this->Nmea[$this->CurrentUTC]['knots']=$split[6];
|
|
|
- $this->Nmea[$this->CurrentUTC]['spdkmph']=$split[7];
|
|
|
- $this->Nmea[$this->CurrentUTC]['kph']=$split[8];
|
|
|
- }
|
|
|
-
|
|
|
- //////////////////////////////////////////////////////////////////////////////////////////////////////
|
|
|
- //degree2decimal-
|
|
|
- //Convert latitude and longitude in degrees minutes seconds format to decimal format.
|
|
|
- //E.g. = 4807.038,N would be 48.12722
|
|
|
- //Formula is as follows
|
|
|
- // Degrees=Degrees
|
|
|
- // .d = M.m/60
|
|
|
- // Decimal Degrees=Degrees+.d
|
|
|
- //////////////////////////////////////////////////////////////////////////////////////////////////////
|
|
|
- private function degree2decimal($deg_coord,$direction,$precision=6){
|
|
|
- $degree=(int)($deg_coord/100); //simple way
|
|
|
- $minutes= $deg_coord-($degree*100);
|
|
|
- $dotdegree=$minutes/60;
|
|
|
- $decimal=$degree+$dotdegree;
|
|
|
- //South latitudes and West longitudes need to return a negative result
|
|
|
- if (($direction=="S") or ($direction=="W"))
|
|
|
- {
|
|
|
- $decimal=$decimal*(-1);
|
|
|
- }
|
|
|
- $decimal=number_format($decimal,$precision,'.',''); //truncate decimal to $precision places
|
|
|
- return $decimal;
|
|
|
- }
|
|
|
-
|
|
|
- //////////////////////////////////////////////////////////////////////////////////////////////////////
|
|
|
- //TimeChanged-
|
|
|
- //@param int $Time - time value
|
|
|
- //@return bool 0,1 (If both time are not equal, then we are processing new nmea data.)
|
|
|
- //
|
|
|
- //////////////////////////////////////////////////////////////////////////////////////////////////////
|
|
|
- private function TimeChanged($Time){
|
|
|
- return $this->CurrentTime==$Time;
|
|
|
- }
|
|
|
-
|
|
|
- //////////////////////////////////////////////////////////////////////////////////////////////////////
|
|
|
- //GetNmeaData-
|
|
|
- //@param void
|
|
|
- //@return array - nmea data array
|
|
|
- //
|
|
|
- //////////////////////////////////////////////////////////////////////////////////////////////////////
|
|
|
- public function GetNmeaData(){
|
|
|
- return $this->Nmea;
|
|
|
- }
|
|
|
-
|
|
|
- //////////////////////////////////////////////////////////////////////////////////////////////////////
|
|
|
- //fixUTCKey-
|
|
|
- //Replaces keys based on UTC with a linux time stamp.
|
|
|
- //@param int $UTC - UTC time (time only)
|
|
|
- //@param int $Unix - linux timestamp (has date)
|
|
|
- //////////////////////////////////////////////////////////////////////////////////////////////////////
|
|
|
- private function fixUTCKey($UTC,$Unix){
|
|
|
- //Not done
|
|
|
- $arr[$newkey] = $arr[$oldkey];
|
|
|
- unset($arr[$oldkey]);
|
|
|
- }
|
|
|
-
|
|
|
- //////////////////////////////////////////////////////////////////////////////////////////////////////
|
|
|
- //cleanUTC-
|
|
|
- //If UTC has a decimal in it, get rid of it.
|
|
|
- //@param int $UTC - UTC time (time only)
|
|
|
- //@return int $UTCfixed -
|
|
|
- //////////////////////////////////////////////////////////////////////////////////////////////////////
|
|
|
- private function fixUTC($UTC){
|
|
|
- //list($Fixed,$Null) = explode('.',$UTC);
|
|
|
- return $UTC; //$Fixed;
|
|
|
- }
|
|
|
-
|
|
|
-
|
|
|
-}
|
|
|
-?>
|
