DIY Auto Alcohol Gel

  2.ออกแบบวงจร เขียนโปรแกรม และ เทสๆ ในบอร์ดทดลอง



















   





   3. หาตำแหน่งติดตั้ง เซอร์โว เพื่อเป็นตัวกดหัวปั้ม โดยใช้สายเอ็น เป็นตัวดึง






























  4.ติดตั้งวงจร และ ตั้งระยะขึงเอ็น ผ่านหัวกด พร้อมทำล็อค ข้างขวดกันเลื่อน






































  5.ปรับจูนวงจร ให้กดเจลออกมาในปริมาณที่เหมาะสม ไม่มาก น้อยเกินไป











คลิบทดสอบใช้งาน
 

       

ซอสโค้ดโปรแกรม เครดิต eBikeThaikit.com

#define Range_In A1
#define Buzzer 12
#define Gel_VolIn A0
#define Servo_Out 2


#include <Servo.h> 
Servo myservo;      // สร้านออปเจ็กชื่อ myservo จากคลาส Servo เพื่อควบคุม servo micro

int Gel_Vol = 0;    // ขาอะนาล็อกใช้ต่อกับตัวต้านทานปรับค่าได้
int val;            // ใช้เก็บค่าที่อ่านได้จากตัวต้านทานปรับค่าได้
int AD = 0;
int i = 0;
int Buzzer_delay;
float Distance;


void setup()
{
  pinMode(Gel_VolIn,INPUT);
  pinMode(Range_In,INPUT);
  pinMode(Buzzer,OUTPUT);
  pinMode(Servo_Out,OUTPUT);
  myservo.attach(2);  // บอกว่าจะต่อ servo ที่ขา 2
 // Serial.begin(9600); // Pour a bowl of Serial
}
 
void loop()
{
      
      
      AD = 0;
      
      for (i=0;i<10;i++)
      {
        AD = AD + analogRead(Range_In);
        delay(5);
      } 
        Distance = AD/100;
        Serial.print("ระยะห่างมือ หรือ วัตถุ = ") & Serial.print(Distance) & Serial.println("Cm"); ;

      if (Distance < 15)
      {
         Buzzer_delay = map(Distance,15,10,5,50);
         digitalWrite(Buzzer,1);
         delay(Buzzer_delay);
         digitalWrite(Buzzer,0);
         delay(Buzzer_delay);    
      } 
        
      if (Distance < 10)
      {
        PushGel();
      }
      else
      {
        Serial.println("หัวกด ไม่ทำงาน ");
        val = 0;        
        myservo.write(val);
        Serial.print("Servo Value = ") & Serial.println(val) ;
        delay(100);
      }
        
}


void PushGel()

{
      Serial.println("หัวกดทำงาน ");
      digitalWrite(Buzzer,1);
      delay(100);
      digitalWrite(Buzzer,0); 
      Gel_Vol = analogRead(Gel_VolIn);
      val = map(Gel_Vol, 0,1023,0,180);     // แปลงช่วง 0-1023 ที่อ่านได้ ให้อยู่ในช่วง 0-180
      Serial.print("Servo Value = ") & Serial.println(val) ;
      myservo.write(val);                       // ส่งค่าไปควบคุม servo
      delay(1000);    // หน่วงเวลาให้ servo ได้ทำงาน
      myservo.write(0);
      delay(1000);    // หน่วงเวลาให้ servo ได้ทำงาน
      
      
} 

 

---