Files
SyncHome/trunk/Arduino/sketch_pro_LineFollower/sketch_pro_LineFollower.ino
2023-03-13 09:05:51 +00:00

68 lines
1.7 KiB
C++

/* **************************************** *
* Title *
* **************************************** *
* (C) 201x-xx-xx Paolo Iocco *
* rev. 0.x *
* **************************************** *
* Circuit diagram
* ---------------
* +-------+
* | ooooo |
* D1--TX<----| A |<---------RAW
* D0--RX---->| r |<---------GND
* RST------->| d |<---------RST
* GND------->| u |<---------VCC
* D2-------->| i |-----A3---D17
* D3----#--->| n |-----A2---D16
* D4-------->| o |-----A1---D15
* D5<---#----| |-----A0---D14
* D6<---#----| m |-----SCK--D13
* D7---------| i |-----MISO-D12
* D8---------| n |--#--MOSI-D11
* D9----#----| i |--#--SS---D10
* +-------+
*
* ***************************************** */
//int motorPin = 3;
int pwm1 = 9;
int pwm2 = 10;
int pwm3 = 6;
int pwm4 = 5;
int led = 13;
void setup()
{
pinMode(pwm1, OUTPUT);
pinMode(pwm2, OUTPUT);
pinMode(pwm3, OUTPUT);
pinMode(pwm4, OUTPUT);
pinMode(led, OUTPUT);
Serial.begin(9600);
while (!Serial);
Serial.println("Speed 0 to 255");
}
void loop()
{
if (Serial.available())
{
int speed = Serial.parseInt();
if (speed >= 0 && speed <= 255)
{
Serial.println(speed);
analogWrite(pwm1, speed);
analogWrite(pwm2, speed);
analogWrite(pwm3, speed);
analogWrite(pwm4, speed);
}
}
digitalWrite(led, HIGH); // turn the LED on (HIGH is the voltage level)
delay(900); // wait for a second
digitalWrite(led, LOW); // turn the LED off by making the voltage LOW
delay(100);
}