CN116048012A - 一种重载mecanum轮移动平台悬挂结构及其抗偏载运动轨迹控制方法 - Google Patents

一种重载mecanum轮移动平台悬挂结构及其抗偏载运动轨迹控制方法 Download PDF

Info

Publication number
CN116048012A
CN116048012A CN202211363693.1A CN202211363693A CN116048012A CN 116048012 A CN116048012 A CN 116048012A CN 202211363693 A CN202211363693 A CN 202211363693A CN 116048012 A CN116048012 A CN 116048012A
Authority
CN
China
Prior art keywords
mobile platform
unbalanced load
mecanum wheel
motor
wheel
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN202211363693.1A
Other languages
English (en)
Other versions
CN116048012B (zh
Inventor
曾勇
徐振威
唐崇邦
卢倩
周临震
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Yancheng Institute of Technology
Yancheng Institute of Technology Technology Transfer Center Co Ltd
Original Assignee
Yancheng Institute of Technology
Yancheng Institute of Technology Technology Transfer Center Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Yancheng Institute of Technology, Yancheng Institute of Technology Technology Transfer Center Co Ltd filed Critical Yancheng Institute of Technology
Priority to CN202211363693.1A priority Critical patent/CN116048012B/zh
Publication of CN116048012A publication Critical patent/CN116048012A/zh
Application granted granted Critical
Publication of CN116048012B publication Critical patent/CN116048012B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00—Programme-control systems
    • G05B19/02—Programme-control systems electric
    • G05B19/418—Total factory control, i.e. centrally controlling a plurality of machines, e.g. direct or distributed numerical control [DNC], flexible manufacturing systems [FMS], integrated manufacturing systems [IMS] or computer integrated manufacturing [CIM]
    • G05B19/4189—Total factory control, i.e. centrally controlling a plurality of machines, e.g. direct or distributed numerical control [DNC], flexible manufacturing systems [FMS], integrated manufacturing systems [IMS] or computer integrated manufacturing [CIM] characterised by the transport system
    • G05B19/41895—Total factory control, i.e. centrally controlling a plurality of machines, e.g. direct or distributed numerical control [DNC], flexible manufacturing systems [FMS], integrated manufacturing systems [IMS] or computer integrated manufacturing [CIM] characterised by the transport system using automatic guided vehicles [AGV]
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00—Program-control systems
    • G05B2219/30—Nc systems
    • G05B2219/32—Operator till task planning
    • G05B2219/32252—Scheduling production, machining, job shop

Landscapes

  • Engineering & Computer Science (AREA)
  • General Engineering & Computer Science (AREA)
  • Manufacturing & Machinery (AREA)
  • Quality & Reliability (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Electric Propulsion And Braking For Vehicles (AREA)

Abstract

本发明公开了一种重载mecanum轮移动平台悬挂结构及其抗偏载运动轨迹控制方法，涉及重载搬运输送技术领域，为解决现有mecanum轮移动平台在遇到爬坡时结构稳定性差和底盘空间利用率低的问题。该重载mecanum轮移动平台悬挂结构及其抗偏载运动轨迹控制方法，能够保证四个Mecanum轮与地面的充分接触，从而有效提高了平稳性，实现偏载工况下全向移动平台轨迹跟踪控制，相比其他控制在偏载工况下精确度更高，且控制简单，实用性强。

Description

一种重载mecanum轮移动平台悬挂结构及其抗偏载运动轨迹 控制方法
技术领域
本发明涉及重载搬运输送技术领域，具体为一种重载mecanum轮移动平台悬挂结构及其抗偏载运动轨迹控制方法。
背景技术
随着制造业规模的不断扩大和自动控制技术的不断发展，重型大件的运输问题已经成为时下研究的热点，移动平台主要承载物料运输任务，在重型工业制造业中，尤其是铁路交通、航空航天、重型汽车制造厂等场所的工业生产和物流运输过程中，对于物料的有效运输有了更高、更快的运输要求，而传统重载轮式移动设备通常存在转弯半径大、无法横向侧移等诸多不利因素，故其作业时空间利用率低，运动灵活性差，相比于传统重载移动平台，mecanum轮全向移动平台可以横向移动，甚至可以沿着弯曲的路径移动和原地旋转，因此其适合工作于操作空间狭窄拥挤、运动路线曲折、对运动灵活性要求较高的场合，然而，在重载Mecanum轮移动平台工作时，工作场地的不平整和所负重物的重心偏移，将导致Mecanum轮移动平台不能按照预期轨迹精准运动，急需改进重载Mecanum轮移动平台的悬挂结构，以及提出针对偏载工况的运动轨迹精确控制方法，确保移动平台的四轮完全接触地面并按照预期轨迹精确运动，发明专利CN 105667632 B中揭示了一种基于mecanum轮的全向运动平台的整体结构，他使用mecanum来实现全向移动，设计新的独立悬挂模块来实现车体的缓冲减震作用，保证车轮与地面充分接触，提高了平台运动稳定性，但上述发明专利中底盘结构中悬挂装置占用空间过大，空间利用率低，且该悬挂进能承受纵向冲击上述发明专利整体结构承载能力低，不适用于重载的工作环境下，且缺少多种传感器，不适用于偏载工况下对移动平台跟踪控制。
发明专利CN 114488790A中揭示了一种基于名义模型的全向移动平台自适应滑模控制，根据全向移动平台运动学和动力学方程计算得到滑模面和滑模控制率，设计了基于名义模型自适应增益调整的控制器，从而完成基于名义模型的全向移动机器人自适应滑膜控制，该发明专利中未考虑偏载工况下移动平台的运动情况，未考虑偏载工况下四独立电机转动不协同的问题，因偏载影响平台的运动控制精度。
因此，针对上述问题提出一种重载mecanum轮移动平台悬挂结构及其抗偏载运动轨迹控制方法。
发明内容
本发明的目的在于提供一种重载mecanum轮移动平台悬挂结构及其抗偏载运动轨迹控制方法，以解决上述背景技术中提出现有mecanum轮移动平台在遇到爬坡时结构稳定性差和底盘空间利用率低的问题。
为实现上述目的，本发明提供如下技术方案：一种重载mecanum轮移动平台悬挂结构及其抗偏载运动轨迹控制方法，包括车架、mecanum轮、独立悬挂模块、动力传动模块和蓄电池箱及中控台；
车架包括工字钢和凹槽，所述工字钢固定在车体周边用于提高车体强度以及平台负载能力，所述凹槽设置与车架两边，且将蓄电池箱及中控台安装与内，保障了车体空间利用率，对蓄电池箱及中控台也起到保护作用：
mecanum轮包括轮毂、麦轮中心连接件、辊子中心轴和辊子，所述麦轮中心连接件与轮毂同轴设置，且麦轮中心连接件两端分别与两个轮毂通过螺柱进行固定连接，所述辊子中心轴同轴固定套装在辊子内部空腔内，以保证辊子正常转动，所述轮毂采用高强度合金加工件，提高承载能力，所述辊子与辊子中心轴的连接体均匀分布在两个轮毂的圆周连接处，以便实现mecanum轮在狭小空间的自由转动；
独立悬挂模块包括电机支撑架电机支撑架，第一减震器，第二减震器，支架和力传感器，所述第一减震器两端为螺柱形式，所述车架和电机支撑架上均打有螺孔，通过螺栓固定第一减震器位置，第一减震器作为弹簧件，受到纵向冲击时，第一减震器的弹簧进行伸缩使得mecanum轮始终与地面充分接触，如图2所示的受力情况，减少纵向冲击对mecanum轮产生的影响，所述第二减震器与支架采用转动连接，第二减震器作为弹簧件，受到横向冲击时，第二减震器的弹簧进行伸缩的同时绕着支架进行旋转，使得mecanum轮始终与地面充分接触，如图2所示的受力情况，用于减少横向冲击对mecanum轮产生的影响，所述支架通过螺钉与电机支撑架和车体进行紧固连接，所述力传感器固定于第一减震器和车体之间，用于测量偏载工况下各车轮承载的力，以便推算偏载时重心位置；
动力传动模块包括电机，减速器和传动轴，所述电机通过螺钉与电机支撑架和电机进行紧固连接，所述减速器的转动轴通过键槽与传动轴相连，用于降低电机转速，所述传动轴的一端通过螺柱与mecanum轮中心连接件的螺孔进行紧固连接，从而使得mecanum转动，所述蓄电池箱及中控台能对四路直流电机的转速与转向进行协同控制，从而实现全向移动平台在平面内任意方向的运动，所述电机是直流无刷电动机，用来产生将mecanum轮旋转的扭矩。
一种重载mecanum轮移动平台的抗偏载运动轨迹控制方法，包括以下步骤：
步骤一：建立基于力传感器得到的偏载工况下全向移动平台的运动学模型S13得到的运动学模型，根据偏载工况下全向移动平台的运动学方程建立偏载工况下全向移动平台的动力学方程S14得到的动力学模型：
S11：通过力传感器可以测得1-4号mecanum轮上的载重力为N1、N2、N3、N4，从而可以计算出偏载工况时的质心位置：
S12：设全向移动平台的几何中心与质心不重合，以移动平台的中心O为原点建立坐标系∑O，如图5(a)，全向移动平台的前方是X轴的正向，向左行驶的方向为Y轴的正向；所以mecanum轮质心位置为
Figure SMS_1
其中x代表质心的横向坐标，y代表质心的纵向坐标，Ni表示1-4号mecanum轮上的载重力其中i＝1、2、3、4，G代表全向移动平台的总重力，l,L代表mecanum轮中心到x轴，y轴的距离：
S13：以移动平台的质心O为原点建立坐标系∑Oi，如图5(b)根据各mecanum轮的轴心速度与全向移动平台质心速度的关系以及全向移动平台结构特征，得到偏载工况下的全向移动平台的运动学方程；V0＝J+Vw
Figure SMS_2
其中，
Figure SMS_3
Figure SMS_4
vx表示全向移动平台的横向速度，vy表示全向移动平台的纵向速度，ωz表示全向移动平台的旋转角速度，Rω表示mecanum轮半径，
Figure SMS_5
表示mecanum轮的角速度，其中i＝1、2、3、4，α表示辊子支撑轴轴线和mecanum轮中心轴线的夹角，l1表示左边两个mecanum轮中心到X轴的距离，l2表示右边两个mecanum轮中心到X轴的距离，L1表示上面两个mecanum轮中心到Y轴的距离,L2表示下面两个mecanum轮中心到Y轴的距离；
S14：根据偏载工况下全向移动平台的运动学方程，构建偏载工况下全向移动平台的Lagrange第二类方程
Figure SMS_6
其中ξ是Lagrange函数，ξ＝V-U,θi、
Figure SMS_7
代表系统的广义坐标和速度，Qi为系统内除去势力和黏性摩擦力以外的其他广义力，R表示瑞利耗散函数；根据Lagrange函数和偏载工况下的全向移动平台的动能方程，计算得到偏载工况下全向移动平台的动力学方程；如所述动力学方程如下：
Figure SMS_8
其中
Figure SMS_9
Figure SMS_10
Figure SMS_11
Figure SMS_12
Figure SMS_13
Figure SMS_14
Figure SMS_15
其中，
Figure SMS_16
Figure SMS_17
M表示偏载工况下全向移动平台的惯性矩阵，J表示整个移动平台绕z轴的转动惯量，J2表示各个轮子绕其中心轴的转动惯量，
Figure SMS_18
表示mecanum轮的角加速度，
Figure SMS_19
表示mecanunm的摩擦力矩，d表示外界的扰动力矩，T表示全向移动平台的总力矩。
步骤二：根据偏载工况下的运动学和动力学模型，提出一种改进的双闭环抗偏载控制方法，其中外环为偏载工况下基于非线性干扰观测器的滑模控制方法，通过计算得到滑模面s(t)和滑模控制律完成偏载工况下基于滑模控制的mecanum轮移动平台的控制，建立双闭环抗偏载轨迹控制方法，外环为基于非线性干扰观测器的滑模控制方法包括如下步骤；
S21，联合偏载工况下的全向移动平台运动学方程和动力学方程可以得到偏载工况下全向移动平台的空间状态方程：
Figure SMS_20
其中q＝[x,y,θz]为平台位姿，J+是J的的广义逆矩阵，d＝[d1,d2,d3,d4]T是各个轮子受到的干扰；
S22，定义偏载工况下的全向移动平台的跟踪误差e(t)，其表达式如下：
e(t)＝qd-q
其中，qd＝[xd,yd,θzd]表示移动平台的期望位姿，q＝[x,y,θz]表示平台的的实际位姿；
S23，根据偏载工况下全向移动平台的跟踪误差，计算得到滑模面s(t)和滑模控制律T，其表达式如下：
Figure SMS_21
Figure SMS_22
其中，
Figure SMS_23
表示跟踪误差的变化率，K4×4表示常数正定矩阵，e(t)表示跟踪误差，K4×4＝diag(K1,K2,K3,K4),R4×4＝diag(R1,R2,R3,R4)是常数整定矩阵，0＜α＜1。
步骤三：根据偏载工况下全向移动平台的空间状态方程设计非线性干扰观测器，包括如下步骤：
S31：根据步骤14所述动力学方程，其系统模型可以改写为状态空间模型，其表达式如下
Figure SMS_24
其中x1是系统的第一状态变量，
Figure SMS_25
是第一状态变量x1的导数，x2是第二状态变量，
Figure SMS_26
是第二状态变量的导数，
Figure SMS_27
是系统的不确定量，B＝JM-1是移动平台的惯性矩阵，y是系统的输出，d是系统的扰动；
S32：根据上述的状态空间方程模型得到非线性干扰观测器的表达式为：
Figure SMS_28
z为非线性干扰观测器状态变量，其中
Figure SMS_29
是d的估计值，H(v)是待设计函数，满足
Figure SMS_30
，G(v)是观测器增益，取
Figure SMS_31
其中h1,h2,h3＞0；
定义观测误差
Figure SMS_32
其中当干扰d变化相比系统状态的变化比较慢，则认为
Figure SMS_33
可以得到
Figure SMS_34
构建Lyapunov函数
Figure SMS_35
则
Figure SMS_36
该非线性干扰观测器稳定；
S33，非线性干扰观测器的输出量表达式为：
Figure SMS_37
联合步骤23滑模控制律T可得补偿后的控制律τ＝T-Td。
步骤四：双闭环抗偏载轨迹控制方法，内环为不同负载下多电机协同的PID控制方法包括如下步骤：
S41、偏载工况下mecanum轮移动平台内置四电机的协同控制方法，通过编码器获取四个电机的实际速度，筛选出四电机中的转速最小值为目标电机，根据目标电机与系统其余三电机的同步误差e(t)为：e(t)＝ω1-ωi
其中，ω1表示目标mecanum轮的转速，ωi表示剩余mecanum轮的转速，其中i＝2、3、4
根据多电机协同控制的PID控制方法
S42、所述PID控制的具体模型为
Figure SMS_38
其中kp为比例参数，ki为微分参数，kd为积分参数，e(t)为电机转速的误差值；引入速度补偿增益
Figure SMS_39
Jm,Jn为电机的转动惯量。
与现有技术相比，本发明的有益效果是：
1、该重载mecanum轮移动平台悬挂结构及其抗偏载运动轨迹控制方法，mecanum轮悬挂机构在mecanum轮的原有固定设计的基础上，在支撑架的设计上将第一减震器、第二减震器放置于电机和减速器的两端，这种悬挂结构不占用传动轴方向的的空间，使得结构更为紧凑，增加空间利用率；
2、该重载mecanum轮移动平台悬挂结构及其抗偏载运动轨迹控制方法，根据压力传感器推算得出重心位置，设计一种双闭环抗偏载轨迹控制方法，外环为偏载工况下全向移动平台位置的滑模控制方法，内环为偏载工况下四电机转速的协同控制方法，该控制方法解决了在偏载工况下全向移动平台不能够完全消除干扰，导致的轨迹跟踪误差较大的问题。
附图说明
图1为本发明的mecanum轮全向移动平台的主视图；
图2为本发明的mecanum轮全向移动平台的独立悬挂模块局部剖视受力图；
图3为本发明的mecanum轮全向移动平台悬挂模块轴侧图；
图4为本发明的mecanum轮移动平台悬挂结构及其抗偏载运动轨迹控制方法的步骤流程图；
图5(a)为本发明的mecanum轮结构图；
图5(b)为本发明的mecanum轮结构图；
图6是基于非线性干扰观测器的滑模轨迹跟踪控制图；
图7是多电机协同控制原理图。
图中：1、车架；1-1、工字钢；1-2、凹槽；2-1、轮毂；2-2、麦伦中心连接件；2-3、辊子中心轴；2-4、辊子；3-1、电机支撑架；3-2、第一减震器；3-3、第二减震器；3-4、支架；3-5、力传感器；4-1、电机；4-2、减速器；4-3、传动轴。
具体实施方式
下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描述，所描述的实施例仅仅是本发明一部分实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都属于本发明保护的范围。
一种重载mecanum轮移动平台悬挂结构及其抗偏载运动轨迹控制方法，包括车架1、mecanum轮2、独立悬挂模块3、动力传动模块4和蓄电池箱及中控台5；
车架1包括工字钢1-1和凹槽1-2，工字钢1-1固定在车体周边用于提高车体强度以及平台负载能力，凹槽1-2设置与车架1两边，且将蓄电池箱及中控台5安装与内，保障了车体空间利用率，对蓄电池箱及中控台5也起到保护作用：
mecanum轮2包括轮毂2-1、麦轮中心连接件2-2、辊子中心轴2-3和辊子2-4，麦轮中心连接件2-2与轮毂2-1同轴设置，且麦轮中心连接件2-2两端分别与两个轮毂2-1通过螺柱进行固定连接，辊子中心轴2-3同轴固定套装在辊子2-4内部空腔内，以保证辊子2-4正常转动，轮毂2-1采用高强度合金加工件，提高承载能力，辊子2-4与辊子中心轴2-3的连接体均匀分布在两个轮毂2-1的圆周连接处，以便实现mecanum轮在狭小空间的自由转动；
独立悬挂模块3包括电机支撑架电机支撑架3-1，第一减震器3-2，第二减震器3-3，支架3-4和力传感器3-5，第一减震器3-2两端为螺柱形式，车架1和电机支撑架3-1上均打有螺孔，通过螺栓固定第一减震器3-2位置，第一减震器3-2作为弹簧件，受到纵向冲击时，第一减震器3-2的弹簧进行伸缩使得mecanum轮2始终与地面充分接触，如图2所示的受力情况，减少纵向冲击对mecanum轮产生的影响，第二减震器3-3与支架3-4采用转动连接，第二减震器3-3作为弹簧件，受到横向冲击时，第二减震器3-3的弹簧进行伸缩的同时绕着支架3-4进行旋转，使得mecanum轮2始终与地面充分接触，如图2所示的受力情况，用于减少横向冲击对mecanum轮产生的影响，支架3-4通过螺钉与电机支撑架3-1和车体1进行紧固连接，力传感器3-5固定于第一减震器3-2和车体1之间，用于测量偏载工况下各车轮承载的力，以便推算偏载时重心位置；
动力传动模块4包括电机4-1，减速器4-2和传动轴4-3，电机4-1通过螺钉与电机支撑架3-1和电机4-1进行紧固连接，减速器4-2的转动轴通过键槽与传动轴相连，用于降低电机转速，传动轴4-3的一端通过螺柱与mecanum轮中心连接件2-2的螺孔进行紧固连接，从而使得mecanum转动，蓄电池箱及中控台5能对四路直流电机4-1的转速与转向进行协同控制，从而实现全向移动平台在平面内任意方向的运动，电机4-1是直流无刷电动机，用来产生将mecanum轮2旋转的扭矩。
一种重载mecanum轮移动平台的抗偏载运动轨迹控制方法，包括以下步骤：
步骤一：建立基于力传感器得到的偏载工况下全向移动平台的运动学模型S13得到的运动学模型，根据偏载工况下全向移动平台的运动学方程建立偏载工况下全向移动平台的动力学方程S14得到的动力学模型：
S11：通过力传感器3-5可以测得1-4号mecanum轮上的载重力为N1、N2、N3、N4，从而可以计算出偏载工况时的质心位置：
S12：设全向移动平台的几何中心与质心不重合，以移动平台的中心O为原点建立坐标系ΣO，如图5(a)，全向移动平台的前方是X轴的正向，向左行驶的方向为Y轴的正向；所以mecanum轮质心位置为
Figure SMS_40
其中x代表质心的横向坐标，y代表质心的纵向坐标，Ni表示1-4号mecanum轮上的载重力其中i＝1、2、3、4，G代表全向移动平台的总重力，l,L代表mecanum轮中心到x轴，y轴的距离：
S13：以移动平台的质心O为原点建立坐标系∑Oi，如图5(b)根据各mecanum轮的轴心速度与全向移动平台质心速度的关系以及全向移动平台结构特征，得到偏载工况下的全向移动平台的运动学方程；V0＝J+Vw
Figure SMS_41
其中，
Figure SMS_42
Figure SMS_43
vx表示全向移动平台的横向速度，vy表示全向移动平台的纵向速度，ωz表示全向移动平台的旋转角速度，Rω表示mecanum轮半径，
Figure SMS_44
表示mecanum轮的角速度，其中i＝1、2、3、4，α表示辊子支撑轴轴线和mecanum轮中心轴线的夹角，l1表示左边两个mecanum轮中心到X轴的距离，l2表示右边两个mecanum轮中心到X轴的距离，L1表示上面两个mecanum轮中心到Y轴的距离,L2表示下面两个mecanum轮中心到Y轴的距离；
S14：根据偏载工况下全向移动平台的运动学方程，构建偏载工况下全向移动平台的Lagrange第二类方程
Figure SMS_45
其中ξ是Lagrange函数，ξ＝V-U,θi、
Figure SMS_46
代表系统的广义坐标和速度，Qi为系统内除去势力和黏性摩擦力以外的其他广义力，R表示瑞利耗散函数；根据Lagrange函数和偏载工况下的全向移动平台的动能方程，计算得到偏载工况下全向移动平台的动力学方程；如动力学方程如下：
Figure SMS_47
其中
Figure SMS_48
Figure SMS_49
Figure SMS_50
Figure SMS_51
Figure SMS_52
Figure SMS_53
Figure SMS_54
其中，
Figure SMS_55
Figure SMS_56
M表示偏载工况下全向移动平台的惯性矩阵，J表示整个移动平台绕z轴的转动惯量，J2表示各个轮子绕其中心轴的转动惯量，
Figure SMS_57
表示mecanum轮的角加速度，
Figure SMS_58
表示mecanunm的摩擦力矩，d表示外界的扰动力矩，T表示全向移动平台的总力矩。
步骤二：根据偏载工况下的运动学和动力学模型，提出一种改进的双闭环抗偏载控制方法，其中外环为偏载工况下基于非线性干扰观测器的滑模控制方法，通过计算得到滑模面s(t)和滑模控制律完成偏载工况下基于滑模控制的mecanum轮移动平台的控制，建立双闭环抗偏载轨迹控制方法，外环为基于非线性干扰观测器的滑模控制方法包括如下步骤；
S21，联合偏载工况下的全向移动平台运动学方程和动力学方程可以得到偏载工况下全向移动平台的空间状态方程：
Figure SMS_59
其中q＝[x,y,θz]为平台位姿，J+是J的的广义逆矩阵，d＝[d1,d2,d3,d4]T是各个轮子受到的干扰；
S22，定义偏载工况下的全向移动平台的跟踪误差e(t)，其表达式如下：
e(t)＝qd-q
其中，qd＝[xd,yd,θzd]表示移动平台的期望位姿，q＝[x,y,θz]表示平台的的实际位姿；
S23，根据偏载工况下全向移动平台的跟踪误差，计算得到滑模面s(t)和滑模控制律T，其表达式如下：
Figure SMS_60
Figure SMS_61
其中，
Figure SMS_62
表示跟踪误差的变化率，K4×4表示常数正定矩阵，e(t)表示跟踪误差，K4×4＝diag(K1,K2,K3,K4),R4×4＝diag(R1,R2,R3,R4)是常数整定矩阵，0＜α＜1。
步骤三：根据偏载工况下全向移动平台的空间状态方程设计非线性干扰观测器，包括如下步骤：
S31：根据步骤14动力学方程，其系统模型可以改写为状态空间模型，其表达式如下
Figure SMS_63
其中x1是系统的第一状态变量，
Figure SMS_64
是第一状态变量x1的导数，x2是第二状态变量，
Figure SMS_65
是第二状态变量的导数，
Figure SMS_66
是系统的不确定量，B＝JM-1是移动平台的惯性矩阵，y是系统的输出，d是系统的扰动；
S32：根据上述的状态空间方程模型得到非线性干扰观测器的表达式为：
Figure SMS_67
z为非线性干扰观测器状态变量，其中
Figure SMS_68
是d的估计值，H(v)是待设计函数，满足
Figure SMS_69
G(v)是观测器增益，取
Figure SMS_70
其中h1,h2,h3＞0；
定义观测误差
Figure SMS_71
其中当干扰d变化相比系统状态的变化比较慢，则认为
Figure SMS_72
可以得到
Figure SMS_73
构建Lyapunov函数
Figure SMS_74
则
Figure SMS_75
该非线性干扰观测器稳定；
S33，非线性干扰观测器的输出量表达式为：
Figure SMS_76
联合步骤23滑模控制律T可得补偿后的控制律τ＝T-Td。
步骤四：双闭环抗偏载轨迹控制方法，内环为不同负载下多电机协同的PID控制方法包括如下步骤：
S41、偏载工况下mecanum轮移动平台内置四电机的协同控制方法，通过编码器获取四个电机的实际速度，筛选出四电机中的转速最小值为目标电机，根据目标电机与系统其余三电机的同步误差e(t)为：e(t)＝ω1-ωi
其中，ω1表示目标mecanum轮的转速，ωi表示剩余mecanum轮的转速，其中i＝2、3、4
根据多电机协同控制的PID控制方法
S42、PID控制的具体模型为
Figure SMS_77
其中kp为比例参数，ki为微分参数，kd为积分参数，e(t)为电机转速的误差值；引入速度补偿增益
Figure SMS_78
Jm,Jn为电机的转动惯量。
对于本领域技术人员而言，显然本发明不限于上述示范性实施例的细节，而且在不背离本发明的精神或基本特征的情况下，能够以其他的具体形式实现本发明。因此，无论从哪一点来看，均应将实施例看作是示范性的，而且是非限制性的，本发明的范围由所附权利要求而不是上述说明限定，因此旨在将落在权利要求的等同要件的含义和范围内的所有变化囊括在本发明内。不应将权利要求中的任何附图标记视为限制所涉及的权利要求。

Claims (4)

1.一种重载mecanum轮移动平台悬挂结构，包括车架(1)、mecanum轮(2)、独立悬挂模块(3)、动力传动模块(4)和蓄电池箱及中控台(5)，其特征在于：
车架(1)包括工字钢(1-1)和凹槽(1-2)，所述工字钢(1-1)固定在车体周边用于提高车体强度以及平台负载能力，所述凹槽(1-2)设置与车架(1)两边，且将蓄电池箱及中控台(5)安装与内，保障了车体空间利用率，对蓄电池箱及中控台(5)也起到保护作用；
mecanum轮(2)包括轮毂(2-1)、麦轮中心连接件(2-2)、辊子中心轴(2-3)和辊子(2-4)，所述麦轮中心连接件(2-2)与轮毂(2-1)同轴设置，且麦轮中心连接件(2-2)两端分别与两个轮毂(2-1)通过螺柱进行固定连接，所述辊子中心轴(2-3)同轴固定套装在辊子(2-4)内部空腔内，以保证辊子(2-4)正常转动；
独立悬挂模块(3)包括电机支撑架电机支撑架(3-1)，第一减震器(3-2)，第二减震器(3-3)，支架(3-4)和力传感器(3-5)，所述第一减震器(3-2)两端为螺柱形式，所述车架(1)和电机支撑架(3-1)上均打有螺孔，通过螺栓固定第一减震器(3-2)位置，所述第二减震器(3-3)与支架(3-4)采用转动连接，所述支架(3-4)通过螺钉与电机支撑架(3-1)和车体(1)进行紧固连接，所述力传感器(3-5)固定于第一减震器(3-2)和车体(1)之间，用于测量偏载工况下各车轮承载的力，以便推算偏载时重心位置；
动力传动模块(4)包括电机(4-1)，减速器(4-2)和传动轴(4-3)，所述电机(4-1)通过螺钉与电机支撑架(3-1)和电机(4-1)进行紧固连接，所述减速器(4-2)的转动轴通过键槽与传动轴相连，用于降低电机转速，所述传动轴(4-3)的一端通过螺柱与mecanum轮中心连接件(2-2)的螺孔进行紧固连接，从而使得mecanum转动，所述蓄电池箱及中控台(5)能对四路直流电机(4-1)的转速与转向进行协同控制，从而实现全向移动平台在平面内任意方向的运动。
2.根据权利要求1所述的一种重载mecanum轮移动平台悬挂结构，其特征在于：所述轮毂(2-1)采用高强度合金加工件，提高承载能力，所述辊子(2-4)与辊子中心轴(2-3)的连接体均匀分布在两个轮毂(2-1)的圆周连接处，以便实现mecanum轮在狭小空间的自由转动。
3.根据权利要求1所述的一种重载mecanum轮移动平台悬挂结构，其特征在于：所述电机(4-1)是直流无刷电动机，用来产生将mecanum轮(2)旋转的扭矩。
4.基于权利要求1-4任意一项所述重载mecanum轮移动平台的抗偏载运动轨迹控制方法，包括以下步骤：
步骤一：建立基于力传感器得到的偏载工况下全向移动平台的运动学模型得到的运动学模型，根据偏载工况下全向移动平台的运动学方程建立偏载工况下全向移动平台的动力学方程得到的动力学模型；
步骤二：根据偏载工况下的运动学和动力学模型，提出一种改进的双闭环抗偏载控制方法，其中外环为偏载工况下基于非线性干扰观测器的滑模控制方法，通过计算得到滑模面s(t)和滑模控制律完成偏载工况下基于滑模控制的mecanum轮移动平台的控制；
步骤三：根据偏载工况下全向移动平台的空间状态方程设计非线性干扰观测器；
步骤四：内环为偏载工况mecanum轮移动平台内置四电机的协同控制方法，通过编码器获取四个电机的实际速度，筛选出四电机中的转速最小值为目标电机，根据目标电机与系统其余三电机的同步误差e(t)，引入PID控制器，对误差速度进行PID调节；由各电机与目标电机的转动惯量比值设立速度补偿增益，以实现多个所述电机的协同控制。
CN202211363693.1A 2022-11-02 2022-11-02 一种重载mecanum轮移动平台悬挂结构及其抗偏载运动轨迹控制方法 Active CN116048012B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202211363693.1A CN116048012B (zh) 2022-11-02 2022-11-02 一种重载mecanum轮移动平台悬挂结构及其抗偏载运动轨迹控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202211363693.1A CN116048012B (zh) 2022-11-02 2022-11-02 一种重载mecanum轮移动平台悬挂结构及其抗偏载运动轨迹控制方法

Publications (2)

Publication Number Publication Date
CN116048012A true CN116048012A (zh) 2023-05-02
CN116048012B CN116048012B (zh) 2024-05-03

Family

ID=86112155

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202211363693.1A Active CN116048012B (zh) 2022-11-02 2022-11-02 一种重载mecanum轮移动平台悬挂结构及其抗偏载运动轨迹控制方法

Country Status (1)

Country Link
CN (1) CN116048012B (zh)

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR20010077779A (ko) * 2000-02-08 2001-08-20 조황 모터에 의해 구동되는 바퀴식 운행 시스템을 위한조향/구동 일체식 메커니즘
CN105479433A (zh) * 2016-01-04 2016-04-13 江苏科技大学 一种麦克纳姆轮全向移动搬运机器人
CN105667632A (zh) * 2016-01-04 2016-06-15 江苏科技大学 一种Mecanum轮全向移动平台
CN106708045A (zh) * 2016-12-16 2017-05-24 盐城工学院 一种具有自动纠偏功能的大型重载式无人导航智能电动平车
US20210046922A1 (en) * 2019-08-14 2021-02-18 Xiamen King Long United Automotive Industry Co., Ltd. Yaw motion control method for four-wheel distributed vehicle
CN214586512U (zh) * 2021-06-21 2021-11-02 盐城工学院 一种竞速型自主行驶智能车

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR20010077779A (ko) * 2000-02-08 2001-08-20 조황 모터에 의해 구동되는 바퀴식 운행 시스템을 위한조향/구동 일체식 메커니즘
CN105479433A (zh) * 2016-01-04 2016-04-13 江苏科技大学 一种麦克纳姆轮全向移动搬运机器人
CN105667632A (zh) * 2016-01-04 2016-06-15 江苏科技大学 一种Mecanum轮全向移动平台
CN106708045A (zh) * 2016-12-16 2017-05-24 盐城工学院 一种具有自动纠偏功能的大型重载式无人导航智能电动平车
US20210046922A1 (en) * 2019-08-14 2021-02-18 Xiamen King Long United Automotive Industry Co., Ltd. Yaw motion control method for four-wheel distributed vehicle
CN214586512U (zh) * 2021-06-21 2021-11-02 盐城工学院 一种竞速型自主行驶智能车

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
PANKAJ SINGH YADAV CA;VANDANA AGRAWAL;J.C. MOHANTA;M.D. FAIYAZ AHMED: "A robust sliding mode control of mecanum wheel-chair for trajectory tracking", MATERIALS TODAY: PROCEEDINGS, vol. 56, no. 2, 3 January 2022 (2022-01-03) *
康升征;吴洪涛;: "全向移动机器人模糊自适应滑模控制方法研究", 机械设计与制造工程, no. 03, 15 March 2017 (2017-03-15) *

Also Published As

Publication number Publication date
CN116048012B (zh) 2024-05-03

Similar Documents

Publication Publication Date Title
Ni et al. Dynamics control of autonomous vehicle at driving limits and experiment on an autonomous formula racing car
An et al. Simulation and control of a two-wheeled self-balancing robot
CN110962626B (zh) 一种多轴轮毂电机驱动车辆的自适应电子差速控制方法
Junfeng et al. Research on control method of two-wheeled self-balancing robot
Huang et al. The path‐tracking controller based on dynamic model with slip for one four‐wheeled OMR
Jiang et al. Stability analysis of the food delivery robot with suspension damping structure
Sangfeel et al. Design of fuzzy logic controller for inverted pendulum-type mobile robot using smart in-wheel motor
CN116048012B (zh) 一种重载mecanum轮移动平台悬挂结构及其抗偏载运动轨迹控制方法
Tan et al. A path tracking algorithm for articulated vehicle: Development and simulations
CN110109353B (zh) 一种反作用轮平衡自行车机器人模糊自适应滑模控制系统
CN112666822B (zh) 一种基于分数阶的重载agv速度控制方法
Şahin et al. Investigation of longitudinal friction characteristics of an omnidirectional wheel via LuGre model
CN116062056A (zh) 面向高曲率管径面的轮式爬壁机器人及其运动控制方法
Qi et al. Path Tracking Control of Car-like Wheeled Mobile Robot on the Slope based on Nonlinear Model Predictive Control
Qian et al. Dynamic balance control of two-wheeled self-balancing pendulum robot based on adaptive machine learning
CN114488790A (zh) 一种基于名义模型的全向移动机器人自适应滑膜控制方法
Ye et al. Design and performance analysis of an adaptive omnidirectional wheel for heavy payload robot
Park et al. Realization of stabilization using feed-forward and feedback controller composition method for a mobile robot
Zhujie et al. Vehicle state and parameter estimation based on improved adaptive dual extended Kalman filter with variable sliding window
Hu et al. Design of vehicle stability control of distributed-driven electric vehicle based on optimal torque allocation
CN111142523A (zh) 一种轮腿式移动机器人运动控制系统
Jiang et al. Research on steering control strategy for steering-by-wire four-wheel electric vehicle
Liu Research on Tracking Control of Two Wheeled Self-balancing Vehicle
Ye et al. Fuzzy parameter tuning sliding mode control for longitudinal motion of underground mining electric vehicles based on a single wheel model
Meng et al. Analysis of nonholonomic constraints about a variable structure bicycle robot

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant