yehor/VaporizR2
Archived
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Project structure change

Browse Source
This commit is contained in:
estevez
2017-12-26 22:25:41 +02:00
parent ab4cecee89
commit 4257fee20a
43 changed files with 0 additions and 0 deletions
Download Patch File Download Diff File Expand all files Collapse all files

74
Arduino/VaporizR2/VaporizR2.ino Normal file
View File

@ -0,0 +1,74 @@
#include <SparkFun_TB6612.h>
#include <SoftwareSerial.h>
#define AIN1 4
#define BIN1 8
#define AIN2 5
#define BIN2 7
#define PWMA 11
#define PWMB 10
#define STBY 6
const int offsetA = 1;
const int offsetB = -1;
SoftwareSerial BTSerial(3, 2); // RX | TX
String reader;
Motor motor1 = Motor(AIN1, AIN2, PWMA, offsetA, STBY);
Motor motor2 = Motor(BIN1, BIN2, PWMB, offsetB, STBY);
void setup()
{
//Serial.begin(9600);
//Serial.println("Ready:");
BTSerial.begin(9600); // HC-05 default speed in AT command more
brake(motor1, motor2);
}
void loop()
{
char m1 = '9';
char m2 = '9';
//Serial.println("There is "+String(BTSerial.available())+" available");
if (BTSerial.available()==2) {
m1 = BTSerial.read();
m2 = BTSerial.read();
//Serial.println("Receved: "+String(m1)+";"+String(m2));
switch (m1) {
case '0':
motor1.drive(-255);
break;
case '1':
motor1.drive(-170);
break;
case '2':
motor1.drive(0);
break;
case '3':
motor1.drive(170);
break;
case '4':
motor1.drive(255);
break;
}
switch (m2) {
case '0':
motor2.drive(-255);
break;
case '1':
motor2.drive(-170);
break;
case '2':
motor2.drive(0);
break;
case '3':
motor2.drive(170);
break;
case '4':
motor2.drive(255);
break;
}
}
}