CN110928337B - 一种裸导线绝缘涂覆机器人***及其升降控制方法 - Google Patents
一种裸导线绝缘涂覆机器人***及其升降控制方法 Download PDFInfo
- Publication number
- CN110928337B CN110928337B CN201911218497.3A CN201911218497A CN110928337B CN 110928337 B CN110928337 B CN 110928337B CN 201911218497 A CN201911218497 A CN 201911218497A CN 110928337 B CN110928337 B CN 110928337B
- Authority
- CN
- China
- Prior art keywords
- lifting
- module
- leveling
- coating
- monitoring device
- 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.)
- Active
Links
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D3/00—Control of position or direction
- G05D3/12—Control of position or direction using feedback
- G05D3/20—Control of position or direction using feedback using a digital comparing device
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Application Of Or Painting With Fluid Materials (AREA)
Abstract
本发明公开了一种裸导线绝缘涂覆机器人***及其升降控制方法，对裸导线绝缘涂覆机器人***进行数据初始化，监控装置对涂覆装置的状态数据进行界面显示；监控装置向涂覆装置发送上升/下降指令；涂覆装置的控制模块接收上升/下降指令，并通过角运动检测模块周期性采集角运动数据；控制模块将升降控制位置预先设置为升降点，根据角运动数据和升降点进行调平计算以得到调平结果，并输出调平结果至升降模块；升降模块接收调平结果进行调平，并返回状态数据至监控装置；监控装置接收返回的状态数据并更新界面显示；通过上述设置，对涂覆装置的平衡状态进行周期性的自动调整，从而保持涂覆装置在升降或下降过程中的动态平衡，无需人工调平，操作方便，便于挂载涂覆装置。
Description
技术领域
本发明涉及电缆涂覆领域，特别涉及一种裸导线绝缘涂覆机器人***及其升降控制方法。
背景技术
早期的架空电力线普遍采用裸线形式，如果电力线上因意外挂有风筝、塑料等杂物容易造成高压电线之间的短路，从而引发意外断电等事故，因此有必要对该部分裸线电网进行绝缘改造，将架空裸线更换为绝缘导线。
国内的地势错综复杂，部分地区的施工难度大甚至不具备施工条件，更换绝缘导线作业难以展开，且存在停电时间长、安全风险大、改造成本高等问题。随着技术的发展，开始采用绝缘涂覆机器人进行绝缘涂覆作业，对架空裸线进行绝缘涂覆，无需进行更换，降低改造难度。
现有的绝缘涂覆机器人往往通过人工挂载到需要进行绝缘涂覆作业的裸线上，对于施工人员来说存在一定的安全风险，且使用不方便。若采取机械挂载的方式，无论采取人工遥控或机械自动挂载，为保证绝缘涂覆机器人在裸线上的挂载成功，均需要保证绝缘涂覆机器人在升降过程中的平衡。
可见，现有技术还有待改进和提高。
发明内容
鉴于上述现有技术的不足之处，本发明的目的在于提供一种裸导线绝缘涂覆机器人***及其升降控制方法，旨在实现涂覆装置的升降过程中自动调整并维持动态平衡，便于在电线上挂载。
为了达到上述目的，本发明采取了以下技术方案：
一种裸导线绝缘涂覆机器人***的升降控制方法，包括以下步骤：步骤SO1：对裸导线绝缘涂覆机器人***进行数据初始化，监控装置对涂覆装置的状态数据进行界面显示；步骤S02：监控装置向涂覆装置发送上升/下降指令；步骤S03：涂覆装置的控制模块接收上升/下降指令，并通过角运动检测模块周期性采集涂覆装置的角运动数据；步骤S04：控制模块将涂覆装置上的升降控制位置预先设置为升降点，根据角运动数据和升降点进行调平计算以得到调平结果，并输出调平结果至涂覆装置的升降模块；步骤S05；升降模块接收调平结果进行调平，并返回状态数据至监控装置；步骤S06：监控装置接收返回的状态数据并更新界面显示。
所述的裸导线绝缘涂覆机器人***的升降控制方法，其中，所述升降点在涂覆装置上设置有四个并构成一个矩形平面作为参考坐标系。
所述的裸导线绝缘涂覆机器人***的升降控制方法，其中，所述角运动数据包括以矩形平面作为参考坐标系的Roll角、Pitch角。
所述的裸导线绝缘涂覆机器人***的升降控制方法，其中，所述调平算法具体如下：将Roll角、Pitch角进行叠加得到矩形平面的水平角度偏差量以计算四个升降点的调平偏差量；根据Roll角、Pitch角，通过PID计算分别得到四个升降点的升降速度值；根据四个升降点的调平偏差量和对应的升降速度值，计算得到四个升降点对应的调整速度值作为调平结果。
所述的裸导线绝缘涂覆机器人***的升降控制方法，其中，当升降模块没有返回状态数据或返回状态数据时发生错误，则丢弃该状态数据并返回步骤S03。
所述的裸导线绝缘涂覆机器人***的升降控制方法，其中，所述监控装置与涂覆装置之间采用无线通讯。
一种裸导线绝缘涂覆机器人***，其特征在于，包括监控装置和与监控装置通讯连接的涂覆装置；所述监控装置上设置有显示屏；所述涂覆装置包括机架、以及设置在机架上的涂覆模块、行走模块、控制模块、升降模块和角运动检测模块；所述裸导线绝缘涂覆机器人***执行如上所述的裸导线绝缘涂覆机器人***的升降控制方法。
有益效果：
本发明提供了一种裸导线绝缘涂覆机器人***及其升降控制方法，相比现有技术，通过设置升降点和周期性采集角运动数据，根据升降点和角运动数据进行调平计算得到调平结果，升降模块根据调平结果进行调平，通过对涂覆装置的平衡状态进行周期性的自动调整，从而保持涂覆装置在升降或下降过程中的动态平衡，无需人工调平，操作方便，便于挂载涂覆装置。
附图说明
图1为本发明一种裸导线绝缘涂覆机器人***的升降控制方法的步骤示意图。
图2为本发明所述矩形平面的说明示意图。
图3为本发明一种裸导线绝缘涂覆机器人***的结构示意图。
主要元件符号说明：100-升降点、200-矩形平面、300-监控装置、310-显示屏、400-涂覆装置、410-机架、420-涂覆模块、430-行走模块、440-控制模块、450-升降模块、451-牵引轮、452-升降电机、460-角运动检测模块。
具体实施方式
本发明提供一种裸导线绝缘涂覆机器人***及其升降控制方法，为使本发明的目的、技术方案及效果更加清楚、明确，以下参照附图并举实施例对本发明进一步详细说明。应当理解，此处所描述的具体实施例仅用以解释本发明，并不用于限定本发明的保护范围。
在本发明的描述中，需要说明的是，除非另有明确的规定和限定，术语“安装”、“相连”、“连接”应做广义理解，例如，可以是固定连接，也可以是可拆卸连接，或一体地连接；可以是机械连接，也可以是电连接或可以相互通讯；可以是直接连接，也可以通过中间媒介间接相连，可以是两个元件内部的连通或两个元件的相互作用关系。对于本领域的普通技术人员而言，可以根据具体情况理解上述术语在本发明中的具体含义。
请参阅图1，本发明提供一种裸导线绝缘涂覆机器人***的升降控制方法，包括以下步骤。
步骤SO1：对裸导线绝缘涂覆机器人***进行数据初始化，监控装置300对涂覆装置400的状态数据进行界面显示；通过对裸导线绝缘涂覆机器人***的数据初始化，避免旧数据影响***的正常工作。
步骤S02：监控装置300向涂覆装置400发送上升/下降指令，控制涂覆装置400工作。
步骤S03：涂覆装置400的控制模块440接收上升/下降指令，并通过角运动检测模块460周期性采集涂覆装置400的角运动数据，以用于实现涂覆装置400的动态平衡。需要说明的是，所述角运动检测装置，优选为陀螺仪，可测定pitch角、yaw角、roll角这三个欧拉角的角度值以及角加速度。
步骤S04：控制模块440将涂覆装置400上的升降控制位置预先设置为升降点100，根据角运动数据和升降点100进行调平计算以得到调平结果，并输出调平结果至涂覆装置400的升降模块450；
请参阅图2，在某些实施方式中，所述升降点100在涂覆装置400上设置有四个并构成一个矩形平面200作为参考坐标系。通过该设置，矩形平面200可分为前后轴、左右轴，便于进行调平计算。
进一步地，在某些实施方式中，所述角运动数据包括以矩形平面200作为参考坐标系的Roll角、Pitch角；其中，所述Roll角为矩形平面200绕X轴旋转的旋转角，所述Pitch角为矩形平面200绕Y轴旋转的旋转角。通过上述两个欧拉角，反映涂覆装置400在上升或下降过程中的平衡情况。
请参阅图2，具体地，在某些实施方式中，所述调平算法如下：将Roll角、Pitch角进行叠加得到矩形平面200的水平角度偏差量以计算四个升降点100的调平偏差量；根据Roll角、Pitch角，通过PID计算分别得到四个升降点100的升降速度值；根据四个升降点100的调平偏差量和对应的升降速度值，计算得到四个升降点100对应的调整速度值作为调平结果。
需要说明的是，所述PID计算包括比例计算、误差积分积累计算、微分角加速度计算。
步骤S05；升降模块450接收调平结果进行调平，并返回状态数据至监控装置300；升降模块450根据调平结果分别对四个升降点100的速度值进行调整，从而实现对涂覆装置400的平衡调整。同时，返回状态数据实现闭环控制，实现对涂覆装置400的升降状态的监控。
进一步地，在某些实施方式中，当升降模块450没有返回状态数据或返回状态数据时发生错误，即升降模块450未能接收或执行调平结果，则丢弃该状态数据并返回步骤S03，避免错误的状态数据影响***的正常工作，提高***的鲁棒性。
步骤S06：监控装置300接收返回的状态数据并更新界面显示；需要说明的是，涂覆装置400周期性采集角运动数据进行调平计算，监控装置300的界面显示的状态数据也随之周期性更新。
作为一种优选，所述监控装置300与涂覆装置400之间采用无线通讯，便于操作人员通过监控装置300远程控制和监控涂覆装置400的工作状态。
请参阅图1，本发明还提供了一种裸导线绝缘涂覆机器人***，包括监控装置300和与监控装置300通讯连接的涂覆装置400；所述监控装置300上设置有显示屏310；所述涂覆装置400包括机架410、以及设置在机架410上的涂覆模块420、行走模块430、控制模块440、升降模块450和角运动检测模块460；所述裸导线绝缘涂覆机器人***执行如上所述的裸导线绝缘涂覆机器人***的升降控制方法；由于上文对该裸导线绝缘涂覆机器人***的升降控制方法进行了详细的描述，此处不再赘述。
需要说明的是，所述控制模块440可选为MCU单元或PLC单元，若采用单片机控制，单片机的型号优选为STM32系列。
请参阅图1-3，为便于理解本发明，以上述***为例，在本实施方式，所述控制模块440包括四组对称设置的牵引轮451和升降电机452，所述牵引轮451的位置为升降控制位置，即升降点100；当涂覆装置400在上升或下降过程中，即使升降电机452的型号相同，升降速度仍然会存在差别，涂覆装置400的角运动会产生变化；角运动检测模块460周期性采集角运动数据，控制模块440根据角运动数据和升降点100的位置来计算出调平结果，升降模块450根据调平结果对四个升降电机452的升降速度和旋转方向进行周期性调整，从而实现涂覆装置400在上升或下降过程中的自动动态平衡。同时，操作人员可根据返回的状态数据对涂覆装置400进行监控，该状态数据可包括：四个电机的升降速度、涂覆装置400的Roll角和Pitch角等。
综上所述，本发明通过上述的升降控制方法，实现对涂覆装置400的平衡状态的自动调整，使涂覆装置400维持动态平衡，无需人工调控，使用方便，便于挂载。
可以理解的是，对本领域普通技术人员来说，可以根据本发明的技术方案及其发明构思加以等同替换或改变，而所有这些改变或替换都应属于本发明的保护范围。
Claims (4)
1.一种裸导线绝缘涂覆机器人***的升降控制方法，其特征在于，包括以下步骤：
步骤SO1：对裸导线绝缘涂覆机器人***进行数据初始化，监控装置对涂覆装置的状态数据进行界面显示；
步骤S02：监控装置向涂覆装置发送上升/下降指令；
步骤S03：涂覆装置的控制模块接收上升/下降指令，并通过角运动检测模块周期性采集涂覆装置的角运动数据；
步骤S04：控制模块将涂覆装置上的升降控制位置预先设置为升降点，根据角运动数据和升降点进行调平计算以得到调平结果，并输出调平结果至涂覆装置的升降模块；
步骤S05；升降模块接收调平结果进行调平，并返回状态数据至监控装置；
步骤S06：监控装置接收返回的状态数据并更新界面显示；
所述升降点在涂覆装置上设置有四个并构成一个矩形平面作为参考坐标系；
所述角运动数据包括以矩形平面作为参考坐标系的Roll角、Pitch角；
所述调平计算具体如下：将Roll角、Pitch角进行叠加得到矩形平面的水平角度偏差量以计算四个升降点的调平偏差量；根据Roll角、Pitch角，通过PID计算分别得到四个升降点的升降速度值；根据四个升降点的调平偏差量和对应的升降速度值，计算得到四个升降点对应的调整速度值作为调平结果。
2.根据权利要求1所述的裸导线绝缘涂覆机器人***的升降控制方法，其特征在于，当升降模块没有返回状态数据或返回状态数据时发生错误，则丢弃该状态数据并返回步骤S03。
3.根据权利要求1所述的裸导线绝缘涂覆机器人***的升降控制方法，其特征在于，所述监控装置与涂覆装置之间采用无线通讯。
4.一种裸导线绝缘涂覆机器人***，其特征在于，包括监控装置和与监控装置通讯连接的涂覆装置；所述监控装置上设置有显示屏；所述涂覆装置包括机架、以及设置在机架上的涂覆模块、行走模块、控制模块、升降模块和角运动检测模块；所述裸导线绝缘涂覆机器人***执行如权利要求1-3任一项所述的裸导线绝缘涂覆机器人***的升降控制方法。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201911218497.3A CN110928337B (zh) | 2019-12-03 | 2019-12-03 | 一种裸导线绝缘涂覆机器人***及其升降控制方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201911218497.3A CN110928337B (zh) | 2019-12-03 | 2019-12-03 | 一种裸导线绝缘涂覆机器人***及其升降控制方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN110928337A CN110928337A (zh) | 2020-03-27 |
| CN110928337B true CN110928337B (zh) | 2020-08-18 |
Family
ID=69848440
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201911218497.3A Active CN110928337B (zh) | 2019-12-03 | 2019-12-03 | 一种裸导线绝缘涂覆机器人***及其升降控制方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN110928337B (zh) |
Families Citing this family (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN111844079B (zh) * | 2020-08-03 | 2021-05-14 | 国网山东省电力公司德州市陵城区供电公司 | 一种紧急救援的电力巡检智能机器人 |
Family Cites Families (30)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS61239305A (ja) * | 1985-04-16 | 1986-10-24 | Ishikawajima Harima Heavy Ind Co Ltd | 自走台車位置誤差修正方法 |
| JP3078202B2 (ja) * | 1995-05-10 | 2000-08-21 | 日立造船株式会社 | 多関節ロボットの塗装姿勢制御方法 |
| US6905546B2 (en) * | 2002-10-23 | 2005-06-14 | Acco Systems, Inc. | Conveyor and powder paint collection and method |
| MXPA03005530A (es) * | 2003-06-17 | 2003-09-23 | Coraza Ind S A De C V | Metodo y aparato para la fabricacion de molduras decorativas. |
| CN101229908B (zh) * | 2007-01-25 | 2010-05-19 | 中国国际海运集装箱(集团)股份有限公司 | 固定式升降台及其自动调平方法 |
| DE102009012140A1 (de) * | 2009-03-06 | 2010-09-09 | Dürr Systems GmbH | Roboteranordnung, insbesondere in einer Lackierkabine |
| CN101866184A (zh) * | 2009-04-16 | 2010-10-20 | 上海派芬自动控制技术有限公司 | 吊篮调平控制*** |
| CN101639701A (zh) * | 2009-07-31 | 2010-02-03 | 零八一电子集团有限公司 | 多点智能调平控制操控*** |
| CN101995885B (zh) * | 2009-08-18 | 2014-07-09 | 派芬自控（上海）股份有限公司 | 一种底盘调平***及方法 |
| CN102278989B (zh) * | 2011-07-29 | 2014-02-26 | 北京航空航天大学 | 一种多功能航空遥感三轴惯性稳定平台*** |
| CN102541093A (zh) * | 2012-01-30 | 2012-07-04 | 中联重科股份有限公司 | 一种工程机械的控制***及高空车平台的自动调平*** |
| CN202563981U (zh) * | 2012-04-18 | 2012-11-28 | 山西省电力公司太原供电分公司 | 架空裸导线绝缘化喷涂装置 |
| CN102808502B (zh) * | 2012-08-27 | 2017-09-29 | 维和泰隆（北京）科技有限公司 | 高效铺设建筑面层的自动化智能设备及其铺设方法 |
| CN103292127B (zh) * | 2013-05-20 | 2014-12-10 | 哈尔滨工业大学 | 多轴支撑气浮平台的测量控制*** |
| CN103362885A (zh) * | 2013-07-24 | 2013-10-23 | 华电重工股份有限公司 | 多平台多缸协同自动调平方法 |
| CN104699119B (zh) * | 2015-01-21 | 2017-06-20 | 哈尔滨工程大学 | 一种装载平台及装载物的水平调节控制方法 |
| WO2016172162A1 (en) * | 2015-04-20 | 2016-10-27 | Darisse Ian J | Articulated robotic probes |
| CN105183006A (zh) * | 2015-08-24 | 2015-12-23 | 安徽农业大学 | 用于工作台的测平和调平装置 |
| CN106679614A (zh) * | 2015-11-06 | 2017-05-17 | 北京卫星环境工程研究所 | 具有自动调平装置的电子经纬仪 |
| CN206011057U (zh) * | 2016-07-14 | 2017-03-15 | 青岛金光鸿智能机械电子有限公司 | 导轨对接装置 |
| CN206003561U (zh) * | 2016-08-30 | 2017-03-08 | 安徽美通电力科技有限公司 | 一种用于电线的端头标记装置 |
| CN209093676U (zh) * | 2018-04-05 | 2019-07-12 | 广东冠能电力科技发展有限公司 | 一种稳定的挤压型架高裸导线绝缘涂覆机器人 |
| CN208865809U (zh) * | 2018-04-05 | 2019-05-17 | 广东冠能电力科技发展有限公司 | 一种喷头可调的导线喷涂装置用喷涂结构 |
| CN208622508U (zh) * | 2018-05-18 | 2019-03-19 | 中科开创（广州）智能科技发展有限公司 | 一种用于架空裸导线绝缘化施工机器人的喷胶头 |
| CN109066498B (zh) * | 2018-08-02 | 2019-05-03 | 广东冠能电力科技发展有限公司 | 机器人自动涂覆绝缘材料的方法 |
| CN109094673B (zh) * | 2018-09-20 | 2021-06-18 | 成都山神轨道交通设备有限公司 | 一种平台式履带爬楼车及自动调平方法 |
| CN109202934A (zh) * | 2018-10-26 | 2019-01-15 | 山东金惠新达智能制造科技有限公司 | 地面巡检机器人升降装置、升降方法及地面巡检机器人 |
| CN209372855U (zh) * | 2018-12-27 | 2019-09-10 | 深圳市哥拜尔涂料股份有限公司 | 一种测量涂料湿膜固体份的装置 |
| CN109969980A (zh) * | 2019-03-12 | 2019-07-05 | 中国南方电网有限责任公司超高压输电公司贵阳局 | 一种高空竖直升降用机械手 |
| CN110026309B (zh) * | 2019-03-12 | 2021-06-29 | 中国南方电网有限责任公司超高压输电公司贵阳局 | 一种变电站用支柱绝缘子rtv涂料智能喷涂机器人 |
-
2019
- 2019-12-03 CN CN201911218497.3A patent/CN110928337B/zh active Active
Also Published As
| Publication number | Publication date |
|---|---|
| CN110928337A (zh) | 2020-03-27 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN110928337B (zh) | 一种裸导线绝缘涂覆机器人***及其升降控制方法 | |
| CN105691613A (zh) | 一种平稳升降的无人机装置及控制方法 | |
| JP2016524892A (ja) | 車両制御装置および車両制御方法 | |
| US20180093868A1 (en) | Anti-sway crane control method with a third-order filter | |
| CN109607301A (zh) | 智能电网巡检设备搭载平台 | |
| CN104283153A (zh) | 旋翼式跨越障碍的输电线路巡检行走机构 | |
| CN111114292A (zh) | 一种静音机器的底盘结构 | |
| CN111376976A (zh) | 一种可适用于不平整地面的移动机器人底盘及其控制方法 | |
| CN111947523B (zh) | 一种用于火箭垂直度全自动调整的控制***及控制方法 | |
| CN109443641A (zh) | 一种快速调校飞机水平的***及方法 | |
| CN114906737A (zh) | 吊钩姿态调整***、方法、塔机起重机 | |
| CN216890001U (zh) | 一种绝缘斗臂车的遥控装置 | |
| CN106895813B (zh) | 一种输电线路架空导线弧垂测量装置及其测量方法 | |
| CN108709479A (zh) | 一种货叉高度监测装置 | |
| CN209455827U (zh) | 智能电网巡检设备搭载平台 | |
| CN210426494U (zh) | 一种离子交换膜厚度检测装置 | |
| CN111501299A (zh) | 一种电器及其底座*** | |
| CN110618358A (zh) | 飞行上下线绝缘子串检测机器人***、平台及方法 | |
| CN208044318U (zh) | 一种多旋翼无人机***中pid平衡调试装置 | |
| CN113565357A (zh) | 一种垂直停车设备用安全防护*** | |
| CN113446491B (zh) | 一种顶板支撑反向自动调平装置及其方法 | |
| CN107902547B (zh) | 全自动水文测量吊箱 | |
| CN110171513A (zh) | 一种双轮自平衡车 | |
| CN108382995B (zh) | 一种舞台用可调节平衡吊杆的操作方法 | |
| CN216700171U (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 | ||
| GR01 | Patent grant | ||
| GR01 | Patent grant |