initial import
This commit is contained in:
		
							
								
								
									
										51
									
								
								Sketches/bluetooth_motor/bluetooth_motor.ino
									
									
									
									
									
										Normal file
									
								
							
							
						
						
									
										51
									
								
								Sketches/bluetooth_motor/bluetooth_motor.ino
									
									
									
									
									
										Normal file
									
								
							| @@ -0,0 +1,51 @@ | ||||
| #include <SparkFun_TB6612.h> | ||||
|  | ||||
| #include <SoftwareSerial.h> | ||||
|  | ||||
| #define AIN1 4 | ||||
| #define BIN1 8 | ||||
| #define AIN2 5 | ||||
| #define BIN2 9 | ||||
| #define PWMA 7 | ||||
| #define PWMB 10 | ||||
| #define STBY 6 | ||||
|  | ||||
| const int offsetA = 1; | ||||
| const int offsetB = 1; | ||||
|  | ||||
| SoftwareSerial BTSerial(3, 2); // RX | TX | ||||
| String reader; | ||||
| int d = 0; | ||||
| 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 | ||||
| } | ||||
|  | ||||
| void loop() | ||||
| { | ||||
|   reader=""; | ||||
|   while (BTSerial.available()) { | ||||
|     delay(3); | ||||
|     if (BTSerial.available()>0) { | ||||
|       char c = BTSerial.read(); | ||||
|       reader += c; | ||||
|          | ||||
|     } | ||||
|   } | ||||
|   if (reader.length() > 0) { | ||||
|     Serial.println("Receved: "+reader+""); | ||||
|     d = reader.toInt();     | ||||
|   } | ||||
|   | ||||
|   if (d == 11) { | ||||
|     motor1.drive(255); | ||||
|   } else if (d == 12) { | ||||
|     motor1.drive(-255); | ||||
|   } | ||||
|    | ||||
| } | ||||
		Reference in New Issue
	
	Block a user