Zalohy z 24. schuzky.

zalohy/viky/auto_david/auto_david.ino

@@ -0,0 +1,165 @@
+
+#include <Servo.h>
+#include <Servo.h>
+Servo myservo;
+int Echo_Pin=A0;  // ultrasonic module   ECHO to A0
+int Trig_Pin=A1;  // ultrasonic module  TRIG to A1
+#define Lpwm_pin  5     //pin of controlling speed---- ENA of motor driver board
+#define Rpwm_pin  6    //pin of controlling speed---- ENB of motor driver board
+int pinLB=2;             //pin of controlling turning---- IN1 of motor driver board
+int pinLF=4;             //pin of controlling turning---- IN2 of motor driver board
+int pinRB=7;            //pin of controlling turning---- IN3 of motor driver board
+int pinRF=8;            //pin of controlling turning---- IN4 of motor driver board
+volatile int D_mix;
+volatile int D_mid;
+volatile int D_max;
+volatile int Front_Distance;
+volatile int Left_Distance;
+volatile int Right_Distance;
+volatile int Right_IR_Value;
+volatile int Left_IR_Value;
+
+float checkdistance() {
+  digitalWrite(Trig_Pin, LOW);
+  delayMicroseconds(2);
+  digitalWrite(Trig_Pin, HIGH);
+  delayMicroseconds(10);
+  digitalWrite(Trig_Pin, LOW);
+  float distance = pulseIn(Echo_Pin, HIGH) / 58.00;
+  delay(10);
+  return distance;
+}
+
+void Detect_Left_and_Right__distance() {
+  myservo.write(180);
+  delay(400);
+  Left_Distance = checkdistance();
+  delay(600);
+  Serial.print("Left_Distance:");
+  Serial.println(Left_Distance);
+  myservo.write(0);
+  delay(400);
+  Right_Distance = checkdistance();
+  delay(600);
+  Serial.print("Right_Distance:");
+  Serial.println(Right_Distance);
+  myservo.write(90);
+}
+
+void Ultrasonic_obstacle_avoidance()
+{
+  Front_Distance=checkdistance(); //obtain the value detected by ultrasonic sensor 
+  if((Front_Distance < 20)&&(Front_Distance > 0)) {
+      stopp();//stop
+      delay(100);
+      myservo.write(180);
+      delay(500);
+      Left_Distance=checkdistance();//measure the distance
+      delay(100);
+      myservo.write(0);
+      delay(500);
+      Right_Distance=checkdistance();//measure the distance
+      delay(100);
+      if(Left_Distance > Right_Distance) {
+        rotate_left(150);//turn left
+        myservo.write(90);
+        delay(300); 
+      }
+      else {
+        rotate_right(150);// turn right
+        myservo.write(90);
+        delay(300); 
+      }
+  }
+  else {
+    go_forward(100);//go forward
+  }
+}
+
+
+
+
+
+
+void Obstacle_Avoidance_Main() 
+{
+  Ultrasonic_obstacle_avoidance();
+}
+
+
+
+void setup(){
+  myservo.attach(A2);
+  Serial.begin(9600);
+  D_mix = 10;
+  D_mid = 20;
+  D_max = 100;
+  Front_Distance = 0;
+  Left_Distance = 0;
+  Right_Distance = 0;
+  myservo.write(90);
+  pinMode(Echo_Pin, INPUT);      
+  pinMode(Trig_Pin, OUTPUT);    
+  pinMode(pinLB,OUTPUT); // /pin 2
+  pinMode(pinLF,OUTPUT); // pin 4
+  pinMode(pinRB,OUTPUT); // pin 7
+  pinMode(pinRF,OUTPUT);  // pin 8
+  pinMode(Lpwm_pin,OUTPUT);  // pin 5 (PWM) 
+  pinMode(Rpwm_pin,OUTPUT);  // pin 6(PWM)   
+}
+
+void loop(){
+  Obstacle_Avoidance_Main();
+
+}
+
+
+
+void go_forward(unsigned char speed_val)    // speed_val：0~255
+    {digitalWrite(pinRB,HIGH); 
+     digitalWrite(pinRF,LOW);
+     digitalWrite(pinLB,HIGH);
+     digitalWrite(pinLF,LOW);
+     analogWrite(Lpwm_pin,speed_val+5);
+     analogWrite(Rpwm_pin,speed_val+8);
+     
+      
+    }
+
+void go_backward(unsigned char speed_val)    // speed_val：0~255
+    {
+     digitalWrite(pinRB,LOW);  
+     digitalWrite(pinRF,HIGH);
+     digitalWrite(pinLB,LOW);  
+     digitalWrite(pinLF,HIGH);
+     analogWrite(Lpwm_pin,speed_val);
+     analogWrite(Rpwm_pin,speed_val);
+    }
+    
+void rotate_left(unsigned char speed_val)        // speed_val：0~255
+    {digitalWrite(pinRB,HIGH);
+     digitalWrite(pinRF,LOW );  
+     digitalWrite(pinLB,LOW); 
+     digitalWrite(pinLF,HIGH);
+     analogWrite(Lpwm_pin,speed_val);
+     analogWrite(Rpwm_pin,speed_val);
+      
+     
+    }
+void rotate_right(unsigned char speed_val)    // speed_val：0~255
+    {
+      digitalWrite(pinRB,LOW);  
+     digitalWrite(pinRF,HIGH);
+     digitalWrite(pinLB,HIGH);
+     digitalWrite(pinLF,LOW);  
+     analogWrite(Lpwm_pin,speed_val);
+     analogWrite(Rpwm_pin,speed_val);
+     
+    }    
+void stopp()        //stop
+    {
+     digitalWrite(pinRB,HIGH);
+     digitalWrite(pinRF,HIGH);
+     digitalWrite(pinLB,HIGH);
+     digitalWrite(pinLF,HIGH);
+    }

zalohy/viky/nas_nnelepsi_ramen_program_frfr/nas_nnelepsi_ramen_program_frfr.ino

@@ -0,0 +1,179 @@
+#include <Servo.h> // add the servo libraries
+Servo myservo1; // create servo object to control a servo
+Servo myservo2;
+Servo myservo3;
+Servo myservo4;
+int pos1=90, pos2=90, pos3=90, pos4=90; // define the variable of 4 servo angle,and assign the initial value (that is the boot posture
+//angle value)
+const int right_X = A2; // define the right X pin to A2
+const int right_Y = A5; // define the right Y pin to A5
+const int right_key = 7; // define the right key pin to 7（that is the value of Z）
+const int left_X = A3; // define the left X pin to A3
+const int left_Y = A4; // define the left X pin to A4
+const int left_key = 8; //define the left key pin to 8（that is the value of Z）
+int x1,yyy,z1; // define the variable, used to save the joystick value it read.
+int x2,y2,z2;
+
+void setup()
+{
+// boot posture
+myservo1.write(pos1);
+delay(1000);
+myservo2.write(pos2);
+myservo3.write(pos3);
+myservo4.write(pos4);
+delay(1500);
+pinMode(right_key, INPUT); // set the right/left key to INPUT
+pinMode(left_key, INPUT);
+Serial.begin(9600); // set the baud rate to 9600
+}
+void loop()
+{
+myservo1.attach(3); // set the control pin of servo 1 to D3  dizuo-servo1-3
+myservo2.attach(5); // set the control pin of servo 2 to D5  arm-servo2-5
+myservo3.attach(6); //set the control pin of servo 3 to D6   lower arm-servo-6
+myservo4.attach(9); // set the control pin of servo 4 to D9  claw-servo-9
+x2 = analogRead(right_X); //read the right X value
+y2 = analogRead(right_Y); // read the right Y value
+z2 = digitalRead(right_key); //// read the right Z value
+x1 = analogRead(left_X); //read the left X value
+yyy = analogRead(left_Y); //read the left Y value
+z1 = digitalRead(left_key); // read the left Z value
+//delay(5); // lower the speed overall
+
+// claw
+claw();
+
+// rotate
+turn();
+
+// upper arm
+upper_arm();
+
+//lower arm
+lower_arm();
+}
+
+
+
+//***************************************************
+//claw
+void claw()
+{
+//claw
+if(x1<50) // if push the left joystick to the right
+{
+pos4=pos4+3; 
+myservo4.write(pos4); //servo 4 operates the motion, the claw gradually opens. 
+delay(5);
+
+if(pos4>120) //limit the largest angle when open the claw 
+{
+pos4=120;
+}
+}
+
+if(x1>1000) ////if push the right joystick to the left 
+{
+pos4=pos4-3; 
+myservo4.write(pos4); // servo 4 operates the action, claw is gradually closed.
+delay(5);
+if(pos4<45) // 
+{
+pos4=45; //limit the largest angle when close the claw
+}
+
+}
+}
+
+
+
+//******************************************************/
+// turn
+void turn()
+{
+if(x2<50) //if push the right joystick to the let 
+{
+pos1=pos1+3; 
+myservo1.write(pos1); // arm turns left
+delay(5);
+if(pos1>180) //limit the angle when turn right 
+{
+pos1=180;
+}
+
+}
+
+if(x2>1000) // if push the right joystick to the right
+{
+pos1=pos1-3; 
+myservo1.write(pos1); //servo 1 operates the motion, the arm turns right. 
+delay(5);
+if(pos1<1) // limit the angle when turn left
+{
+pos1=1;
+}
+}
+}
+
+
+
+
+//**********************************************************/
+// lower arm
+void lower_arm()
+{
+if(y2>1000) // if push the right joystick downward
+{
+pos2=pos2-2;
+myservo2.write(pos2); // lower arm will draw back
+delay(5);
+if(pos2<25) // limit the retracted angle
+{
+pos2=25;
+}
+}
+
+if(y2<50) // if push the right joystick upward
+{
+pos2=pos2+2;
+myservo2.write(pos2); // lower arm will stretch out
+delay(5);
+if(pos2>180) // limit the stretched angle
+{
+pos2=180;
+}
+}
+}
+
+
+
+
+
+//*************************************************************/
+
+//upper arm
+void upper_arm()
+{
+if(yyy<50) // if push the left joystick downward
+{
+pos3=pos3-2;
+myservo3.write(pos3); // upper arm will go down
+delay(5);
+if(pos3<1) //  limit the angle when go down 
+{
+pos3=1;
+}
+}
+if(yyy>1000) // if push the left joystick upward
+{
+pos3=pos3+2;
+myservo3.write(pos3); // the upper arm will lift
+delay(5);
+
+if(pos3>135) //limit the lifting angle 
+{
+pos3=135;
+}
+}
+}

zalohy/viky/sketch_semafor123/sketch_semafor123.ino

@@ -0,0 +1,30 @@
+int pinG = 13;
+int pinY = 12;
+int pinR = 11;
+
+int pinB = 2;
+
+int hodnota = HIGH;
+const OFF = HIGH;
+const ON = LOW;
+
+void setup() {
+ pinMode (pinG, OUTPUT);
+ pinMode (pinY, OUTPUT);
+ pinMode (pinR, OUTPUT);
+
+ pinMode (pinB, INPUT);
+
+ Serial.begin(9600);
+
+}
+
+void loop(){
+hodnota = digitalRead(pinB);
+Serial.println(hodnota);
+ if (hodnota == ON){
+  digitalWrite(pinG, HIGH);
+  delay(500);
+ }
+
+}