CN116605326B - 一种以缆绳机构控制的爬壁机器人的操控方法 - Google Patents

Abstract

本发明提供以缆绳机构控制的爬壁机器人及其操控方法，包括：以缆绳控制为定位依据，利用推导公式的计算，设计爬壁机器人的操控方法；由推导公式，利用传感器测量缆绳被拉出的长度来控制机器人行动的精度，计算得出机器人相对缆绳绞车原点的x,y,z坐标，该x,y,z坐标依所推导的公式可找出机器人行经路线的表面形状，也可找出机器人任何位置工作路线或区域所经过的曲面及扫描边界，所述扫描边界可提供机器人在行走时的路径规划，以便能将工程作业覆盖到曲面的扫描边界范围内，使工程作业无遗漏。本发明提供一种以缆绳机构来操控机器人的方法，既提高了爬壁机器人在立面上作业定位精确度，且不易受周围环境干扰，具有重量轻、吸附性强优点。

Description

一种以缆绳机构控制的爬壁机器人的操控方法

技术领域

本发明涉及空间定位技术领域，特别地，涉及在立面工作的爬壁机器人的定位工作，具体而言，涉及一种以缆绳机构控制的爬壁机器人的操控方法。

背景技术

当前在各个工程技术领域里，对于在竖直立面上的工程作业有相当多的需求，比如：大楼墙面清洗、大结构的立面切割和焊接等，都需要进行立面上的作业。

但是，这些立面上工程作业的最大困难在于定位的困难，定位困难使许多工程作业在自动化作业方面产生很大困难，只能依靠人工来完成，例如：大楼清洗要用吊笼放人下去、用人力清洗，船舶焊接、喷砂(或水刀、激光)清洗需要用脚手架承载工人让工人在高空施工，凡此种种需要立面定位的工程作业都让自动化难以展开。

自动化的第一步必须要在机器人左右、上下移动做某些加工动作时，能够精确地确定机器人在任何时间所处的位置。而且，也要确定机器人在此位置时所有的加工工具(焊接、喷、水刀或激光清洗头等)的工作区域的位置。

现阶段最常用到空间定位的作业设备是无人机，无人机除了利用GPS技术进行定位以外，通常为进一步增加定位精度而采用所谓的实时动态技术(RTK:Real TimeKinematic)或动态后处理技术(PPK:post processed kinematic)，来做GPS定位校正技术，可在无人机现场测量和捕获图像时对位置数据进行校正。然而，无论RTK或PPK技术均需要建立一个基准站，基准站将接收到的卫星信号通过无线通信网实时发送给移动站，以测站坐标信息求得基准站和移动站间的位置关系，在户外空旷地区可以取得公分(厘米)等级的定位精度。

另一种方法是利用室内无线发射器发射无线电，依靠无线电的接收与发送的方式，确定目标对象的位置(例如：工业4.0-UWB精准室内定位系统)，能够将人员、物料、设备、车辆的位置进行定位，以便做各种不同的应用，比如：人员或物体的追踪，智能机器人的操控，定位精度在公分到十公分这样的等级。

然而，现有的上述操控方法最大的缺点就是无法将定位精度达到毫米(mm)等级，对于需要毫米等级的加工作业采用现有的这些方法是不可行的。并且，周围环境对现有操控方法的精度影响也很大，尤其是在工作场所存在许多目标对象时，各种电波会遭到阻挡。而且，工作机具所发出的电磁波会对外界产生电波干涉，天气状况不佳也会对光电传播形成非常差的影响。凡此种种扰动问题，均会造成较差的定位精度。

另外，也可利用爬壁机器人本身来定位，因为无论是轮型或足型都要靠马达来驱动机器人，控制及定位的原理是利用爬壁机构的摩擦力来推动爬壁机器人进行精密的操控及定位，增加摩擦力是爬墙机器人吸附在立面工作时能精密移动的重要手段，然而，驱动的马达现阶段都的装在爬壁机器人本体上，使得爬壁机器人的重量沉重，会有因吸附力不足而使得机器人与立面的磨擦力不足产生滑动的情况出现，因而增加了对吸附力的需求，增加对吸附力的需求使得爬壁机器人重量更沉重，控制更加困难。要减轻爬墙机器人的重量也是立面工作机具的重要工作。

因此，当前亟需开发一种在立面上做精密工程作业时定位更精确，且不易受到周围环境干扰，并且减轻机器人本体重量的方法。

发明内容

鉴于此，本发明的目的在于以缆绳控制为定位依据，利用推导公式的计算，设计爬壁机器人的操控及操控方法；利用传感器测量缆绳被拉出的长度来控制机器人行动的精度，计算得出机器人相对缆绳绞车原点的x,y,z坐标，该x,y,z坐标依所推导的公式可找出机器人行经路线的表面形状，也可找出机器人任何位置工作路线或区域所经过的曲面及扫描边界。

本发明较佳实例为以缆绳机构控制的爬壁机器人，包括：可吸附墙壁的机器人、4根及以上根数的缆绳，其中，所述机器人包括：与墙壁接触的用于爬壁的轮子、爬足或其他攀爬装置；各根缆绳其中的一个端头分别与所述机器人的对应联接点固定连接，各根缆绳的另一个端头分别与绞车绞盘的对应挂点固定连接，所述缆绳的伸出长度随绞盘的转动而改变；

通过调整缆绳的长度及缆绳与y轴、xy平面的两个夹角，操控机器人的位置及姿态角。

将爬壁机器人的行走路径的曲面公式设为z＝f(x,y)，4根缆绳的编号分别为L1、L2、R1、R2，4根缆绳和所述机器人的接点分别为a点、b点、k点、n点，c为a点、b点连线的中点，m为k点、n点连线的中点，4根缆绳和绞车的挂点分别为A点、B点、C点、D点，设A点为坐标原点，的长度为L_AB，/>的长度为L_AC，/>的长度为L_AD，所述机器人的中心点d的坐标为(x_d,y_d,z_d)，4根缆绳的长度分别为L_L1、L_L2、L_R1、L_R2，爬壁机器人的高度为H_h，4根缆绳分别与y轴的夹角为θ_L1、θ_L2、θ_R1及θ_R2，爬壁机器人的行进方向和x轴的夹角为θ_d，缆绳L1、L2、R1、R2与xy平面的夹角分别为θ_L13、θ_L23、θ_R13、θ_R23，；

爬壁机器人和缆绳连接的a点位置坐标(x_a,y_a,z_a)为：

x_a＝L_AB+L_L1cosθ_L13 sinθ_L1 (1)

y_a＝L_L1cosθ_L13cosθ_L1 (2)

z_a＝L_L1sinθ_L13 (3)

爬壁机器人和缆绳连接的b点位置坐标(x_b,y_b,z_b)为：

x_b＝L_AC-L_R1cosθ_R13sinθ_R1 (4)

y_b＝L_R1cosθ_R13cosθ_R1 (5)

z_b＝L_R1sinθ_R13 (6)

爬壁机器人和缆绳连接的k点位置坐标(x_k,y_k,z_k)为：

x_k＝L_L2cosθ_L23sinθ_L2 (7)

y_k＝L_L2cosθ_L23cosθ_L2 (8)

z_k＝L_L2sinθL_L28 (9)

爬壁机器人和缆绳连接的n点位置坐标(x_n,y_n,z_n)为：

x_n＝L_AD-L_R2cosθ_R23sinθ_R2 (10)

y_n＝L_R2cosθ_R23cosθ_R2 (11)

z_n＝L_R2sinθ_R23 (12)。

所述的以缆绳机构控制的爬壁机器人的操控方法，包括以下步骤：

S1、选用轮子数为前后各两轮的四轮爬壁机器人进行工程作业；

所述四轮爬壁机器人的前轮轴与机器人的中心点d的垂直距离为M，前后两轮轴之间的距离为F，左右两轮轴之间的距离为B，及/>的长度为H，爬壁机器人的xz截面和x轴的夹角为α；四个轮子的中心点与爬壁曲面的接触点分别为e点、f点、g点、h点；

S2、依据机器人和缆绳的连接位置a点、b点、k点、n点对中心点d的相对位置，联接机器人的4根缆绳的长度，缆绳L1、L2、R1、R2与xy平面的夹角以及与y轴的夹角，求解得到机器人的中心点d的坐标；

S3、由所述中心点d的坐标，中心点d与原点的向量为利用a点、b点、k点、n点的坐标计算得出机器人本体内的单位向量/>得出e点、f点、g点、h点以中心点d为原点的相对位置，(B、F及H均为己知的设计几何参数)，计算得出e点、f点、g点、h点的x，y，z坐标(x_e,y_e,z_e)，(x_f,y_f,z_f)，(x_g,y_g,z_g)，(x_h,y_h,z_h)，(x_g,y_g,z_g)；

所述计算得出e点、f点、g点、h点的x，y，z坐标的方法包括：

建立e点、f点、g点、h点对应中心点d的坐标，将e，f，g，h四点在机器人本体上的坐标向量表示成为/>

由和x，y，z坐标的单位向量/>的转换推导出:

利用式(20)-式(22)将式(16)-式(19)换算成单位向量的表示式：

S4、将机器人的作业区域设为直线，设绞车车体内与工作关联的工作线长度为B₁，与中心点d的垂直距离为H₂，所述作业区域/>的两个端点i，j的坐标分别为(x_i,y_i,z_i)，(x_j,y_j,z_j)，计算机器人的中心点d的位置及方向；

控制机器人沿着方向走直线，将a点、b点、k点、n点的坐标沿着/>移动,即将a点、b点、k点、n点的坐标沿着/>移动dL；

分别为从原点到i，j两点的向量：

将a点、b点、k点、n点四点移动至新的坐标a’、b’、k’及n’，新坐标与旧坐标的关系表达式为:

根据式(1)-(3)可知，测量获取L_L1、L_L2、L_R1、L_R2的长度，4根缆绳与y轴的夹角θ_L1、θ_L2、θ_R1、θ_R2角，缆绳L1、L2、R1、R2与xy平面的夹角θ_L13、θ_L23、θ_L13、θ_R23，即可计算得到机器人的中心点d的位置及方向；

由式(31)-(42)及公式(1)-(12)计算获得4根缆绳与y轴的夹角θ_L1、θ_L2、θ_R1、θ_R2以及缆绳L1、L2、R1、R2与xy平面的夹角θ_L13、θ_L23、θ_R13、θ_R23和缆绳的长度L_L1、L_L2、L_R1、L_R2，将绞车缆绳的长度调整为新的长度，得到机器人的中心点d的位置及方向；

S5、测量缆绳与xy平面的坐标的夹角，与S4步骤计算得出的角度作比较以及相应调整，在测量夹角和计算角度相同后进行步进增量计算；

如果测量出来的夹角和计算得出的夹角相同，则不再调整，将dL加到公式内进行第二步的步进增量计算；

如果测量出来的夹角和计算得出的角度不相同，则再用测量出来的夹角及dL计算新的a’、b’、k’及n’坐标，重复S4步骤的方法计算角度及长度，直到计算得出的角度与测量出来的夹角相同，停止迭代，进行第二步的步进增量计算。

如此就能够将机器人控制并随着需求移动到相应的位置，使爬壁机器人走到控制者期望的路径。

进一步地，所述S5步骤之后还包括：

计算4根缆绳在不同长度下的e点、f点、g点、h点的x，y，z坐标，将多个不同长度下的所述x，y，z坐标汇集后输入计算机，以多个不同长度下的e点、f点、g点、h点结合生成作业对象物体的表面形状的网状图，用于建立作业对象物体的数学模型。

进一步地，所述S4步骤的缆绳L1、L2、R1、R2与xy平面的夹角θ_L13、θ_L23、θ_R13、θ_R23的获取方法包括：

在A点、B点、C点、D点上设置角测量器，采用角测量器测量得到θ_L1、θ_L2、θ_R1、θ_R2以及θ_L13、θ_L23、θ_R13、θ_R23。

进一步地，所述S4步骤的缆绳L1、L2、R1、R2与xy平面的夹角θ_L13、θ_L23、θ_R13、θ_R23的获取方法包括：

在a点、b点、k点、n点上设置姿态角测量器，采用姿态角测量器测量得到θ_L1、θ_L2、θ_R1、θ_R2以及θ_L13、θ_L23、θ_R13、θ_R23。

进一步地，所述缆绳的长度L_L1、L_L2、L_R1、L_R2的测量采用长条量尺。

进一步地，所述四个轮子替换为能支撑爬壁机器人爬壁的任何装置，不同长度的i，j两点的x，y，z坐标的坐标可由式(1)-(42)的方法得到。

进一步地，如所述机器人的作业区域为一个面区域，则各点的坐标由与式(27)-(42)相同的方法得到。

所述其他攀爬装置包括：由前轮和后轮组成的三个轮子或其他可附在机器人身上且能爬壁的机构。

通常缆绳会安装在绞车内部，随着爬壁机器人的上下左右移动，缆绳的长度以及与立面(垂直平面)的夹角随着机器人的移动而改变，可利用传感器测量出缆绳被拉出的长度(必须要有足够的张力以维持缆绳近似直线，若有困难可用静力学的悬链线公式校正)、与重力方向垂直线的夹角角度以及与缆绳和垂直面的夹角角度。

因为H₁、B、F及H均为己知的设计几何参数，可将这些己知参数换算成机器人与缆绳的连接点的x,y,z坐标，机器人身上附有测量机器人欧拉角的感测器(例如POLO的UM6Orientation Sensor)，也可采用三个角度传感器测量三个维度的角度，再转换成欧拉角；

若机器人和立面的接触类型是点接触，则由这些接触点即可得到立面的数学曲面模型。若是工程作业线(例如激光扫描面)或作业区域，则可得到工程作业路径上的工作面及工作边界，可依此将工作面进行清楚地控制以完成完整的工作路径。

本发明还提供一种计算机设备，所述计算机设备包括可读存储介质、存储器、处理器及存储在可读存储介质、存储器上并可在处理器上运行的计算机程序，所述程序被所述处理器执行时实现上述所述的以缆绳机构控制的爬壁机器人的操控方法的步骤。

与现有技术相比，本发明的有益效果在于：

本发明通过机器人在任何一点的位置坐标与机器人的起始欧拉角以及移动后的欧拉角测量原点的坐标向量相加得到总欧拉角，将该总欧拉角做坐标转换得到机器人任何一点对缆绳连接点的xyz坐标系的坐标，再加上缆绳连接点的x,y,z坐标可得到以绞盘为原点的坐标；由机器人和立面的接触点可得到立面的数学曲面模型；由工程作业线(例如激光扫描面)或区域可得到工程作业路径上的工作面及工作边界，依此将工作面进行清楚地控制从而完成完整的工作路径，很多提高了在立面上作业的定位精确度，并且不易受周围环境干扰。

附图说明

通过阅读下文优选实施方式的详细描述，各种其他的优点和益处对于本领域普通技术人员将变得清楚明了。附图仅用于示出优选实施方式的目的，而并不认为是对本发明的限制。

在附图中：

图1为本发明以缆绳机构控制的爬壁机器人的立面作业上视图和侧视图；

图2为本发明实施例计算机设备的构成示意图；

图3为本发明实施例的机器人与缆绳的联接点以及中心点示意图；

图4为本发明实施例的机器人主体放大图；

图5为本发明实施例控制机器人行走路径的流程示意图；

图6为本发明实施例的机器人从第1位置移动到第2位置的坐标转换示意图；

图7为本发明以缆绳机构控制的爬壁机器人操控及操控方法的流程图。

具体实施方式

这里将详细地对示例性实施例进行说明，其示例表示在附图中。下面的描述涉及附图时，除非另有表示，不同附图中的相同数字表示相同或相似的要素。以下示例性实施例中所描述的实施方式并不代表与本公开相一致的所有实施方式。相反，它们仅是与如所附权利要求书中所详述的、本公开的一些方面相一致的装置和产品的例子。

在本公开使用的术语是仅仅出于描述特定实施例的目的，而非旨在限制本公开。在本公开和所附权利要求书中所使用的单数形式的“一种”、“所述”和“该”也旨在包括多数形式，除非上下文清楚地表示其他含义。还应当理解，本文中使用的术语“和/或”是指并包含一个或多个相关联的列出项目的任何或所有可能组合。

应当理解，尽管在本公开可能采用术语第一、第二、第三等来描述各种信息，但这些信息不应限于这些术语。这些术语仅用来将同一类型的信息彼此区分开。例如，在不脱离本公开范围的情况下，第一信息也可以被称为第二信息，类似地，第二信息也可以被称为第一信息。取决于语境，如在此所使用的词语“如果”可以被解释成为“在……时”或“当……时”或“响应于确定”。

下面结合附图对本发明实施例作进一步详细说明。

本发明实施例提供以缆绳机构控制的爬壁机器人，包括：可吸附墙壁的机器人、4根缆绳，其中，所述机器人包括：与墙壁接触的用于爬壁的轮子、爬足或其他攀爬装置；各根缆绳其中的一个端头分别与所述机器人的对应联接点固定连接，各根缆绳的另一个端头分别与绞车绞盘的对应挂点固定连接，所述缆绳的伸出长度随绞盘的转动而改变；

所述其他攀爬装置包括：由前轮和后轮组成的三个轮子或其他可附在机器人身上且能爬壁的机构。

通过调整缆绳的长度及缆绳与y轴、xy平面的两个夹角，操控机器人的位置及姿态角。

将爬壁机器人的行走路径的曲面公式设为z＝f(x,y)，4根缆绳的编号分别为L1、L2、R1、R2，4根缆绳和所述机器人的接点分别为a点、b点、k点、n点，c为a点、b点连线的中点，m为k点、n点连线的中点，4根缆绳和绞车的挂点分别为A点、B点、C点、D点，设A点为坐标原点，的长度为L_AB，/>的长度为L_AC，/>的长度为L_AD，所述机器人的中心点d的坐标为(x_d,y_d,z_d)，4根缆绳的长度分别为L_L1、L_L2、L_R1、L_R2，爬壁机器人的高度为H_h，4根缆绳分别与y轴的夹角为θ_L1、θ_L2、θ_R1及θ_R2，爬壁机器人的行进方向和x轴的夹角为θ_d，缆绳L1、L2、R1、R2与xy平面的夹角分别为θ_L13、θ_L23、θ_R13、θ_R23(未示于图中，但在xz平面投影为θ₂)；

爬壁机器人和缆绳连接的a点位置坐标(x_a,y_a,z_a)为：

x_a＝L_AB+L_L1cosθ_L13sinθ_L1 (1)

y_a＝L_L1cosθ_L13cosθ_L1 (2)

z_a＝L_L1sinθ_L13 (3)

爬壁机器人和缆绳连接的b点位置坐标(x_b,y_b,z_b)为：

x_b＝L_AC-L_R1cosθ_R13sinθ_R1 (4)

y_b＝L_R1cosθ_R13cosθ_R1 (5)

z_b＝L_R1sinθ_R13 (6)

爬壁机器人和缆绳连接的k点位置坐标(x_k,y_k,z_k)为：

x_k＝L_L2cosθ_L23sinθ_L2 (7)

y_k＝L_L2cosθ_L23cosθ_L2 (8)

z_k＝L_L2sinθ_L23 (9)

爬壁机器人和缆绳连接的n点位置坐标(x_n,y_n,z_n)为：

x_n＝L_AD-L_R2cosθ_R23sinθ_R2 (10)

y_n＝L_R2cosθ_R23cosθ_R2 (11)

z_n＝L_R2sinθ_R23 (12)。

所述的以缆绳机构控制的爬壁机器人的操控方法，参见图7所示，包括以下步骤：

S1、选用轮子数为前后各两轮的四轮爬壁机器人进行工程作业；

所述四轮爬壁机器人的前轮轴与机器人的中心点d的垂直距离为M，前后两轮轴之间的距离为F，左右两轮轴之间的距离为B，及/>的长度为H，爬壁机器人的xz截面和x轴的夹角为α；四个轮子的中心点与爬壁曲面的接触点分别为e点、f点、g点、h点；

S2、依据机器人和缆绳的连接位置a点、b点、k点、n点对中心点d的相对位置，联接机器人的4根缆绳的长度，缆绳L1、L2、R1、R2与xy平面的夹角以及与y轴的夹角，(如图3所示)求解得到机器人的中心点d的坐标；

S3、由所述中心点d的坐标，中心点d与原点的向量为利用a点、b点、k点、n点的坐标计算得出机器人本体内的单位向量/>得出e点、f点、g点、h点以中心点d为原点的相对位置，(因B、F及H均为己知的设计几何参数)，计算得出e点、f点、g点、h点的x，y，z坐标(x_e,y_e,z_e)，(x_f,y_f,z_f)，(x_g,y_g,z_g)，(x_h,y_h,z_h)，(x_g,y_g,z_g)；

所述计算得出e点、f点、g点、h点的x，y，z坐标的方法包括：

建立e点、f点、g点、h点对应中心点d的坐标，将e，f，g，h四点在机器人本体上的坐标向量表示成为/>

由和x，y，z坐标的单位向量/>的转换推导出:

利用式(20)-式(22)将式(16)-式(19)换算成单位向量的表示式：

S4、将机器人的作业区域设为直线，设绞车车体内与工作关联的工作线长度为B₁，与中心点d的垂直距离为H₂，所述作业区域/>的两个端点i，j的坐标分别为(x_i,y_i,z_i)，(x_j,y_j,z_j)，计算机器人的中心点d的位置及方向，如图4所示；

控制机器人沿着方向走直线，将a点、b点、k点、n点的坐标沿着/>移动,即将a点、b点、k点、n点的坐标沿着/>移动dL；

分别为从原点到i，j两点的向量：

将a点、b点、k点、n点四点移动至新的坐标a’、b’、k’及n’，新坐标与旧坐标的关系表达式为:

根据式(1)-(3)可知，测量获取L_L1、L_L2、L_R1、L_R2的长度，4根缆绳与y轴的夹角θ_L1、θ_L2、θ_R1、θ_R2角，缆绳L1、L2、R1、R2与xy平面的夹角θ_L13、θ_L23、θ_R13、θ_R23，即可计算得到机器人的中心点d的位置及方向；

由式(31)-(42)及公式(1)-(12)计算获得4根缆绳与y轴的夹角θ_L1、θ_L2、θ_R1、θ_R2以及缆绳L1、L2、R1、R2与xy平面的夹角θ_L13、θ₁₂₃、θ_R12、θ_R22和缆绳的长度L_L1、L_L2、L_R1、L_R2，将绞车缆绳的长度调整为新的长度，得到机器人的中心点d的位置及方向；

本实施例中，所述4根缆绳与y轴的夹角θ_L1、θ_L2、θ_R1、θ_R2角的获取方法为：

通过在a点、b点、k点、n点使用角度测量器测量得到θ_L1、θ_L2、θ_R1、θ_R2角。

本实施例中，所述缆绳L1、L2、R1、R2与xy平面的夹角θ_L13、θ_L23、θ_R13、θ_R23的获取方法为：

在a点、b点、k点、n点上设置姿态角测量器，采用姿态角测量器测量得到θ_L1、θ_L2、θ_R1、θ_R2以及θ_L13、θ_L23、θ_R13、θ_R23。

本实施例中，所述缆绳的长度L_L1、L_L2、L_R1、L_R2的测量采用长条量尺。

S5、测量缆绳与xy平面的坐标的夹角，与S4步骤计算得出的角度作比较以及相应调整，在测量夹角和计算角度相同后进行步进增量计算；

如果测量出来的夹角和计算得出的夹角相同，则不再调整，将dL加到公式内进行第二步的步进增量计算；

如果测量出来的夹角和计算得出的角度不相同，则再用测量出来的夹角及dL计算新的a’、b’、k’及n’坐标，重复S4步骤的方法计算角度及长度，直到计算得出的角度与测量出来的夹角相同，停止迭代，进行第二步的步进增量计算。

参见图5所示，以如此流程进行控制就能够将机器人控制并随着需求移动到相应的位置，使爬壁机器人走到控制者期望的路径。

所述S5步骤之后还包括：

计算4根缆绳在不同长度下的e点、f点、g点、h点的x，y，z坐标，将多个不同长度下的所述x，y，z坐标汇集后输入计算机，以多个不同长度下的e点、f点、g点、h点结合生成作业对象物体的表面形状的网状图，用于建立作业对象物体的数学模型。

如所述机器人的作业区域为一个面区域，则各点的坐标由与式(27)-(42)相同的方法得到

通常缆绳会安装在绞车内部，随着爬壁机器人的上下左右移动，缆绳的长度以及与立面(垂直平面)的夹角随着机器人的移动而改变，可利用传感器测量出缆绳被拉出的长度(必须要有足够的张力以维持缆绳近似直线，若有困难可用静力学的悬链线公式校正)、与重力方向垂直线的夹角角度以及与缆绳和垂直面的夹角角度。

因为H₁、B、F及H均为己知的设计几何参数，可将这些己知参数换算成机器人与缆绳的连接点的x,y,z坐标，绞车上可装置角度感测器来量测各角度。机器人身上a,b,k,n点装置姿态角感测器来量测各角度。

若机器人和立面的接触类型是点接触，则由这些接触点即可得到立面的数学曲面模型。若是工程作业线(例如激光扫描面)或作业区域，则可得到工程作业路径上的工作面及工作边界，可依此将工作面进行清楚地控制以完成完整的工作路径。

参见图6所示，当第1位置的缆绳长度所及的范围走完，可以移动至第2位置将上一次的工作区域的边界做坐标平移，以该边界的新坐标再次规划机器人的行进路径，使得工作范围更大。由于第1位置移动至第2位置时要将绞车位置移动，移动精度可由装在机器人上的传感器寻第一位置加工边界予以校正。

本发明实施例还提供了一种计算机设备，图2是本发明实施例提供的一种计算机设备的结构示意图；参见附图图2所示，该计算机设备包括：输入装置23、输出装置24、存储器22和处理器21；所述存储器22，用于存储一个或多个程序；当所述一个或多个程序被所述一个或多个处理器21执行，使得所述一个或多个处理器21实现如上述实施例提供的以缆绳机构控制的爬壁机器人的操控方法；其中输入装置23、输出装置24、存储器22和处理器21可以通过总线或者其他方式连接，图2中以通过总线连接为例。

存储器22作为一种计算设备可读写存储介质，可用于存储软件程序、计算机可执行程序，如本发明实施例所述的以缆绳机构控制的爬壁机器人的操控方法对应的程序指令；存储器22可主要包括存储程序区和存储数据区，其中，存储程序区可存储操作系统、至少一个功能所需的应用程序；存储数据区可存储根据设备的使用所创建的数据等；此外，存储器22可以包括高速随机存取存储器，还可以包括非易失性存储器，例如至少一个磁盘存储器件、闪存器件、或其他非易失性固态存储器件；在一些实例中，存储器22可进一步包括相对于处理器21远程设置的存储器，这些远程存储器可以通过网络连接至设备。上述网络的实例包括但不限于互联网、企业内部网、局域网、移动通信网及其组合。

输入装置23可用于接收输入的数字或字符信息，以及产生与设备的用户设置以及功能控制有关的键信号输入；输出装置24可包括显示屏等显示设备。

处理器21通过运行存储在存储器22中的软件程序、指令以及模块，从而执行设备的各种功能应用以及数据处理，即实现上述的以缆绳机构控制的爬壁机器人的操控方法。

上述提供的计算机设备可用于执行上述实施例提供的以缆绳机构控制的爬壁机器人的操控方法，具备相应的功能和有益效果。

本发明实施例还提供一种包含计算机可执行指令的存储介质，所述计算机可执行指令在由计算机处理器执行时用于执行如上述实施例提供的以缆绳机构控制的爬壁机器人的操控方法，存储介质是任何的各种类型的存储器设备或存储设备，存储介质包括：安装介质，例如CD-ROM、软盘或磁带装置；计算机系统存储器或随机存取存储器，诸如DRAM、DDRRAM、SRAM、EDO RAM，兰巴斯(Rambus)RAM等；非易失性存储器，诸如闪存、磁介质(例如硬盘或光存储)；寄存器或其它相似类型的存储器组件等；存储介质可以还包括其它类型的存储器或其组合；另外，存储介质可以位于程序在其中被执行的第一计算机系统中，或者可以位于不同的第二计算机系统中，第二计算机系统通过网络(诸如因特网)连接到第一计算机系统；第二计算机系统可以提供程序指令给第一计算机用于执行。存储介质包括可以驻留在不同位置中(例如在通过网络连接的不同计算机系统中)的两个或更多存储介质。存储介质可以存储可由一个或多个处理器执行的程序指令(例如具体实现为计算机程序)。

当然，本发明实施例所提供的一种包含计算机可执行指令的存储介质，其计算机可执行指令不限于如上实施例所述的以缆绳机构控制的爬壁机器人的操控方法，还可以执行本发明任意实施例所提供的以缆绳机构控制的爬壁机器人操控方法中的相关操作。

至此，已经结合附图所示的优选实施方式描述了本发明的技术方案，但是，本领域技术人员容易理解的是，本发明的保护范围显然不局限于这些具体实施方式。在不偏离本发明的原理的前提下，本领域技术人员可以对相关技术特征做出等同的更改或替换，例如A点、B点、C点、D点四点不在同一直线上，这些更改或替换之后的技术方案都将落入本发明的保护范围之内。

以上所述仅为本发明的优选实施例，并不用于限制本发明；对于本领域的技术人员来说，本发明可以有各种更改和变化。凡在本发明的精神和原则之内，所作的任何修改、等同替换、改进等，均应包含在本发明的保护范围之内。

Claims (7)

1.一种以缆绳机构控制的爬壁机器人的操控方法，其特征在于，包括：可吸附墙壁的机器人、4根及以上根数的缆绳，其中，所述机器人包括：与墙壁接触的用于爬壁的轮子、爬足；各根缆绳其中的一个端头分别与所述机器人的对应联接点固定连接，各根缆绳的另一个端头分别与绞车绞盘的对应挂点固定连接，所述缆绳的伸出长度随绞盘的转动而改变；

通过调整缆绳的长度及缆绳与y轴、xy平面的两个夹角，操控机器人的位置及姿态角；

将爬壁机器人的行走路径的曲面公式设为z＝f(x,y)，4根缆绳的编号分别为L1、L2、R1、R2，4根缆绳和所述机器人的接点分别为a点、b点、k点、n点，c为a点、b点连线的中点，m为k点、n点连线的中点，4根缆绳和绞车的挂点分别为A点、B点、C点、D点，设A点为坐标原点，的长度为L_AB，/>的长度为L_AC，/>的长度为L_AD，所述机器人的中心点d的坐标为(x_d，y_d，z_d)；4根缆绳的长度分别为L_L1、L_L2、L_R1、L_R2，爬壁机器人的高度为H_h，4根缆绳分别与y轴的夹角为θ_L1、θ_L2、θ_R1及θ_R2，爬壁机器人的行进方向和x轴的夹角为θ_d，缆绳L1、L2、R1、R2与xy平面的夹角分别为θ_L13、θ_L23、θ_R13、θ_R23；

爬壁机器人和缆绳连接的a点位置坐标(x_a,y_a,z_a)为：

x_a＝L_AB+L_L1cosθ_L13sinθ_L1 (1)

y_a＝L_L1cosθ_L13cosθ_L1 (2)

z_a＝L_L1sinθ_L13 (3)

爬壁机器人和缆绳连接的b点位置坐标(x_b，y_b，z_b)为：

x_L＝L_AC-L_R1cosθ_R13sinθ_R1 (4)

y_b＝L_R1cosθ_R13cosθ_R1 (5)

z_b＝L_R1sinθ_R13 (6)

爬壁机器人和缆绳连接的k点位置坐标(x_k，y_k，z_k)为：

x_k＝L_L2cosθ_L23sinθ_L2 (7)

y_k＝L_L2cosθ_L23cosθ_L2 (8)

z_k＝L_L2sinθ_L23 (9)

爬壁机器人和缆绳连接的n点位置坐标(x_n，y_n，z_n)为：

x_n＝L_AD-L_R2cosθ_R23sinθ_R2 (10)

y_n＝L_R2cosθ_R23cosθ_R2 (11)

z_n＝L_R2sinθ_R23 (12)；

所述的以缆绳机构控制的爬壁机器人的操控方法，包括以下步骤：

S1、选用轮子数为前后各两轮的四轮爬壁机器人进行工程作业；

所述四轮爬壁机器人的前轮轴与机器人的中心点d的垂直距离为M，前后两轮轴之间的距离为F，左右两轮轴之间的距离为B，及/>的长度为H，爬壁机器人的xz截面和x轴的夹角为α；四个轮子的中心点与爬壁曲面的接触点分别为e点、f点、g点、h点；

S2、依据机器人和缆绳的连接位置a点、b点、k点、n点对中心点d的相对位置，联接机器人的4根缆绳的长度，缆绳L1、L2、R1、R2与xy平面的夹角以及与y轴的夹角，求解得到机器人的中心点d的坐标；

S3、由所述中心点d的坐标，中心点d与原点的向量为利用a点、b点、k点、n点的坐标计算得出机器人本体内的单位向量/>得出e点、f点、g点、h点以中心点d为原点的相对位置，计算得出e点、f点、g点、h点的x，y，z坐标(x_e，y_e，z_e)，(x_f，y_f，z_f)，(x_g，y_g,z_s)，(x_h,y_h,z_h)，(x_g，y_g，z_g)；

所述计算得出e点、f点、g点、h点的x，y，z坐标的方法包括：

建立e点、f点、g点、h点对应中心点d的坐标，将e，f，g，h四点在机器人本体上的坐标向量表示成为/>

由和x，y，z坐标的单位向量/>的转换推导出：

利用式(20)-式(22)将式(16)-式(19)换算成单位向量的表示式：

S4、将机器人的作业区域设为直线，设绞车车体内与工作关联的工作线长度为B₁，与中心点d的垂直距离为H₂，所述作业区域/>的两个端点i，j的坐标分别为(x_i，y_i，z_i)，(x_j，y_j，z_j)，计算机器人的中心点d的位置及方向；

控制机器人沿着方向走直线，将a点、b点、k点、n点的坐标沿着/>移动，即将a点、b点、k点、n点的坐标沿着/>移动dL；

分别为从原点到i，j两点的向量：

将a点、b点、k点、n点四点移动至新的坐标a’、b’、k’及n’，新坐标与旧坐标的关系表达式为：

由式(31)-(42)及公式(1)-(12)计算获得4根缆绳与y轴的夹角θ_L1、θ_L2、θ_R1、θ_R2以及缆绳L1、L2、R1、R2与xy平面的夹角θ_L13、θ_L23、θ_R13、θ_R23和缆绳的长度L_L1、L_L2、L_R1、L_R2，将绞车缆绳的长度调整为新的长度，得到机器人的中心点d的位置及方向；

S5、测量缆绳与xy平面的坐标的夹角，与S4步骤计算得出的角度作比较以及相应调整，在测量夹角和计算角度相同后进行步进增量计算；

如果测量出来的夹角和计算得出的夹角相同，则不再调整，将dL加到公式内进行第二步的步进增量计算；

如果测量出来的夹角和计算得出的角度不相同，则再用测量出来的夹角及dL计算新的a’、b’、k’及n’坐标，重复S4步骤的方法计算角度及长度，直到计算得出的角度与测量出来的夹角相同，停止迭代，进行第二步的步进增量计算；

所述S5步骤之后还包括：

计算4根缆绳在不同长度下的e点、f点、g点、h点的x，y，z坐标，将多个不同长度下的所述x，y，z坐标汇集后输入计算机，以多个不同长度下的e点、f点、g点、h点结合生成作业对象物体的表面形状的网状图，用于建立作业对象物体的数学模型。

2.根据权利要求1所述的以缆绳机构控制的爬壁机器人的操控方法，其特征在于，所述S4步骤的缆绳L1、L2、R1、R2与xy平面的夹角θ_L13、θ_L23、θ_R13、θ_R23的获取方法包括：

在A点、B点、C点、D点上设置角测量器，采用角测量器测量得到θ_L1、θ_L2、θ_R1、θ_R2以及θ_L13、θ_L23、θ_k13、θ_R23。

3.根据权利要求1所述的以缆绳机构控制的爬壁机器人的操控方法，其特征在于，所述S4步骤的缆绳L1、L2、R1、R2与xy平面的夹角θ_L13、θ_L23、θ_R13、θ_R23的获取方法包括：

在a点、b点、k点、n点上设置姿态角测量器，采用姿态角测量器测量得到θ_L1、θ_L2、θ_R1、θ_R2以及θ_L13、θ_L23、θ_R13、θ_R22。

4.根据权利要求1-3任一项所述的以缆绳机构控制的爬壁机器人的操控方法，其特征在于，所述缆绳的长度L_L1、L_L2、L_R1、L_R2的测量采用长条量尺。

5.根据权利要求1-3任一项所述的以缆绳机构控制的爬壁机器人的操控方法，其特征在于，所述四个轮子替换为能支撑爬壁机器人爬壁的任何装置，不同长度的i，j两点的x，y，z坐标的坐标可由式(1)-(42)的方法得到。

6.根据权利要求1所述的以缆绳机构控制的爬壁机器人的操控方法，其特征在于，如所述机器人的作业区域为一个面区域，则各点的坐标由与式(27)-(42)相同的方法得到。

7.一种计算机设备，所述计算机设备包括可读存储介质、存储器、处理器及存储在可读存储介质、存储器上并可在处理器上运行的计算机程序，其特征在于，所述程序被所述处理器执行时实现权利要求1-6任一项所述的以缆绳机构控制的爬壁机器人的操控方法的步骤。