ตัวอย่างการสั่งงานด้วย Arduino Code
ตัวอย่างการสั่งงานด้วย Arduino Code สำหรับทดสอบการทำงานเบื้องต้น
Linear_Slide_LSSX05_TB6600
|
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 |
#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(10000.0); // ปรับความเร็ว stepper.setAcceleration(10000.0); // ปรับความเร่ง } void loop(){ stepper.runToNewPosition(0); delay(500); stepper.runToNewPosition(10000); // ระยะการเคลื่อนที่ไป delay(500); stepper.runToNewPosition(0); delay(500); stepper.runToNewPosition(-10000); // ระยะการเคลื่อนที่กลับ delay(500); } |
ตัวอย่างการสั่งงานด้วย Arduino Code แบบมี Home Limit Switch
|
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 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 |
#include <AccelStepper.h> // The X Stepper pins #define STEPPER1_DIR_PIN 3 #define STEPPER1_STEP_PIN 2 AccelStepper stepper(AccelStepper::DRIVER, STEPPER1_STEP_PIN, STEPPER1_DIR_PIN); const int buttonPin = 7; //home switch int state = 0; int buttonState = 0; int MaxAcc = 6000; int MaxSpd = 4000; void setup() { Serial.begin(9600); pinMode(buttonPin, INPUT_PULLUP); stepper.setMaxSpeed(MaxSpd); // ทดลองปรับความเร็ว stepper.setAcceleration(MaxAcc); // ทดลองปรับความเร่ง } void loop() { //Serial.println(state); buttonState = digitalRead(buttonPin); if((buttonState == HIGH)&&(state == 0))// { stepper.setMaxSpeed(MaxSpd); // หมุนช้าเข้าหาสวิตช์ Home stepper.setAcceleration(MaxAcc); stepper.setSpeed(-500); stepper.runSpeed(); } else if ((buttonState == LOW) &&(state == 0)) { stepper.setMaxSpeed(MaxSpd); stepper.setAcceleration(MaxAcc); stepper.setCurrentPosition(0); state = 1; delay(1000); } if(state ==1 ) { stepper.runToNewPosition(12000); delay(1000); stepper.runToNewPosition(0); delay(1000); } } |
