一种偏心双舵轮AGV低能耗转向与运动误差补偿方法技术

本发明专利技术属于AGV运动控制技术领域，公开了一种偏心双舵轮AGV低能耗转向与运动误差补偿方法，适用于对角布置的偏心双舵轮AGV底盘的精确运动控制。本发明专利技术根据逆运动学最优求解控制AGV低能耗转向，并对转向误差进行补偿，根据给定AGV运动方向θ，速度V，以及角速度W，求解出两个舵轮的运动参数，包括舵向角R1,R2和线速度W1,W2，并且所求得舵向角R1,R2为最小转动量，具有转动能耗最优的特点；同时由于偏心舵轮在转动时受底盘自重及地面摩擦影响，无法原地转动，本发明专利技术根据舵轮转动量对行走电机进行补偿，满足偏心舵轮原地转动的需求。本发明专利技术为偏心舵轮的AGV底盘提供了低能耗转向与运动误差补偿方法。差补偿方法。差补偿方法。

【技术实现步骤摘要】
一种偏心双舵轮AGV低能耗转向与运动误差补偿方法


[0001]本专利技术属于AGV运动控制
，尤其涉及一种偏心双舵轮AGV低能耗转向与运动误差补偿方法。

技术介绍

[0002]AGV(Automated Guided Vehicle)是指自动引导车，是一种能够自主运行的物流车辆。它可以通过激光雷达、红外传感器等多种传感器来感知周围环境，采用导航算法和路径规划技术，实现自主导航和运行。由于物流行业的快速发展，AGV的应用背景越来越广，技术也越来越成熟，在制造业、医疗行业、餐饮业、军工等领域都有着广泛的应用。面对不同的作业需求，其结构设计也具有针对性，影响着AGV的稳定性、速度、载重能力等多个方面。常见的有：1)单舵轮驱动结构，适合1T以上负载，牵引车，叉车类应用场景；2)双舵轮驱动结构，适合1T以上负载，同时要求可以任意方向平移的场合；3)两轮差速驱动结构，适合500KG～1.5T负载，可以原地旋转，不能平移；4)麦克纳姆轮驱动结构，适合运行频率较低、同时要求任意方向平移和旋转的场合。其中，双舵轮底盘有两种结构布置，一种是舵轮居中布置：舵轮布置在车体中心线上，前后对称布置，直线行走时，前后舵轮调整同样的角度实现路径偏移调整，自转时，左右舵轮转动90度，变成差速式，可实现自转。另一种是舵轮对角布置，本专利技术针对双舵轮驱动结构中舵轮对角布置的情况，运动形式相较中心线布置时调整较为复杂，如果逆运动学求解不准确就会存在牵连运动，导致底盘发生偏移，无法按照正确路径行驶，甚至无法移动。另一方面，在准确求得逆运动学解的情况下，是否考虑能耗最优、是否对转动量进行补偿对于底盘重载情况下的电量消耗、运动的准确性具有显著的意义。

技术实现思路

[0003]本专利技术目的在于提供一种偏心双舵轮AGV低能耗转向与运动误差补偿方法，以解决上述的技术问题。
[0004]为解决上述技术问题，本专利技术采用的技术方案如下：
[0005]一种偏心双舵轮AGV低能耗转向与运动误差补偿方法，所述偏心双舵轮AGV包括前方舵机和后方舵机；所述前方舵机包括转向电机一和行走电机三，所述后方舵机包括转向电机二和行走电机四，所述方法包括如下步骤：
[0006]S1：根据给定的底盘运动参数(V，W)，求解底盘中心转向半径R；
[0007]S2：根据偏心舵轮对角安装的尺寸参数，计算两个舵轮旋转中心的连线与底盘几何结构正前方的夹角α，其为计算辅助量；
[0008]S3：根据给定舵轮底盘的运动方向角A，计算辅助角θ3及长度H，用于判断舵轮转向电机转动方向与计算角度大小；
[0009]S4：根据S3的计算结果，结合两个舵轮旋转中心的连线长度L，判断舵轮转向电机一转动方向，并计算其转角θ1；
[0010]S5：同理判断舵轮转向电机二的转动方向并计算其转角θ2；
[0011]S6：根据勾股定理计算舵轮行走电机三和电机四分别对应的转弯半径R1和R2；
[0012]S7：基于计算得到的转弯半径R1和R2，结合给定的底盘绕转向中心的角速度W，得到舵轮行走电机三和行走电机四的线速度值V1和V2；
[0013]S8：根据步骤S4～S7的结果，已经求得在给定舵轮底盘运动参数V，W，A下的运动学逆解结果，根据舵轮转向电机转角进行最优选解，以使转动能耗最低；
[0014]S9：对每个舵轮，基于最优选解得到的舵轮转角，以及舵轮直径及偏心距离d
r
对舵轮行走电机进行补偿。
[0015]上述技术方案中，进一步地，所述S1求解的底盘中心转向半径R表示为：
[0016][0017]公式(1)中，V代表舵轮底盘的运动速度，W代表舵轮底盘绕转向中心的旋转角速度，eps代表微小量，数量级在10
‑
16
。
[0018]进一步地，所述S2计算两个舵轮旋转中心的连线与底盘几何结构正前方的夹角α表示为：
[0019][0020]公式(2)中，d
x
、d
y
分别为两个舵轮旋转中心连线在x和y方向上的间距。进一步地，所述S3的计算公式为：
[0021][0022]进一步地，所述S4：根据公式(3)的计算结果，判断舵轮转向电机一转动方向，并计算其转角θ1，L为两个舵轮旋转中心的连线长度，判断与计算方式如下：
[0023][0024]进一步地，所述S5：同理计算舵轮转向电机二的转动方向角θ2如下：
[0025][0026]进一步地，所述S6：计算舵轮行走电机三和行走电机四分别对应的转弯半径R1和R2，由勾股定理计算得到：
[0027][0028]公式(6)中d
r
为舵轮的偏心距离。
[0029]进一步地，所述S7：基于计算得到的转弯半径R1和R2，结合给定的底盘绕转弯半径的角速度W，得到舵轮行走电机三和行走电机四的线速度值V1和V2：
[0030][0031]公式(7)中，V和W是S1中给出的底盘运动参数，针对底盘做直线运动，即W＝0的情况，给出了相应的结果。
[0032]进一步地，所述S8：根据步骤S4～S7的结果，已经求得在给定舵轮底盘运动参数V,W,A下的运动学逆解结果(见式(4)、(5)和(7))，根据舵轮转向电机转角进行最优选解，判断条件及结果如下：
[0033][0034][0035]其他情况下维持运动学逆解结果不变。
[0036]进一步地，S9对行走电机进行补偿的计算公式为：
[0037][0038]公式(10)中，ΔΦ
1(2)
是行走电机三或行走电机四的补偿角度，D
1(2)
是对应舵轮的直径，这里行走电机的旋转以顺时针为正方向。
[0039]本专利技术的一种偏心双舵轮AGV低能耗转向与运动误差补偿方法具有以下优点：
[0040]1、本专利技术为一种偏心双舵轮AGV低能耗转向与运动误差补偿方法，通过几何分析、设计中间变量、三角划分等方法求得准确可行的运动学逆解。
[0041]2、本专利技术针对舵轮转向电机可以360
°
旋转的特性对转动角度进行最优选解，使得转动能耗最优，这种特性可以使得双舵轮AGV在重载、多弯的情况下有效降低电量消耗。
[0042]3、本专利技术针对舵轮转向过程中容易出现的牵连问题，对转动角度进行补偿，避免因牵连导致的偏移，或者因为重载而无法转动的情况。
附图说明
[0043]图1为本专利技术实施例提供的一种偏心双舵轮AGV底盘结构及参数示意图。
[0044]图2为本专利技术实施例提供的SolidWorks底盘结构关键尺寸示意图。
[0045]图3为本专利技术实施例提供的逆运动学计算结果示意图。
[0046]图4为本专利技术实施例提供的一种偏心双舵轮AGV底盘三维模型示意图。
具体实施方式
[0047]为了更好地了解本专利技术的目的、结构及功能，下面结合附图，对本专利技术一种偏心双舵轮AGV低能耗转向与运动误差补偿方法做进一步详细本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种偏心双舵轮AGV低能耗转向与运动误差补偿方法，所述偏心双舵轮AGV包括前方舵机和后方舵机；所述前方舵机包括转向电机一和行走电机三，所述后方舵机包括转向电机二和行走电机四，其特征在于，所述方法包括如下步骤：S1：根据给定的底盘运动参数(V,W)，求解底盘中心转向半径R；S2：根据偏心舵轮对角安装的尺寸参数，计算两个舵轮旋转中心的连线与底盘几何结构正前方的夹角α，其为计算辅助量；S3：根据给定舵轮底盘的运动方向角A，计算辅助角θ3及长度H；用于后续判断舵轮转向电机转动方向与计算角度大小；S4：根据S3的计算结果，结合两个舵轮旋转中心的连线长度L，判断舵轮转向电机一的转动方向，并计算其转角θ1；S5：根据S3的计算结果，结合两个舵轮旋转中心的连线长度L，判断舵轮转向电机二的转动方向，并计算其转角θ2；S6：根据勾股定理计算舵轮行走电机三和行走电机四分别对应的转弯半径R1和R2；S7：基于计算得到的转弯半径R1和R2，结合给定的底盘绕转向中心的角速度W，得到舵轮行走电机三和行走电机四的线速度值V1和V2；S8：根据步骤S4～S7的结果，已经求得在给定舵轮底盘运动参数V,W,A下的运动学逆解结果，根据舵轮转向电机转角进行最优选解，以使转动能耗最低；S9：对每个舵轮，基于最优选解得到的舵轮转角，以及舵轮直径及偏心距离d
r
对舵轮行走电机进行补偿。2.根据权利要求1所述的方法，其特征在于，所述S1求解的底盘中心转向半径R表示为：公式(1)中，V代表舵轮底盘的运动速度，W代表舵轮底盘绕转向中心的旋转角速度，eps代表微小量，数量级在10
‑
16
。3.根据权利要求1所述的方法，其特征在于，所述S2计算两个舵轮旋转中心的连线...

【专利技术属性】
技术研发人员：陈磊杰，王进，张科文，张海运，陆国栋，张建明，
申请(专利权)人：浙江钱塘机器人及智能装备研究有限公司，
类型：发明
国别省市：