Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- #define prog 500
- #define czas 300
- void tytyna();
- void accto();
- int n[ 10 ];
- unsigned long czasoff = 0;
- void setup() {
- Serial.begin(9600);
- pinMode(3,OUTPUT);
- pinMode(5,OUTPUT);
- pinMode(A0,INPUT);
- pinMode(A1,INPUT);
- pinMode(A2,INPUT);
- pinMode(A3,INPUT);
- pinMode(A4,INPUT);
- pinMode(A5,INPUT);
- }
- void loop() {
- n[ 1 ] = analogRead(A0);
- n[ 2 ] = analogRead(A1);
- n[ 3 ] = analogRead(A2);
- n[ 4 ] = analogRead(A3);
- n[ 5 ] = analogRead(A4);
- n[ 6 ] = analogRead(A5);
- void tytyna();
- void accto();
- }
- void tytyna(){
- if(Serial.available())
- char zyw ;
- zyw = Serial.read();
- switch(zyw){
- case "stop";
- analogWrite(3,0);
- analogWrite(5,0);
- case"go";
- analogWrite(3,255);
- analogWrite(5,255);
- case"back";
- analogWrite(3,-255);
- analogWrite(5,-255);
- case"left";
- analogWrite(3,255);
- analogWrite(5,-255);
- case"right"
- analogWrite(3,-255);
- analogWrite(5,255);
- }
- }
- void odczytCzujnikow(){
- for(int i = 14;i<=19;++i){
- int tmp = analogRead(i);
- if(tmp >= prog) n[i-14]=1;
- else n[i-14]=0;
- }
- }
- void accto(){
- if (czasoff + czas < millis()) {
- czasoff = millis();
- for(int x = 0;x<=5;++x){
- Serial.print(n[x]);
- }
- Serial.println();
- }
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement