CN115320408A - 轮腿式轮毂电机驱动移动机器人转矩修正控制方法 - Google Patents
轮腿式轮毂电机驱动移动机器人转矩修正控制方法 Download PDFInfo
- Publication number
- CN115320408A CN115320408A CN202211203243.6A CN202211203243A CN115320408A CN 115320408 A CN115320408 A CN 115320408A CN 202211203243 A CN202211203243 A CN 202211203243A CN 115320408 A CN115320408 A CN 115320408A
- Authority
- CN
- China
- Prior art keywords
- wheel
- control mode
- mobile robot
- torque correction
- leg
- 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.)
- Pending
Links
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60L—PROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
- B60L15/00—Methods, circuits, or devices for controlling the traction-motor speed of electrically-propelled vehicles
- B60L15/20—Methods, circuits, or devices for controlling the traction-motor speed of electrically-propelled vehicles for control of the vehicle or its driving motor to achieve a desired performance, e.g. speed, torque, programmed variation of speed
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60K—ARRANGEMENT OR MOUNTING OF PROPULSION UNITS OR OF TRANSMISSIONS IN VEHICLES; ARRANGEMENT OR MOUNTING OF PLURAL DIVERSE PRIME-MOVERS IN VEHICLES; AUXILIARY DRIVES FOR VEHICLES; INSTRUMENTATION OR DASHBOARDS FOR VEHICLES; ARRANGEMENTS IN CONNECTION WITH COOLING, AIR INTAKE, GAS EXHAUST OR FUEL SUPPLY OF PROPULSION UNITS IN VEHICLES
- B60K7/00—Disposition of motor in, or adjacent to, traction wheel
- B60K7/0007—Disposition of motor in, or adjacent to, traction wheel the motor being electric
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60L—PROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
- B60L2220/00—Electrical machine types; Structures or applications thereof
- B60L2220/40—Electrical machine applications
- B60L2220/44—Wheel Hub motors, i.e. integrated in the wheel hub
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60L—PROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
- B60L2240/00—Control parameters of input or output; Target parameters
- B60L2240/10—Vehicle control parameters
- B60L2240/24—Steering angle
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60L—PROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
- B60L2240/00—Control parameters of input or output; Target parameters
- B60L2240/40—Drive Train control parameters
- B60L2240/42—Drive Train control parameters related to electric machines
- B60L2240/429—Current
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60L—PROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
- B60L2240/00—Control parameters of input or output; Target parameters
- B60L2240/40—Drive Train control parameters
- B60L2240/46—Drive Train control parameters related to wheels
- B60L2240/463—Torque
-
- 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/60—Other road transportation technologies with climate change mitigation effect
- Y02T10/72—Electric energy management in electromobility
Landscapes
- Engineering & Computer Science (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Power Engineering (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种轮腿式轮毂电机驱动移动机器人转矩修正控制方法,步骤如下:首先获取移动机器人的期望转角、轮腿摆角信息和移动机器人的动力信息,根据期望转角划分为直线行驶控制模式和转向控制模式,根据移动机器人轮腿的摆角信息、横摆角速度和质心偏侧角划分为正常直线行驶控制模式、非正常直线行驶控制模式、正常转向控制模式和非正常转向控制模式,并计算确定各控制模式下的各轮驱动转矩的目标值,通过调节轮毂电机的电流实现对驱动转矩的反馈控制,使移动机器人的实际行驶路径与期望行驶路径一致。本发明旨在克服轮腿式移动机器人由于轮腿摆动对小车行驶稳定性的影响,提高各轮的行驶稳定性。
Description
技术领域
本发明涉及机器人驱动控制技术领域,具体地指一种轮腿式轮毂电机驱动移动机器人转矩修正控制方法。
背景技术
在轮毂电机驱动车辆与传统车辆相比,其在动力配置、传动效率、操控性能以及能源利用等方面具有技术优势,其响应快捷,正反转灵活,瞬间动力性能更为优越,显著提高了车辆适应恶劣路面条件的行驶能力。轮腿式机器人具有机动灵活、行驶速度快、越障能力强等优点,在太空探测、极地探险、考古发掘、军事侦查、救灾抢险等领域有广泛的应用前景。轮腿式轮毂电机驱动移动机器人能够很好的适应果园以及油茶林的崎岖地形,能够精确调节四轮转矩,从而提高机器人的行驶稳定性。
轮腿式移动机器人在越障过程中由于轮腿的摆动,会导致各轮转矩的差异从而影响了其行驶稳定性,同时轮腿式移动机器人在转向过程由于轮腿的摆动角度的差异,也会导致各轮的轴向力不在同一轴线上的情况,从而使其在驱动控制过程中的精度不足。
发明内容
本发明的目的就是要克服上述现有技术存在的不足,提供一种轮腿式轮毂电机驱动移动机器人转矩修正控制方法,该方法可以提高移动机器人驱动控制过程中的控制精度,提高轮腿式移动机器人的行驶稳定性。
为实现上述目的,本发明公开了一种轮腿式轮毂电机驱动移动机器人转矩修正控制方法,步骤如下:首先获取移动机器人的期望转角、轮腿摆角信息和移动机器人的动力信息,根据期望转角划分为直线行驶控制模式和转向控制模式,根据移动机器人轮腿的摆角信息、横摆角速度和质心偏侧角划分为正常直线行驶控制模式、非正常直线行驶控制模式、正常转向控制模式和非正常转向控制模式,并计算确定各控制模式下的各轮驱动转矩的目标值,通过调节轮毂电机的电流实现对驱动转矩的反馈控制,使移动机器人的实际行驶路径与期望行驶路径一致。
进一步地,当期望转角为零,且各轮腿摆角一致,且横摆角速度和质心偏侧角在合理范围内时,进入正常直线行驶控制模式,无需对当前各轮进行转矩修正。
进一步地,当期望转角为零,且各轮腿摆角一致,且横摆角速度或质心偏侧角超出允许范围内时,或当期望转角为零,且各轮腿摆角不一致时,进入非正常直线行驶控制模式,对当前各轮进行转矩修正。
进一步地,当期望转角不为零,且横摆角速度和质心偏侧角在允许范围内时,进入正常转向控制模式,无需对当前各轮进行转矩修正。
进一步地,当期望转角不为零,且横摆角速度或质心偏侧角不在允许范围内时,进入非正常转向控制模式,对当前各轮进行转矩修正。
进一步地,在非正常直线行驶控制模式中,由于各轮腿的摆角不一致,则会产生横摆角速度以及质心偏侧角,导致小车无法正常直线行驶,因此需要对各轮进行转矩修正。
进一步地,在正常转向控制模式中,由于各轮腿的摆腿角度不一致所产生的横摆角速度和质心偏侧角正好处于当前期望转角所要求的允许范围内,能满足其正常转向,无需对各轮进行转矩修正。
进一步地,在非正常转向控制模式中,由于各轮腿的摆腿角度不一致所产生的横摆角速度和质心偏侧角与当前期望转角方向相反或同向当不在允许范围内,不能满足其正常转向,因此需要对各轮进行转矩修正。
本发明的有益效果:
1、控制模式划分更细化,提高控制精度。划分驱动控制模式时,还综合考虑了轮腿摆动角度的影响,根据轮腿摆角、横摆角速度和质心偏侧角将移动机器人行驶的工况划分为四种控制模式。
2、各轮转矩的目标值更加的精确,提高了行驶稳定性。本发明分别给出了正常直线行驶、非正常直线行驶、正常转向和非正常转向控制模式时摆角所处的状态,通过电流反馈修正各驱动轮的转矩,提高了各轮的行驶稳定性。
附图说明
图1为本发明控制方法的结构框图。
图2 为本发明控制方法的工作流程示意图。
具体实施方式
下面结合附图对本发明作进一步的解释。
如图1所示,一种轮腿式轮毂电机驱动移动机器人转矩修正控制方法,其主要控制思路为:首先根据各传感器获取机器人的车轮期望转角、各轮腿摆角和动力信息输入ECU,动力信息包括各轮轮速、横摆角速度、质心偏侧角、纵向加速度和侧向加速度;根据期望转角划分为直线行驶控制模式和转向控制模式,根据移动机器人轮腿的摆角信息、横摆角速度和质心偏侧角划分为正常直线行驶控制模式、非正常直线行驶控制模式、正常转向控制模式和非正常转向控制模式,并计算确定各控制模式下的各轮驱动转矩的目标值,通过调节轮毂电机的电流实现对驱动转矩的反馈控制,使移动机器人的实际行驶路径与期望行驶路径一致。
如图2所示,本发明所述的轮腿式轮毂电机驱动移动机器人控制方法工作流程如下:
首先,机器人通过接收到的车轮期望转角信号,确定机器人的驱动控制模式是直线行驶控制模式还是转向控制模式;如果期望转角信号为零,则为直线行驶控制模式;若期望转角不为零,则执行转向控制模式。
ECU根据期望转角信息、各轮腿摆角和动力信息计算出该驱动控制模式下的期望横摆角速度和期望质心偏侧角。
当期望转角为零,且各轮腿摆角一致,且横摆角速度和质心偏侧角在合理范围内时,进入正常直线行驶控制模式,无需对当前各轮转矩进行调节。
当期望转角为零,且各轮腿摆角一致,且横摆角速度或质心偏侧角超出允许范围内时,或当期望转角为零,且各轮腿摆角不一致时,进入非正常直线行驶控制模式,计算各轮驱动转矩的目标值。
当期望转角不为零,且横摆角速度和质心偏侧角在允许范围内时,进入正常转向控制模式,无需对当前各轮进行转矩修正。
当期望转角不为零,且横摆角速度或质心偏侧角不在允许范围内时,进入非正常转向控制模式,计算各轮驱动转矩的目标值。
最后,根据不同控制模式下计算出的相应车轮驱动转矩的目标值输入到对应的电机控制器,电机控制器根据目标转矩信号,对与之相连的轮毂电机采用电流反馈调节转矩的控制方法进行电机驱动控制,从而实现各模式下各轮转矩的精确控制和各轮的行驶稳定性。
Claims (8)
1.一种轮腿式轮毂电机驱动移动机器人转矩修正控制方法,其特征在于:获取智能小车的期望转角、轮腿摆角信息和小车的动力信息,根据期望转角划分为直线行驶控制模式和转向控制模式,根据小车轮腿的摆角信息、横摆角速度和质心偏侧角划分为正常直线行驶控制模式、非正常直线行驶控制模式、正常转向控制模式和非正常转向控制模式,并计算确定各控制模式下的各轮驱动转矩的目标值,通过调节轮毂电机的电流实现对驱动转矩的反馈控制,使小车的实际行驶路径与期望行驶路径一致。
2.根据权利要求1所述的轮腿式轮毂电机驱动移动机器人转矩修正控制方法,其特征在于:当期望转角为零,且各轮腿摆角一致,且横摆角速度和质心偏侧角在合理范围内时,进入正常直线行驶控制模式,无需对当前各轮进行转矩修正。
3.根据权利要求1所述的轮腿式轮毂电机驱动移动机器人转矩修正控制方法,其特征在于:当期望转角为零,且各轮腿摆角一致,且横摆角速度或质心偏侧角超出允许范围内时,或当期望转角为零,且各轮腿摆角不一致时,进入非正常直线行驶控制模式,对当前各轮进行转矩修正。
4.根据权利要求1所述的轮腿式轮毂电机驱动移动机器人转矩修正控制方法,其特征在于:当期望转角不为零,且横摆角速度和质心偏侧角在允许范围内时,进入正常转向控制模式,无需对当前各轮进行转矩修正。
5.根据权利要求1所述的轮腿式轮毂电机驱动移动机器人转矩修正控制方法,其特征在于:当期望转角不为零,且横摆角速度或质心偏侧角不在允许范围内时,进入非正常转向控制模式,对当前各轮进行转矩修正。
6.根据权利要求3所述的轮腿式轮毂电机驱动移动机器人转矩修正控制方法,其特征在于:在非正常直线行驶模式中,由于各轮腿的摆角不一致,则会产生横摆角速度以及质心偏侧角,导致小车无法正常直线行驶,因此需要对各轮进行转矩修正。
7.根据权利要求4所述的轮腿式轮毂电机驱动移动机器人转矩修正控制方法,其特征在于:在正常转向控制模式中,由于各轮腿的摆腿角度不一致所产生的横摆角速度和质心偏侧角正好处于当前期望转角所要求的允许范围内,能满足其正常转向,无需进行转矩修正。
8.根据权利要求5所述的轮腿式轮毂电机驱动移动机器人转矩修正控制方法,其特征在于:在非正常转向控制模式中,由于各轮腿的摆腿角度不一致所产生的横摆角速度和质心偏侧角与当前期望转角方向相反或同向当不在允许范围内,不能满足其正常转向,因此需要对各轮进行转矩修正。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211203243.6A CN115320408A (zh) | 2022-09-29 | 2022-09-29 | 轮腿式轮毂电机驱动移动机器人转矩修正控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211203243.6A CN115320408A (zh) | 2022-09-29 | 2022-09-29 | 轮腿式轮毂电机驱动移动机器人转矩修正控制方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN115320408A true CN115320408A (zh) | 2022-11-11 |
Family
ID=83914030
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202211203243.6A Pending CN115320408A (zh) | 2022-09-29 | 2022-09-29 | 轮腿式轮毂电机驱动移动机器人转矩修正控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN115320408A (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN117434572A (zh) * | 2023-12-22 | 2024-01-23 | 深圳市明心数智科技有限公司 | 位置信息处理方法、装置、设备及介质 |
-
2022
- 2022-09-29 CN CN202211203243.6A patent/CN115320408A/zh active Pending
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN117434572A (zh) * | 2023-12-22 | 2024-01-23 | 深圳市明心数智科技有限公司 | 位置信息处理方法、装置、设备及介质 |
CN117434572B (zh) * | 2023-12-22 | 2024-03-26 | 深圳市明心数智科技有限公司 | 位置信息处理方法、装置、设备及介质 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109515512B (zh) | 用于轮式独立驱动车辆的线控差动转向系统的控制方法 | |
CN106080753B (zh) | 一种融合主动转向、助力转向和直接横摆力矩控制功能的电动轮转向控制系统及其控制方法 | |
CN107685767B (zh) | 多轴轮毂电机驱动车辆后轮线控转向驱动装置及转向方法 | |
KR101734277B1 (ko) | 인휠 시스템을 이용한 차량 제어 방법 | |
CN110466604B (zh) | 轮毂电机驱动电动汽车差动驱动转向及稳定性的控制方法 | |
CN106882080B (zh) | 一种差速转向系统及其自适应神经网络容错控制方法 | |
CN111546907B (zh) | 一种四轮转向轮毂电机驱动车辆的轮速分配方法 | |
CN105966263A (zh) | 一种轮毂电机驱动的电动轮汽车差动转向路感控制方法 | |
CN112590770B (zh) | 轮毂电机驱动车辆转向稳定性控制方法 | |
CN115320408A (zh) | 轮腿式轮毂电机驱动移动机器人转矩修正控制方法 | |
CN112026777B (zh) | 一种车辆复合转向系统及其模式切换控制方法 | |
CN110901652B (zh) | 一种电动差动转向车辆车速控制系统及其直行纠偏方法 | |
CN102717726B (zh) | 一种电子差速控制方法及运用该方法的电驱动矿车 | |
CN104773201A (zh) | 一种用于多轴分布式机电驱动车辆的复合转向辅助系统 | |
CN106168758B (zh) | 四轮独立驱动电动汽车的航向跟踪控制方法 | |
CN109849898A (zh) | 基于遗传算法混合优化gpc的车辆横摆稳定性控制方法 | |
CN113353061A (zh) | 一种基于滑模控制的四电机驱动fsae赛车电子差速算法 | |
CN209739155U (zh) | 一种线控四轮主动转向电动轮系统 | |
CN110126808B (zh) | 一种爆胎状态下分布式驱动电动汽车的控制方法及系统 | |
CN109795551B (zh) | 一种基于线性二次型微分博弈的四轮独立驱动电动汽车四轮主动转向控制方法 | |
CN114148411B (zh) | 一种轮式无人平台的漂移控制方法 | |
CN114524021A (zh) | 基于分布式电机驱动的车辆行驶轨迹调节方法和装置 | |
CN111824256B (zh) | 具有自适应容错控制功能的线控转向系统及其控制方法 | |
CN109795337B (zh) | 一种基于车轮转速控制的分布式车辆纵向控制方法 | |
CN115257922B (zh) | 一种原地转向控制方法、装置及控制系统 |
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 |