โค๊ดโปรแกรม หุ่นยนต์เดินตามเส้นแบบสาย พาน

1 ปีที่ผ่านมา
โดย เจ้าของร้าน

#include <Servo.h>
#include <AFMotor.h>
AF_DCMotor motor1(1);
AF_DCMotor motor2(2);
AF_DCMotor motor3(3);
AF_DCMotor motor4(4); 
Servo myservo;  
Servo myservo2;
const int analogInPin0 = A0; ///เซ็นเซอร์มือคีบ
const int analogInPin1 = A1; //เซ็นเซอร์แทรคเส้นต่อOUT1
const int analogInPin2 = A2; //เซ็นเซอร์แทรคเส้นต่อOUT2
const int analogInPin3 = A3; //เซ็นเซอร์แทรคเส้นต่อOUT3
const int analogInPin4 = A4; //เซ็นเซอร์แทรคเส้นต่อOUT4
const int analogInPin5 = A5; //เซ็นเซอร์แทรคเส้นต่อOUT5
int sensorValue0 = 0;
int sensorValue1 = 0;
int sensorValue2 = 0;
int sensorValue3 = 0;
int sensorValue4 = 0;
int sensorValue5 = 0;
int Step=0;///ขั้นตอนการทำงาน
int Speed=150;
int aa=30;
void setup() 
{
 myservo.attach(9);
  myservo2.attach(10);
  Serial.begin(9600);
}
void loop() 
{
 
  
sensorValue0 = analogRead(analogInPin0);
sensorValue1 = analogRead(analogInPin1);
sensorValue2 = analogRead(analogInPin2);
sensorValue3 = analogRead(analogInPin3);
sensorValue4 = analogRead(analogInPin4);
sensorValue5 = analogRead(analogInPin5);
if(sensorValue0<=200)
{
Step=1;
   Serial.print("s1 = ");
 Serial.print(sensorValue1);
  Serial.print("s2 = ");
 Serial.print(sensorValue2);
  Serial.print("s3 = ");
 Serial.print(sensorValue3);
  Serial.print("s4 = ");
 Serial.print(sensorValue4);
  Serial.print("s5 = ");
 Serial.print(sensorValue5);
 
 Serial.print("sensor = ");
 Serial.print(sensorValue0);
  Serial.print("step[");
 Serial.print(Step);
  Serial.println("]");  
delay(500);
}
else if(Step==1)
{
 LINE(); 
}
else
{
  STOP();
   Serial.print("s1 = ");
 Serial.print(sensorValue1);
  Serial.print("s2 = ");
 Serial.print(sensorValue2);
  Serial.print("s3 = ");
 Serial.print(sensorValue3);
  Serial.print("s4 = ");
 Serial.print(sensorValue4);
  Serial.print("s5 = ");
 Serial.print(sensorValue5);
 
 Serial.print("sensor = ");
 Serial.print(sensorValue0);
  Serial.print("step[");
 Serial.print(Step);
  Serial.println("]");  
}
}
void LINE()
{
 if(sensorValue1<500||sensorValue2<500)//ซ้าย
{
LEFT();
}
else if(sensorValue5<500||sensorValue4<500)//ขวา
{
RIGH(); 
}
 
else
{
GO();  
} 
}
void RIGH()
{
motor1.run(FORWARD);
motor1.setSpeed(Speed); 
motor2.run(BACKWARD);
motor2.setSpeed(Speed);  
delay(100);  
}
void LEFT()
{
motor1.run(BACKWARD);
motor1.setSpeed(Speed); 
motor2.run(FORWARD);
motor2.setSpeed(Speed); 
delay(100);  
}
void GO()
{
motor1.run(FORWARD);
motor1.setSpeed(Speed); 
motor2.run(FORWARD);
motor2.setSpeed(Speed);  
motor3.run(FORWARD);
motor3.setSpeed(Speed); 
motor4.run(FORWARD);
motor4.setSpeed(Speed);   
delay(100);  
}
void STOP()
{motor1.run(FORWARD);
motor1.setSpeed(0); 
motor2.run(FORWARD);
motor2.setSpeed(0);   
}




//////////////V2

#include <Servo.h>
#include <AFMotor.h>
AF_DCMotor motor1(1);
AF_DCMotor motor2(2);
AF_DCMotor motor3(3);
AF_DCMotor motor4(4); 
Servo myservo;  
Servo myservo2;
const int analogInPin0 = A0; ///เซ็นเซอร์มือคีบ
const int analogInPin1 = A1; //เซ็นเซอร์แทรคเส้นต่อOUT1
const int analogInPin2 = A2; //เซ็นเซอร์แทรคเส้นต่อOUT2
const int analogInPin3 = A3; //เซ็นเซอร์แทรคเส้นต่อOUT3
const int analogInPin4 = A4; //เซ็นเซอร์แทรคเส้นต่อOUT4
const int analogInPin5 = A5; //เซ็นเซอร์แทรคเส้นต่อOUT5
int sensorValue0 = 0;
int sensorValue1 = 0;
int sensorValue2 = 0;
int sensorValue3 = 0;
int sensorValue4 = 0;
int sensorValue5 = 0;
int Step=0;///ขั้นตอนการทำงาน
int Speed=150;
int aa=30;
void setup() 
{
 myservo.attach(9);
  myservo2.attach(10);
  Serial.begin(9600);
}
void loop() 
{
 
  
sensorValue0 = analogRead(analogInPin0);
sensorValue1 = analogRead(analogInPin1);
sensorValue2 = analogRead(analogInPin2);
sensorValue3 = analogRead(analogInPin3);
sensorValue4 = analogRead(analogInPin4);
if(sensorValue0<=200)
{
Step=1;
 
delay(500);
}
else if(Step==1)
{
 LINE(); 
}
else
{
  STOP();
  Serial.print("s1 = ");
 Serial.print(sensorValue1);
  Serial.print("s2 = ");
 Serial.print(sensorValue2);
  Serial.print("s3 = ");
 Serial.print(sensorValue3);
  Serial.print("s4 = ");
 Serial.print(sensorValue4);
//  Serial.print("s5 = ");
// Serial.print(sensorValue5);
 
 Serial.print("  BT=");
 Serial.print(sensorValue0);
  Serial.print("step[");
 Serial.print(Step);
  Serial.println("]");   
}
}
void LINE()
{
 if(sensorValue1<300||sensorValue2<300)//ซ้าย
{
LEFT();
}
else if(sensorValue3<300||sensorValue4<300)//ขวา
{
RIGH(); 
}
 
else
{
GO();  
} 
}
void RIGH()
{
motor1.run(FORWARD);
motor1.setSpeed(Speed); 
motor2.run(BACKWARD);
motor2.setSpeed(Speed);  
delay(100);  
}
void LEFT()
{
motor1.run(BACKWARD);
motor1.setSpeed(Speed); 
motor2.run(FORWARD);
motor2.setSpeed(Speed); 
delay(100);  
}
void GO()
{
motor1.run(FORWARD);
motor1.setSpeed(Speed); 
motor2.run(FORWARD);
motor2.setSpeed(Speed);  
motor3.run(FORWARD);
motor3.setSpeed(Speed); 
motor4.run(FORWARD);
motor4.setSpeed(Speed);   
delay(100);  
}
void STOP()
{motor1.run(FORWARD);
motor1.setSpeed(0); 
motor2.run(FORWARD);
motor2.setSpeed(0);   
}

CATEGORY

สินค้าทั้งหมด [220]
สินค้ามาใหม่ [5]
สินค้าแนะนำ [22]
หุ่นยนต์สำหรับงานศิลปหัตถกรรม สพฐ. [18]
ชุดหุ่นยนต์ ระดับประถม ม.ต้น ม.ปลาย อปท.2025 [4]
หุ่นยนต์เดินตามเส้น [0]
หุ่นยนต์ระดับพื้นฐาน สพฐ. [42]
หุ่นยนต์ระดับกลาง,ระดับสูง สพฐ. [14]
หุ่นยนต์แบบผสม สพฐ. [5]
ชุดฝึกหุ่นยนต์ สำหรับงานประดิษฐ์ เอกชน [18]
หุ่นยนต์อุตสาหกรรมขนาดใหญ่และโรงงาน [5]
ชุดหุ่นยนต์coding ระดับอนุบาล และ ประถม [0]
ชุดเรียนรู้ออนไลน์แขนกลสมองกลฝังตัว [10]
ชุดเรียนรู้ออนไลน์หุ่นยนต์สมองกลฝังตัว2020 [8]
ชุดโครงงานและโปรเจคสิ่งประดิษฐ์ [8]
จองครอสอบรมหุ่นยนต์ [14]
ชุดเครื่องพิมพ์และเครื่องตัด CNC พร้อมสอนการใช้งาน [0]
หุ่นยนต์สำเร็จรูป ไม่ต้องเขียนโปรแกรม [1]
อะไหล่และชิ้นส่วนหุ่นยนต์ [2]
ชุดวีดิโอและโปรแกรมเแผ่นซีดีคู่มือสอน [7]
หุ่นยนต์ส่งของอัตโนมัติ แบบต่างๆ [5]
อะไหล่หุ่นยนต์รุ่น ดั้งเดิม [41]
หุ่นยนต์สำหรับการเกษตร-และคุมไร้สาย [6]
บอร์ด ควบคุมหุ่นยนต์ [9]
หุ่นยนต์บังคับสาย ระดับประถม [0]
หุ่นยนต์เดินตามเส้น ระดับม.ต้น [2]
หุ่นยนต์ ซูโม่ บังคับไร้สาย [1]
ชุดอบรมหุ่นยนต์ อุดมศึกษา 2025 [0]

MEMBER

ตะกร้า
( 0 )
▲
▼
รายการสั่งซื้อของฉัน
เข้าสู่ระบบด้วย
เข้าสู่ระบบ
สมัครสมาชิก

ยังไม่มีบัญชีเทพ สร้างบัญชีใหม่ ไม่มีค่าใช้จ่าย
สมัครสมาชิก (ฟรี)
รายการสั่งซื้อของฉัน
ข้อมูลร้านค้านี้
ร้านรับอบรมหุ่นยนต์ รับบสร้างหุ่นยนต์ รับสอนหุ่นยนต์ รับอบรมกิจกรรมหุ่นยนต์ รับบสร้างหุ่นยนต์ รับสร้างปัญญาประดิษฐ์ สมาร์ชโรโบติกส์
รับอบรมหุ่นยนต์ รับบสร้างหุ่นยนต์ รับสอนหุ่นยนต์ รับอบรมกิจกรรมหุ่นยนต์ รับบสร้างหุ่นยนต์ รับสร้างปัญญาประดิษฐ์ สมาร์ชโรโบติกส์
รับอบรมหุ่นยนต์ รับบสร้างหุ่นยนต์ รับสอนหุ่นยนต์ รับอบรมกิจกรรมหุ่นยนต์ รับบสร้างหุ่นยนต์ รับสร้างปัญญาประดิษฐ์ จำหน่ายชุดฝึกเพื่อการศึกษา รับสอน เขียนโปรแกรมควบคุมบอร์ด arduino ด้วยภาษา C รับสอน เขียนโปรแกรมควบคุมบอร์ด Micro Bit ด้วยบล็อกคำสั่ง รับสอน สร้างแอพพลิเคชั่นด้วย MIT App inventor รับสอน การเขียน PLC ควบคุมระบบ automation ในงานอุตสาหกรรม
เบอร์โทร : 0847999639
อีเมล : woottermfun1@gmail.com
ส่งข้อความติดต่อร้าน
เกี่ยวกับร้านค้านี้
ค้นหาสินค้าในร้านนี้
หรือค้นหาอย่างละเอียด
ค้นหาสินค้า
สินค้าที่ดูล่าสุด

{{pdata.name}}
ดูสินค้าทั้งหมดในร้าน
สินค้าที่ดูล่าสุด
บันทึกเป็นร้านโปรด
Join เป็นสมาชิกร้าน
แชร์หน้านี้
แชร์หน้านี้
↑
TOP เลื่อนขึ้นบนสุด
พูดคุย-สอบถาม