Phần mềm được viết trên VB 6.0
Sử dụng thuật toán nội suy để tính toán chuyển động của các trục máy. Sau khi tính toán chuyển động của các trục xuất tín hiệu điều khiển các động cơ ra cổng song song. Làm cho bàn máy chuyển động theo yêu cầu của từng chuyển động.
+ Thuật toán nội suy đường tròn: Từ câu lệnh Gcode.
Điểm đầu.==> điểm cuối.
Biểu thức: d2 2
2 d
k X Y R
73
Với trường hợp cung tròn chạy ở góc phần tư thứ nhất.chạy theo chiều kim đồng hồ: Nếu Dk > 0 : điều này có nghĩa là (Xd,Yd) đang nằm phía ngoài cung tròn. Trong trường hợp này thì xuất xung cho trục Y chạy theo chiều âm.
Nếu Dk < 0: điều này có nghĩa là (Xd,Yd) đang nằm phía trong cung tròn. Trong trường hợp này thì xuất xung cho trục X chạy theo chiều dương.
Khi Dk = 0: Ta có thể xuất xung cho các trục chạy ở 1 trong 2 trường hợp trên. Mỗi lần xuất xung xong thì tọa độ mới của (Xd,Yd) là (Xd+1,Yd+1). Khi đó lại tính lại biểu thức Dk. và lặp lại như vậy.
Đến khi Xd+1,Yd+1 gần bằng Xf,Yf. thì kết thúc vòng lặp.
Hình 4.27 Lưu đồ thuật toán nội suy đường tròn
+ Thuật toán nội suy đường thẳng: Từ câu lệnh G-code.
Điểm đầu.==> điểm cuối.
Xét nếu X1>=X2⇒ xét Y1>=Y2.
Tính X = X2 - X1. Tính Y = Y2 - Y1
74
Nếu X=0. Thì chỉ xuất xung chạy trục Y. Nếu Y=0. Thì chỉ xuất xung chạy trục X. Nếu X khác 0, Y khác 0:
+) X =Y: Xuất xung ra 2 trục X, Y với tỉ lệ nhất định để cho trục X và trục Y chạy những đoạn bằng nhau.
+) X khác Y: Tính tỉ lệ X/Y nếu X>Y(hoặc Y/X nếu Y>X) . xuất xung cho các trục khác nhau rồi đưa đến tọa độ yêu cầu.
Hình 4.28 Lưu đồ thuật toán nội suy đường thẳng.