//Testprogramm Funk-Fernsteuerung Sender
//Funk-Fernsteuerung_Sender204.ino
//Code fuer Arduino
//Author Retian
//Version 1.1
#include <MySparkfun7SegI2C.h>
#include <Metro.h>
#include <Wire.h>
#include <MyKeypad_I2C.h>
#include <VirtualWire.h>
//0 ... kein Debug-Modus Ausgabe am Seriellen Monitor
//1 ... Debug-Modus Ausgabe am Seriellen Monitor
#define debug 0
bool sendeStatus = 0; //Merker, ob Sender AUS- oder Ein-geschaltet ist
//Zyklische Abfragen in Millisekunden
Metro tastZyklusMetro(100); //Zyklus für Tastatur-Bearbeitung
Metro servoZyklusMetro(15); //Zyklus für Servo-Bearbeitung
Metro motorPotiZyklusMetro(150); //Zyklus für Motor-Bearbeitung
//Hintergrundzyklus für Motoren
Metro hintergrundZyklus3(480);
Metro hintergrundZyklus4(520);
//Definition der Analog- und Digitalpins
#define potiPin1 0 //Potentiometer1-Pin ist Analogpin 0
#define potiPin2 1 //Potentiometer2-Pin ist Analogpin 1
#define potiPin3 2 //Potentiometer3-Pin ist Analogpin 2
#define potiPin4 3 //Potentiometer3-Pin ist Analogpin 3
#define txPin 2 //TX-Pin
#define ledPin 3 //LED-Pin
MySparkfun7SegI2C My7Seg(0x71); //Initalisiere 7-Segmentanzeige
MyKeypad_I2C MyTast(0x38); //Initialisiere Tastatur
//Definition des Sende-Telegramms
const byte telegrammLaenge = 4; //Telegrammlaenge in Bytes
//Byte0: IDByte
//Byte1: PWM-Impulszeit High-Byte
//Byte2: PWM-Impulszeit Low-Byte
//Byte3: CheckSumme
byte IDByte;
int pwmTime; //PWM-Impulszeit
byte checkSum;
//Index-Nummern des Sendetelegrammms (Variable "sendeBuffer")
#define indexIDByte 0
#define indexHighByte 1
#define indexLowByte 2
#define indexCheckSumByte telegrammLaenge - 1
//Über diese Bytes soll die Checksumme ermittelt werden
#define checkSumByteAnf 0
#define checkSumByteEnd (telegrammLaenge - 2)
//Zusammensetzung des ID-Bytes
//Bit7-6: EmpfängerID
//Bit5-2: KomponentenID
//Bit1-0: BefehlsID
byte empfaengerID = 0;
byte komponentenID;
byte befehlsID;
byte taste; //Wert der gedrückten Taste
int potiWert1; //Wert des Potentiometer1
int potiWert2; //Wert des Potentiometer2
int potiWert3; //Wert des Potentiometer3
int potiWert4; //Wert des Potentiometer4
//Wird nur bei Potis für Motoren verwendet
//int altPotiWert1; //Altwert des Potentiometer1
//int altPotiWert2; //Altwert des Potentiometer2
int altPotiWert3; //Altwert des Potentiometer3
int altPotiWert4; //Altwert des Potentiometer4
byte sendeBuffer[telegrammLaenge]; //Der Sendebuffer wird der VirtualWire-Library übergeben
int pwmTime1Max = 2400; //maximale PWM-Impulszeit für Servo/Motor1
int pwmTime1Min = 560; //minimale PWM-Impulszeit für Servo/Motor1
int pwmTime2Max = 2460; //maximale PWM-Impulszeit für Servo/Motor2
int pwmTime2Min = 560; //minimale PWM-Impulszeit für Servo/Motor2
int pwmTime3Max = 255; //maximale PWM-Impulszeit für Servo/Motor3
int pwmTime3Min = 0; //minimale PWM-Impulszeit für Servo/Motor3
int pwmTime4Max = 255; //maximale PWM-Impulszeit für Servo/Motor4
int pwmTime4Min = 0; //minimale PWM-Impulszeit für Servo/Motor4
//Merker für Tastenbefehl, der gesendet werden soll. Nicht alle Tasten bewirken einen Sendebefehl!
bool sendTastBefehl = false;
//Definition vom maximal 16 Komponenten (0 bis 15)
#define LED1 1
#define LED2 2
#define Servo1 12
#define Servo2 13
#define Motor1 14
#define Motor2 15
void setup() {
if (debug)
{
Serial.begin(115200);
if (MyTast.isReady()) Serial.println("Tastatur gefunden");
else Serial.println("Tastatur-Fehler");
if (My7Seg.isReady()) Serial.println("7-Segmentanzeige gefunden");
else Serial.println("7-Segmentanzeige-Fehler");
}
pinMode(ledPin, OUTPUT);
//altPotiWert1 = analogRead(potiPin1);
//altPotiWert2 = analogRead(potiPin2);
altPotiWert3 = analogRead(potiPin3);
altPotiWert4 = analogRead(potiPin4);
//Initialisierung von VirtualWire
vw_set_tx_pin(txPin); //Setze TX-Pin
vw_setup(8000); //Übertragungsrate 8000 Bit/Sekunde
//sendeBuffer[0] = syncindexHighByte;
My7Seg.setBrightness(50);
My7Seg.sendChar('E', empfaengerID, ' ', ' ');
}
void loop() {
//Zyklisches Abfragen der Tastatur
if (tastZyklusMetro.check())
{
taste = MyTast.receiveKey(-1);
if (debug && taste != 255)
{
Serial.print("Taste: ");
Serial.println(taste);
}
if (taste >= 0 && taste <= 15)
{
//Mit den Tasten 0 - 4 wird der Empfaenger ausgwählt
if (taste == 0)
{
empfaengerID = 0;
//Schreibe "E0" in die 7-Segmentanzeige
My7Seg.sendChar('E', empfaengerID, ' ', ' ');
}
if (taste == 1)
{
empfaengerID = 1;
//Schreibe "E1" in die 7-Segmentanzeige
My7Seg.sendChar('E', empfaengerID, ' ', ' ');
}
if (taste == 2)
{
empfaengerID = 2;
//Schreibe "E2" in die 7-Segmentanzeige
My7Seg.sendChar('E', empfaengerID, ' ', ' ');
}
if (taste == 3)
{
empfaengerID = 3;
//Schreibe "E3" in die 7-Segmentanzeige
My7Seg.sendChar('E', empfaengerID, ' ', ' ');
}
//Mit den Tasten 4 - 15 können Befehle gesendet werden
if (taste == 4) //Befehl LED 1 Ein
{
komponentenID = LED1;
befehlsID = 1;
sendTastBefehl = true; //Merker wenn Befehl gesendet werden soll
}
if (taste == 5)//Befehl LED 1 Aus
{
komponentenID = LED1;
befehlsID = 0;
sendTastBefehl = true; //Merker wenn Befehl gesendet werden soll
}
if (taste == 6) //Befehl LED 1 umschalten (toggle)
{
komponentenID = LED1;
befehlsID = 2;
sendTastBefehl = true; //Merker wenn Befehl gesendet werden soll
}
if (taste == 7) //Befehl Motor 1 Drehrichtung vorwaerts
{
komponentenID = Motor1;
befehlsID = 0;
sendTastBefehl = true; //Merker wenn Befehl gesendet werden soll
}
if (taste == 8) //Befehl Motor 1 Drehrichtung rueckwärts
{
komponentenID = Motor1;
befehlsID = 1;
sendTastBefehl = true; //Merker wenn Befehl gesendet werden soll
}
if (taste == 9) //Befehl Motor 2 Drehrichtung vorwaerts
{
komponentenID = Motor2;
befehlsID = 0;
sendTastBefehl = true; //Merker wenn Befehl gesendet werden soll
}
if (taste == 10) //Befehl Motor 2 Drehrichtung rueckwärts
{
komponentenID = Motor2;
befehlsID = 1;
sendTastBefehl = true; //Merker wenn Befehl gesendet werden soll
}
if (taste == 11) //Befehl LED 2 Ein
{
komponentenID = LED2;
befehlsID = 1;
sendTastBefehl = true; //Merker wenn Befehl gesendet werden soll
}
if (taste == 12)//Befehl LED 2 Aus
{
komponentenID = LED2;
befehlsID = 0;
sendTastBefehl = true; //Merker wenn Befehl gesendet werden soll
}
if (taste == 13) //Befehl LED 1 umschalten (toggle)
{
komponentenID = LED2;
befehlsID = 2;
sendTastBefehl = true; //Merker wenn Befehl gesendet werden soll
}
if (taste == 14) //
{
//Platzhalter für Befehle Taste14
}
if (taste == 15) //Senden EIN/AUS
{
sendeStatus = !sendeStatus;
}
IDByte = (empfaengerID << 6) | (komponentenID << 2) | befehlsID;
//Werte-Bytes im Telegramm loeschen
for (byte i = 2; i < telegrammLaenge - 1; i++) sendeBuffer[i] = 0;
sendeBuffer[indexIDByte] = IDByte;
//Wenn eine Taste mit Sendebefehl gedrueckt wurde, dann gehe zur Sende-Routine
if (sendTastBefehl == true) Sende();
}
}
//Zyklus Servo-Bearbeitung
if (servoZyklusMetro.check())
{
//Bearbeitung Servo1
potiWert1 = analogRead(potiPin1); //Einlesen Poti Servo1
if (debug)
{
Serial.print("Potiwert1: ");
Serial.println(potiWert1);
}
//Ermittlung PWM-Impulszeit Servo1
pwmTime = map(potiWert1, 0, 1023, pwmTime1Min, pwmTime1Max);
if (debug)
{
Serial.print("pwmTime: ");
Serial.println(pwmTime);
}
//IDByte und Sendebuffer definieren
komponentenID = Servo1;
befehlsID = B11;
IDByte = (empfaengerID << 6) | (komponentenID << 2) | befehlsID;
//altPotiWert1 = potiWert1; //aktueller Potiwert wird in "altPotiWert" gespeichert
sendeBuffer[indexIDByte] = IDByte;
sendeBuffer[indexHighByte] = highByte(pwmTime);
sendeBuffer[indexLowByte] = lowByte(pwmTime);
Sende(); //Gehe zur Sende-Routine
//Bearbeitung Servo2
potiWert2 = analogRead(potiPin2); //Einlesen Poti Servo2
if (debug)
{
Serial.print("Potiwert2: ");
Serial.println(potiWert2);
}
//Ermittlung PWM-Impulszeit Servo2
pwmTime = map(potiWert2, 0, 1023, pwmTime2Min, pwmTime2Max);
if (debug)
{
Serial.print("pwmTime: ");
Serial.println(pwmTime);
}
//IDByte und Sendebuffer definieren
komponentenID = Servo2;
befehlsID = B11;
IDByte = (empfaengerID << 6) | (komponentenID << 2) | befehlsID;
//altPotiWert2 = potiWert2; //aktueller Potiwert wird in "altPotiWert" gespeichert
sendeBuffer[indexIDByte] = IDByte;
sendeBuffer[indexHighByte] = highByte(pwmTime);
sendeBuffer[indexLowByte] = lowByte(pwmTime);
Sende(); //Gehe zur Sende-Routine
}
//Zyklus Motor-Bearbeitung
if (motorPotiZyklusMetro.check())
{
//Bearbeitung Motor1
potiWert3 = analogRead(potiPin3); //Einlesen Poti Motor1
//Bei Verstellung von Poti3 oder wenn Hintergrundzyklus aktiv, dann sende PWM-Zeit
if (abs(potiWert3 - altPotiWert3) || hintergrundZyklus3.check())
{
if (debug)
{
Serial.print("Potiwert3: ");
Serial.println(potiWert3);
}
//Ermittlung der PWM-Impulszeit Motor 1
pwmTime = map(potiWert3, 0, 1023, pwmTime3Min, pwmTime3Max);
if (debug)
{
Serial.print("pwmTime: ");
Serial.println(pwmTime);
}
//IDByte und Sendebuffer definieren
komponentenID = Motor1;
befehlsID = B11;
IDByte = (empfaengerID << 6) | (komponentenID << 2) | befehlsID;
altPotiWert3 = potiWert3; //aktueller Potiwert wird in "altPotiWert" gespeichert
sendeBuffer[indexIDByte] = IDByte;
sendeBuffer[indexHighByte] = highByte(pwmTime);
sendeBuffer[indexLowByte] = lowByte(pwmTime);
Sende(); //Gehe zur Sende-Routine
}
//Bearbeitung Motor2
potiWert4 = analogRead(potiPin4); //Einlesen Poti Motor2
//Bei Verstellung von Poti4 oder wenn Hintergrundzyklus aktiv, dann sende PWM-Zeit
if (abs(potiWert4 - altPotiWert4) || hintergrundZyklus4.check())
{
if (debug)
{
Serial.print("Potiwert4: ");
Serial.println(potiWert4);
}
//IDByte und Sendebuffer definieren
pwmTime = map(potiWert4, 0, 1023, pwmTime4Min, pwmTime4Max);
if (debug)
{
Serial.print("pwmTime: ");
Serial.println(pwmTime);
}
komponentenID = Motor2;
befehlsID = B11;
IDByte = (empfaengerID << 6) | (komponentenID << 2) | befehlsID;
altPotiWert4 = potiWert4; //aktueller Potiwert wird in "altPotiWert" gespeichert
sendeBuffer[indexIDByte] = IDByte;
sendeBuffer[indexHighByte] = highByte(pwmTime);
sendeBuffer[indexLowByte] = lowByte(pwmTime);
Sende(); //Gehe zur Sende-Routine
}
}
}
void Sende()
{
if(sendeStatus == true)
{
//Ermittlung der Checksumme
checkSum = 0;
for (byte i = checkSumByteAnf; i <= checkSumByteEnd; i++)
{
CheckByte(sendeBuffer[i], i);
}
//Schreibe ermittelte Checksumme in den Sendebuffer
sendeBuffer[indexCheckSumByte] = checkSum;
if (debug)
{
Serial.print("IDByte: ");
Serial.println(IDByte, BIN);
Serial.print("Sendebuffer: ");
for (byte i = 0; i < telegrammLaenge; i++)
{
Serial.print(sendeBuffer[i]);
Serial.print(" ");
}
Serial.println("\n");
}
//Senden des Telegramms
vw_send((byte*)sendeBuffer, telegrammLaenge);
vw_wait_tx();
//Bei jedem gesendetem Telegramm blinkt die LED für 0,05 ms auf
digitalWrite(ledPin, 1);
delayMicroseconds(50);
digitalWrite(ledPin, 0);
sendTastBefehl = false; //Rücksetzen des Merkers für Tastenbefehl
}
}
//Checksummenbildung
void CheckByte(byte buf, byte i)
{
for (int j = 0; j < 8; j++)
{
if (bitRead(buf, j) == 1) checkSum += (i + j + 1);
}
}
