fix: clean gitignore for Godot C#
This commit is contained in:
55
Scripts/Core/TorqueMap.cs
Normal file
55
Scripts/Core/TorqueMap.cs
Normal file
@@ -0,0 +1,55 @@
|
||||
using System;
|
||||
using System.Collections.Generic;
|
||||
using System.Linq;
|
||||
|
||||
public class TorqueMap
|
||||
{
|
||||
public Dictionary<int, double> points;
|
||||
|
||||
public TorqueMap()
|
||||
{
|
||||
points = new Dictionary<int, double>();
|
||||
}
|
||||
|
||||
public void AddPoint(int rpm, double torque)
|
||||
{
|
||||
points.Add(rpm, torque);
|
||||
}
|
||||
|
||||
public double GetTorque(int rpm)
|
||||
{
|
||||
if (points == null || points.Count == 0)
|
||||
throw new System.InvalidOperationException("Torque map has no points.");
|
||||
|
||||
var sortedRpms = points.Keys.OrderBy(r => r).ToList();
|
||||
int firstRpm = sortedRpms[0];
|
||||
int lastRpm = sortedRpms[sortedRpms.Count - 1];
|
||||
|
||||
if (rpm <= firstRpm)
|
||||
return points[firstRpm];
|
||||
if (rpm >= lastRpm)
|
||||
return points[lastRpm];
|
||||
|
||||
for (int i = 0; i < sortedRpms.Count - 1; i++)
|
||||
{
|
||||
int r1 = sortedRpms[i];
|
||||
int r2 = sortedRpms[i + 1];
|
||||
if (rpm >= r1 && rpm <= r2)
|
||||
{
|
||||
double t1 = points[r1];
|
||||
double t2 = points[r2];
|
||||
return t1 + (rpm - r1) * (t2 - t1) / (r2 - r1);
|
||||
}
|
||||
}
|
||||
|
||||
throw new System.InvalidOperationException("Interpolation failed.");
|
||||
}
|
||||
|
||||
public double GetTorque(double angularVelocityRadPerSec)
|
||||
{
|
||||
// Convert rad/s to RPM: 1 rad/s = 60/(2π) RPM
|
||||
double rpmDouble = angularVelocityRadPerSec * 60.0 / (2.0 * Math.PI);
|
||||
int rpm = (int)rpmDouble; // or use rounding if preferred: (int)Math.Round(rpmDouble)
|
||||
return GetTorque(rpm);
|
||||
}
|
||||
}
|
||||
Reference in New Issue
Block a user