一种用于墙面抹灰机器人的垂直度测量与补偿系统及方法
【技术领域】
[0001] 本发明属于建筑机器人领域，尤其设及一种用于墙面抹灰机器人的垂直度测量与 补偿系统及方法，其能够精确的测量墙面抹灰机器人与竖直方向的偏差，并根据测量结果， 规划抹灰机器人的运动路径，达到补偿垂直度偏差的目的。
【背景技术】
[0002] 目前，刷墙机或者墙面抹灰机是利用两根平行的撑杆，将墙面抹灰机轨道固定于 天花板与地面之间，抹灰机顺着撑杆由下往上进行抹灰，到达顶部之后抹灰板翻转，再由上 往下进行抹平抹光。所W，两平行撑杆固定的空间位置，决定了墙面抹灰的上下厚度是否均 匀。但是由于地面不平整或者撑杆连接处不紧密，就有可能导致撑杆不是完全竖直，即两撑 杆构成的平面不能完全平行于待粉刷的墙面。若测量不准确或者没有进行处理，就有可能 导致粉刷后的墙面达不到厚度均匀的要求，造成返工的后果。
[0003] 目前对于垂直度的测量，可采用直接测量的方法，直接测量方法一般采用倾角仪、 巧螺仪、加速度传感器等传感器进行测量，但该些垂直度测量的传感器精度都较低，而且随 着精度要求的提高，传感器的成本也会随之增加。另外，还可W采用基于图像处理技术的间 接测量垂直度的方法，该方法需要在测量机构上增加摄像头，对于处理器的处理速度要求 较高，而且整个系统的成本也较高。
[0004] 墙面抹灰机器人抹灰作业环境非常恶劣，充满了灰尘、砂浆W及抹灰过程中电动 机运转带来的振动，该使得对于检测传感器的抗干扰能力W及检测方法的有效性都有着很 高的要求，比如倾角仪、巧螺仪都无法在该些环境中直接应用；对于基于图像处理的方法， 振动对于摄像头的干扰W及灰浆和灰尘对于采集图像的污染无法避免且难W处理。按照 《抹灰工程施工质量验收规范》的要求并考虑墙面抹灰机器人实际应用情况，W高度为=米 的墙面计算，垂直度的最低检测要求是在0.oor之内，该是普通传感器无法达到的。
【发明内容】
[0005] 为了尽可能的减小机器抹灰过程中由于两平行撑杆固定位置造成的误差，降低测 量成本，本发明提供一种用于墙面抹灰机器人的垂直度测量与补偿系统及方法，本发明不 仅能够精确测量抹灰机器人撑杆的垂直度，而且还能够基于测量结果，进行补偿调整，W减 小垂直度偏差所带来的影响，并且本发明仅仅只需要两个激光测距传感器，将测量成本降 到了最低。
[0006] 为了解决上述技术问题，根据本发明的一方面，提出了一种用于墙面抹灰机器人 的垂直度测量与补偿系统，该系统包括：墙面抹灰机器人、第一撑杆和第二撑杆，其中：
[0007] 所述第一撑杆和第二撑杆放置在作业空间中的天花板与地面之间，用于固定工作 过程中的墙面抹灰机器人；
[000引所述墙面抹灰机器人放置在所述第一撑杆和第二撑杆之间，沿着所述第一撑杆和 第二撑杆形成的轨道进行墙面抹灰作业；
[0009] 其中，所述墙面抹灰机器人朝向墙面的一侧安装有抹灰板，所述抹灰板的后端连 接有可伸缩调节的丝杠，所述抹灰板可根据丝杠的伸缩而伸缩；
[0010] 所述墙面抹灰机器人垂直于墙面的两侧面分别安装有第一激光测距传感器和第 二激光测距传感器；
[0011] 所述墙面抹灰机器人的一侧面上安装有磁编码器。
[0012] 根据本发明的另一方面，还提出一种用于墙面抹灰机器人的垂直度测量与补偿方 法，该方法包括W下步骤：
[0013] 步骤1，在作业空间中的天花板与地面之间固定放置第一撑杆和第二撑杆，将墙面 抹灰机器人放置在所述第一撑杆和第二撑杆之间的初始作业点处；
[0014] 步骤2,所述墙面抹灰机器人沿着所述第一撑杆和第二撑杆形成的轨道第一次由 地面上升到天花板，进行待刷墙面抹灰作业，并在第一次上升过程中，利用第一激光测距传 感器和第二激光测距传感器分别测量两个处于不同高度位置的标记点处所述墙面抹灰机 器人与待刷墙面之间的距离，同时利用磁编码器分别检测两标记点在第一撑杆和第二撑杆 长度方向上的距离1W及所述墙面抹灰机器人沿所述第一撑杆和第二撑杆上升的总高度 h ；
[0015] 步骤3,根据所述步骤2的测量结果，计算得到所述第一撑杆和第二撑杆的垂直 度，即所述第一撑杆和第二撑杆与竖直方向之间的夹角0 ;
[0016] 步骤4,根据所述墙面抹灰机器人沿所述第一撑杆和第二撑杆上升的总高度hW 及第一撑杆和第二撑杆的垂直度e，计算得到墙面抹灰机器人与待刷墙面的最大距离偏差
[0017] 步骤5,根据所述最大距离偏差及所述墙面抹灰机器人沿所述第一撑杆和 第二撑杆上升的总高度h，计算得到所述墙面抹灰机器人的上升速度与连接抹灰板的丝杆 的调节速度之间的关系；
[0018] 步骤6,墙面抹灰机器人回到初始位置装入灰浆，沿着所述第一撑杆和第二撑杆形 成的轨道再次上升进行抹灰作业，作业过程中，基于所述步骤5的计算结果，根据墙面抹灰 机器人的上升速度来调节抹灰板的伸缩速度，使得抹灰板的运动路径与墙面保持平行，补 偿垂直度的偏差。
[0019] 本发明的有益效果是，能够在机器人执行抹灰作业的过程中，自动精确的测量抹 灰机器人撑杆与竖直方向上的夹角。此种测量方式，相比于直接进行角度测量，能够大大提 高测量精度，且能为后续的自动补偿调整直接提供参数。
【附图说明】
[0020] 图1是本发明用于墙面抹灰机器人的垂直度测量与补偿系统的组成示意图；
[0021] 图2是本发明墙面抹灰机器人的基本结构示意图；
[0022] 图3是根据本发明一实施例的用于墙面抹灰机器人的垂直度测量与补偿方法的 流程图。
[0023] 主要附图标记说明：
[0024] 1 ;墙面抹灰机器人 [00巧]2 ;抹灰板
[0026] 3 ;第一激光测距传感器
[0027] 4 ;第一撑杆
[002引 5 :待刷墙面
[0029] 6 ;丝杆
[0030] 15 ;第二激光测距传感器
[0031] 16 ;第二撑杆
【具体实施方式】
[0032] 为使本发明的目的、技术方案和优点更加清楚明白，W下结合具体实施例，并参照 附图，对本发明进一步详细说明。
[0033] 图1是本发明用于墙面抹灰机器人的垂直度测量与补偿系统的组成示意图，图1 中，5表示待抹灰墙面，12表示抹灰区域厚度，13表示调节过程中抹灰板的移动路径，14表 示墙面抹灰机器人的移动轨迹。如图1所示，所述用于墙面抹灰机器人的垂直度测量与补 偿系统包括；墙面抹灰机器人1、第一撑杆4和第二撑杆6,其中：
[0034] 所述第一撑杆4和第二撑杆6放置在作业空间中的天花板与地面之间，用于固定 工作过程中的墙面抹灰机器人1 ;
[0035] 所述墙面抹灰机器人1放置在所述第一撑杆4和第二撑杆6之间，沿着所述第一 撑杆4和第二撑杆6形成的轨道进行墙面抹灰作业；
[0036] 图2是本发明墙面抹灰机器人的基本结构示意图，如图2所示，所述墙面抹灰机器 人1朝向墙面的一侧安装有抹灰板2,所述抹灰板2的后端连接有可伸缩调节的丝杠6,所 述抹灰板2可根据丝杠6的伸缩而伸缩；所述墙面抹灰机器人1垂直于墙面的两侧面分别 安装有第一激光测距传感器3和第二激光测距传感器15,所述第一激光测距传感器3和第 二激光测距传感器15处于同一水平面上，且测量方向均与撑杆垂直；所述墙面抹灰机器人 1的一侧面上安装有磁编码器17。
[0037] 其中，所述第一激光测距传感器3和第二激光测距传感器15使用激光=角测距法 中的直射式测距，测量量程在80mm?230mm之间，分辨率在量程范围内能达到1mm W内。 [003引图3是根据本发明一实施例的用于墙面抹灰机器人的垂直度测量与补偿方法的 流程图，请同时参考图1和图3,所述用于墙面抹灰机器人的垂直度测量与补偿方法包括W 下步骤：
[0039] 步骤1，在作业空间中的天花板与地面之间固定放置第一撑杆4和第二撑杆6,将 墙面抹灰机器人1放置在所述第一撑杆4和第二撑杆6之间的初始作业点处；
[0040] 在抹灰作业之前，需撑紧所述第一撑杆4和第二撑杆6,使得墙面抹灰机器人1在 作业过程中保持位置稳定。
[0041] 步骤2,所述墙面抹灰机器人1沿着所述第一撑杆4和第二撑杆6形成的轨道第一 次由地面上升到天花板，进行待刷墙面5抹灰作业，并在第一次上升过程中，利用第一激光 测距传感器3和第二激光测距传感器15分别测量两个处于不同高度位置的标记点处所述 墙面抹灰机器人1与待刷墙面之间的距离（如图1中附图标记9