WO2024007569A1 - Dead reckoning method and apparatus, device, and medium - Google Patents

Dead reckoning method and apparatus, device, and medium Download PDF

Info

Publication number
WO2024007569A1
WO2024007569A1 PCT/CN2023/072286 CN2023072286W WO2024007569A1 WO 2024007569 A1 WO2024007569 A1 WO 2024007569A1 CN 2023072286 W CN2023072286 W CN 2023072286W WO 2024007569 A1 WO2024007569 A1 WO 2024007569A1
Authority
WO
WIPO (PCT)
Prior art keywords
rear wheel
wheel pulse
pulse number
right rear
left rear
Prior art date
Application number
PCT/CN2023/072286
Other languages
French (fr)
Chinese (zh)
Inventor
周同同
季丹
Original Assignee
南京市德赛西威汽车电子有限公司
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 南京市德赛西威汽车电子有限公司 filed Critical 南京市德赛西威汽车电子有限公司
Publication of WO2024007569A1 publication Critical patent/WO2024007569A1/en

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/04Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by terrestrial means
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/20Instruments for performing navigational calculations

Definitions

  • This application relates to the field of vehicle technology, for example, to a position prediction method, device, equipment and medium.
  • Dead-Reckoning starts from the known position of the object at the previous moment, and calculates the position of the object at the current moment based on the current movement course and speed, and so on.
  • ABS anti-lock braking system
  • using ABS wheel speed sensors as dead reckoning sensors can make full use of resources. Utilization can reduce the production cost of vehicle navigation systems.
  • the main processing method is the differential mileage algorithm, and the input can be the pulse data of the front and rear four wheels.
  • the input can be the pulse data of the front and rear four wheels.
  • This application provides a dead position prediction method, device, equipment and medium to improve the dead position prediction accuracy.
  • a flight position prediction method including:
  • the position information of the current vehicle at the current moment is predicted based on the corrected first left rear wheel pulse number and the first right rear wheel pulse number.
  • a flight position prediction device including:
  • the initial phase difference determination module is configured to determine the initial phase difference of the current vehicle
  • a correction module configured to correct the first left rear wheel pulse number or the first right rear wheel pulse number at the current moment based on the initial phase difference
  • a prediction module configured to be based on the corrected first left rear wheel pulse number and the first right rear wheel pulse Predict the position information of the current vehicle at the current moment.
  • an electronic device including:
  • the memory stores a computer program that can be executed by the at least one processor, and the computer program is executed by the at least one processor, so that the at least one processor can execute the method described in any embodiment of the present application. Deadline prediction method.
  • a computer-readable storage medium stores computer instructions, and the computer instructions are used to implement any of the embodiments of the present application when executed by a processor. flight position prediction method.
  • Figure 1 is a schematic diagram of the principle of differential mileage algorithm in related technologies
  • Figure 2 is a flow chart of a flight position prediction method provided by an embodiment of the present application.
  • Figure 3 is a schematic diagram of the implementation of the flight position prediction method provided according to an embodiment of the present application.
  • Figure 4 is a schematic structural diagram of a flight position prediction device provided by an embodiment of the present application.
  • FIG. 5 is a schematic structural diagram of an electronic device that implements the flight position prediction method according to the embodiment of the present application.
  • FIG. 1 a schematic diagram of the differential mileage algorithm principle shown in Figure 1 is given.
  • the pulse input data of the rear two wheels non-driving wheels
  • the number of pulses output by the left and right wheels of the car after time k-1 are LR k-1 and RR k-1 respectively.
  • the output pulses are LR k and RR k .
  • the movement distance of the left rear wheel is ⁇ LR
  • the movement distance of the right rear wheel is ⁇ RR .
  • the trajectory of the car during this period of time is represented by the trajectory of the midpoint of the rear axle of the car.
  • the motion trajectory during this short period of time can be regarded as a circle with O as the center.
  • the estimation formulas of the car’s driving distance ⁇ and the driving azimuth angle change ⁇ are respectively:
  • W R is the length of the rear axle.
  • FIG 2 is a flow chart of a dead position prediction method provided by an embodiment of the present application. This embodiment can be applied to the situation of dead position prediction.
  • the method can be executed by a dead position prediction device.
  • the dead position prediction device can use hardware.
  • the flight position prediction device can be configured in the server. As shown in Figure 2, the method includes:
  • the gear trigger sensor on the wheel can be used to count and output the corresponding number of pulses.
  • the number of pulses is the cumulative value of an integer. Since there is a certain distance between the two gears, when the car moves from rest to starting, the left rear and right rear wheels may be in the middle of the two gears. For example, when the first gear slides past the sensor, it counts as 1, but until the second gear slides past the sensor, the sensor's count value or number of pulses is 1. Therefore, the initial phase can be understood as the situation where the left rear and right rear wheels may be in the middle of the two gears when the car is moving from rest to starting.
  • the initial phase difference can be understood as the difference in pulse number between the left and right rear wheels when the vehicle is stationary, or as the average value of the difference in pulse numbers between the left and right rear wheels in multiple frames.
  • the wheel speed pulse values of the left and right rear wheels are L0, R0, 0 ⁇ L0 ⁇ 1, 0 ⁇ R0 ⁇ 1, within one pulse.
  • the driving paths of the left and right wheels are the same, both are recorded as LR i , because there is a truncation, where the truncation can be understood as a value between 0-1, and the output is a value of 0, so the wheel speed pulse output value is L i , R i ,i represent different moments.
  • the truncation errors each time are ⁇ L i and ⁇ R i , which are also 0 ⁇ L i ⁇ 1 and 0 ⁇ R i ⁇ 1 within one pulse.
  • L0-R0 (L i -R i )+( ⁇ L i - ⁇ R i )
  • L i and R i are respectively output through the left and right rear pulses of multiple frames, which can be calculated by the formula
  • the initial phase difference is obtained, which can be used to calculate DR.
  • the method of determining the initial phase difference of the current vehicle can be: controlling the current vehicle to drive straight from stationary to starting for a set duration; obtaining the left rear wheel pulses corresponding to multiple frames within the set duration. number and the number of right rear wheel pulses; calculate the difference in the number of left and right wheel pulses in each frame; average the difference in the number of left and right wheel pulses in multiple frames to obtain the initial phase difference of the current vehicle.
  • the set time which may be 3 to 4 seconds, for example.
  • this embodiment does not limit the specific value of multiple frames, for example, it can be 80 to 100 frames.
  • the current vehicle is controlled to drive as straight as possible from stationary to starting.
  • the number of left rear wheel pulses and the number of right rear wheel pulses of the current vehicle in the straight traveling state can be obtained based on the initial driving angle and the set threshold, and the Set the pulse number of the left rear wheel and right rear wheel in multiple frames within the duration, so that the difference in pulse number of the left rear wheel and right rear wheel in each frame can be calculated first, and then the pulse number of the left rear wheel and right rear wheel in multiple frames can be calculated. Calculate the average of the differences to obtain the initial phase difference.
  • the initial driving angle is denoted as ⁇
  • the set threshold is denoted as ⁇ threshold .
  • ⁇ threshold ⁇ t/W R .
  • i can represent a blocked moment or different frames
  • ⁇ t represents the time difference between two frames
  • ⁇ LR represents the difference between the two pulses before and after the left rear wheel
  • ⁇ RR represents the difference between the two pulses before and after the right rear wheel
  • can be expressed as Driving azimuth angle change
  • the quantitative quantity may be understood as angular velocity.
  • the initial phase difference can be expressed as ⁇ LR 0 , and the initial phase difference can be calculated by the following formula
  • the initial phase difference can be determined. If it is valid, the first left rear wheel pulse number or the first right rear wheel pulse number at the current moment can be corrected based on the initial phase difference, thereby reducing the angle error.
  • the method of correcting the first left rear wheel pulse number or the first right rear wheel pulse number at the current moment based on the initial phase difference may be: obtaining the second left rear wheel pulse number and the second right rear wheel pulse number at the previous moment. wheel pulse number; determine the difference between the first left rear wheel pulse number and the second left rear wheel pulse number, and determine it as the left rear wheel pulse difference; determine the first right rear wheel pulse number and the second right rear wheel pulse number. The difference is determined as the right rear wheel pulse difference; if the initial phase difference falls into the first set interval, the first left rear wheel pulse number is corrected according to the right rear wheel pulse difference; if the initial phase difference falls into the second set interval within a certain interval, based on the left rear wheel pulse difference Correct the first right rear wheel pulse number.
  • the first set interval can be expressed as (0,1)
  • the second set interval can be expressed as (-1,0).
  • the method of correcting the first left rear wheel pulse number based on the right rear wheel pulse difference may be: determining whether the current vehicle is going straight, and if so, then calculating the second left rear wheel pulse number and the right rear wheel pulse difference. The values are accumulated to obtain the corrected first left rear wheel pulse number.
  • the corrected first left rear wheel pulse number can be expressed as the difference between the second left rear wheel pulse number and the right rear wheel pulse.
  • the first left rear wheel pulse number can be obtained directly, or the first left rear wheel pulse number can be expressed as the second left rear wheel pulse number and the left rear wheel pulse difference. added value.
  • Li Li -1 + ⁇ LR , ⁇ LR : represents the difference between the two pulses before and after the left rear wheel, which can be understood as the difference between the first left rear wheel pulse number and the second left rear wheel pulse number.
  • the method of correcting the first right rear wheel pulse number based on the left rear wheel pulse difference may be: determining whether the current vehicle is going straight, and if it is going straight, then calculating the second right rear wheel pulse number and the left rear wheel pulse difference. The values are accumulated to obtain the corrected first right rear wheel pulse number.
  • the corrected first right rear wheel pulse number can be expressed as the difference between the second right rear wheel pulse number and the left rear wheel pulse.
  • R i represents the first right rear wheel pulse number
  • R i-1 represents the second right rear wheel pulse number.
  • the first right rear wheel pulse number can be obtained directly, or the first right rear wheel pulse number can be expressed as the second right rear wheel pulse number and the right rear wheel pulse difference. added value.
  • R i R i-1 + ⁇ RR , ⁇ RR : represents the difference between the two pulses of the right rear wheel, which can be understood as the difference between the first right rear wheel pulse number and the second right rear wheel pulse number.
  • the method of determining whether the current vehicle is going straight may be: determining the driving angle at the current moment based on the left rear wheel pulse difference and the right rear wheel pulse difference; and determining whether the current vehicle is going straight based on the driving angle.
  • the driving angle at the current moment may be determined using a method based on the initial driving angle and a set threshold to determine whether the vehicle is traveling straight. That is, if
  • the navigation information includes driving angle and position coordinates.
  • the position information of the current vehicle at the current moment can be predicted based on the corrected first left rear wheel pulse number and the first right rear wheel pulse number, so that the initial phase difference can be calculated in real time while the vehicle is driving. Updating the position information at the current moment can not only improve the accuracy of position prediction, but also has strong practicality.
  • the method of predicting the position information of the current vehicle at the current moment based on the corrected first left rear wheel pulse number and the first right rear wheel pulse number may be: based on the corrected first left rear wheel pulse number and The first right rear wheel pulse number determines the driving distance and azimuth angle change; determines the corrected driving angle at the current moment based on the azimuth angle change and the driving angle at the previous moment; based on the driving distance, azimuth angle change, and the previous moment's driving angle The driving angle and the position coordinates at the previous moment determine the position coordinates at the current moment.
  • the left rear wheel pulse difference and the right rear wheel pulse difference can be recalculated based on the corrected first left rear wheel pulse number and the first right rear wheel pulse number, so that the left rear wheel pulse difference and the right rear wheel pulse difference can be recalculated based on the corrected first left rear wheel pulse number and the first right rear wheel pulse number.
  • the product value i.e., the angle change value
  • the value obtained by adding the driving angle and the angle change value at the previous moment is used as the corrected driving angle at the current moment. .
  • the position coordinates at the current moment can be determined based on the driving distance, the azimuth angle change, the driving angle at the previous moment and the position coordinates at the previous moment. For example, as shown in Figure 3, ⁇ LR and ⁇ RR can be recalculated based on the corrected first left rear wheel pulse number Li and the first right rear wheel pulse number Ri , Then drive distance according to the formula and the formula azimuth angle Calculate the driving distance ⁇ and the azimuth angle change ⁇ .
  • the corrected driving angle at the current moment The position coordinates at the current moment can be expressed by x i and y i . Specifically,
  • the initial phase difference can be calculated according to the following steps to correct the left and right rear wheel pulse numbers based on the initial phase difference.
  • Step 1 Based on the initial driving angle, determine whether the vehicle is traveling straight.
  • Step 2 Obtain the number of left rear wheel pulses and the number of right rear wheel pulses that meet the conditions of step 1 above according to the set duration or set frame.
  • the set duration can be 3-4 seconds, and the set frame corresponding to the set duration can be 80-100 frames.
  • Step 3 According to the initial phase difference formula Calculate the initial phase difference ⁇ LR 0 .
  • Step 4 Determine whether ⁇ LR 0 is valid. If -1 ⁇ LR 0 ⁇ 1, ⁇ LR 0 is considered valid.
  • Step 5 If ⁇ LR 0 >0, correct the first left rear wheel pulse number; if ⁇ LR 0 ⁇ 0, correct the first right rear wheel pulse number.
  • ⁇ LR 0 >0 determine whether the current vehicle is going straight. If it is going straight, accumulate the difference between the second left rear wheel pulse number and the right rear wheel pulse to obtain the corrected first left rear wheel pulse number. If the vehicle is not traveling straight, the first left rear wheel pulse number can be obtained directly, or the first left rear wheel pulse number can be expressed as the sum of the second left rear wheel pulse number and the left rear wheel pulse difference. value.
  • ⁇ LR 0 ⁇ 0 determine whether the current vehicle is going straight. If it is going straight, accumulate the difference between the second right rear wheel pulse number and the left rear wheel pulse to obtain the corrected first right rear wheel pulse number. If the vehicle is In the non-straight-moving state, the first right rear wheel pulse number can be obtained directly, or the first right rear wheel pulse number can be expressed as a value that adds the second right rear wheel pulse number and the right rear wheel pulse difference.
  • flight position prediction can be achieved according to the following steps.
  • the specific steps are as follows:
  • Step 1 Start the vehicle.
  • Step 2 Obtain the pulse number of the left rear wheel and the right rear wheel.
  • Step 3 Update the current position information without using the initial phase difference method.
  • Step 4 Obtain the pulse number of the left rear wheel and the right rear wheel when the vehicle is traveling straight, and obtain the pulse number of the left rear wheel and the right rear wheel of the set frame or set duration.
  • Step 5 Calculate the initial phase difference.
  • Step 6 Determine whether the initial phase difference is valid, and update the position information at the current moment based on the valid initial phase difference.
  • the technical solution of the embodiment of the present application determines the initial phase difference of the current vehicle; corrects the first left rear wheel pulse number or the first right rear wheel pulse number at the current moment based on the initial phase difference; based on the corrected first left rear wheel pulse number
  • the number of pulses and the number of first right rear wheel pulses predict the position information of the current vehicle at the current moment.
  • the above technical solution corrects the left rear wheel pulse number and the right rear wheel pulse number through the initial phase difference, and predicts the current moment position information based on the corrected left rear wheel pulse number and right rear wheel pulse number. Compared with related technologies, it can Improve flight position prediction accuracy.
  • the technical solution provided by the embodiments of the present application does not need to rely on other reference sensors. When other positioning sensors are interfered, it can still provide reliable position information, has strong practicability, and also provides a basis for subsequent multi-sensor positioning algorithms. The accuracy and applicability are guaranteed.
  • Figure 4 is a schematic structural diagram of a flight position prediction device provided by an embodiment of the present application. As shown in Figure 4, the device includes: an initial phase difference determination module 401, a correction module 402 and a prediction module 403.
  • the initial phase difference determination module is used to determine the initial phase difference of the current vehicle
  • a correction module configured to correct the first left rear wheel pulse number or the first right rear wheel pulse number at the current moment based on the initial phase difference
  • a prediction module configured to predict the position information of the current vehicle at the current moment based on the corrected first left rear wheel pulse number and the first right rear wheel pulse number.
  • the technical solution of the embodiment of the present application determines the initial phase difference of the current vehicle through the initial phase difference determination module; and uses the correction module to correct the first left rear wheel pulse number or the first right rear wheel pulse number at the current moment based on the initial phase difference;
  • the prediction module predicts the position information of the current vehicle at the current moment based on the corrected first left rear wheel pulse number and the first right rear wheel pulse number.
  • the above technical solution corrects the left rear wheel pulse number and the right rear wheel pulse number through the initial phase difference, based on the corrected left rear wheel pulse number
  • the scheme of predicting the current moment's dead position information based on the pulse number of the right rear wheel can improve the dead position prediction accuracy compared with related technologies.
  • the initial phase difference determination module is specifically used to: control the current vehicle to drive in a straight direction from standstill to start for a set duration; obtain the left rear wheel pulse number and right rear wheel pulse number corresponding to multiple frames within the set duration. The number of wheel pulses; calculate the difference in pulse numbers between the left rear wheel and the right rear wheel in each frame; average the difference in pulse numbers between the left rear wheel and the right rear wheel in multiple frames to obtain the initial phase difference of the current vehicle .
  • the correction module is specifically configured to: obtain the second left rear wheel pulse number and the second right rear wheel pulse number at the previous moment; determine the first left rear wheel pulse number and the second left rear wheel pulse.
  • the difference between the number of pulses is determined as the left rear wheel pulse difference; the difference between the first right rear wheel pulse number and the second right rear wheel pulse number is determined as the right rear wheel pulse difference; if the If the initial phase difference falls into the first set interval, the first left rear wheel pulse number is corrected according to the right rear wheel pulse difference; if the initial phase difference falls into the second set interval, the first left rear wheel pulse number is corrected according to the right rear wheel pulse difference value.
  • the left rear wheel pulse difference corrects the first right rear wheel pulse number.
  • the correction module is also used to determine whether the current vehicle is going straight. If it is going straight, then accumulate the difference between the second left rear wheel pulse number and the right rear wheel pulse to obtain the corrected first Left rear wheel pulse number.
  • the correction module is also used to determine whether the current vehicle is going straight. If it is going straight, then accumulate the difference between the second right rear wheel pulse number and the left rear wheel pulse to obtain the corrected first Right rear wheel pulse number.
  • the correction module is also configured to: determine the driving angle at the current moment based on the left rear wheel pulse difference and the right rear wheel pulse difference; and determine whether the current vehicle is going straight based on the driving angle.
  • the flight position information includes driving angle and position coordinates; optionally, the prediction module is specifically configured to: determine the driving distance based on the corrected first left rear wheel pulse number and the first right rear wheel pulse number. and the azimuth angle change; determine the corrected driving angle at the current moment based on the azimuth angle change and the driving angle at the previous moment; based on the driving distance, the azimuth angle change, the driving angle at the previous moment and the previous moment
  • the position coordinates determine the position coordinates at the current moment.
  • the flight position prediction device provided by the embodiments of this application can execute the flight position prediction method provided by any embodiment of this application, and has functional modules and beneficial effects corresponding to the execution method.
  • FIG. 5 shows a schematic structural diagram of an electronic device 10 that can be used to implement embodiments of the present application.
  • Electronic devices are intended to mean various forms of digital computers, such as laptops, desktop computers, workstations, personal digital assistants, servers, blade servers, mainframe computers, and others suitable computer.
  • Electronic devices may also represent various forms of mobile devices, such as personal digital assistants, cellular phones, smart phones, wearable devices (eg, helmets, glasses, watches, etc.), and other similar computing devices.
  • the components shown herein, their connections and relationships, and their functions are examples only and are not intended to limit the implementation of the present application as described and/or claimed herein.
  • the electronic device 10 includes at least one processor 11, and a memory communicatively connected to the at least one processor 11, such as a read-only memory (Read-Only Memory, ROM) 12, a random access memory (Random Access Memory, RAM) 13, etc., wherein the memory stores a computer program that can be executed by at least one processor, and the processor 11 can be loaded into the random access memory (RAM) according to the computer program stored in the read-only memory (ROM) 12 or from the storage unit 18.
  • a computer program in RAM) 13 to perform various appropriate actions and processes.
  • various programs and data required for the operation of the electronic device 10 can also be stored.
  • the processor 11, the ROM 12 and the RAM 13 are connected to each other via the bus 14.
  • An input/output (I/O) interface 15 is also connected to the bus 14 .
  • the I/O interface 15 Multiple components in the electronic device 10 are connected to the I/O interface 15, including: an input unit 16, such as a keyboard, a mouse, etc.; an output unit 17, such as various types of displays, speakers, etc.; a storage unit 18, such as a magnetic disk, an optical disk, etc. etc.; and communication unit 19, such as network card, modem, wireless communication transceiver, etc.
  • the communication unit 19 allows the electronic device 10 to exchange information/data with other devices through computer networks such as the Internet and/or various telecommunications networks.
  • Processor 11 may be a variety of general and/or special purpose processing components having processing and computing capabilities. Some examples of the processor 11 include, but are not limited to, a central processing unit (Central Processing Unit, CPU), a graphics processing unit (Graphics Processing Unit, GPU), various dedicated artificial intelligence (Artificial Intelligence, AI) computing chips, various running Machine learning model algorithm processor, digital signal processor (Digital Signal Processor, DSP), and any appropriate processor, controller, microcontroller, etc.
  • the processor 11 performs various methods and processes described above, such as method position prediction.
  • the method dead position prediction may be implemented as a computer program that is tangibly embodied in a computer-readable storage medium, such as the storage unit 18 .
  • part or all of the computer program may be loaded and/or installed onto the electronic device 10 via the ROM 12 and/or the communication unit 19 .
  • processor 11 may be configured to perform method position prediction in any other suitable manner (eg, by means of firmware).
  • FPGAs Field Programmable Gate Arrays
  • ASICs Application Specific Integrated Circuits
  • ASSP Application Specific Standard Product
  • SOC System on Chip
  • CPLD Complex Programmable Logic Device
  • These various embodiments may include implementation in one or more computer programs executable and/or interpreted on a programmable system including at least one programmable processor, the programmable processor
  • the processor which may be a special purpose or general purpose programmable processor, may receive data and instructions from a storage system, at least one input device, and at least one output device, and transmit data and instructions to the storage system, the at least one input device, and the at least one output device.
  • An output device may be a special purpose or general purpose programmable processor, may receive data and instructions from a storage system, at least one input device, and at least one output device, and transmit data and instructions to the storage system, the at least one input device, and the at least one output device.
  • An output device may be a special purpose or general purpose programmable processor, may receive data and instructions from a storage system, at least one input device, and at least one output device, and transmit data and instructions to the storage system, the at least one input device, and the at least one output device.
  • Computer programs for implementing the methods of the present application may be written in any combination of one or more programming languages. These computer programs may be provided to a processor of a general-purpose computer, a special-purpose computer, or other programmable data processing device, such that the computer program, when executed by the processor, causes the functions/operations specified in the flowcharts and/or block diagrams to be implemented.
  • a computer program may execute entirely on the machine, partly on the machine, as a stand-alone software package, partly on the machine and partly on a remote machine or entirely on the remote machine or server.
  • a computer-readable storage medium may be a tangible medium that may contain or store a computer program for use by or in connection with an instruction execution system, apparatus, or device.
  • Computer-readable storage media may include, but are not limited to, electronic, magnetic, optical, electromagnetic, infrared, or semiconductor systems, devices or devices, or any suitable combination of the foregoing.
  • the computer-readable storage medium may be a machine-readable signal medium.
  • machine-readable storage media would include one or more wire-based electrical connections, laptop disks, hard drives, random access memory (RAM), 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 device, magnetic storage device, or any of the above Suitable combination.
  • RAM random access memory
  • ROM read only memory
  • EPROM erasable programmable read only memory
  • EPROM erasable programmable Read-Only Memory
  • flash memory optical fiber
  • portable compact disk read-only memory Compact Disc Read-Only Memory
  • CD-ROM Compact Disc Read-Only Memory
  • magnetic storage device or any of the above Suitable combination.
  • the systems and techniques described herein may be implemented on an electronic device having a display device (eg, a cathode ray tube (CRT) or a liquid crystal) for displaying information to the user. (Liquid Crystal Display, LCD monitor); and a keyboard and pointing device (such as a mouse or trackball) through which the user can The keyboard and the pointing device are used to provide input to the electronic device.
  • a display device eg, a cathode ray tube (CRT) or a liquid crystal
  • LCD monitor Liquid Crystal Display, LCD monitor
  • keyboard and pointing device such as a mouse or trackball
  • Other kinds of devices may also be used to provide interaction with the user; for example, the feedback provided to the user may be any form of sensory feedback (e.g., visual feedback, auditory feedback, or tactile feedback); and may be provided in any form, including Acoustic input, voice input or tactile input) to receive input from the user.
  • the systems and techniques described herein may be implemented in a computing system that includes back-end components (e.g., as a data server), or a computing system that includes middleware components (e.g., an application server), or a computing system that includes front-end components (e.g., A user's computer having a graphical user interface or web browser through which the user can interact with implementations of the systems and technologies described herein), or including such backend components, middleware components, or any combination of front-end components in a computing system.
  • the components of the system may be interconnected by any form or medium of digital data communication (eg, a communications network). Examples of communication networks include: Local Area Network (LAN), Wide Area Network (WAN), blockchain network, and the Internet.
  • Computing systems may include clients and servers.
  • Clients and servers are generally remote from each other and typically interact over a communications network.
  • the relationship of client and server is created by computer programs running on corresponding computers and having a client-server relationship with each other.
  • the server can be a cloud server, also known as cloud computing server or cloud host. It is a host product in the cloud computing service system to solve the problems that exist in traditional physical host and virtual private server (VPS) services. It has the disadvantages of difficult management and weak business scalability.
  • VPN virtual private server

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Automation & Control Theory (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Navigation (AREA)
  • Gyroscopes (AREA)

Abstract

A dead reckoning method and apparatus, an electronic device, and a computer-readable storage medium. The method comprises: determining an initial phase difference of a current vehicle (S110); correcting, on the basis of the initial phase difference, a first left rear wheel pulse count or a first right rear wheel pulse count at the current moment (S120); and predicting dead reckoning information of the current vehicle at the current moment on the basis of the corrected first left rear wheel pulse count or first right rear wheel pulse count (S130).

Description

航位预测方法、装置、设备及介质Flight position prediction methods, devices, equipment and media
本申请要求在2022年07月04日提交中国专利局、申请号为202210781542.1的中国专利申请的优先权,以上申请的全部内容通过引用结合在本申请中。This application claims priority to the Chinese patent application with application number 202210781542.1, which was submitted to the China Patent Office on July 4, 2022. The entire content of the above application is incorporated into this application by reference.
技术领域Technical field
本申请涉及车辆技术领域,例如涉及一种航位预测方法、装置、设备及介质。This application relates to the field of vehicle technology, for example, to a position prediction method, device, equipment and medium.
背景技术Background technique
航位预测(Dead-Reckoning,DR)是从物体在上一时刻所处的已知位置出发,根据当前的运动航向和航速推算出物体在当前时刻的位置,以此类推。随着车载导航系统的应用日益普及,以及防抱死刹车系统(Anti-lock Braking System,ABS)逐渐成为多种车型的标准配置,将ABS车轮转速传感器作为航位推测传感器,可以使资源得到充分利用,从而可以降低车载导航系统的生产成本。Dead-Reckoning (DR) starts from the known position of the object at the previous moment, and calculates the position of the object at the current moment based on the current movement course and speed, and so on. As the application of in-vehicle navigation systems becomes more and more popular, and anti-lock braking system (ABS) gradually becomes the standard configuration of many models, using ABS wheel speed sensors as dead reckoning sensors can make full use of resources. Utilization can reduce the production cost of vehicle navigation systems.
目前主要的处理方法为差分里程算法,输入可以采用前后四轮的脉冲数据。但是采用该方法计算DR会存在一定的角度误差,会影响到整个行驶轨迹的精度。At present, the main processing method is the differential mileage algorithm, and the input can be the pulse data of the front and rear four wheels. However, there will be a certain angle error in calculating DR using this method, which will affect the accuracy of the entire driving trajectory.
发明内容Contents of the invention
本申请提供了一种航位预测方法、装置、设备及介质,以提高航位预测精度。This application provides a dead position prediction method, device, equipment and medium to improve the dead position prediction accuracy.
根据本申请的一方面,提供了一种航位预测方法,包括:According to one aspect of the present application, a flight position prediction method is provided, including:
确定当前车辆的初相差;Determine the initial phase difference of the current vehicle;
基于所述初相差对当前时刻的第一左后轮脉冲数或第一右后轮脉冲数进行修正;Modify the first left rear wheel pulse number or the first right rear wheel pulse number at the current moment based on the initial phase difference;
基于修正后的第一左后轮脉冲数和所述第一右后轮脉冲数预测所述当前车辆在所述当前时刻的航位信息。The position information of the current vehicle at the current moment is predicted based on the corrected first left rear wheel pulse number and the first right rear wheel pulse number.
根据本申请的另一方面,提供了一种航位预测装置,包括:According to another aspect of the present application, a flight position prediction device is provided, including:
初相差确定模块,设置为确定当前车辆的初相差;The initial phase difference determination module is configured to determine the initial phase difference of the current vehicle;
修正模块,设置为基于所述初相差对当前时刻的第一左后轮脉冲数或第一右后轮脉冲数进行修正;A correction module configured to correct the first left rear wheel pulse number or the first right rear wheel pulse number at the current moment based on the initial phase difference;
预测模块,设置为基于修正后的第一左后轮脉冲数和所述第一右后轮脉冲 数预测所述当前车辆在所述当前时刻的航位信息。a prediction module configured to be based on the corrected first left rear wheel pulse number and the first right rear wheel pulse Predict the position information of the current vehicle at the current moment.
根据本申请的另一方面,提供了一种电子设备,所述电子设备包括:According to another aspect of the present application, an electronic device is provided, the electronic device including:
至少一个处理器;以及at least one processor; and
与所述至少一个处理器通信连接的存储器;其中,a memory communicatively connected to the at least one processor; wherein,
所述存储器存储有可被所述至少一个处理器执行的计算机程序,所述计算机程序被所述至少一个处理器执行,以使所述至少一个处理器能够执行本申请任一实施例所述的航位预测方法。The memory stores a computer program that can be executed by the at least one processor, and the computer program is executed by the at least one processor, so that the at least one processor can execute the method described in any embodiment of the present application. Deadline prediction method.
根据本申请的另一方面,提供了一种计算机可读存储介质,所述计算机可读存储介质存储有计算机指令,所述计算机指令用于使处理器执行时实现本申请任一实施例所述的航位预测方法。According to another aspect of the present application, a computer-readable storage medium is provided. The computer-readable storage medium stores computer instructions, and the computer instructions are used to implement any of the embodiments of the present application when executed by a processor. flight position prediction method.
应当理解,本部分所描述的内容并非旨在标识本申请的实施例的关键或重要特征,也不用于限制本申请的范围。本申请的其它特征将通过以下的说明书而变得容易理解。It should be understood that the content described in this section is not intended to identify key or important features of the embodiments of the application, nor is it intended to limit the scope of the application. Other features of the present application will become readily understood from the following description.
附图说明Description of the drawings
图1是相关技术中的差分里程算法原理示意图;Figure 1 is a schematic diagram of the principle of differential mileage algorithm in related technologies;
图2为本申请实施例提供的一种航位预测方法的流程图;Figure 2 is a flow chart of a flight position prediction method provided by an embodiment of the present application;
图3是根据本申请实施例提供的航位预测方法实现示意图;Figure 3 is a schematic diagram of the implementation of the flight position prediction method provided according to an embodiment of the present application;
图4为本申请实施例提供的一种航位预测装置的结构示意图;Figure 4 is a schematic structural diagram of a flight position prediction device provided by an embodiment of the present application;
图5是实现本申请实施例的航位预测方法的电子设备的结构示意图。FIG. 5 is a schematic structural diagram of an electronic device that implements the flight position prediction method according to the embodiment of the present application.
具体实施方式Detailed ways
基于本申请中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都应当属于本申请保护的范围。Based on the embodiments in this application, all other embodiments obtained by those of ordinary skill in the art without creative efforts should fall within the scope of protection of this application.
需要说明的是,本申请的说明书和权利要求书及上述附图中的术语“第一”、“第二”等是用于区别类似的对象,而不必用于描述特定的顺序或先后次序。应该理解这样使用的数据在适当情况下可以互换,以便这里描述的本申请的实施例能够以除了在这里图示或描述的那些以外的顺序实施。此外,术语“包括”和“具有”以及他们的任何变形,意图在于覆盖不排他的包含,例如,包含了一系列步骤或单元的过程、方法、系统、产品或设备不必限于清楚地列出的那些步骤或单元,而是可包括没有清楚地列出的或对于这些过程、方法、产品或设备固有的其它步骤或单元。 It should be noted that the terms "first", "second", etc. in the description and claims of this application and the above-mentioned drawings are used to distinguish similar objects and are not necessarily used to describe a specific order or sequence. It is to be understood that the data so used are interchangeable under appropriate circumstances so that the embodiments of the application described herein can be practiced in sequences other than those illustrated or described herein. In addition, the terms "including" and "having" and any variations thereof are intended to cover non-exclusive inclusions, e.g., a process, method, system, product, or apparatus that encompasses a series of steps or units and need not be limited to those explicitly listed. Those steps or elements may instead include other steps or elements not expressly listed or inherent to the process, method, product or apparatus.
为便于理解,给出了如图1所示的差分里程算法原理示意图。以后两轮(非驱动轮)的脉冲输入数据为例。如图1所示,车子在k-1时刻后左右两轮输出脉冲数分别为LRk-1,RRk-1,在k时刻输出为LRk,RRk,左后轮的运动距离为ΔLR,右后轮的运动距离为为ΔRR。以汽车后轴中点的轨迹表示这段时间内的车子的行驶轨迹,图中所示从Mk-1行驶到Mk,在这一小段时间的运动轨迹可以视为一个以O为圆心,以半径为R的圆弧,于是汽车行驶距离Δ与行驶方位角变化量ω的估算公式分别为:

For ease of understanding, a schematic diagram of the differential mileage algorithm principle shown in Figure 1 is given. Take the pulse input data of the rear two wheels (non-driving wheels) as an example. As shown in Figure 1, the number of pulses output by the left and right wheels of the car after time k-1 are LR k-1 and RR k-1 respectively. At time k, the output pulses are LR k and RR k . The movement distance of the left rear wheel is Δ LR , the movement distance of the right rear wheel is ΔRR . The trajectory of the car during this period of time is represented by the trajectory of the midpoint of the rear axle of the car. As shown in the figure, traveling from M k-1 to M k , the motion trajectory during this short period of time can be regarded as a circle with O as the center. Taking an arc with radius R, the estimation formulas of the car’s driving distance Δ and the driving azimuth angle change ω are respectively:

其中WR为后轴长度。Where W R is the length of the rear axle.
图2为本申请实施例提供的一种航位预测方法的流程图,本实施例可适用于航位预测的情况,该方法可以由航位预测装置来执行,该航位预测装置可以采用硬件和/或软件的形式实现,该航位预测装置可配置于服务器中。如图2所示,该方法包括:Figure 2 is a flow chart of a dead position prediction method provided by an embodiment of the present application. This embodiment can be applied to the situation of dead position prediction. The method can be executed by a dead position prediction device. The dead position prediction device can use hardware. And/or implemented in the form of software, the flight position prediction device can be configured in the server. As shown in Figure 2, the method includes:
S110、确定当前车辆的初相差。S110. Determine the initial phase difference of the current vehicle.
需要说明的是,汽车行驶时,可通过车轮上的齿轮触发传感器进行计数,从而输出对应的脉冲数。其中,脉冲数为一个整数的累加值。由于两个齿轮中间存在一定的距离,因此,汽车从静止到起始运动时,左后和右后两轮可能处于两个齿轮中间。例如,当第一个齿轮滑过传感器时,可计数为1,但在第二个齿轮滑过传感器之前,传感器的计数值或脉冲数都是1。所以,初相可以理解为汽车从静止到起始运动时,左后和右后两轮可能处于两个齿轮中间的情况。而初相差可以理解为车辆在静止时的左后和右后两轮脉冲数的差值,或者为多帧的左后和右后两轮脉冲数差值的平均值。It should be noted that when the car is running, the gear trigger sensor on the wheel can be used to count and output the corresponding number of pulses. Among them, the number of pulses is the cumulative value of an integer. Since there is a certain distance between the two gears, when the car moves from rest to starting, the left rear and right rear wheels may be in the middle of the two gears. For example, when the first gear slides past the sensor, it counts as 1, but until the second gear slides past the sensor, the sensor's count value or number of pulses is 1. Therefore, the initial phase can be understood as the situation where the left rear and right rear wheels may be in the middle of the two gears when the car is moving from rest to starting. The initial phase difference can be understood as the difference in pulse number between the left and right rear wheels when the vehicle is stationary, or as the average value of the difference in pulse numbers between the left and right rear wheels in multiple frames.
示例性的,假设汽车静止时,左后和右后两轮的轮速脉冲值为L0,R0,0≤L0<1,0≤R0<1,在一个脉冲内。起始直行,左右两轮的行驶路径一致,都记为LRi,因为存在截断,其中截断可以理解为0-1之间的值,输出为0的值,所以轮速脉冲输出值为Li,Ri,i代表不同时刻。假设每次的截断误差为δLi,δRi,同样在一个脉冲内即0≤δLi<1,0≤≤δRi<1。For example, assuming that when the car is stationary, the wheel speed pulse values of the left and right rear wheels are L0, R0, 0≤L0<1, 0≤R0<1, within one pulse. Start going straight, the driving paths of the left and right wheels are the same, both are recorded as LR i , because there is a truncation, where the truncation can be understood as a value between 0-1, and the output is a value of 0, so the wheel speed pulse output value is L i , R i ,i represent different moments. Assume that the truncation errors each time are δL i and δR i , which are also 0≤δL i <1 and 0≤≤δR i <1 within one pulse.
具体公式如下:L0+LRi=Li+δLiThe specific formula is as follows: L0+LR i =L i +δL i ;
R0+LRi=Ri+δRiR0+LR i =R i +δR i ;
L0-R0=(Li-Ri)+(δLi-δRi)
L0-R0=(L i -R i )+(δL i -δR i )
经过验证,多帧的脉冲数累加后,接近于0,那么通过多帧的左后和右后两轮脉冲分别输出Li,Ri,可以通过公式得到初相差,从而可以用于计算DR。After verification, after the number of pulses in multiple frames is accumulated, is close to 0, then L i and R i are respectively output through the left and right rear pulses of multiple frames, which can be calculated by the formula The initial phase difference is obtained, which can be used to calculate DR.
可选的,在实际应用中,确定当前车辆的初相差的方式可以是:控制当前车辆从静止到启动以直行的方式行驶设定时长;获取设定时长内多帧分别对应的左后轮脉冲数和右后轮脉冲数;计算每帧的左右轮脉冲数差值;对多帧的左右轮脉冲数差值求取平均值,获得当前车辆的初相差。Optionally, in practical applications, the method of determining the initial phase difference of the current vehicle can be: controlling the current vehicle to drive straight from stationary to starting for a set duration; obtaining the left rear wheel pulses corresponding to multiple frames within the set duration. number and the number of right rear wheel pulses; calculate the difference in the number of left and right wheel pulses in each frame; average the difference in the number of left and right wheel pulses in multiple frames to obtain the initial phase difference of the current vehicle.
本实施例,对设定时长不作限制,例如可以是3至4秒。同样,本实施例对多帧的具体值不作限制,例如可以是80至100帧。具体的,控制当前车辆从静止到启动时尽量以直行的状态行驶,可基于初始行驶角度和设定阈值进行获取当前车辆在直行状态下的左后轮脉冲数和右后轮脉冲数,并且获取设定时长内多帧左后轮和右后轮的脉冲数,从而可先计算每帧的左后轮和右后轮的脉冲数差值,再对多帧的左后轮和右后轮脉冲数差值求取平均值,得到初相差。示例性的,将初始行驶角度记为θ,将设定阈值记为θthresholdθthreshold=Δt/WR。其中,i可表示不通时刻或不同帧,Δt表示两帧之间的时间差,ΔLR:表示左后轮前后两次脉冲差,ΔRR:表示右后轮前后两次脉冲差,ω可表示为行驶方位角变 化量或可理解为角速度。当|θi|<2*θthreshold可认为是车辆在直行状态下行驶。In this embodiment, there is no limit to the set time, which may be 3 to 4 seconds, for example. Similarly, this embodiment does not limit the specific value of multiple frames, for example, it can be 80 to 100 frames. Specifically, the current vehicle is controlled to drive as straight as possible from stationary to starting. The number of left rear wheel pulses and the number of right rear wheel pulses of the current vehicle in the straight traveling state can be obtained based on the initial driving angle and the set threshold, and the Set the pulse number of the left rear wheel and right rear wheel in multiple frames within the duration, so that the difference in pulse number of the left rear wheel and right rear wheel in each frame can be calculated first, and then the pulse number of the left rear wheel and right rear wheel in multiple frames can be calculated. Calculate the average of the differences to obtain the initial phase difference. For example, the initial driving angle is denoted as θ, and the set threshold is denoted as θ threshold . θ threshold =Δt/W R . Among them, i can represent a blocked moment or different frames, Δt represents the time difference between two frames, Δ LR : represents the difference between the two pulses before and after the left rear wheel, Δ RR : represents the difference between the two pulses before and after the right rear wheel, ω can be expressed as Driving azimuth angle change The quantitative quantity may be understood as angular velocity. When |θ i |<2*θ threshold , it can be considered that the vehicle is traveling straight ahead.
需要说明的是,由于θi=θi-1+ω·Δt,所以两帧之间的角度变化值为ω·Δt,若车辆在直行的状态下,角度没有变化,则ΔLR=ΔRR,ω=0,如果车辆在非直行的状态下,车辆存在角度变化,那么ΔLRRR的最小值为1,那么ω=1/WR,则角度变化值为Δt/WR,所以将设定阈值设定为θthreshold=Δt/WR。由于ΔLRRR为整数值,为了表示|θi|<=θthreshold,可将|θi|<2*θthreshold表示为车辆在直行状态下,在直行状态下,左右后轮的脉冲数可以用于计算初相差。It should be noted that due to θ ii-1 +ω·Δt, so the angle change value between the two frames is ω·Δt. If the vehicle is traveling straight and the angle does not change, then Δ LRRR , ω=0, if When the vehicle is not traveling straight, the vehicle angle changes, then the minimum value of Δ LR - Δ RR is 1, then ω = 1/W R , then the angle change value is Δt/W R , so the threshold is set is θ threshold =Δt/W R . Since Δ LR - Δ RR is an integer value, in order to express |θ i |<=θ threshold , |θ i |<2*θ threshold can be expressed as the pulse of the left and right rear wheels when the vehicle is traveling straight. The number can be used to calculate the initial phase difference.
示例性的,初相差可表示为ΔLR0,则可通过如下公式进行计算得到初相差
For example, the initial phase difference can be expressed as ΔLR 0 , and the initial phase difference can be calculated by the following formula
S120、基于初相差对当前时刻的第一左后轮脉冲数或第一右后轮脉冲数进行修正。S120. Modify the first left rear wheel pulse number or the first right rear wheel pulse number at the current time based on the initial phase difference.
本实施例,可对初相差进行判断,若有效,则可基于初相差对当前时刻的第一左后轮脉冲数或第一右后轮脉冲数进行修正,从而可减少角度误差。In this embodiment, the initial phase difference can be determined. If it is valid, the first left rear wheel pulse number or the first right rear wheel pulse number at the current moment can be corrected based on the initial phase difference, thereby reducing the angle error.
可选的,基于初相差对当前时刻的第一左后轮脉冲数或第一右后轮脉冲数进行修正的方式可以是:获取上一时刻的第二左后轮脉冲数和第二右后轮脉冲数;确定第一左后轮脉冲数和第二左后轮脉冲数的差值,确定为左后轮脉冲差值;确定第一右后轮脉冲数和第二右后轮脉冲数的差值,确定为右后轮脉冲差值;若初相差落入第一设定区间,则根据右后轮脉冲差值对第一左后轮脉冲数进行修正;若初相差落入第二设定区间,则根据左后轮脉冲差值 对第一右后轮脉冲数进行修正。Optionally, the method of correcting the first left rear wheel pulse number or the first right rear wheel pulse number at the current moment based on the initial phase difference may be: obtaining the second left rear wheel pulse number and the second right rear wheel pulse number at the previous moment. wheel pulse number; determine the difference between the first left rear wheel pulse number and the second left rear wheel pulse number, and determine it as the left rear wheel pulse difference; determine the first right rear wheel pulse number and the second right rear wheel pulse number. The difference is determined as the right rear wheel pulse difference; if the initial phase difference falls into the first set interval, the first left rear wheel pulse number is corrected according to the right rear wheel pulse difference; if the initial phase difference falls into the second set interval within a certain interval, based on the left rear wheel pulse difference Correct the first right rear wheel pulse number.
其中,第一设定区间可以表示为(0,1),第二设定区间可以表示为(-1,0)。本实施例,可对初相差进行判断是否有效,若初相差处于第一设定区间或第二设定区间,则可以认为初相差有效。具体的,若初相差落入第一设定区间,则表示需要对当前时刻的第一左后轮脉冲数进行修正,并且可基于右后轮脉冲差值对第一左后轮脉冲数进行修正。若初相差落入第二设定区间,则表示需要对当前时刻的第一右后轮脉冲数进行修正,并且可基于左后轮脉冲差值对第一右后轮脉冲数进行修正。The first set interval can be expressed as (0,1), and the second set interval can be expressed as (-1,0). In this embodiment, it is possible to determine whether the initial phase difference is valid. If the initial phase difference is within the first set interval or the second set interval, the initial phase difference can be considered to be valid. Specifically, if the initial phase difference falls within the first set interval, it means that the first left rear wheel pulse number at the current moment needs to be corrected, and the first left rear wheel pulse number can be corrected based on the right rear wheel pulse difference. . If the initial phase difference falls within the second set interval, it means that the first right rear wheel pulse number at the current moment needs to be corrected, and the first right rear wheel pulse number can be corrected based on the left rear wheel pulse difference.
可选的,根据右后轮脉冲差值对第一左后轮脉冲数进行修正的方式可以是:判断当前车辆是否直行,若是直行,则将第二左后轮脉冲数与右后轮脉冲差值进行累加,获得修正后的第一左后轮脉冲数。Optionally, the method of correcting the first left rear wheel pulse number based on the right rear wheel pulse difference may be: determining whether the current vehicle is going straight, and if so, then calculating the second left rear wheel pulse number and the right rear wheel pulse difference. The values are accumulated to obtain the corrected first left rear wheel pulse number.
具体的,可根据行驶角度判断当前车辆是否直行,若车辆在直行的状态下,则修正后的第一左后轮脉冲数可表示为将第二左后轮脉冲数与右后轮脉冲差值进行相加的值。例如,Li=Li-1RR,ΔRR:表示右后轮前后两次脉冲差,可以理解为第一右后轮脉冲数和第二右后轮脉冲数的差值,Li表示为第一左后轮脉冲数,Li-1表示为第二左后轮脉冲数。当然,若车辆在非直行的状态下,可直接获取第一左后轮脉冲数,或者第一左后轮脉冲数可表示为将第二左后轮脉冲数与左后轮脉冲差值进行相加的值。例如,Li=Li-1LR,ΔLR:表示左后轮前后两次脉冲差,可以理解为第一左后轮脉冲数和第二左后轮脉冲数的差值。Specifically, it can be determined according to the driving angle whether the current vehicle is going straight. If the vehicle is going straight, the corrected first left rear wheel pulse number can be expressed as the difference between the second left rear wheel pulse number and the right rear wheel pulse. The values to be added. For example, Li = Li -1 + Δ RR , Δ RR : represents the difference between the two pulses of the right rear wheel, which can be understood as the difference between the first right rear wheel pulse number and the second right rear wheel pulse number, Li is expressed as the first left rear wheel pulse number, and L i-1 is expressed as the second left rear wheel pulse number. Of course, if the vehicle is not traveling straight, the first left rear wheel pulse number can be obtained directly, or the first left rear wheel pulse number can be expressed as the second left rear wheel pulse number and the left rear wheel pulse difference. added value. For example, Li = Li -1 + Δ LR , Δ LR : represents the difference between the two pulses before and after the left rear wheel, which can be understood as the difference between the first left rear wheel pulse number and the second left rear wheel pulse number.
可选的,根据左后轮脉冲差值对第一右后轮脉冲数进行修正的方式可以是:判断当前车辆是否直行,若是直行,则将第二右后轮脉冲数与左后轮脉冲差值进行累加,获得修正后的第一右后轮脉冲数。Optionally, the method of correcting the first right rear wheel pulse number based on the left rear wheel pulse difference may be: determining whether the current vehicle is going straight, and if it is going straight, then calculating the second right rear wheel pulse number and the left rear wheel pulse difference. The values are accumulated to obtain the corrected first right rear wheel pulse number.
具体的,可根据行驶角度判断当前车辆是否直行,若车辆在直行的状态下,则修正后的第一右后轮脉冲数可表示为将第二右后轮脉冲数与左后轮脉冲差值进行相加的值。例如,Ri=Ri-1LR,ΔLR:表示左后轮前后两次脉冲差,可以理解为第一左后轮脉冲数和第二左后轮脉冲数的差值。Ri表示为第一右后轮脉冲数,Ri-1表示为第二右后轮脉冲数。当然,若车辆在非直行的状态下,可直接获取第一右后轮脉冲数,或者第一右后轮脉冲数可表示为将第二右后轮脉冲数与右后轮脉冲差值进行相加的值。例如,Ri=Ri-1RR,ΔRR:表示右后轮前后两次脉冲差,可以理解为第一右后轮脉冲数和第二右后轮脉冲数的差值。 Specifically, it can be determined according to the driving angle whether the current vehicle is going straight. If the vehicle is going straight, the corrected first right rear wheel pulse number can be expressed as the difference between the second right rear wheel pulse number and the left rear wheel pulse. The values to be added. For example, R i =R i-1 + Δ LR , Δ LR : represents the difference between the two pulses before and after the left rear wheel, which can be understood as the difference between the first left rear wheel pulse number and the second left rear wheel pulse number. R i represents the first right rear wheel pulse number, and R i-1 represents the second right rear wheel pulse number. Of course, if the vehicle is not traveling straight, the first right rear wheel pulse number can be obtained directly, or the first right rear wheel pulse number can be expressed as the second right rear wheel pulse number and the right rear wheel pulse difference. added value. For example, R i =R i-1 + Δ RR , Δ RR : represents the difference between the two pulses of the right rear wheel, which can be understood as the difference between the first right rear wheel pulse number and the second right rear wheel pulse number.
可选的,判断当前车辆是否直行的方式可以是:根据左后轮脉冲差值和右后轮脉冲差值确定当前时刻的行驶角度;根据行驶角度判断当前车辆是否直行。Optionally, the method of determining whether the current vehicle is going straight may be: determining the driving angle at the current moment based on the left rear wheel pulse difference and the right rear wheel pulse difference; and determining whether the current vehicle is going straight based on the driving angle.
本实施例,确定当前时刻的行驶角度可使用基于初始行驶角度和设定阈值的方法进行确定车辆是否在直行的状态下。即若|行驶角度|<2*设定阈值,则表示为车辆在直行状态下。具体细节,不再赘述。In this embodiment, the driving angle at the current moment may be determined using a method based on the initial driving angle and a set threshold to determine whether the vehicle is traveling straight. That is, if |traveling angle|<2*set threshold, it means that the vehicle is traveling straight. The specific details will not be repeated.
S130、基于修正后的第一左后轮脉冲数和第一右后轮脉冲数预测当前车辆在当前时刻的航位信息。S130. Predict the position information of the current vehicle at the current moment based on the corrected first left rear wheel pulse number and the first right rear wheel pulse number.
其中,航位信息包括行驶角度和位置坐标。本实施例,可基于修正后的第一左后轮脉冲数和第一右后轮脉冲数预测当前车辆在当前时刻的航位信息,从而可在车辆行驶的过程中,实时计算初相差,实时更新当前时刻的航位信息,不仅可提高航位预测精度,同时具有较强的实用性。Among them, the navigation information includes driving angle and position coordinates. In this embodiment, the position information of the current vehicle at the current moment can be predicted based on the corrected first left rear wheel pulse number and the first right rear wheel pulse number, so that the initial phase difference can be calculated in real time while the vehicle is driving. Updating the position information at the current moment can not only improve the accuracy of position prediction, but also has strong practicality.
可选的,基于修正后的第一左后轮脉冲数和第一右后轮脉冲数预测当前车辆在当前时刻的航位信息的方式可以是:基于修正后的第一左后轮脉冲数和第一右后轮脉冲数确定行驶距离和方位角变化量;基于方位角变化量及上一时刻的行驶角度确定当前时刻修正后的行驶角度;根据行驶距离、方位角变化量、上一时刻的行驶角度及上一时刻的位置坐标确定当前时刻的位置坐标。Optionally, the method of predicting the position information of the current vehicle at the current moment based on the corrected first left rear wheel pulse number and the first right rear wheel pulse number may be: based on the corrected first left rear wheel pulse number and The first right rear wheel pulse number determines the driving distance and azimuth angle change; determines the corrected driving angle at the current moment based on the azimuth angle change and the driving angle at the previous moment; based on the driving distance, azimuth angle change, and the previous moment's driving angle The driving angle and the position coordinates at the previous moment determine the position coordinates at the current moment.
具体的,在车辆前进行驶的情况下,可基于修正后的第一左后轮脉冲数和第一右后轮脉冲数重新计算左后轮脉冲差值和右后轮脉冲差值,从而可基于行驶距离和方位角变化量公式进行计算,得到行驶距离和方位角变化量。可根据方位角变化量与两帧之间的时间增量进行计算乘积值(即角度变化值),再将上一时刻的行驶角度与角度变化值相加的值作为当前时刻修正后的行驶角度。可根据行驶距离、方位角变化量、上一时刻的行驶角度及上一时刻的位置坐标确定当前时刻的位置坐标。示例性的,如图3所示,可先根据修正后的第一左后轮脉冲数Li和第一右后轮脉冲数Ri重新计算ΔLR,ΔRR, 再根据公式行驶距离和公式方位角度化量计算行驶距离Δ和方位角变化量ω。当前时刻修正后的行驶角度当前时刻的位置坐标可以xi和yi表示,具体的, Specifically, when the vehicle is traveling forward, the left rear wheel pulse difference and the right rear wheel pulse difference can be recalculated based on the corrected first left rear wheel pulse number and the first right rear wheel pulse number, so that the left rear wheel pulse difference and the right rear wheel pulse difference can be recalculated based on the corrected first left rear wheel pulse number and the first right rear wheel pulse number. Calculate the driving distance and azimuth angle change formulas to obtain the driving distance and azimuth angle change. The product value (i.e., the angle change value) can be calculated based on the azimuth angle change and the time increment between two frames, and then the value obtained by adding the driving angle and the angle change value at the previous moment is used as the corrected driving angle at the current moment. . The position coordinates at the current moment can be determined based on the driving distance, the azimuth angle change, the driving angle at the previous moment and the position coordinates at the previous moment. For example, as shown in Figure 3, Δ LR and Δ RR can be recalculated based on the corrected first left rear wheel pulse number Li and the first right rear wheel pulse number Ri , Then drive distance according to the formula and the formula azimuth angle Calculate the driving distance Δ and the azimuth angle change ω. The corrected driving angle at the current moment The position coordinates at the current moment can be expressed by x i and y i . Specifically,
示例性的,可根据如下步骤计算初相差以根据初相差对左后和右后轮脉冲数进行修正。For example, the initial phase difference can be calculated according to the following steps to correct the left and right rear wheel pulse numbers based on the initial phase difference.
步骤1:根据初始行驶角度,判断车辆是否在直行状态下。Step 1: Based on the initial driving angle, determine whether the vehicle is traveling straight.
可根据如下公式进行判断:θthreshold=Δt/WRθi表示当前时刻的初始行驶角度,θthreshold表示设定阈值,若|θi|<2*θthreshold表示当前车辆在直行状态下。It can be judged according to the following formula: θ threshold =Δt/W R ; θ i represents the initial driving angle at the current moment, and θ threshold represents the set threshold. If |θ i | <2*θ threshold , it represents that the current vehicle is traveling straight.
步骤2,根据设定时长或设定帧获取满足上述步骤1条件下的左后轮脉冲数和右后轮脉冲数。Step 2: Obtain the number of left rear wheel pulses and the number of right rear wheel pulses that meet the conditions of step 1 above according to the set duration or set frame.
设定时长可为3-4秒,设定时长对应的设定帧可为80-100帧。The set duration can be 3-4 seconds, and the set frame corresponding to the set duration can be 80-100 frames.
步骤3:根据初相差公式计算初相差ΔLR0Step 3: According to the initial phase difference formula Calculate the initial phase difference ΔLR 0 .
步骤4:判断ΔLR0是否有效,若-1<ΔLR0<1,认为ΔLR0有效。Step 4: Determine whether ΔLR 0 is valid. If -1<ΔLR 0 <1, ΔLR 0 is considered valid.
步骤5:若ΔLR0>0,对第一左后轮脉冲数进行修正,若ΔLR0<0对第一右后轮脉冲数进行修正。Step 5: If ΔLR 0 >0, correct the first left rear wheel pulse number; if ΔLR 0 <0, correct the first right rear wheel pulse number.
若ΔLR0>0,判断当前车辆是否直行,若是直行,则将第二左后轮脉冲数与右后轮脉冲差值进行累加,获得修正后的第一左后轮脉冲数。若车辆在非直行的状态下,可直接获取第一左后轮脉冲数,或者第一左后轮脉冲数可表示为将第二左后轮脉冲数与左后轮脉冲差值进行相加的值。If ΔLR 0 >0, determine whether the current vehicle is going straight. If it is going straight, accumulate the difference between the second left rear wheel pulse number and the right rear wheel pulse to obtain the corrected first left rear wheel pulse number. If the vehicle is not traveling straight, the first left rear wheel pulse number can be obtained directly, or the first left rear wheel pulse number can be expressed as the sum of the second left rear wheel pulse number and the left rear wheel pulse difference. value.
若ΔLR0<0,判断当前车辆是否直行,若是直行,则将第二右后轮脉冲数与左后轮脉冲差值进行累加,获得修正后的第一右后轮脉冲数。若车辆在 非直行的状态下,可直接获取第一右后轮脉冲数,或者第一右后轮脉冲数可表示为将第二右后轮脉冲数与右后轮脉冲差值进行相加的值。If ΔLR 0 <0, determine whether the current vehicle is going straight. If it is going straight, accumulate the difference between the second right rear wheel pulse number and the left rear wheel pulse to obtain the corrected first right rear wheel pulse number. If the vehicle is In the non-straight-moving state, the first right rear wheel pulse number can be obtained directly, or the first right rear wheel pulse number can be expressed as a value that adds the second right rear wheel pulse number and the right rear wheel pulse difference.
示例性的,可根据如下步骤实现航位预测,具体步骤如下:For example, flight position prediction can be achieved according to the following steps. The specific steps are as follows:
步骤1:车辆启动。Step 1: Start the vehicle.
步骤2:获取左后轮和右后轮脉冲数。Step 2: Obtain the pulse number of the left rear wheel and the right rear wheel.
步骤3:在没有根据初相差的方法下,更新当前时刻的航位信息。Step 3: Update the current position information without using the initial phase difference method.
步骤4:获取车辆在直行的状态下的左后轮和右后轮脉冲数,并获取设定帧或设定时长的左后轮和右后轮脉冲数。Step 4: Obtain the pulse number of the left rear wheel and the right rear wheel when the vehicle is traveling straight, and obtain the pulse number of the left rear wheel and the right rear wheel of the set frame or set duration.
步骤5:计算初相差。Step 5: Calculate the initial phase difference.
步骤6:判断初相差是否有效,基于有效的初相差,更新当前时刻的航位信息。Step 6: Determine whether the initial phase difference is valid, and update the position information at the current moment based on the valid initial phase difference.
本申请实施例的技术方案,通过确定当前车辆的初相差;基于初相差对当前时刻的第一左后轮脉冲数或第一右后轮脉冲数进行修正;基于修正后的第一左后轮脉冲数和第一右后轮脉冲数预测当前车辆在当前时刻的航位信息。上述技术方案,通过初相差修正左后轮脉冲数和右后轮脉冲数,基于修正后的左后轮脉冲数和右后轮脉冲数预测当前时刻航位信息的方案,相比相关技术,可提高航位预测精度。另外,本申请实施例提供的技术方案不需要依赖其它参考传感器,在当其它定位传感器受到干扰后,仍可提供可靠的航位信息,具有较强的实用性,以及还为后续多传感器定位算法的精度与适用性提供了保障。The technical solution of the embodiment of the present application determines the initial phase difference of the current vehicle; corrects the first left rear wheel pulse number or the first right rear wheel pulse number at the current moment based on the initial phase difference; based on the corrected first left rear wheel pulse number The number of pulses and the number of first right rear wheel pulses predict the position information of the current vehicle at the current moment. The above technical solution corrects the left rear wheel pulse number and the right rear wheel pulse number through the initial phase difference, and predicts the current moment position information based on the corrected left rear wheel pulse number and right rear wheel pulse number. Compared with related technologies, it can Improve flight position prediction accuracy. In addition, the technical solution provided by the embodiments of the present application does not need to rely on other reference sensors. When other positioning sensors are interfered, it can still provide reliable position information, has strong practicability, and also provides a basis for subsequent multi-sensor positioning algorithms. The accuracy and applicability are guaranteed.
图4为本申请实施例提供的一种航位预测装置的结构示意图。如图4所示,该装置包括:初相差确定模块401、修正模块402以及预测模块403。Figure 4 is a schematic structural diagram of a flight position prediction device provided by an embodiment of the present application. As shown in Figure 4, the device includes: an initial phase difference determination module 401, a correction module 402 and a prediction module 403.
初相差确定模块,用于确定当前车辆的初相差;The initial phase difference determination module is used to determine the initial phase difference of the current vehicle;
修正模块,用于基于所述初相差对当前时刻的第一左后轮脉冲数或第一右后轮脉冲数进行修正;A correction module configured to correct the first left rear wheel pulse number or the first right rear wheel pulse number at the current moment based on the initial phase difference;
预测模块,用于基于修正后的第一左后轮脉冲数和所述第一右后轮脉冲数预测所述当前车辆在所述当前时刻的航位信息。A prediction module configured to predict the position information of the current vehicle at the current moment based on the corrected first left rear wheel pulse number and the first right rear wheel pulse number.
本申请实施例的技术方案,通过初相差确定模块确定当前车辆的初相差;通过修正模块基于所述初相差对当前时刻的第一左后轮脉冲数或第一右后轮脉冲数进行修正;通过预测模块基于修正后的第一左后轮脉冲数和所述第一右后轮脉冲数预测所述当前车辆在所述当前时刻的航位信息。上述技术方案,通过初相差修正左后轮脉冲数和右后轮脉冲数,基于修正后的左后轮脉冲数 和右后轮脉冲数预测当前时刻航位信息的方案,相比相关技术,可提高航位预测精度。The technical solution of the embodiment of the present application determines the initial phase difference of the current vehicle through the initial phase difference determination module; and uses the correction module to correct the first left rear wheel pulse number or the first right rear wheel pulse number at the current moment based on the initial phase difference; The prediction module predicts the position information of the current vehicle at the current moment based on the corrected first left rear wheel pulse number and the first right rear wheel pulse number. The above technical solution corrects the left rear wheel pulse number and the right rear wheel pulse number through the initial phase difference, based on the corrected left rear wheel pulse number The scheme of predicting the current moment's dead position information based on the pulse number of the right rear wheel can improve the dead position prediction accuracy compared with related technologies.
可选的,初相差确定模块具体用于:控制所述当前车辆从静止到启动以直行的方式行驶设定时长;获取所述设定时长内多帧分别对应的左后轮脉冲数和右后轮脉冲数;计算每帧的左后轮和右后轮脉冲数差值;对多帧的所述左后轮和右后轮脉冲数差值求取平均值,获得所述当前车辆的初相差。Optionally, the initial phase difference determination module is specifically used to: control the current vehicle to drive in a straight direction from standstill to start for a set duration; obtain the left rear wheel pulse number and right rear wheel pulse number corresponding to multiple frames within the set duration. The number of wheel pulses; calculate the difference in pulse numbers between the left rear wheel and the right rear wheel in each frame; average the difference in pulse numbers between the left rear wheel and the right rear wheel in multiple frames to obtain the initial phase difference of the current vehicle .
可选的,修正模块具体用于:获取上一时刻的第二左后轮脉冲数和第二右后轮脉冲数;确定所述第一左后轮脉冲数和所述第二左后轮脉冲数的差值,确定为左后轮脉冲差值;确定所述第一右后轮脉冲数和所述第二右后轮脉冲数的差值,确定为右后轮脉冲差值;若所述初相差落入第一设定区间,则根据所述右后轮脉冲差值对所述第一左后轮脉冲数进行修正;若所述初相差落入第二设定区间,则根据所述左后轮脉冲差值对所述第一右后轮脉冲数进行修正。Optionally, the correction module is specifically configured to: obtain the second left rear wheel pulse number and the second right rear wheel pulse number at the previous moment; determine the first left rear wheel pulse number and the second left rear wheel pulse. The difference between the number of pulses is determined as the left rear wheel pulse difference; the difference between the first right rear wheel pulse number and the second right rear wheel pulse number is determined as the right rear wheel pulse difference; if the If the initial phase difference falls into the first set interval, the first left rear wheel pulse number is corrected according to the right rear wheel pulse difference; if the initial phase difference falls into the second set interval, the first left rear wheel pulse number is corrected according to the right rear wheel pulse difference value. The left rear wheel pulse difference corrects the first right rear wheel pulse number.
可选的,修正模块还用于:判断所述当前车辆是否直行,若是直行,则将所述第二左后轮脉冲数与所述右后轮脉冲差值进行累加,获得修正后的第一左后轮脉冲数。Optionally, the correction module is also used to determine whether the current vehicle is going straight. If it is going straight, then accumulate the difference between the second left rear wheel pulse number and the right rear wheel pulse to obtain the corrected first Left rear wheel pulse number.
可选的,修正模块还用于:判断所述当前车辆是否直行,若是直行,则将所述第二右后轮脉冲数与所述左后轮脉冲差值进行累加,获得修正后的第一右后轮脉冲数。Optionally, the correction module is also used to determine whether the current vehicle is going straight. If it is going straight, then accumulate the difference between the second right rear wheel pulse number and the left rear wheel pulse to obtain the corrected first Right rear wheel pulse number.
可选的,修正模块还用于:根据所述左后轮脉冲差值和所述右后轮脉冲差值确定当前时刻的行驶角度;根据所述行驶角度判断所述当前车辆是否直行。Optionally, the correction module is also configured to: determine the driving angle at the current moment based on the left rear wheel pulse difference and the right rear wheel pulse difference; and determine whether the current vehicle is going straight based on the driving angle.
可选的,所述航位信息包括行驶角度和位置坐标;可选的,预测模块具体用于:基于修正后的第一左后轮脉冲数和所述第一右后轮脉冲数确定行驶距离和方位角变化量;基于所述方位角变化量及上一时刻的行驶角度确定当前时刻修正后的行驶角度;根据所述行驶距离、方位角变化量、上一时刻的行驶角度及上一时刻的位置坐标确定当前时刻的位置坐标。Optionally, the flight position information includes driving angle and position coordinates; optionally, the prediction module is specifically configured to: determine the driving distance based on the corrected first left rear wheel pulse number and the first right rear wheel pulse number. and the azimuth angle change; determine the corrected driving angle at the current moment based on the azimuth angle change and the driving angle at the previous moment; based on the driving distance, the azimuth angle change, the driving angle at the previous moment and the previous moment The position coordinates determine the position coordinates at the current moment.
本申请实施例所提供的航位预测装置可执行本申请任意实施例所提供的航位预测方法,具备执行方法相应的功能模块和有益效果。The flight position prediction device provided by the embodiments of this application can execute the flight position prediction method provided by any embodiment of this application, and has functional modules and beneficial effects corresponding to the execution method.
图5示出了可以用来实施本申请的实施例的电子设备10的结构示意图。电子设备旨在表示各种形式的数字计算机,诸如,膝上型计算机、台式计算机、工作台、个人数字助理、服务器、刀片式服务器、大型计算机、和其它 适合的计算机。电子设备还可以表示各种形式的移动装置,诸如,个人数字处理、蜂窝电话、智能电话、可穿戴设备(如头盔、眼镜、手表等)和其它类似的计算装置。本文所示的部件、它们的连接和关系、以及它们的功能仅仅作为示例,并且不意在限制本文中描述的和/或者要求的本申请的实现。FIG. 5 shows a schematic structural diagram of an electronic device 10 that can be used to implement embodiments of the present application. Electronic devices are intended to mean various forms of digital computers, such as laptops, desktop computers, workstations, personal digital assistants, servers, blade servers, mainframe computers, and others suitable computer. Electronic devices may also represent various forms of mobile devices, such as personal digital assistants, cellular phones, smart phones, wearable devices (eg, helmets, glasses, watches, etc.), and other similar computing devices. The components shown herein, their connections and relationships, and their functions are examples only and are not intended to limit the implementation of the present application as described and/or claimed herein.
如图5所示,电子设备10包括至少一个处理器11,以及与至少一个处理器11通信连接的存储器,如只读存储器(Read-Only Memory,ROM)12、随机访问存储器(Random Access Memory,RAM)13等,其中,存储器存储有可被至少一个处理器执行的计算机程序,处理器11可以根据存储在只读存储器(ROM)12中的计算机程序或者从存储单元18加载到随机访问存储器(RAM)13中的计算机程序,来执行各种适当的动作和处理。在RAM 13中,还可存储电子设备10操作所需的各种程序和数据。处理器11、ROM 12以及RAM 13通过总线14彼此相连。输入/输出(Input/Output,I/O)接口15也连接至总线14。As shown in Figure 5, the electronic device 10 includes at least one processor 11, and a memory communicatively connected to the at least one processor 11, such as a read-only memory (Read-Only Memory, ROM) 12, a random access memory (Random Access Memory, RAM) 13, etc., wherein the memory stores a computer program that can be executed by at least one processor, and the processor 11 can be loaded into the random access memory (RAM) according to the computer program stored in the read-only memory (ROM) 12 or from the storage unit 18. A computer program in RAM) 13 to perform various appropriate actions and processes. In the RAM 13, various programs and data required for the operation of the electronic device 10 can also be stored. The processor 11, the ROM 12 and the RAM 13 are connected to each other via the bus 14. An input/output (I/O) interface 15 is also connected to the bus 14 .
电子设备10中的多个部件连接至I/O接口15,包括:输入单元16,例如键盘、鼠标等;输出单元17,例如各种类型的显示器、扬声器等;存储单元18,例如磁盘、光盘等;以及通信单元19,例如网卡、调制解调器、无线通信收发机等。通信单元19允许电子设备10通过诸如因特网的计算机网络和/或各种电信网络与其他设备交换信息/数据。Multiple components in the electronic device 10 are connected to the I/O interface 15, including: an input unit 16, such as a keyboard, a mouse, etc.; an output unit 17, such as various types of displays, speakers, etc.; a storage unit 18, such as a magnetic disk, an optical disk, etc. etc.; and communication unit 19, such as network card, modem, wireless communication transceiver, etc. The communication unit 19 allows the electronic device 10 to exchange information/data with other devices through computer networks such as the Internet and/or various telecommunications networks.
处理器11可以是各种具有处理和计算能力的通用和/或专用处理组件。处理器11的一些示例包括但不限于中央处理单元(Central Processing Unit,CPU)、图形处理单元(Graphics Processing Unit,GPU)、各种专用的人工智能(Artificial Intelligence,AI)计算芯片、各种运行机器学习模型算法的处理器、数字信号处理器(Digital Signal Processor,DSP)、以及任何适当的处理器、控制器、微控制器等。处理器11执行上文所描述的各个方法和处理,例如方法航位预测。Processor 11 may be a variety of general and/or special purpose processing components having processing and computing capabilities. Some examples of the processor 11 include, but are not limited to, a central processing unit (Central Processing Unit, CPU), a graphics processing unit (Graphics Processing Unit, GPU), various dedicated artificial intelligence (Artificial Intelligence, AI) computing chips, various running Machine learning model algorithm processor, digital signal processor (Digital Signal Processor, DSP), and any appropriate processor, controller, microcontroller, etc. The processor 11 performs various methods and processes described above, such as method position prediction.
在一些实施例中,方法航位预测可被实现为计算机程序,其被有形地包含于计算机可读存储介质,例如存储单元18。在一些实施例中,计算机程序的部分或者全部可以经由ROM 12和/或通信单元19而被载入和/或安装到电子设备10上。当计算机程序加载到RAM 13并由处理器11执行时,可以执行上文描述的方法航位预测的一个或多个步骤。备选地,在其他实施例中,处理器11可以通过其他任何适当的方式(例如,借助于固件)而被配置为执行方法航位预测。 In some embodiments, the method dead position prediction may be implemented as a computer program that is tangibly embodied in a computer-readable storage medium, such as the storage unit 18 . In some embodiments, part or all of the computer program may be loaded and/or installed onto the electronic device 10 via the ROM 12 and/or the communication unit 19 . When the computer program is loaded into the RAM 13 and executed by the processor 11, one or more steps of the dead prediction method described above may be performed. Alternatively, in other embodiments, processor 11 may be configured to perform method position prediction in any other suitable manner (eg, by means of firmware).
本文中以上描述的系统和技术的各种实施方式可以在数字电子电路系统、集成电路系统、场可编程门阵列(Field Programmable Gate Array,FPGA)、专用集成电路(Application Specific Integrated Circuit,ASIC)、专用标准产品(Application Specific Standard Product,ASSP)、芯片上系统的系统(System on Chip,SOC)、负载可编程逻辑设备(Complex Programmable Logic Device,CPLD)、计算机硬件、固件、软件、和/或它们的组合中实现。这些各种实施方式可以包括:实施在一个或者多个计算机程序中,该一个或者多个计算机程序可在包括至少一个可编程处理器的可编程系统上执行和/或解释,该可编程处理器可以是专用或者通用可编程处理器,可以从存储系统、至少一个输入装置、和至少一个输出装置接收数据和指令,并且将数据和指令传输至该存储系统、该至少一个输入装置、和该至少一个输出装置。Various implementations of the systems and techniques described above may be implemented in digital electronic circuit systems, integrated circuit systems, Field Programmable Gate Arrays (FPGAs), Application Specific Integrated Circuits (ASICs), Application Specific Standard Product (ASSP), System on Chip (SOC), Complex Programmable Logic Device (CPLD), computer hardware, firmware, software, and/or they implemented in a combination. These various embodiments may include implementation in one or more computer programs executable and/or interpreted on a programmable system including at least one programmable processor, the programmable processor The processor, which may be a special purpose or general purpose programmable processor, may receive data and instructions from a storage system, at least one input device, and at least one output device, and transmit data and instructions to the storage system, the at least one input device, and the at least one output device. An output device.
用于实施本申请的方法的计算机程序可以采用一个或多个编程语言的任何组合来编写。这些计算机程序可以提供给通用计算机、专用计算机或其他可编程数据处理装置的处理器,使得计算机程序当由处理器执行时使流程图和/或框图中所规定的功能/操作被实施。计算机程序可以完全在机器上执行、部分地在机器上执行,作为独立软件包部分地在机器上执行且部分地在远程机器上执行或完全在远程机器或服务器上执行。Computer programs for implementing the methods of the present application may be written in any combination of one or more programming languages. These computer programs may be provided to a processor of a general-purpose computer, a special-purpose computer, or other programmable data processing device, such that the computer program, when executed by the processor, causes the functions/operations specified in the flowcharts and/or block diagrams to be implemented. A computer program may execute entirely on the machine, partly on the machine, as a stand-alone software package, partly on the machine and partly on a remote machine or entirely on the remote machine or server.
在本申请的上下文中,计算机可读存储介质可以是有形的介质,其可以包含或存储以供指令执行系统、装置或设备使用或与指令执行系统、装置或设备结合地使用的计算机程序。计算机可读存储介质可以包括但不限于电子的、磁性的、光学的、电磁的、红外的、或半导体系统、装置或设备,或者上述内容的任何合适组合。备选地,计算机可读存储介质可以是机器可读信号介质。机器可读存储介质的更具体示例会包括基于一个或多个线的电气连接、便携式计算机盘、硬盘、随机存取存储器(RAM)、只读存储器(ROM)、可擦除可编程只读存储器(Erasable Programmable Read-Only Memory,EPROM)或快闪存储器、光纤、便捷式紧凑盘只读存储器(Compact Disc Read-Only Memory,CD-ROM)、光学储存设备、磁储存设备、或上述内容的任何合适组合。In the context of this application, a computer-readable storage medium may be a tangible medium that may contain or store a computer program for use by or in connection with an instruction execution system, apparatus, or device. Computer-readable storage media may include, but are not limited to, electronic, magnetic, optical, electromagnetic, infrared, or semiconductor systems, devices or devices, or any suitable combination of the foregoing. Alternatively, the computer-readable storage medium may be a machine-readable signal medium. More specific examples of machine-readable storage media would include one or more wire-based electrical connections, laptop disks, hard drives, random access memory (RAM), 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 device, magnetic storage device, or any of the above Suitable combination.
为了提供与用户的交互,可以在电子设备上实施此处描述的系统和技术,该电子设备具有:用于向用户显示信息的显示装置(例如,阴极射线管(Cathode Ray Tube,CRT)或者液晶显示器(Liquid Crystal Display,LCD)监视器);以及键盘和指向装置(例如,鼠标或者轨迹球),用户可以通过 该键盘和该指向装置来将输入提供给电子设备。其它种类的装置还可以用于提供与用户的交互;例如,提供给用户的反馈可以是任何形式的传感反馈(例如,视觉反馈、听觉反馈、或者触觉反馈);并且可以用任何形式(包括声输入、语音输入或者、触觉输入)来接收来自用户的输入。To provide interaction with a user, the systems and techniques described herein may be implemented on an electronic device having a display device (eg, a cathode ray tube (CRT) or a liquid crystal) for displaying information to the user. (Liquid Crystal Display, LCD monitor); and a keyboard and pointing device (such as a mouse or trackball) through which the user can The keyboard and the pointing device are used to provide input to the electronic device. Other kinds of devices may also be used to provide interaction with the user; for example, the feedback provided to the user may be any form of sensory feedback (e.g., visual feedback, auditory feedback, or tactile feedback); and may be provided in any form, including Acoustic input, voice input or tactile input) to receive input from the user.
可以将此处描述的系统和技术实施在包括后台部件的计算系统(例如,作为数据服务器)、或者包括中间件部件的计算系统(例如,应用服务器)、或者包括前端部件的计算系统(例如,具有图形用户界面或者网络浏览器的用户计算机,用户可以通过该图形用户界面或者该网络浏览器来与此处描述的系统和技术的实施方式交互)、或者包括这种后台部件、中间件部件、或者前端部件的任何组合的计算系统中。可以通过任何形式或者介质的数字数据通信(例如,通信网络)来将系统的部件相互连接。通信网络的示例包括:局域网(Local Area Network,LAN)、广域网(Wide Area Network,WAN)、区块链网络和互联网。The systems and techniques described herein may be implemented in a computing system that includes back-end components (e.g., as a data server), or a computing system that includes middleware components (e.g., an application server), or a computing system that includes front-end components (e.g., A user's computer having a graphical user interface or web browser through which the user can interact with implementations of the systems and technologies described herein), or including such backend components, middleware components, or any combination of front-end components in a computing system. The components of the system may be interconnected by any form or medium of digital data communication (eg, a communications network). Examples of communication networks include: Local Area Network (LAN), Wide Area Network (WAN), blockchain network, and the Internet.
计算系统可以包括客户端和服务器。客户端和服务器一般远离彼此并且通常通过通信网络进行交互。通过在相应的计算机上运行并且彼此具有客户端-服务器关系的计算机程序来产生客户端和服务器的关系。服务器可以是云服务器,又称为云计算服务器或云主机,是云计算服务体系中的一项主机产品,以解决了传统物理主机与虚拟专用服务器(Virtual Private Server,VPS)服务中,存在的管理难度大,业务扩展性弱的缺陷。Computing systems may include clients and servers. Clients and servers are generally remote from each other and typically interact over a communications network. The relationship of client and server is created by computer programs running on corresponding computers and having a client-server relationship with each other. The server can be a cloud server, also known as cloud computing server or cloud host. It is a host product in the cloud computing service system to solve the problems that exist in traditional physical host and virtual private server (VPS) services. It has the disadvantages of difficult management and weak business scalability.
应该理解,可以使用上面所示的各种形式的流程,重新排序、增加或删除步骤。例如,本申请中记载的各步骤可以并行地执行也可以顺序地执行也可以不同的次序执行,只要能够实现本申请的技术方案所期望的结果,本文在此不进行限制。 It should be understood that various forms of the process shown above may be used, with steps reordered, added or deleted. For example, each step described in this application can be executed in parallel, sequentially, or in a different order. As long as the desired results of the technical solution of this application can be achieved, there is no limitation here.

Claims (10)

  1. 一种航位预测方法,包括:A flight position prediction method, including:
    确定当前车辆的初相差;Determine the initial phase difference of the current vehicle;
    基于所述初相差对当前时刻的第一左后轮脉冲数或第一右后轮脉冲数进行修正;Modify the first left rear wheel pulse number or the first right rear wheel pulse number at the current moment based on the initial phase difference;
    基于修正后的第一左后轮脉冲数和所述第一右后轮脉冲数预测所述当前车辆在所述当前时刻的航位信息。The position information of the current vehicle at the current moment is predicted based on the corrected first left rear wheel pulse number and the first right rear wheel pulse number.
  2. 根据权利要求1所述的方法,其中,确定当前车辆的初相差,包括:The method according to claim 1, wherein determining the initial phase difference of the current vehicle includes:
    控制所述当前车辆从静止到启动以直行的方式行驶设定时长;Control the current vehicle to drive in a straight direction for a set duration from stationary to starting;
    获取所述设定时长内多帧分别对应的左后轮脉冲数和右后轮脉冲数;Obtain the number of left rear wheel pulses and the number of right rear wheel pulses corresponding to multiple frames within the set time period;
    计算每帧的左后轮和右后轮脉冲数差值;Calculate the difference between the pulse numbers of the left rear wheel and the right rear wheel in each frame;
    对多帧的所述左后轮和右后轮脉冲数差值求取平均值,获得所述当前车辆的初相差。The difference in pulse numbers of the left rear wheel and the right rear wheel in multiple frames is averaged to obtain the initial phase difference of the current vehicle.
  3. 根据权利要求1所述的方法,其中,基于所述初相差对当前时刻的第一左后轮脉冲数或第一右后轮脉冲数进行修正,包括:The method of claim 1, wherein correcting the first left rear wheel pulse number or the first right rear wheel pulse number at the current moment based on the initial phase difference includes:
    获取上一时刻的第二左后轮脉冲数和第二右后轮脉冲数;Obtain the second left rear wheel pulse number and the second right rear wheel pulse number at the previous moment;
    确定所述第一左后轮脉冲数和所述第二左后轮脉冲数的差值,确定为左后轮脉冲差值;Determine the difference between the first left rear wheel pulse number and the second left rear wheel pulse number, and determine it as the left rear wheel pulse difference;
    确定所述第一右后轮脉冲数和所述第二右后轮脉冲数的差值,确定为右后轮脉冲差值;Determine the difference between the first right rear wheel pulse number and the second right rear wheel pulse number, and determine it as the right rear wheel pulse difference;
    若所述初相差落入第一设定区间,则根据所述右后轮脉冲差值对所述第一左后轮脉冲数进行修正;If the initial phase difference falls within the first set interval, the first left rear wheel pulse number is corrected according to the right rear wheel pulse difference;
    若所述初相差落入第二设定区间,则根据所述左后轮脉冲差值对所述第一右后轮脉冲数进行修正。If the initial phase difference falls within the second set interval, the first right rear wheel pulse number is corrected according to the left rear wheel pulse difference.
  4. 根据权利要求3所述的方法,其中,根据所述右后轮脉冲差值对所述第一左后轮脉冲数进行修正,包括:The method of claim 3, wherein correcting the first left rear wheel pulse number according to the right rear wheel pulse difference includes:
    判断所述当前车辆是否直行,若是直行,则将所述第二左后轮脉冲数与所述右后轮脉冲差值进行累加,获得修正后的第一左后轮脉冲数。It is determined whether the current vehicle is going straight. If it is going straight, the difference between the second left rear wheel pulse number and the right rear wheel pulse is accumulated to obtain the corrected first left rear wheel pulse number.
  5. 根据权利要求3所述的方法,其中,根据所述左后轮脉冲差值对所述第一右后轮脉冲数进行修正,包括:The method of claim 3, wherein correcting the first right rear wheel pulse number according to the left rear wheel pulse difference includes:
    判断所述当前车辆是否直行,若是直行,则将所述第二右后轮脉冲数与所述左后轮脉冲差值进行累加,获得修正后的第一右后轮脉冲数。It is determined whether the current vehicle is going straight. If it is going straight, the difference between the second right rear wheel pulse number and the left rear wheel pulse is accumulated to obtain the corrected first right rear wheel pulse number.
  6. 根据权利要求4或5所述的方法,其中,判断所述当前车辆是否直行, 包括:The method according to claim 4 or 5, wherein it is determined whether the current vehicle is going straight, include:
    根据所述左后轮脉冲差值和所述右后轮脉冲差值确定当前时刻的行驶角度;Determine the driving angle at the current moment based on the left rear wheel pulse difference and the right rear wheel pulse difference;
    根据所述行驶角度判断所述当前车辆是否直行。Determine whether the current vehicle is going straight based on the driving angle.
  7. 根据权利要求1所述的方法,其中,所述航位信息包括行驶角度和位置坐标;基于修正后的第一左后轮脉冲数和所述第一右后轮脉冲数预测所述当前车辆在所述当前时刻的航位信息,包括:The method according to claim 1, wherein the position information includes a driving angle and a position coordinate; and the current vehicle is predicted based on the corrected first left rear wheel pulse number and the first right rear wheel pulse number. The flight position information at the current moment includes:
    基于修正后的第一左后轮脉冲数和所述第一右后轮脉冲数确定行驶距离和方位角变化量;Determine the travel distance and azimuth angle change based on the corrected first left rear wheel pulse number and the first right rear wheel pulse number;
    基于所述方位角变化量及上一时刻的行驶角度确定当前时刻修正后的行驶角度;Determine the corrected driving angle at the current moment based on the azimuth angle change and the driving angle at the previous moment;
    根据所述行驶距离、方位角变化量、上一时刻的行驶角度及上一时刻的位置坐标确定当前时刻的位置坐标。The position coordinates at the current moment are determined based on the driving distance, the azimuth angle change, the driving angle at the previous moment, and the position coordinates at the previous moment.
  8. 一种航位预测装置,包括:A flight position prediction device, including:
    初相差确定模块,设置为确定当前车辆的初相差;The initial phase difference determination module is configured to determine the initial phase difference of the current vehicle;
    修正模块,设置为基于所述初相差对当前时刻的第一左后轮脉冲数或第一右后轮脉冲数进行修正;A correction module configured to correct the first left rear wheel pulse number or the first right rear wheel pulse number at the current moment based on the initial phase difference;
    预测模块,设置为基于修正后的第一左后轮脉冲数和所述第一右后轮脉冲数预测所述当前车辆在所述当前时刻的航位信息。A prediction module configured to predict the position information of the current vehicle at the current moment based on the corrected first left rear wheel pulse number and the first right rear wheel pulse number.
  9. 一种电子设备,包括:An electronic device including:
    至少一个处理器;以及at least one processor; and
    与所述至少一个处理器通信连接的存储器;其中,a memory communicatively connected to the at least one processor; wherein,
    所述存储器存储有可被所述至少一个处理器执行的计算机程序,所述计算机程序被所述至少一个处理器执行,以使所述至少一个处理器能够执行权利要求1-7中任一项所述的一种航位预测方法。The memory stores a computer program executable by the at least one processor, the computer program being executed by the at least one processor, so that the at least one processor can execute any one of claims 1-7 A flight position prediction method.
  10. 一种计算机可读存储介质,所述计算机可读存储介质存储有计算机指令,所述计算机指令用于使处理器执行时实现权利要求1-7中任一项所述的一种航位预测方法。 A computer-readable storage medium, the computer-readable storage medium stores computer instructions, and the computer instructions are used to implement a flight position prediction method according to any one of claims 1-7 when executed by a processor. .
PCT/CN2023/072286 2022-07-04 2023-01-16 Dead reckoning method and apparatus, device, and medium WO2024007569A1 (en)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
CN202210781542.1A CN115752426A (en) 2022-07-04 2022-07-04 Navigation position prediction method, device, equipment and medium
CN202210781542.1 2022-07-04

Publications (1)

Publication Number Publication Date
WO2024007569A1 true WO2024007569A1 (en) 2024-01-11

Family

ID=85350055

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2023/072286 WO2024007569A1 (en) 2022-07-04 2023-01-16 Dead reckoning method and apparatus, device, and medium

Country Status (2)

Country Link
CN (1) CN115752426A (en)
WO (1) WO2024007569A1 (en)

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5402365A (en) * 1992-10-28 1995-03-28 Motorola, Inc. Differential odometer dynamic calibration method and apparatus therefor
JP2003207520A (en) * 2002-01-16 2003-07-25 Nissan Motor Co Ltd Wheel speed pulse correcting device and method
JP2012081905A (en) * 2010-10-13 2012-04-26 Equos Research Co Ltd Travel control device
JP2015075337A (en) * 2013-10-04 2015-04-20 本田技研工業株式会社 Movable body position calculation device and method
CN110709302A (en) * 2017-06-13 2020-01-17 日立汽车系统株式会社 Vehicle control device
CN111780756A (en) * 2020-07-20 2020-10-16 北京百度网讯科技有限公司 Vehicle dead reckoning method, device, equipment and storage medium
US20210078586A1 (en) * 2018-03-28 2021-03-18 Hitachi Automotive Systems, Ltd. Vehicle control device

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5402365A (en) * 1992-10-28 1995-03-28 Motorola, Inc. Differential odometer dynamic calibration method and apparatus therefor
JP2003207520A (en) * 2002-01-16 2003-07-25 Nissan Motor Co Ltd Wheel speed pulse correcting device and method
JP2012081905A (en) * 2010-10-13 2012-04-26 Equos Research Co Ltd Travel control device
JP2015075337A (en) * 2013-10-04 2015-04-20 本田技研工業株式会社 Movable body position calculation device and method
CN110709302A (en) * 2017-06-13 2020-01-17 日立汽车系统株式会社 Vehicle control device
US20210078586A1 (en) * 2018-03-28 2021-03-18 Hitachi Automotive Systems, Ltd. Vehicle control device
CN111780756A (en) * 2020-07-20 2020-10-16 北京百度网讯科技有限公司 Vehicle dead reckoning method, device, equipment and storage medium

Also Published As

Publication number Publication date
CN115752426A (en) 2023-03-07

Similar Documents

Publication Publication Date Title
JP7299261B2 (en) Vehicle dead reckoning method, apparatus, device, storage medium, and program
CN114572240B (en) Vehicle running control method, device, vehicle, electronic device and storage medium
WO2023221963A1 (en) Following error determination method and apparatus, device, and storage medium
WO2024051661A1 (en) Pavement unevenness classification and identification method and apparatus, vehicle, and storage medium
WO2023036286A1 (en) Slope estimation method and apparatus, electronic device, and storage medium
WO2022247203A1 (en) Method and apparatus for controlling autonomous vehicle, device, and storage medium
CN113044042B (en) Vehicle predicted lane change image display method and device, electronic equipment and readable medium
WO2024066943A1 (en) Intelligent-parking vehicle positioning method applied to vehicle
CN112051864A (en) Method, device, equipment and readable medium for tracking moving target track
WO2023005742A1 (en) Traveling trajectory control method and apparatus applied to unmanned vehicle, and device and medium
WO2024007569A1 (en) Dead reckoning method and apparatus, device, and medium
WO2022105361A1 (en) Vehicle control method and apparatus, computer-readable storage medium, and electronic device
WO2024001758A1 (en) Valet parking speed determination method and apparatus, and device and medium
WO2023231833A1 (en) Creep control method and apparatus, electronic device and storage medium
WO2023241556A1 (en) Parking control method and apparatus, and device and storage medium
WO2024045741A1 (en) Vehicle yaw angle prediction method and device and computer readable storage medium
WO2024016892A1 (en) Method and apparatus for external-parameter calibration of sensors, and electronic device
CN117261880A (en) Vehicle control method, device, equipment and storage medium
CN116772858A (en) Vehicle positioning method, device, positioning equipment and storage medium
JP7158109B2 (en) Method and apparatus for calibrating forward axis of vehicle accelerometer
CN115792985A (en) Vehicle positioning method and device, electronic equipment, storage medium and vehicle
CN114834529A (en) Vehicle control method, device, equipment and medium
WO2024021541A1 (en) Target tracking method and apparatus, device, and medium
CN114620074A (en) Vehicle control method, device, electronic device and storage medium
CN109900294A (en) Vision inertia odometer based on hardware accelerator

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: 23834355

Country of ref document: EP

Kind code of ref document: A1