[go: up one dir, main page]

CN115454089A - A vehicle longitudinal speed control method, device, vehicle and readable storage medium - Google Patents

A vehicle longitudinal speed control method, device, vehicle and readable storage medium Download PDF

Info

Publication number
CN115454089A
CN115454089A CN202211198114.2A CN202211198114A CN115454089A CN 115454089 A CN115454089 A CN 115454089A CN 202211198114 A CN202211198114 A CN 202211198114A CN 115454089 A CN115454089 A CN 115454089A
Authority
CN
China
Prior art keywords
vehicle
wheel
information
longitudinal speed
swing
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
Application number
CN202211198114.2A
Other languages
Chinese (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.)
BDstar Intelligent and Connected Vehicle Technology Co Ltd
Original Assignee
BDstar Intelligent and Connected Vehicle Technology 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 BDstar Intelligent and Connected Vehicle Technology Co Ltd filed Critical BDstar Intelligent and Connected Vehicle Technology Co Ltd
Priority to CN202211198114.2A priority Critical patent/CN115454089A/en
Publication of CN115454089A publication Critical patent/CN115454089A/en
Pending legal-status Critical Current

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0231Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0238Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors
    • G05D1/024Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors in combination with a laser
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0214Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory in accordance with safety or protection criteria, e.g. avoiding hazardous areas
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0255Control of position or course in two dimensions specially adapted to land vehicles using acoustic signals, e.g. ultra-sonic singals
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0276Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
    • YGENERAL 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
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02TCLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
    • Y02T10/00Road transport of goods or passengers
    • Y02T10/60Other road transportation technologies with climate change mitigation effect
    • Y02T10/72Electric energy management in electromobility

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Optics & Photonics (AREA)
  • Electromagnetism (AREA)
  • Acoustics & Sound (AREA)
  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)

Abstract

本申请涉及车辆控制技术领域,提供一种车辆纵向速度控制方法、装置、车辆和可读存储介质,该车辆纵向速度控制方法通过获取车辆的实时姿态信息,基于实时姿态信息确定车辆的摆动信息,获取车辆的车轮振动信息,获取车辆的车轮转动圈数和行驶距离,基于车轮转动圈数和行驶距离确定车辆的滑移率,基于摆动信息、振动信息和滑移率计算车辆的纵向速度,控制车辆按照纵向速度行驶。本申请一方面减少了车辆损耗和车辆可能发生损坏的概率,另一方面避免或者减少发生交通安全事故的损失,提高了乘客的乘坐舒适性和安全性。

Figure 202211198114

The present application relates to the technical field of vehicle control, and provides a vehicle longitudinal speed control method, device, vehicle and readable storage medium. The vehicle longitudinal speed control method obtains real-time attitude information of the vehicle and determines the swing information of the vehicle based on the real-time attitude information. Obtain the wheel vibration information of the vehicle, obtain the number of wheel rotations and driving distance of the vehicle, determine the slip rate of the vehicle based on the number of wheel rotations and driving distance, calculate the longitudinal speed of the vehicle based on the swing information, vibration information and slip rate, and control The vehicle travels at longitudinal speed. On the one hand, the application reduces vehicle loss and the possibility of vehicle damage, on the other hand, avoids or reduces the loss of traffic safety accidents, and improves the comfort and safety of passengers.

Figure 202211198114

Description

一种车辆纵向速度控制方法、装置、车辆和可读存储介质A vehicle longitudinal speed control method, device, vehicle and readable storage medium

技术领域technical field

本发明涉及车辆控制技术领域,具体而言,涉及一种车辆纵向速度控制方法、装置、车辆和可读存储介质。The present invention relates to the technical field of vehicle control, in particular to a vehicle longitudinal speed control method, device, vehicle and readable storage medium.

背景技术Background technique

车辆在行驶过程中行驶的地形复杂,路面状况多变,例如,车辆将可能在泥地、水泥地以及沥青路等地面进行行驶,而车辆通过轮胎直接与地面接触,因此,路面的状况直接影响车辆的行驶稳定性和行驶安全。目前,自动驾驶车辆在行驶过程中判断的路面状况可能与实际的路面状况存在区别,当估计的路面状况与实际路面状态存在较大差别时,将严重影响自动驾驶车辆的行驶安全性和舒适性,且可能导致车辆发生交通安全事故。The terrain in which the vehicle is driving is complex and the road conditions are changeable. For example, the vehicle may drive on muddy ground, concrete ground, and asphalt roads, and the vehicle directly contacts the ground through the tires. Therefore, the condition of the road surface directly affects Driving stability and driving safety of the vehicle. At present, the road conditions judged by the self-driving vehicles during driving may be different from the actual road conditions. When there is a large difference between the estimated road conditions and the actual road conditions, it will seriously affect the driving safety and comfort of the self-driving vehicles. , and may lead to vehicle traffic accidents.

发明内容Contents of the invention

本发明的目的在于提供一种车辆纵向速度控制方法、装置、车辆和可读存储介质。The object of the present invention is to provide a vehicle longitudinal speed control method, device, vehicle and readable storage medium.

第一方面,本发明提供一种车辆纵向速度控制方法,所述方法包括:In a first aspect, the present invention provides a method for controlling vehicle longitudinal speed, the method comprising:

获取车辆的实时姿态信息,基于所述实时姿态信息确定所述车辆的摆动信息;acquiring real-time attitude information of the vehicle, and determining swing information of the vehicle based on the real-time attitude information;

获取所述车辆的车轮振动信息;acquiring wheel vibration information of the vehicle;

获取所述车辆的车轮转动圈数和行驶距离,基于所述车轮转动圈数和所述行驶距离确定所述车辆的滑移率;Obtaining the number of wheel turns and the travel distance of the vehicle, and determining the slip ratio of the vehicle based on the number of wheel turns and the travel distance;

基于所述摆动信息、所述振动信息和所述滑移率,计算所述车辆的纵向速度,控制所述车辆按照所述纵向速度行驶。Calculate the longitudinal speed of the vehicle based on the swing information, the vibration information and the slip ratio, and control the vehicle to run according to the longitudinal speed.

在可选的实施方式中,所述实时姿态信息包括俯仰角和侧倾角,所述基于所述实时姿态信息确定所述车辆的摆动信息,包括:In an optional embodiment, the real-time attitude information includes a pitch angle and a roll angle, and the determination of the swing information of the vehicle based on the real-time attitude information includes:

对所述俯仰角和所述侧倾角进行求导得到相应的俯仰角速度和侧倾角速度;Deriving the pitch angle and the roll angle to obtain a corresponding pitch rate and roll rate;

基于所述俯仰角、所述侧倾角、所述俯仰角速度和所述侧倾角速度确定所述摆动信息。The swing information is determined based on the pitch angle, the roll angle, the pitch rate, and the roll rate.

在可选的实施方式中,所述车辆上设置有多个陀螺仪传感器,所述获取所述车辆的车轮振动信息,包括:In an optional embodiment, the vehicle is provided with a plurality of gyro sensors, and the acquisition of wheel vibration information of the vehicle includes:

通过所述多个陀螺仪传感器分别检测对应车轮的振幅大小和振幅频率;Detecting the amplitude and amplitude frequency of the corresponding wheels respectively through the plurality of gyroscope sensors;

根据每个车轮的振幅大小和振幅频率确定全部车轮的振幅大小平均值和振幅频率平均值,所述车轮振动信息包括所述振幅大小平均值和所述振幅频率平均值。The average value of the amplitude and the average frequency of all wheels are determined according to the amplitude and frequency of each wheel, and the wheel vibration information includes the average value of the amplitude and the average value of the frequency.

在可选的实施方式中,通过纵向运动表达式计算所述纵向速度,所述纵向运动表达式为:In an optional implementation manner, the longitudinal velocity is calculated by a longitudinal motion expression, and the longitudinal motion expression is:

OP=P+R*(Va+Vc+Vs)*v;OP=P+R*(Va+Vc+Vs)*v;

其中,OP为所述纵向速度,R为总增益系数,P为预设纵向运动控制器的输出速度,v为所述车辆的实时速度,Va为所述车辆的车身摆动系数,Vc为所述车辆的车轮振动系数,Vs为所述车辆的滑移系数,所述滑移系数通过所述滑移率计算得到。Wherein, OP is the longitudinal speed, R is the overall gain coefficient, P is the output speed of the preset longitudinal motion controller, v is the real-time speed of the vehicle, Va is the body swing coefficient of the vehicle, and Vc is the The wheel vibration coefficient of the vehicle, Vs is the slip coefficient of the vehicle, and the slip coefficient is obtained by calculating the slip ratio.

在可选的实施方式中,所述车身摆动系数根据所述摆动信息通过第一预设公式计算得到,所述第一预设公式为:In an optional implementation manner, the vehicle body swing coefficient is calculated according to the swing information through a first preset formula, and the first preset formula is:

Va=k*(k1*pitch+k2*roll+k3*pitch_dot+k4*roll_dot);V a =k*(k1*pitch+k2*roll+k3*pitch_dot+k4*roll_dot);

其中,pitch为俯仰角,roll为侧倾角,pitch_dot为俯仰角速度,roll_dot为侧倾角速度,k1、k2、k3和k4分别为所述俯仰角、所述侧倾角、所述俯仰角速度和所述侧倾角速度的增益系数,k为车身纵向运动控制增益系数。Among them, pitch is the pitch angle, roll is the roll angle, pitch_dot is the pitch angular velocity, roll_dot is the roll angular velocity, k1, k2, k3 and k4 are the pitch angle, the roll angle, the pitch angular velocity and the side The gain coefficient of the inclination velocity, k is the gain coefficient of the body longitudinal motion control.

在可选的实施方式中,所述车轮振动系数根据所述车轮振动信息通过第二预设公式计算得到,所述第二预设公式为:In an optional implementation manner, the wheel vibration coefficient is calculated according to the wheel vibration information through a second preset formula, and the second preset formula is:

Vc=g*(g1*h+g2*w);Vc=g*(g1*h+g2*w);

其中,h为车辆车轮的振幅大小平均值,w为所述车辆车轮的振幅频率平均值,g为车轮纵向运动控制总增益,g1和g2分别为车轮摆动大小和车轮摆动频率的增益系数。Wherein, h is the average value of the amplitude of the vehicle wheel, w is the average value of the amplitude frequency of the vehicle wheel, g is the total gain of the wheel longitudinal motion control, and g1 and g2 are the gain coefficients of the wheel swing size and wheel swing frequency, respectively.

在可选的实施方式中,所述车身摆动系数、所述车轮振动系数和所述滑移系数的取值范围均为(-1,0)。In an optional embodiment, the value ranges of the vehicle body sway coefficient, the wheel vibration coefficient and the slip coefficient are all (-1, 0).

第二方面,本发明提供一种车辆纵向速度控制装置,所述装置包括:In a second aspect, the present invention provides a vehicle longitudinal speed control device, the device comprising:

第一获取模块,用于获取车辆的实时姿态信息,基于所述实时姿态信息确定所述车辆的摆动信息;A first acquisition module, configured to acquire real-time attitude information of the vehicle, and determine swing information of the vehicle based on the real-time attitude information;

第二获取模块,用于获取所述车辆的车轮振动信息;A second acquisition module, configured to acquire wheel vibration information of the vehicle;

第三获取模块,用于获取所述车辆的车轮转动圈数和行驶距离,基于所述车轮转动圈数和所述行驶距离确定所述车辆的滑移率;A third acquisition module, configured to acquire the number of wheel turns and the travel distance of the vehicle, and determine the slip ratio of the vehicle based on the number of wheel turns and the travel distance;

确定模块,用于基于所述摆动信息、所述振动信息和所述滑移率,计算所述车辆的纵向速度,控制所述车辆按照所述纵向速度行驶。A determining module, configured to calculate the longitudinal speed of the vehicle based on the swing information, the vibration information and the slip ratio, and control the vehicle to travel according to the longitudinal speed.

第三方面,本发明提供一种车辆,包括存储器和处理器,所述存储器存储有计算机程序,所述计算机程序在所述处理器上运行时执行所述的车辆纵向速度控制方法。In a third aspect, the present invention provides a vehicle, including a memory and a processor, the memory stores a computer program, and the computer program executes the vehicle longitudinal speed control method when running on the processor.

第四方面,本发明提供一种可读存储介质,其存储有计算机程序,所述计算机程序在处理器上运行时执行所述的车辆纵向速度控制方法。In a fourth aspect, the present invention provides a readable storage medium, which stores a computer program, and executes the vehicle longitudinal speed control method when the computer program runs on a processor.

本发明实施例的有益效果是:The beneficial effects of the embodiments of the present invention are:

本申请实施例提供一种车辆纵向速度控制方法,该车辆纵向速度控制方法通过获取车辆的实时姿态信息,基于实时姿态信息确定车辆的摆动信息,获取车辆的车轮振动信息,获取车辆的车轮转动圈数和行驶距离,基于车轮转动圈数和行驶距离确定车辆的滑移率,基于摆动信息、振动信息和滑移率计算车辆的纵向速度,控制车辆按照纵向速度行驶。本申请一方面减少了车辆损耗和车辆可能发生损坏的概率,另一方面避免或者减少发生交通安全事故的损失,提高了乘客的乘坐舒适性和安全性。An embodiment of the present application provides a vehicle longitudinal speed control method. The vehicle longitudinal speed control method obtains the real-time attitude information of the vehicle, determines the swing information of the vehicle based on the real-time attitude information, obtains the wheel vibration information of the vehicle, and obtains the wheel rotation circle of the vehicle. Calculate the vehicle's slip rate based on the number of wheel rotations and the travel distance, calculate the vehicle's longitudinal speed based on the swing information, vibration information and slip rate, and control the vehicle to travel at the longitudinal speed. On the one hand, the application reduces vehicle loss and the possibility of vehicle damage, on the other hand, avoids or reduces the loss of traffic safety accidents, and improves the comfort and safety of passengers.

为使本申请的上述目的、特征和优点能更明显易懂,下文特举较佳实施例,并配合所附附图,作详细说明如下。In order to make the above-mentioned purpose, features and advantages of the present application more comprehensible, preferred embodiments will be described in detail below together with the accompanying drawings.

附图说明Description of drawings

为了更清楚地说明本发明的技术方案,下面将对实施例中所需要使用的附图作简单地介绍,应当理解,以下附图仅示出了本发明的某些实施例,因此不应被看作是对本发明保护范围的限定。在各个附图中,类似的构成部分采用类似的编号。In order to illustrate the technical solution of the present invention more clearly, the following drawings will be briefly introduced in the embodiments. It should be understood that the following drawings only show some embodiments of the present invention, and therefore should not be regarded as It is regarded as limiting the protection scope of the present invention. In the respective drawings, similar components are given similar reference numerals.

图1示出了本申请实施例提出的一种车辆纵向速度控制方法的流程示意图;FIG. 1 shows a schematic flow chart of a vehicle longitudinal speed control method proposed in an embodiment of the present application;

图2示出了本申请实施例提出的一种车辆纵向速度控制方法中确定车轮振动信息的流程示意图;Fig. 2 shows a schematic flow chart of determining wheel vibration information in a vehicle longitudinal speed control method proposed by an embodiment of the present application;

图3示出了本申请实施例提出的一种车辆纵向速度控制装置的结构示意图。Fig. 3 shows a schematic structural diagram of a vehicle longitudinal speed control device proposed by an embodiment of the present application.

主要元件符号说明:Description of main component symbols:

10-车辆纵向速度控制装置;11-第一获取模块;12-第二获取模块;13-第三获取模块;14-确定模块。10 - vehicle longitudinal speed control device; 11 - first acquisition module; 12 - second acquisition module; 13 - third acquisition module; 14 - determination module.

具体实施方式detailed description

下面将结合本发明实施例中附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。The following will clearly and completely describe the technical solutions in the embodiments of the present invention with reference to the accompanying drawings in the embodiments of the present invention. Obviously, the described embodiments are only some, not all, embodiments of the present invention.

通常在此处附图中描述和示出的本发明实施例的组件可以以各种不同的配置来布置和设计。因此,以下对在附图中提供的本发明的实施例的详细描述并非旨在限制要求保护的本发明的范围,而是仅仅表示本发明的选定实施例。基于本发明的实施例,本领域技术人员在没有做出创造性劳动的前提下所获得的所有其他实施例,都属于本发明保护的范围。The components of the embodiments of the invention generally described and illustrated in the figures herein may be arranged and designed in a variety of different configurations. Accordingly, the following detailed description of the embodiments of the invention provided in the accompanying drawings is not intended to limit the scope of the claimed invention, but merely represents selected embodiments of the invention. Based on the embodiments of the present invention, all other embodiments obtained by those skilled in the art without making creative efforts belong to the protection scope of the present invention.

在下文中,可在本发明的各种实施例中使用的术语“包括”、“具有”及其同源词仅意在表示特定特征、数字、步骤、操作、元件、组件或前述项的组合,并且不应被理解为首先排除一个或更多个其它特征、数字、步骤、操作、元件、组件或前述项的组合的存在或增加一个或更多个特征、数字、步骤、操作、元件、组件或前述项的组合的可能性。Hereinafter, the terms "comprising", "having" and their cognates that may be used in various embodiments of the present invention are only intended to represent specific features, numbers, steps, operations, elements, components or combinations of the foregoing, And it should not be understood as first excluding the existence of one or more other features, numbers, steps, operations, elements, components or combinations of the foregoing or adding one or more features, numbers, steps, operations, elements, components or a combination of the foregoing possibilities.

此外,术语“第一”、“第二”、“第三”等仅用于区分描述,而不能理解为指示或暗示相对重要性。In addition, the terms "first", "second", "third", etc. are only used for distinguishing descriptions, and should not be construed as indicating or implying relative importance.

除非另有限定,否则在这里使用的所有术语(包括技术术语和科学术语)具有与本发明的各种实施例所属领域普通技术人员通常理解的含义相同的含义。所述术语(诸如在一般使用的词典中限定的术语)将被解释为具有与在相关技术领域中的语境含义相同的含义并且将不被解释为具有理想化的含义或过于正式的含义,除非在本发明的各种实施例中被清楚地限定。Unless otherwise defined, all terms (including technical terms and scientific terms) used herein have the same meaning as commonly understood by one of ordinary skill in the art to which various embodiments of the present invention belong. The terms (such as those defined in commonly used dictionaries) will be interpreted as having the same meaning as the contextual meaning in the relevant technical field and will not be interpreted as having an idealized meaning or an overly formal meaning, Unless clearly defined in various embodiments of the present invention.

可以理解的是,车辆的运动控制不仅与地面上的复杂环境、交通法规和车辆动力学约束相关,还与路面状况有关。为了精确预测车辆对路面激励输入的响应,首先需要对路面本身进行恰当的测量,目前常用的测量方法有四种,第一种是经典测量技术,通过水平仪和标尺进行路面不平度测量,但是该方法费时费力,并不适用于自动驾驶汽车这种实时系统;第二种为使用路面不平度测量仪进行测量,路面不平度测量仪一般安装在车体或者拖车上,通过拖带的从动轮来测量路面不平度,该方法需要在车辆上增加机械结构,并不适用于自动驾驶汽车;第三种方法为使用倾斜测量装置进行测量,即使用一辆双轮小车并配合自立式陀螺仪来测量非路面的不平度,该方法将明显增加机械结构,并且不适用于平路的测量,此方案也不适用;第四种方法为使用非接触式路面测量装置,即通过激光或者超声波来测量路面不平度,且测量精度较高,但是将增加元器件,从而将增加车辆的成本。It is understandable that the motion control of a vehicle is not only related to the complex environment on the ground, traffic regulations, and vehicle dynamics constraints, but also to the road surface conditions. In order to accurately predict the response of the vehicle to the excitation input of the road surface, it is first necessary to properly measure the road surface itself. At present, there are four commonly used measurement methods. The first is the classical measurement technology, which uses a level meter and a ruler to measure the road surface roughness. However, this The method is time-consuming and labor-intensive, and is not suitable for real-time systems such as self-driving cars; the second method is to use a road surface roughness measuring instrument for measurement. The road surface roughness measuring instrument is generally installed on the car body or trailer, and is measured by the driven wheel of the towing Road unevenness, this method needs to add a mechanical structure to the vehicle, and is not suitable for self-driving cars; the third method is to use a tilt measurement device to measure, that is, to use a two-wheeled car and a self-supporting gyroscope to measure non-uniform The unevenness of the road surface, this method will obviously increase the mechanical structure, and it is not suitable for the measurement of flat roads, and this scheme is not applicable; the fourth method is to use a non-contact road surface measurement device, that is, to measure the unevenness of the road surface by laser or ultrasonic waves Degree, and the measurement accuracy is high, but it will increase the components, which will increase the cost of the vehicle.

本申请通过一种不增加明显的车辆机械部件,不增加大额的车辆硬件成本的方式测量和估计路面不平度,通过路面状况为响应,不论在泥地、水泥地还是沥青等路面,都可以自适应全部的路面状况来控制车辆运动。使得车辆的运动控制更加符合实际路面状况,不仅增加了自动驾驶车辆的行驶安全性和舒适性,还在一定层度上减少了车辆的磨损和降低了发生的损坏的可能性。This application measures and estimates the unevenness of the road surface in a way that does not add obvious vehicle mechanical parts and does not increase the cost of large vehicle hardware, and responds to the road surface conditions, no matter on muddy ground, cement ground or asphalt. Adapt to all road conditions to control vehicle movement. The motion control of the vehicle is more in line with the actual road conditions, which not only increases the driving safety and comfort of the self-driving vehicle, but also reduces the wear and tear of the vehicle and the possibility of damage to a certain extent.

实施例1Example 1

请参考图1,本申请实施例提出一种车辆纵向速度控制方法,示范性地,该车辆纵向速度控制方法包括步骤S100~S400。Please refer to FIG. 1 , the embodiment of the present application proposes a method for controlling the longitudinal speed of a vehicle. Exemplarily, the method for controlling the longitudinal speed of a vehicle includes steps S100-S400.

步骤S100:获取车辆的实时姿态信息,基于实时姿态信息确定车辆的摆动信息。Step S100: Obtain real-time attitude information of the vehicle, and determine vehicle swing information based on the real-time attitude information.

在本申请中,摆动信息包括摆动角度和角速度,摆动角度包括俯仰角和侧倾角,角速度包括俯仰角速度和侧倾角速度。车辆将通过INS(Inertial Navigation System,惯性导航系统)实时获取车辆的姿态和位置,即车辆的实时姿态信息。实时姿态信息包括车辆的pitch(俯仰角)、yaw(航向角)和roll(侧倾角)等信息,若以x轴正方向为车辆的前进方向,俯仰角是车辆绕车体坐标Y轴的摆动,侧倾角是车辆绕车体坐标x轴摆动,俯仰角和侧倾角最能反映路面不平激励对车辆的影响,因此车辆的摆动角度,即俯仰角和侧倾角将用于评价车身摆动程度。In the present application, the swing information includes a swing angle and an angular velocity, the swing angle includes a pitch angle and a roll angle, and the angular velocity includes a pitch angular velocity and a roll angular velocity. The vehicle will obtain the attitude and position of the vehicle in real time through the INS (Inertial Navigation System, inertial navigation system), that is, the real-time attitude information of the vehicle. The real-time attitude information includes information such as the pitch (pitch angle), yaw (yaw angle) and roll (roll angle) of the vehicle. If the positive direction of the x-axis is the forward direction of the vehicle, the pitch angle is the swing of the vehicle around the Y-axis of the body coordinates. , the roll angle is the swing angle of the vehicle around the x-axis of the car body coordinates, and the pitch angle and roll angle can best reflect the impact of the uneven road excitation on the vehicle, so the swing angle of the vehicle, that is, the pitch angle and roll angle, will be used to evaluate the swing degree of the vehicle body.

通过对俯仰角和侧倾角进行求导计算,将得到俯仰角对应的俯仰角速度(pitch_dot)和侧倾角对应的侧倾角速度(roll_dot),俯仰角速度和侧倾角速度也将作为车身对路面激励响应的频率指标,以此来确定车辆的行驶稳定性。因此,将根据俯仰角、侧倾角、俯仰角速度和侧倾角速度确定摆动信息。By calculating the derivative of the pitch angle and roll angle, the pitch angular velocity (pitch_dot) corresponding to the pitch angle and the roll angular velocity (roll_dot) corresponding to the roll angle will be obtained. Frequency index, in order to determine the driving stability of the vehicle. Therefore, the roll information will be determined from pitch angle, roll angle, pitch rate and roll rate.

步骤S200:获取车辆的车轮振动信息。Step S200: Obtain wheel vibration information of the vehicle.

可以理解的是,车辆的悬架具有缓冲、减振和传递力矩的作用,可以减轻大部分的车身摆动,使得通过INS获取的摆动信息,即摆动角度和角速度来估计的路面状况和实际的路面状况有所差别。因此,本申请中还将获取车辆的车轮振动信息,根据车轮振动信息来评测路面响应激励对车辆底盘的摆动情况,其中,车轮振动信息包括车辆多个车轮的振幅大小平均值和振幅频率平均值。It can be understood that the suspension of the vehicle has the functions of buffering, damping and torque transmission, which can alleviate most of the body swing, so that the estimated road conditions and the actual road conditions can be obtained through the swing information obtained by the INS, that is, the swing angle and angular velocity. The situation is different. Therefore, this application will also obtain the wheel vibration information of the vehicle, and evaluate the vibration of the vehicle chassis by the road surface response excitation according to the wheel vibration information, wherein the wheel vibration information includes the average value of the amplitude and frequency of multiple wheels of the vehicle .

在一种实施方式中,如图2所示,步骤S200包括子步骤S210~S220。In one implementation manner, as shown in FIG. 2 , step S200 includes substeps S210-S220.

子步骤S210:通过多个陀螺仪传感器分别检测对应车轮的振幅大小和振幅频率。Sub-step S210: respectively detecting the amplitude and amplitude frequency of the corresponding wheel through a plurality of gyro sensors.

在本申请中,将在车辆上设置多个陀螺仪传感器,每个车轮上设置有至少一个陀螺仪传感器,例如,可以在车辆的四个车轮上均设置有相应的一个陀螺仪传感器。通过车辆上设置多个陀螺仪传感器检测对应车轮的振幅大小和振幅频率。In this application, a plurality of gyro sensors will be provided on the vehicle, and at least one gyro sensor will be provided on each wheel, for example, a corresponding gyro sensor may be provided on each of the four wheels of the vehicle. The amplitude and amplitude frequency of the corresponding wheels are detected by setting multiple gyro sensors on the vehicle.

子步骤S220:根据每个车轮的振幅大小和振幅频率确定全部车轮的振幅大小平均值和振幅频率平均值,车轮振动信息包括振幅大小平均值和振幅频率平均值。Sub-step S220: Determine the average amplitude and average frequency of all wheels according to the amplitude and frequency of each wheel, and the wheel vibration information includes the average amplitude and average frequency.

在检测到每个车轮的振幅大小和振幅频率后,将计算检测到全部车轮对应的多个振幅大小和多个振幅频率的平均值,即计算振幅大小平均值和振幅频率平均值,将计算到的振幅大小平均值和振幅频率平均值作为评价路面状况的依据,以此来评测路面响应激励对车辆底盘冲击的影响。After detecting the amplitude and frequency of each wheel, the average value of multiple amplitudes and multiple amplitude frequencies corresponding to all the wheels will be calculated, that is, the average value of the amplitude and the average value of the amplitude frequency will be calculated. The average value of the amplitude and the average value of the amplitude frequency are used as the basis for evaluating the condition of the road surface, so as to evaluate the impact of the road surface response excitation on the impact of the vehicle chassis.

步骤300:获取车辆的车轮转动圈数和行驶距离,基于车轮转动圈数和行驶距离确定车辆的滑移率。Step 300: Obtain the number of wheel rotations and driving distance of the vehicle, and determine the slip rate of the vehicle based on the number of wheel rotations and driving distance.

可以理解的是,除了用路面不平度判断路面状况外,还将通过车辆的滑移率评价路面状况。本申请中将通过传感器获取车轮转动圈数和车辆的行驶距离,示范性地,可以通过车辆的CAN线读取车辆从起始点行驶当前位置时车轮的转动圈数,或是也可以通过车辆自身的传感器获取。例如,车辆上装有ABS(antilock brake system,防抱死系统)时,将通过车轮转速传感器实时读取四个车轮的转速和转动圈数,一般前轮传感器装在转向节上,后轮装在固定支架上,车辆行驶距离可通过车辆纵向速度积分获取。本申请中通过车辆的车轮转动圈数和车辆实际行驶距离计算得到车辆的滑移率。It can be understood that, in addition to judging the road surface condition by the road surface roughness, the road surface condition will also be evaluated by the slip rate of the vehicle. In this application, the number of rotations of the wheels and the driving distance of the vehicle will be obtained through the sensor. Exemplarily, the number of rotations of the wheels when the vehicle is driving from the starting point to the current position can be read through the CAN line of the vehicle, or the number of rotations of the wheels can be obtained through the vehicle itself acquired by the sensor. For example, when the vehicle is equipped with ABS (antilock brake system, anti-lock braking system), the speed and number of rotations of the four wheels will be read in real time through the wheel speed sensor. Generally, the front wheel sensor is installed on the steering knuckle, and the rear wheel is installed on the steering knuckle. On the fixed support, the vehicle travel distance can be obtained by integrating the longitudinal velocity of the vehicle. In this application, the slip rate of the vehicle is calculated by the number of turns of the wheels of the vehicle and the actual driving distance of the vehicle.

在路面状况良好时,车辆的车轮转动圈数乘以车轮的周长应该约等于车辆行驶的距离,公式为:S≈n*l,其中,式中S为车辆的实际行驶距离,n为车轮转动圈数,l为车轮的外半径,即车轮的周长。通过相应的滑移率计算公式计算车辆的滑移率,滑移率计算公式为:F=s/(n*l),F为车辆的实际行驶距离和车辆期望行驶距离的比值,即车辆的滑移率。When the road surface is in good condition, the number of turns of the wheel of the vehicle multiplied by the circumference of the wheel should be approximately equal to the distance traveled by the vehicle. The formula is: S≈n*l, where S is the actual distance traveled by the vehicle and n is the wheel The number of turns, l is the outer radius of the wheel, i.e. the circumference of the wheel. Calculate the slip rate of the vehicle through the corresponding slip rate calculation formula, the slip rate calculation formula is: F=s/(n*l), F is the ratio of the actual driving distance of the vehicle to the expected driving distance of the vehicle, that is, the vehicle’s slip rate.

步骤400:基于摆动信息、振动信息和滑移率,计算车辆的纵向速度,控制车辆按照纵向速度行驶。Step 400: Calculate the longitudinal speed of the vehicle based on the swing information, vibration information and slip ratio, and control the vehicle to run according to the longitudinal speed.

可以理解的是,在获取到车辆的摆动信息、振动信息和滑移率后,根据摆动信息、振动信息和滑移率通过纵向表达式计算得到车辆的纵向速度,将控制自动驾驶车辆按照得到的纵向速度进行行驶。在自动驾驶车辆中将设置有纵向运动控制器,本申请中,车辆的纵向运动控制器中的纵向运动表达式为:It can be understood that after obtaining the swing information, vibration information and slip rate of the vehicle, the longitudinal velocity of the vehicle is calculated through the longitudinal expression according to the swing information, vibration information and slip rate, and the self-driving vehicle will be controlled according to the obtained Travel at longitudinal speed. A longitudinal motion controller will be provided in the self-driving vehicle. In this application, the longitudinal motion expression in the longitudinal motion controller of the vehicle is:

OP=P+R*(Va+Vc+Vs)*v;OP=P+R*(Va+Vc+Vs)*v;

其中,OP为该纵向运动控制器输出的纵向速度,R为Va、Vc和Vs的总增益系数,P为预设纵向运动控制器的输出速度,预设纵向运动控制器包括但不限于PID(ProportionalIntegral Derivative)控制器和mpc(modle predictive contro)控制器等,v为车辆的实时速度,Va为车辆的车身摆动系数,Vc为车辆的车轮振动系数,Vs为车辆的滑移系数,滑移系数通过所述滑移率计算得到。其中,总增益系数R使纵向运动表达式的取值范围为(-1,0)。Wherein, OP is the longitudinal speed output by the longitudinal motion controller, R is the total gain coefficient of Va, Vc and Vs, P is the output speed of the preset longitudinal motion controller, and the preset longitudinal motion controller includes but not limited to PID ( Proportional Integral Derivative) controller and mpc (model predictive control) controller, etc., v is the real-time speed of the vehicle, Va is the body swing coefficient of the vehicle, Vc is the wheel vibration coefficient of the vehicle, Vs is the slip coefficient of the vehicle, slip coefficient Calculated from the slip ratio. Wherein, the total gain coefficient R makes the value range of the longitudinal motion expression be (-1,0).

在本申请中,根据摆动信息通过第一预设公式进行计算得到车辆的车身摆动系数,第一预设公式为:In this application, according to the swing information, the body swing coefficient of the vehicle is calculated through the first preset formula, and the first preset formula is:

Va=k*(k1*pitch+k2*roll+k3*pitch_dot+k4*roll_dot);V a =k*(k1*pitch+k2*roll+k3*pitch_dot+k4*roll_dot);

其中,k1、k2、k3和k4分别为俯仰角、侧倾角、俯仰角速度和侧倾角速度的增益系数,k为车身纵向运动控制增益系数,pitch为俯仰角,roll为侧倾角,pitch_dot为俯仰角速度,roll_dot为侧倾角速度。Among them, k1, k2, k3 and k4 are pitch angle, roll angle, pitch angular velocity and roll angular velocity gain coefficients respectively, k is the body longitudinal motion control gain coefficient, pitch is pitch angle, roll is roll angle, and pitch_dot is pitch angular velocity , roll_dot is the roll angular velocity.

可以理解的是,在第一预设公式主要考虑了车辆的摆动信息,即车身摆动冲击和摆动频率,即摆动角度和角速度对乘客的影响。一般,当车身摆动角度和摆动频率较大时,则需要降低车辆行驶速度,从而达到减少车身摆动冲击和摆动频率对乘客的影响,因此,k系数固定为负数,k1、k2、k3和k4通常为正值,总体的车身摆动系数Va的取值范围应为(-1,0)。It can be understood that the first preset formula mainly considers the swing information of the vehicle, that is, the swing impact of the vehicle body and the swing frequency, that is, the impact of the swing angle and angular velocity on passengers. Generally, when the swing angle and swing frequency of the vehicle body are large, the vehicle speed needs to be reduced to reduce the impact of the swing impact of the vehicle body and the impact of the swing frequency on passengers. Therefore, the k coefficient is fixed as a negative number, k1, k2, k3 and k4 are usually is a positive value, the value range of the overall body swing coefficient Va should be (-1, 0).

在本申请中,车轮振动系数根据车轮振动信息通过第二预设公式进行计算得到,第二预设公式为:In this application, the wheel vibration coefficient is calculated according to the wheel vibration information through the second preset formula, and the second preset formula is:

Vc=g*(g1*h+g2*w);Vc=g*(g1*h+g2*w);

其中,h为车辆车轮的振幅大小平均值,w为车辆车轮的振幅频率平均值,g为车轮纵向运动控制总增益,g1和g2分别为车轮摆动大小和车轮摆动频率的增益系数。第二预设公式考虑了路面响应激励对车辆底盘的影响,通常情况下,当车轮上下摆动幅度和摆动频率较大时,将通过降低车辆速度,来减少对车辆底盘的冲击和冲击频率,故g固定为负值,g1和g2一般为正值,车轮振动系数Vc取值范围为(-1,0)。Among them, h is the average value of the amplitude of the vehicle wheel, w is the average value of the amplitude frequency of the vehicle wheel, g is the total gain of the wheel longitudinal motion control, g1 and g2 are the gain coefficients of the wheel swing size and wheel swing frequency, respectively. The second preset formula takes into account the impact of the road surface response excitation on the vehicle chassis. Usually, when the wheel swings up and down and the swing frequency is large, the impact on the vehicle chassis and the impact frequency will be reduced by reducing the vehicle speed. Therefore, g is fixed as a negative value, g1 and g2 are generally positive values, and the value range of the wheel vibration coefficient Vc is (-1, 0).

在本申请中,滑移系数通过第三预设公式进行计算,第三预设公式为:In this application, the slip coefficient is calculated by the third preset formula, and the third preset formula is:

Vs=j*(|1-F|);Vs=j*(|1-F|);

其中,j为车辆滑移率的增益系数,当车辆发生滑移时,通过降低车辆速度来达到避免或者减少发生交通安全事故的损失,因此j为负值,滑移系数Vs的取值范围为(-1,0)。Among them, j is the gain coefficient of the vehicle slip ratio. When the vehicle slips, the vehicle speed can be reduced to avoid or reduce the loss of traffic safety accidents. Therefore, j is a negative value, and the value range of the slip coefficient Vs is (-1, 0).

由此可知,OP=P+R*(k*(k1*pitch+k2*roll+k3*pitch_dot+k4*roll_dot)+g*(g1*h+g2*w)+j*(|1-F|))*v;换言之,通过车辆的俯仰角、侧倾角、俯仰角速度、侧倾角速度、滑移率、振幅大小平均值和振幅频率平均值将计算得到车辆的纵向速度行驶。It can be seen that OP=P+R*(k*(k1*pitch+k2*roll+k3*pitch_dot+k4*roll_dot)+g*(g1*h+g2*w)+j*(|1-F |))*v; in other words, the longitudinal speed of the vehicle will be calculated by the vehicle's pitch angle, roll angle, pitch rate, roll rate, slip rate, average value of amplitude and average value of amplitude frequency.

可以理解的是,上述参数k、k1、k2、k3、k4、j、g、g1和g2等增益系数可以先按照公式搭建仿真模型,并给上述增益系数赋一个初值,通过仿真得出每个参数的范围,而后在车辆上进行实际调试。It can be understood that the gain coefficients of the above parameters k, k1, k2, k3, k4, j, g, g1 and g2 can first build a simulation model according to the formula, and assign an initial value to the above gain coefficients, and obtain each gain coefficient through simulation. range of parameters, and then carry out actual debugging on the vehicle.

在本申请中,以实时的路面状况为响应,不论在泥地、水泥地还是沥青等路面,都可以自适应全部的路面状况来控制车辆运动,不仅考虑了车身摆动角度和摆动频率对乘客的影响,车轮的摆动冲击和摆动频率对车辆底盘的影响,还考虑了车辆滑移对车辆行驶安全的影响,使得车辆的运动控制更加符合实际路面状况,通过控制车速,一方面减少了车辆损耗和车辆可能发生损坏的概率,另一方面避免或者减少发生交通安全事故的损失,提高了乘客的乘坐舒适性和安全性。并且本申请利用车辆上原有的传感器,不需要对传感器进行加装,避免了车辆硬件成本的增加。In this application, in response to real-time road conditions, no matter on muddy, cement or asphalt roads, it can adapt to all road conditions to control vehicle movement, not only considering the impact of vehicle body swing angle and swing frequency on passengers Influence, the impact of the swing impact of the wheel and the swing frequency on the vehicle chassis, also consider the impact of vehicle slippage on vehicle driving safety, so that the motion control of the vehicle is more in line with the actual road conditions. By controlling the speed of the vehicle, on the one hand, it reduces vehicle loss and The probability of possible damage to the vehicle, on the other hand, avoids or reduces the loss of traffic safety accidents, and improves the comfort and safety of passengers. Moreover, the present application utilizes the original sensors on the vehicle, and does not need to install additional sensors, thereby avoiding an increase in vehicle hardware costs.

基于上述实施例的车辆纵向速度控制方法,图3示出了本申请实施例提供的一种车辆纵向速度控制装置10的结构示意图。该车辆纵向速度控制装置10包括:Based on the vehicle longitudinal speed control method of the above embodiments, FIG. 3 shows a schematic structural diagram of a vehicle longitudinal speed control device 10 provided by an embodiment of the present application. The vehicle longitudinal speed control device 10 includes:

第一获取模块11,用于获取车辆的实时姿态信息,基于实时姿态信息确定车辆的摆动信息;The first acquiring module 11 is used to acquire the real-time attitude information of the vehicle, and determine the swing information of the vehicle based on the real-time attitude information;

第二获取模块12,用于获取车辆的车轮振动信息;The second acquiring module 12 is used to acquire wheel vibration information of the vehicle;

第三获取模块13,用于获取车辆的车轮转动圈数和行驶距离,基于车轮转动圈数和行驶距离确定车辆的滑移率;The third acquisition module 13 is used to obtain the number of wheel rotations and the travel distance of the vehicle, and determine the slip rate of the vehicle based on the number of rotations of the wheels and the travel distance;

确定模块14,用于基于摆动信息、振动信息和滑移率,计算车辆的纵向速度,控制车辆按照纵向速度行驶。The determining module 14 is configured to calculate the longitudinal speed of the vehicle based on the swing information, the vibration information and the slip rate, and control the vehicle to run according to the longitudinal speed.

本实施例的车辆纵向速度控制装置10用于执行上述实施例的车辆纵向速度控制方法,上述实施例所涉及的实施方案以及有益效果在本实施例中同样适用,在此不再赘述。The vehicle longitudinal speed control device 10 of this embodiment is used to implement the vehicle longitudinal speed control method of the above-mentioned embodiments, and the implementation solutions and beneficial effects involved in the above-mentioned embodiments are also applicable to this embodiment, and will not be repeated here.

本申请实施例还提供一种车辆,包括存储器和处理器,存储器存储有计算机程序,计算机程序在处理器上运行时执行上述的车辆纵向速度控制方法。The embodiment of the present application also provides a vehicle, including a memory and a processor, the memory stores a computer program, and the computer program executes the above method for controlling the longitudinal speed of the vehicle when running on the processor.

本申请实施例还提供一种计算机可读存储介质,其存储有计算机程序,计算机程序在处理器上执行时,实施上述的车辆纵向速度控制方法。The embodiment of the present application also provides a computer-readable storage medium, which stores a computer program, and when the computer program is executed on a processor, implements the above-mentioned vehicle longitudinal speed control method.

在本申请所提供的几个实施例中,应该理解到,所揭露的装置和方法,也可以通过其它的方式实现。以上所描述的装置实施例仅仅是示意性的,例如,附图中的流程图和结构图显示了根据本发明的多个实施例的装置、方法和计算机程序产品的可能实现的体系架构、功能和操作。在这点上,流程图或框图中的每个方框可以代表一个模块、程序段或代码的一部分,所述模块、程序段或代码的一部分包含一个或多个用于实现规定的逻辑功能的可执行指令。也应当注意,在作为替换的实现方式中,方框中所标注的功能也可以以不同于附图中所标注的顺序发生。例如,两个连续的方框实际上可以基本并行地执行,它们有时也可以按相反的顺序执行,这依所涉及的功能而定。也要注意的是,结构图和/或流程图中的每个方框、以及结构图和/或流程图中的方框的组合,可以用执行规定的功能或动作的专用的基于硬件的系统来实现,或者可以用专用硬件与计算机指令的组合来实现。In the several embodiments provided in this application, it should be understood that the disclosed devices and methods may also be implemented in other ways. The device embodiments described above are only illustrative. For example, the flowcharts and structural diagrams in the accompanying drawings show the possible implementation architecture and functions of devices, methods and computer program products according to multiple embodiments of the present invention. and operation. In this regard, each block in a flowchart or block diagram may represent a module, program segment, or part of code that includes one or more Executable instructions. It should also be noted that, in alternative implementations, the functions noted in the block may occur out of the order noted in the figures. For example, two blocks in succession may, in fact, be executed substantially concurrently, or they may sometimes be executed in the reverse order, depending upon the functionality involved. It is also to be noted that each block of the block diagrams and/or flow diagrams, and combinations of blocks in the block diagrams and/or flow diagrams, can be implemented by a dedicated hardware-based system that performs the specified function or action may be implemented, or may be implemented by a combination of special purpose hardware and computer instructions.

另外,在本发明各个实施例中的各功能模块或单元可以集成在一起形成一个独立的部分,也可以是各个模块单独存在,也可以两个或更多个模块集成形成一个独立的部分。In addition, each functional module or unit in each embodiment of the present invention can be integrated together to form an independent part, or each module can exist independently, or two or more modules can be integrated to form an independent part.

所述功能如果以软件功能模块的形式实现并作为独立的产品销售或使用时,可以存储在一个计算机可读取存储介质中。基于这样的理解,本发明的技术方案本质上或者说对现有技术做出贡献的部分或者该技术方案的部分可以以软件产品的形式体现出来,该计算机软件产品存储在一个存储介质中,包括若干指令用以使得一台计算机设备(可以是智能手机、个人计算机、服务器、或者网络设备等)执行本发明各个实施例所述方法的全部或部分步骤。而前述的存储介质包括:U盘、移动硬盘、只读存储器(ROM,Read-Only Memory)、随机存取存储器(RAM,Random Access Memory)、磁碟或者光盘等各种可以存储程序代码的介质。If the functions are implemented in the form of software function modules and sold or used as independent products, they can be stored in a computer-readable storage medium. Based on this understanding, the essence of the technical solution of the present invention or the part that contributes to the prior art or the part of the technical solution can be embodied in the form of a software product, and the computer software product is stored in a storage medium, including Several instructions are used to make a computer device (which may be a smart phone, a personal computer, a server, or a network device, etc.) execute all or part of the steps of the method described in each embodiment of the present invention. The aforementioned storage medium includes: U disk, mobile hard disk, read-only memory (ROM, Read-Only Memory), random access memory (RAM, Random Access Memory), magnetic disk or optical disk and other media that can store program codes. .

以上所述,仅为本发明的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明揭露的技术范围内,可轻易想到变化或替换,都应涵盖在本发明的保护范围之内。The above is only a specific embodiment of the present invention, but the scope of protection of the present invention is not limited thereto. Anyone skilled in the art can easily think of changes or substitutions within the technical scope disclosed in the present invention. Should be covered within the protection scope of the present invention.

Claims (10)

1.一种车辆纵向速度控制方法,其特征在于,所述方法包括:1. A vehicle longitudinal speed control method, characterized in that the method comprises: 获取车辆的实时姿态信息,基于所述实时姿态信息确定所述车辆的摆动信息;acquiring real-time attitude information of the vehicle, and determining swing information of the vehicle based on the real-time attitude information; 获取所述车辆的车轮振动信息;acquiring wheel vibration information of the vehicle; 获取所述车辆的车轮转动圈数和行驶距离,基于所述车轮转动圈数和所述行驶距离确定所述车辆的滑移率;Obtaining the number of wheel turns and the travel distance of the vehicle, and determining the slip ratio of the vehicle based on the number of wheel turns and the travel distance; 基于所述摆动信息、所述振动信息和所述滑移率,计算所述车辆的纵向速度,控制所述车辆按照所述纵向速度行驶。Calculate the longitudinal speed of the vehicle based on the swing information, the vibration information and the slip ratio, and control the vehicle to run according to the longitudinal speed. 2.根据权利要求1所述的车辆纵向速度控制方法,其特征在于,所述实时姿态信息包括俯仰角和侧倾角,所述基于所述实时姿态信息确定所述车辆的摆动信息,包括:2. The vehicle longitudinal speed control method according to claim 1, wherein the real-time attitude information includes a pitch angle and a roll angle, and determining the swing information of the vehicle based on the real-time attitude information comprises: 对所述俯仰角和所述侧倾角进行求导得到相应的俯仰角速度和侧倾角速度;Deriving the pitch angle and the roll angle to obtain a corresponding pitch rate and roll rate; 基于所述俯仰角、所述侧倾角、所述俯仰角速度和所述侧倾角速度确定所述摆动信息。The swing information is determined based on the pitch angle, the roll angle, the pitch rate, and the roll rate. 3.根据权利要求1所述的车辆纵向速度控制方法,其特征在于,所述车辆上设置有多个陀螺仪传感器,所述获取所述车辆的车轮振动信息,包括:3. The vehicle longitudinal speed control method according to claim 1, wherein the vehicle is provided with a plurality of gyroscope sensors, and the acquisition of wheel vibration information of the vehicle comprises: 通过所述多个陀螺仪传感器分别检测对应车轮的振幅大小和振幅频率;Detecting the amplitude and amplitude frequency of the corresponding wheels respectively through the plurality of gyroscope sensors; 根据每个车轮的振幅大小和振幅频率确定全部车轮的振幅大小平均值和振幅频率平均值,所述车轮振动信息包括所述振幅大小平均值和所述振幅频率平均值。The average value of the amplitude and the average frequency of all wheels are determined according to the amplitude and frequency of each wheel, and the wheel vibration information includes the average value of the amplitude and the average value of the frequency. 4.根据权利要求1所述的车辆纵向速度控制方法,其特征在于,通过纵向运动表达式计算所述纵向速度,所述纵向运动表达式为:4. The vehicle longitudinal speed control method according to claim 1, wherein the longitudinal speed is calculated by a longitudinal motion expression, and the longitudinal motion expression is: OP=P+R*(Va+Vc+Vs)*v;OP=P+R*(Va+Vc+Vs)*v; 其中,OP为所述纵向速度,R为总增益系数,P为预设纵向运动控制器的输出速度,v为所述车辆的实时速度,Va为所述车辆的车身摆动系数,Vc为所述车辆的车轮振动系数,Vs为所述车辆的滑移系数,所述滑移系数通过所述滑移率计算得到。Wherein, OP is the longitudinal speed, R is the overall gain coefficient, P is the output speed of the preset longitudinal motion controller, v is the real-time speed of the vehicle, Va is the body swing coefficient of the vehicle, and Vc is the The wheel vibration coefficient of the vehicle, Vs is the slip coefficient of the vehicle, and the slip coefficient is obtained by calculating the slip ratio. 5.根据权利要求4所述的车辆纵向速度控制方法,其特征在于,所述车身摆动系数根据所述摆动信息通过第一预设公式计算得到,所述第一预设公式为:5. The vehicle longitudinal speed control method according to claim 4, characterized in that, the vehicle body sway coefficient is calculated according to the sway information through a first preset formula, and the first preset formula is: Va=k*(k1*pitch+k2*roll+k3*pitch_dot+k4*roll_dot);V a =k*(k1*pitch+k2*roll+k3*pitch_dot+k4*roll_dot); 其中,pitch为俯仰角,roll为侧倾角,pitch_dot为俯仰角速度,roll_dot为侧倾角速度,k1、k2、k3和k4分别为所述俯仰角、所述侧倾角、所述俯仰角速度和所述侧倾角速度的增益系数,k为车身纵向运动控制增益系数。Among them, pitch is the pitch angle, roll is the roll angle, pitch_dot is the pitch angular velocity, roll_dot is the roll angular velocity, k1, k2, k3 and k4 are the pitch angle, the roll angle, the pitch angular velocity and the side The gain coefficient of the inclination velocity, k is the gain coefficient of the body longitudinal motion control. 6.根据权利要求4所述的车辆纵向速度控制方法,其特征在于,所述车轮振动系数根据所述车轮振动信息通过第二预设公式计算得到,所述第二预设公式为:6. The vehicle longitudinal speed control method according to claim 4, wherein the wheel vibration coefficient is calculated according to the wheel vibration information through a second preset formula, and the second preset formula is: Vc=g*(g1*h+g2*w);Vc=g*(g1*h+g2*w); 其中,h为车辆车轮的振幅大小平均值,w为所述车辆车轮的振幅频率平均值,g为车轮纵向运动控制总增益,g1和g2分别为车轮摆动大小和车轮摆动频率的增益系数。Wherein, h is the average value of the amplitude of the vehicle wheel, w is the average value of the amplitude frequency of the vehicle wheel, g is the total gain of the wheel longitudinal motion control, and g1 and g2 are the gain coefficients of the wheel swing size and wheel swing frequency, respectively. 7.根据权利要求4所述的车辆纵向速度控制方法,其特征在于,所述车身摆动系数、所述车轮振动系数和所述滑移系数的取值范围均为(-1,0)。7. The vehicle longitudinal speed control method according to claim 4, characterized in that, the value ranges of the vehicle body swing coefficient, the wheel vibration coefficient and the slip coefficient are all (-1, 0). 8.一种车辆纵向速度控制装置,其特征在于,所述装置包括:8. A vehicle longitudinal speed control device, characterized in that the device comprises: 第一获取模块,用于获取车辆的实时姿态信息,基于所述实时姿态信息确定所述车辆的摆动信息;A first acquisition module, configured to acquire real-time attitude information of the vehicle, and determine swing information of the vehicle based on the real-time attitude information; 第二获取模块,用于获取所述车辆的车轮振动信息;A second acquisition module, configured to acquire wheel vibration information of the vehicle; 第三获取模块,用于获取所述车辆的车轮转动圈数和行驶距离,基于所述车轮转动圈数和所述行驶距离确定所述车辆的滑移率;A third acquisition module, configured to acquire the number of wheel turns and the travel distance of the vehicle, and determine the slip ratio of the vehicle based on the number of wheel turns and the travel distance; 确定模块,用于基于所述摆动信息、所述振动信息和所述滑移率,计算所述车辆的纵向速度,控制所述车辆按照所述纵向速度行驶。A determining module, configured to calculate the longitudinal speed of the vehicle based on the swing information, the vibration information and the slip ratio, and control the vehicle to travel according to the longitudinal speed. 9.一种车辆,其特征在于,包括存储器和处理器,所述存储器存储有计算机程序,所述计算机程序在所述处理器上运行时执行权利要求1至7任一项所述的车辆纵向速度控制方法。9. A vehicle, characterized in that it comprises a memory and a processor, the memory stores a computer program, and when the computer program runs on the processor, it executes the vehicle longitudinal control according to any one of claims 1 to 7. speed control method. 10.一种可读存储介质,其特征在于,其存储有计算机程序,所述计算机程序在处理器上运行时执行权利要求1至7任一项所述的车辆纵向速度控制方法。10. A readable storage medium, characterized in that it stores a computer program, and the computer program executes the vehicle longitudinal speed control method according to any one of claims 1 to 7 when running on a processor.
CN202211198114.2A 2022-09-29 2022-09-29 A vehicle longitudinal speed control method, device, vehicle and readable storage medium Pending CN115454089A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202211198114.2A CN115454089A (en) 2022-09-29 2022-09-29 A vehicle longitudinal speed control method, device, vehicle and readable storage medium

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202211198114.2A CN115454089A (en) 2022-09-29 2022-09-29 A vehicle longitudinal speed control method, device, vehicle and readable storage medium

Publications (1)

Publication Number Publication Date
CN115454089A true CN115454089A (en) 2022-12-09

Family

ID=84305968

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202211198114.2A Pending CN115454089A (en) 2022-09-29 2022-09-29 A vehicle longitudinal speed control method, device, vehicle and readable storage medium

Country Status (1)

Country Link
CN (1) CN115454089A (en)

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
FR2892823A1 (en) * 2005-10-28 2007-05-04 Peugeot Citroen Automobiles Sa METHOD FOR DETERMINING A LONGITUDINAL SPEED DRIFT OF A MOTOR VEHICLE
CN105501078A (en) * 2015-11-26 2016-04-20 湖南大学 Cooperative control method of four-wheel independent-drive electric car
JP2017022870A (en) * 2015-07-10 2017-01-26 Ntn株式会社 Slip control device
CN113353081A (en) * 2021-06-29 2021-09-07 东风汽车集团股份有限公司 Front and rear axle torque distribution system and method for four-wheel drive vehicle
CN114083951A (en) * 2020-04-27 2022-02-25 现代自动车株式会社 Apparatus and method for controlling damping force by road frequency classification

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
FR2892823A1 (en) * 2005-10-28 2007-05-04 Peugeot Citroen Automobiles Sa METHOD FOR DETERMINING A LONGITUDINAL SPEED DRIFT OF A MOTOR VEHICLE
JP2017022870A (en) * 2015-07-10 2017-01-26 Ntn株式会社 Slip control device
CN105501078A (en) * 2015-11-26 2016-04-20 湖南大学 Cooperative control method of four-wheel independent-drive electric car
CN114083951A (en) * 2020-04-27 2022-02-25 现代自动车株式会社 Apparatus and method for controlling damping force by road frequency classification
CN113353081A (en) * 2021-06-29 2021-09-07 东风汽车集团股份有限公司 Front and rear axle torque distribution system and method for four-wheel drive vehicle

Similar Documents

Publication Publication Date Title
CN110626353B (en) Vehicle dangerous state early warning method based on roll risk index
CN105829185B (en) Potential adhesive force is estimated by assessment rolling radius
CN103407451B (en) A kind of road longitudinal and additional forces method of estimation
US10632978B2 (en) Method and system for determining friction between the ground and a tire of a vehicle
US10093321B1 (en) System and method for calibrating parameters of tires
US20130151075A1 (en) System and method for vehicle rollover prediction
US20080228329A1 (en) Methods and systems for friction detection and slippage control
JP2016034826A (en) System and method for determining abrasion of tire
US20220189215A1 (en) Condition monitoring of a vehicle
CN103625475B (en) A kind of vehicle side inclination angle based on recurrence least square and pitch angle method of estimation
KR102542377B1 (en) Autonomous method and device for determining a global inclination of a motor vehicle
CN110843787A (en) Method and system for determining wading condition and vehicle with system
CN109677415B (en) Apparatus and method for estimating radius of curvature of vehicle
JP6012523B2 (en) Construction vehicle
US20220073041A1 (en) Method for the Traction Control of a Single-Track Motor Vehicle Taking the Slip Angle of the Rear Wheel Into Consideration
CN103217158A (en) Method for increasing vehicle-mounted SINS/OD combination navigation precision
CN112455456B (en) Intelligent commercial vehicle centroid position measurement method and driving safety control system
CN109307782B (en) Vehicle speed estimation device, vehicle speed estimation method, and computer-readable medium
CN115454089A (en) A vehicle longitudinal speed control method, device, vehicle and readable storage medium
JP2019066444A (en) Position calculation method, vehicle control method, and position calculation device
KR102425459B1 (en) Road slope calculation system and method for correcting stopping diatance
JP4028842B2 (en) Tire pressure drop detection method and apparatus, and tire decompression determination program
KR102046994B1 (en) Estimation method of longitudinal and lateral road angle, and center of gravity position of vehicle and apparatus using the same
US20230150462A1 (en) Vibration based mu detection
KR20180075082A (en) Method and device for sending rollover of vehicle

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
CB02 Change of applicant information
CB02 Change of applicant information

Country or region after: China

Address after: 401120 Building 2, No. 81, Tonggui Avenue, Yufengshan Town, Yubei District, Chongqing

Applicant after: Beidou Zhilian Technology Co.,Ltd.

Address before: No. 3 Tonggui Avenue, Yufengshan Town, Yubei District, Chongqing City

Applicant before: Beidou Xingtong Zhilian Technology Co.,Ltd.

Country or region before: China