DMC2000 運(yùn)動(dòng)控制卡常見軟件問題的解決方案
-
企業(yè)：控制網(wǎng)
領(lǐng)域：工業(yè)安全
行業(yè)：市政工程
- 點(diǎn)擊數(shù)：1585 發(fā)布時(shí)間：2005-08-10 15:59:55
- 分享到：
一、0脈沖速度初始化故障
示例介紹：
Set_move_speed(3200, 6400 ); //設(shè)置插補(bǔ)矢量速度
Set_move_accel( 0.1 ); //設(shè)置加速時(shí)間
Start_move_xy(0, 6400, 6400 ); //進(jìn)行直線插補(bǔ)
If( Motion_done(0) == 0 || // 可以Wait_for_done，Wait_for_all之類函數(shù)
Motion_done(1) == 0 ){ //脈沖在輸出時(shí)，做其它事情
… do s.th
}
else{//脈沖輸出完畢
… next operator //無法執(zhí)行到此處
}
原因分析：
庫(kù)函數(shù)故障； 當(dāng)?shù)谝淮芜\(yùn)行時(shí)，速度寄存器未填入有效數(shù)據(jù)，具體原因未明。
Set_move_speed 設(shè)置多軸運(yùn)動(dòng)的矢量速度
Set_move_accel 設(shè)置多軸運(yùn)動(dòng)的矢量加速時(shí)間
Start_move_xy 讓指定卡號(hào)的第1,2軸以插補(bǔ)方式運(yùn)動(dòng)到指定位置
Move_xy 同Start_move_xy，需等待完成
Start_move_zu 讓指定卡號(hào)的第3，4軸以插補(bǔ)方式運(yùn)動(dòng)到指定位置
Move_zu 同Start_move_zu，需等待完成
Arc_xy 讓指定卡號(hào)的第1,2軸作圓弧運(yùn)動(dòng)，需等待完成
Arc_zu 讓指定卡號(hào)的第3,4軸作圓弧運(yùn)動(dòng)，需等待完成
附帶檢測(cè)函數(shù)：
Wait_for_all 等待指定的多軸并完成
Wait_for_done 等待運(yùn)動(dòng)并完成
Motion_done 檢測(cè)當(dāng)前運(yùn)動(dòng)狀態(tài)
故障現(xiàn)象：
當(dāng)程序執(zhí)行到Motion_done等檢測(cè)函數(shù)時(shí)，發(fā)現(xiàn)它們無法返回完成的狀態(tài),原因不是檢測(cè)函數(shù)的故障。而是X，Y無法取得速度值，進(jìn)而也無法完成指定的脈沖輸出，這就是為什么檢測(cè)函數(shù)返回不了脈沖輸出完成的狀態(tài)。此問題是庫(kù)函數(shù)的小毛病。
解決方法：
Start_r_move(0,0,3200, 6400, 0.1); //驅(qū)動(dòng)X軸,但其輸出脈沖為0個(gè),不會(huì)損失位置
Start_move_xy(0, 6400, 6400 ); //再次驅(qū)動(dòng)，問題解決了。
二、多軸插補(bǔ)數(shù)據(jù)類型引起沖突
示例介紹：
int marray[2]={0,1}; //指定驅(qū)動(dòng)軸號(hào)（期望是X，Y運(yùn)動(dòng)）
double pos[2]={6400,12800}; // X=6400 Y=12800
double LowSpeed[2]={6400,6400};
double HighSpeed[2]={12800,12800};
double Taccel[2]={0.1,0.1};
Map_axes( 2, marray );
Move_all( 2, marray, pos, LowSpeed, HighSpeed, Taccel );
相關(guān)函數(shù)：
Map_axes 為多軸運(yùn)行配置指定的軸號(hào)
Move_all 啟動(dòng)多軸運(yùn)動(dòng)
Start_move_all 啟動(dòng)多軸運(yùn)行，并等待完成
故障現(xiàn)象：
當(dāng)調(diào)用 Map_axes()，Move_all(),Start_move_all()函數(shù)時(shí)，出現(xiàn)被操作的驅(qū)動(dòng)軸變得混亂，如Y軸不動(dòng)，X軸走出Y軸的距離。
原因分析：
int 為4字節(jié) (在VC編程環(huán)境)
WORD 為2字節(jié)
當(dāng)發(fā)生int轉(zhuǎn)成WORD時(shí)，int數(shù)組后面的數(shù)據(jù)被裁切而遺失。即marray[1]會(huì)無效。所以上例的XY值實(shí)質(zhì)上為：
X= marray[0]&0x000f= 0;
Y=(marray[0]&0xf0000>>16) = 0;
可以看出Y為0，是X軸的值，當(dāng)驅(qū)動(dòng)時(shí)，每個(gè)軸以最后配置的對(duì)應(yīng)數(shù)據(jù)有效。則Y為X軸時(shí)，已對(duì)應(yīng)數(shù)據(jù)索引第1個(gè)，即pos[1]=12800個(gè)脈沖了。這就是為什么X軸走Y軸的脈沖，而Y軸不動(dòng)作，從以上得知，Y軸從未直正被指定驅(qū)動(dòng)。據(jù)此原理，修改起來就簡(jiǎn)單了，只需要將marray[0]的數(shù)據(jù)初始化如下：
marray[0] = 0x00010000;
//低16位兩字節(jié)，為0，指向X軸 ,高16位兩字節(jié)，為1，指向Y軸
但是用此種方法初始化marray不受程序員的歡迎，通常我們建議用以下的方法進(jìn)行解決.
解決方法：
WORD marray[2]={0,1}; //將int變?yōu)閃ORD
Map_axes( 2, (int *)marray ); //為獲取編譯通過，需將WORD數(shù)組轉(zhuǎn)成（int *）方式
三、用曲線擬合算法，替代庫(kù)函Arc插補(bǔ)
示例介紹：
void OnButtonArc()
{
Arc_xy( 0, 1000, 1000, 360); //進(jìn)行圓弧插補(bǔ)
}
void OnTimer()//定時(shí)器內(nèi)取位置
{
long CurX = Get_position( 0 );//取X軸位置
long CurY = Get_Position( 1 );//取Y軸位置
}
相關(guān)函數(shù)：
Arc_xy XY圓弧插補(bǔ)函數(shù)
Arc_zu ZU圓弧插補(bǔ)函數(shù)
Get_Position 取位置函數(shù)
故障現(xiàn)象：
1. 當(dāng)進(jìn)行圓弧插補(bǔ)時(shí)，不響應(yīng)其它事件
2. 取得位置，不準(zhǔn)確
原因分析：
1．不響應(yīng)其它事件，原點(diǎn)是：函數(shù)庫(kù)進(jìn)行圓弧插補(bǔ)時(shí)，實(shí)質(zhì)上同樣進(jìn)行的純軟件算法處理，內(nèi)部使用軟件查詢位置方式，從而形成單一任務(wù)響應(yīng)。
2．位置讀取不準(zhǔn)確暫未明了。
解決方法：
參見下列源代碼：
voidArc(int ch1, int ch2, double cen1, double cen2,
double angle, double speed, FUNCTION pfn)
{// cen1 和 cen2 為絕對(duì)位置
if( fabs(angle) < 1.0 ) return ;//簡(jiǎn)單的超值處理
double x = cen1; double y = cen2;
double curx = GetMM(ch1,TRUE); //取當(dāng)前位置
double cury = GetMM(ch2,TRUE);
double r = sqrt( (x-curx) * (x-curx) +
(y-cury) * (y-cury) );//計(jì)算半徑
double startPAI = atan2( cury-y, curx -x);//計(jì)算起始角度
double dt = 1; //圓弧精度值(超小,精度越高,過小可能要考慮計(jì)算溢出的問題)
double l = r*fabs(angle)*PAIUT;//弧長(zhǎng)
double tmpStep = (dt/r)*(angle>0.0?1.0:-1.0);//步長(zhǎng)PAI單位
int n = int(l/dt);
double tx,ty ;
double tm = startPAI + (angle)*PAIUT;///180.0*PAI);
for(int i=0; i
{
tx = x + r * cos(startPAI);
ty = y + r * sin(startPAI);
ConLine2(ch1,ch2,tx,ty,speed);//使直線插補(bǔ)函數(shù)
startPAI +=tmpStep;
while( IsRunning(ch1) != 0 ||
IsRunning(ch2) != 0 )if( pfn ) pfn();//響應(yīng)函數(shù)
}
tx = x + r * cos( tm );
ty = y + r * sin( tm );
ConLine2(ch1,ch2,tx,ty,speed,NULL);
while( IsRunning(ch1) != 0 || IsRunning(ch2) != 0 )if( pfn ) pfn();
return;
}
//其它函數(shù)及數(shù)據(jù)類型聲明
//直線插補(bǔ)
int ConLine2(int ch1, int ch2, double pos1, double pos2, double speed,FUNCTION pfn)
{//指向絕對(duì)位置(毫米單位)
speed = MMPulse( XCH, speed );
pos1 = MMPulse( ch1, pos1 ); //毫米轉(zhuǎn)成脈沖
pos2 = MMPulse( ch2, pos2 );
Set_move_speed( speed, speed );
Set_move_accel( 0.0f );
Start_r_move(XCH,0,speed,speed,0);//此問題,請(qǐng)參見[0脈沖]
Start_move_xy(0,pos1,pos2);
if( !pfn ) return 2;
while( IsRunning(ch1) != 0 ||
IsRunning(ch2) != 0 )
pfn();
return 1;
}
//函數(shù)指針聲明
typedef void (*FUNCTION)(void);
//檢測(cè)是否在運(yùn)動(dòng)函數(shù)
int IsRunning( int ch)
{//停止返回0
return Motion_done(ch) == 0;//為1正在運(yùn)行
}
案例頻道
北京市公安局海淀分局備案號(hào)：11010802023656號(hào)
x
今日頭條
官方微信
官方抖音
