WO2023103188A1 - 车辆控制方法、控制器、系统、装置及存储介质 - Google Patents
车辆控制方法、控制器、系统、装置及存储介质 Download PDFInfo
- Publication number
- WO2023103188A1 WO2023103188A1 PCT/CN2022/078942 CN2022078942W WO2023103188A1 WO 2023103188 A1 WO2023103188 A1 WO 2023103188A1 CN 2022078942 W CN2022078942 W CN 2022078942W WO 2023103188 A1 WO2023103188 A1 WO 2023103188A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- vehicle
- data
- rotation angle
- front wheel
- steering wheel
- Prior art date
Links
- 238000000034 method Methods 0.000 title claims abstract description 44
- 238000003860 storage Methods 0.000 title claims abstract description 14
- 238000005259 measurement Methods 0.000 claims abstract description 13
- 238000012545 processing Methods 0.000 claims description 19
- 238000012937 correction Methods 0.000 claims description 9
- 238000005070 sampling Methods 0.000 claims description 9
- 238000004590 computer program Methods 0.000 claims description 4
- 238000010295 mobile communication Methods 0.000 claims description 4
- 238000010586 diagram Methods 0.000 description 14
- 230000006870 function Effects 0.000 description 6
- 238000009434 installation Methods 0.000 description 5
- 241000209094 Oryza Species 0.000 description 4
- 235000007164 Oryza sativa Nutrition 0.000 description 4
- 230000003287 optical effect Effects 0.000 description 4
- 235000009566 rice Nutrition 0.000 description 4
- 230000009977 dual effect Effects 0.000 description 3
- 238000005516 engineering process Methods 0.000 description 3
- 230000001133 acceleration Effects 0.000 description 2
- 230000003416 augmentation Effects 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 238000012271 agricultural production Methods 0.000 description 1
- 239000004020 conductor Substances 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 238000009313 farming Methods 0.000 description 1
- 238000001914 filtration Methods 0.000 description 1
- 239000013307 optical fiber Substances 0.000 description 1
- 230000000644 propagated effect Effects 0.000 description 1
- 230000003252 repetitive effect Effects 0.000 description 1
- 239000004065 semiconductor Substances 0.000 description 1
- 238000009331 sowing Methods 0.000 description 1
- 238000005507 spraying Methods 0.000 description 1
- 239000002699 waste material Substances 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W60/00—Drive control systems specially adapted for autonomous road vehicles
- B60W60/001—Planning or execution of driving tasks
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W40/00—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
- B60W2050/0001—Details of the control system
- B60W2050/0002—Automatic control, details of type of controller or control system architecture
- B60W2050/0004—In digital systems, e.g. discrete-time systems involving sampling
Definitions
- the present application relates to the technical field of automatic driving, for example, to a vehicle control method, controller, system, device and storage medium.
- the present application provides a vehicle control method, a controller, a system, a device and a storage medium, so as to realize fast and stable control of the vehicle for driving while reducing cost consumption.
- the present application provides a vehicle control method, including:
- the motor position encoder data of the electric steering wheel and the vehicle size data obtain the front wheel angle information of the vehicle;
- Target control information Generate target control information based on the target rotation angle information, and send the target control information to the electric steering wheel, so that the electric steering wheel can rotate based on the target control information.
- the present application also provides an integrated controller, the controller comprising:
- the mobile communication signal receiver is configured to receive the differential information sent by the base station or the server, and send the differential information to the GNSS module;
- a GNSS module configured to obtain positioning data based on the differential information
- IMU module set to obtain IMU data
- the central processing unit is configured to obtain attitude angle data based on the positioning data and the IMU data; obtain vehicle front wheel angle information based on the IMU data, motor position encoder data and vehicle size data of the electric steering wheel; The positioning data, the attitude angle data, the vehicle size data, the vehicle front wheel angle information and the planned path data, obtain the target angle information of the vehicle front wheels; generate target control information based on the target angle information, and convert the Target control information is sent to the electric steering wheel, so that the electric steering wheel rotates based on the target control information.
- the present application also provides an automatic driving system for agricultural machinery, including the above-mentioned integrated controller, handle and electric steering wheel; wherein,
- the handle is set to at least one of the following: the automatic driving state is turned on and off based on the user operation, and the planned path data set by the user is sent to the central processing unit of the integrated controller;
- the electric steering wheel is configured to receive the target control information sent by the central processing unit, and rotate based on the received target control information to drive the front wheels of the vehicle to rotate.
- the present application also provides a vehicle control device, which includes:
- the data acquisition module is configured to obtain the positioning data output by the global navigation satellite system GNSS module and the IMU data output by the inertial measurement unit IMU module, and obtain attitude angle data based on the positioning data and the IMU data;
- the vehicle front wheel angle determination module is configured to obtain the vehicle front wheel angle information based on the IMU data, the motor position encoder data of the electric steering wheel and the vehicle size data;
- a target rotation angle determination module configured to obtain target rotation angle information of the front wheels of the vehicle based on the positioning data, the attitude angle data, the vehicle size data, the vehicle front wheel rotation angle information, and the planned path data;
- the steering wheel control module is configured to generate target control information based on the target rotation angle information, and send the target control information to the electric steering wheel, so that the electric steering wheel can rotate based on the target control information.
- the present application also provides a computer-readable storage medium, on which a computer program is stored, and the above-mentioned vehicle control method is realized when the program is executed by a processor.
- FIG. 1 is a flow chart of a vehicle control method provided in Embodiment 1 of the present application.
- FIG. 2 is a schematic diagram of an electric steering wheel calibration provided in Embodiment 1 of the present application.
- FIG. 3 is a schematic diagram of a handle button provided in Embodiment 1 of the present application.
- FIG. 4 is a flow chart of a vehicle control method provided in Embodiment 2 of the present application.
- FIG. 5 is a schematic diagram of obtaining vehicle front wheel angle information provided in Embodiment 2 of the present application.
- FIG. 6 is a flow chart of a vehicle control method provided in Embodiment 3 of the present application.
- FIG. 7 is a schematic diagram of obtaining vehicle front wheel angle information provided by Embodiment 3 of the present application.
- FIG. 8 is a schematic structural diagram of an integrated controller provided in Embodiment 4 of the present application.
- FIG. 9 is a schematic structural diagram of an agricultural machinery automatic driving system provided in Embodiment 5 of the present application.
- Fig. 10 is an operation flowchart of an agricultural machinery automatic driving system provided in Embodiment 5 of the present application.
- FIG. 11 is a schematic structural diagram of a vehicle control device provided in Embodiment 6 of the present application.
- Figure 1 is a flow chart of a vehicle control method provided in Embodiment 1 of the present application. This embodiment is applicable to the situation of controlling the automatic driving of the vehicle.
- the method can be executed by the vehicle control device in the embodiment of the present application.
- the device can Realized by means of software and/or hardware, as shown in Figure 1, the method includes:
- GNSS global navigation satellite system
- IMU inertial measurement unit
- GNSS generally refers to all satellite navigation systems, with omnipotent, global, all-weather, continuous and real-time navigation, positioning and timing functions.
- the GNSS module supports both GNSS positioning and GNSS orientation.
- GNSS orientation can determine the direction of the geometric vector formed by two points in space in a given coordinate system.
- the positioning data output by GNSS can be received by using the GNSS receiving antenna.
- the positioning data includes position positioning information and orientation information.
- the GNSS module also supports real-time differential positioning (Real-Time Kinematic, RTK), satellite-based augmentation system (Satellite-Based Augmentation System, SBAS), differential global positioning system (Differential Global Position System, DGPS) and precise point positioning technology (Precise Point Positioning, PPP) and other enhanced modes.
- the IMU can be set up to detect and measure acceleration and rotational motion.
- the IMU can collect and output IMU data, and the IMU data includes the rotational angular velocity of the vehicle body and the acceleration of the vehicle body.
- Attitude angle data is calculated based on GNSS positioning data and IMU data.
- the attitude angle data includes heading angle, pitch angle and roll angle, etc.
- the spatial rotation of the body coordinate system relative to the geographic coordinate system can be expressed in the order of heading angle, pitch angle and roll angle.
- the motor position encoder data of the electric steering wheel indicates the current rotational position of the electric steering wheel.
- the vehicle size data includes the distance between the front and rear axles of the vehicle body, the height of the rear wheel axle, the wheelbase of the front wheels, the distance between the antenna and the center axis, the position of the antenna relative to the center axis, the distance between the antenna and the rear axle, the position of the antenna relative to the rear axle, the height of the antenna and the working width wait.
- Vehicle dimensional data can be used to build vehicle kinematics models and data corrections.
- FIG. 2 is a schematic diagram of an electric steering wheel calibration provided in Embodiment 1 of the present application, as shown in FIG. 2 .
- the process of calibrating the electric steering wheel is described in steps 1-6. Among them, the calibration process requires an open and flat hard ground about 100 meters long and 10 meters wide.
- the two circles are the path of the vehicle, "540 degrees” means that turning the electric steering wheel makes the vehicle turn 540 degrees, and "10 meters” means that the vehicle moves forward 10 meters after turning 540 degrees.
- Step 1 Set the AB line.
- the distance between AB and AB should be greater than 70 meters.
- Step 2 After setting the AB line, turn around manually, park the vehicle at point B, and head towards point A.
- Step 3 Keep the speed of 2Km/h and drive forward at a constant speed, and automatically drive to point A.
- Step 4 Manually turn around, park the vehicle at point A, with the front of the car facing point B.
- Step 5 Keep driving at a constant speed of 2Km/h, and drive to point B automatically.
- FIG. 3 is a schematic diagram of a handle button provided in Embodiment 1 of the present application.
- the handle includes at least three buttons.
- the AUTO button controls the on and off of the automatic driving state.
- the button "A" and button “B” on the handle control the straight-line path planning operation of two points A and B.
- installation offset calibration can be performed on the terminal equipment, and installation offset calibration can eliminate related installation errors.
- the identification of the actuator system can be established, that is, the functional relationship between the rotation angle of the steering wheel and the rotation angle of the front wheels of the vehicle can be established.
- the motor position encoder data of the electric steering wheel and the vehicle size data the front wheel angle information of the vehicle is obtained.
- the front wheel rotation angle information of the vehicle is information such as the current rotation angle angle and the rotation angle direction of the front wheel of the vehicle.
- the planned route data can be obtained in the form of webpage access through WIFI, Bluetooth or mobile communication data link.
- the planned route data can be imported through the mobile phone, or the planned route data can be obtained by the user operating the handle buttons.
- the target rotation angle information of the front wheels of the vehicle includes angle information and direction information that the front wheels of the vehicle should turn at the next moment.
- S140 Generate target control information based on the target rotation angle information, and send the target control information to the electric steering wheel, so that the electric steering wheel rotates based on the target control information.
- the target rotation angle information is the angle information at which the steering wheel controls the front wheels of the vehicle to turn.
- the target control information can be generated according to the target rotation angle information.
- target control information is generated based on the target corner information, including steps A1-A2:
- Step A1 Obtain the function relationship between the preset steering wheel rotation angle and the front wheel rotation angle of the vehicle.
- the front wheels of the vehicle can be controlled to turn.
- Step A2 Determine the target steering wheel rotation angle corresponding to the target rotation angle information based on the functional relationship, and generate target control information based on the target steering wheel rotation angle.
- the target rotation angle information includes information on the angle at which the front wheels of the vehicle should turn and information on the direction in which the front wheels of the vehicle should turn.
- the target steering wheel turning angle is the angle at which the electric steering wheel should turn.
- the target control information includes the target steering wheel rotation angle. After the target steering wheel rotation angle is obtained, target control information is generated, and the electric steering wheel is controlled to rotate based on the target control information.
- the vehicle By making the electric steering wheel rotate based on the target control information through the above steps, the vehicle can be accurately and quickly controlled to drive according to the path planning information, and the automatic driving of the vehicle can be realized.
- the technical scheme of the present embodiment obtains the attitude angle data based on the positioning data and the IMU data by obtaining the positioning data output by the global navigation satellite system GNSS module and the IMU data output by the inertial measurement unit IMU module; based on the IMU data, the motor position of the electric steering wheel Encoder data and vehicle size data to obtain the vehicle front wheel angle information; based on positioning data, attitude angle data, vehicle size data, vehicle front wheel angle information and planning path data, to obtain the target angle information of the electric steering wheel; based on the target angle information to generate
- the target control information is to send the target control information to the electric steering wheel, so that the electric steering wheel can rotate based on the target control information.
- the technical solution of this embodiment can obtain GNSS positioning data accurate to the centimeter level, and can set vehicle parameters, calibration and design path planning data through the mobile terminal. After setting, it can be separated from the terminal to carry out automatic driving of the vehicle; Fixed-point navigation line control and turning on and off the automatic driving function; easy to install and maintain, greatly reducing the consumption cost; reducing the hardware damage rate of the automatic driving system, and can quickly and stably control the driving state of the vehicle.
- the embodiment of the present application can obtain accurate and reliable navigation pose information, and can quickly and stably control the driving state of the vehicle when the environmental road conditions are complex. There is no need to use traditional displays and angle sensors, and it is easy to install and maintain hardware facilities, greatly reducing cost consumption.
- FIG. 4 is a flow chart of a vehicle control method provided in Embodiment 2 of the present application. This embodiment refines the method for obtaining the vehicle front wheel angle information based on the foregoing embodiments. As shown in Figure 4, the method of this embodiment includes:
- the motor position encoder data of the electric steering wheel includes data such as the rotation position, rotation angle and rotation speed of the current electric steering wheel.
- the vehicle speed information includes the speed and direction information of the current vehicle travel.
- the motor position encoder data of the electric steering wheel can be obtained through the motor position encoder. After the vehicle is started, the vehicle speed information can be determined through the real-time output data of the GNSS module.
- IMU data can be obtained, and the IMU data includes the rotational angular velocity of the vehicle body.
- the forward and reverse states of the vehicle can be judged by using the average value information of historical IMU data. If the average value information is positive, the vehicle is in the forward state; if the average value information is negative, the vehicle is in the reverse state.
- vehicle size data may be acquired, and the vehicle size data includes distances between front and rear axles of the vehicle body.
- S220 Determine the front wheel observation angle based on the vehicle speed information, the angular velocity of the vehicle body, and the distance between the front and rear axles of the vehicle body.
- the observation angle of the front wheels can be determined through the following formula:
- L is the front and rear axle distance of the car body
- V gnss is the vehicle speed information
- W is the observation angle of the front wheel.
- the observation angle of the front wheels can be calculated through the vehicle speed information, the angular velocity of the vehicle body and the distance between the front and rear axles of the vehicle body.
- the vehicle front wheel rotation angle information is obtained based on the motor position encoder data and the front wheel observation angle.
- obtaining the vehicle front wheel angle information includes step B1-step B2:
- Step B1 Determine the vehicle front wheel angular velocity based on the motor position encoder data.
- the angular velocity of the front wheels of the vehicle is determined based on the motor position encoder data, including step B11-step B13:
- Step B11 Perform dead zone correction on the motor position encoder data based on the imported dead zone value.
- the motor position encoder data includes data such as the rotation position, rotation angle and rotation speed of the current electric steering wheel. During the process of the motor position encoder generating the above data, the motor position encoder will generate a control signal dead zone. Deadband correction can be performed on the motor position encoder data based on the deadband value.
- the dead zone value can be obtained by importing terminal devices, such as mobile phones, tablets and laptops. By adjusting the dead zone value, the dead zone correction can be performed on the motor position encoder data.
- Step B12 Determine the position increment of the electric steering wheel according to the corrected motor position encoder data, and determine the angular velocity of the electric steering wheel according to the position increment and the sampling period.
- the position increment of the electric steering wheel is the position movement amount of the electric steering wheel at the current moment relative to the previous moment.
- Step B13 Determine the angular velocity of the front wheels of the vehicle according to the angular velocity of the electric steering wheel and the preset functional relationship between the steering wheel rotation angle and the vehicle front wheel rotation angle.
- the method for determining the angular velocity of the front wheels of the vehicle through the above steps can be applied to determine the angular velocity of the front wheels of the wheel-steered tractor to meet the operation requirements of the wheel-steered tractor.
- the target vehicle front wheel rotation angle can be determined by using the preset functional relationship between the rotation angle of the electric steering wheel and the vehicle front wheel rotation angle. According to the angular velocity of the electric steering wheel and the functional relationship, the angular velocity of the front wheels of the vehicle can be determined.
- Step B2 Use the filter model to obtain the vehicle front wheel angle information according to the vehicle front wheel angular velocity and the front wheel observation angle.
- the filter model may be a Kalman filter. Kalman filtering can use the linear system state equation to optimally estimate the system state through the input and output observation data of the system.
- a Kalman filter model may be constructed according to an angle tracking algorithm. The vehicle front wheel angular velocity and front wheel observation angle are input into the Kalman filter model, and the Kalman filter operation is performed to output the vehicle front wheel angle information in real time.
- the accurate front wheel angle information of the vehicle can be output in real time.
- FIG. 5 is a schematic diagram of obtaining information on the front wheel rotation angle of a vehicle provided by an embodiment of the present application, as shown in FIG. 5 .
- the observation angle of the front wheels is obtained according to the distance between the front and rear axles of the car body, the vehicle speed information and the angular velocity of the car body; the dead zone correction is performed on the data of the motor position encoder; the information of the front wheel rotation angle of the vehicle is obtained through the filter model.
- the technical solution of this embodiment obtains the motor position encoder data of the electric steering wheel, the vehicle speed information, the vehicle body angular velocity determined according to the IMU data, and the distance between the front and rear axles of the vehicle body; The distance is used to determine the front wheel observation angle; based on the motor position encoder data and the front wheel observation angle, the front wheel rotation angle information of the vehicle is obtained.
- the forward and reverse judging algorithm can be used to distinguish the forward or reverse state of the vehicle, and the method suitable for determining the angular velocity of the front wheel of the wheel-steered tractor can meet the operation requirements of the wheel-steered tractor. This makes the technical solution of this embodiment easy to popularize and use.
- FIG. 6 is a flow chart of a vehicle control method provided in Embodiment 3 of the present application. This embodiment refines the method for obtaining the vehicle front wheel angle information based on the foregoing embodiments. As shown in Figure 6, the method of this embodiment includes the following steps:
- S320 Determine the front wheel observation angle based on the vehicle speed information, the angular velocity of the vehicle body, and the distance between the front and rear axles of the vehicle body.
- the vehicle front wheel angle information is obtained, including step C1-step C2:
- Step C1 Compensate the median value in the motor position encoder data according to the front wheel observation angle and the preset functional relationship between the steering wheel rotation angle and the vehicle front wheel rotation angle.
- the steering wheel rotation angle corresponding to the front wheel observation angle can be obtained. Then use the steering wheel rotation angle to perform median compensation on the motor position encoder data, and detect whether there is a deviation between the median value in the motor position encoder data and the steering wheel rotation angle. The median value is compensated.
- Step C2 Obtain the vehicle front wheel rotation angle information based on the compensated motor position encoder data and the preset functional relationship between the steering wheel rotation angle and the vehicle front wheel rotation angle.
- the vehicle front wheel rotation angle can be calculated.
- vehicle front wheel rotation angle information includes the vehicle front wheel rotation angle and the vehicle front wheel rotation direction.
- the method for determining the rotation angle information of the front wheels of the vehicle through the above steps can be applied to determine the rotation angle information of the front wheels of the rice transplanter to meet the operation requirements of the rice transplanter.
- FIG. 7 is a schematic diagram of obtaining vehicle front wheel rotation angle information provided by Embodiment 3 of the present application, as shown in FIG. 7 .
- the observation angle of the front wheel is obtained; the median compensation is performed on the data of the motor position encoder; and the information of the front wheel rotation angle of the vehicle is obtained.
- the technical solution of this embodiment obtains the motor position encoder data of the electric steering wheel, the vehicle speed information, the vehicle body angular velocity determined according to the IMU data, and the distance between the front and rear axles of the vehicle body; The distance is used to determine the front wheel observation angle; based on the motor position encoder data and the front wheel observation angle, the front wheel rotation angle information of the vehicle is obtained.
- the operation requirement of the rice transplanter is met by the method suitable for determining the information of the front wheel rotation angle of the rice transplanter. This makes the technical solution of this embodiment easy to popularize and use.
- FIG. 8 is a schematic structural diagram of an integrated controller provided in Embodiment 4 of the present application. As shown in Figure 8, the integrated controller includes:
- the mobile communication signal receiver is configured to receive differential information sent by the base station or server, and sends the differential information to the GNSS module; the GNSS module is configured to obtain positioning data based on the differential information; the IMU module is configured to obtain IMU data; The central processing unit is configured to obtain attitude angle data based on the positioning data and the IMU data; obtain vehicle front wheel angle information based on the IMU data, motor position encoder data and vehicle size data of the electric steering wheel; The positioning data, the attitude angle data, the vehicle size data, the vehicle front wheel angle information and the planned path data, obtain the target angle information of the vehicle front wheels; generate target control information based on the target angle information, and convert the Target control information is sent to the electric steering wheel, so that the electric steering wheel rotates based on the target control information.
- the central processing unit is configured to obtain the front wheel angle information of the vehicle based on the IMU data, the motor position encoder data of the electric steering wheel and the vehicle size data in the following manner:
- the central processing unit is configured to obtain vehicle front wheel rotation angle information based on the motor position encoder data and the front wheel observation angle in the following manner:
- the central processing unit is configured to determine the vehicle front wheel angular velocity based on the motor position encoder data in the following manner:
- the central processing unit is configured to obtain vehicle front wheel rotation angle information based on the motor position encoder data and the front wheel observation angle in the following manner:
- the median value in the motor position encoder data is compensated; based on the compensated motor position encoder data and The function relationship between the preset steering wheel rotation angle and the front wheel rotation angle of the vehicle is used to obtain the front wheel rotation angle information of the vehicle.
- the central processing unit is also configured to determine the viewing angle of the front wheels using the following formula:
- W is the observation angle of the front wheel
- L is the distance between the front and rear axles of the car body
- V gnss is the vehicle speed information
- the integrated controller can be connected with an independent GNSS antenna to realize dual-antenna directional attitude measurement.
- the dual antennas can be the dual antennas of the GNSS module, and the dual antennas are on one line, and the directional data measurement includes heading angle and pitch angle.
- FIG. 9 is a schematic structural diagram of an automatic driving system for agricultural machinery provided in Embodiment 5 of the present application, as shown in FIG. 9 .
- the system includes integrated controls, joysticks and an electric steering wheel.
- the handle is configured to turn on and off the automatic driving state based on user operations, and/or send the planned path data set by the user to the central processing unit of the integrated controller; the electric steering wheel is configured to receive The target control information sent by the central processing unit is rotated based on the received target control information to drive the front wheels of the vehicle to rotate.
- the handle and the electric steering wheel are connected through a Controller Area Network (CAN).
- CAN Controller Area Network
- the system also includes:
- the mobile terminal communicates with the integrated controller and is configured to perform at least one operation of path planning, vehicle calibration, parameter setting, parameter adjustment, and automatic driving on or off in the form of webpage access.
- Mobile terminals can be devices such as mobile phones, tablets, and notebook computers.
- the automatic driving system of agricultural machinery can set vehicle parameters, perform mechanical calibration, set navigation lines, and turn on and off automatic driving through the application software or webpage on the mobile phone.
- the mobile phone can be connected to the integrated controller through any method such as Bluetooth, WIFI and mobile network.
- the electric steering wheel includes a steering drive motor module, a fixed frame module, a clamp module, a sleeve module and a steering wheel ring module.
- the fixing frame module can be installed at a fixed position at the bottom of the steering drive motor, and fastened on the steering rod through a supporting fixture.
- FIG. 10 is an operation flowchart of an automatic driving system for agricultural machinery provided in Embodiment 5 of the present application, as shown in FIG. 10 .
- the vehicle front wheel angle information is obtained from the size information and the motor position encoder data; the target control information is generated based on the actuator system identification parameters, the corrected positioning data and attitude angle data, the vehicle size information, the vehicle front wheel angle information and the planned path data, Realize the automatic driving of the vehicle.
- the identification parameters determine the target steering wheel rotation angle, generate target control information based on the target steering wheel rotation angle, and send the target control information to the electric steering wheel, so that the electric steering wheel rotates based on the target control information.
- FIG 11 is a schematic structural diagram of a vehicle control device provided in Embodiment 6 of the present application. This embodiment can be applied to the situation of controlling the automatic driving of a vehicle.
- the device can be implemented in the form of software and/or hardware, and the device can be integrated in any
- the vehicle control device includes:
- the data acquisition module 610 is configured to obtain the positioning data output by the global navigation satellite system GNSS module and the IMU data output by the inertial measurement unit IMU module, and obtain attitude angle data based on the positioning data and the IMU data;
- the vehicle front wheel angle determination module 620 configured to obtain vehicle front wheel rotation angle information based on the IMU data, the motor position encoder data of the electric steering wheel, and vehicle size data;
- the target rotation angle determination module 630 configured to obtain the vehicle front wheel rotation angle information based on the positioning data, the attitude angle data, The vehicle size data, the vehicle front wheel rotation angle information and the planned route data are used to obtain target rotation angle information of the vehicle front wheels;
- the steering wheel control module 640 is configured to generate target control information based on the target rotation angle information, and control the target Information is sent to the electric steering wheel, so that the electric steering wheel is turned based on the target control information.
- the vehicle front wheel angle determination module 620 includes:
- the first determination unit set to obtain the motor position encoder data of the electric steering wheel, vehicle speed information, the vehicle body angular velocity determined according to the IMU data, and the distance between the front and rear axles of the vehicle body;
- the second determination unit set to be based on the vehicle speed Information, the angular velocity of the vehicle body and the distance between the front and rear axles of the vehicle body to determine the observation angle of the front wheels;
- the information acquisition unit for the rotation angle of the front wheels of the vehicle set to obtain the vehicle angle based on the motor position encoder data and the observation angle of the front wheels Front wheel angle information.
- the vehicle front wheel angle information acquisition unit includes:
- the vehicle front wheel angular velocity subunit configured to determine the vehicle front wheel angular velocity based on the motor position encoder data; the first rotation angle determination subunit is configured to adopt a filter model, according to the vehicle front wheel angular velocity and the front wheel observation Angle, to obtain the vehicle front wheel angle information.
- the vehicle front wheel angular velocity subunit is set to:
- the vehicle front wheel angle information acquisition unit includes:
- the median compensation subunit is configured to compensate the median value in the motor position encoder data according to the front wheel observation angle and the preset functional relationship between the steering wheel rotation angle and the vehicle front wheel rotation angle; the second The rotation angle determination subunit is configured to obtain the vehicle front wheel rotation angle information based on the compensated motor position encoder data and the preset functional relationship between the steering wheel rotation angle and the vehicle front wheel rotation angle.
- the second determination unit is set to: determine the front wheel observation angle by using the following formula:
- L is the front and rear axle distance of the car body
- V gnss is the vehicle speed information
- the steering wheel control module 640 is set to:
- the above-mentioned products can execute the vehicle control method provided by any embodiment of the present application, and have corresponding functional modules and effects for executing the method.
- Embodiment 7 of the present application provides a computer-readable storage medium, on which a computer program is stored.
- the vehicle control method provided in all the application embodiments of the present application is realized: obtaining the GNSS module of the global navigation satellite system
- the output positioning data and the IMU data output by the inertial measurement unit IMU module obtain attitude angle data based on the positioning data and the IMU data; based on the IMU data, the motor position encoder data and the vehicle size data of the electric steering wheel, obtain Front wheel angle information of the vehicle; based on the positioning data, the attitude angle data, the vehicle size data, the front wheel angle information of the vehicle and the planned path data, obtain the target angle information of the front wheels of the vehicle; based on the target angle
- the information generates target control information, and the target control information is sent to the electric steering wheel, so that the electric steering wheel turns based on the target control information.
- the computer readable medium may be a computer readable signal medium or a computer readable storage medium.
- a computer-readable storage medium may be, for example, but not limited to, an electrical, magnetic, optical, electromagnetic, infrared, or semiconductor system, device, or device, or any combination thereof.
- Examples (non-exhaustive list) of computer-readable storage media include: electrical connections with one or more conductors, portable computer disks, hard disks, random access memory (Random Access Memory, RAM), read-only memory (Read- Only Memory, ROM), erasable programmable read-only memory (Erasable Programmable Read-Only Memory, EPROM or flash memory), optical fiber, portable compact disk read-only memory (Compact Disc Read-Only Memory, CD-ROM), optical storage components, magnetic storage devices, or any suitable combination of the above.
- a computer-readable storage medium may be any tangible medium that contains or stores a program that can be used by or in conjunction with an instruction execution system, apparatus, or device.
- a computer readable signal medium may include a data signal carrying computer readable program code in baseband or as part of a carrier wave. Such propagated data signals may take many forms, including but not limited to electromagnetic signals, optical signals, or any suitable combination of the foregoing.
- a computer-readable signal medium may also be any computer-readable medium other than a computer-readable storage medium, which can send, propagate, or transmit a program for use by or in conjunction with an instruction execution system, apparatus, or device. .
- the program code contained on the computer readable medium can be transmitted by any appropriate medium, including but not limited to wireless, electric wire, optical cable, radio frequency (Radio Frequency, RF), etc., or any suitable combination of the above.
- any appropriate medium including but not limited to wireless, electric wire, optical cable, radio frequency (Radio Frequency, RF), etc., or any suitable combination of the above.
- Computer program codes for performing the operations of the present application may be written in one or more programming languages or combinations thereof, including object-oriented programming languages such as Java, Smalltalk, C++, and conventional A procedural programming language, such as the "C" language or similar programming language.
- the program code may execute entirely on the user's computer, partly on the user's computer, as a stand-alone software package, partly on the user's computer and partly on a remote computer or entirely on the remote computer or server.
- the remote computer can be connected to the user's computer through any kind of network, including a Local Area Network (LAN) or a Wide Area Network (WAN), or it can be connected to an external computer ( For example, use an Internet service provider to connect via the Internet).
- LAN Local Area Network
- WAN Wide Area Network
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Human Computer Interaction (AREA)
- Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
Abstract
Description
Claims (17)
- 一种车辆控制方法,包括:获取全球导航卫星系统GNSS模块输出的定位数据和惯性测量单元IMU模块输出的IMU数据,基于所述定位数据和所述IMU数据获得姿态角数据;基于所述IMU数据、电动方向盘的电机位置编码器数据以及车辆尺寸数据,获得车辆前轮转角信息;基于所述定位数据、所述姿态角数据、所述车辆尺寸数据、所述车辆前轮转角信息以及规划路径数据,获得所述车辆前轮的目标转角信息;基于所述目标转角信息生成目标控制信息,将所述目标控制信息发送给所述电动方向盘,以使所述电动方向盘基于所述目标控制信息进行转动。
- 根据权利要求1所述的方法,其中,所述基于所述IMU数据、电动方向盘的电机位置编码器数据以及车辆尺寸数据,获得车辆前轮转角信息,包括:获取所述电动方向盘的电机位置编码器数据、车辆速度信息、根据所述IMU数据确定的车体角速度和所述车辆尺寸数据中的车体前后轴距离;基于所述车辆速度信息、所述车体角速度和所述车体前后轴距离,确定前轮观测角度;基于所述电机位置编码器数据和所述前轮观测角度,获得车辆前轮转角信息。
- 根据权利要求2所述的方法,其中,所述基于所述电机位置编码器数据和所述前轮观测角度,获得车辆前轮转角信息,包括:基于所述电机位置编码器数据确定车辆前轮角速度;采用滤波器模型,根据所述车辆前轮角速度和所述前轮观测角度,获得所述车辆前轮转角信息。
- 根据权利要求3所述的方法,其中,所述基于所述电机位置编码器数据确定车辆前轮角速度,包括:基于导入的死区值对所述电机位置编码器数据进行死区修正;根据修正后的电机位置编码器数据确定所述电动方向盘的位置增量,根据所述位置增量和采样周期,确定所述电动方向盘的角速度;根据所述电动方向盘的角速度和预先设置的方向盘转动角度与车辆前轮转动角度的函数关系,确定所述车辆前轮角速度。
- 根据权利要求2所述的方法,其中,所述基于所述电机位置编码器数据和所述前轮观测角度,获得车辆前轮转角信息,包括:根据所述前轮观测角度和预先设置的方向盘转动角度与车辆前轮转动角度的函数关系,对所述电机位置编码器数据中的中位值进行补偿;基于补偿后的电机位置编码器数据以及所述预先设置的方向盘转动角度与车辆前轮转动角度的函数关系,获得所述车辆前轮转角信息。
- 根据权利要求1所述的方法,其中,所述基于所述目标转角信息生成目标控制信息,包括:获取预先设置的方向盘转动角度与车辆前轮转动角度的函数关系;基于所述函数关系确定所述目标转角信息对应的目标方向盘转动角度,基于所述目标方向盘转动角度生成所述目标控制信息。
- 一种一体化控制器,包括:移动通信信号接收器,设置为接收基站或者服务器发送的差分信息,将所述差分信息发送给全球导航卫星系统GNSS模块;所述GNSS模块,设置为基于所述差分信息获得定位数据;惯性测量单元IMU模块,设置为获得IMU数据;中央处理器,设置为基于所述定位数据和所述IMU数据获得姿态角数据;基于所述IMU数据、电动方向盘的电机位置编码器数据以及车辆尺寸数据,获得车辆前轮转角信息;基于所述定位数据、所述姿态角数据、所述车辆尺寸数据、所述车辆前轮转角信息以及规划路径数据,获得所述车辆前轮的目标转角信息;基于所述目标转角信息生成目标控制信息,将所述目标控制信息发送给所述电动方向盘,以使所述电动方向盘基于所述目标控制信息进行转动。
- 根据权利要求8所述的控制器,其中,所述中央处理器设置为通过如下方式基于所述IMU数据、电动方向盘的电机位置编码器数据以及车辆尺寸数据,获得车辆前轮转角信息:获取所述电动方向盘的电机位置编码器数据、车辆速度信息、根据所述IMU数据确定的车体角速度和所述车辆尺寸数据中的车体前后轴距离;基于所述车辆速度信息、所述车体角速度和所述车体前后轴距离,确定前轮观测角度;基于所述电机位置编码器数据和所述前轮观测角度,获得车辆前轮转角信息。
- 根据权利要求9所述的控制器,其中,所述中央处理器设置为通过如下方式基于所述电机位置编码器数据和所述前轮观测角度,获得车辆前轮转角信息:基于所述电机位置编码器数据确定车辆前轮角速度;采用滤波器模型,根据所述车辆前轮角速度和所述前轮观测角度,获得所述车辆前轮转角信息。
- 根据权利要求10所述的控制器,其中,所述中央处理器设置为通过如下方式基于所述电机位置编码器数据确定车辆前轮角速度:基于导入的死区值对所述电机位置编码器数据进行死区修正;根据修正后的电机位置编码器数据确定所述电动方向盘的位置增量,根据所述位置增量和采样周期,确定所述电动方向盘的角速度;根据所述电动方向盘的角速度和预先设置的方向盘转动角度与车辆前轮转动角度的函数关系,确定车辆前轮角速度。
- 根据权利要求9所述的控制器,其中,所述中央处理器设置为通过如下方式基于所述电机位置编码器数据和所述前轮观测角度,获得车辆前轮转角信息:根据所述前轮观测角度和预先设置的方向盘转动角度与车辆前轮转动角度的函数关系,对所述电机位置编码器数据中的中位值进行补偿;基于补偿后的电机位置编码器数据以及所述预先设置的方向盘转动角度与车辆前轮转动角度的函数关系,获得所述车辆前轮转角信息。
- 一种农机自动驾驶系统,包括如权利要求8-13中任一项所述的一体化 控制器、手柄和电动方向盘;其中,所述手柄设置为以下至少之一:基于用户操作进行自动驾驶状态的开启和关闭,将用户设置的规划路径数据发送给所述一体化控制器的中央处理器;所述电动方向盘设置为,接收所述中央处理器发送的目标控制信息,基于接收的所述目标控制信息进行转动,以带动车辆前轮转动。
- 根据权利要求14所述的系统,还包括:移动终端,与所述一体化控制器通信连接,设置为通过网页访问的形式进行路径规划、车辆校准、参数设置和参数调整中的至少一项操作。
- 一种车辆控制装置,包括:数据获取模块,设置为获取全球导航卫星系统GNSS模块输出的定位数据和惯性测量单元IMU模块输出的IMU数据,基于所述定位数据和所述IMU数据获得姿态角数据;车辆前轮转角确定模块,设置为基于所述IMU数据、电动方向盘的电机位置编码器数据以及车辆尺寸数据,获得车辆前轮转角信息;目标转角确定模块,设置为基于所述定位数据、所述姿态角数据、所述车辆尺寸数据、所述车辆前轮转角信息以及规划路径数据,获得所述车辆前轮的目标转角信息;方向盘控制模块,设置为基于所述目标转角信息生成目标控制信息,将所述目标控制信息发送给所述电动方向盘,以使所述电动方向盘基于所述目标控制信息进行转动。
- 一种计算机可读存储介质,存储有计算机程序,其中,所述程序被处理器执行时实现如权利要求1-7中任一项所述的车辆控制方法。
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111477499.1A CN114162139B (zh) | 2021-12-06 | 2021-12-06 | 一种车辆控制方法、控制器、系统、装置及存储介质 |
CN202111477499.1 | 2021-12-06 |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2023103188A1 true WO2023103188A1 (zh) | 2023-06-15 |
Family
ID=80483351
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/CN2022/078942 WO2023103188A1 (zh) | 2021-12-06 | 2022-03-03 | 车辆控制方法、控制器、系统、装置及存储介质 |
Country Status (2)
Country | Link |
---|---|
CN (1) | CN114162139B (zh) |
WO (1) | WO2023103188A1 (zh) |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20180113473A1 (en) * | 2003-03-20 | 2018-04-26 | Agjunction Llc | Gnss and optical guidance and machine control |
CN108657269A (zh) * | 2018-04-04 | 2018-10-16 | 南京天辰礼达电子科技有限公司 | 一种农业机械方向盘电机驱动自动驾驶设备及方法 |
CN110530361A (zh) * | 2019-08-26 | 2019-12-03 | 青岛农业大学 | 一种基于农业机械双天线gnss自动导航系统的转向角度估计器 |
CN111216708A (zh) * | 2020-01-13 | 2020-06-02 | 上海华测导航技术股份有限公司 | 车辆导航引导系统及车辆 |
CN112977603A (zh) * | 2021-02-20 | 2021-06-18 | 黑龙江惠达科技发展有限公司 | 一种电机控制的方法和装置 |
CN113126136A (zh) * | 2019-12-31 | 2021-07-16 | 上海司南卫星导航技术股份有限公司 | 基于电机方向盘的无前轮传感器自动驾驶系统 |
US20210291833A1 (en) * | 2020-06-29 | 2021-09-23 | Beijing Baidu Netcom Science And Technology Co., Ltd. | Method and apparatus for controlling cruise of vehicle, electronic device, and storage medium |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107063241B (zh) * | 2017-03-16 | 2023-08-25 | 上海联适导航技术股份有限公司 | 基于双gnss天线及单轴mems陀螺的前轮测角系统 |
CN108663036B (zh) * | 2018-04-04 | 2021-11-02 | 南京天辰礼达电子科技有限公司 | 一种车辆前轮转动跟踪的方法 |
CN112014122B (zh) * | 2020-07-21 | 2022-10-28 | 无锡卡尔曼导航技术有限公司 | 一种车轮转角测量装置及运行方法 |
-
2021
- 2021-12-06 CN CN202111477499.1A patent/CN114162139B/zh active Active
-
2022
- 2022-03-03 WO PCT/CN2022/078942 patent/WO2023103188A1/zh active Application Filing
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20180113473A1 (en) * | 2003-03-20 | 2018-04-26 | Agjunction Llc | Gnss and optical guidance and machine control |
CN108657269A (zh) * | 2018-04-04 | 2018-10-16 | 南京天辰礼达电子科技有限公司 | 一种农业机械方向盘电机驱动自动驾驶设备及方法 |
CN110530361A (zh) * | 2019-08-26 | 2019-12-03 | 青岛农业大学 | 一种基于农业机械双天线gnss自动导航系统的转向角度估计器 |
CN113126136A (zh) * | 2019-12-31 | 2021-07-16 | 上海司南卫星导航技术股份有限公司 | 基于电机方向盘的无前轮传感器自动驾驶系统 |
CN111216708A (zh) * | 2020-01-13 | 2020-06-02 | 上海华测导航技术股份有限公司 | 车辆导航引导系统及车辆 |
US20210291833A1 (en) * | 2020-06-29 | 2021-09-23 | Beijing Baidu Netcom Science And Technology Co., Ltd. | Method and apparatus for controlling cruise of vehicle, electronic device, and storage medium |
CN112977603A (zh) * | 2021-02-20 | 2021-06-18 | 黑龙江惠达科技发展有限公司 | 一种电机控制的方法和装置 |
Also Published As
Publication number | Publication date |
---|---|
CN114162139B (zh) | 2024-03-26 |
CN114162139A (zh) | 2022-03-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US20240241518A1 (en) | 3-d image system for vehicle control | |
WO2022007437A1 (zh) | 传感器安装偏差角的标定方法、组合定位系统和车辆 | |
CN107315345B (zh) | 基于双天线gnss和预瞄追踪模型的农机自动导航控制方法 | |
EP2285643B1 (en) | Methods and system for automatic user-configurable steering parameter control | |
US10782384B2 (en) | Localization methods and systems for autonomous systems | |
AU2020203993A1 (en) | Apparatus and methods for vehicle steering to follow a curved path | |
US20140266877A1 (en) | Precision accuracy global navigation satellite system (gnss) with smart devices | |
CN106229680B (zh) | 对运动中的卫星天线进行实时对星的装置的应用方法 | |
US20210165111A1 (en) | Method for determining the position of a vehicle | |
CN112382844B (zh) | 一种低轨卫星通信系统的天线伺服电机控制方法和系统 | |
CN111949030A (zh) | 一种农机定位方法、农机车辆和存储介质 | |
CN113295174A (zh) | 一种车道级定位的方法、相关装置、设备以及存储介质 | |
US10908300B2 (en) | Navigation method, navigation device and navigation system | |
CN108572380A (zh) | 一种基于卫星导航和视觉导航的导航方法及其应用 | |
CN110824524B (zh) | 一种基于机载Ka波段的卫星视频传输系统 | |
CN113419265B (zh) | 一种基于多传感器融合的定位方法、装置与电子设备 | |
WO2023103188A1 (zh) | 车辆控制方法、控制器、系统、装置及存储介质 | |
TWM617479U (zh) | 車輛自動定位管理系統 | |
CN115451919B (zh) | 一种智能型无人测绘装置及方法 | |
WO2022018964A1 (ja) | 情報処理装置、情報処理方法およびプログラム | |
CN111897370B (zh) | 基于航姿仪的动态天线跟星参数校正方法 | |
KR100491168B1 (ko) | 기하학적으로 구속된 다중 gps를 이용한 위치 및 자세측정 장치 | |
TWI720923B (zh) | 定位系統以及定位方法 | |
CN114758001B (zh) | 基于pnt的轮胎吊自动行走方法 | |
JP7105659B2 (ja) | 画像情報合成装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
121 | Ep: the epo has been informed by wipo that ep was designated in this application |
Ref document number: 22902632 Country of ref document: EP Kind code of ref document: A1 |
|
REG | Reference to national code |
Ref country code: BR Ref legal event code: B01A Ref document number: 112024011211 Country of ref document: BR |
|
WWE | Wipo information: entry into national phase |
Ref document number: 2022902632 Country of ref document: EP |
|
NENP | Non-entry into the national phase |
Ref country code: DE |
|
ENP | Entry into the national phase |
Ref document number: 2022902632 Country of ref document: EP Effective date: 20240708 |
|
ENP | Entry into the national phase |
Ref document number: 112024011211 Country of ref document: BR Kind code of ref document: A2 Effective date: 20240604 |