Trio运动控制器在检测设备上的应用

1.系统要求

　　1)设计一检测系统，它能控制检测头沿着物体表面0.5mm的距离运动，并且在运动同时时刻保证检测头垂直于物体表面。

　　2)系统可控制两个直线轴（X Z1）和一个回转轴（B），其中两个直线轴（X Z1）和回转轴（B）可以联动，回转轴（B）的方向保持与X Z1运行轨迹的法线保持一致。为了增加检测速度，再增加一Z2轴检测工件的直线部分。

　　3)可通过手动、自动方式对4个轴进行控制。

　　4)提供10个零件的运行轨迹，各零件的工作起始点可以通过手动方式确定。

　　5)可通过触摸屏进行手动操作。

　　2.硬件构成

　　检测头是针形结构。旋转轴通过减速器控制检测头旋转。二维十字平台控制旋转轴的平面运动。被检测物体固定以后，运动控制器要根据其外形控制检测头沿物体表面运动。

　　主要硬件构成：

　　1)二维十字平台(Z1 Z2)，单维平台(Z2)

　　2)行星减速器，用在旋转轴

　　3)MOTEC伺服电机4套

　　4)Trio MC206运动控制卡

　　5)斯美特触摸屏

　　6)行程开关等

　3. 编程说明

　　检测头运动规划如图所示：

一共有十种工件，每一种工件的尺寸都是预先知道的。而且可以看出工件外形都是由直线和圆弧组成。所以检测头没走一个线段都要经过两个步骤，第一步走到线段的起始点，并调整检测头垂直于起始点的切线方向；第二步，分两种情况：1，如果线段是直线，则直接控制二维十字平台走直线插补，旋转轴没有运动；2.如果是圆弧，需要走3轴插补，控制十字平台逆时针走大圆弧，同时旋转轴旋转一定的角度，保证检测头垂直于曲面。

　　特殊处理：个线段之间如出现奇点，由于法线方向跳变，需要调整检测头，才能继续检测。

　　触摸屏通过MODBUS总线和MC206通讯，Trio MC206x 运动控制器内置实时多任务嵌入式操作系统，使206可以同时运行多个程序，等级高的程序优先执行。MC206x用一个进程做键盘响应和参数修改，这样触摸屏就可以控制MC206x了。

　　检测过程中不能被其他事件打断，所以检测运动控制部分单独用一个高级进程来执行。

　　检测过程中MC206x的输入口用来接收结果信号，合格与否用输出口控制指示灯点亮，同时做好工件统计，显示在触摸屏上。

　　　　　　　　　　　　　　　　　　　　　　　　　　　　　　　　　　　Trio编程画面

4.总结

　　最终效果非常理想，2s内可以快速检测完一个元件，检测头距离物体保持在0.5mm，检测仪器输出稳定。