CN109846411A - 一种攀爬支撑臂扬角控制系统 - Google Patents
一种攀爬支撑臂扬角控制系统 Download PDFInfo
- Publication number
- CN109846411A CN109846411A CN201811628969.8A CN201811628969A CN109846411A CN 109846411 A CN109846411 A CN 109846411A CN 201811628969 A CN201811628969 A CN 201811628969A CN 109846411 A CN109846411 A CN 109846411A
- Authority
- CN
- China
- Prior art keywords
- module
- output end
- electrically connected
- angle
- climbing
- 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.)
- Granted
Links
Abstract
本发明公开了一种攀爬支撑臂扬角控制系统，包括主控制器，所述主控制器的输出端电性连接有参数设置模块，所述主控制器的输出端电性连接有程序执行模块，所述主控制器的输出端电性连接有执行检测模块，所述程序执行模块的输出端电性连接有轨迹规划模块，所述轨迹规划模块的输出端电性连接有轨迹控制模块。本发明通过逻辑检测模块和轨迹检测模块对攀爬清洁机器人攀爬轨迹进行检测，当攀爬清洁机器人发生状况时，能快速的做出判断，且通过倾斜角度计算和分析模块和高度计算模块对攀爬清洁机器人攀爬的实际高度和支撑臂扬角的实际倾斜角度与参数设置模块设置的运行轨迹进行对比和计算，从而减小了误差，提高了攀爬清洁机器人的使用效果。
Description
技术领域
本发明涉及攀爬扬角控制系统技术领域，具体为一种攀爬支撑臂扬角控制系统。
背景技术
随着社会经济的发展，人们对安全意识越来越重视，例如：高楼玻璃清洁，现使用攀爬清洁机器人代替人工清洁，大大降低了清洁的难度。
然而现有的攀爬清洁机器人对支撑臂的控制较为局限，且覆盖范围较小，从而降低了清洁的效果，且现有的攀爬清洁机器人在使用的过程中无法对攀爬轨迹进行检测，当攀爬清洁机器人发生状况时，不能快速的做出判断，且现有的攀爬清洁机器人在运行的过程中容易与预先设定好的数值存在一定的误差，从而降低了攀爬清洁机器人的使用效果。
发明内容
本发明的目的在于提供一种攀爬支撑臂扬角控制系统，以解决上述背景技术中提出的问题。
为实现上述目的，本发明提供如下技术方案：一种攀爬支撑臂扬角控制系统，包括主控制器，所述主控制器的输出端电性连接有参数设置模块，所述主控制器的输出端电性连接有程序执行模块，所述主控制器的输出端电性连接有执行检测模块，所述程序执行模块的输出端电性连接有轨迹规划模块，所述轨迹规划模块的输出端电性连接有轨迹控制模块，所述轨迹规划模块的输出端电性连接有逻辑控制模块，所述轨迹控制模块和逻辑控制模块的输出端皆电性连接有第一单片机，所述轨迹控制模块和逻辑控制模块的输出端皆电性连接有第二单片机，所述第一单片机的输出端电性连接有俯角轨迹控制模块，所述第一单片机的输出端电性连接有仰角轨迹控制模块，所述执行检测模块的输出端电性连接有数据采集模块，所述数据采集模块的输出端电性连接有逻辑检测模块，所述数据采集模块的输出端电性连接有轨迹检测模块。
优选地，所述俯角轨迹控制模块和仰角轨迹控制模块的输出端电性连接有倾斜角度计算和分析模块，且倾斜角度计算和分析模块的输出端电性连接有对比模块,所述对比模块的输出端与主控制器的输入端电性连接。
优选地，所述第一单片机和第二单片机的输出端皆与逻辑检测模块的输入端电性连接，所述第一单片机和第二单片机的输出端皆与轨迹检测模块的输入端电性连接。
优选地，所述第二单片机的输出端电性连接有上下攀爬控制模块，所述上下攀爬控制模块的输出端电性连接有高度计算模块，所述高度计算模块的输出端与对比模块的输入端电性连接。
优选地，所述轨迹控制模块和逻辑控制模块的输出端皆与第一单片机和第二单片机的输入端电性连接。
优选地，所述参数设置模块的输出端与对比模块的输入端电性连接。
与现有技术相比，本发明的有益效果是：本发明通过第一单片机对攀爬清洁机器人的俯角轨迹和仰角轨迹进行统一控制，同时通过第二单片机对攀爬清洁机器人上下攀爬的高度进行控制，从而使攀爬清洁机器人的控制更为全面，且覆盖范围更大，从而提高了清洁的效果，且通过逻辑检测模块和轨迹检测模块对攀爬清洁机器人攀爬轨迹进行检测，当攀爬清洁机器人发生状况时，能快速的做出判断，且通过倾斜角度计算和分析模块和高度计算模块对攀爬清洁机器人攀爬的实际高度和支撑臂扬角的实际倾斜角度与参数设置模块设置的运行轨迹进行对比和计算，从而减小了误差，提高了攀爬清洁机器人的使用效果。
附图说明
图1为本发明的系统流程图。
具体实施方式
下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本发明一部分实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都属于本发明保护的范围。
请参阅图1，本发明提供的一种实施例：一种攀爬支撑臂扬角控制系统，包括主控制器(型号为KTJl5B)，主控制器的输出端电性连接有参数设置模块，主控制器的输出端电性连接有程序执行模块(型号为STEP7)，主控制器的输出端电性连接有执行检测模块(型号为GS100-N)，程序执行模块的输出端电性连接有轨迹规划模块(型号为ROS)，轨迹规划模块的输出端电性连接有轨迹控制模块(型号为GE-X00-SV)，轨迹规划模块的输出端电性连接有逻辑控制模块(型号为445L-P4X1440YD)，轨迹控制模块和逻辑控制模块的输出端皆电性连接有第一单片机(型号为MCS-51)，轨迹控制模块和逻辑控制模块的输出端皆电性连接有第二单片机(型号为MCS-51)，第一单片机的输出端电性连接有俯角轨迹控制模块(型号为GY-25)，第一单片机的输出端电性连接有仰角轨迹控制模块(型号为GY-25)，执行检测模块的输出端电性连接有数据采集模块(型号为DTGS)，数据采集模块的输出端电性连接有逻辑检测模块(型号为HDL-MCL)，数据采集模块的输出端电性连接有轨迹检测模块(型号为6FX2001-5)。
本发明通过参数设置模块对攀爬清洁机器人需要运行的轨迹进行预设，然后通过程度执行模块对预设的参数进行整理和分析，然后通过轨迹规划模块对预设的参数进行轨迹设定，通过第二单片机对攀爬清洁机器人上下攀爬的高度进行控制，从而使攀爬清洁机器人的控制更为全面，且覆盖范围更大，从而提高了清洁的效果，且通过逻辑检测模块和轨迹检测模块对攀爬清洁机器人攀爬轨迹进行检测，当攀爬清洁机器人发生状况时，能快速的做出判断。
请着重参详附图1，俯角轨迹控制模块和仰角轨迹控制模块的输出端电性连接有倾斜角度计算和分析模块，且倾斜角度计算和分析模块的输出端电性连接有对比模块,对比模块的输出端与主控制器的输入端电性连接。
该种攀爬支撑臂扬角控制系统通过倾斜角度计算和分析模块对俯角轨迹控制模块和仰角轨迹控制模块实际的倾斜角度进行计算，并通过对比模块对支撑臂实际的倾斜角度和参数设置模块原设置的参数进行对比，从而更好的减小误差，使该种攀爬支撑臂扬角控制系统的使用效果更好。
请着重参详附图1，第一单片机和第二单片机的输出端皆与逻辑检测模块的输入端电性连接，第一单片机和第二单片机的输出端皆与轨迹检测模块的输入端电性连接。
该种攀爬支撑臂扬角控制系统通过逻辑检测模块对第一单片机和第二单片机运行的逻辑范围进行检测，从而避免了出现逻辑错误，且通过轨迹检测模块对第一单片机和第二单片机运行的轨迹进行检测，从而避免了运行中发生轨迹错误，从而使该种攀爬支撑臂扬角控制系统的使用效果更好。
请着重参详附图1，第二单片机的输出端电性连接有上下攀爬控制模块，上下攀爬控制模块的输出端电性连接有高度计算模块，高度计算模块的输出端与对比模块的输入端电性连接。
该种攀爬支撑臂扬角控制系统通过对攀爬清洁机器人运行的实际高度进行检测，且通过对比模块使实际运行的高度与参数设备模块预先设置的高度进行对比，从而减小了误差，使工作人员更直观的观测到攀爬清洁机器人实际的爬升范围。
请着重参详附图1，轨迹控制模块和逻辑控制模块的输出端皆与第一单片机和第二单片机的输入端电性连接，参数设置模块的输出端与对比模块的输入端电性连接。
该种攀爬支撑臂扬角控制系统通过轨迹控制模块和逻辑控制模块更好的控制第一单片机和第二单片机运行，通过第一单片机和第二单片机带动攀爬清洁机器人运行，从而使该种攀爬支撑臂扬角控制系统对攀爬清洁机器人的控制效果更好，控制更为全面。
工作原理：使用时，先通过参数设置模块对攀爬清洁机器人需要运行的轨迹进行预设，然后通过程度执行模块对预设的参数进行整理和分析，然后通过轨迹规划模块对预设的参数进行轨迹设定，同时在轨迹控制模块和逻辑控制模块和相互配合下带动第一单片机和第二单片机向攀爬清洁机器人发生指令信号，控制攀爬清洁机器人运行，且攀爬清洁机器人在运行的过程中俯角轨迹模块控制支撑臂向下倾斜的角度，仰角轨迹控制模块控制支撑臂向上倾斜的角度，从而更好的对攀爬清洁机器人支撑臂的扬角进行控制，然后通过倾斜角度计算和分析模块调度攀爬清洁机器人实际倾斜的角度，并经过对比模块将实际倾斜的角度与预设的参数进行对比和计算，从而减小了误差。
对于本领域技术人员而言，显然本发明不限于上述示范性实施例的细节，而且在不背离本发明的精神或基本特征的情况下，能够以其他的具体形式实现本发明。因此，无论从哪一点来看，均应将实施例看作是示范性的，而且是非限制性的，本发明的范围由所附权利要求而不是上述说明限定，因此旨在将落在权利要求的等同要件的含义和范围内的所有变化囊括在本发明内。不应将权利要求中的任何附图标记视为限制所涉及的权利要求。
Claims (6)
1.一种攀爬支撑臂扬角控制系统，包括主控制器，其特征在于：所述主控制器的输出端电性连接有参数设置模块，所述主控制器的输出端电性连接有程序执行模块，所述主控制器的输出端电性连接有执行检测模块，所述程序执行模块的输出端电性连接有轨迹规划模块，所述轨迹规划模块的输出端电性连接有轨迹控制模块，所述轨迹规划模块的输出端电性连接有逻辑控制模块，所述轨迹控制模块和逻辑控制模块的输出端皆电性连接有第一单片机，所述轨迹控制模块和逻辑控制模块的输出端皆电性连接有第二单片机，所述第一单片机的输出端电性连接有俯角轨迹控制模块，所述第一单片机的输出端电性连接有仰角轨迹控制模块，所述执行检测模块的输出端电性连接有数据采集模块，所述数据采集模块的输出端电性连接有逻辑检测模块，所述数据采集模块的输出端电性连接有轨迹检测模块。
2.根据权利要求1所述的一种攀爬支撑臂扬角控制系统，其特征在于：所述俯角轨迹控制模块和仰角轨迹控制模块的输出端电性连接有倾斜角度计算和分析模块，且倾斜角度计算和分析模块的输出端电性连接有对比模块,所述对比模块的输出端与主控制器的输入端电性连接。
3.根据权利要求1所述的一种攀爬支撑臂扬角控制系统，其特征在于：所述第一单片机和第二单片机的输出端皆与逻辑检测模块的输入端电性连接，所述第一单片机和第二单片机的输出端皆与轨迹检测模块的输入端电性连接。
4.根据权利要求2所述的一种攀爬支撑臂扬角控制系统，其特征在于：所述第二单片机的输出端电性连接有上下攀爬控制模块，所述上下攀爬控制模块的输出端电性连接有高度计算模块，所述高度计算模块的输出端与对比模块的输入端电性连接。
5.根据权利要求1所述的一种攀爬支撑臂扬角控制系统，其特征在于：所述轨迹控制模块和逻辑控制模块的输出端皆与第一单片机和第二单片机的输入端电性连接。
6.根据权利要求2所述的一种攀爬支撑臂扬角控制系统，其特征在于：所述参数设置模块的输出端与对比模块的输入端电性连接。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201811628969.8A CN109846411B (zh) | 2018-12-28 | 2018-12-28 | 一种攀爬支撑臂扬角控制系统 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201811628969.8A CN109846411B (zh) | 2018-12-28 | 2018-12-28 | 一种攀爬支撑臂扬角控制系统 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN109846411A true CN109846411A (zh) | 2019-06-07 |
| CN109846411B CN109846411B (zh) | 2020-12-29 |
Family
ID=66893056
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201811628969.8A Active CN109846411B (zh) | 2018-12-28 | 2018-12-28 | 一种攀爬支撑臂扬角控制系统 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN109846411B (zh) |
Citations (18)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN101603826A (zh) * | 2009-07-06 | 2009-12-16 | 三一重工股份有限公司 | 一种倾角传感器及倾角控制系统 |
| CN102183963A (zh) * | 2011-01-26 | 2011-09-14 | 徐州赫思曼电子有限公司 | 一种高空作业平台的工作轨迹控制方法 |
| CN102722956A (zh) * | 2012-06-19 | 2012-10-10 | 宝钢发展有限公司 | 智能扫描红外测温报警装置及方法 |
| CN102987976A (zh) * | 2012-12-25 | 2013-03-27 | 平湖普英特高层设备有限公司 | 擦窗机 |
| CN203244337U (zh) * | 2012-12-25 | 2013-10-23 | 平湖普英特高层设备有限公司 | 一种擦窗机 |
| CN103568011A (zh) * | 2012-07-20 | 2014-02-12 | 精工爱普生株式会社 | 控制系统、程序以及机械装置的控制方法 |
| CN105500331A (zh) * | 2015-12-31 | 2016-04-20 | 上海灿星文化传播有限公司 | 多用途智能摄像机器人 |
| WO2016103302A1 (ja) * | 2014-12-26 | 2016-06-30 | 川崎重工業株式会社 | 双腕ロボット |
| CN106491040A (zh) * | 2016-11-14 | 2017-03-15 | 浙江工业大学 | 一种摆动式擦窗机器人玻璃边缘触碰检测处理方法 |
| CN206096952U (zh) * | 2016-10-14 | 2017-04-12 | 天津城建大学 | 一种高精度跟踪式太阳辐射光热一体化检测装置 |
| CN106625687A (zh) * | 2016-10-27 | 2017-05-10 | 安徽马钢自动化信息技术有限公司 | 一种关节机器人运动学建模方法 |
| CN107616742A (zh) * | 2016-07-14 | 2018-01-23 | 南京海益开电子科技有限公司 | 一种幕墙无人清洁主机控制系统 |
| DE102016221734A1 (de) * | 2016-11-07 | 2018-05-09 | Dr. Ing. H.C. F. Porsche Aktiengesellschaft | Verfahren zur Feinausrichtung von Roboterwerkzeugen |
| CN207387637U (zh) * | 2017-07-04 | 2018-05-22 | 江苏苏萨食品有限公司 | 一种整箱搬运机械手臂 |
| CN108582074A (zh) * | 2018-05-09 | 2018-09-28 | 深圳新物种科技有限公司 | 机器人、机器人控制方法及装置 |
| CN108858121A (zh) * | 2018-07-27 | 2018-11-23 | 国网江苏省电力有限公司徐州供电分公司 | 带电作业机器人及其控制方法 |
| US20180362270A1 (en) * | 2013-05-17 | 2018-12-20 | Intelligrated Headquarters, Llc | Robotic carton unloader |
| CN109044181A (zh) * | 2018-08-14 | 2018-12-21 | 广东宝乐机器人股份有限公司 | 一种擦窗机器人的行走控制方法和行走控制装置 |
-
2018
- 2018-12-28 CN CN201811628969.8A patent/CN109846411B/zh active Active
Patent Citations (18)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN101603826A (zh) * | 2009-07-06 | 2009-12-16 | 三一重工股份有限公司 | 一种倾角传感器及倾角控制系统 |
| CN102183963A (zh) * | 2011-01-26 | 2011-09-14 | 徐州赫思曼电子有限公司 | 一种高空作业平台的工作轨迹控制方法 |
| CN102722956A (zh) * | 2012-06-19 | 2012-10-10 | 宝钢发展有限公司 | 智能扫描红外测温报警装置及方法 |
| CN103568011A (zh) * | 2012-07-20 | 2014-02-12 | 精工爱普生株式会社 | 控制系统、程序以及机械装置的控制方法 |
| CN102987976A (zh) * | 2012-12-25 | 2013-03-27 | 平湖普英特高层设备有限公司 | 擦窗机 |
| CN203244337U (zh) * | 2012-12-25 | 2013-10-23 | 平湖普英特高层设备有限公司 | 一种擦窗机 |
| US20180362270A1 (en) * | 2013-05-17 | 2018-12-20 | Intelligrated Headquarters, Llc | Robotic carton unloader |
| WO2016103302A1 (ja) * | 2014-12-26 | 2016-06-30 | 川崎重工業株式会社 | 双腕ロボット |
| CN105500331A (zh) * | 2015-12-31 | 2016-04-20 | 上海灿星文化传播有限公司 | 多用途智能摄像机器人 |
| CN107616742A (zh) * | 2016-07-14 | 2018-01-23 | 南京海益开电子科技有限公司 | 一种幕墙无人清洁主机控制系统 |
| CN206096952U (zh) * | 2016-10-14 | 2017-04-12 | 天津城建大学 | 一种高精度跟踪式太阳辐射光热一体化检测装置 |
| CN106625687A (zh) * | 2016-10-27 | 2017-05-10 | 安徽马钢自动化信息技术有限公司 | 一种关节机器人运动学建模方法 |
| DE102016221734A1 (de) * | 2016-11-07 | 2018-05-09 | Dr. Ing. H.C. F. Porsche Aktiengesellschaft | Verfahren zur Feinausrichtung von Roboterwerkzeugen |
| CN106491040A (zh) * | 2016-11-14 | 2017-03-15 | 浙江工业大学 | 一种摆动式擦窗机器人玻璃边缘触碰检测处理方法 |
| CN207387637U (zh) * | 2017-07-04 | 2018-05-22 | 江苏苏萨食品有限公司 | 一种整箱搬运机械手臂 |
| CN108582074A (zh) * | 2018-05-09 | 2018-09-28 | 深圳新物种科技有限公司 | 机器人、机器人控制方法及装置 |
| CN108858121A (zh) * | 2018-07-27 | 2018-11-23 | 国网江苏省电力有限公司徐州供电分公司 | 带电作业机器人及其控制方法 |
| CN109044181A (zh) * | 2018-08-14 | 2018-12-21 | 广东宝乐机器人股份有限公司 | 一种擦窗机器人的行走控制方法和行走控制装置 |
Also Published As
| Publication number | Publication date |
|---|---|
| CN109846411B (zh) | 2020-12-29 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN106556761B (zh) | 一种应用于现场的直流充电桩检测系统及方法 | |
| CN105465971A (zh) | 一种空气净化器系统 | |
| CN101835178B (zh) | 一种实现远程无线监测的方法及无线监测装置 | |
| CN205536374U (zh) | 一种空气净化器系统 | |
| CN107015566A (zh) | 一种基于LabVIEW的多机器人检测系统 | |
| CN207308479U (zh) | 一种可自动除尘的激光雷达 | |
| CN110084158A (zh) | 一种基于智能算法的用电设备识别方法 | |
| CN110960150B (zh) | 清洁机器人及其控制方法和控制装置 | |
| CN102589901A (zh) | 一种电动车窗升降试验台及试验方法 | |
| CN102433911B (zh) | 一种采用挖掘机在线故障诊断系统进行故障诊断的方法 | |
| CN108008716A (zh) | 便携式电动汽车整车控制器检测装置及其检测方法 | |
| CN103853141A (zh) | 风机塔筒焊缝自动检测爬壁机器人控制系统 | |
| CN107222164B (zh) | 高控制化高智能化太阳能光伏组件运维方法 | |
| CN109846411A (zh) | 一种攀爬支撑臂扬角控制系统 | |
| WO2016015637A1 (zh) | 光伏空调系统及其性能检测方法和性能检测装置 | |
| CN204556816U (zh) | 一种电能表通信调试器 | |
| CN106598026B (zh) | 输变电设备状态检修时间检测方法和装置 | |
| CN203758572U (zh) | 数字量输出的液面检测装置 | |
| CN206075033U (zh) | 一种基于防误闭锁的智能变电站顺控调试仿真设备 | |
| CN205405114U (zh) | 具有远程维护功能的智能化养殖控制系统 | |
| CN202583156U (zh) | 无线室内空气质量监测装置 | |
| CN114992150A (zh) | 燃煤电站风机失速的预警方法、装置及存储介质 | |
| CN108956546A (zh) | 一种基于浊度检测的医疗器械清洗系统及方法 | |
| CN108055294A (zh) | 一种感应加热成套设备远程智能监控与诊断系统 | |
| CN203909585U (zh) | 一种基于canopen总线的上片控制系统 |
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 |