110 lines
3.6 KiB
C#
110 lines
3.6 KiB
C#
|
using System;
|
|||
|
|
using System.Globalization;
|
|||
|
|
|
|||
|
|
|
|||
|
|
namespace Assets.Scenes.Ride.Scripts
|
|||
|
|
{
|
|||
|
|
public class Helper
|
|||
|
|
{
|
|||
|
|
/// <summary>
|
|||
|
|
/// 计算速度
|
|||
|
|
/// 参考 http://bikecalculator.com/index.html
|
|||
|
|
/// </summary>
|
|||
|
|
/// <param name="elevationv">海拔</param>
|
|||
|
|
/// <param name="gradev">坡度%</param>
|
|||
|
|
/// <param name="powerv">功率</param>
|
|||
|
|
/// <param name="rweightv">体重</param>
|
|||
|
|
/// <param name="bweightv">自行车重量</param>
|
|||
|
|
/// <returns>km/h</returns>
|
|||
|
|
public static double CalculateSpeed(double elevationv, double gradev, double powerv, double rweightv, double bweightv)
|
|||
|
|
{
|
|||
|
|
if (powerv < 0)
|
|||
|
|
{
|
|||
|
|
return 0;
|
|||
|
|
}
|
|||
|
|
if (gradev < -10)
|
|||
|
|
{
|
|||
|
|
gradev = -10;
|
|||
|
|
}
|
|||
|
|
var tireValues = new double[] { 0.005, 0.004, 0.012 };
|
|||
|
|
var aeroValues = new double[] { 0.388, 0.445, 0.420, 0.300, 0.233, 0.200 };
|
|||
|
|
var units = 0;
|
|||
|
|
|
|||
|
|
//温度
|
|||
|
|
var temperaturev = 25;
|
|||
|
|
|
|||
|
|
//海拔
|
|||
|
|
//var elevationv = 100;
|
|||
|
|
|
|||
|
|
//坡度
|
|||
|
|
//var gradev = 6 * 0.01 * -1;
|
|||
|
|
|
|||
|
|
//风，转换成m/s
|
|||
|
|
var headwindv = 0 / 3.6;
|
|||
|
|
|
|||
|
|
var frontalArea = aeroValues[0];
|
|||
|
|
|
|||
|
|
var transv = 0.95; // no one knows what this is, so why bother presenting a choice?
|
|||
|
|
var rollingRes = tireValues[0];
|
|||
|
|
|
|||
|
|
//应该是空气密度
|
|||
|
|
var density = (1.293 - 0.00426 * temperaturev) * Math.Exp(-elevationv / 7000.0);
|
|||
|
|
|
|||
|
|
|
|||
|
|
//全空气阻力参数
|
|||
|
|
var a2 = 0.5 * frontalArea * density; // full air resistance parameter
|
|||
|
|
var twt = 9.8 * (rweightv + bweightv); // total weight in newtons
|
|||
|
|
var tres = twt * (gradev * 0.01 + rollingRes); // gravity and rolling resistance
|
|||
|
|
|
|||
|
|
//var powerv = 195;
|
|||
|
|
|
|||
|
|
var v = Newton(a2, headwindv, tres, transv, powerv) * 3.6;// convert to km/h
|
|||
|
|
|
|||
|
|
//Trace.WriteLine($"速度为：{ v }");
|
|||
|
|
|
|||
|
|
var t1 = makeDecimal2(v * (units == 1 ? 1.609 : 1.0));
|
|||
|
|
return double.Parse(t1, CultureInfo.InvariantCulture);
|
|||
|
|
}
|
|||
|
|
private static double Newton(double aero, double hw, double tr, double tran, double p)
|
|||
|
|
{
|
|||
|
|
var vel = 20D;
|
|||
|
|
var MAX = 10;
|
|||
|
|
var TOL = 0.05;
|
|||
|
|
for (int i = 0; i < MAX; i++)
|
|||
|
|
{
|
|||
|
|
var tv = vel + hw;
|
|||
|
|
var aeroEff = (tv > 0.0) ? aero : -aero; // wind in face, must reverse effect
|
|||
|
|
var f = vel * (aeroEff * tv * tv + tr) - tran * p; // the function
|
|||
|
|
var fp = aeroEff * (3.0 * vel + hw) * tv + tr; // the derivative
|
|||
|
|
var vNew = vel - f / fp;
|
|||
|
|
if (Math.Abs(vNew - vel) < TOL)
|
|||
|
|
{
|
|||
|
|
return vNew; // success
|
|||
|
|
}
|
|||
|
|
vel = vNew;
|
|||
|
|
}
|
|||
|
|
return 0.0;
|
|||
|
|
}
|
|||
|
|
private static string makeDecimal2(double value)
|
|||
|
|
{
|
|||
|
|
if (value != 0)
|
|||
|
|
{
|
|||
|
|
var x = Math.Round(value * 100);
|
|||
|
|
int d;
|
|||
|
|
if (x < 100)
|
|||
|
|
{
|
|||
|
|
d = 0;
|
|||
|
|
}
|
|||
|
|
else
|
|||
|
|
{
|
|||
|
|
d = Convert.ToInt32(Math.Floor(x / 100), CultureInfo.InvariantCulture);
|
|||
|
|
};
|
|||
|
|
var c = x % 100;
|
|||
|
|
var g = (c >= 10) ? "" : "0";
|
|||
|
|
return "" + d + "." + g + c;
|
|||
|
|
}
|
|||
|
|
return value.ToString(CultureInfo.InvariantCulture);
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
}
|