八轮全向电机驱动移动平台系统及其控制方法技术方案

技术编号:38491475 阅读:28 留言:0更新日期:2023-08-15 17:04
本发明专利技术涉及驱动轮技术控制领域,具体涉及八轮全向电机驱动移动平台系统及其控制方法。包括四个车轮组件,四个车轮组件均包括左轮毂电机和右轮毂电机,左轮毂电机和右轮毂电机分别连接有左车轮和右车轮,左车轮和右车轮形成车轮模组,左轮毂电机和右轮毂电机均连接有方向角度传感器,方向角度传感器连接有DIR方向模块,DIR方向模块连接有CAN数据解码模块,CAN数据解码模块连接主控模块,左轮毂电机通过左功率驱动模块连接有左FOC软件模块,右轮毂电机通过右功率驱动模块连接有右FOC软件模块。使整个移动平台按照主控模块最开始设定的方向基准值和速度基准值前进,运动过程可根据需要不断调整误差,使之达到主控模块既定的方向和速度完成运动。和速度完成运动。和速度完成运动。

【技术实现步骤摘要】
八轮全向电机驱动移动平台系统及其控制方法


[0001]本专利技术涉及驱动轮技术控制领域,具体涉及八轮全向电机驱动移动平台系统及其控制方法。

技术介绍

[0002]自动导引运输车(AGV:Automated Guided Vehicle)是一种装备有电磁或光学等自动导引装置的运输车,它能够沿规定的导引路径行驶,以搬运物料,得到了广泛应用。然而,AGV的转向性能较差,如无法在复杂路况下正常行走,从而无法满足实际的需要。
[0003]有鉴于此,本专利技术提供一种八轮全向电机驱动移动平台系统及其控制方法。

技术实现思路

[0004]本专利技术的目的在于针对现有技术的不足,提供八轮全向电机驱动移动平台系统及其控制方法。
[0005]为了解决上述技术问题,采用如下技术方案:八轮全向电机驱动移动平台系统,包括四个车轮组件,所述车轮组件的结构相同,且四个所述车轮组件均包括左轮毂电机、右轮毂电机、左功率驱动模块、右功率驱动模块、左FOC软件模块和右FOC软件模块,所述左轮毂电机和右轮毂电机分别连接有左车轮和右车轮,所述左车轮和右车轮形成车轮模组,所述左轮毂电机和右轮毂电机均连接有方向角度传感器,所述方向角度传感器连接有DIR方向模块,所述DIR方向模块连接有CAN数据解码模块,所述CAN数据解码模块连接主控模块,所述左轮毂电机连接有左功率驱动模块,所述左功率驱动模块连接有左FOC软件模块,所述右轮毂电机连接有右功率驱动模块,所述右功率驱动模块连接有右FOC软件模块,所述左FOC软件模块和右FOC软件模块均连接有CAN数据解码模块。
[0006]八轮全向电机驱动移动平台系统的转向控制方法,包括以下步骤:(1)先通过所述CAN数据解码模块传送并解码得到所述主控模块的所述车轮模组的方向基准值DIR.ref和速度基准值SP.ref(all)。然后通过所述方向角度传感器得到第一组所述车轮模组的方向反馈值DIR.fback;最后通过上述的方向基准值DIR.ref和方向反馈值DIR.fback,得到所述车轮模组的方向误差值DIR.err。
[0007](2)通过所述左FOC软件模块和右FOC软件模块的速度PI调节,分别调整左车轮和右车轮的转速,重新得到所述左车轮的左速度基准SP.ref(L)和右车轮的右速度基准SP.ref(R)。
[0008](3)先通过所述左轮毂电机的转子位置编码器和所述右轮毂电机的转子位置编码器,分别将左车轮实际的左车轮反馈速度SP.fback(L)和右车轮反馈速度SP.fback(L)传送给左FOC软件模块和右FOC软件模块,从而得到左车轮的左车轮速度误差SP.err (L)和右车轮的右车轮速度误差SP.err (R)。
[0009](4)重复上述步骤(2)和步骤(3),直至左车轮的左车轮速度误差SP.err (L)和右
车轮的右车轮速度误差SP.err(R)均为零,从而使方向偏差值DIR.err=0,最后所述左车轮和右车轮以相同的速度按照指定的方向前进。
[0010](5)按照上述步骤(1)至步骤(4)的方式,调整其他三组所述车轮模组的车轮,使所述移动平台按照设定的方向进行转动。
[0011]进一步,在所述步骤(1)中,设定所述车轮模组指向主控模块的基准方式时,所述方向角度传感器输出方向反馈值DIR.fback=0,当所述车轮模组方向往0点左偏时,DIR.fback为负数,当方向往0点右偏时,DIR.fback为正数。
[0012]进一步,在所述步骤(1)中,所述车轮模组的方向误差值DIR.err的计算公式如下。
[0013]DIR.err =DIR.ref

DIR.fback。
[0014]如果所述方向误差值DIR.err为零时,反应了当前所述车轮模组的车轮方向正常运动。
[0015]如果所述方向误差值DIR.err为正数时,反应了当前所述车轮模组的车轮偏左。
[0016]如果所述方向误差值DIR.err为负数时,反应了当前所述车轮模组的车轮偏右。
[0017]进一步,在所述步骤(2)中,所述左车轮的左速度基准SP.ref(L)和右车轮的右速度基准SP.ref(R)的计算公式如下:SP.ref(L) = SP.ref(all) + DIR.err * kp +Σ(DIR.err * ki) ;SP.ref(R) = SP.ref(all)
ꢀ‑ꢀ
DIR.err * kp
ꢀ‑
Σ(DIR.err * ki) ;其中,kp和ki为左FOC软件模块和右FOC软件模块的速度PI调节系数;进一步,在所述步骤(3)中,所述左车轮的左车轮速度误差SP.err (L)和右车轮的右车轮速度误差SP.err(R) 的计算公式如下:SP.err(L)=SP.ref(L)

SP.fback(L);SP.err(R)=SP.ref(R)

SP.fback(R);通过比较左速度基准SP.ref(L)和左车轮反馈速度SP.fback(L)的差值,及其右速度基准SP.ref(R)和右车轮反馈速度SP.fback(R) 的差值,分别得到所述左车轮的左车轮速度误差SP.err (L)和右车轮的右车轮速度误差SP.err (R)。
[0018]进一步,在所述步骤(3)中,所述左车轮速度误差SP.err (L)和右车轮速度误差SP.err (R)分别通过左FOC软件模块和右FOC软件模块的速度PI调节,得到左轮毂电机和右轮毂电机的IQ电流基准值,公式如下:IQ.ref(L) = SP.err (L) * kp + Σ(SP.err (L) * ki) ; 所述IQ.ref(L)为左轮毂电机的IQ电流基准值;IQ.ref(R) = SP.err (R) * kp +Σ(SP.err (R) * ki) ; 所述IQ.ref(R)为右轮毂电机的IQ电流基准值。
[0019]进一步,在所述步骤(4)中,通过左轮毂电机的IQ电流基准值和右轮毂电机的IQ电流基准值,重新调整所述左车轮的左速度基准SP.ref(L)和右车轮的右速度基准SP.ref(R),直至左车轮的左车轮速度误差SP.err (L)和右车轮的右车轮速度误差SP.err(R)均为零,从而使方向偏差值DIR.err=0,最后所述左车轮和右车轮以相同的速度按照指定的方向前进。
[0020]由于采用上述技术方案,具有以下有益效果:本专利技术为八轮全向电机驱动移动平台系统及其控制方法,本控制方法先将移动平
台设置四个车轮组件,每组车轮组件上均设有2个车轮,将2个车轮形成一组差速轮结构;并每个车轮都匹配有相应的功率驱动模块和FOC软件模块;然后通过所述CAN数据解码模块传送并解码得到所述主控模块的所述车轮模组的方向基准值DIR.ref和速度基准值SP.ref(all),与方向角度传感器得到的方向反馈值DIR.fback相比较,如果两者不相等,表示该组的车轮模组的方向有偏差。接着通过所述左FOC软件模块和右本文档来自技高网
...

【技术保护点】

【技术特征摘要】
1.八轮全向电机驱动移动平台系统,包括四个车轮组件,所述车轮组件的结构相同,其特征在于:且四个所述车轮组件均包括左轮毂电机、右轮毂电机、左功率驱动模块、右功率驱动模块、左FOC软件模块和右FOC软件模块,所述左轮毂电机和右轮毂电机分别连接有左车轮和右车轮,所述左车轮和右车轮形成车轮模组,所述左轮毂电机和右轮毂电机均连接有方向角度传感器,所述方向角度传感器连接有DIR方向模块,所述DIR方向模块连接有CAN数据解码模块,所述CAN数据解码模块连接主控模块,所述左轮毂电机连接有左功率驱动模块,所述左功率驱动模块连接有左FOC软件模块,所述右轮毂电机连接有右功率驱动模块,所述右功率驱动模块连接有右FOC软件模块,所述左FOC软件模块和右FOC软件模块均连接有CAN数据解码模块。2.如权利要求1所述的八轮全向电机驱动移动平台系统的转向控制方法,其特征在于包括以下步骤:(1)先通过所述CAN数据解码模块传送并解码得到所述主控模块的第一组所述车轮模组的方向基准值DIR.ref和速度基准值SP.ref(all);然后通过所述方向角度传感器得到第一组所述车轮模组的方向反馈值DIR.fback;最后通过上述的方向基准值DIR.ref和方向反馈值DIR.fback,得到所述车轮模组的方向误差值DIR.err;(2)通过所述左FOC软件模块和右FOC软件模块的速度PI调节,分别调整左车轮和右车轮的转速,重新得到所述左车轮的左速度基准SP.ref(L)和右车轮的右速度基准SP.ref(R);(3)先通过所述左轮毂电机的转子位置编码器和所述右轮毂电机的转子位置编码器,分别将左车轮实际的左车轮反馈速度SP.fback(L)和右车轮反馈速度SP.fback(L)传送给左FOC软件模块和右FOC软件模块,从而得到左车轮的左车轮速度误差SP.err (L)和右车轮的右车轮速度误差SP.err (R);(4)重复上述步骤(2)和步骤(3),直至左车轮的左车轮速度误差SP.err (L)和右车轮的右车轮速度误差SP.err(R)均为零,从而使方向偏差值DIR.err=0,最后所述左车轮和右车轮以相同的速度按照指定的方向前进;(5)按照上述步骤(1)至步骤(4)的方式,调整其他三组所述车轮模组的车轮,使所述移动平台按照设定的方向进行转动。3.根据权利要求2所述的八轮全向电机驱动移动平台系统的转向控制方法,其特征在于:在所述步骤(1)中,设定所述车轮模组指向主控模块的基准方式时,所述方向角度传感器输出方向反馈值DIR.fback=0,当所述车轮模组方向往0点左偏时,DIR.fback为负数,当方向往0点右偏时,DIR.fback为正数。4.根据权利要求2或3所述的八轮全向电机驱动移动平台系统的转向控制方法,其特征在于:在所述步骤(1)中,所述车轮模组的方向误差值DIR.err的计算公式如下:DIR.err =DIR.ref

DIR.fback;如果所述...

【专利技术属性】
技术研发人员:请求不公布姓名江先武刘文迅翟春蓓江军杨得运
申请(专利权)人:杭州龙蓓格科技有限公司
类型:发明
国别省市:

网友询问留言 已有0条评论
  • 还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。

1