1

I'm using Unity3D and I created simple distance, speed and acceleration calculator using latitude and longitude of last position. I'm calculating last distance, speed and acceleration in each GPS update (approximately once per second). But sometimes (2-3 second interval) latitude and longitude values changes rapidly (in clear weather and no obstacles). That's why speed and acceleration values gets unreal results. For example, at stable 40 km/h speed, speed value becomes 60 km/h and returns to 40 km/h within 2-3 second. I'm here to ask how can I avoid this inaccurate and rapid GPS data changes?

I'm using Nexus 5 device

There is my code:

using UnityEngine;
using System.Collections;
using UnityEngine.UI;
using UnityEngine.SceneManagement;

public class Manager : MonoBehaviour
{
public Text longitude, latitude, lonAText, latAText, lonBText, latBText;
public Text result, overallResult, speedText, lastTimeText, timerText, accelerationText, speed0Text;

float lonA, lonB, latA, latB, overallDistance, lastDistance, timer, lastTime, speed, speed0, acceleration;
bool firstTime, allowTimer;

public AudioSource audio;

void Awake()
{
    overallDistance = 0;
    lastDistance = 0;
    timer = 0;
    lastTime = 0;
    speed = 0;
    speed0 = 0;

    firstTime = true;
    allowTimer = true;
}

IEnumerator Start()
{
    // First, check if user has location service enabled
    if (!Input.location.isEnabledByUser)
        yield break;

    // Start service before querying location
    Input.location.Start(1, 1);

    // Wait until service initializes
    int maxWait = 20;
    while (Input.location.status == LocationServiceStatus.Initializing && maxWait > 0)
    {
        yield return new WaitForSeconds(1);
        maxWait--;
    }

    // Service didn't initialize in 20 seconds
    if (maxWait < 1)
    {
        print("Timed out");
        yield break;
    }

    // Connection has failed
    if (Input.location.status == LocationServiceStatus.Failed)
    {
        print("Unable to determine device location");
        yield break;
    }
    else
    {
        // Access granted and location value could be retrieved
        print("Location: " + Input.location.lastData.latitude + " " + Input.location.lastData.longitude + " " + Input.location.lastData.altitude + " " + Input.location.lastData.horizontalAccuracy + " " + Input.location.lastData.timestamp);

        longitude.text = Input.location.lastData.longitude.ToString();
        latitude.text = Input.location.lastData.latitude.ToString();

        lonA = Input.location.lastData.longitude;
        latA = Input.location.lastData.latitude;
    }

    // Stop service if there is no need to query location updates continuously
    //Input.location.Stop();
}

void Update()
{
    longitude.text = Input.location.lastData.longitude.ToString();
    latitude.text = Input.location.lastData.latitude.ToString();

    timer += Time.deltaTime;
    timerText.text = timer.ToString();


    if (lonA != Input.location.lastData.longitude || latA != Input.location.lastData.latitude)
    {
        audio.Play();

        CalculateDistances(lonA, latA, Input.location.lastData.longitude, Input.location.lastData.latitude);  // last distance and overall distanceS            
        lonA = Input.location.lastData.longitude;
        latA = Input.location.lastData.latitude;

        lastTime = timer;
        lastTimeText.text = lastTime.ToString();
        timer = 0;


        speed0 = speed;
        speed0Text.text = speed0.ToString();

        CalculateSpeed();

        CalculateAcceleration();
    }            
}   

public static float Radians(float x)
{
    return x * Mathf.PI / 180;
}

public void CalculateDistances(float firstLon, float firstLat, float secondLon, float secondLat)
{
    lonAText.text = firstLon.ToString();
    latAText.text = firstLat.ToString();

    lonBText.text = secondLon.ToString();
    latBText.text = secondLat.ToString();

    float dlon = Radians(secondLon - firstLon);
    float dlat = Radians(secondLat - firstLat);

    float distance = Mathf.Pow(Mathf.Sin(dlat / 2), 2) + Mathf.Cos(Radians(firstLat)) * Mathf.Cos(Radians(secondLat)) * Mathf.Pow(Mathf.Sin(dlon / 2), 2);

    float c = 2 * Mathf.Atan2(Mathf.Sqrt(distance), Mathf.Sqrt(1 - distance));

    lastDistance = 6371 * c * 1000; 

    result.text = lastDistance.ToString() + " meters";

    overallDistance += lastDistance;  // bu 1 anliq 6.000.000-dan boyuk qiymet ala biler

    StartCoroutine(Overall());
}

IEnumerator Overall()
{
    if (firstTime)
    {
        firstTime = false;

        yield return new WaitForSeconds(2);

        if (overallDistance > 6000000)
        {
            overallDistance = 0;
            lastDistance = 0;
        }
    }

    overallDistance += lastDistance;
    overallResult.text = overallDistance.ToString() + " meters";
}

void CalculateSpeed()
{
    speed = lastDistance / lastTime * 3.6f;

    speedText.text = speed.ToString();
}

void CalculateAcceleration()
{
    acceleration = (speed - speed0) / lastTime;
    accelerationText.text = acceleration.ToString();
}
}
desertnaut
  • 57,590
  • 26
  • 140
  • 166
  • How do you calculate speed? Over which distance and time? – greenapps Apr 25 '16 at 07:52
  • 1
    Yes. Please look at CalculateSpeed() method. –  Apr 25 '16 at 07:54
  • No . You should tell distance and time in meters and seconds. What do you use? What are there values? Give examples please. – greenapps Apr 25 '16 at 07:55
  • 1
    lastDistance and lastTime changes every GPS update. Multiplying to *3.6 for converting speed from meter-per-second to km-per-hour –  Apr 25 '16 at 07:57
  • You dont have to tell me how to do calcultions. I asked you to tell which values have de used distance and time? – greenapps Apr 25 '16 at 07:58
  • 1
    I'm calculating time between each gps update with timer value (If lastLocation != prevLocation) –  Apr 25 '16 at 08:02

0 Answers0