1、開啟控制器 GT_Open2、啟動伺服使能 GT_ClrSts3、軸規劃位置清零 GT_SetPrfPos4、軸運動模式 GT_PrfTrap5、軸目標位置 GT_SetPos6、軸轉動速度 GT_SetVel7、啟動軸 GT_Update8、關閉使能 GT_AxisOff9、關閉控制器 GT_Close
C#:using System;using System.Collections.Generic;using System.Linq;using System.Text;using gts;namespace GTS{ class Program { static void command(string sz, short nR) { Console.WriteLine(sz + " = " + nR); } static void Main(string[] args) { short mAxis = 2; short nR = mc.GT_Open(0, 1); if (nR != 0) { command("GT_Open", nR); Console.WriteLine("Open error"); return; } command("GT_Open", nR); // 清除各軸的警示和限位 command("GT_ClrSts", mc.GT_ClrSts(mAxis, 1)); // 伺服使能 command("GT_AxisOn", mc.GT_AxisOn(mAxis)); // 位置清零 command("GT_ZeroPos", mc.GT_ZeroPos(mAxis, 1)); // 軸規劃位置清零 command("GT_SetPrfPos", mc.GT_SetPrfPos(mAxis, 0)); // 設定指定軸為點位運動模式。 command("GT_PrfTrap", mc.GT_PrfTrap(mAxis)); // 設定點位運動參數 mc.TTrapPrm trap = new mc.TTrapPrm(); trap.acc = 0.25; trap.dec = 0.125; trap.smoothTime = 25; command("GT_SetTrapPrm", mc.GT_SetTrapPrm(mAxis, ref trap)); // 設定軸的目標位置 command("GT_SetPos", mc.GT_SetPos(mAxis, 50000)); // 設定軸的目標速度 command("GT_SetVel", mc.GT_SetVel(mAxis, 25)); // 啟動軸運動 command("GT_Update", mc.GT_Update(1 << mAxis - 1)); mc.GT_Close(); Console.ReadKey(); } }}
C++源碼:#include "stdafx.h"#include "windows.h"#include "conio.h"#include "gts.h"#define AXIS1// 該函數檢測某條GT指令的執行結果,command為指令名稱,error為指令執行傳回值void commandhandler(char *command, short error){// 如果指令執行傳回值為非0,說明指令執行錯誤,向螢幕輸出錯誤結果if(error){printf("%s = %d\n", command, error);}}int main(int argc, char* argv[]){short sRtn;TTrapPrm trap;long sts;double prfPos;// 開啟運動控制器sRtn = GT_Open();// 指令傳回值檢測,請查閱例2-1commandhandler("GT_Open", sRtn);// 配置運動控制器// 注意:設定檔取消了各軸的警示和限位sRtn = GT_LoadConfig("test.cfg");commandhandler("GT_LoadConfig ", sRtn);// 清除各軸的警示和限位sRtn = GT_ClrSts(1, 8);commandhandler("GT_ClrSts", sRtn);// 伺服使能sRtn = GT_AxisOn(AXIS);commandhandler("GT_AxisOn", sRtn);// 位置清零sRtn = GT_ZeroPos(AXIS);commandhandler("GT_ZeroPos", sRtn);// AXIS軸規劃位置清零sRtn = GT_SetPrfPos(AXIS, 0);commandhandler("GT_SetPrfPos", sRtn);// 將AXIS軸設為點位元模式sRtn = GT_PrfTrap(AXIS);commandhandler("GT_PrfTrap", sRtn);// 讀取點位運動參數sRtn = GT_GetTrapPrm(AXIS, &trap);commandhandler("GT_GetTrapPrm", sRtn);trap.acc = 0.25;trap.dec = 0.125;trap.smoothTime = 25;// 設定點位運動參數sRtn = GT_SetTrapPrm(AXIS, &trap);commandhandler("GT_SetTrapPrm", sRtn);// 設定AXIS軸的目標位置sRtn = GT_SetPos(AXIS, 50000L);commandhandler("GT_SetPos", sRtn);// 設定AXIS軸的目標速度sRtn = GT_SetVel(AXIS, 50);commandhandler("GT_SetVel", sRtn);// 啟動AXIS軸的運動sRtn = GT_Update(1<<(AXIS-1));commandhandler("GT_Update", sRtn);do{// 讀取AXIS軸的狀態sRtn = GT_GetSts(AXIS, &sts);// 讀取AXIS軸的規劃位置sRtn = GT_GetPrfPos(AXIS, &prfPos);printf("sts=0x%-10lxprfPos=%-10.1lf\r", sts, prfPos);}while(sts&0x400);// 等待AXIS軸規劃停止// 伺服關閉sRtn = GT_AxisOff(AXIS);printf("\nGT_AxisOff()=%d\n", sRtn);getch();return 0;}