Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- int enA = 10; // zadeklarowanie pinow do silnika
- int in1 = 9;
- int in2 = 8;
- int enB = 5;
- int in3 = 7;
- int in4 = 6;//
- void setup() {
- pinMode(A3, INPUT);
- pinMode(A5, INPUT);
- pinMode(A4, INPUT);
- pinMode(13, LED_BUILTIN);
- Serial.begin(9600);
- }
- boolean sensor1() {
- if(analogRead(A5) < 750) {
- return 0;
- }
- else {
- return 1;
- }
- }
- boolean sensor2() {
- if(analogRead(A4) < 750) {
- return 0;
- }
- else {
- return 1;
- }
- }
- boolean sensor3() {
- if(analogRead(A3) < 750) {
- return 0;
- }
- else {
- return 1;
- }
- }
- void lewysilnik() {
- digitalWrite(in1, HIGH);// wpisanie pinowi stanu wysokiego
- digitalWrite(in2, LOW);// wpisanie pinowi stanu niskiego
- analogWrite(enA, 255);// wpisanie predkosci silnika (0 do 255) na pin enA
- }
- void prawysilnik() {
- digitalWrite(in3, HIGH);// wpisanie pinowi stanu wysokiego
- digitalWrite(in4, LOW);// wpisanie pinowi stanu niskiego
- analogWrite(enB, 255);// wpisanie predkosci silnika (0 do 255) na pin enB
- }
- void zatrzymaj() {
- analogWrite(enA, 0);// wylaczenie silnikow
- analogWrite(enB, 0);//
- }
- void loop() {
- int odczyt = analogRead(A3);
- int odczyt1 = analogRead(A4);
- int odczyt2 = analogRead(A5);
- Serial.println(odczyt1);
- Serial.println(odczyt2);
- Serial.println(odczyt);
- if (sensor1() == 1 && sensor2() == 1 && sensor3() == 1) { //Jesli oba czujniki widza linii
- lewysilnik();
- prawysilnik();
- }
- else if (sensor1() == 0 && sensor2() == 1 && sensor3() == 0) { //Jesli oba czujniki widza linii
- lewysilnik();
- prawysilnik();
- }
- else if (sensor1() == 1 && sensor2() == 0 && sensor3() == 0) { //Jesli oba czujniki widza linii
- zatrzymaj();
- lewysilnik();
- }
- else if (sensor1() == 0 && sensor2() == 0 && sensor3() == 1) { //Jesli oba czujniki widza linii
- zatrzymaj();
- prawysilnik();
- }
- else if (sensor1() == 0 && sensor2() == 0 && sensor3() == 0) { //Jesli oba czujniki widza linii
- zatrzymaj();
- }
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement