Pendelzug Erstversion

new file:   .gitignore
new file:   .vscode/extensions.json
new file:   ErsterTest.code-workspace
new file:   include/README
new file:   lib/AnalogFiveButtons/AnalogFiveButtons.cpp
new file:   lib/AnalogFiveButtons/AnalogFiveButtons.h
new file:   lib/Imotor/Imotor.cpp
new file:   lib/Imotor/Imotor.h
new file:   lib/L298n/L298n.cpp
new file:   lib/L298n/L298n.h
new file:   lib/README
new file:   lib/fahrt/fahrt.cpp
new file:   lib/fahrt/fahrt.h
new file:   lib/gleis/gleis.cpp
new file:   lib/gleis/gleis.h
new file:   lib/gleisabschnitt/gleisabschnitt.cpp
new file:   lib/gleisabschnitt/gleisabschnitt.h
new file:   lib/locomotive/locomotive.cpp
new file:   lib/locomotive/locomotive.h
new file:   lib/motor/dfquad.h
new file:   lib/motor/motor.cpp
new file:   lib/motor/motor.h
new file:   lib/weiche/weiche.cpp
new file:   lib/weiche/weiche.h
new file:   platformio.ini
new file:   src/main.cpp
new file:   test/README

lib/locomotive/locomotive.cpp

@@ -0,0 +1,119 @@
+#include<locomotive.h>
+#include<motor.h>
+#include<math.h>
+
+Locomotive::Locomotive(int accelerate, int decelerate, byte minSpeed, byte maxSpeed, IMotor& motor): _motor(motor)
+{
+    _currentSpeed=0;
+    _currentAcc=0;
+    _accelerate=accelerate;
+    _decelerate=decelerate;
+    _minSpeed=minSpeed;
+    _maxSpeed=maxSpeed;
+
+};
+
+void Locomotive::Accelerate()
+{
+    Accelerate(_maxSpeed);
+};
+
+void Locomotive::Accelerate(byte Speed)
+{
+/*      Serial.print("Locomotive.Accelerate: ");
+        Serial.print(_currentSpeed);
+        Serial.print(" ");
+        Serial.print(Speed);
+        Serial.print(" ");
+*/ 
+    _targetSpeed = Speed;
+    _millisStart = millis()-_delay;
+    if (_targetSpeed>_currentSpeed)
+        _currentAcc = _accelerate;
+    else
+        _currentAcc = - _decelerate;
+
+};
+
+
+void Locomotive::Accelerate(byte Speed, float bremsweg)
+{
+    _targetSpeed = Speed;
+    _currentSpeed = (_currentSpeed<_minSpeed)? _minSpeed : _currentSpeed;
+    _millisStart = millis()-_delay;
+
+    byte _targetSpeed2 = ((_targetSpeed < _currentSpeed)&&(_targetSpeed == 0)) ? _minSpeed : _targetSpeed;
+    int deltaspeed = (_targetSpeed2 - _currentSpeed);
+    
+    _currentAcc = copysign(deltaspeed * deltaspeed / (100.0 * bremsweg), deltaspeed);
+    if (_currentAcc == 0)
+        _currentAcc = copysign(1, deltaspeed);
+
+};
+
+
+void Locomotive::Break()
+{
+    Accelerate(0);
+};
+
+void Locomotive::setSpeed(byte Speed)
+{
+    _currentSpeed = Speed;
+    _motor.setSpeed(_currentSpeed);
+};
+
+void Locomotive::setDirection(MotorDirection dir)
+{
+    Serial.print("Lokomotive Richtung: ");
+    Serial.println(dir);
+    _motor.setDirection(dir);
+};
+
+void Locomotive::loop()
+{
+    unsigned long currentMillis;
+    currentMillis = millis();
+    if (currentMillis - _millisStart >= _delay)  //test whether the period has elapsed
+    {
+        byte newspeed;
+        newspeed = _currentSpeed + _currentAcc;
+ /*       Serial.print("Locomotive.Loop: ");
+        Serial.print(_currentSpeed);
+        Serial.print(" ");
+        Serial.print(_currentAcc);
+        Serial.print(" ");
+        Serial.println(newspeed);
+*/
+
+        int breakspeed = _minSpeed * 80 / 100;
+
+        if ((newspeed>_targetSpeed) && (_currentAcc>0))
+        {
+            newspeed = _targetSpeed;
+            _currentAcc =0;
+        }
+        else if ((newspeed<_minSpeed) && (_currentAcc>0)) newspeed = _minSpeed;
+        else if ((newspeed<breakspeed) && (_currentAcc<0))
+        {
+            newspeed = 0;
+            _currentAcc = 0;
+        };
+
+        setSpeed(newspeed);
+
+        _millisStart = currentMillis;  //IMPORTANT to save the start time of the current LED state.
+    }
+
+};
+
+byte Locomotive::currentSpeed()
+{
+    return _currentSpeed;
+};
+
+byte Locomotive::getDefaultSpeed()
+{
+    return _maxSpeed;
+};
+

lib/locomotive/locomotive.h

@@ -0,0 +1,36 @@
+#ifndef Locomotive_h
+#define Locomotive_h
+
+#include "Arduino.h"
+#include "Imotor.h"
+
+class Locomotive
+{
+  public:
+    Locomotive(int accelerate, int decelerate, byte minSpeed, byte maxSpeed, IMotor& motor);
+    Locomotive(int accelerate, byte speed, int decelerate, byte minSpeed, byte maxSpeed, IMotor& motor);
+    void Accelerate();
+    void Accelerate(byte Speed);
+    void Accelerate(byte Speed, float bremsweg);
+    void Break();
+    void setSpeed(byte Speed);
+    void loop();
+    byte currentSpeed();
+    void setDirection(MotorDirection dir);
+    byte getDefaultSpeed();
+
+  private:
+    int _accelerate;
+    int _decelerate;
+    int _currentAcc;
+    byte _minSpeed;
+    byte _maxSpeed;
+    byte _targetSpeed;
+    const unsigned int _delay=300;
+    unsigned long _millisStart;
+    byte _currentSpeed;
+    IMotor& _motor;
+};
+
+
+#endif