public long getVerticalSpeedToNoFmt(GpsParams gpsParams) {
double altAbove = getAltitudeAboveDest(gpsParams);
double time = (mDistance / gpsParams.getSpeed()) * 60;
if (altAbove == 0 || time == 0) {
return 0;
}
return -Math.round(altAbove / time);
}
/**
* Update the current speed, lat, lon, that will update ETA, distance and bearing to the
* destination
*
* @param params
*/
public void updateTo(GpsParams params) {
/*
*/
double mLon = params.getLongitude();
double mLat = params.getLatitude();
double speed = params.getSpeed();
mDeclination = params.getDeclinition();
if (!mFound) {
return;
}
if (!mInited) {
mLonInit = mLon;
mLatInit = mLat;
mInited = true;
}
/*
* Project and find distance
*/
Projection p = new Projection(mLon, mLat, mLond, mLatd);
mDistance = p.getDistance();
mBearing = p.getBearing();
// in flying mode, calculate time based on ground speed from GPS
mGroundSpeed = speed;
mWca = 0;
mCrs = mBearing;
if (mPref.isSimulationMode()) {
double ws = 0;
double wd = 0;
if (mWinds != null) {
double winds[] = mWinds.getWindAtAltitude(params.getAltitude());
ws = winds[0];
wd = winds[1];
}
// in sim mode, do planning with winds
speed = mPref.getAircraftTAS(); // in sim mode, use preferred TAS
// from aviation formulary
double hd = mBearing;
mGroundSpeed =
Math.sqrt(
ws * ws + speed * speed - 2 * ws * speed * Math.cos((hd - wd) * Math.PI / 180.0));
mWca =
-Math.toDegrees(
Math.atan2(
ws * Math.sin((hd - wd) * Math.PI / 180.0),
speed - ws * Math.cos((hd - wd) * Math.PI / 180.0)));
mCrs = (hd + mWca + 360) % 360;
} else if (mPref.useBearingForETEA() && (!mService.getPlan().isActive())) {
// This is just when we have a destination set and no plan is active
// We can't assume that we are heading DIRECTLY for the destination, so
// we need to figure out the multiply factor by taking the COS of the difference
// between the bearing and the heading.
double angDif = Helper.angularDifference(params.getBearing(), mBearing);
double xFactor = 1;
// If the difference is 90 or greater, then ETE means nothing as we are not
// closing on the target
if (angDif < 90) {
// Calculate the actual relative speed closing on the target
xFactor = Math.cos(angDif * Math.PI / 180);
}
mGroundSpeed *= xFactor;
}
/*
* ETA when speed != 0
*/
mEte = Helper.calculateEte(mDistance, mGroundSpeed, 0, true);
if (mGroundSpeed == 0) {
mEteSec = Long.MAX_VALUE;
mFuelGallons = Float.MAX_VALUE;
mFuel = "-.-";
} else {
mEteSec = (long) (mDistance / mGroundSpeed * 3600);
mFuelGallons = (float) mEteSec / 3600 * mPref.getFuelBurn();
mFuel = String.valueOf((float) Math.round(mFuelGallons * 10.f) / 10.f);
}
// Calculate the time of arrival at our destination. We SHOULD be taking in to account
// the timezone at that location
mEta = Helper.calculateEta(Calendar.getInstance().getTimeZone(), mDistance, mGroundSpeed);
}