阅读 | 订阅
阅读 | 订阅
控制系统

DMC2000运动控制卡常见软件问题的解决方案

星之球激光 来源:中国自动化网2012-03-03 我要评论(0 )   

一、0脉冲速度初始化故障 示例介绍: Set_move_speed(3200, 6400 ); //设置插补矢量速度 Set_move_accel( 0.1 ); //设置加速时间 Start_move_xy(0, 6400, 6400 );...

  一、0脉冲速度初始化故障 

示例介绍: 

Set_move_speed(3200, 6400 ); //设置插补矢量速度 

Set_move_accel( 0.1 ); //设置加速时间 

Start_move_xy(0, 6400, 6400 ); //进行直线插补 

If( Motion_done(0) == 0 || // 可以Wait_for_done,Wait_for_all之类函数 

Motion_done(1) == 0 ){ //脉冲在输出时,做其它事情 

… do s.th 

} 

else{//脉冲输出完毕 

… next operator //无法执行到此处 

} 

原因分析: 

库函数故障; 当第一次运行时,速度寄存器未填入有效数据,具体原因未明。 

Set_move_speed 设置多轴运动的矢量速度 

Set_move_accel 设置多轴运动的矢量加速时间 

Start_move_xy 让指定卡号的第1,2轴以插补方式运动到指定位置 

Move_xy 同Start_move_xy,需等待完成 

Start_move_zu 让指定卡号的第3,4轴以插补方式运动到指定位置 

Move_zu 同Start_move_zu,需等待完成 

Arc_xy 让指定卡号的第1,2轴作圆弧运动,需等待完成 

Arc_zu 让指定卡号的第3,4轴作圆弧运动,需等待完成 

附带检测函数: 

#p#分页标题#e#Wait_for_all 等待指定的多轴并完成 

Wait_for_done 等待运动并完成 

Motion_done 检测当前运动状态 

故障现象: 

当程序执行到Motion_done等检测函数时,发现它们无法返回完成的状态,原因不是检测函数的故障。而是X,Y无法取得速度值,进而也无法完成指定的脉冲输出,这就是为什么检测函数返回不了脉冲输出完成的状态。此问题是库函数的小毛病。 

解决方法: 

Start_r_move(0,0,3200, 6400, 0.1); //驱动X轴,但其输出脉冲为0个,不会损失位置 

Start_move_xy(0, 6400, 6400 ); //再次驱动,问题解决了。 

二、多轴插补数据类型引起冲突 

示例介绍: 

int marray[2]={0,1}; //指定驱动轴号(期望是X,Y运动) 

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 ); 


相关函数: 

Map_axes 为多轴运行配置指定的轴号 

Move_all 启动多轴运动 

Start_move_all 启动多轴运行,并等待完成 


故障现象: 

当调用 Map_axes(),Move_all(),Start_move_all()函数时,出现被操作的驱动轴变得混乱,如Y轴不动,X轴走出Y轴的距离。 #p#分页标题#e#

原因分析: 

int 为4字节 (在VC编程环境) 

WORD 为2字节 

当发生int转成WORD时,int数组后面的数据被裁切而遗失。即marray[1]会无效。所以上例的XY值实质上为: 

X= marray[0]&0x000f= 0; 

Y=(marray[0]&0xf0000>>16) = 0; 

可以看出Y为0,是X轴的值,当驱动时,每个轴以最后配置的对应数据有效。则Y为X轴时,已对应数据索引第1个,即pos[1]=12800个脉冲了。这就是为什么X轴走Y轴的脉冲,而Y轴不动作,从以上得知,Y轴从未直正被指定驱动。据此原理,修改起来就简单了,只需要将marray[0]的数据初始化如下: 

marray[0] = 0x00010000; 

//低16位两字节,为0,指向X轴 ,高16位两字节,为1,指向Y轴 

但是用此种方法初始化marray不受程序员的欢迎,通常我们建议用以下的方法进行解决。

解决方法: 

WORD marray[2]={0,1}; //将int变为WORD 

Map_axes( 2, (int *)marray ); //为获取编译通过,需将WORD数组转成(int *)方式 

三、用曲线拟合算法,替代库函Arc插补 

示例介绍: 

void OnButtonArc() 

{ 

Arc_xy( 0, 1000, 1000, 360); //进行圆弧插补 

} 

void OnTimer()//定时器内取位置 

{ 

long CurX = Get_position( 0 );//取X轴位置 
#p#分页标题#e#
long CurY = Get_Position( 1 );//取Y轴位置 

} 

相关函数: 

Arc_xy XY圆弧插补函数 

Arc_zu ZU圆弧插补函数 

Get_Position 取位置函数 

故障现象: 

1. 当进行圆弧插补时,不响应其它事件 

2. 取得位置,不准确 

原因分析: 

1.不响应其它事件,原点是:函数库进行圆弧插补时,实质上同样进行的纯软件算法处理,内部使用软件查询位置方式,从而形成单一任务响应。 

2.位置读取不准确暂未明了。 

解决方法: 

参见下列源代码: 

voidArc(int ch1, int ch2, double cen1, double cen2, 

double angle, double speed, FUNCTION pfn) 

{// cen1 和 cen2 为绝对位置 

if( fabs(angle) < 1.0 ) return ;//简单的超值处理 

double x = cen1; double y = cen2; 

double curx = GetMM(ch1,TRUE); //取当前位置 

double cury = GetMM(ch2,TRUE); 

double r = sqrt( (x-curx) * (x-curx) + 

(y-cury) * (y-cury) );//计算半径 

#p#分页标题#e#double startPAI = atan2( cury-y, curx -x);//计算起始角度 

double dt = 1; //圆弧精度值(超小,精度越高,过小可能要考虑计算溢出的问题) 

double l = r*fabs(angle)*PAIUT;//弧长 

double tmpStep = (dt/r)*(angle>0.0?1.0:-1.0);//步长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);//使直线插补函数 

startPAI +=tmpStep; 

while( IsRunning(ch1) != 0 || 

IsRunning(ch2) != 0 )if( pfn ) pfn();//响应函数 

} 

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; 

} 

//其它函数及数据类型声明 

//直线插补 
#p#分页标题#e#
int ConLine2(int ch1, int ch2, double pos1, double pos2, double speed,FUNCTION pfn) 

{//指向绝对位置(毫米单位) 

speed = MMPulse( XCH, speed ); 

pos1 = MMPulse( ch1, pos1 ); //毫米转成脉冲 

pos2 = MMPulse( ch2, pos2 ); 

Set_move_speed( speed, speed ); 

Set_move_accel( 0.0f ); 

Start_r_move(XCH,0,speed,speed,0);//此问题,请参见[0脉冲] 

Start_move_xy(0,pos1,pos2); 

if( !pfn ) return 2; 

while( IsRunning(ch1) != 0 || 

IsRunning(ch2) != 0 ) 

pfn(); 

return 1; 

} 

//函数指针声明 

typedef void (*FUNCTION)(void); 

//检测是否在运动函数 

int IsRunning( int ch) 

{//停止返回0 

return Motion_done(ch) == 0;//为1正在运行

 

转载请注明出处。

暂无关键词
免责声明

① 凡本网未注明其他出处的作品,版权均属于激光制造网,未经本网授权不得转载、摘编或利用其它方式使用。获本网授权使用作品的,应在授权范围内使 用,并注明"来源:激光制造网”。违反上述声明者,本网将追究其相关责任。
② 凡本网注明其他来源的作品及图片,均转载自其它媒体,转载目的在于传递更多信息,并不代表本媒赞同其观点和对其真实性负责,版权归原作者所有,如有侵权请联系我们删除。
③ 任何单位或个人认为本网内容可能涉嫌侵犯其合法权益,请及时向本网提出书面权利通知,并提供身份证明、权属证明、具体链接(URL)及详细侵权情况证明。本网在收到上述法律文件后,将会依法尽快移除相关涉嫌侵权的内容。

网友点评
0相关评论
精彩导读