wip start adding double stuff

scenes/Main.tscn

@@ -1,19 +1,15 @@
-[gd_scene load_steps=4 format=2]
+[gd_scene load_steps=3 format=2]
 
-[ext_resource path="res://scenes/Train.tscn" type="PackedScene" id=1]
-[ext_resource path="res://scenes/Railway.tscn" type="PackedScene" id=2]
 [ext_resource path="res://scenes/OrbitCamera.tscn" type="PackedScene" id=3]
+[ext_resource path="res://scenes/OrbitSystem.tscn" type="PackedScene" id=4]
 
 [node name="Main" type="Node2D"]
 
 [node name="DirectionalLight" type="DirectionalLight" parent="."]
 transform = Transform( 0.515898, 0.606099, -0.605386, -0.393123, 0.795389, 0.461314, 0.76112, -2.26831e-08, 0.648611, 0, 0, 0 )
+visible = false
 
-[node name="OrbitCamera" parent="." instance=ExtResource( 3 )]
+[node name="Camera" parent="." instance=ExtResource( 3 )]
 _speed = 0.5
 
-[node name="Railway" parent="." instance=ExtResource( 2 )]
-
-[node name="Train" parent="." instance=ExtResource( 1 )]
-_speed = 5.0
-_railwayPath = NodePath("../Railway")
+[node name="Orbit System" parent="." instance=ExtResource( 4 )]

scenes/OrbitSystem.tscn

@@ -0,0 +1,15 @@
+[gd_scene load_steps=2 format=2]
+
+[ext_resource path="res://scripts/orbits/OrbitSystem.cs" type="Script" id=1]
+
+[node name="Orbit System" type="Spatial"]
+script = ExtResource( 1 )
+_a = NodePath("A")
+_b = NodePath("B")
+_barycenter = NodePath("Barycenter")
+
+[node name="A" type="Spatial" parent="."]
+
+[node name="B" type="Spatial" parent="."]
+
+[node name="Barycenter" type="Spatial" parent="."]

scripts/orbits/ILocation.cs

@@ -0,0 +1,7 @@
+using Godot;
+using System;
+
+public interface ILocation
+{
+    Vector3 Position { get; }
+}

scripts/orbits/IMassive.cs

@@ -0,0 +1,7 @@
+using Godot;
+using System;
+
+public interface IMassive
+{
+    float Mass { get; }
+}

scripts/orbits/Orbit.cs

@@ -0,0 +1,12 @@
+using Godot;
+using System;
+
+public class Orbit
+{
+    public Orbit(PointMass a, PointMass b)
+    {
+
+    }
+
+    // ellipse
+}

scripts/orbits/OrbitSystem.cs

@@ -0,0 +1,104 @@
+using Godot;
+using System;
+
+public class OrbitSystem : Node, IMassive, ILocation
+{
+    [Export] private NodePath _a;
+    [Export] private NodePath _b;
+    [Export] private NodePath _barycenter;
+
+    private readonly PointMass[] _pointMasses = new PointMass[2];
+
+    public Vector3 Position => Barycenter;
+
+    [Export]
+    public Vector3 Barycenter
+    {
+        get
+        {
+            var p0 = _pointMasses[0].Position;
+            var p1 = _pointMasses[1].Position;
+
+            return p0.LinearInterpolate(p1, .5f);
+        }
+        set => _ = value;
+    }
+
+    public float Mass { get; } = 1;
+
+    private Orbit _orbit;
+
+    private ImmediateGeometry _orbitGeometry;
+
+    public override void _Ready()
+    {
+        InitPointMasses();
+        InitGeometry();
+    }
+
+    public override void _Process(float delta)
+    {
+        DrawOrbit();
+    }
+
+    private void InitOrbit()
+    {
+
+    }
+
+    private void DrawOrbit()
+    {
+        int steps = 100;
+
+        _orbitGeometry.Clear();
+        _orbitGeometry.Begin(Mesh.PrimitiveType.LineLoop);
+        _orbitGeometry.SetColor(new Color(1, 0, 0));
+        for (int i = 0; i < steps; i++)
+        {
+            float t = i / (float)steps;
+            float a = t * Mathf.Tau;
+
+            _orbitGeometry.AddVertex(new Vector3
+            {
+                x = Mathf.Sin(a),
+                z = Mathf.Cos(a)
+            });
+        }
+        _orbitGeometry.End();
+    }
+
+    private void InitGeometry()
+    {
+        _orbitGeometry = new ImmediateGeometry();
+        var m = new SpatialMaterial();
+        m.VertexColorUseAsAlbedo = true;
+        m.FlagsUnshaded = true;
+        _orbitGeometry.MaterialOverride = m;
+        AddChild(_orbitGeometry);
+    }
+
+    private void InitPointMasses()
+    {
+        var a = GetPointMass(_a);
+        var b = GetPointMass(_b);
+
+        if (a.Mass > b.Mass)
+        {
+            _pointMasses[0] = a;
+            _pointMasses[1] = b;
+        }
+        else
+        {
+            _pointMasses[0] = b;
+            _pointMasses[1] = a;
+        }
+    }
+
+    private PointMass GetPointMass(NodePath path)
+    {
+        var spatial = GetNode<Spatial>(path);
+        //var massive = node.GetChild<IMassive>(0);
+
+        return new PointMass(spatial, 1f);
+    }
+}

scripts/orbits/Planet.cs

@@ -0,0 +1,18 @@
+using Godot;
+using System;
+
+public class Planet : Node, IMassive
+{
+    [Export]
+    public float Mass { get; set; }
+
+    public override void _Ready()
+    {
+
+    }
+
+    //  public override void _Process(float delta)
+    //  {
+    //
+    //  }
+}

scripts/orbits/PointMass.cs

@@ -0,0 +1,25 @@
+using Godot;
+
+public struct PointMass : IMassive, ILocation
+{
+    public float Mass => _massive == null ? _mass : _massive.Mass;
+    public Vector3 Position => _spatial.Translation;
+
+    private IMassive _massive;
+    private Spatial _spatial;
+    private float _mass;
+
+    public PointMass(Spatial spatial, IMassive massive)
+    {
+        _spatial = spatial;
+        _massive = massive;
+        _mass = 0;
+    }
+
+    public PointMass(Spatial spatial, float mass)
+    {
+        _spatial = spatial;
+        _massive = null;
+        _mass = mass;
+    }
+}

scripts/orbits/math/Double2.cs

@@ -0,0 +1,8 @@
+using Godot;
+using System;
+
+public struct Double2
+{
+    public double x;
+    public double y;
+}

scripts/orbits/math/Ellipse.cs

@@ -0,0 +1,34 @@
+using Godot;
+using System;
+
+public struct Ellipse
+{
+    public double a { get => SemiMajorAxis; set => SemiMajorAxis = value; }
+    public double SemiMajorAxis { get; set; }
+
+    public double e { get => Eccentricity; set => Eccentricity = value; }
+    public double Eccentricity { get; set; }
+
+    public double b => SemiMajorAxis;
+    public double SemiMinorAxis => Math.Sqrt(Apisides.max * Apisides.min);
+
+    private Apisides Apisides => new Apisides(a, e);
+
+    public Ellipse(double a = 1, double e = 0)
+    {
+        SemiMajorAxis = a;
+        Eccentricity = e;
+    }
+}
+
+public struct Apisides
+{
+    public readonly double min;
+    public readonly double max;
+
+    public Apisides(double a, double e)
+    {
+        min = a * (1 - e);
+        max = a * (1 + e);
+    }
+}