diff --git a/src/main.cpp b/src/main.cpp index 935e8ef..8fe7945 100644 --- a/src/main.cpp +++ b/src/main.cpp @@ -1,8 +1,14 @@ #include +#include #include "body.h" #include "config.h" +//! --- Start of onfiguration --- +const char* hostname = "Hexapod"; +//! --- End of configuration --- + + Body body = Body::instance(); Config config; @@ -15,6 +21,21 @@ void servoTest() { } } +void connectWiFi() +{ + Serial.printf("Connecting to %s\n", config.data().wifiSSID); + WiFi.begin(config.data().wifiSSID, config.data().wifiPass); + WiFi.setHostname(hostname); + while (WiFi.status() != WL_CONNECTED) { + delay(500); + Serial.print("."); + } + Serial.println(""); + Serial.println("WiFi connected"); + Serial.println("IP address: "); + Serial.println(WiFi.localIP()); +} + void setup() { Serial.begin(9600); @@ -27,6 +48,10 @@ void setup() { Serial.printf("SSID: %s\n", config.data().wifiSSID); Serial.printf("pass: %s\n", config.data().wifiPass); + connectWiFi(); + + + // Only to save as a test /* config.setSSID("testSSID");