phithetahistory

gistfile1.txt

public class HomicidalChauffeurPursuit : MonoBehaviour
{
public List<float> angles = new List<float>();
    public float angle;
    public float angleDiff;

        public static object phiThetaHistory(object X) 
        {
           // var angles = np.arctan2(X[":",4] - X[":",1], X[":",3] - X[":",0]);
           angles = Mathf.Atan((X[":",4] - X[":",1])/(X[":",3]-X[":",0]))
            //var angle = np.unwrap(angles)[-1];
            // print("unwrapped:", angle, " wrapped:  ", angles[-1])
            angle = 2*Math.PI*(a/(2*Math.PI))+(a % (2 * Math.PI))
            angleDiff = Math.PI/2 - angle - X[-1,2];
            return (angleDiff/(verticalInput / minTurnRadius));
        }