วันพุธที่ 8 กุมภาพันธ์ พ.ศ. 2560

โปรเจค หุ่นยนต์ฮิวแมนนอยด์ Arduino 8 DOF

โปรเจค หุ่นยนต์ฮิวแมนนอยด์ Arduino 8 DOF

8 DOF Biped Robotic Educational Robot Humanoid Robot Servo Bracket



Humanoid Robot หรือ หุ่นยนต์ฮิวแมนนอยด์ คือ หุ่นยนต์เคลื่อนไหวคล้ายมนุษย์นั้นเอง โดยโครงสร้างของหุ่นยนต์จะถูกออกแบบมาจากร่างกายของมนุษย์ ซึ่งโดยทั่วไป จะมีส่วนประกอบของหัว ลำตัว 2 แขน 2 ขา และอื่นๆ ซึ่งหุ่นยนต์ฮิวแมนนอยด์บางตัวอาจจะมีใบหน้า ที่ประกอบไปด้วยตา และปากอีกด้วย เพื่อให้การออกแบบดูคล้ายมนุษย์มากขึ้น

เราจะเรียกข้อต่อจุดหมุนว่าเป็นองศาอิสระ (Degrees Of Freedom: DOF) หมายถึงมันสามารถที่จะเคลื่อนไหวได้อย่างอิสระภายใต้ระยะจุดหมุนที่หมุนได้ ถ้าเปรียบเทียบกับแขนมนุษย์ที่สามารถยกแขนให้เคลื่อนที่จากตำแหน่งไปสู่ ตำแหน่งหนึ่ง ซึ่งในโปรเจคนี้ เราจะใช้จุดหมุน 8 DOF  ด้วยกัน สำหรับการเคลื่อนไหว 2 ขา ของหุ่นยนต์ จากเอวลงไป เพื่อศึกษาจุดหมุน 8 DOF ของหุ่นยนต์
โปรเจค หุ่นยนต์ฮิวแมนนอยด์ 8 DOF อุปกรณ์ที่ต้องใช้ก็คือ

     1. Large U Bracket  จำนวน 1 ชิ้น
     2. Servo Bracket จำนวน 8 ชิ้น
     3. Long U Bracket จำนวน  2 ชิ้น
     
     4. Short U Bracket จำนวน  4 ชิ้น
      
     5. Big Feet จำนวน 2 ชิ้น
     6. Disc 25T Metal จำนวน 8 ชิ้น
     7. Metal Cup Bearing จำนวน 6 ชิ้น
 
     8. สกรูหัวกลม + น็อตตัวเมีย ขนาด 3 มม. ยาว 10 มม. จำนวน 72 ชิ้น
     9. Arduino UNO R3 - Made in italy จำนวน 1 ชิ้น
    10. Sensor Shield V5.0  จำนวน 1 ชิ้น
     
    13. รางถ่านแบบ 18650 ใส่ถ่าน 2 ก้อน

    14. แบตเตอรี่ลิเธียม 18650 จำนวน 2 ก้อน


เริ่มต้นโดย นำ Large U Brackets ซึ่งเปรียบเสมือน ลำตัวส่วนเอว ของหุ่นยนต์ ประกอบเข้ากับ Servo Bracket ซึ่งเปรียบเสมือน ต้นขาขวา ของหุ่นยนต์ โดย สกรูหัวกลม + น็อตตัวเมีย ขนาด 3 มม. ยาว 10 มม.


ประกอบ เซอร์โวมอเตอร์ MG996R เข้ากับ  Servo Bracket ตัวที่ 1

ประกอบ บอร์ด Sensor Shield V5.0 เข้ากับ บอร์ด Arduino UNO R3

รายละเอียดเพิ่มเติม  : https://robotsiam.blogspot.com/2016/09/arduino-sensor-shield-v50.html



เราจะเซตค่าองศาของ เซอร์โวมอเตอร์ ก่อนที่จะประกอบขั้นตอนต่อไปทุกๆตัว  ซึ่งการตั้งองศา ขึ้นอยู่กับความเหมาะสมของหุ่นยนต์  การออกแบบ และ การเขียนโปรแกรมคอมพิวเตอร์ควบคุมซึ่งต้อง สัมพันธ์กัน

ซึ่งในที่นี้ องศาที่่เราจะตั้ง เป็น 90 องศา  ขั้นตอนคือ ต่อสาย เซอร์โวมอเตอร์ MG996R เข้ากับ บอร์ด Sensor Shield V5.0 สายสีส้มเข้าที่ ขา 5 สายสีแดง เข้าที่ ขา V และ สายสีน้ำตาล เข้าที่ ขา G


เปิดโปรแกรม Arduino (IDE) และ Upload โค้ดนี้ ไปยัง บอร์ด Arduino UNO R3


#include <Servo.h>

Servo myservo;  //ประกาศตัวแปร myservo เรียกใช้งานคำสั่งจาก Library

void setup()

{

  myservo.attach(5); //ให้ Digital Pin 5 เป็นขาของ Servo


  myservo.write(90);  //หมุน 90 องศา
  delay(1000);
  myservo.write(45); //หมุน 45 องศา
  delay(1000);
  myservo.write(90);  //หมุน 90 องศา
  delay(1000);
  myservo.write(135); //หมุน 135 องศา
  delay(1000);
  myservo.write(90);  //หมุน 90 องศา
  delay(1000);

}

void loop()
{

  myservo.write(90);  //หมุน 90 องศา
  delay(1000);

}

เมื่อได้องศาที่ต้องการแล้ว จึงประกอบ Disc Metal เข้ากับ เซอร์โวมอเตอร์ MG996R ตัวที่ 1 และนำสกรูสีดำ ที่มาพร้อม ถุงอุปกรณ์เสริม MG996R เข้าที่แกนกลาง



และ นำสกรู จำนวน 4 ตัว ที่มาพร้อมกับ Disc Metal



ยึด  Servo Bracket ตัวที่ 2 เข้ากับ Disc Metal ของ  เซอร์โวมอเตอร์ ตัวที่ 1




นำ Metal Cup ยึด Long U Bracket เข้า กับ Servo Bracket ตัวที่ 2 (ซึ่งจะเป็นข้อต่อจุดหมุน)

ประกอบ เซอร์โวมอเตอร์ MG996R ตัวที่ 2 และ Disc Metal ยึดเข้ากับ Long U Bracket

และเมื่อทดสอบการทำงาน เซอร์โวมอเตอร์ MG996R  กับ บอร์ด Sensor Shield V5.0 สายสีส้มเข้าที่ ขา 5 สายสีแดง เข้าที่ ขา V และ สายสีน้ำตาล เข้าที่ ขา G จะเห็นความเคลื่อนไหว และ กลับมาอยู่ตำแหน่งเดิม คือ 90 องศา


ยึด Servo Bracket ตัวที่ 3 เข้ากับ Long U Bracket



นำ Metal Cup ยึด Short U Bracket ตัวที่ 1 เข้า กับ Servo Bracket ตัวที่ 3



ประกอบ เซอร์โวมอเตอร์ MG996R ตัวที่ 3 และ Disc Metal ยึดเข้ากับ Short U Bracket ตัวที่ 1



ยึด Short U Bracket ตัวที่ 2 เข้ากับ Short U Bracket ตัวที่ 1


ประกอบเท้าของหุ่นยนต์

ยึด Servo Bracket ตัวที่ 4 เข้ากับ Big Feet





นำ Metal Cup ยึด เท้าของหุ่นยนต์ที่ประกอบแล้ว (Servo Bracket ตัวที่ 4) เข้ากับ Short U Bracket ตัวที่ 2 (ด้านล่าง)

ประกอบ เซอร์โวมอเตอร์ MG996R ตัวที่ 4 และ Disc Metal ยึดเข้ากับ Short U Bracket ตัวที่ 2 และ เมื่อยกตั้งขึ้นจะได้ดังรูปด้านล่าง

ประกอบขาด้านซ้ายของหุ่นยนต์ ขั้นตอนคล้ายกับการประกอบขาด้านขวา เพียงแต่ทิศทางของ เซอร์โวมอเตอร์ MG996R จะกลับด้านกัน


เมื่อประกอบสำเร็จ ยืนขึ้น จะได้ หุ่นยนต์ฮิวแมนนอยด์ 8 DOF ตามรูปด้านล่าง


ตัด แผ่นอะคริลิค ขนาด 9  x 11 เซ็นติเมตร จำนวน 2 แผ่น

ด้านหน้ายึด บอร์ด Sensor Shield V5.0 ทีประกอบกับ บอร์ด Arduino UNO R3

ด้านหลัง ยึด รางถ่านแบบ 18650 (2 ก้อน) นำสายสีแดง ขั้วบวก ของรางถ่าน ต่อเข้ากับ VCC และ สายสีดำ ขั้วลบ ต่อเข้ากับ GND ของ บอร์ด Sensor Shield V5.0
ต่อสาย เซอร์โวมอเตอร์ MG996R ทั้ง 8 ตัวเข้ากับ บอร์ด Sensor Shield V5.0 (G,V,S) ตั้งแต่ ขา 2 ถึง ขา 9 โดยตรวจสอบตำแหน่งการต่อให้ถูกต้อง
  //Servo input pins
  rightAnkle.attach(2); // เท้าขวา
  rightKnee.attach(3);  // เข่าขวา
  rightThigh.attach(4); // ต้นขาขวา
  rightHip.attach(5);  // สะโพกขวา
  leftAnkle.attach(6);  // เท้าซ้าย
  leftKnee.attach(7); // เข่าซ้าย
  leftThigh.attach(8);  // ต้นขาซ้าย
  leftHip.attach(9);  // สะโพกซ้าย


เปิดโปรแกรม Arduino (IDE) และ Upload โค้ดนี้ ไปยัง บอร์ด Arduino UNO R3

เพื่อทดสอบการยืนของหุ่นยนต์

#include <Servo.h>

//Creating Servo Objects
Servo rightAnkle; // เท้าขวา
Servo leftAnkle;  // เท้าซ้าย
Servo rightKnee; // เข่าขวา
Servo leftKnee;   // เข่าซ้าย
Servo rightThigh; // ต้นขาขวา
Servo leftThigh;  // ต้นขาซ้าย
Servo rightHip;  // สะโพกขวา
Servo leftHip;  // สะโพกซ้าย


void setup()
{
  //Servo input pins
  rightAnkle.attach(2); // เท้าขวา
  rightKnee.attach(3);  // เข่าขวา
  rightThigh.attach(4); // ต้นขาขวา
  rightHip.attach(5);  // สะโพกขวา
  leftAnkle.attach(6);  // เท้าซ้าย
  leftKnee.attach(7); // เข่าซ้าย
  leftThigh.attach(8);  // ต้นขาซ้าย
  leftHip.attach(9);  // สะโพกซ้าย

  delay(2000);
  stand();


}

void loop()
{}

int rightAnkPos = 90;
int rightKneePos = 90;
int rightThighPos = 90;
int rightHipPos = 90;
int leftAnkPos = 90;
int leftKneePos = 90;
int leftThighPos = 90;
int leftHipPos = 90;


//ปรับค่าตามความเหมาะสม//

void stand ()
{

  rightAnkle.write(100); // เท้าขวา
  int rightAnkPos = 100;
  rightKnee.write(90);   // เข่าขวา
  int rightKneePos = 90;
  rightThigh.write(100);  // ต้นขาขวา
  int rightThighPos = 100;
  rightHip.write(90);   // สะโพกขวา
  int rightHipPos = 90;
  leftAnkle.write(90);  // เท้าซ้าย
  int leftAnkPos = 90;
  leftKnee.write(90);  // เข่าซ้าย
  int leftKneePos = 90;
  leftThigh.write(80);  // ต้นขาซ้าย
  int leftThighPos = 80;
  leftHip.write(92);  // สะโพกซ้าย
  int leftHipPos = 92;


}

เมื่อหุ่นยนต์ยืนแล้ว ตรวจการยืนของห่นยนต์ว่าเหมาะสมหรือไม่  ถ้าไม่แก้ไขค่าองศา ของเซอร์โวมอเตอร์ MG996R ที่ void stand () 

แล้ว Upload ใหม่ (ทดสอบจนกว่าจะสมบูรณ์)


แก้ไข void stand ()  ของโค้ดนี้ตามที่ได้ค่าจากโคดด้านบน แล้วจึง Upload โค้ดนี้ ไปยัง บอร์ด Arduino UNO R3

#include <Servo.h>

int delayVal = 40;

//Creating Servo Objects
Servo rightAnkle; // เท้าขวา
Servo leftAnkle;  // เท้าซ้าย
Servo rightKnee; // เข่าขวา
Servo leftKnee;   // เข่าซ้าย
Servo rightThigh; // ต้นขาขวา
Servo leftThigh;  // ต้นขาซ้าย
Servo rightHip;  // สะโพกขวา
Servo leftHip;  // สะโพกซ้าย


void setup() {
  //Servo input pins
  rightAnkle.attach(2); // เท้าขวา
  rightKnee.attach(3);  // เข่าขวา
  rightThigh.attach(4); // ต้นขาขวา
  rightHip.attach(5);  // สะโพกขวา
  leftAnkle.attach(6);  // เท้าซ้าย
  leftKnee.attach(7); // เข่าซ้าย
  leftThigh.attach(8);  // ต้นขาซ้าย
  leftHip.attach(9);  // สะโพกซ้าย


  delay(1000);
  stand();
  

}
void loop()
{

stand();
turnLeft();

}


int rightAnkPos = 90;
int rightKneePos = 90;
int rightThighPos = 90;
int rightHipPos = 90;
int leftAnkPos = 90;
int leftKneePos = 90;
int leftThighPos = 90;
int leftHipPos = 90;



//ปรับค่าตามความเหมาะสม//

void stand ()
{

  rightAnkle.write(100); // เท้าขวา
  int rightAnkPos = 100;
  rightKnee.write(90);   // เข่าขวา
  int rightKneePos = 90;
  rightThigh.write(100);  // ต้นขาขวา
  int rightThighPos = 100;
  rightHip.write(90);   // สะโพกขวา
  int rightHipPos = 90;
  leftAnkle.write(90);  // เท้าซ้าย
  int leftAnkPos = 90;
  leftKnee.write(90);  // เข่าซ้าย
  int leftKneePos = 90;
  leftThigh.write(80);  // ต้นขาซ้าย
  int leftThighPos = 80;
  leftHip.write(92);  // สะโพกซ้าย
  int leftHipPos = 92;


}


///////////////LEFT/////////////////////////////////////////


void turnLeft()
{

  for (int i = 0; i < 5; i += 1)
  {
    leftThighPos -= 2;
    leftKneePos += 2;
    leftThigh.write( leftThighPos);
    leftKnee.write(leftKneePos );
    delay(60);
  }

  //Left and Right Ankle Bend Left
  for (int i = 0; i < 5; i += 1)
  {
    leftAnkPos += 3;
    rightAnkPos += 3;
    leftAnkle.write(leftAnkPos);
    rightAnkle.write(rightAnkPos );

    delay(60);
  }

  delay(delayVal);

  //Left Hip Counter ClockWise,

  for (int i = 0; i < 5; i += 1)
  {
    leftHipPos -= 4;
    leftHip.write(leftHipPos);




    delay(60);
  }

  delay(delayVal);

  //Left and Right Ankle back to normal
  for (int i = 0; i < 5; i += 1)
  {
    leftAnkPos -= 3;
    rightAnkPos -= 3;
    leftAnkle.write(leftAnkPos);
    rightAnkle.write(rightAnkPos );

    delay(60);
  }



  //Left and Right Ankle Bend Right Left Hip Straighten
  for (int i = 0; i < 5; i += 1)
  {
    leftAnkPos -= 3;
    rightAnkPos -= 3;
    leftAnkle.write(leftAnkPos);
    rightAnkle.write(rightAnkPos );
    leftHipPos += 4;
    leftHip.write(leftHipPos);
    delay(60);
  }

  delay(delayVal);



  //Right Hip Counter Clockwise
  for (int i = 0; i < 5; i += 1)
  {

    rightHipPos -= 4;

    rightHip.write(rightHipPos);
    leftHipPos += 4;

    leftHip.write(leftHipPos);

    delay(60);
  }

  delay(delayVal);


  //Left and Right Ankle Normal
  for (int i = 0; i < 5; i += 1)
  {
    leftAnkPos += 3;
    rightAnkPos += 3;
    leftAnkle.write(leftAnkPos);
    rightAnkle.write(rightAnkPos );

    delay(60);
  }

  delay(delayVal);

  ///////SECOND TIME///////////////

  //Left and Right Ankle BEND LEFT
  for (int i = 0; i < 5; i += 1)
  {
    leftAnkPos += 3;
    rightAnkPos += 3;
    leftAnkle.write(leftAnkPos);
    rightAnkle.write(rightAnkPos );

    leftThighPos += 2;
    leftKneePos -= 2;
    leftThigh.write( leftThighPos);
    leftKnee.write(leftKneePos );
    delay(60);
  }

  delay(delayVal);



  //LEFT HIP CC
  for (int i = 0; i < 5; i += 1)
  {
    leftHipPos -= 4;
    leftHip.write(leftHipPos);

    rightHipPos += 4;

    rightHip.write(rightHipPos);

    delay(60);
  }

  delay(delayVal);




  //LEFT RIGHT ANKLE NORMAL
  for (int i = 0; i < 5; i += 1)
  {
    leftAnkPos -= 3;
    rightAnkPos -= 3;
    leftAnkle.write(leftAnkPos);
    rightAnkle.write(rightAnkPos );

    delay(60);
  }



  //Left and Right Ankle Bend Right
  for (int i = 0; i < 5; i += 1)
  {
    leftAnkPos -= 3;
    rightAnkPos -= 3;
    leftAnkle.write(leftAnkPos);
    rightAnkle.write(rightAnkPos );



    delay(60);
  }

  delay(delayVal);


  //Right Hip Counter Clockwise
  for (int i = 0; i < 5; i += 1)
  {

    rightHipPos -= 5;

    rightHip.write(rightHipPos);

    leftHipPos += 2;
    leftHip.write(leftHipPos);

    delay(60);
  }


  //LEFT RIGHT ANKLE NORMAL
  for (int i = 0; i < 5; i += 1)
  {
    leftAnkPos += 3;
    rightAnkPos += 3;
    leftAnkle.write(leftAnkPos);
    rightAnkle.write(rightAnkPos );

    delay(60);
  }

  //LEFT RIGHT ANKLE BEND LEFT
  for (int i = 0; i < 5; i += 1)
  {
    leftAnkPos += 3;
    rightAnkPos += 3;
    leftAnkle.write(leftAnkPos);
    rightAnkle.write(rightAnkPos );
    rightHipPos += 5;
    rightHip.write(rightHipPos);
    leftHipPos -= 2;
    leftHip.write(leftHipPos);

    delay(60);
  }


  //LEFT RIGHT ANKLE STRAIGHT
  for (int i = 0; i < 5; i += 1)
  {
    leftAnkPos -= 3;
    rightAnkPos -= 3;
    leftAnkle.write(leftAnkPos);
    rightAnkle.write(rightAnkPos );

    delay(60);
  }
}
เขียนโดย ที่ ไม่มีความคิดเห็น:

PIR เซนเซอร์ตรวจจับความเคลื่อนไหว Motion Sensor Module

PIR เซนเซอร์ตรวจจับความเคลื่อนไหว Motion Sensor Module

         ตรวจจับความเคลื่อนไหวจากความร้อน เมื่อมีคนเดินผ่านก็จะจับค่าความร้อนที่เปลี่ยนแปลง แล้วส่งค่าสัญญาณมีไฟ ออกมา ในกรณีที่ไม่มีการเปลี่ยนแปลงส่งค่าไม่มีไฟ ออกมา เราสามารถนำค่านี้ไปสั่งควบคุม Arduino ได้ สามารถปรับเวลาหน่วงเวลาในการตรวจจับครั้งต่อไปได้ ปรับระยะทางการตรวจจับได้ 3-7 เมตร มีช่องให้ต่อ LDR เพิ่ม เพื่อให้ทำงานตรวจจับแค่ตอนกลางคืน
รายละเอียด PIR เซนเซอร์ตรวจจับความเคลื่อนไหว Motion Sensor Module
  • Dimension: 3.2cm x 2.4cm x 1.8cm (approx)
  • Infrared sensor with control circuit board
  • The sensitivity and holding time can be adjusted
  • Working Voltage Range: DC 3V- 5V
  • Current drain:<60uA
  • Voltage Output: High/Low level signal:3.3V TTL output
  • Detection distance: 3--7M(can be adjusted)
  • Detection range: <140°
  • Delay time: 5-200S(can be adjusted, default 5s +-3%)
  • Blockade time: 2.5 S (default)
  • Trigger: L: Non-repeatable trigger  H: Repeat Trigger (default)
  • Work temperature:-20-+80°C
  • Trigger Method: L unrepeatable trigger / H repeatable trigger
ตัวอย่างโคด Code Arduino PIR Motion Sensor Module


int ledPin= 13;
int inputPin= 3;

void setup(){
  pinMode(ledPin, OUTPUT);
  pinMode(inputPin, INPUT);
}

void loop(){
  int value= digitalRead(inputPin);

  if (value == HIGH)
  {
    digitalWrite(ledPin, HIGH);
    delay(1000) ;
  }

  else
  {
    digitalWrite(ledPin, LOW);
  }
}
เขียนโดย ที่ ไม่มีความคิดเห็น:

Fingerprint Senser โมดูลสแกนลายนิ้วมือ สำหรับ Arduino

Fingerprint Senser โมดูลสแกนลายนิ้วมือ สำหรับ Arduino



การต่อสายกับบอร์ด Arduino Uno

  • VCC : สีแดง - 5V
  • GND : สีดำ - GND
  • RX : สีขาว - 3
  • TX : สีเขียว - 2

โคดตัวอย่างการใช้งาน Arduino Fingerprint Scanner Code แบบเข้าใจง่าย
2. เพิ่มลายนิ้วมือลงในโมดูล โดย อัพโหลด Arduino Fingerprint Scanner Code จากไฟล์ตัวอย่าง enroll.ino จากโฟลเดอร์ Fingerprint\examples\enroll
พิมพ์เลข ID ที่ต้องการบันทึก เช่น
  • พิมพ์เลข 2 เพื่อบันทึกลายนิ้วมือ ID 2 แล้วกดปุ่ม Send
  • เอามือออก และประทับลายนิ้วมืออีกครั้ง 
  • โปรแกรมบันทึกเรียบร้อยได้เป็น ID #2 ที่ตรงกับลายนิ้วมือที่สแกน
3. การสแกนอ่านลายนิ้วมือว่าเป็นของใคร ทำได้โดย อัพโหลด Arduino Fingerprint Scanner Code ไฟล์ตัวอย่าง fingerprint.ino จากโฟลเดอร์ Fingerprint\examples\fingerprint
  • เมื่อรันโปรแกรมและวางนิ้วมือที่สแกน ก็จะพบข้อมูลว่าตรงกับเลข ID อะไร
  • ถ้าไม่ตรงก็จะไม่พบหมายเลข ID

ข้อมูล Fingerprint Senser โมดูลสแกนลายนิ้วมือ

  • Supply voltage: 3.6 - 6.0VDC
  • Operating current: 120mA max
  • Peak current: 150mA max
  • Fingerprint imaging time: 
  • Window area: 14mm x 18mm
  • Signature file: 256 bytes
  • Template file: 512 bytes
  • Storage capacity: 162 templates
  • Safety ratings (1-5 low to high safety)
  • False Acceptance Rate: <0.001% (Security level 3)
  • False Reject Rate: <1.0% (Security level 3)
  • Interface: TTL Serial
  • Baud rate: 9600, 19200, 28800, 38400, 57600 (default is 57600)
  • Working temperature rating: -20C to +50C
  • Working humidy: 40%-85% RH
  • Full Dimensions: 56 x 20 x 21.5mm
  • Exposed Dimensions (when placed in box): 21mm x 21mm x 21mm triangular
  • Weight: 20 grams
ข้อมูลเพิ่มเติม Fingerprint Senser โมดูลสแกนลายนิ้วมือ

อ้างอิง

 https://www.arduinoall.com/product/1336/fingerprint-arduino-senser-โมดูล-สแกนลายนิ้วมือ-สำหรับ-arduino
เขียนโดย ที่ ไม่มีความคิดเห็น:
สมัครสมาชิก: บทความ (Atom)