public void OnGpsLocationUpdate()
{
labelLatitude.Text = "Latitude: " + gpsProvider.GetLatitude();
labelLongitude.Text = "Longitude: " + gpsProvider.GetLongitude();
labelSpeed.Text = "Speed: " + gpsProvider.GetSpeed();
labelDistance.Text = "Distance: " + gpsProvider.GetDistance(startLatitude, startLongitude, gpsProvider.GetLatitude(), gpsProvider.GetLongitude());
startLatitude = gpsProvider.GetLatitude();
startLongitude = gpsProvider.GetLongitude();
}
void ApplyCalibration(bool logDetailsToFile)
{
// apply calibration of given profile to acceleration sensor launch detection
DataItemVehicle vehicle = Database.GetInstance().GetActiveProfile();
RunStartStop startStop = new RunStartStop(vehicle);
if (logDetailsToFile == true)
{
string latitude = gpsProvider.GetLatitude().ToString().Replace(',', '.');
string longitute = gpsProvider.GetLongitude().ToString().Replace(',', '.');
Debug.LogToFile("location [latitude, longitude]: " + latitude + ", " + longitute);
Debug.LogToFile(startStop.GetStartString());
Debug.LogToFile(startStop.GetStopString());
Analytics.TrackLocation(latitude, longitute);
}
accelerometerProvider.SetForceDetectLimit(startStop.GetStartLimit());
accelerometerProvider.SetAxisOffset(vehicle.AxisOffsetX,
vehicle.AxisOffsetY,
vehicle.AxisOffsetZ);
runModeProvider.StopDetectionLimit = startStop.GetStopLimit();
}
public void AddStartLocation(IDeviceGps gps, float time)
{
startLatitudeList.Add(gps.GetLatitude());
startLongitudeList.Add(gps.GetLongitude());
startAltitudeList.Add(gps.GetAltitude());
lastTime = time;
}
public void AddRunLocation(IDeviceGps gps, float time, float speed, bool isRunStart)
{
float deltaTime = time - lastTime;
float distance = 0;
float height = 0;
if (isRunStart)
{
if ((mode.Equals(RunModeAcceleration.Mode)) || (mode.Equals(RunModeZeroToZero.Mode)))
{
// vehicle launched from zero speed
// in mode acceleration OR zerotozero -> we can make the start location more precise
if ((startLatitudeList.Count > 0))
{
// some locations were reported until vehicle launched -> use them as starting point
startLatitude = startLatitudeList.Average();
startLongitude = startLongitudeList.Average();
startAltitude = startAltitudeList.Average();
}
else
{
// cannot make location more precise -> use given location
startLatitude = gps.GetLatitude();
startLongitude = gps.GetLongitude();
startAltitude = gps.GetAltitude();
}
}
else
{
// vehicle reached target speed in mode "brake"
// in mode brake -> use last known location as starting point
if (startLatitudeList.Count > 0)
{
// some locations were reported since vehicle launched in brake mode
startLatitude = startLatitudeList.Last();
startLongitude = startLongitudeList.Last();
startAltitude = startAltitudeList.Last();
// check if given location is same as last known location
if (IsLocationEqual(startLatitude, startLongitude, gps.GetLatitude(), gps.GetLongitude()))
{
// given location is same as last known location -> add the distance (=speed*time) traveled since last gps update
// this is the case in 95% of all cases, because this method is called 20 times a seconds, but gps update is only 1Hz
distance = speed * deltaTime;
}
else
{
// this is the case in 5% of all cases (more ore less)
// given location is the freshest location available
startLatitude = gps.GetLatitude();
startLongitude = gps.GetLongitude();
startAltitude = gps.GetAltitude();
}
}
else
{
// no locations were reported since launch -> use given location as starting point
startLatitude = gps.GetLatitude();
startLongitude = gps.GetLongitude();
startAltitude = gps.GetAltitude();
}
}
}
else
{
// given location is not a start location -> measurement is running
distanceGps = gps.GetDistance(startLatitude, startLongitude, gps.GetLatitude(), gps.GetLongitude());
if ((mode.Equals(RunModeAcceleration.Mode)) || (mode.Equals(RunModeZeroToZero.Mode)))
{
if (IsLocationEqual(lastLatitude, lastLongitude, gps.GetLatitude(), gps.GetLongitude()))
{
// no gps update since last call -> add distance traveled since last gps update to the filter
// this is the case in 95% of all cases, because this method is called 20 times a seconds, but gps update is only 1Hz
distance = distanceFiltered + speed * deltaTime;
}
else
{
// given location is a new one
// insert a reference from the gps-driver to the filter (correct our speed/time drift)
distance = distanceGps;
}
}
else
{
// we are in mode "brake" -> just integrate speed by time -> add distance traveled to the filter
// inserting a reference from the gps-driver would be more incorrect
distance = distanceFiltered + speed * deltaTime;
}
// "height since start"
height = gps.GetHeight(startAltitude, gps.GetAltitude());
// add to the height-filter
heightFiltered = heightFilter.Get(height);
// overwrite to the raw buffer
heightGps = height;
}
if (distance > 0.01) // prevent update of filter if no distance was calculated
{
// apply moving average filter
distanceFiltered = distanceFilter.Get(distance);
}
lastTime = time;
lastLatitude = gps.GetLatitude();
lastLongitude = gps.GetLongitude();
}
