CN111702782B - 一种换电机器人举升装置结构及控制参数协同优化方法 - Google Patents
一种换电机器人举升装置结构及控制参数协同优化方法 Download PDFInfo
- Publication number
- CN111702782B CN111702782B CN202010606596.5A CN202010606596A CN111702782B CN 111702782 B CN111702782 B CN 111702782B CN 202010606596 A CN202010606596 A CN 202010606596A CN 111702782 B CN111702782 B CN 111702782B
- Authority
- CN
- China
- Prior art keywords
- optimization
- section
- follows
- gear
- connecting rod
- 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.)
- Active
Links
- 238000005457 optimization Methods 0.000 title claims abstract description 40
- 238000000034 method Methods 0.000 title claims abstract description 12
- 230000007246 mechanism Effects 0.000 claims abstract description 35
- 230000004044 response Effects 0.000 claims description 13
- 230000008569 process Effects 0.000 claims description 4
- 238000004088 simulation Methods 0.000 claims description 2
- 238000013461 design Methods 0.000 abstract description 4
- 239000002245 particle Substances 0.000 description 6
- 238000006073 displacement reaction Methods 0.000 description 4
- 230000000694 effects Effects 0.000 description 3
- 238000010586 diagram Methods 0.000 description 2
- 238000009434 installation Methods 0.000 description 2
- 239000003921 oil Substances 0.000 description 2
- 238000012545 processing Methods 0.000 description 2
- 230000001133 acceleration Effects 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 239000000295 fuel oil Substances 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 238000012804 iterative process Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 238000002922 simulated annealing Methods 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J11/00—Manipulators not otherwise provided for
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1679—Programme controls characterised by the tasks executed
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60S—SERVICING, CLEANING, REPAIRING, SUPPORTING, LIFTING, OR MANOEUVRING OF VEHICLES, NOT OTHERWISE PROVIDED FOR
- B60S5/00—Servicing, maintaining, repairing, or refitting of vehicles
- B60S5/06—Supplying batteries to, or removing batteries from, vehicles
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T10/00—Road transport of goods or passengers
- Y02T10/10—Internal combustion engine [ICE] based vehicles
- Y02T10/40—Engine management systems
Landscapes
- Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- Robotics (AREA)
- Manipulator (AREA)
- Arrangement Or Mounting Of Propulsion Units For Vehicles (AREA)
Abstract
本发明的主要目的是在综合考虑换电机器人机械结构参数与控制系统参数,保证机器人举升机构的动力学性能在满足设计要求的情况下达到最优,即公开了一种换电机器人举升装置结构及控制参数协同优化方法,对电动汽车换电机器人电池举升装置进行运动分析,建立运动学模型和动力学模型,并设计相应的控制器,以举升机构动力学性能为目标,建立举升机构尺寸及控制参数协同优化模型,采用优化算法进行优化求解。
Description
技术领域
本发明涉及机器人领域,具体涉及电动汽车换电机器人举升装置结构及控制参数协同优化。
背景技术
在全球石油储量有限的条件下,石油紧缺也会限制传统燃油汽车的发展。电动汽车作为汽车产业转型升级的重要方向,得到了世界各国的高度重视。为了在现有技术基础上解决电动汽车大面积推广面临的瓶颈,电动汽车换电运营模式应运而生。为了保证重量较重的电池包能够快速精确举升到特定位置且电池快换插头不受较大冲击,换电机器人的动力学性能要求苛刻,合理设计换电机器人的举升机构尺寸参数及控制参数尤为重要。
发明内容
本发明的主要目的是在综合考虑换电机器人机械结构参数与控制系统参数,保证机器人举升机构的动力学性能在满足设计要求的情况下达到最优。
为实现本发明目的而采用的技术方案是这样的,即一种换电机器人举升装置结构及控制参数协同优化方法,其特征在于:
对电动汽车换电机器人电池举升装置进行运动分析,建立运动学模型和动力学模型,推导举升机构动力学性能的控制律并设计相应的控制器,以举升机构动力学性能为目标,建立举升机构尺寸及控制参数协同优化模型,采用优化算法进行优化求解。
优选地,电动汽车换电机器人电池举升装置运动学模型和动力学模型以及举升机构动力学性能的控制器为:
将举升机构简化,如图2所示,θ0为举升机构处于初始状态时曲柄的位置,A0为举升机构处于初始状态时滑块中心点A的位置,β0为连杆AB段与BC段的固定夹角。电机M通过平行轴齿轮将力矩传递到丝杆,齿轮1的齿数为Z1,角位移为θ1,齿轮2的齿数为Z2,角位移为θ2,齿轮1、齿轮2的中心距为d,电池托盘及电池等效载荷距离节点C的距离为h。
举升机构的运动学关系为:
式中,S为丝杆导程,P为丝杆螺距,χ为丝杆线数;
整个举升系统的动力学方程为:
式中,Je为电机转子等效转动惯量,Bv表示为黏滞摩擦系数,Tm为电机输出转矩。
根据电池举升高度期望值解算举升电机期望角位移,通过模糊PID控制器对举升机构进行控制。
优选的,举升机构尺寸及控制参数协同优化模型为:
(1)决策变量
优化变量为齿轮1的齿数Z1、齿轮2的齿数Z2、丝杆导程P、连杆AB段长度l1、连杆BC段长度l2、曲柄OB长度l3,控制器中比例因子Kkp、Kki、Kkd,控制器中的比例系数Kp、积分系数Ki、微分系数Kd,优化变量用X表示如下:
X=[Z1,P,l1,l2,l3,Kkp,Kki,Kkd,Kp,Ki,Kd]
(2)目标函数
换电池机器人向电动汽车更换动力电池时,需要保证电池举升高度准确并且举升过程迅速,以保证电池能够准确固定在电动汽车底盘并尽可能减少车辆在更换电池时的等待时间。因此,选择换电池机器人举升机构系统的阶跃响应特性中的上升时间及稳态误差作为其动力学性能指标,如图3所示。
1)上升时间tr
上升时间tr即举升系统的阶跃响应曲线首次达到目标值所需的时间;
2)稳态误差δ
稳态误差δ即系统达到稳定时系统期望输出与实际输出之间的差值;
上升时间及稳态误差的数值无直接的数学表达,在优化过程中通过举升机构控制器的阶跃响应仿真曲线得到;
(3)约束条件
考虑到举升机构伺服电机的安装布置空间有限且为了尽可能避免改变该伺服电机的安装位置,齿轮1和齿轮2的中心距设置为固定值d,且齿轮1的齿数应小于齿轮2的齿数,以达到减速增扭的效果。齿轮1和齿轮2的齿数满足以下约束条件:
Z1<Z2
滚珠丝杆推荐的导程范围(单位:mm)为:
5≤P≤12,P∈{5,6,8,10,12}
连杆AB段、BC段以及OB段的长度范围(单位:mm)为:
70≤l1≤110
140≤l2≤180
100≤l3≤140
为了保证举升机构的举升高度达到要求,当连杆AB竖直时,连杆AB段和BC段的长度应满足一定的约束条件:
控制器中比例因子Kkp、Kki、Kkd的范围为:
控制器中的比例系数Kp、积分系数Ki、微分系数Kd的范围为:
0≤Kp≤400
0≤Ki≤4
0≤Kd≤25
综上,面向电池举升动力学性能的换电池机器人结构参数与控制参数协同优化模型为:
minf(Z1,P,l1,l2,l3,Kkp,Kki,Kkd,Kp,Ki,Kd)=min(tr,δ)
s.t.
优选地,换电机器人举升装置结构及控制参数协同优化方法,其特征在于:使用优化算法进行优化求解,包括但不限于进化算法,采用优化后的加工参数进行加工。
附图说明
图1协同优化基本框架
图2举升机构简化图
图3举升机构系统动力学性能指标示意图
图4四组参数下动力学性能对比
具体实施方式
下面结合附图和实施例对本发明作进一步说明,但不应该理解为本发明上述主题范围仅限于下述实施例。在不脱离本发明上述技术思想的情况下,根据本领域普通技术知识和惯用手段,做出各种替换和变更,均应包括在本发明的保护范围内。
本实施例以重庆某电动车换电科技有限公司全自动换电机器人为研究对象:
图2中,齿轮1、齿轮2、丝杆和滑块均只具有动能,势力不做功。系统中动能T表示为:
vj(j=1,2,...,8)为举升机构各组成部分质心的速度,以O点为重力势零势位,系统中势函数V为:
式中,g为重力加速度。
电机负载扭矩TL为系统中的广义力。该举升机构为单自由度系统,选择伺服电机输出角位移量θ1为广义坐标,则举升机构系统(不含电机部分)的动力学方程为:
令Jeq和Geq满足:
简化为:
电机系统状态方程式为:
式中,Je为电机转子等效转动惯量,Bv表示为黏滞摩擦系数,Tm为电机输出转矩。
整个举升系统的动力学方程为:
在设计举升过程模糊PID控制器时,主要设计思想是通过模糊控制的输出,对PID控制中Kp、Ki、Kd三个控制参数在小范围内进行调整,以提高控制器的灵活性和适应性。
采用模拟退火-量子粒子群混合算法进行举升机构动力学性能优化时,对离散优化变量Z1和P采用模拟退火算法的相邻解生成规则进行迭代。在离散变量的每一次迭代完成后,采用量子粒子群算法的粒子位置更新方式进行连续性变量l1、l2、l3、Kkp、Kki、Kkd、Kp、Ki和Kd的迭代和寻优。在量子粒子群算法迭代部分,采用非劣解集QPSOArchive存储迭代过程中产生的非劣解,并在量子粒子群算法终止时从中选择一组解作为离散优化变量确定时连续性优化变量的最优解,从而完成一次所有优化变量的迭代。
以原始结构参数和控制参数为基础,进行三组对比优化,共四组对照组:
第一组:原始结构参数和控制参数;
第二组:在第一组的基础上,保持控制参数不变,仅进行结构参数的优化;
第三组:在第一组的基础上,保持结构参数不变,仅进行控制参数的优化;
第四组:同时针对结构参数和控制参数进行协同优化。
通过模拟退火-量子粒子群算法协同优化,上述四组对照组的结构参数及控制参数如表1所示,其动力学性能对比图如图4所示。
表1四组对照组的结构参数及控制参数
从表1可以看出,单独优化换电机器人举升机构的结构参数时,能够提升响应速度并小幅度降低响应误差;单独优化换电机器人举升机构的控制器参数时,能够比较显著的提升响应速度和改善响应误差,优化效果好于单独优化举升机器人结构参数,说明响应速度和响应误差的更多地受举升机构控制参数的影响;通过举升机构结构参数和控制参数的协同优化,相比于单独优化控制参数,能够进一步在一定范围内提高响应速度并降低响应误差,优化效果好于单独优化控制参数和单独优化结构参数。
Claims (1)
1.一种换电机器人举升装置结构及控制参数协同优化方法,其特征在于:
对电动汽车换电机器人电池举升装置进行运动分析,建立一种电动汽车换电机器人电池举升装置的运动学模型和动力学模型,设计相应的控制器,以举升机构动力学性能为目标,建立举升机构尺寸及控制参数协同优化模型,采用优化算法进行优化求解;
举升机构尺寸及控制参数协同优化模型为:
(1)决策变量
换电机器人举升装置由直流伺服电机、一对齿轮、丝杆螺母机构、曲柄滑块机构和连杆组成,其中曲柄滑块机构由一个直流伺服电机驱动,举升系统由直流伺服电机通过一对齿轮带动丝杆旋转,进而驱动滑块沿着导轨作直线运动,使连杆作平面运动,连杆末端限制在电池托盘上的水平槽孔中,由连杆末端的竖直分运动完成电池托盘的举升;
优化变量为齿轮1的齿数Z1、齿轮2的齿数Z2、丝杆导程P、连杆AB段长度l1、连杆BC段长度l2、曲柄OB长度l3,控制器中比例因子Kkp、Kki、Kkd,控制器中的比例系数Kp、积分系数Ki、微分系数Kd,优化变量用X表示如下:
X=[Z1,Z2,P,l1,l2,l3,Kkp,Kki,Kkd,Kp,Ki,Kd]
(2)目标函数
1)上升时间tr
上升时间tr即举升系统的阶跃响应曲线首次达到目标值所需的时间;
2)稳态误差δ
稳态误差δ即系统达到稳定时系统期望输出与实际输出之间的差值;
上升时间及稳态误差的数值无直接的数学表达,在优化过程中通过举升机构控制器的阶跃响应仿真曲线得到,优化模型为:
minf(Z1,Z2,P,l1,l2,l3,Kkp,Kki,Kkd,Kp,Ki,Kd)=min(tr,δ)
(3)约束条件
齿轮1和齿轮2的齿数满足以下约束条件:
Z1<Z2
其中,d为齿轮1和齿轮2的中心距设置固定值;
滚珠丝杆的导程范围如下,单位mm:
5≤P≤12,P∈{5,6,8,10,12}
连杆AB段、BC段以及OB段的长度范围如下,单位mm:
70≤l1≤110
140≤l2≤180
100≤l3≤140
为了保证举升机构的举升高度达到要求,当连杆AB竖直时,连杆AB段和BC段的长度应满足一定的约束条件:
其中,β0为连杆AB段与BC段的固定夹角;
控制器中比例因子Kkp、Kki、Kkd的范围为:
控制器中的比例系数Kp、积分系数Ki、微分系数Kd的范围为:
0≤Kp≤400
0≤Ki≤4
0≤Kd≤25。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010606596.5A CN111702782B (zh) | 2020-06-29 | 2020-06-29 | 一种换电机器人举升装置结构及控制参数协同优化方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010606596.5A CN111702782B (zh) | 2020-06-29 | 2020-06-29 | 一种换电机器人举升装置结构及控制参数协同优化方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111702782A CN111702782A (zh) | 2020-09-25 |
CN111702782B true CN111702782B (zh) | 2022-07-19 |
Family
ID=72544689
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010606596.5A Active CN111702782B (zh) | 2020-06-29 | 2020-06-29 | 一种换电机器人举升装置结构及控制参数协同优化方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111702782B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113110630A (zh) * | 2021-04-23 | 2021-07-13 | 重庆大学 | 一种换电机器人举升系统节能性集成参数优化方法 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6782839B1 (en) * | 1999-11-01 | 2004-08-31 | Yanmar Diesel Engine Co., Ltd. | Hydrofoil boat |
CN104517033A (zh) * | 2014-12-17 | 2015-04-15 | 重庆大学 | 一种面向能量效率的数控加工工艺参数多目标优化方法 |
CN107387030A (zh) * | 2017-07-26 | 2017-11-24 | 中国海洋石油总公司 | 一种利用本井气的接力举升采油设计方法 |
CN109667567A (zh) * | 2017-10-16 | 2019-04-23 | 中国石油化工股份有限公司 | 一种抽油机井泵下速度提效管提效举升装置及方法 |
CN110450156A (zh) * | 2019-07-30 | 2019-11-15 | 洛阳润信机械制造有限公司 | 多自由度机械臂系统自适应模糊控制器的优化设计方法 |
CN110989526A (zh) * | 2019-12-10 | 2020-04-10 | 南京航空航天大学 | 一种双agv协同运载控制系统及方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102015212515A1 (de) * | 2015-07-03 | 2017-01-05 | Thieme Gmbh & Co. Kg | Siebdruckvorrichtung und Verfahren zum Siebdrucken |
-
2020
- 2020-06-29 CN CN202010606596.5A patent/CN111702782B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6782839B1 (en) * | 1999-11-01 | 2004-08-31 | Yanmar Diesel Engine Co., Ltd. | Hydrofoil boat |
CN104517033A (zh) * | 2014-12-17 | 2015-04-15 | 重庆大学 | 一种面向能量效率的数控加工工艺参数多目标优化方法 |
CN107387030A (zh) * | 2017-07-26 | 2017-11-24 | 中国海洋石油总公司 | 一种利用本井气的接力举升采油设计方法 |
CN109667567A (zh) * | 2017-10-16 | 2019-04-23 | 中国石油化工股份有限公司 | 一种抽油机井泵下速度提效管提效举升装置及方法 |
CN110450156A (zh) * | 2019-07-30 | 2019-11-15 | 洛阳润信机械制造有限公司 | 多自由度机械臂系统自适应模糊控制器的优化设计方法 |
CN110989526A (zh) * | 2019-12-10 | 2020-04-10 | 南京航空航天大学 | 一种双agv协同运载控制系统及方法 |
Non-Patent Citations (2)
Title |
---|
移动分体式垃圾压缩站举升机构优化设计与强度分析;沈磊;《移动分体式垃圾压缩站举升机构优化设计与强度分析》;机械制造与自动化;20180228;第47卷(第1期);第97-100页 * |
面向能耗的纯电动汽车双电机动力系统控制策略;李聪波;《面向能耗的纯电动汽车双电机动力系统控制策略》;计算机集成制造系统;20180308;第24卷(第5期);第1098-1109页 * |
Also Published As
Publication number | Publication date |
---|---|
CN111702782A (zh) | 2020-09-25 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110717218B (zh) | 一种电驱动车辆分布式动力驱动系统重构控制方法及车辆 | |
CN107168104B (zh) | 基于观测器的纯电动智能汽车纵向车速控制方法 | |
CN111702782B (zh) | 一种换电机器人举升装置结构及控制参数协同优化方法 | |
CN113296407A (zh) | 一种基于5次非均匀有理b样条的多机协同轨迹优化方法 | |
CN101508112A (zh) | 三自由度搬运工业机器人多目标优化设计参数的获取方法 | |
CN113110630A (zh) | 一种换电机器人举升系统节能性集成参数优化方法 | |
CN111639422A (zh) | 基于动力学与神经网络的机床进给系统建模方法及设备 | |
CN106934182B (zh) | 一种轻量化机械臂的统一设计方法 | |
CN113219827A (zh) | 无接触型悬浮抓取系统及其模型参考自适应控制方法 | |
CN108839057B (zh) | 一种工业机器人机械结构的模块化参数化设计方法 | |
Bandong et al. | Optimal Gantry Crane PID Controller Based on LQR With Prescribed Degree of Stability by Means of GA, PSO, and SA | |
CN114291067B (zh) | 基于预测的混合动力汽车凸优化能量控制方法及系统 | |
CN103413049B (zh) | 基于机电耦合特性的并联机床结构优化参数值的获取方法 | |
Feng et al. | Multi-objective trajectory planning method for a redundantly actuated parallel manipulator under hybrid force and position control | |
Wang et al. | Lightweight Design of Robot Arm Based on Response Surface Method and MOGA | |
Khorasani et al. | A methodology for designing a lightweight and energy-efficient kinematically redundant actuator | |
CN116088299A (zh) | 卫星天线混联运动机构神经网络反步控制方法 | |
Wang et al. | Design and Control Performance Optimization of Variable Structure Hydrostatic Drive Systems for Wheel Loaders | |
Ming et al. | Sectional Trajectory Planning of Transmission Mechanism based on S-curve and Spline Curve | |
CN114434429B (zh) | 一种工业机器人动态精度设计方法和系统 | |
Li et al. | Integrated optimization for service robotic arms involving workspace, drive train, structural stiffness and lightweight | |
Fan et al. | Multi-objective optimal backstepping control design for the under-actuated rotary flexible link | |
Zhang et al. | Energy Consumption Modeling and Optimization of a Hobbing Machine Tool Considering Multi-Axis Coupling | |
CN118114509B (zh) | 基于预防性混合维保的支链驱动装备在役可靠度增强方法 | |
Jia et al. | A Discrete-Time Sliding Mode Control Method for Multi-Cylinder Hydraulic Press |
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 |