Lauffähig und aufgeräumt

src/driveModi/Modi/ManualControl/manualControl.cpp

@@ -24,10 +24,14 @@ void ManualControl::init(MoveControl *moveControl) {
 }
 
 void ManualControl::loop() {
+    this->moveControl->loop();
+
     static uint32_t last_millis = 0;
     if (millis() - last_millis < delay) {
         return;
     }
+    this->runManualControl();
+    last_millis = millis();
 }
 
 void ManualControl::runManualControl() {

src/driveModi/driveManager.cpp

@@ -16,8 +16,8 @@ DriveManager::DriveManager(MoveControl *moveControl) {
 }
 
 void DriveManager::loop() {
-    this->currentModus->loop();
-    this->moveControl->loop();
+    if (currentModus)
+        this->currentModus->loop();
 }
 
 void DriveManager::runDriveManager() {

src/main.cpp

@@ -18,19 +18,22 @@ DriveManager driveManager(&moveController);
 
 void setup() {
     Serial.begin(115200);
+    Serial.println("Welcome...");
 
-    setIps();
-    connectWifi();
-    setupMQTT();
+    Network::setIps();
+    Network::connectWifi();
+    Network::setupMQTT();
 
     Ps3.attach(callbackControllerAction);
     Ps3.attachOnConnect(callbackControllerConnect);
     Serial.println("\nReady to connect a PS3 Controller... \n");
     Ps3.begin();
+
+    driveManager.changeModus(Modi::ManualControl);
 }
 
 void loop() {
-    checkMQTT();
+    Network::checkMQTT();
     driveManager.loop();
 }
 

src/moveControl.cpp

@@ -1,8 +1,8 @@
 #include "moveControl.h"
 
 MoveControl::MoveControl() {
-    this->left_motor = new MotorControl;
-    this->right_motor = new MotorControl;
+    this->left_motor = new MotorControl();
+    this->right_motor = new MotorControl();
     this->left_speedometer = new Speedometer;
     this->right_speedometer = new Speedometer;
 
@@ -113,7 +113,6 @@ void MoveControl::regulateMotors() {
     case DrivingStatus::drive :
         this->left_motor->setTargetPower( (int8_t) this->left_pid_out);
         this->right_motor->setTargetPower( (int8_t) this->right_pid_out);
-        
         break;
 
     default:

src/network.cpp

@@ -1,7 +1,7 @@
 /**
  * @file network.cpp
  * @author Alexander Klein (alex@kleiax.de)
- * @brief Contains function implementation of network.h
+ * @brief TODO: write some stuff
  * @version 0.1
  * @date 2021-12-14
  * 
@@ -10,36 +10,50 @@
  */
 
 #include "network.h"
-void setIps() {
+
+IPAddress Network::local_IP;
+IPAddress Network::gateway;
+IPAddress Network::subnet;
+IPAddress Network::mqtt_server;
+
+WiFiClient Network::wifi_client;
+PubSubClient* Network::mqtt_client;
+
+void Network::setIps() {
     local_IP.fromString(WLAN_IP);
     gateway.fromString(WLAN_GATEWAY);
     subnet.fromString(WLAN_SUBNETMASK);
     mqtt_server.fromString(MQTT_SERVER);
 }
 
-void setupMQTT() {
-    mqtt_client.setServer(mqtt_server, MQTT_PORT);
+void Network::setupMQTT() {
+    mqtt_client = new PubSubClient(wifi_client);
+    mqtt_client->setServer(mqtt_server, MQTT_PORT);
     // mqtt_client.setServer(MQTT_SERVER, MQTT_PORT);
-    mqtt_client.setSocketTimeout(1);
+    Network::mqtt_client->setSocketTimeout(1);
+    mqtt_client->setSocketTimeout(1);
     connectMQTT();
 }
 
-bool connectMQTT() {
+bool Network::connectMQTT() {
     // Create a random client ID
     String clientId = "ESP32Rover-";
     clientId += String(random(0xffff), HEX);
+
     #ifdef MQTT_AUTH
-    if (mqtt_client.connect(clientId.c_str(), MQTT_USER, MQTT_PASSWORD)) {
+        if (mqtt_client->connect(clientId.c_str(), MQTT_USER, MQTT_PASSWORD)) {
     #endif //MQTT_AUTH
+
     #ifndef MQTT_AUTH
-    if (mqtt_client.connect(clientId.c_str())) {
+        if (mqtt_client->connect(clientId.c_str())) {
     #endif //MQTT_AUTH
+
         // Once connected, publish an announcement...
-        mqtt_client.publish("Rover/Info", "Connected to Mqtt-Broker");
+        mqtt_client->publish("Rover/Info", "Connected to Mqtt-Broker");
     }
-    return mqtt_client.connected();
+    return mqtt_client->connected();
 }
-void connectWifi() {
+void Network::connectWifi() {
    // Configures static IP address
     if (!WiFi.config(local_IP, gateway, subnet)) {
         Serial.println("STA Failed to configure");
@@ -61,9 +75,9 @@ void connectWifi() {
     Serial.println(WiFi.localIP()); 
 }
 
-void checkMQTT() {
+void Network::checkMQTT() {
     static uint64_t lastReconnectAttempt = 0;
-    if (!mqtt_client.connected()) {
+    if (!mqtt_client->connected()) {
         long now = millis();
         if (now - lastReconnectAttempt > MQTT_TIME_RECONNECT) {
             lastReconnectAttempt = now;
@@ -72,5 +86,9 @@ void checkMQTT() {
                 lastReconnectAttempt = 0;
         }
     } else
-    mqtt_client.loop();
+    mqtt_client->loop();
+}
+
+PubSubClient* Network::getMqtttClient() {
+    return mqtt_client;
 }