ตัวอย่างการควบคุม สเต็ปปิ้งมอเตอร์ขนาด 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
|
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 |
#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); } |