AplTVY3-B3-1sk-4T
(→se pohyboval vpřed do vzdálenosti 1m) |
(→se pohyboval vpřed ve čtyřúhelníku o straně cca 0,5m) |
||
Řádka 48: | Řádka 48: | ||
==se pohyboval vpřed ve čtyřúhelníku o straně cca 0,5m == | ==se pohyboval vpřed ve čtyřúhelníku o straně cca 0,5m == | ||
+ | int motor_left[] = {6, 7};<br /> | ||
+ | |||
+ | int motor_right[] = {8, 10};<br /> | ||
+ | void setup() {<br /> | ||
+ | Serial.begin(9600);<br /> | ||
+ | int i;<br /> | ||
+ | for(i = 0; i < 2; i++){<br /> | ||
+ | pinMode(motor_left[i], OUTPUT);<br /> | ||
+ | pinMode(motor_right[i], OUTPUT);<br /> | ||
+ | }<br /> | ||
+ | }<br /> | ||
+ | |||
+ | void loop() {}<br /> | ||
+ | |||
+ | drive_forward();<br /> | ||
+ | delay(3200);<br /> | ||
+ | motor_stop();<br /> | ||
+ | Serial.println("1");<br /> | ||
+ | |||
+ | turn_left();<br /> | ||
+ | delay(420);<br /> | ||
+ | motor_stop();<br /> | ||
+ | Serial.println("3");<br /> | ||
+ | |||
+ | motor_stop();<br /> | ||
+ | delay(1000);<br /> | ||
+ | motor_stop();<br /> | ||
+ | Serial.println("5");<br /> | ||
+ | |||
+ | }<br /> | ||
+ | |||
+ | |||
+ | void motor_stop(){<br /> | ||
+ | digitalWrite(motor_left[0], LOW);<br /> | ||
+ | digitalWrite(motor_left[1], LOW);<br /> | ||
+ | |||
+ | digitalWrite(motor_right[0], LOW);<br /> | ||
+ | digitalWrite(motor_right[1], LOW);<br /> | ||
+ | delay(25);<br /> | ||
+ | }<br /> | ||
+ | |||
+ | void drive_forward(){<br /> | ||
+ | digitalWrite(motor_left[0], HIGH);<br /> | ||
+ | digitalWrite(motor_left[1], LOW);<br /> | ||
+ | |||
+ | digitalWrite(motor_right[0], HIGH);<br /> | ||
+ | digitalWrite(motor_right[1], LOW);<br /> | ||
+ | }<br /> | ||
+ | |||
+ | void turn_left(){<br /> | ||
+ | digitalWrite(motor_left[0], LOW);<br /> | ||
+ | digitalWrite(motor_left[1], HIGH);<br /> | ||
+ | |||
+ | digitalWrite(motor_right[0], HIGH);<br /> | ||
+ | digitalWrite(motor_right[1], LOW);<br /> | ||
+ | }<br /> | ||
+ | |||
==jel rovně a zastavil na 60 cm vzdáleném místě označeném černou lepící páskou == | ==jel rovně a zastavil na 60 cm vzdáleném místě označeném černou lepící páskou == | ||
==se pohyboval dokud nebude stisknutý dotykový senzor == | ==se pohyboval dokud nebude stisknutý dotykový senzor == |
Verze z 4. 6. 2012, 12:10
HW: Arduino realizace: Maxa David Charvát Jakub Lukáš Jílek
Úkoly:
- Sestavte robota, napište program a vyzkoušejte proto, aby robot:
se pohyboval vpřed do vzdálenosti 1m
int motor_left[] = {6, 7};
int motor_right[] = {8, 10};
void setup() {
Serial.begin(9600);
int i;
for(i = 0; i < 2; i++){
pinMode(motor_left[i], OUTPUT);
pinMode(motor_right[i], OUTPUT);
drive_forward();
delay(6200);
motor_stop();
Serial.println("1");
}
}
void loop() {
}
void motor_stop(){
digitalWrite(motor_left[0], LOW);
digitalWrite(motor_left[1], LOW);
digitalWrite(motor_right[0], LOW);
digitalWrite(motor_right[1], LOW);
}
void drive_forward(){
digitalWrite(motor_left[0], HIGH);
digitalWrite(motor_left[1], LOW);
digitalWrite(motor_right[0], HIGH);
digitalWrite(motor_right[1], LOW);
}
se pohyboval vpřed ve čtyřúhelníku o straně cca 0,5m
int motor_left[] = {6, 7};
int motor_right[] = {8, 10};
void setup() {
Serial.begin(9600);
int i;
for(i = 0; i < 2; i++){
pinMode(motor_left[i], OUTPUT);
pinMode(motor_right[i], OUTPUT);
}
}
void loop() {}
drive_forward();
delay(3200);
motor_stop();
Serial.println("1");
turn_left();
delay(420);
motor_stop();
Serial.println("3");
motor_stop();
delay(1000);
motor_stop();
Serial.println("5");
}
void motor_stop(){
digitalWrite(motor_left[0], LOW);
digitalWrite(motor_left[1], LOW);
digitalWrite(motor_right[0], LOW);
digitalWrite(motor_right[1], LOW);
delay(25);
}
void drive_forward(){
digitalWrite(motor_left[0], HIGH);
digitalWrite(motor_left[1], LOW);
digitalWrite(motor_right[0], HIGH);
digitalWrite(motor_right[1], LOW);
}
void turn_left(){
digitalWrite(motor_left[0], LOW);
digitalWrite(motor_left[1], HIGH);
digitalWrite(motor_right[0], HIGH);
digitalWrite(motor_right[1], LOW);
}