Bài 13: PIC Điều khiển StepMotor

Tài liệu

Bài 13: PIC Điều khiển StepMotor

Yêu cầu: Điều khiển step motor chạy đúng góc

Linh kiện sử dụng

PIC 16f887
driver A4988
Step motor size 42 1.8 Step

Bản vẽ mạch

Có thể sử dụng nguồn 5V từ arduino

Lắp thêm tụ 47uF trước nguồn 24V để lọc nhiễu, tăng độ chính xác cho step motor

Bạn có thể chạy Step Motor ở chế độ vi bước để tăng Moment cho Motor cũng như chạy mượt hơn nhưng motor sẽ khá nóng nên cần tản nhiệt cho motor

Bảng cài chế độ vi bước

MS1	MS2	MS3	RESOLUTION
LOW	LOW	LOW	1
HIGH	LOW	LOW	1/2
LOW	HIGH	LOW	1/4
HIGH	HIGH	LOW	1/8
HIGH	HIGH	HIGH	1/16

Chương trình điều khiển

#define STEP PIN_D0
#define DIR PIN_D1
float AngleStep = 1.8; //goc cua motor di duoc sau 1 buoc
float MutiStep = 1; // che do vi buoc
float Number = 0; // nhap so vong
int PPR = 0; // xung tren vong
int NumberStep = 0; //so luong xung
void stepmotor() // Chuong trình con cho step motor
{
PPR = 360.0/(AngleStep*MutiStep); //tinh so xung trên 1 vòng
NumberStep = PPR*Number; // tinh so xung de chay "Number" vong
for(int x = 0; x < NumberStep; x++)
{
output_high(STEP);
delay_ms(100); // ch?
output_low(STEP);
delay_ms(100); // ch?
}
}
void main()
{
set_tris_d(0xff);