หมวดหมู่: Mechatronic

ตัวอย่างการควบคุม สเต็ปปิ้งมอเตอร์ขนาด 3 แอมป์ ด้วย Arduino + ไมโคร Step Driver TB6600 เบื้องต้น

Linear_Slide_LSSX05_TB6600 https://drive.google.com/drive/folders/1YALYYlV6PUrQz-IYNR843RhyF7twXqQ4?usp=sharing

สเต็ปปิ้งมอเตอร์ขนาด 3 แอมป์ ปรับตั้ง ดิฟต์สวิตช์ของไมโคร Step Driver TB6600 ดังนี้

• DIP Switch S1 S2 S3 ตั้งเป็น On Off On
• DIP Switch S4 S5 S6 ตั้งเป็น On Off On

#include <AccelStepper.h>
// The X Stepper pins
#define PUL_PIN 2  // PUL_PIN
#define DIR_PIN 3  // DIR_PIN

AccelStepper stepper(AccelStepper::DRIVER, PUL_PIN, DIR_PIN);
 
void setup()
{
    stepper.setMaxSpeed(3500.0);     // ปรับความเร็ว หน่วยเป็น พัลส์ต่อวินาที steps per second
    stepper.setAcceleration(5500.0); // ปรับความเร่ง หน่วยเป็น พัลส์ต่อวินาทีกำลังสอง steps per second per second
    stepper.setCurrentPosition(0);           //เซตค่าตำแหน่งเริ่มเท่ากับ 0 ก่อนเข้าลูป
}
void loop()
{    
    stepper.runToNewPosition(0); //เริ่มต้นที่ตำแหน่ง 0
    delay(500);
    stepper.runToNewPosition(1500); // ระยะการเคลื่อนที่ไปทางบวก ด้านขวา จำนวน พัลส์
    delay(500);
    
    stepper.runToNewPosition(0);
    delay(500);
    stepper.runToNewPosition(-1500); // ระยะการเคลื่อนที่กลับ ทางลบ ด้านซ้าย จำนวน พัลส์
    delay(500);
}