排爆机器人(EOD robot)是一种遥操作地面移动机器人,操作机主体一般是由一个机械手和一个可移动平台组成,主要用于拆除疑似以减少作业现场人员伤亡,是军警部门必须装备的设施。目前国际上主要流行美国Remotec公司的Andros系列排爆机器人、法国Cybernetics公司研制的TRS200中型排爆机器人等。但是国外的排爆机器人价格过高,出现故障后维修特别不方便。因此国家863专家组已经将高性能排爆机器人的研发及国产化列入了重点支持的课题。
由于种种原因,目前的排爆机器人很多只采用PLC实现点动控制,功能有限且操作性较差。研究高性能控制器成为排爆、消防等各种遥操作地面移动机器人的共同课题。利用先进的嵌入式系统技术可以较好地解决这类问题。
本文概述了上海交通大学机器人研究所研制的新型遥控移动式排爆机器人PBJ-1的嵌入式控制系统(如图1所示),主要叙述基于RTX51嵌入式实时操作系统(RTOS)开发排爆机器人PBJ-1嵌入式控制系统固件的情况。利用嵌入式系统技术开发适合排爆等各类遥控地面移动机器人使用的嵌入式控制系统能够解决上述种种矛盾。
图1 遥操作排爆机器人PBJ-1
1 PBJ-1功能介绍
目前国际上比较流行的排爆机器人,都需要由经过专门培训的操作人员通过操作一组分别控制机械臂上各个关节驱动电机的按键控制,操作很不方便。操作人员需要根据现场的状况,判断出需要机械手执行的动作,再经过大脑的转换,手工控制机械臂各个关节顺序动作,使机械手爪拟合出一条空间轨迹以完成作业,大大降低了工作效率。这类排爆机器人一般都需要大量的摄像机,随时显示爆炸物相对机械手爪的位置,以便操作人员决定下一步动作。
新型排爆机器人PBJ-1为了使操作人员操作更加方便,在嵌入式控制器中嵌入了机器人运动学运算,能够实现机械臂的自主联动控制。操作者只要通过观看控制箱上面的显示器,直接操纵控制器命令机器人水平前、后或垂直上、下运动,机械臂可以实时进行机器人运动学运算和分解运动控制,控制机械手爪完成空间的直线拟合运动。这种操作方式略过了操作人员在大脑中进行动作转换的步骤,大大方便了排爆这一高危险性作业现场的作业。
为了方便现场操作,在其嵌入式控制器系统中还加入了机器人的一些半自主动作功能。例如当机器人完成作业后机械臂可以自动折叠归位;机械臂可以自动进入作业最佳操作姿态;当操作不当时,控制器可以自主取消操作人员发送的命令,以避免机械臂与车体之间的干涉碰撞等。
为防止爆炸物被恐怖分子遥控引爆拆除作业危险性很大,所以对排爆机器人的有线通讯系统的可靠性要求很高。PBJ-1是通过RS-485协议实现相互之间远距离、高速、高可靠性通讯。
MOOG Valve Checker 100mA 10mA
Electrical teaching lab ELCON Type 2A59 75W 230V motor demonstration board
Kell-Storm Aero Angle Pro 360 electronic aviation protractor
Teaching Lab Training Tachometer Board M&W Type DGK/GSF
Technical Teaching board dummy load 6.8 Ohm
Brandenburg 30 KV high voltage generator type S.0530 Mk 2 all valve tested and w
Model 7 Avometer resistance range extension unit Vintage in wooden casing
ACWEECO Model 7 Avometer voltage multiplier Vintage in wooden casing
Micro Ameter LEEDS & NORTHRUP CO CAT NO 2435-C 187130
electronic tools PCB circuit board holder service soldering aid
Bruel & Kjaer Linear Potentiometer 10-35 mV
Communication pulse code modulation decoder C72606 PCM-X30 STR SWITZERLAND
Spectrum Analyzer HP 8554B RF SECTION HP8552B IF SECTION HP 141T DISPLAY
Ex Tafe electrical electronic test bench power supply console bench AC Lab
Parameters Oscilloscope 5502 20MHZ
Advance instruments LF Oscillator J2E - AS IS
Tafe teaching lab dummy load in oil PSU transformer thermometer
Teaching Lab bench mount power outlet unit with transformer stainless panel
Teaching Lab bench mount power outlet unit without transformer stainless panel
24V DC Bench Top power supply TX-230/24
Dual variable voltage transformer variac 240v
Stanford Research Systems SR510 Lock-In Amplifier SR-510
Stanford Research Systems SR530 Lock-In Amplifier SR-530
Universal Avometer 5OP/17447 Vintage multimeter in leather case
Variac variable voltage transformer 12kg probably 8A
Huggenberger Zurich Tepic Indicator Type IT1 Transistor High Precision Strain
Vintage Kyoritsu Vacuum Tube Voltmeter Model K–142
Standard Potentiostat Wenking ST 72 Gerhard Bank Elektronik Gottingen
RACAL DANA 9300B True RMS Voltmeter
Wenking PPT 70 Gerhard Bank Elektronik Gottingen
n connected 333.3 OHM