/*
 * Datei: Heltec_ESP32_LoRa_V3_Sevo_TX_AiRotaryEncoder.ino  
 * geschrieben am 24. Jun, 2025 von Ahmad Shamshiri  
 * 
 * =====================================================================  
 * ARDUINO CODE BESCHREIBUNG: SICHERES LoRa SERVO STEUERUNGSSYSTEM (TX)  
 * =====================================================================  
 * 
 * HARDWAREKOMPONENTEN:  
 * -------------------  
 * - Hauptsteuerung: Heltec WiFi LoRa 32 V3  
 * - Gehäuse: Meshnology N33 Gehäuse mit 3000mAh Batterie  
 * - Eingabe: Drehgeber mit Druckknopf  
 * - Rückmeldung: Eingebaute OLED-Anzeige  
 * - Ausgabe: Servomotor + LoRa-Drahtlosübertragung  
 * 
 * SYSTEMFUNKTIONALITÄT:  
 * -------------------  
 * [1] DREHGEBERSTEUERUNG:  
 * - Im Uhrzeigersinn/Gegen den Uhrzeigersinn Drehung passt den Zielwinkel an (0°-180°)  
 * - Echtzeitanzeige des Winkels auf dem OLED-Bildschirm  
 * - Druckknopf bringt den Servomotor in die Home-Position (Standard: 90°)  
 * 
 * [2] SICHERE DRAHTLOSÜBERTRAGUNG:  
 * - Alle Winkelwerte werden vor der LoRa-Übertragung verschlüsselt  
 * - Kommando für die Home-Position wird als spezielles sicheres Paket übertragen  
 * - Verwendet das 433MHz LoRa-Band für zuverlässige Kommunikation  
 * 
 * [3] ENERGIEVERWALTUNG:  
 * - Optimiert für den Batteriebetrieb (3000mAh)  
 * - Energiesparmodi zwischen den Übertragungen  
 * 
 * FÜR VOLLSTÄNDIGE EINRICHTUNGSANLEITUNGEN:  
 * Bitte sehen Sie sich das Tutorial-Video an: https://youtu.be/EPynuJ7sasY  
 * =====================================================================  
 * 
 * Vollständige Videoerklärung ansehen: https://youtu.be/EPynuJ7sasY  
 * Ressourcenseite: https://robojax.com/T635  
 * 
 * HAFTUNGSAUSSCHLUSS:  
 * Dieser Code wird "WIE BESEHEN" ohne jegliche Gewährleistung bereitgestellt. Der Autor  
 * kann nicht für Schäden haftbar gemacht werden, die aus der Nutzung dieses Codes entstehen.  
 * 
 * LIZENZ:  
 * Dieses Werk ist unter der GNU General Public License v3.0 lizenziert.  
 * Genehmigungen, die über den Umfang dieser Lizenz hinausgehen, sind möglicherweise auf Robojax.com erhältlich.  
 * 
 * TEILENBEDINGUNGEN:  
 * Sie dürfen diesen Code für nicht-kommerzielle Zwecke teilen, kopieren und modifizieren,  
 * VORAAUSGESEZT, dass Sie:  
 * 1. Dieses gesamte Kommentarblock mit dem Originalcode intakt halten  
 * 2. Den Originallink von Robojax.com einfügen  
 * 3. Den YouTube-Tutorial-Link (falls zutreffend) beibehalten  
 * 4. Alle vorgenommenen Änderungen deutlich angeben  
 * 
 * Originaltutorial unter: https://robojax.com/T635  
 * YouTube-Video: https://youtu.be/EPynuJ7sasY
 */
#include <Wire.h>
#include "HT_SSD1306Wire.h"
#include "WiFi.h"
static SSD1306Wire  display(0x3c, 500000, SDA_OLED, SCL_OLED, GEOMETRY_128_64, RST_OLED); // addr , freq , i2c-Gruppe , Auflösung , rst


const int TX_POWER = 2; // dBm von 2 bis 20. Bei batteriebetriebener Versorgung ist 2 bis 14 dBm die beste Option.
const int MAX_ANGLE = 180; // Am häufigsten ist 180, aber Sie können es nach Bedarf einstellen.

String labelAngle = "Angle";
const int homePosition = 90; // startposition


 // endcoder
const int SW_PIN = 4; // Definieren Sie einen PIN für den Drehschalter.
const int PIN_A  = 6;
const int PIN_B  = 5;
const int ANGLE_STEP  = 6;
const bool debug= false; // Um Debug-Daten im seriellen Monitor auszugeben, setzen Sie es auf wahr, andernfalls auf falsch.

int servoAngel = homePosition;
int oldAngleValue = servoAngel;
#include "mbedtls/aes.h" // zur Sicherung von Daten
#include <cstring> // Für memset, memcpy
mbedtls_aes_context aes;
const char *userKey = "hyhT676#h~_1a"; // Sicherheitsschlüssel.


#include "LoRaWan_APP.h"
#include "AiEsp32RotaryEncoder.h"
#include "Arduino.h"
#define ROTARY_ENCODER_VCC_PIN -1

 // Statt hier zu ändern, ändern Sie lieber die Zahlen oben.
AiEsp32RotaryEncoder rotaryEncoder = AiEsp32RotaryEncoder(
            PIN_A,
            PIN_B,
            SW_PIN,
            ROTARY_ENCODER_VCC_PIN,
            ANGLE_STEP);



#define RF_FREQUENCY                                915432000 // Hz

#define TX_OUTPUT_POWER                             TX_POWER // dBm von 2 bis 20. bei betrieb über Batterie 2 bis 14 dBm

#define LORA_BANDWIDTH                              0 // [0: 125 kHz,
 // 1: 250 kHz,
 // 2: 500 kHz,
 // 3: Reserviert
#define LORA_SPREADING_FACTOR                       7 // [SF7..SF12]
#define LORA_CODINGRATE                             1 // [1: 4/5,
 // 2: 4/6,
 // 3: 4/7,
 // 4: 4/8]
#define LORA_PREAMBLE_LENGTH                        8 // Gleich für Tx und Rx
#define LORA_SYMBOL_TIMEOUT                         0 // Symbole
#define LORA_FIX_LENGTH_PAYLOAD_ON                  false
#define LORA_IQ_INVERSION_ON                        false


#define RX_TIMEOUT_VALUE                            1000
#define BUFFER_SIZE                                 64 // Definieren Sie hier die Payload-Größe.

char txpacket[BUFFER_SIZE];
char rxpacket[BUFFER_SIZE];

double txNumber;

bool lora_idle=true;

static RadioEvents_t RadioEvents;
unsigned long lastTxTime = 0;
void OnTxDone( void );
void OnTxTimeout( void );
void decryptAES(uint8_t *data, const char *key);
void encryptAES(uint8_t *data, const char *key);
void processKey(const char *userKey, uint8_t *processedKey, size_t keySize);
void VextON(void);

void rotary_loop(); // Prototypfunktion: Drehgeber
void IRAM_ATTR readEncoderISR(); // Prototypfunktion: Drehgeber
void rotary_onButtonClick(); // Prototypfunktion: Drehgeber

void setup() {
  Serial.begin(115200);
  Serial.println();

  VextON();
  delay(100);

 // wir müssen den Drehgeber initialisieren
	rotaryEncoder.begin();
	rotaryEncoder.setup(readEncoderISR);
	bool circleValues = false;
	rotaryEncoder.setBoundaries(0, MAX_ANGLE, circleValues); // minValue, maxValue, circleValues wahr|falsch (wenn max zu min und umgekehrt)
/*
 * Rotationsbeschleunigung eingeführt am 25.2.2021.  
 * Falls der auszuwählende Bereich riesig ist, zum Beispiel - wähle einen Wert zwischen 0 und 1000 und wir möchten 785.  
 * Ohne Beschleunigung benötigt man lange, um zu dieser Zahl zu gelangen.  
 * Mit Beschleunigung gilt: Je schneller du drehst, desto schneller wird der Wert steigen.  
 * Zum Feineinstellen langsamer werden.
 */
 // rotaryEncoder.deaktiviereBeschleunigung(); //Beschleunigung ist jetzt standardmäßig aktiviert - deaktivieren, wenn du sie nicht benötigst
	rotaryEncoder.setAcceleration(20); // oder setzen Sie den Wert - größere Zahl = mehr Beschleunigung; 0 oder 1 bedeutet deaktivierte Beschleunigung
  rotaryEncoder.reset(homePosition); // Heimposition setzen

 // Die Initialisierung der Benutzeroberfläche wird auch das Display initialisieren.
  display.init();
  display.setFont(ArialMT_Plain_10);
 // LoRa-Zeug
  Mcu.begin(HELTEC_BOARD,SLOW_CLK_TPYE);

    txNumber=0;

    RadioEvents.TxDone = OnTxDone;
    RadioEvents.TxTimeout = OnTxTimeout;

    Radio.Init( &RadioEvents );
    Radio.SetChannel( RF_FREQUENCY );
    Radio.SetTxConfig( MODEM_LORA, TX_OUTPUT_POWER, 0, LORA_BANDWIDTH,
                                   LORA_SPREADING_FACTOR, LORA_CODINGRATE,
                                   LORA_PREAMBLE_LENGTH, LORA_FIX_LENGTH_PAYLOAD_ON,
                                   true, 0, 0, LORA_IQ_INVERSION_ON, 3000 );

}


void displayAngle() {
    display.clear(); // Anzeige vor neuem Inhalt löschen

 // Winkel
    display.setTextAlignment(TEXT_ALIGN_LEFT);

 // Zeile 2: Temperaturwert in 24pt Schriftgröße
    display.setFont(ArialMT_Plain_24);

 // Format
    String angleString = String(servoAngel) + "°";

    display.setFont(ArialMT_Plain_16);
    display.drawString(0, 0, labelAngle);
    display.setFont(ArialMT_Plain_24);
    display.drawString(0, 15, angleString);

    display.display(); // Update OLED
}



void VextON(void)
{
  pinMode(Vext,OUTPUT);
  digitalWrite(Vext, LOW);
}

void VextOFF(void) // Vext Standard AUS
{
  pinMode(Vext,OUTPUT);
  digitalWrite(Vext, HIGH);
}

void sendData()
{

  String txData = String(servoAngel) ;

  uint8_t data[BUFFER_SIZE];
  memset(data, 0, sizeof(data)); // Null-Padding
  strncpy((char*)data, txData.c_str(), sizeof(data) - 1); // Sicheren Sie den Kopiervorgang.

  encryptAES(data, userKey); // Vor dem Senden verschlüsseln
  if(lora_idle == true)
    {
 // delay(1000);
      Radio.Send(data,  sizeof(data));
      if(debug){
      Serial.print("Sending: ");
      Serial.println((char *)data);
      }
      lora_idle = false;
      oldAngleValue =servoAngel; // Aufzeichnung der Winkeländerung führen
    }
    Radio.IrqProcess( );
}



void loop() {
  rotary_loop();
 // Anzeige löschen
  display.clear();

  displayAngle();

  if(oldAngleValue != servoAngel)
  {
	  sendData();
  }
 // delay(100);

}


void OnTxDone( void )
{
        if(debug){
	        Serial.println("TX done......");
        }
	lora_idle = true;
}

void OnTxTimeout( void )
{
    Radio.Sleep( );
        if(debug){
	        Serial.println("TX Timeout......");
        }
    lora_idle = true;
}


/*
 * Konvertiert einen vom Benutzer bereitgestellten Klartextschlüssel in einen festen 16-Byte (128-Bit) oder 32-Byte (256-Bit) Schlüssel.
 */
void processKey(const char *userKey, uint8_t *processedKey, size_t keySize) {
    memset(processedKey, 0, keySize); // Mit Nullen auffüllen
    size_t len = strlen(userKey);
    if (len > keySize) len = keySize; // Abschneiden, wenn zu lang
    memcpy(processedKey, userKey, len); // Kopiere den gültigen Schlüsselteil
}

/*
 * Verschlüsselt eine 16-Byte (ein Block) Nachricht mit AES-128.
 */
void encryptAES(uint8_t *data, const char *key) {
    uint8_t processedKey[16]; // 128-Bit-Schlüssel
    processKey(key, processedKey, 16);

    mbedtls_aes_init(&aes);
    mbedtls_aes_setkey_enc(&aes, processedKey, 128);
    mbedtls_aes_crypt_ecb(&aes, MBEDTLS_AES_ENCRYPT, data, data);
    mbedtls_aes_free(&aes);
}

/*
 * Entschlüsselt eine 16-Byte (ein Block) Nachricht mit AES-128.
 */
void decryptAES(uint8_t *data, const char *key) {
    uint8_t processedKey[16]; // 128-Bit-Schlüssel
    processKey(key, processedKey, 16);

    mbedtls_aes_init(&aes);
    mbedtls_aes_setkey_dec(&aes, processedKey, 128);
    mbedtls_aes_crypt_ecb(&aes, MBEDTLS_AES_DECRYPT, data, data);
    mbedtls_aes_free(&aes);
}



void rotary_onButtonClick()
{
	static unsigned long lastTimePressed = 0;
 // Ignoriere mehrfaches Drücken in diesem Zeitrahmen in Millisekunden.
	if (millis() - lastTimePressed < 500)
	{
		return;
	}
	lastTimePressed = millis();

	        if(debug){
	          Serial.print("button pressed ");
	          Serial.print(millis());
	          Serial.println(" milliseconds after restart");
          }
}

void rotary_loop()
{
 // Drucke nichts aus, es sei denn, der Wert hat sich geändert.
	if (rotaryEncoder.encoderChanged())
	{
		        if(debug){
	            Serial.print("Value: ");
		          Serial.println(rotaryEncoder.readEncoder());
            }
    servoAngel = rotaryEncoder.readEncoder();

	}
	if (rotaryEncoder.isEncoderButtonClicked())
	{
    rotaryEncoder.reset(homePosition);
    servoAngel = homePosition;
		rotary_onButtonClick();
	}
}

void IRAM_ATTR readEncoderISR()
{
	rotaryEncoder.readEncoder_ISR();
}