12-05-2016, 00:08
Kod:
#include <SoftwareSerial.h>
#define in1 5 //L298n Motor Driver pins.
#define in2 6
#define in3 10
#define in4 11
int command; //Int to store app command state.
int button; // Store how many times a button has been pressed.
void setup() {
pinMode(in1, OUTPUT);
pinMode(in2, OUTPUT);
pinMode(in3, OUTPUT);
pinMode(in4, OUTPUT);
Serial.begin(9600); //Set the baud rate to your Bluetooth module.
}
void loop() {
Button();
if (Serial.available() > 0) {
command = Serial.read();
Stop(); //Initialize with motors stoped.
switch (command) {
case 'F':
forward();
break;
case 'B':
back();
break;
case 'L':
left();
break;
case 'R':
right();
break;
}
}
}
void Button () {
Serial.print("button = ");
Serial.print(button);
Serial.println(" ");
delay(10);
}
void forward() {
analogWrite(in1, 255);
analogWrite(in4, 255);
}
void back() {
analogWrite(in2, 255);
analogWrite(in3, 255);
}
void left() {
analogWrite(in3, 255);
analogWrite(in1, 255);
}
void right() {
analogWrite(in4, 255);
analogWrite(in2, 255);
}
void Stop() {
analogWrite(in1, 0);
analogWrite(in2, 0);
analogWrite(in3, 0);
analogWrite(in4, 0);
}
(11-05-2016, 10:30)JasQ napisał(a): Pobaw się jak nie będzie działać wklej poszukamy przyczynyTen kod musiałbym połączyć z kodem od serv.