Browse Source

Moved measurement to robot instaed of RC.

master
nickg 5 years ago
parent
commit
3d38ab4b4f
  1. 17
      Code/miniRobot/miniRobot.ino
  2. 0
      Code/miniRobot/temperatureDistance.ino
  3. 18
      Code/miniRobotRC/_main.ino

17
Code/miniRobot/miniRobot.ino

@ -12,6 +12,7 @@
RF24 radio(A0, 3); // CE, CSN RF24 radio(A0, 3); // CE, CSN
byte commands[32]; //byte 0 = command byte commands[32]; //byte 0 = command
long timer;
void inline clearCommands() { void inline clearCommands() {
for(uint8_t i=0; i<32; i++) { for(uint8_t i=0; i<32; i++) {
@ -72,6 +73,11 @@ void setup() {
radio.setPALevel(RF24_PA_MAX); radio.setPALevel(RF24_PA_MAX);
radio.startListening(); radio.startListening();
clearCommands(); clearCommands();
//Temperatur- und Abstandsmessung
tempDistSetup();
setEchoPins(0, 0); //Setze die pins für den Abstandsensor aus denen gelesenw erden soll das erster ist der Trigger-, das zweite der Echopin
timer = millis();
} }
void loop() { void loop() {
@ -86,6 +92,17 @@ void loop() {
} }
drive.setPWM_A(pwmA); drive.setPWM_A(pwmA);
drive.setPWM_B(pwmB); drive.setPWM_B(pwmB);
//Temperatur- und Abstandsmessung
temperature = dallas(4, 0);
if(millis() - timer >= 100){
measureDistance();
timer = millis();
}
distance = calculateDistance();
} }
void commandInterpretation() { void commandInterpretation() {

0
Code/miniRobotRC/temperatureDistance.ino → Code/miniRobot/temperatureDistance.ino

18
Code/miniRobotRC/_main.ino

@ -2,8 +2,6 @@
#include <avr/io.h> #include <avr/io.h>
#include <Arduino.h> #include <Arduino.h>
long timer;
void inline clearCommands() { void inline clearCommands() {
for(uint8_t i=0; i<32; i++) { for(uint8_t i=0; i<32; i++) {
commands[i] = 0xFF; commands[i] = 0xFF;
@ -17,10 +15,7 @@ void setup() {
driveTimeout = 10; driveTimeout = 10;
joystickInit(); //TODO joystickInit(); //TODO
clearCommands(); clearCommands();
//Temperatur- und Abstandsmessung
tempDistSetup();
setEchoPins(0, 0); //Setze die pins für den Abstandsensor aus denen gelesenw erden soll das erster ist der Trigger-, das zweite der Echopin
timer = millis();
} }
void loop() { void loop() {
@ -38,17 +33,6 @@ void loop() {
} }
tasten.clearButton(buttonStart); tasten.clearButton(buttonStart);
//Temperatur- und Abstandsmessung
temperature = dallas(4, 0);
if(millis() - timer >= 100){
measureDistance();
timer = millis();
}
distance = calculateDistance();
} }
void lcdMenu() { void lcdMenu() {

Loading…
Cancel
Save