CN201812169U

CN201812169U - 高压带电作业机器人专用遥控剥皮器控制器

Info

Publication number: CN201812169U
Application number: CN2010202535215U
Authority: CN
Inventors: 赵玉良; 戚晖; 陈凡明; 李健
Original assignee: Electric Power Research Institute of State Grid Shandong Electric Power Co Ltd
Current assignee: State Grid Corp of China SGCC; Electric Power Research Institute of State Grid Shandong Electric Power Co Ltd
Priority date: 2010-07-12
Filing date: 2010-07-12
Publication date: 2011-04-27
Anticipated expiration: 2020-07-12

Abstract

本实用新型涉及一种高压带电作业机器人专用遥控剥皮器控制器。它由发射启动遥控器和接收与电机驱动器组成；其中所述发射启动遥控器包括微处理器I，它与人机接口单元连接，同时微处理器I还与无线通信单元连接；所述接收与电机驱动器包括无线接收器，无线接收器与微处理器II连接，微处理器II通过转换电路与电机驱动电路连接，电机驱动电路与电机连接；同时，微处理器I、微处理器II和电机驱动电路分别与电源连接；电机驱动电路通过电流反馈电路与微处理器II构成闭环连接。它可以对高压带电作业机器人遥控剥皮器进行速度、方向和扭矩控制，通过遥控器进行远程控制，比手动剥皮器更加安全、可靠，操作也更加方便，满足高压带电机器人作业任务的要求。

Description

高压带电作业机器人专用遥控剥皮器控制器

技术领域：

本实用新型属于高压带电作业电动工具控制系统领域，特别涉及一种发送、接收无线信号并进行电机电流闭环控制，以便控制高压带电作业机器人配电线路专用剥皮器的转动方向、速度和转矩的高压带电作业机器人专用遥控剥皮器控制器。

背景技术：

为了提高带电作业的自动化水平和安全性，减轻操作人员的劳动强度和强电磁场对操作人员的人身威胁，从80年代起许多国家都先后开展了带电作业机器人的研究，如日本、西班牙、美国、加拿大、法国等国家先后开展了对带电作业机器人的研究。2002年我国也进行了高压带电作业机器人产品化样机的研制。目前带电作业所用的剥皮器工具是高压带电作业机器人的专用作业工具，其主要功能是剥除10KV配电线路绝缘外皮，为完成其他作业任务做好准备。目前应用的剥皮器工具多是手动控制，操作安全性不高，不适合高压带电作业机器人作业的需要。

发明内容：

本实用新型的目的在于解决下述问题，提供一种高压带电作业机器人专用遥控剥皮器控制器，它采用无线遥控的方式，以ATMEGA128作为主控制器，电源模块具有过压、过流、低压、防反接保护功能，选用集成度高的电机驱动芯片，采用积分分离PID控制电流反馈方法，可以对高压带电作业机器人遥控剥皮器进行速度、方向和扭矩控制。这种遥控剥皮器通过遥控器进行远程控制，比手动剥皮器更加安全、可靠，操作也更加方便，满足高压带电机器人作业任务的要求。

为实现上述目的，本实用新型采用如下技术方案：

一种高压带电作业机器人专用遥控剥皮器控制器，它由发射启动遥控器和接收与电机驱动器组成；其中所述发射启动遥控器包括微处理器I，它与人机接口单元连接，同时微处理器I还与无线通信单元连接；所述接收与电机驱动器包括无线接收器，无线接收器与微处理器II连接，微处理器II通过转换电路与电机驱动电路连接，电机驱动电路与电机连接；同时，微处理器I、微处理器II和电机驱动电路分别与电源连接；电机驱动电路通过电流反馈电路与微处理器II构成闭环连接。

所述人机接口单元包括键盘和状态指示单元，它们分别与微处理器I连接。

所述微处理器II输出使能信号到电机驱动电路，电机驱动电路为PWM功率驱动装置。

所述微处理器I和微处理器II均采用ATMEGA128芯片。

所述无线通信单元包括调制编码信号电路，它的输入端与微处理器I连接，输出端与载波振荡电路输入端连接，载波振荡电路输出端与无线放大发射电路输入端连接。

所述电流反馈电路包括电流传感器、运算放大器，电流传感器采集电机驱动电路的电流，送入运算放大器，放大后的信号送入微处理器II，微处理器II控制电机驱动电路。

所述电源电路包括12V升压芯片MAX734，其6脚经一二极管与电感L3串联，电感L3一端经电容C8接地，另一端通过串联的电阻R3和LED3接地；升压芯片MAX734的1脚与6脚间连接电感L4，同时1脚还与电容C6连接；3脚与电容C5连接，同时1脚还经反接的二极管D1与78L05芯片输入连接，78L05芯片产生5V电源；78L05芯片的输出端与电感L1连接，电感L1输出5V电压，同时电感L1的该端还分别经过电容C4以及串联的电阻R2、LED2接地；78L05芯片的输入端还与电容C3连接，接头P3通过自恢复保险丝LT160与该输入端连接；自恢复保险丝LT160还与自恢复保险丝LT260一端连接，自恢复保险丝LT260另一端则与接头P1、电容C1、串联的电阻R1和LED1以及电容C2并联。

本实用新型的无线遥控剥皮器控制器，由发射启动遥控器和接收与电机驱动器组成。其中，发射启动遥控器由下述部分组成，包括微处理器I、无线通信单元、人机接口单元和状态指示单元；

无线通信单元负责射频信号的发射，调制编码信号电路输出端经过载波振荡电路和无线放大发射电路输出调制载波编码信号。

微处理器I负责射频部分的调制编码信号处理，以及对人机接口单元的输入处理以及状态的输出指示。

人机接口单元包括键盘和状态指示单元，它用来完成人机交互的工作，包括启动剥皮器驱动器的上电/掉电、电机速度、电机方向的控制。

状态指示单元完成信号发送状态的指示。

无线接收与电机控制器，包括无线接收器、微处理器II、DA转换电路、电机驱动电路、电机、电流反馈电路、供电电源。其中：

无线接收器，用于接收来自遥控器的无线信号，并进行解码处理，输出到微处理器；

微处理器器II，用来接收来自无线接收器或其他部分的信息并进行判断和处理；

DA转换电路，它连接至微处理器II和电机驱动电路，用于接收微处理器II的输出模拟控制信号；

电机驱动电路，它连接至DA转换电路和微处理器II，用于在接收到微处理器的开关信号下控制驱动电路的上电/掉电和接收到DA转换电路的控制下输出驱动信号；

电机，它连接至所述电机驱动电路，用来在所述驱动信号的控制下按所需要的方向、速度和转矩旋转；

电流反馈电路，由电流传感器、运算放大器构成。通过电流传感器采集电机驱动电路的电流，经过单电源运算放大器放大后，接到微处理器II的AD转换接口，并加上积分分离PID控制算法，以便输出扭矩快速稳定在要求水平。

电源电路，电源电路带过压、过流、低压、防反接保护，向两个微处理器、无线接收器、电机驱动电路等各电路提供电源。

为了适应高压带电作业机器人应用的要求，本实用新型采用高集成度驱动模块，并由ATMEGA128单片机控制，带过流、过载、过压保护。这种剥皮器工具遥操作控制系统通过遥控器进行远程控制，比手动剥皮器工具更加安全、可靠，操作也更加方便，满足了高压带电机器人作业任务的要求。

采用上述方案，本实用新型具有以下优点，一是剥皮器遥操作控制器通过遥控器进行远程控制，比手动剥皮器工具更加安全、可靠，操作也更加方便，满足了高压带电机器人作业任务的要求。二是电源电路带过压、过流、低压、防反接保护，可靠性高。三是本遥控器可以进行无极变速，正反转控制，控制灵活，可靠性高。三是本剥皮器控制器带有电流反馈控制，并采用积分分离PID控制算法，消除剥皮器工作不稳定对控制系统动态性能的影响。四是剥皮器控制器与其他工具控制通用，便于今后工具系列化。

附图说明

图1是本实用新型通用遥控器的组成图；

图2是本实用新型接收与电机控制器的组成图；

图3是本实用新型电源电路图；

图4是本实用新型电机驱动与电流反馈电路图；

图5是本实用新型电流反馈控制原理框图；

图6是本实用新型积分分离PID控制程序流程图。

其中，1.微处理器I，2.键盘，3.状态指示单元，4.调制编码信号电路，5.载波振荡电路，6.无线放大发射电路，7.无线接收器，8.微处理器II，9.D/A转换电路，10.电机驱动电路，11.电机，12.电源，13.电流反馈电路，14.电流传感器，15.运算放大器

具体实施方式

下面结合附图与实施例对本实用新型做进一步说明。

本实用新型由发射启动遥控器和接收与电机驱动器组成；

其中所述发射启动遥控器如图1所示，它包括微处理器I1，它与人机接口单元连接，同时微处理器I1还与无线通信单元连接；人机接口单元包括键盘2和状态指示单元3，它们分别与微处理器I1连接。无线通信单元包括调制编码信号电路4，它的输入端与微处理器I1连接，输出端与载波振荡电路5输入端连接，载波振荡电路5输出端与无线放大发射电路6输入端连接。

当发射启动遥控器要向剥皮器发送控制命令时，微处理器I1根据采集键盘2的数据，得到相应的控制指令，并交给无线通信单元电路；无线通信单元电路完成调制、载波振荡、功率放大后，将控制信号以射频的形式发送出去。

图2中，所述接收与电机驱动器包括无线接收器7，无线接收器7与微处理器II8，微处理器II8通过D/A转换电路9与电机驱动电路10连接，电机驱动电路10与电机11连接；同时，微处理器I1、微处理器II8和电机驱动电路10分别于电源12连接；电机驱动电路10通过电流反馈电路13与微处理器II8构成闭环连接。微处理器II8还输出使能信号到电机驱动电路10。

无线接收器7用于接收来自遥控器的无线信号，并进行解码处理，输出到微处理器II8；微处理器II8用来接收来自无线接收器或其他部分的信息并进行判断和处理；D/A转换电路9连接至微处理器II8和电机驱动电路10，用于接收微处理器II8的控制下输出模拟控制信号；电机驱动电路10连接至DA转换电路9和微处理器II8，用于在接收到微处理器II8的开关信号下控制电机驱动电路10的上电/掉电和接收到DA转换电路9的控制下输出驱动信号；电机11连接至所述电机驱动电路10，用来在所述驱动信号的控制下按所需要的方向、速度和转矩旋转；电流反馈电路13由电流传感器14、运算放大器15构成，它通过采集电机驱动电路10的电流，经过单电源运算放大器15，接到微处理器II8的AD转换接口，并加上积分分离PID控制算法，以便输出扭矩快速稳定在要求水平；电源12带过压、过流、低压、防反接保护，向所述两个微处理器、无线接收器7、电机驱动电路10等各个需要供电的电路提供电源。

电流反馈电路13包括电流传感器14、运算放大器15，电流传感器14采集电机驱动电路10的电流，送入运算放大器15，放大后的信号送入微处理器II8，微处理器II8采用积分分离PID控制算法处理后控制电机驱动电路10。

微处理器I1和微处理器II8均采用ATMEGA128芯片。

图3中电源电路10带过压、过流、低压、防反接保护。

它包括12V升压芯片MAX734，其6脚经一二极管与电感L3串联，电感L3一端经电容C8接地，另一端通过串联的电阻R3和LED3接地；升压芯片MAX734的1脚与6脚间连接电感L4，同时1脚还与电容C6连接；3脚与电容C5连接，同时1脚还经反接的二极管D1与78L05芯片输入连接，该芯片产生5V电源。该芯片的输出端与电感L1连接，电感L1输出5V电压，同时电感L1的该端还分别经过电容C4以及串联的电阻R2、LED2接地。该芯片的输入端还与电容C3连接，接头P3通过自恢复保险丝LT160与该输入端连接；自恢复保险丝LT160还与自恢复保险丝LT260一端连接，自恢复保险丝LT260另一端则与接头P1连接，同时该端还与电容C1、串联的电阻R1和LED1以及电容C2并联。

为了防止电机驱动电路10和微处理器II8相互干扰，通过一个电感L2实现不共地。为了微处理器II8和电机驱动电路10发生短路，在前序电路都加上自恢复保险丝LT260、LT160。

剥皮器在作业过程中，由于受力不均匀，电压会被拉低，所以在电源部分加上了12V升压芯片MAX734，产生基准电源+12V，给电机驱动芯片供基准电压。由于电池充满时，电压能达14.4V，超过了MAX734的供电电压，所以在MAX734的前端反接了个3.3V稳压二极管D1。通过78L05产生5V的电源，给所述两个微处理器供电。P1端子给电机驱动电路10供电。P2端子给接5V、+12V。

图4中，电机驱动电路10采用PWM功率驱动装置，它利用大功率管的开关特性来调制直流电源，使其按固定的频率通、断。改变一个周期内通、断时间的长短，即改变输出电压的“占空比”，从而改变平均电压，控制输出功率。其结构可分为两大部分：从主电源将能量传递给负载的电路称为功率转换电路，其余部分为控制电路。

功率转换电路包括桥式驱动电路，它12v电源连接；输出端通过RC阻容网络与电机11连接，以抑制瞬时泵升电压的产生。电阻选用100欧姆2W，电容选择1000pf 100V。

控制电路改变脉冲占空比可以实现电动机转速的调节，但首先需要将控制转速的指令信号转换为具有相应占空比的脉冲信号。它包括555定时器，555定时器外接270pf的电容产生45KHZ的三角波。270pf的电容与比较器一输入端连接，该输入端还分别与连个电感串联后接12V电源，这个两个电感也与555定时器连接；比较器另一输入端接指令信号，输出端则输出PWM信号到桥式驱动电路。

当控制指令信号电压大于或等于三角波电压时，输出信号为比较器电源正电压Ucc；当控制指令信号小于三角波电压时，输出信号为电源地信号0V。

所述电流反馈电路包括电流传感器14，它接在桥式驱动电路的两端，电流传感器14两端还分别经过一个二极管接地，同时这两端还分别通过电阻R2和电阻R3与运算放大器15一端连接，电阻R2还净电阻R4接地；运算放大器另一端经过电阻R1接地，同时该端还经过电阻Rf与输出端反馈连接，输出端与微处理器II8连接。

它通过0.01欧姆精密电阻对电流取样，取样电流经过单电源运算放大器LM324的相加和放大10倍后，接到微处理器II8的AD转换接口。

图5、图6中，本实用新型在电流反馈环节加上了积分分离PID控制算法，电流传感器14采集电机驱动电路10的电流值i(k)，通过与给定的电流值r(k)相比较，产生的差值经过积分分离PID算法处理，输出控制信号控制驱动器输出驱动信号。设ε为PID控制算法的积分分离阀，在控制过程中，当|e(k)|＞ε时，采用PD控制，以减少超调量；当|e(k)|≤ε时，则采用PID控制，以保证电流反馈控制精度。

Claims

1.一种高压带电作业机器人专用遥控剥皮器控制器，其特征是，它由发射启动遥控器和接收与电机驱动器组成；其中所述发射启动遥控器包括微处理器I，它与人机接口单元连接，同时微处理器I还与无线通信单元连接；所述接收与电机驱动器包括无线接收器，无线接收器与微处理器II连接，微处理器II通过转换电路与电机驱动电路连接，电机驱动电路与电机连接；同时，微处理器I、微处理器II和电机驱动电路分别与电源连接；电机驱动电路通过电流反馈电路与微处理器II构成闭环连接。

2.如权利要求1所述的高压带电作业机器人专用遥控剥皮器控制器，其特征是，所述人机接口单元包括键盘和状态指示单元，它们分别与微处理器I连接。

3.如权利要求1所述的高压带电作业机器人专用遥控剥皮器控制器，其特征是，所述微处理器II输出使能信号到电机驱动电路，电机驱动电路为PWM功率驱动装置。

4.如权利要求1所述的高压带电作业机器人专用遥控剥皮器控制器，其特征是，所述微处理器I和微处理器II均采用ATMEGA128芯片。

5.如权利要求1所述的高压带电作业机器人专用遥控剥皮器控制器，其特征是，所述无线通信单元包括调制编码信号电路，它的输入端与微处理器I连接，输出端与载波振荡电路输入端连接，载波振荡电路输出端与无线放大发射电路输入端连接。

6.如权利要求1所述的高压带电作业机器人专用遥控剥皮器控制器，其特征是，所述电流反馈电路包括电流传感器、运算放大器，电流传感器采集电机驱动电路的电流，送入运算放大器，放大后的信号送入微处理器II，微处理器II控制电机驱动电路。

7.如权利要求1所述的高压带电作业机器人专用遥控剥皮器控制器，其特征是，所述电源电路包括12V升压芯片MAX734，其6脚经一二极管与电感L3串联，电感L3一端经电容C8接地，另一端通过串联的电阻R3和LED3接地；升压芯片MAX734的1脚与6脚间连接电感L4，同时1脚还与电容C6连接；3脚与电容C5连接，同时1脚还经反接的二极管D1与78L05芯片输入连接，78L05芯片产生5V电源；78L05芯片的输出端与电感L1连接，电感L1输出5V电压，同时电感L1的该端还分别经过电容C4以及串联的电阻R2、LED2接地；78L05芯片的输入端还与电容C3连接，接头P3通过自恢复保险丝LT160与该输入端连接；自恢复保险丝LT160还与自恢复保险丝LT260一端连接，自恢复保险丝LT260另一端则与接头P1、电容C1、串联的电阻R1和LED1以及电容C2并联。