Browse Source

merged master

master
Lukas Reichwein 5 years ago
parent
commit
da1eb955f9
  1. 2
      .~lock.ideen_mechanik_und_elektronik.odt#
  2. 62
      Code/miniRobot/miniRobot.ino
  3. 42
      Code/miniRobot/temperatureDistance.ino
  4. 6
      Code/miniRobotRC/JoystickSteuerung.ino
  5. 13
      Code/miniRobotRC/_main.ino
  6. 55
      Code/miniRobotRC/fahrsteuerung_old.ino
  7. 2
      Code/miniRobotRC/funkInit.ino
  8. 5
      Code/miniRobotRC/interruptRoutinen.ino
  9. 33
      Code/miniRobotRC/joystick.ino
  10. 36
      Code/miniRobotRC/miniRobotRC.ino
  11. 8
      Latex/main.tex
  12. BIN
      ideen_mechanik_und_elektronik.odt

2
.~lock.ideen_mechanik_und_elektronik.odt#

@ -1 +1 @@
,yves,yves-UB,05.02.2020 13:15,file:///home/yves/.config/libreoffice/4;
,yves,yves-UB,05.02.2020 13:51,file:///home/yves/.config/libreoffice/4;

62
Code/miniRobot/miniRobot.ino

@ -12,6 +12,9 @@
RF24 radio(A0, 3); // CE, CSN
byte commands[32]; //byte 0 = command
unsigned long timer;
int16_t temperature = 0;
uint16_t distance = 50;
void inline clearCommands() {
for(uint8_t i=0; i<32; i++) {
@ -20,6 +23,7 @@ void inline clearCommands() {
}
const byte address[6] = "00001";
const byte address2[6] = "00002";
//Kommandos
#define nothing 9 //reset/nichts tun
#define speedA 1 // set speed A + speed
@ -30,7 +34,7 @@ const byte address[6] = "00001";
#define stopDrive 6 //stop
#define getTemp 7 //get temperature
#define timeToDrive 8 //Zeitdauer des fahrens
#define distance 10 //Abstand zu Objekten
#define getDistance 10 //Abstand zu Objekten
//Motortreiber
//#include <MX1508.h>
@ -57,9 +61,6 @@ bool forwardA = true;
bool forwardB = true;
volatile bool driveOn = false;
int temperatur = 0;
volatile long driveTimeout = 0;
volatile long driveTimeDiff = 0;
@ -68,13 +69,39 @@ void setup() {
// motorA.setPWM16(2,RESOLUTION);
// motorB.setPWM16(2,RESOLUTION);
radio.begin();
radio.openReadingPipe(0, address);
radio.openWritingPipe(address2);
radio.openReadingPipe(1, address);
radio.setPALevel(RF24_PA_MAX);
radio.startListening();
clearCommands();
//Temperatur- und Abstandsmessung
setEchoPins(16, 6); //16: A2, 6: D6
tempDistSetup();
timer = millis();
}
void loop() {
//Temperatur- und Abstandsmessung
//Serial.println(temperature);
//Serial.println(distance);
unsigned long currentMillis = millis();
if((unsigned long)(currentMillis - timer) >= 100){
temperature = dallas(4, 0);
measureDistance();
distance = calculateDistance();
Serial.println(distance);
timer = currentMillis;
}
if (radio.available()) {
radio.read(&commands, sizeof(commands));
commandInterpretation();
@ -84,8 +111,22 @@ void loop() {
pwmA = 0;
pwmB = 0;
}
if(distance < 20){
//Serial.println("Achtung!");
if(pwmA < 0 && pwmB < 0){
pwmA = 0;
pwmB = 0;
}
}
drive.setPWM_A(pwmA);
drive.setPWM_B(pwmB);
}
void commandInterpretation() {
@ -130,9 +171,12 @@ void commandInterpretation() {
driveOn = false;
break;
}
case getTemp : {
temperatur = (0xFF00 & (commands[i+1] << 8));
temperatur |= (0x00FF & commands[i+2]);
case getTemp : {
//Serial.println("Senden!");
radio.stopListening();
int16_t sendData = temperature;
radio.write(&sendData, sizeof(int16_t));
radio.startListening();
break;
}
case timeToDrive : {
@ -149,9 +193,11 @@ void commandInterpretation() {
forwardA = true;
forwardB = true;
driveOn = false; */
break;
}
}
}
clearCommands();
}

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

@ -2,17 +2,18 @@
#define maxDistance 400
int trig = 0;
int echo = 0;
int trig;
int echo;
//int distance = 0;
int distance2 = 0;
uint16_t distance3 = 0;
uint16_t distance2 = 0;
//ISR for PCINT20
ISR(PCINT2_vect) {
distance = pulseIn(echo, HIGH);
if(distance > 0){
distance2 = distance;
distance3 = pulseIn(echo, HIGH);
if(distance3 > 0){
distance2 = distance3;
}
delayMicroseconds(10);
@ -25,25 +26,23 @@ void setEchoPins(int pin1, int pin2){
echo = pin2;
}
int calculateDistance(){
int result = distance2/ 58;
if(result > maxDistance){
result = maxDistance;
int16_t calculateDistance(){
int16_t result2 = distance2/ 58;
if(result2 > maxDistance){
result2 = maxDistance;
}
return result;
return result2;
}
void measureDistance(){
PORTD |= (1<<trig);
digitalWrite(trig, HIGH);
// ... wait for 10 µs ...
delayMicroseconds(10);
// ... put the trigger down ...
distance = 600;
PORTD &= ~(1<<trig);
digitalWrite(trig, LOW);
PCICR |= 0b00000100;
PCMSK2 |= 0b00010000;
@ -63,11 +62,13 @@ int16_t dallas(int x, byte start){
ds.write(0xBE); //Read 1st 2 bytes of Scratchpad
result = 0;
for(i = 0; i < 2; i++){
data[i] = ds.read();
result += data[i];
data[i] = ds.read();
}
result = (data[1]<<8)|data[0];
result = result/2;
result = result/16; //DS1820 2 DS18B20 16
ds.reset();
ds.write(0xCC);
ds.write(0x44, 1); //start conversion
@ -88,6 +89,7 @@ void tempDistSetup(){
// Reset the trigger pin and wait a half a second
digitalWrite(trig, LOW);
delayMicroseconds(500);
Serial.println(echo);
sei();
@ -101,7 +103,7 @@ void runMeasurements(){
}
Serial.print("Temperatur: ");
Serial.println(dallas(2, 0));
Serial.println(dallas(4, 0));
Serial.print("Distanz: ");
Serial.print(calculateDistance());

6
Code/miniRobotRC/JoystickSteuerung.ino

@ -72,11 +72,5 @@ void joystickInit() {
commands[7] = highByte(driveTimeout);
commands[8] = lowByte(driveTimeout);
commands[9] = goDrive;
commands[10] = getTemp;
commands[11] = highByte(temperature);
commands[12] = lowByte(temperature);
commands[13] = getTemp;
commands[14] = highByte(distance);
commands[15] = lowByte(distance);
radio.write(&commands, sizeof(commands));
}

13
Code/miniRobotRC/_main.ino

@ -2,8 +2,6 @@
#include <avr/io.h>
#include <Arduino.h>
long timer;
void inline clearCommands() {
for(uint8_t i=0; i<32; i++) {
commands[i] = 0xFF;
@ -17,19 +15,17 @@ void setup() {
driveTimeout = 10;
joystickInit(); //TODO
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() {
//lcdMenu();
while(!tasten.getButtonCycle(buttonStart)) {
manualDigitalDrive();
}
tasten.clearButton(buttonStart);
while(!tasten.getButtonCycle(buttonStart)){
while(!tasten.getButtonCycle(buttonStart)){
motorMapping();
}
tasten.clearButton(buttonStart);
@ -40,6 +36,7 @@ void loop() {
}
tasten.clearButton(buttonStart);
<<<<<<< HEAD
//Temperatur- und Abstandsmessung
/*
temperature = dallas(4, 0);
@ -51,6 +48,8 @@ void loop() {
distance = calculateDistance();
*/
=======
>>>>>>> 48327ec5c42c4d70afa8e9c00bbf52ab2db2ca05
}
void lcdMenu() {

55
Code/miniRobotRC/fahrsteuerung_old.ino

@ -1,37 +1,62 @@
void manualDigitalDrive() {
bool goOn = false;
String temp_str = "T: " + String(temperature) + " Grad C";
lcdLines[5] = temp_str;
// while(!tasten.getButtonCycle(buttonL1)) {
clearCommands();
if(!tasten.getAnyPressed()) {
<<<<<<< HEAD
//lcd.clear();
lcd.println("Warte...");
=======
lcdLines[0] = "Warte...";
>>>>>>> 48327ec5c42c4d70afa8e9c00bbf52ab2db2ca05
}
if(tasten.checkButton(buttonB) || tasten.checkButton(buttonUp)) {
pwmA = -215;
pwmB = -255;
<<<<<<< HEAD
//lcd.clear();
lcd.println("geradeaus fahren");
=======
lcdLines[0] = "geradeaus fahren";
>>>>>>> 48327ec5c42c4d70afa8e9c00bbf52ab2db2ca05
goOn =true;
}
if(tasten.checkButton(buttonC) || tasten.checkButton(buttonDown)) {
pwmA = 100;
pwmB = 255;
<<<<<<< HEAD
//lcd.clear();
lcd.println("rueckwaerts fahren");
=======
lcdLines[0] = "rueckwaerts fahren";
>>>>>>> 48327ec5c42c4d70afa8e9c00bbf52ab2db2ca05
goOn =true;
}
if(tasten.checkButton(buttonRight)) {
pwmA = -100; //rechter Motor
pwmB = 100;
<<<<<<< HEAD
//lcd.clear();
lcd.println("rechts lenken");
=======
lcdLines[0] = "rechts lenken";
>>>>>>> 48327ec5c42c4d70afa8e9c00bbf52ab2db2ca05
goOn =true;
}
if(tasten.checkButton(buttonLeft)) {
pwmB = -100;
pwmA = 100;
<<<<<<< HEAD
//lcd.clear();
lcd.println("links lenken");
=======
lcdLines[0] = "links lenken";
>>>>>>> 48327ec5c42c4d70afa8e9c00bbf52ab2db2ca05
goOn =true;
}
if(goOn) {
@ -45,9 +70,39 @@ void manualDigitalDrive() {
commands[7] = highByte(driveTimeout);
commands[8] = lowByte(driveTimeout);
commands[9] = goDrive;
radio.write(&commands, sizeof(commands));
goOn = false;
}
//Temperatur <3
unsigned long currentMillis = millis();
if((unsigned long)(currentMillis - temp_time) >= 1000){ // jede Sekunden
temp_time = millis();
bool err = false;
clearCommands();
commands[0] = getTemp;
radio.write(&commands, sizeof(commands) && !err);
unsigned long start = micros();
radio.startListening();
while(!radio.available()){
//Serial.println("nix");
unsigned long currentMicros = micros();
if((unsigned long)(currentMicros - start) >= 1){
err = true;
}
}
if(!err){
int16_t readData;
radio.read(&readData, sizeof(int16_t));
temperature = readData;
}
radio.stopListening();
clearCommands();
}
// }
// tasten.clearAllButtons();
}

2
Code/miniRobotRC/funkInit.ino

@ -1,6 +1,8 @@
void funkInit() {
radio.begin();
radio.openWritingPipe(address);
radio.openReadingPipe(1, address2);
radio.setPALevel(RF24_PA_MAX);
radio.stopListening();
}

5
Code/miniRobotRC/interruptRoutinen.ino

@ -3,6 +3,11 @@ ISR(TIMER2_COMPA_vect) {
tasten.checkButtons();
renderTime++;
if(renderTime >= renderTimeout) {
lcd.clear();
for(uint8_t i = 0; i < sizeof(lcdLines); i++) {
lcd.gotoXY(0, i);
lcd.print(lcdLines[i]);
}
lcd.renderAll();
renderTime = 0;
}

33
Code/miniRobotRC/joystick.ino

@ -10,28 +10,8 @@ volatile int16_t yValue = 0;
volatile int16_t leftPWM = 0;
volatile int16_t rightPWM = 0;
const int16_t deadZone = 10;
/*
void setup() {
Serial.begin(115200);
}
void loop() {
koordinaten(analogRead(xPin), analogRead(yPin));
motorPWM();
Serial.print("X: ");
Serial.println(xValue);
Serial.print("Y: ");
Serial.println(yValue);
Serial.print("links: ");
Serial.println(leftPWM);
Serial.print("rechts: ");
Serial.println(rightPWM);
delay(200);
const int16_t deadZone = 40;
}
*/
void motorMapping() {
static long temp = millis();
koordinaten(analogRead(xPin), analogRead(yPin));
@ -40,12 +20,23 @@ void motorMapping() {
pwmB = map(leftPWM, -255,255,leftMin,leftMax);
pwmA = map(rightPWM, -255,255,rightMin,rightMax);
if((millis() - temp) > 100) {
<<<<<<< HEAD
//lcd.clear();
lcd.println("Links: ");
lcd.println(pwmB);
lcd.gotoXY(0,2);
lcd.println("Rechts: ");
lcd.println(pwmA);
=======
// lcd.clear();
// lcd.println("Links: ");
lcdLines[0] = "Links: " + String(pwmB, DEC);
// lcd.println(pwmB);
// lcd.gotoXY(0,2);
// lcd.println("Rechts: ");
lcdLines[0] = "Rechts: " + String(pwmA, DEC);
// lcd.println(pwmA);
>>>>>>> 48327ec5c42c4d70afa8e9c00bbf52ab2db2ca05
}
senden();

36
Code/miniRobotRC/miniRobotRC.ino

@ -4,7 +4,7 @@
#define CLR_BIT(p,n) ((p) &= ~((1) << (n)))
#define SET_BIT(p,n) ((p) |= (1 << (n)))
//Pinzuordnungen
#define BL 10 //backlight, Hintergrundbeleuchtung LCD
#define SD_CARD_CS 2 //D2 ist Chip Enable
#define BAT_VOLTAGE A7 //Akkuspannung an A7
@ -17,7 +17,8 @@ volatile myInterrupts pwmBL;
volatile shiftRegButton tasten;
//LCD
uint8_t renderTime = 0;
#define renderTimeout 100
#define renderTimeout 100 //es wird alle 100ms gerendert
String lcdLines[6]; //Strings welche alle 100ms ausgegeben werden
//Kommandos
#define nothing 9 //reset/nichts tun
@ -31,15 +32,17 @@ uint8_t renderTime = 0;
#define timeToDrive 8 //Zeitdauer des fahrens
#define getDistance 10 //Abstand zu Objekten
int pwmA = 0;
int pwmB = 0;
int16_t pwmA = 0;
int16_t pwmB = 0;
bool forwardA = true;
bool forwardB = true;
bool driveOn = false;
uint16_t driveTimeout = 0;
int distance;
int temperature;
uint8_t distance;
uint8_t temperature = 0;
unsigned long temp_time = millis();
//Funk
#include <SPI.h>
@ -49,25 +52,6 @@ int temperature;
RF24 radio(A2, A3); // CE, CSN
const byte address[6] = "00001";
const byte address2[6] = "00002";
uint8_t commands[32];
/*
const String mainMenu[] = {
"fahren", //0
"stoppen", //1
"manuell fahren", //2
"", //3
"", //4
"", //5
"", //6
"", //7
"", //8
"" //9
};
const String subMenuEntry0[] = {
"Zeitdauer",
"Speed A",
"Speed B",
"Starten"
}; */

8
Latex/main.tex

@ -229,12 +229,16 @@ const byte address[6] = "00001";
\end{file}
Damit sind bereits Sämtliche Konfigurationen für die Hardware-SPI Kommunikation zwischen Arduino nano und dem nRF24L01 erledigt.
<<<<<<< HEAD
Kommunizieren zwischen zwei dieser Setups wird dann durch die Funktionen read und wirite,
jedoch muss vor dem Start einer Kommunikation die Methoden begin(),
openWritingPipe(address) mit address als Kommunikationsleitung und stopListening() bei Sender bzw startListening() beim Empfänger aufgerufen werden.
Die Methode setPALevel() setzt den Power Amplifiyer Level umso höher dieser Wert umso Stärker das Signal,
wodurch der Stromverbrauch Steigt.
Der Anstieg des Stromverbrauchs kann auch bei einer nicht ganz konstanten Stromversorgung dazu führen das das Modul nicht korrekt funktioniert.
=======
Kommunizieren zwischen zwei dieser Setups wird dann durch die Funktionen read und write, jedoch muss vor dem Start einer Kommunikation die Methode begin() aufgerufen werden.
>>>>>>> 48327ec5c42c4d70afa8e9c00bbf52ab2db2ca05
\begin{file}[RF24 initialisieren]
\begin{lstlisting}[language=C++]
//An der Sender Seite
@ -273,7 +277,9 @@ if (radio.available()) {
%Folgende beiden ließen sich auch durch subsections mittels sensoric als section realisieren, kommt aber auf die menge des textes an subsections sollten nicht über eine halbe seite lang sein.
\newpage
\section{Thermosensor} %Nick
Wie bereits erwähnt benutzen wir einen Dallas DS1820 1-Wire Digital Thermometer, um die Motortemperatur zu messen. Der DS1820 speichert die Temperatur als einen 9bit Wert und kann Temperaturen im Bereich von -55°C bis 125°C messen. Für unsere Bedürfnisse reicht es wenn wir in 1-er Schritten messen. Der Sensor kommt aber auch mit halben Graden zu recht.
Eine Messung wird durchgeführt indem der Sensor Takte, innerhalb eines Zeitfensters zählt. Der Zähler startet bei einem Wert, der -55°C darstellt. Erreicht der Zähler 0 schneller als das vorgegebene Zeitfenster wird das Temperaturregister inkrementiert. Der Zähler wird auf einen vom Slope Accumulator Circuitry abhängigen wert gestellt und wieder runtergezählt. Dies wiederholt sich solange bis das festgelegte Zeitfenster abgelaufen ist.
\newpage
\section{Ultraschallsensor} %Nick

BIN
ideen_mechanik_und_elektronik.odt

Loading…
Cancel
Save