|
|
|
一、問題現象
用戶通過以下編程：
# define XCH 0
# define YCH 1
double fUnit[]={ 3200/5.0, 3200/5.0}; //脈沖當量，每毫米脈沖數
//每轉脈沖數為3200，每轉毫米數為5.0
short axisArray[]={ XCH, YCH };//選擇XY兩軸
long distArray[]={ x * fUnit[XCH], y*fUnit[YCH] }; //x和y為毫米單位的絕對位置
d1000_start_ta_line( 2, axisArray, distArray, 10, 10, 0.0);//勻速插補
通過實際運動發現以下情況：
No.1 當X=100,Y=0，即水平方向，所花時間為10.002秒
No.2 當X=0,Y=100，即垂直方向，所花時間為10.003秒
No.3 當X=100，Y=100，即45度斜線，所花時間為10.005秒
即三種情況下的運行時間幾乎相當（當中的微小時間差可能由系統的多任務特性引起的），而實質上當走45度斜線時，其距離等于100*sqrt(2) = 100*1.414=141.4毫米，由此可見距離長了許多，故其速度也快了許多。此種情況在速度慢的情況下表現不明顯，但是在激光切割時，速度不穩定，同樣的能量切割出來的效果就不一致，質量也就不能過關。
二、原因分析
DMC1000的開發較早，對于直線插補的算法是采用三角函數進行合成，故以上設定的10,10,0.0的速度是對距離長的運動軸有效（即長軸），不是一個矢量的速度，由此可見，同樣的速度設定會因為直線的斜率不同而快慢不一致。
三、解決方法
解決此問題也很簡單，每次需要重新計算長軸的速度，以用于作為插補速度，下面給出原代碼，以對上面的代碼進行補充：
double fP1 = distArray[XCH] - (double)d1000_get_command_pos(XCH);
double fP2 = distArray[YCH] - (double)d1000_get_command_pos(YCH);
double fLen= sqrt( fP1*fP1 + fP2*fP2 );
if( fLen < 1 )//0脈個不要
return nAxises;
long nStart,nSpeed; //計算出新的速度
if( fabs(fP1)>fabs(fP2) )
{
double kx = fP1 / fLen;
double AP = kx * fP1;
kx = AP / fP1;
nStart = long(fUnit[XCH] * speed.start * kx );
nSpeed = long(fUnit[XCH] * speed.speed * kx );
}
else{
double ky = fP2 / fLen;
double AP = ky * fP2;
ky = AP/ fP2;
nStart = long(fUnit[YCH]*ky);
nSpeed = long(fUnit[YCH]*ky);
}
nStart和nSpeed是計算出來的最后設定的速度。
關于speed是一個速度結構，大致如下（單位：毫米/秒）
typedef struct tag_SPEED
{
double start;
double speed;
double accel;
};
四、附帶聲明
在DMC1000以后的系列控制卡，如：DMC2000,DMC3000,DMC5000，對矢量速度的設定都已進行充分的考慮，不再需要用戶添加額外的代碼進行計算了。
|
|
狀 態：
離線
公司簡介
產品目錄
|
|
|
公司名稱：
|
深圳市雷賽智能控制股份有限公司
|
| 聯 系 人： |
梁邦敏
|
| 電 話： |
755-26401178
|
| 傳 真： |
|
| 地 址： |
深圳市南山區登良路天安南油工業區2棟3樓 |
| 郵 編： |
518000 |
| 主 頁： |
|
|
|
|
|
