CN112947396B - 反光信标夹角误差补偿方法、自动行走设备以及存储介质 - Google Patents

Abstract

本发明涉及的一种反光信标夹角误差补偿方法、自动行走设备以及存储介质，所述误差补偿方法包括：当自动行走设备在第一方向匀速直线运动时，获取激光转台从静止状态旋转至第m圈起始位置时的旋转时长T_sync，其中，整数m≥6；根据旋转时长T_sync，通过第一信标角度误差补偿公式，计算出第一信标角度的补偿角度值，其中，第一信标角度误差补偿公式为自动行走设备在第一方向匀速直线运动时第一信标角度关于激光转台旋转时长的函数公式，第一信标角度为第一反光信标发出的激光反射信号与自动行走设备行走方向之间的夹角。通过上述设置，可解决目前自动行走设备在沿着固定方向匀速直线运动过程中获取的反光信标夹角不够准确的问题。

Description

反光信标夹角误差补偿方法、自动行走设备以及存储介质

技术领域

本发明涉及家用电器领域，尤其涉及一种反光信标夹角误差补偿方法、自动行走设备及存储介质。

背景技术

目前，自动行走设备在空间中移动时所在的位置通常可通过激光定位方法来确定。自动行走设备内设置激光转台，激光转台上设有激光发射装置、激光接收装置以及角度编码器。自动行走设备的工作区域则预先放置多个反光信标，且多个反光信标在自动行走设备工作区域的坐标是已知的。

自动行走设备在行进的过程中，激光发射装置以一定的角速度360°水平向外部发射旋转的激光扫描光束，激光扫描光束扫过每个预置的反光信标时，反光信标形成平行于激光扫描光束的激光反射光束；接着，激光接收装置接收激光反射光束，同时通过角度编码器检测激光反射光束和自动行走设备行走方向上的夹角，即在自动行走设备行走方向上每个反光信标与自动行走设备行走方向的夹角；通过计算比对多个反光信标的这些夹角，自动行走设备的导航定位系统即可计算出当前自动行走设备在工作区域所处的坐标。

反光信标发出反射激光信号的时间与激光转台接收激光反射信号的时间不同，且激光转台发出激光信号时刻与接收激光反射信号时刻两者不同，激光发射反射过程中，自动行走设备一直处于运动状态，激光转台也一直处于旋转状态，导致编码器获取的反光信标夹角值并不准确，从而通过多个反光信标的夹角来测算自动行走设备的坐标位置也必然不够准确，无法对自动行走设备进行精准定位与控制。

发明内容

本发明的目的在于提供一种反光信标夹角误差补偿方法、自动行走设备以及存储介质，用来解决目前自动行走设备在沿着固定方向匀速直线运动过程中获取的反光信标夹角不够准确的问题。

为了实现上述发明目的之一，本发明提供一种反光信标夹角误差补偿方法，所述方法包括：当自动行走设备在第一方向匀速直线运动时，获取激光转台从静止状态旋转至第m圈起始位置时的旋转时长T_sync，其中，整数m≥6；根据旋转时长T_sync，通过第一信标角度误差补偿公式，计算出第一信标角度的补偿角度值，其中，第一信标角度误差补偿公式为自动行走设备在第一方向匀速直线运动时第一信标角度关于激光转台旋转时长的函数公式，第一信标角度为第一反光信标发出的激光反射信号与自动行走设备行走方向之间的夹角。

作为本发明一实施方式的进一步改进，所述方法还包括：获取第一信标角度信号从自动行走设备的激光信号处理模块传输至自动行走设备的定位计算模块的通讯时长T_com；计算第一信标角度的补偿时长T_final＝T_sync+T_com；根据补偿时长T_final，通过第一信标角度误差补偿公式，计算出第一信标角度的补偿角度值。

作为本发明一实施方式的进一步改进，所述方法还包括：当自动行走设备在第一方向匀速直线运动时，获取激光转台实际测得的第一信标角度A_n以及相应的激光转台实际旋转时长T_n，其中，n为激光转台的旋转圈数序号。

作为本发明一实施方式的进一步改进，所述方法还包括：根据至少两组数据(A_n，T_n)，通过最小二乘法拟合公式，计算得到关于第一信标角度的误差补偿公式。

作为本发明一实施方式的进一步改进，所述方法还包括：根据至少两组数据(A_n，T_n)，通过加权最小二乘法拟合公式，计算得到关于第一信标角度的误差补偿公式。

作为本发明一实施方式的进一步改进，所述方法还包括：获取第一信标角度信号从自动行走设备的激光信号处理模块传输至自动行走设备的定位计算模块的通讯时长T_com；计算第一信标角度的补偿时长T_final＝T_sync+T_com；获取实际旋转时长T_n与补偿时长T_final之间的时间差t1；计算权重系数其中，β为大于零的常数；根据至少两组数据(A_n，T_n)与权重系数c，通过加权最小二乘法公式，计算得到关于第一信标角度的误差补偿公式。

作为本发明一实施方式的进一步改进，所述方法还包括：在激光转台连续旋转5圈之后，获取对应的5组不同数据(A_n，T_n)；根据5组不同数据(A_n，T_n)，通过最小二乘法拟合公式，计算得到关于第一信标角度的误差补偿公式。

作为本发明一实施方式的进一步改进，所述方法还包括：将n分别取值m-5、m-4、m-3、m-2以及m-1，获取与时刻T_sync最邻近的五组数据(A_m-5，T_m-5)、(A_m-4，T_m-4)、(A_m-3，T_m-3)、(A_m-2，T_m-2)以及(A_m-1，T_m-1)。

作为本发明一实施方式的进一步改进，所述方法还包括：获取激光转台从第n圈起始位置时至接收到第一反光信标发出的激光反射信号时的时差t2；获取激光转台旋转n-1圈的消耗时长t_round；计算激光转台实际旋转时长T_n＝t2+t_round。

作为本发明一实施方式的进一步改进，所述方法还包括：通过激光转台内的角度编码器测量实际的第一信标角度；接收角度编码器发出的第一信标角度信号。

作为本发明一实施方式的进一步改进，所述方法还包括：获取第二信标角度的误差补偿公式，根据旋转时长T_sync，通过第二信标角度误差补偿公式，计算出第二信标角度的补偿角度值；获取第三信标角度的误差补偿公式，根据旋转时长T_sync，通过第三信标角度误差补偿公式，计算出第三信标角度的补偿角度值；根据三个信标相应的补偿角度值，获取自动行走设备的坐标位置。

作为本发明一实施方式的进一步改进，所述自动行走设备为割草机器人。

本发明还提供一种自动行走设备，包括存储器与处理器，所述存储器存储有可在所述处理器上运行的计算机程序，所述处理器执行所述程序时实现上述任意一项所述的反光信标夹角误差补偿方法中的步骤。

本发明还提供一种存储介质，所述存储介质存储于计算机程序，其特征在于，所述计算机程序被处理器执行时实现上述任意一项所述的反光信标夹角误差补偿方法中的步骤。

与现有技术相比，本发明的有益效果在于：在自动行走设备在第一方向匀速直线运动中，通过获取关于反光信标夹角的角度误差补偿公式，并根据获取的激光转台当前旋转时长来计算当前反光信标的补偿角度值，以对反光信标夹角进行误差补偿；同时，在激光转台旋转5圈之后，获取激光转台旋转至当前一圈起始位置时的旋转时长，根据这个5圈之后的旋转时长来计算所有反光信标的补偿角度值，以便通过多个反光信标的补偿角度值分析出自动行走设备的坐标位置，即自动行走设备在工作区域当前所处的位置信息，从而便于精准定位与控制自动行走设备。

附图说明

图1是本发明实施例中反光信标夹角误差补偿方法的流程图；

图2是本发明实施例中自动行走设备的模块示意图。

具体实施方式

为使本申请的目的、技术方案和优点更加清楚，下面将结合本申请具体实施方式及相应的附图对本申请技术方案进行清楚、完整地描述。显然，所描述的实施方式仅是本申请一部分实施方式，而不是全部的实施方式。基于本申请中的实施方式，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施方式，都属于本申请保护的范围。

下面详细描述本发明的实施方式，实施方式的示例在附图中示出，其中自始至终相同或类似的标号表示相同或类似的元件或具有相同或类似功能的元件。下面通过参考附图描述的实施方式是示例性的，仅用于解释本发明，而不能理解为对本发明的限制。

如图1所示，本发明实施例提供了一种反光信标夹角误差补偿方法，所述方法包括以下若干步骤，下面对所述方法进行说明：

S2当自动行走设备在第一方向匀速直线运动时，获取激光转台从静止状态旋转至第m圈起始位置时的旋转时长T_sync，其中，整数m≥6；

S4根据旋转时长T_sync，通过第一信标角度误差补偿公式，计算出第一信标角度的补偿角度值，其中，第一信标角度误差补偿公式为自动行走设备在第一方向匀速直线运动时第一信标角度关于激光转台旋转时长的函数公式，第一信标角度为第一反光信标发出的激光反射信号与自动行走设备行走方向之间的夹角。

在移动机器人等自动行走设备的工作区域中，预先放置多个反光信标，且多个反光信标在工作区域内的位置坐标等信息是已知的。

实际行走过程中，激光转台发出激光信号时刻与接收激光反射信号时刻以及反光信标发出反射激光信号时刻均不在同一时刻点，且自动行走设备一直处于行走状态，激光转台也一直处于旋转状态，这些因素会导致采集或获取的反光信标夹角不准确，因此需要进行角度误差补偿。

本发明实施例中，设置有至少三个反光信标，可通过获取同一时刻至少三个反光信标的补偿角度值对自动行走设备进行分析定位。

本发明实施例以第一反光信标为例，对误差补偿方法进行具体描述。

为补偿时差、运动状态等因素对第一反光信标夹角采集带来的误差，可事先计算出对第一反光信标夹角的误差补偿公式，即第一信标角度误差补偿公式。为保证误差补偿的精度，误差补偿公式的推算前提是自动行走设备在第一方向匀速直线运动状态，即自动行走设备方向稳定不变、匀速行走时，误差补偿公式才适用，可对此运动状态下的反光信标夹角进行较精确的补偿。其中，第一方向是指自动行走设备当前的行走方向。

其中，可先测量第一反光信标或第一信标的实际夹角、对应的激光转台旋转时长这两种数据，根据两种数据计算得出误差补偿公式，即第一信标角度关于激光转台旋转时长的函数公式。具体的函数公式也可以是根据最小二乘法或加权最小二乘法等公式计算得出。

为对自动行走设备进行定位计算，需要获取同一时刻多个反光信标的补偿角度值。考虑到激光转台旋转至每圈起始位置即机械零点时，可触发自动行走设备的所有计算与处理功能，本实施例中，将激光转台旋转至第m圈起始位置时的时间点作为多个反光信标夹角获取的同步时间点，且m≥6，即激光转台从静止状态开始旋转了至少5圈。

先获取激光转台从静止状态旋转至第m圈起始位置时的旋转时长T_sync，再通过上述获取的第一信标角度误差补偿公式，计算出第一信标角度的补偿角度值，对第一反光信标的夹角进行修正。

此外，还可在旋转时长T_sync基础上考虑数据信号传输的时差，将信号传输时差与旋转时长T_sync两者之和作为最终的补偿时长数值，来计算第一信标角度的补偿角度值。

本实施例中的反光信标夹角误差补偿方法，在考虑误差补偿效果的情况下，获取在激光转台从静止状态旋转至少5圈之后、激光转台旋转至当前一圈起始位置的时间点T_sync，根据预先获得的反光信标角度误差补偿公式，计算出对应的反光信标补偿角度值，对当前反光信标的夹角进行修正；并将T_sync对应的时间点作为同步获取其他反光信标夹角的同步时间点，从而方便后续通过多个反光信标的补偿角度值来分析出自动行走设备的坐标位置。

进一步的，在步骤S4之后，所述方法还包括：

获取第一信标角度信号从自动行走设备的激光信号处理模块传输至自动行走设备的定位计算模块的通讯时长T_com；

计算第一信标角度的补偿时长T_final＝T_sync+T_com；

根据补偿时长T_final，通过第一信标角度误差补偿公式，计算出第一信标角度的补偿角度值。

本发明实施例中，自动行走设备系统包括激光信号处理模块(scanner)与定位计算模块(main)，激光信号处理模块(scanner)可用于生产角度数据、保存历史角度数据或创建推算公式；定位计算模块(main)可用于搜集通讯时间或计算推算角；角度、时间等数据信号从激光信号处理模块(scanner)传输至定位计算模块(main)时，存在一定的通信时差T_com。

为保证误差补偿精度，在同步时间T_sync时间基础上考虑这个通信时差，即计算补偿时长T_final＝T_sync+T_com，通过补偿时长T_final来计算补偿角度值，即将补偿角度值作为对第一反光信标夹角的修正。

当然，当通信时差T_com足够小时，也可以忽略不计，不纳入考虑。

进一步的，在步骤S4之前，所述方法还包括：

S31当自动行走设备在第一方向匀速直线运动时，获取激光转台实际测得的第一信标角度A_n以及相应的激光转台实际旋转时长T_n，其中，n为激光转台的旋转圈数序号。

本发明实施例中，第一信标角度误差补偿公式可通过最小二乘法或加权最小二乘法公式计算得出。

在自动行走设备沿着第一方向这个固定方向匀速运动时，可先采集第一反光信标的实际夹角A_n以及当前采集时间点T_n，即同时获取或采集第一反光信标夹角A_n与激光转台旋转时长T_n；并通过多次获取或采集得到的多组数据(A_n，T_n)，然后结合最小二乘法或加权最小二乘法的推导公式，推导出具体的第一信标角度误差补偿公式。其中，具体的第一信标角度误差补偿公式是指包含具体参数数值的公式，将旋转时长代入公式后，可计算出确定的补偿角度值。

进一步的，在步骤S31之后，所述方法还包括：

S33根据至少两组数据(A_n，T_n)，通过最小二乘法拟合公式，计算得到关于第一信标角度的误差补偿公式。

进一步的，在步骤S31之后，所述方法还包括：

S35根据至少两组数据(A_n，T_n)，通过加权最小二乘法拟合公式，计算得到关于第一信标角度的误差补偿公式。

在利用最小二乘法或加权最小二乘法推导公式推导时，得到的第一信标角度误差补偿公式为第一信标角度关于激光转台旋转时长的线性函数公式，可通过两组或多组实测数据(A_n，T_n)来计算出公式中的参数，从而得到具体的第一信标角度误差补偿公式。

进一步的，对于步骤S35，所述方法具体包括：

获取第一信标角度信号从自动行走设备的激光信号处理模块传输至自动行走设备的定位计算模块的通讯时长T_com；

计算第一信标角度的补偿时长T_final＝T_sync+T_com；

获取实际旋转时长T_n与补偿时长T_final之间的时间差t1；

计算权重系数其中，β为大于零的常数；

根据至少两组数据(A_n，T_n)与权重系数c，通过加权最小二乘法公式，计算得到关于第一信标角度的误差补偿公式。

在通过加权最小二乘法推导公式计算具体的第一信标角度误差补偿公式时，权重系数c的选择不限。

实测数据(A_n，T_n)的采集时间点越接近补偿时间点T_final，实测数据的可信度越高，最终得到的第一信标角度的补偿角度值也越准确。

基于此，可获取实测数据的采集时间点与补偿时间点T_final之间的时间差t1，将时间差t1的倒数作为权重系数；此外，为避免分母为0的情况，添加大于零的常数β，将t1与β两者之和的倒数作为最终的权重系数c，即由此，可推导计算出具体的第一信标角度误差补偿公式。

当然，当通信时差T_com足够小可以忽略不计时，也可只获取实测数据的采集时间点与同步时间T_sync之间的时间差，并将此时间差的倒数作为最终的权重系数，来推导计算具体公式。

进一步的，对于步骤S33，所述方法具体包括：

S331在激光转台连续旋转5圈之后，获取对应的5组不同数据(A_n，T_n)；

S333根据5组不同数据(A_n，T_n)，通过最小二乘法拟合公式，计算得到关于第一信标角度的误差补偿公式。

进一步的，对于步骤S331，所述方法具体包括：

将n分别取值m-5、m-4、m-3、m-2以及m-1，获取与时刻T_sync最邻近的五组数据(A_m-5，T_m-5)、(A_m-4，T_m-4)、(A_m-3，T_m-3)、(A_m-2，T_m-2)以及(A_m-1，T_m-1)。

本发明实施例中，为保证最小二乘法公式的拟合精度，可通过5组实测数据(A_n，T_n)来计算公式。

较佳的，5组不同数据(A_n，T_n)是通过激光转台连续旋转5圈获取的数据，可避免数据不连续导致公式拟合精度不高的问题。

此外，实测数据的采集时间点越接近同步时间点T_sync或补偿时间点T_final时，实测数据的可信度越高，推导得到的最小二乘法拟合公式的拟合精度也越高，计算得到的角度补偿值也越准确；由于通讯时差是固定不变的，因此，可获取与同步时间T_sync最邻近的五组实测数据，根据这五组实测数据推导出具体的第一信标角度误差补偿公式。

由此，通过递进式选取与T_sync时刻最接近的五组实测数据，来推导角度误差补偿公式，可极大提高误差补偿公式的拟合精度，避免间隔时间过长、实测数据采集不够及时带来的拟合精度问题。

进一步的，对于步骤S31，所述方法具体包括：

获取激光转台从第n圈起始位置时至接收到第一反光信标发出的激光反射信号时的时差t2；

获取激光转台旋转n-1圈的消耗时长t_round；

计算激光转台实际旋转时长T_n＝t2+t_round。

进一步的，对于步骤S31，所述方法具体包括：

通过激光转台内的角度编码器测量实际的第一信标角度；

接收角度编码器发出的第一信标角度信号。

激光转台具有机械零点，当激光转台旋转至机械零点时，激光信号处理模块(scanner)可以得到一个机械零信号；记录相邻两个机械零信号出现的时间间隔，即可得到激光转台旋转一周所需要的时长t_round；实际旋转过程中，激光转台每一圈的旋转时长可能不相同。

为得到激光转台实际旋转时长T_n，可先获取激光转台旋转n-1圈的总消耗时长t_round，并获取激光转台从当前一圈机械零点至接收到激光反射信号时的时差，即激光转台从第n圈起始位置时至接收到第一反光信标发出的激光反射信号时的时差t2；计算t_round与t2两者之和，可最终得到激光转台实际旋转时长T_n。

此外，激光转台的机械零点与角度编码器自身的零点重合，角度编码器的零点信号是自动行走设备系统中所有计算与处理功能的触发信号。角度编码器设于激光转台内，用于检测激光反射光束和自动行走设备行走方向上的夹角，即每个反光信标的夹角。在检测到第一反光信标的实际夹角后，角度编码器可将实际夹角信息发送给定位计算模块(main)进行计算与处理。

进一步的，在步骤S4之后，所述方法还包括：

获取第二信标角度的误差补偿公式，根据旋转时长T_sync，通过第二信标角度误差补偿公式，计算出第二信标角度的补偿角度值；

获取第三信标角度的误差补偿公式，根据旋转时长T_sync，通过第三信标角度误差补偿公式，计算出第三信标角度的补偿角度值；

根据三个信标相应的补偿角度值，获取自动行走设备的坐标位置。

为了对自动行走设备进行定位计算，本实施例中设置有三个反光信标，通过获取三个反光信标的补偿角度值来对自动行走设备进行分析定位。

与第一反光信标类似，可通过上述方法步骤获取其他两个反光信标的补偿角度值；补偿角度值可以是与同步时间点T_sync对应的补偿角度值，也可以是与补偿时间点T_final对应的补偿角度值。

较佳的，通过获取三个反光信标的角度补偿值，即第一信标角度补偿角度值、第二信标角度补偿角度值、以及第三信标角度补偿角度值这三个补偿角度值，来分析计算自动行走设备具体的坐标位置信息。

如图2所示，本发明实施例还提供了一种自动行走设备，包括存储器与处理器，所述存储器存储有可在所述处理器上运行的计算机程序，所述处理器执行所述程序时实现如上任意一项所述的反光信标夹角误差补偿方法中的步骤。

进一步的，所述自动行走设备为割草机器人。

具体的，本发明实施例中的自动行走设备为割草机器人。

本发明实施例还提供了一种存储介质，所述存储介质存储于计算机程序，所述计算机程序被处理器执行时实现如上任意一项所述的反光信标夹角误差补偿方法中的步骤。

下面针对反光信标夹角误差补偿方法进行整体描述：

本发明实施例中，自动行走设备为割草机器人，其工作区域中预先放置三个反光信标，且三个反光信标在工作区域内的位置坐标等信息是已知的。

为对割草机器人进行分析定位，需要获取同一时刻三个反光信标的夹角。为补偿时差、运动状态等因素对反光信标夹角带来的误差，需要对三个反光信标的夹角一一进行误差补偿，以最终获取同一时刻三个反光信标的补偿角度值。

需要说明的是，本发明实施例中，当割草机器人沿着第一方向以方向不变、匀速移动的运动状态运动时，本误差补偿方法才适用。第一方向是指割草机器人当前的行走方向。

获取激光转台从静止状态旋转至第m圈起始位置时的旋转时长T_sync，其中，整数m≥6，即激光转台在旋转至少5圈之后到达当前一圈起始位置时的时间点为T_sync，将T_sync作为同步获取三个反光信标夹角的时间点，从而来计算三个反光信标对应的补偿角度值。

考虑到角度、时间等信号从激光信号处理模块(scanner)传输至定位计算模块(main)时存在通讯时差，可先获取这个通信时差T_com，然后计算补偿时长T_final＝T_sync+T_com，将补偿时长T_final对应的时间点作为最终同步获取三个反光信标夹角的时间点，以便计算三个反光信标对应的补偿角度值。

在割草机器人沿着第一方向方向不变、匀速运动时，割草机器人上的激光转台也一直匀速旋转；当激光转台旋转至第n圈时，可通过激光转台上的角度编码器检测第一反光信标实际夹角A_n，并获取与A_n对应的激光转台旋转时长T_n，形成一组实测数据(A_n，T_n)；其中，T_n对应的时间点是激光转台接收到第一反光信标发出的激光发射信号的时刻。

为保证实测数据采集的及时有效，可将激光转台最接近同步时间点T_sync或补偿时间点T_final的连续5圈旋转作为实测数据采集范围，以获取对应的连续五组实测数据(A_m-5，T_m-5)、(A_m-4，T_m-4)、(A_m-3，T_m-3)、(A_m-2，T_m-2)以及(A_m-1，T_m-1)，并形成实测数据矩阵。

其中，激光转台从第n圈起始位置旋转至接收到激光反射信号时刻的时差为t2，激光转台旋转n-1圈的总消耗时长为t_round，激光转台实际旋转时长T_n为t2与t_round两者之和；实测角度A_n由角度编码器检测得到后壳发送给定位计算模块(main)进行计算处理。

为提高拟合精度，可通过加权最小二乘法推导公式来获取角度误差补偿公式，为此，需要先确定权重系数c：获取每个实际旋转时长T_n与补偿时间点T_final之间的时间差t1，计算时间差t1与大于零的常数β两者之和，将两者之和的倒数作为与每个实际旋转时长T_n对应的权重系数c，即由此，一一计算得到对应的5个权重系数，并形成权重矩阵。

然后，根据上述实测数据矩阵与上述权重矩阵，通过加权最小二乘法推导公式，计算得到具体的第一反光信标误差补偿公式。

类似的，通过上述方法与步骤，可同样得到具体的第二反光信标误差补偿公式以及具体的第三反光信标误差补偿公式。

最终，根据补偿时长T_final，通过三个误差补偿公式计算得到三个反光信标对应的角度补偿值，以便进一步分析得到割草机器人在工作区域内的坐标位置信息。

综上，本发明提供的反光信标夹角误差补偿方法、自动行走设备以及存储介质，所述方法在考虑误差补偿效果的情况下，获取在激光转台从静止状态旋转至少5圈之后、激光转台旋转至当前一圈起始位置的时间点T_sync，根据预先获得的反光信标角度误差补偿公式，计算对应的反光信标补偿角度值，对反光信标夹角进行修正；并将T_sync作为同步获取其他反光信标夹角的时间点，从而方便后续通过多个反光信标的补偿角度值分析自动行走设备的坐标位置信息。

应当理解，虽然本说明书按照实施方式加以描述，但并非每个实施方式仅包含一个独立的技术方案，说明书的这种叙述方式仅仅是为清楚起见，本领域技术人员应当将说明书作为一个整体，各实施方式中的技术方案也可以经适当组合，形成本领域技术人员可以理解的其他实施方式。

上文所列出的一系列的详细说明仅仅是针对本发明的可行性实施方式的具体说明，并非用以限制本发明的保护范围，凡未脱离本发明技艺精神所作的等效实施方式或变更均应包含在本发明的保护范围之内。

Claims (10)

1.一种反光信标夹角误差补偿方法，其特征在于，包括：

当自动行走设备在第一方向匀速直线运动时，获取激光转台从静止状态旋转至第m圈起始位置时的旋转时长T_sync、激光转台实际测得的第一信标角度A_n以及相应的激光转台实际旋转时长T_n，其中，n为激光转台的旋转圈数序号，整数m≥6；

根据至少两组数据(A_n，T_n)，通过最小二乘法拟合公式或加权最小二乘法拟合公式，计算得到关于第一信标角度的误差补偿公式；

根据旋转时长T_sync，通过第一信标角度误差补偿公式，计算出第一信标角度的补偿角度值，其中，第一信标角度误差补偿公式为自动行走设备在第一方向匀速直线运动时第一信标角度关于激光转台旋转时长的函数公式，第一信标角度为第一反光信标发出的激光反射信号与自动行走设备行走方向之间的夹角；

其中，所述根据至少两组数据(A_n，T_n)，通过加权最小二乘法拟合公式，计算得到关于第一信标角度的误差补偿公式，包括：

获取第一信标角度信号从自动行走设备的激光信号处理模块传输至自动行走设备的定位计算模块的通讯时长T_com；

计算第一信标角度的补偿时长T_final＝T_sync+T_com；

获取实际旋转时长T_n与补偿时长T_final之间的时间差t1；

计算权重系数其中，β为大于零的常数；

根据至少两组数据(A_n，T_n)与权重系数c，通过加权最小二乘法公式，计算得到关于第一信标角度的误差补偿公式。

2.根据权利要求1所述的反光信标夹角误差补偿方法，其特征在于，步骤“根据旋转时长T_sync，通过第一信标角度误差补偿公式，计算出第一信标角度的补偿角度值”具体包括：

获取第一信标角度信号从自动行走设备的激光信号处理模块传输至自动行走设备的定位计算模块的通讯时长T_com；

计算第一信标角度的补偿时长T_final＝T_sync+T_com；

根据补偿时长T_final，通过第一信标角度误差补偿公式，计算出第一信标角度的补偿角度值。

3.根据权利要求1所述的反光信标夹角误差补偿方法，其特征在于，步骤“根据至少两组数据(A_n，T_n)，通过最小二乘法拟合公式，计算得到关于第一信标角度的误差补偿公式”具体包括：

在激光转台连续旋转5圈之后，获取对应的5组不同数据(A_n，T_n)；

根据5组不同数据(A_n，T_n)，通过最小二乘法拟合公式，计算得到关于第一信标角度的误差补偿公式。

4.根据权利要求3所述的反光信标夹角误差补偿方法，其特征在于，步骤“在激光转台连续旋转5圈之后，获取对应的5组不同数据(A_n，T_n)”具体包括：

将n分别取值m-5、m-4、m-3、m-2以及m-1，获取与时刻T_sync最邻近的五组数据(A_m-5，T_m-5)、(A_m-4，T_m-4)、(A_m-3，T_m-3)、(A_m-2，T_m-2)以及(A_m-1，T_m-1)。

5.根据权利要求1所述的反光信标夹角误差补偿方法，其特征在于，步骤“当自动行走设备在第一方向匀速直线运动时，获取激光转台实际测得的第一信标角度A_n以及相应的激光转台实际旋转时长T_n，其中，n为激光转台的旋转圈数序号”具体包括：

获取激光转台从第n圈起始位置时至接收到第一反光信标发出的激光反射信号时的时差t2；

获取激光转台旋转n-1圈的消耗时长t_round；

计算激光转台实际旋转时长T_n＝t2+t_round。

6.根据权利要求1所述的反光信标夹角误差补偿方法，其特征在于，步骤“当自动行走设备在第一方向匀速直线运动时，获取激光转台实际测得的第一信标角度A_n以及相应的激光转台实际旋转时长T_n，其中，n为激光转台的旋转圈数序号”具体包括：

通过激光转台内的角度编码器测量实际的第一信标角度；

接收角度编码器发出的第一信标角度信号。

7.根据权利要求1所述的反光信标夹角误差补偿方法，其特征在于，在步骤“根据旋转时长T_sync，通过第一信标角度误差补偿公式，计算出第一信标角度的补偿角度值”之后，所述方法还包括：

获取第二信标角度的误差补偿公式，根据旋转时长T_sync，通过第二信标角度误差补偿公式，计算出第二信标角度的补偿角度值；

获取第三信标角度的误差补偿公式，根据旋转时长T_sync，通过第三信标角度误差补偿公式，计算出第三信标角度的补偿角度值；

根据三个信标相应的补偿角度值，获取自动行走设备的坐标位置。

8.一种自动行走设备，包括存储器与处理器，所述存储器存储有可在所述处理器上运行的计算机程序，其特征在于，所述处理器执行所述程序时实现权利要求1至7任意一项所述的反光信标夹角误差补偿方法中的步骤。

9.根据权利要求8所述的自动行走设备，其特征在于，所述自动行走设备为割草机器人。

10.一种存储介质，所述存储介质存储于计算机程序，其特征在于，所述计算机程序被处理器执行时实现权力要求1至7任意一项所述的反光信标夹角误差补偿方法中的步骤。