Added GPRMB

This commit is contained in:
mort5161 2014-07-25 14:21:41 -07:00
parent 9663da9cf2
commit 6c1ae5db06
4 changed files with 186 additions and 2 deletions

View file

@ -0,0 +1,122 @@
//
// Copyright (c) 2014 Morten Nielsen
//
// Licensed under the Microsoft Public License (Ms-PL) (the "License");
// you may not use this file except in compliance with the License.
// You may obtain a copy of the License at
//
// http://opensource.org/licenses/Ms-PL.html
//
// Unless required by applicable law or agreed to in writing, software
// distributed under the License is distributed on an "AS IS" BASIS,
// WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
// See the License for the specific language governing permissions and
// limitations under the License.
//
using System;
using System.Collections.Generic;
using System.Globalization;
using System.Linq;
using System.Text;
using System.Threading.Tasks;
namespace NmeaParser.Nmea.Gps
{
/// <summary>
/// Recommended minimum navigation information
/// </summary>
[NmeaMessageType(Type = "GPRMB")]
public class Gprmb : NmeaMessage
{
public enum DataStatus
{
OK,
Warning
}
protected override void LoadMessage(string[] message)
{
Status = message[0] == "A" ? DataStatus.OK : Gprmb.DataStatus.Warning;
double tmp;
if (double.TryParse(message[1], NumberStyles.Float, CultureInfo.InvariantCulture, out tmp))
{
CrossTrackError = tmp;
if (message[2] == "L") //Steer left
CrossTrackError *= -1;
}
else
CrossTrackError = double.NaN;
if(message[3].Length > 0)
OriginWaypointID = int.Parse(message[3], CultureInfo.InvariantCulture);
if (message[3].Length > 0)
DestinationWaypointID = int.Parse(message[4], CultureInfo.InvariantCulture);
DestinationLatitude = NmeaMessage.StringToLatitude(message[5], message[6]);
DestinationLongitude = NmeaMessage.StringToLongitude(message[7], message[8]);
if (double.TryParse(message[9], NumberStyles.Float, CultureInfo.InvariantCulture, out tmp))
RangeToDestination = tmp;
else
RangeToDestination = double.NaN;
if (double.TryParse(message[10], NumberStyles.Float, CultureInfo.InvariantCulture, out tmp))
TrueBearing = tmp;
else
TrueBearing = double.NaN;
if (double.TryParse(message[11], NumberStyles.Float, CultureInfo.InvariantCulture, out tmp))
Velocity = tmp;
else
Velocity = double.NaN;
Arrived = message[12] == "A";
}
/// <summary>
/// Data Status
/// </summary>
public DataStatus Status { get; private set; }
/// <summary>
/// Cross-track error (steer left when negative, right when positive)
/// </summary>
public double CrossTrackError { get; private set; }
/// <summary>
/// Origin waypoint ID
/// </summary>
public double OriginWaypointID { get; private set; }
/// <summary>
/// Destination waypoint ID
/// </summary>
public double DestinationWaypointID { get; private set; }
/// <summary>
/// Destination Latitude
/// </summary>
public double DestinationLatitude { get; private set; }
/// <summary>
/// Destination Longitude
/// </summary>
public double DestinationLongitude { get; private set; }
/// <summary>
/// Range to destination in nautical miles
/// </summary>
public double RangeToDestination { get; private set; }
/// <summary>
/// True bearing to destination
/// </summary>
public double TrueBearing { get; private set; }
/// <summary>
/// Velocity towards destination in knots
/// </summary>
public double Velocity { get; private set; }
/// <summary>
/// Arrived (<c>true</c> if arrived)
/// </summary>
public bool Arrived { get; private set; }
}
}

View file

@ -12,6 +12,7 @@
<Compile Include="$(MSBuildThisFileDirectory)NmeaDevice.cs" />
<Compile Include="$(MSBuildThisFileDirectory)NmeaFileDevice.cs" />
<Compile Include="$(MSBuildThisFileDirectory)Nmea\Gps\GPGGA.cs" />
<Compile Include="$(MSBuildThisFileDirectory)Nmea\Gps\GPRMB.cs" />
<Compile Include="$(MSBuildThisFileDirectory)Nmea\Gps\GPRMC.cs" />
<Compile Include="$(MSBuildThisFileDirectory)Nmea\LaserRangeMessage.cs" />
<Compile Include="$(MSBuildThisFileDirectory)Nmea\LaserTech\LaserRange\PLTIT.cs" />

View file

@ -21,12 +21,69 @@ using System.Text;
using Microsoft.VisualStudio.TestPlatform.UnitTestFramework;
using NmeaParser.Nmea;
using NmeaParser.Nmea.Gps;
using System.Threading.Tasks;
using System.IO;
namespace NmeaParser.Tests
{
[TestClass]
public class NmeaMessages
{
[TestMethod]
public async Task ParseNmeaFile()
{
var file = await Windows.Storage.StorageFile.GetFileFromApplicationUriAsync(new Uri("ms-appx:///NmeaSampleData.txt"));
System.IO.StreamReader reader = new System.IO.StreamReader(await file.OpenStreamForReadAsync());
while(!reader.EndOfStream)
{
var line = reader.ReadLine();
if(line.StartsWith("$"))
{
var msg = NmeaMessage.Parse(line);
Assert.IsNotNull(msg);
Assert.IsNotInstanceOfType(msg, typeof(Nmea.UnknownMessage), "Type " + msg.MessageType + " not supported");
}
}
}
[TestMethod]
public void TestGprmb_Empty()
{
string input = "$GPRMB,A,,,,,,,,,,,,A,A*0B";
var msg = NmeaMessage.Parse(input);
Assert.IsInstanceOfType(msg, typeof(Gprmb));
Gprmb rmb = (Gprmb)msg;
Assert.AreEqual(true, rmb.Arrived);
Assert.AreEqual(double.NaN, rmb.CrossTrackError);
Assert.AreEqual(double.NaN, rmb.DestinationLatitude);
Assert.AreEqual(double.NaN, rmb.DestinationLongitude);
Assert.AreEqual(0, rmb.DestinationWaypointID);
Assert.AreEqual(0, rmb.OriginWaypointID);
Assert.AreEqual(double.NaN, rmb.RangeToDestination);
Assert.AreEqual(Gprmb.DataStatus.OK, rmb.Status);
Assert.AreEqual(double.NaN, rmb.TrueBearing);
Assert.AreEqual(double.NaN, rmb.Velocity);
}
[TestMethod]
public void TestGprmb()
{
string input = "$GPRMB,A,0.66,L,003,004,4917.24,S,12309.57,W,001.3,052.5,000.5,V*3D";
var msg = NmeaMessage.Parse(input);
Assert.IsInstanceOfType(msg, typeof(Gprmb));
Gprmb rmb = (Gprmb)msg;
Assert.AreEqual(Gprmb.DataStatus.OK, rmb.Status);
Assert.AreEqual(-.66, rmb.CrossTrackError);
Assert.AreEqual(3, rmb.OriginWaypointID);
Assert.AreEqual(4, rmb.DestinationWaypointID);
Assert.AreEqual(-49.287333333333333333, rmb.DestinationLatitude);
Assert.AreEqual(-123.1595, rmb.DestinationLongitude);
Assert.AreEqual(1.3, rmb.RangeToDestination);
Assert.AreEqual(52.5, rmb.TrueBearing);
Assert.AreEqual(.5, rmb.Velocity);
Assert.AreEqual(false, rmb.Arrived);
}
[TestMethod]
public void TestGprmc()
{

View file

@ -9,8 +9,8 @@
<ProjectGuid>{5B5BAF9D-3FB9-47F9-AE07-B8CC43EC887C}</ProjectGuid>
<OutputType>Library</OutputType>
<AppDesignerFolder>Properties</AppDesignerFolder>
<RootNamespace>BTDevices.Tests</RootNamespace>
<AssemblyName>BTDevices.Tests</AssemblyName>
<RootNamespace>NmeaParser.Tests</RootNamespace>
<AssemblyName>NmeaParser.Tests</AssemblyName>
<DefaultLanguage>en-US</DefaultLanguage>
<TargetPlatformVersion>8.1</TargetPlatformVersion>
<MinimumVisualStudioVersion>12</MinimumVisualStudioVersion>
@ -56,6 +56,10 @@
<None Include="NmeaParser.Tests_TemporaryKey.pfx" />
</ItemGroup>
<ItemGroup>
<Content Include="..\NmeaSampleData.txt">
<Link>NmeaSampleData.txt</Link>
<CopyToOutputDirectory>PreserveNewest</CopyToOutputDirectory>
</Content>
<Content Include="Images\UnitTestLogo.scale-100.png">
<CopyToOutputDirectory>PreserveNewest</CopyToOutputDirectory>
</Content>