[发明专利]一种轮式机器人的误差调校方法和装置

权利要求书

1.一种轮式机器人的误差调校方法，其特征在于，所述方法包括：

通过往返测试的方式，获取轮式机器人往返的实际距离L_act、在拐点顺时针拐弯时的往返路线的第一夹角α_cw，以及在拐点逆时针拐弯时的往返路线的第二夹角α_ccw；

根据所述第一夹角和所述第二夹角确定第二偏差角α与第一偏差角θ之和θ+α，以及由左右轮直径不等引起的第三偏差角β，其中，第二偏差角α由理论轮距与实际轮距的偏差所产生，第一偏差角θ由理想平均轮径与实际轮径的偏差所产生；

根据述述往返的实际距离L_act与轮式机器人的理论距离值，获得理想平均轮径与实际轮径之间的偏差的调校参数Es，根据所述调校参数Es确定由理想轮平均轮径与实际轮径的偏差所产生的第一偏差角θ；

根据所述第一偏差角θ，以及第一偏差角与第二偏差角之和θ+α，确定理论轮距与实际轮距的调校参数Eb，根据所述第三偏差角β、所述往返的实际距离L_act以及实际轴距离，确定左右轮直径不等调校参数Ed。

2.如权利要求1所述的轮式机器人的误差调校方法，其特征在于，所述根据所述第一夹角和所述第二夹角确定第二偏差角α与第一偏差角θ之和θ+α，以及由左右轮直径不等引起的第三偏差角β的步骤具体为：

根据公式θ+α＝(α_cw-α_ccw)/2确定第二偏差角α与第一偏差角θ之和θ+α；

根据公式β＝(α_cw+α_ccw)/2确定由左右轮直径不等引起的第三偏差角β。

3.如权利要求1所述的轮式机器人的误差调校方法，其特征在于，所述根据述述往返的实际距离L_act与轮式机器人的理论距离值，获得理想平均轮径与实际轮径之间的偏差的调校参数Es，根据所述调校参数Es确定由理想平均轮径与实际轮径的偏差所产生的第一偏差角θ的步骤具体为：

判断所述第三偏差角β是否为零；

如果第三偏差角β为零，则根据公式计算理想平均轮径与实际轮径之间的偏差的调校参数Es＝L_act/L_nom，其中，L_nom为理论上的单程直线距离，L_act为实际距离；

如果所述第三偏差角β不为零，则根据公式计算得到理想平均轮径与实际轮径之间的偏差的调校参数；

根据公式θ＝π(1-Es)确定由理想平均轮径与实际轮径的偏差所产生的第一偏差角θ。

4.根据权利要求1所述的轮式机器人的误差调校方法，其特征在于，所述根据所述第一偏差角θ，以及第一偏差角与第二偏差角之和θ+α，确定理论轮距与实际轮距的调校参数Eb的步骤包括：

根据公式Eb＝(π-θ)/(π-(θ+α))确定所述理论轮距与实际轮距的调校参数Eb。

5.根据权利要求1所述的轮式机器人的误差调校方法，其特征在于，所述根据所述第三偏差角、所述往返的实际距离L_act以及实际轴距离，确定左右轮直径不等调校参数Ed的步骤包括：

判断由左右轮直径不等引起的第三偏差角β是否大于零；

如果所述第三偏差角β大于零，则所述轮直径不等调校参数如果所述第三偏差角β大于零，则所述轮直径不等调校参数其中b_act为机器人实际轮距。