CN106625725A - 换流阀大厅内壁清洁机器人的控制系统 - Google Patents

换流阀大厅内壁清洁机器人的控制系统 Download PDF

Info

Publication number
CN106625725A
CN106625725A CN201611024875.0A CN201611024875A CN106625725A CN 106625725 A CN106625725 A CN 106625725A CN 201611024875 A CN201611024875 A CN 201611024875A CN 106625725 A CN106625725 A CN 106625725A
Authority
CN
China
Prior art keywords
module
cleaning
stepper motor
robot
control system
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Pending
Application number
CN201611024875.0A
Other languages
English (en)
Inventor
曾晰
潘烨
计时鸣
张书豹
苏林杰
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Zhejiang University of Technology ZJUT
Original Assignee
Zhejiang University of Technology ZJUT
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Zhejiang University of Technology ZJUT filed Critical Zhejiang University of Technology ZJUT
Priority to CN201611024875.0A priority Critical patent/CN106625725A/zh
Publication of CN106625725A publication Critical patent/CN106625725A/zh
Pending legal-status Critical Current

Links

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J13/00—Controls for manipulators
    • B25J13/08—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
    • B25J13/088—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices with position, velocity or acceleration sensors
    • B25J13/089—Determining the position of the robot with reference to its environment
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J11/00—Manipulators not otherwise provided for
    • B25J11/008—Manipulators for service tasks
    • B25J11/0085—Cleaning
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J13/00—Controls for manipulators
    • B25J13/08—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/16—Programme controls
    • B25J9/1602—Programme controls characterised by the control system, structure, architecture

Abstract

本发明公开了一种换流阀大厅内壁清洁机器人的控制系统，包括至少一个驱动模块、至少一个被控对象步进电机、电动推杆、清洁模块、导向模块、避障模块、电脑PC端、单片机芯片以及CAN总线，其中，电脑PC端从所述的CAN总线中接收所有的总线消息，以完成对驱动模块、清洁模块、导向模块、避障模块的初始化和工作状态的监控；驱动模块从CAN总线中获取导航信息，并且通过步进电机驱动器实现机器人在攀爬行进和原路返程时步进电机的正转、反转和停止；清洁模块从CAN总线中获取开始清洁信息，进而通过控制电动推杆的伸缩实现清洁刷的上升和下降，清洁刷下降的距离由电动推杆的行程决定；导向模块对两个测距传感器实施控制。

Description

换流阀大厅内壁清洁机器人的控制系统
技术领域
本发明涉及一种换流阀大厅内壁清洁机器人的控制系统。
背景技术
换流站是在高压直流输电系统中，为了完成直流电与交流电的转换，并达到电力系统对于安全稳定及电能质量而建立的站点。换流阀是直流输电工程的核心设备，通过依次将三相交流电压连接到直流端得到期望的直流电压并实现对功率的控制，其价值约占换流站成套设备总价的22～25％。换流阀大厅是放置换流阀的封闭建筑，其内壁累积的灰尘若不及时清理会扩散到空气中，从而对换流阀的正常运行和使用寿命产生很大影响。目前，壁面的清洁工作由人工完成，需购买专业升降机器，效率低、危险性高且浪费了大量的人力和物力，为保证换流阀大厅内部清洁，提高换流阀运行稳定性，研制自动化清洁机器人势在必行。
发明内容
为了克服现有壁面的清洁工作由人工完成，需购买专业升降机器，效率低、危险性高且浪费了大量的人力和物力的缺陷，本发明提供一种能够保证换流阀大厅内部清洁、提高换流阀运行稳定性的换流阀大厅内壁清洁机器人的控制系统。
本发明采用的技术方案是：
换流阀大厅内壁清洁机器人的控制系统，其特征在于：包括至少一个驱动模块、至少一个被控对象步进电机、电动推杆、清洁模块、导向模块、避障模块、电脑PC端、单片机芯片以及CAN总线，所述的单片机芯片分别与驱动模块、清洁模块、导向模块、避障模块、电脑PC端连接；其中，
所述的电脑PC端，与CAN总线连接，所述的电脑PC端从所述的CAN总线中接收所有的总线消息，以完成对所述的驱动模块、清洁模块、导向模块、避障模块的初始化和工作状态的监控；
所述的驱动模块，与CAN总线连接，所述的驱动模块从所述的CAN总线中获取导航信息，并且通过步进电机驱动器实现机器人在攀爬行进和原路返程时步进电机的正转、反转和停止；
所述的清洁模块，与CAN总线连接，所述的清洁模块从所述的CAN总线中获取开始清洁信息，进而通过控制电动推杆的伸缩实现清洁刷的上升和下降，清洁刷下降的距离由电动推杆的行程决定；
所述的导向模块，与CAN总线连接，所述的导向模块对两个测距传感器实施控制，当测距传感器实时测得的机器人至左右两侧壁面凸起边缘的距离大小在设定距离范围内(测距传感器分别安装在左前轮固定板左侧和右前轮固定板右侧，分别检测机器人至左右两侧壁面凸起边缘的距离)，机器人正常攀爬行进或原路返程；当测距传感器实时测得的距离大小超出设定距离时，反馈信号通过CAN总线传输至单片机芯片，单片机芯片根据反馈信号调节两个步进电机速度以达到纠偏的效果；
所述的避障模块，与CAN总线连接，所述的避障模块对广角摄像头实施控制，通过输入程序实现广角摄像头的环境识别、环境重建和重新规划路线三种功能，在广角摄像头识别前方遇障时，反馈信号通过CAN总线传输至单片机芯片，单片机芯片根据障碍反馈信息对步进电机发出指令，令其停车或反转，以达到避障效果。
所述的驱动模块、步进电机、电动推杆分别包括两个，即左端步进电机控制器和右端步进电机控制器，左端步进电机和右端步进电机，左端电动推杆和右端电动推杆。
所述的清洁刷为U型清洁刷。
所述的电脑PC端可实时监控控制系统运行情况，所述的单片机芯片为控制中枢，通过烧入程序控制各个被控对象；所述的CAN总线为控制器局域网络，其以节点形式实现控制系统与被控对象的数据通讯。
本发明控制系统对机器人实施控制时，基本流程框架为：(1)机器人位于壁面底部初始状态，广角摄像机开启，机器人进入识别障碍状态；(2)测距传感器得电，机器人进入实时测距状态；(3)电动推杆得电，推杆伸出，“U”型清洁刷垂直下降；(4)电动推杆行程到达，电动推杆失电；(5)步进电机通电，机器人行进；(6)机器人遇障或至顶，步进电机先停止后反转；(7)机器人返程至初始位置，步进电机失电；(8)电动推杆得电，推杆回缩，“U”型清洁刷垂直上升；(9)电动推杆行程到达，电动推杆失电；(10)测距传感器失电，机器人关闭实时测距状态；(11)广角摄像机失电，机器人关闭识别障碍状态；(12)返回初始状态。除上述流程外，机器人还要实时处理各个反馈信号，并对各个被控对象重新发送指令，以达到最佳控制效果。
本发明的技术构思为：采用CAN总线形式，对机器人的控制系统进行设计，电脑PC端用于实时监控控制系统运行情况，单片机芯片作为控制中枢，对机器人各个被控对象实施控制。以模块化形式对控制系统的被控对象进行划分，使控制系统设计简单化、明了化。
本发明的有益效果体现在：
首先，针对换流阀大厅内壁清洁的技术难题，提出了一种内壁清洁机器人的控制系统方案，使其集攀爬吸附、直线行驶、障碍识别和有效清洁等功能于一体，满足基本使用要求；
其次，采用CAN总线形式，对机器人的控制系统进行设计，电脑PC端实时监控控制系统运行情况，单片机芯片实现对各个被控对象的实时控制；
最后，以模块化形式对控制系统的被控对象进行划分，使控制系统设计简单化、规范化。
附图说明
图1是本发明控制系统框架图。
图2是本发明控制系统模块图。
图3是本发明控制任务流程图。
具体实施方式
参照图1至图3，换流阀大厅内壁清洁机器人的控制系统，包括至少一个驱动模块1、至少一个被控对象步进电机、电动推杆201、202、清洁模块2、导向模块3、避障模块4、电脑PC端10、单片机芯片8以及CAN总线9，所述的单片机芯片8分别与驱动模块1、清洁模块2、导向模块3、避障模块4、电脑PC端10连接；其中，
所述的电脑PC端10，与CAN总线9连接，所述的电脑PC端10从所述的CAN总线9中接收所有的总线消息，以完成对所述的驱动模块1、清洁模块2、导向模块3、避障模块4的初始化和工作状态的监控；
所述的驱动模块1，与CAN总线9连接，所述的驱动模块1从所述的CAN总线9中获取导航信息，并且通过步进电机驱动器实现机器人在攀爬行进和原路返程时步进电机的正转、反转和停止；
所述的清洁模块2，与CAN总线9连接，所述的清洁模块2从所述的CAN总线中获取开始清洁信息，进而通过控制电动推杆的伸缩实现清洁刷204的上升和下降，清洁刷下降的距离由电动推杆的行程决定；
所述的导向模块3，与CAN总线9连接，所述的导向模块3对两个测距传感器301实施控制，当测距传感器实时测得的机器人至左右两侧壁面凸起边缘的距离大小在设定距离范围内(测距传感器分别安装在左前轮固定板左侧和右前轮固定板右侧，分别检测机器人至左右两侧壁面凸起边缘的距离)，机器人正常攀爬行进或原路返程；当测距传感器实时测得的距离大小超出设定距离时，反馈信号通过CAN总线传输至单片机芯片，单片机芯片根据反馈信号调节两个步进电机速度以达到纠偏的效果；
所述的避障模块4，与CAN总线9连接，所述的避障模块4对广角摄像头401实施控制，通过输入程序实现广角摄像头的环境识别、环境重建和重新规划路线三种功能，在广角摄像头识别前方遇障时，反馈信号通过CAN总线传输至单片机芯片，单片机芯片根据障碍反馈信息对步进电机发出指令，令其停车或反转，以达到避障效果。
所述的驱动模块、步进电机、电动推杆分别包括两个，即左端步进电机控制器103和右端步进电机控制器104，左端步进电机101和右端步进电机102，左端电动推杆201和右端电动推杆202。
所述的清洁刷204为U型清洁刷。
所述的电脑PC端10可实时监控控制系统运行情况，所述的单片机芯片为控制中枢，通过烧入程序控制各个被控对象；所述的CAN总线为控制器局域网络，其以节点形式实现控制系统与被控对象的数据通讯。
参照图3，控制系统对机器人实施控制时，基本流程框架为：(1)机器人位于壁面底部初始状态，广角摄像头401开启，机器人进入识别障碍状态；(2)测距传感器301得电，机器人进入实时测距状态；(3)电动推杆(201和202)得电，推杆伸出，“U”型清洁刷204垂直下降；(4)电动推杆(201和202)行程到达，电动推杆失电；(5)步进电机(101和102)通电，机器人行进；(6)机器人遇障或至顶，步进电机(101和102)先停止后反转；(7)机器人返程至初始位置，步进电机(101和102)失电；(8)电动推杆(201和202)得电，推杆回缩，“U”型清洁刷204垂直上升；(9)电动推杆(201和202)行程到达，电动推杆失电；(10)测距传感器301失电，机器人关闭实时测距状态；(11)广角摄像机401失电，机器人关闭识别障碍状态；(12)返回初始状态。除上述流程外，机器人还要实时处理各个反馈信号，并对各个被控对象重新发送指令，以达到最佳控制效果。
本说明书实施例所述的内容仅仅是对发明构思的实现形式的列举，本发明的保护范围不应当被视为仅限于实施例所陈述的具体形式，本发明的保护范围也及于本领域技术人员根据本发明构思所能够想到的等同技术手段。

Claims (3)

1.换流阀大厅内壁清洁机器人的控制系统，其特征在于：包括至少一个驱动模块、至少一个被控对象步进电机、电动推杆、清洁模块、导向模块、避障模块、电脑PC端、单片机芯片以及CAN总线，所述的单片机芯片分别与驱动模块、清洁模块、导向模块、避障模块、电脑PC端连接；其中，
所述的电脑PC端，与CAN总线连接，所述的电脑PC端从所述的CAN总线中接收所有的总线消息，以完成对所述的驱动模块、清洁模块、导向模块、避障模块的初始化和工作状态的监控；
所述的驱动模块，与CAN总线连接，所述的驱动模块从所述的CAN总线中获取导航信息，并且通过步进电机驱动器实现机器人在攀爬行进和原路返程时步进电机的正转、反转和停止；
所述的清洁模块，与CAN总线连接，所述的清洁模块从所述的CAN总线中获取开始清洁信息，进而通过控制电动推杆的伸缩实现清洁刷的上升和下降，清洁刷下降的距离由电动推杆的行程决定；
所述的导向模块，与CAN总线连接，所述的导向模块对两个测距传感器实施控制，当测距传感器实时测得的机器人至左右两侧壁面凸起边缘的距离大小在设定距离范围内，机器人正常攀爬行进或原路返程；当测距传感器实时测得的距离大小超出设定距离时，反馈信号通过CAN总线传输至单片机芯片，单片机芯片根据反馈信号调节两个步进电机速度以达到纠偏的效果；
所述的避障模块，与CAN总线连接，所述的避障模块对广角摄像头实施控制，通过输入程序实现广角摄像头的环境识别、环境重建和重新规划路线三种功能，在广角摄像头识别前方遇障时，反馈信号通过CAN总线传输至单片机芯片，单片机芯片根据障碍反馈信息对步进电机发出指令，令其停车或反转，以达到避障效果。
2.如权利要求1所述的换流阀大厅内壁清洁机器人的控制系统，其特征在于：所述的驱动模块、步进电机、电动推杆分别包括两个，即左端步进电机控制器和右端步进电机控制器，左端步进电机和右端步进电机，左端电动推杆和右端电动推杆。
3.如权利要求2所述的换流阀大厅内壁清洁机器人的控制系统，其特征在于：所述的清洁刷为U型清洁刷。
CN201611024875.0A 2016-11-16 2016-11-16 换流阀大厅内壁清洁机器人的控制系统 Pending CN106625725A (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201611024875.0A CN106625725A (zh) 2016-11-16 2016-11-16 换流阀大厅内壁清洁机器人的控制系统

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201611024875.0A CN106625725A (zh) 2016-11-16 2016-11-16 换流阀大厅内壁清洁机器人的控制系统

Publications (1)

Publication Number Publication Date
CN106625725A true CN106625725A (zh) 2017-05-10

Family

ID=58808523

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201611024875.0A Pending CN106625725A (zh) 2016-11-16 2016-11-16 换流阀大厅内壁清洁机器人的控制系统

Country Status (1)

Country Link
CN (1) CN106625725A (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111070213A (zh) * 2020-01-08 2020-04-28 北京海益同展信息科技有限公司 一种机器人控制系统

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
TW201132327A (en) * 2010-03-19 2011-10-01 Chung Chou Inst Of Technology Home stairs-de-dusting robot
CN102525333A (zh) * 2012-01-13 2012-07-04 燕山大学 室内自动检测清洁机器人
CN105388896A (zh) * 2015-09-23 2016-03-09 上海物景智能科技有限公司 基于can总线的分布式清洁机器人控制系统及控制方法
CN205475002U (zh) * 2016-03-30 2016-08-17 贾配洋 一种用于道路护栏清洗的清洗机器人
CN206242072U (zh) * 2016-11-16 2017-06-13 浙江工业大学 换流阀大厅内壁清洁机器人的控制系统

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
TW201132327A (en) * 2010-03-19 2011-10-01 Chung Chou Inst Of Technology Home stairs-de-dusting robot
CN102525333A (zh) * 2012-01-13 2012-07-04 燕山大学 室内自动检测清洁机器人
CN105388896A (zh) * 2015-09-23 2016-03-09 上海物景智能科技有限公司 基于can总线的分布式清洁机器人控制系统及控制方法
CN205475002U (zh) * 2016-03-30 2016-08-17 贾配洋 一种用于道路护栏清洗的清洗机器人
CN206242072U (zh) * 2016-11-16 2017-06-13 浙江工业大学 换流阀大厅内壁清洁机器人的控制系统

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111070213A (zh) * 2020-01-08 2020-04-28 北京海益同展信息科技有限公司 一种机器人控制系统

Similar Documents

Publication Publication Date Title
CN205989678U (zh) 一种无人驾驶的清扫车
CN206242072U (zh) 换流阀大厅内壁清洁机器人的控制系统
CN204541962U (zh) 一种自动清扫机器人
CN109057359A (zh) 一种全自动水泥抹光机器人
CN104047248B (zh) 复合式轨道路面自动清洁车系统
CN106426122A (zh) 面向地下管道的四向行走智能机器人
CN103552073A (zh) 一种桥梁缆索检测机器人的控制系统
CN104408788B (zh) 一种巡检电力仪表的方法
CN105013733B (zh) 变电站带电水冲洗辅冲机器人及方法
CN110955234A (zh) 用于充电站的轨道机器人巡检系统及其使用方法
CN107422726A (zh) 一种应用于温室的自主导航智能变量喷雾系统及其控制方法
CN106625725A (zh) 换流阀大厅内壁清洁机器人的控制系统
CN103457203B (zh) 一种基于物联网的机器人综合布线方法
CN108390312A (zh) 一种架空配电线路巡检机器人作业方法
CN108508909A (zh) 一种基于综合导航的输电线路巡视机器人及其巡线方法
CN204251998U (zh) 破损路面修复预处理装置
DE102016108460A1 (de) Reinigungsroboter und Verfahren zur Steuerung
CN204576260U (zh) 一种仓库安监机器人
CN206600034U (zh) 自适应固定式u型移车系统
CN104389260B (zh) 多功能自定位破损路面铣刨机
CN108971070A (zh) 一种适用于光伏板的自动化清洁设备
CN205024582U (zh) 高速公路无人驾驶远程控制自动划线装置
CN212398562U (zh) 一种焊接用可移动式机器人
CN210742159U (zh) 一种用于建构筑物病害检测的自动检测系统
CN208179557U (zh) 一种巡检机器人的手臂机构

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination