CN103632558A - Bionic swarm intelligence-based real-time positioning navigation and motion control method and system for moving vehicle - Google Patents

Bionic swarm intelligence-based real-time positioning navigation and motion control method and system for moving vehicle Download PDF

Info

Publication number
CN103632558A
CN103632558A CN201310577959.7A CN201310577959A CN103632558A CN 103632558 A CN103632558 A CN 103632558A CN 201310577959 A CN201310577959 A CN 201310577959A CN 103632558 A CN103632558 A CN 103632558A
Authority
CN
China
Prior art keywords
vehicle
module
information
road
data processing
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Pending
Application number
CN201310577959.7A
Other languages
Chinese (zh)
Inventor
曲仕茹
来磊
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Northwestern Polytechnical University
Original Assignee
Northwestern Polytechnical University
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 Northwestern Polytechnical University filed Critical Northwestern Polytechnical University
Priority to CN201310577959.7A priority Critical patent/CN103632558A/en
Publication of CN103632558A publication Critical patent/CN103632558A/en
Pending legal-status Critical Current

Links

Images

Abstract

The invention discloses a bionic swarm intelligence-based real-time positioning navigation and motion control method for a moving vehicle and is used for solving the technical problem of lower reliability of the existing real-time positioning navigation and motion control method for the moving vehicle. The technical scheme is that the method comprises the steps of firstly selecting the vehicle and information nodes of known coordinates in a complex road as the positioning reference nodes, converting the equation set positioning and solving problem into the extreme value optimizing problem, and adopting a bionic swarm algorithm to solve the positioning coordinates. For the control on driving among multiple vehicles, a bionic swarm motion model is established to control the motion among the vehicles by establishing the bionic swarm behaviors, and the controllability on the real-time positioning and navigation and the motion control for the moving vehicle is improved. The real-time positioning navigation and motion control system for the moving vehicle is formed by a vehicle-mounted terminal module, a road information node module and a road traffic control center module. The three modules cooperatively work to realize the real-time positioning navigation and motion control on the moving vehicle.

Description

The real-time location navigation of moving vehicle, motion control method and system based on bionical swarm intelligence
Technical field
The present invention relates to the real-time location navigation of a kind of moving vehicle based on bionical swarm intelligence, motion control method, also relate to the real-time location navigation of a kind of moving vehicle based on bionical swarm intelligence, kinetic control system.
Background technology
Vehicle automatic positioning technology is the gordian technique that in intelligent transportation system, various fields all relates to.At present, the vehicle positioning technology of main practical application is mainly GPS location, and the combined orientation technology based on GPS.
Document 1 " patent announcement number is the Chinese utility model patent of CN201741289U " discloses a kind of vehicle locating device, and this locating device is mainly that GPS module has been installed, and vehicle is located it in real time by receiving gps signal.
Document 2 " Li Guifang; the vehicle GPS/DR integrated navigation research based on UPF algorithm; < < science and technology and engineering > > 2012.11, p8143-8146. " discloses the Combinated navigation method of a kind of GPS and DR fusion.The method is usingd positioning signal that current statistical model obtains as the state equation of system, the GPS device of vehicle mounting of usining as the measuring value of system, and vehicle is located in real time.
In disclosed vehicle positioning method, its essence is to adopt to receive the gps satellite navigate mode that in space, a plurality of satellite-signals position above, is requisite ingredient in its positioning system from the satellite-signal in space, high-altitude, and its defect is:
(1) there is the susceptible problem of reliability in gps signal, is subject to the interference of external environment larger, and the environment such as the skyscraper in city, tunnel all can affect accuracy and the reliability of vehicle location; The satellite-signal transmission of long distance is very easily subject to the impact of physical environment and artificial interference, and while sailing long tunnel into as vehicle, dropout can cause the temporary transient inefficacy of location; Satellite became striking target of enemy and also can cause positioning system forever to paralyse wartime.
(2) vehicle only obtains the position coordinates of self, and do not have to consider and other neighbours' vehicles between position relationship, thereby the coordinating and unifying of travelling between lower shortage vehicle colony at the crowded road environment of complexity, make running efficiency and the deterioration of safety of vehicle in road.
As can be seen from the above the locating information that open source literature is difficult to provide accurately, reliability is high, also lacks the function of coordinating a plurality of vehicle movements simultaneously.
Summary of the invention
In order to overcome the lower deficiency of existing vehicle GPS and integrated positioning system thereof reliability in urban environment, the invention provides the real-time location navigation of a kind of moving vehicle based on bionical swarm intelligence, motion control method.First the method chooses the vehicle of known coordinate in complicated road and information node as position reference node, by the poor positioning equation group of setting up of the relative distance between measuring vehicle and reference mode, to solve again this positioning equation group problem and be converted into extremal optimization problem, and adopt bionical ant colony algorithm to solve the elements of a fix.For travel control method between many vehicles, by setting up biotic population behavior, set up the motion between bionical group movement model control vehicle, can improve the controllability of the real-time location navigation of moving vehicle, motion control.
The present invention also provides the real-time location navigation of a kind of moving vehicle based on bionical swarm intelligence, kinetic control system.This system is comprised of vehicle-mounted control terminal module, road information node module and road traffic control center module.Three module cooperative work, can realize the reliable location in real time of moving vehicle, and the control of travelling of the colony between vehicle.
The technical solution adopted for the present invention to solve the technical problems is: the real-time location navigation of a kind of moving vehicle based on bionical swarm intelligence, motion control method, be characterized in comprising the following steps:
Step 1: at moment t, vehicle vehicle adjacent thereto and information node form cordless communication network, and the vehicle of each known location coordinate sends the position coordinates of self in the mode of broadcast transmission by wireless network.
Step 2: vehicle to be positioned receives the location coordinate information of neighbours' vehicle and information node transmission is passed through the relative distance d between electromagnetic wave signal principle time of arrival measurement self and neighbours' vehicle, information node simultaneously i
d i=ct i,i=1,2,…,n (1)
In formula, c is the aerial velocity of propagation of electromagnetic wave signal, t ifor the travel-time of electromagnetic wave signal from vehicle to be positioned to neighbours' vehicle i, n is the number that receives signal.
Choose d ibe worth minimum m vehicle or information node as the position reference node of vehicle to be positioned.
Step 3: the relative distance d between vehicle basis to be positioned and reference mode iset up positioning equation with the position coordinates of reference mode, its positioning equation is expressed as
( x 1 t - x t ) 2 + ( y 1 t - y t ) 2 - ( x 2 t - x t ) 2 + ( y 2 t - y t ) 2 = d 2 - d 1 . . . ( x 1 t - x t ) 2 + ( y 1 t - y t ) 2 - ( x mt - x t ) 2 + ( y mt - y t ) 2 = d m - d 1 - - - ( 2 )
In formula, (x t, y t) be that vehicle to be positioned is at t moment coordinate, (x it, y it) be that reference mode is at t moment position coordinates.
Step 4: the positioning equation of formula (2) is converted into minimizing problem, and its expression formula is
f 1 = [ ( x 1 t - x t ) 2 + ( y 1 t - y t ) 2 - ( x 2 t - x t ) 2 + ( y 2 t - y t ) 2 ] 2 - ( d 2 - d 1 ) 2 = 0 . . . f m = [ ( x 1 t - x t ) 2 + ( y 1 t - y t ) 2 - ( x mt - x t ) 2 + ( y mt - y t ) 2 ] 2 - ( d m - d 1 ) 2 = 0 - - - ( 3 )
f 1 2 + f 2 2 + . . . + f m 2 = 0 - - - ( 4 )
For formula (4) minimal value equation, adopt artificial bee colony intelligent computation method to solve it, the minimum value (x solving t, y t) be the position coordinates of vehicle to be positioned.
Step 5: vehicle to be positioned, in its radius R field, is chosen field in-group neighbours' vehicle, and selection standard is
N it={i:[x t-x it] 2+[y t-y it] 2+[z t-z it] 2≤R 2} (5)
In formula, z ifor the vehicle i positional value on axle in the vertical direction.
Step 6: the direction of motion of vehicle k is the mean value of its neighbours' direction of vehicle movement.
&alpha; kt = 1 n kt - 1 &Sigma; i &Element; Nt &alpha; it - 1 &beta; kt = 1 n kt - 1 &Sigma; i &Element; Nt &beta; it - 1 &gamma; kt = 1 n kt - 1 &Sigma; i &Element; Nt &gamma; it - 1 - - - ( 6 )
In formula, α it, β it, γ itfor vehicle is at the t direction of motion along three axes constantly, n tfor t moment neighbours' vehicle number.
The location formula of vehicle k is:
x kt = x kt - 1 + v k cos &alpha; kt y kt = y kt - 1 + v k cos &beta; kt z kt = z kt - 1 + v k cos &gamma; kt - - - ( 7 )
In formula, v ktravel speed for vehicle k.
Each vehicle is constantly adjusted the position of oneself according to the position equation of formula (7).
The real-time location navigation of moving vehicle based on bionical swarm intelligence, a kinetic control system, be characterized in: comprise vehicle-mounted control terminal module, road information node module and road traffic control center module, transmission of signal between two between three modules.
Vehicle-mounted control terminal module comprises wireless communication module, data processing module, path planning module, data acquisition module, vehicle control module, memory module and display module.Wireless communication module and road information node, other vehicle communications, with reception, transmission information, obtain vehicle location and control required parameter.Data processing module obtains the required parameter in location from wireless communication module, and locating information car-mounted terminal node being received according to algorithm is converted into the accurate location coordinate of vehicle.Data acquisition module receives the signal of measuring from vehicle self speed pickup, rotary angle transmitter, acceleration transducer, and is translated into numerical information to obtain the motion state of self.Path planning module receives the signal from wireless communication module, data acquisition module and data processing module, obtain the position coordinates of Real-time Road environment and vehicle its data and vehicle self, to next driving path constantly of vehicle carry out reasonably, optimization plans.The travel route that vehicle control module RX path planning module is planned, control vehicle speed, turn to and acceleration.Memory module and display module receive and real-time position and the optimal path information showing from data processing module and path planning module.
Road information node module comprises wireless communication module, data processing module and sensor assembly.Sensor assembly is vehicle fleet size, wagon flow speed and visibility information in the road environment of measuring, with analog signal transmission to data processing module.The simulating signal of data processing module autobiography sensor module in future is processed and is translated into the discernible digital signal of processor.Wireless communication module sends to road traffic control center module by the node location from data processing module, road traffic and vehicle speed signal.
Road traffic control center module comprises wireless communication module, data processing module and database module.Wireless communication module is communicated by letter with vehicle-mounted control terminal module with road information node module, receives, sends information of vehicles, terrain vehicle stream information and road geographic information.Data processing module receives the information from wireless communication module, and it is carried out after pre-service, its appointment being stored in database module, need to from database, extract relevant road geographic information according to vehicle-mounted control terminal module simultaneously.The information of vehicle flowrate of database module stores road and the road geographic information for navigating.
The invention has the beneficial effects as follows: the real-time location navigation of moving vehicle based on bionical swarm intelligence, motion control method, first choose the vehicle of known coordinate in complicated road and information node as position reference node, by the poor positioning equation group of setting up of the relative distance between measuring vehicle and reference mode, to solve again this positioning equation group problem and be converted into extremal optimization problem, and adopt bionical ant colony algorithm to solve the elements of a fix.For travel control method between many vehicles, by setting up biotic population behavior, set up bionical group movement model and control the motion between vehicle, improved the controllability of the real-time location navigation of moving vehicle, motion control.The real-time location navigation of moving vehicle based on bionical swarm intelligence, kinetic control system.This system is comprised of vehicle-mounted control terminal module, road information node module and road traffic control center module.Three module cooperative work, have realized the reliable location in real time of moving vehicle, and the control of travelling of the colony between vehicle.
Below in conjunction with the drawings and specific embodiments, describe the present invention in detail.
Accompanying drawing explanation
Fig. 1 is the real-time location navigation of moving vehicle that the present invention is based on bionical swarm intelligence, the process flow diagram of motion control method.
Fig. 2 is the real-time location navigation of moving vehicle that the present invention is based on bionical swarm intelligence, the block scheme of kinetic control system.
Fig. 3 is that in Fig. 2, vehicle-mounted control terminal module forms structural drawing.
Fig. 4 is that in Fig. 2, road information node module forms structural drawing.
Fig. 5 is that in Fig. 2, road traffic control center module forms structural drawing.
Fig. 6 is the schematic diagram of the first-selected embodiment of the present invention.
Embodiment
Following examples are with reference to Fig. 1-6.
Embodiment 1.The present embodiment is described the real-time location navigation of moving vehicle based on bionical swarm intelligence, the step of motion control method in detail:
Step 1: at moment t, vehicle V to be positioned vehicle V1 adjacent thereto, V2, V3, V4, V5, V6 and information node N1 form cordless communication network, the coordinate of vehicle V1, V2, V3, V4, V5, V6 and information node N1 is known, and the position coordinates that sends self in the mode of broadcast transmission by wireless network is to vehicle V.
Step 2: vehicle V to be positioned receives the location coordinate information that neighbours' vehicle V1, V2, V3, V4, V5, V6 and information node N1 send is passed through the distance d between electromagnetic wave signal principle time of arrival measurement self and neighbours' vehicle V1, V2, V3, V4, V5, V6, information node N1 simultaneously v1, d v2, d v3, d v4, d v5, d v6, d n1.
d i=ct i,i=v1,v2,v3,v4,v5,v6,N1 (1)
In formula, c is the aerial velocity of propagation of electromagnetic wave signal, t ifor electromagnetic wave signal is from vehicle to be positioned to neighbours' vehicle or the travel-time of information node i, n is the number that receives signal.
From d v1, d v2, d v3, d v4, d v5, d v6, d n1the m=4 of a middle selected value minimum vehicle or information node are as the position reference node of vehicle to be positioned.In this example, choose V1, V2, V4, N1 as location reference point.
Step 3: according to the relative distance d between vehicle V to be positioned and reference point V1, V2, V4, N1 v1, d v2, d v4, d n1position coordinates (x with reference point v1, y v1), (x v2, y v2), (x v4, y v4), (x n1, y n1) set up positioning equation:
( x v 2 t - x t ) 2 + ( y v 2 t - y t ) 2 - ( x v 1 t - x t ) 2 + ( y v 1 t - y t ) 2 = d v 2 - d v 1 ( x v 3 t - x t ) 2 + ( y v 3 t - y t ) 2 - ( x v 1 t - x t ) 2 + ( y v 1 t - y t ) 2 = d v 3 - d v 1 ( x v 4 t - x t ) 2 + ( y v 4 t - y t ) 2 - ( x v 1 t - x t ) 2 + ( y v 1 t - y t ) 2 = d v 4 - d v 1 ( x N 1 t - x t ) 2 + ( y N 1 t - y t ) 2 - ( x v 1 t - x t ) 2 + ( y v 1 t - y t ) 2 = d N 1 - d v 1 - - - ( 2 )
In formula, (x t, y t) be that vehicle V to be positioned is at t moment coordinate.
Step 4: the positioning equation of formula (2) is converted into minimizing problem:
f 1 = [ ( x v 2 t - x t ) 2 + ( y v 2 t - y t ) 2 - ( x v 1 t - x t ) 2 + ( y v 1 t - y t ) 2 ] 2 - ( d v 2 - d v 1 ) 2 = 0 f 2 = [ ( x v 3 t - x t ) 2 + ( y v 3 t - y t ) 2 - ( x v 1 t - x t ) 2 + ( y v 1 t - y t ) 2 ] 2 - ( d v 3 - d v 1 ) 2 = 0 f 3 = [ ( x v 4 t - x t ) 2 + ( y v 4 t - y t ) 2 - ( x v 1 t - x t ) 2 + ( y v 1 t - y t ) 2 ] 2 - ( d v 4 - d v 1 ) 2 = 0 f 4 = [ ( x N 1 t - x t ) 2 + ( y N 1 t - y t ) 2 - ( x v 1 t - x t ) 2 + ( y v 1 t - y t ) 2 ] 2 - ( d N 1 - d v 1 ) 2 = 0 - - - ( 3 )
f 1 2 + f 2 2 + . . . + f m 2 = 0 - - - ( 4 )
For formula (4) minimal value equation, adopt artificial bee colony intelligent computation method to solve it, the minimum value (x solving t, y t) be the position coordinates of vehicle to be positioned.
Step 5: vehicle to be positioned, in its field, radius R=100, is chosen field in-group neighbours' vehicle, and its selection standard is
N it={i:[x t-x it] 2+[y t-y it] 2+[z t-z it] 2≤R 2} (5)
In formula, z ifor the vehicle i coordinate figure on axle in the vertical direction.Establish vehicle herein in same level, z ibe worth identical.
Step 6: the direction of motion of vehicle k is the mean value of its neighbours' direction of vehicle movement.
&alpha; kt = 1 n kt - 1 &Sigma; i &Element; Nt &alpha; it - 1 &beta; kt = 1 n kt - 1 &Sigma; i &Element; Nt &beta; it - 1 &gamma; kt = 1 n kt - 1 &Sigma; i &Element; Nt &gamma; it - 1 , i = v 1 , v 2 , v 3 , v 4 , v 5 , v 6 - - - ( 6 )
In formula, α it, β it, γ itfor vehicle is at t direction of motion constantly, n tfor t moment neighbours' vehicle number.
The location formula of vehicle k is:
x kt = x kt - 1 + v k cos &alpha; kt y kt = y kt - 1 + v k cos &beta; kt z kt = z kt - 1 + v k cos &gamma; kt - - - ( 7 )
In formula, v ktravel speed for vehicle k.
Each vehicle is constantly adjusted the position of oneself according to the position equation of formula (7).
Embodiment 2.The present embodiment is described the real-time location navigation of moving vehicle based on bionical swarm intelligence, the structure of kinetic control system in detail:
The unified TMS320F2808 chip that adopts of data processing module in structure and path planning module; Wireless communication module adopts NRF905 chip; Memory module adopts W25X16AVSIG chip; Sensor assembly comprises ccd sensor TSL1401CL, accelerometer LSM303DLHC; Vehicle control module adopts MC9S12XS128MAA chip; Display module is LCD1602 display screen.
In the present invention, vehicle control terminal module comprises: wireless communication module, data processing module, data acquisition module, vehicle control module, path planning module, memory module and display module.Data processing module obtains the required parameter in location from wireless communication module, sets up positioning equation group, thereby and adopts ant colony algorithm positioning equation group to be solved to the position coordinates that obtains vehicle to be positioned.Data acquisition module receives the signal of measuring from vehicle self speed pickup, rotary angle transmitter, acceleration transducer, and is translated into digital quantity to obtain the motion state of self.Path planning module receives the signal from wireless communication module, data acquisition module, data processing module, to obtain the position coordinates of Real-time Road environment and vehicle its data and vehicle self, to next driving path constantly of vehicle carry out reasonably, optimization plans.The travel route that vehicle control module RX path planning module is planned, control vehicle speed, turn to and acceleration.Memory module and display module receive and real-time position and the optimal path information showing from data processing module and path planning module.
Vehicle control terminal module information flows to: vehicle in the process of moving, wireless communication module in vehicle-mounted control terminal is neighbours' vehicle and road information node transmission positioning request signal towards periphery, reception is from the positional information of neighbours' vehicle and road information node, and this information is sent to data processing module; Data acquisition module is measured locating required relative information, and is sent to data processing module; Data processing module sends respectively the positional information calculating to path planning module, vehicle control module, memory module and display module; Path planning module sends by data processing module the vehicle route of having planned to vehicle control module.
The bulk information node of road information node in being dispersed in road and around road forms, and each node is comprised of wireless communication module, data processing module and sensor assembly.Sensor assembly can measurement road environment in the road information such as vehicle fleet size, wagon flow speed and visibility, and by the analog signal transmission of measuring to data processing module.The simulating signal of data processing module autobiography sensor module in future is processed and is translated into digital signal.Wireless communication module sends to vehicle-mounted control terminal, road traffic control center by signals such as the node location from data processing module, road traffic, the speed of a motor vehicle.
Road information node module information flow direction is: sensor assembly is sent to data processing module by the relevant information measuring, and data processing module sends to wireless communication module after metrical information is processed.
Road traffic control center module is comprised of wireless communication module, data processing module and database module.Wireless communication module is communicated by letter with vehicle-mounted control terminal module with road information node module, receives, sends information of vehicles, terrain vehicle stream information and road geographic information.Data processing module receives the relevant information from wireless communication module, and it is carried out after pre-service, its appointment being stored in database module, need to from database, extract relevant road geographic information according to vehicle-mounted control terminal module simultaneously.The information of vehicle flowrate of database module stores road and the road geographic information for navigating.
Road traffic control center module information flow direction is: wireless communication module sends to data processing module by the relevant information receiving, and information is specified and arranged to store in database module by data processing module after treatment; Data memory module also can send localized road geography information to data processing module simultaneously, and sends to required vehicle by wireless communication module.
The information flow direction of whole system is: in the process of moving, vehicle-mounted control terminal receives the positional information from neighbours' vehicle and road information node to vehicle, receives the localized road geography information from road traffic control center module simultaneously.In addition, the status information that vehicle-mounted control terminal also can send self is to road information node module and road traffic control center module.

Claims (2)

1. the real-time location navigation of the moving vehicle based on bionical swarm intelligence, a motion control method, is characterized in that comprising the following steps:
Step 1: at moment t, vehicle vehicle adjacent thereto and information node form cordless communication network, and the vehicle of each known location coordinate sends the position coordinates of self in the mode of broadcast transmission by wireless network;
Step 2: vehicle to be positioned receives the location coordinate information of neighbours' vehicle and information node transmission is passed through the relative distance d between electromagnetic wave signal principle time of arrival measurement self and neighbours' vehicle, information node simultaneously i
d i=ct i,i=1,2,…,n (1)
In formula, c is the aerial velocity of propagation of electromagnetic wave signal, t ifor the travel-time of electromagnetic wave signal from vehicle to be positioned to neighbours' vehicle i, n is the number that receives signal;
Choose d ibe worth minimum m vehicle or information node as the position reference node of vehicle to be positioned;
Step 3: the relative distance d between vehicle basis to be positioned and reference mode iset up positioning equation with the position coordinates of reference mode, its positioning equation is expressed as
( x 1 t - x t ) 2 + ( y 1 t - y t ) 2 - ( x 2 t - x t ) 2 + ( y 2 t - y t ) 2 = d 2 - d 1 . . . ( x 1 t - x t ) 2 + ( y 1 t - y t ) 2 - ( x mt - x t ) 2 + ( y mt - y t ) 2 = d m - d 1 - - - ( 2 )
In formula, (x t, y t) be that vehicle to be positioned is at t moment coordinate, (x it, y it) be that reference mode is at t moment position coordinates;
Step 4: the positioning equation of formula (2) is converted into minimizing problem, and its expression formula is
f 1 = [ ( x 1 t - x t ) 2 + ( y 1 t - y t ) 2 - ( x 2 t - x t ) 2 + ( y 2 t - y t ) 2 ] 2 - ( d 2 - d 1 ) 2 = 0 . . . f m = [ ( x 1 t - x t ) 2 + ( y 1 t - y t ) 2 - ( x mt - x t ) 2 + ( y mt - y t ) 2 ] 2 - ( d m - d 1 ) 2 = 0 - - - ( 3 )
f 1 2 + f 2 2 + . . . + f m 2 = 0 - - - ( 4 )
For formula (4) minimal value equation, adopt artificial bee colony intelligent computation method to solve it, the minimum value (x solving t, y t) be the position coordinates of vehicle to be positioned;
Step 5: vehicle to be positioned, in its radius R field, is chosen field in-group neighbours' vehicle, and selection standard is
N it={i:[x t-x it] 2+[y t-y it] 2+[z t-z it] 2≤R 2} (5)
In formula, z ifor the vehicle i positional value on axle in the vertical direction;
Step 6: the direction of motion of vehicle k is the mean value of its neighbours' direction of vehicle movement;
&alpha; kt = 1 n kt - 1 &Sigma; i &Element; Nt &alpha; it - 1 &beta; kt = 1 n kt - 1 &Sigma; i &Element; Nt &beta; it - 1 &gamma; kt = 1 n kt - 1 &Sigma; i &Element; Nt &gamma; it - 1 - - - ( 6 )
In formula, α it, β it, γ itfor vehicle is at the t direction of motion along three axes constantly, n tfor t moment neighbours' vehicle number;
The location formula of vehicle k is:
x kt = x kt - 1 + v k cos &alpha; kt y kt = y kt - 1 + v k cos &beta; kt z kt = z kt - 1 + v k cos &gamma; kt - - - ( 7 )
In formula, v ktravel speed for vehicle k;
Each vehicle is constantly adjusted the position of oneself according to the position equation of formula (7).
2. the real-time location navigation of the moving vehicle based on bionical swarm intelligence, a kinetic control system, is characterized in that: comprise vehicle-mounted control terminal module, road information node module and road traffic control center module, transmission of signal between two between three modules;
Vehicle-mounted control terminal module comprises wireless communication module, data processing module, path planning module, data acquisition module, vehicle control module, memory module and display module; Wireless communication module and road information node, other vehicle communications, with reception, transmission information, obtain vehicle location and control required parameter; Data processing module obtains the required parameter in location from wireless communication module, and locating information car-mounted terminal node being received according to algorithm is converted into the accurate location coordinate of vehicle; Data acquisition module receives the signal of measuring from vehicle self speed pickup, rotary angle transmitter, acceleration transducer, and is translated into numerical information to obtain the motion state of self; Path planning module receives the signal from wireless communication module, data acquisition module and data processing module, obtain the position coordinates of Real-time Road environment and vehicle its data and vehicle self, to next driving path constantly of vehicle carry out reasonably, optimization plans; The travel route that vehicle control module RX path planning module is planned, control vehicle speed, turn to and acceleration; Memory module and display module receive and real-time position and the optimal path information showing from data processing module and path planning module;
Road information node module comprises wireless communication module, data processing module and sensor assembly; Sensor assembly is vehicle fleet size, wagon flow speed and visibility information in the road environment of measuring, with analog signal transmission to data processing module; The simulating signal of data processing module autobiography sensor module in future is processed and is translated into the digital signal that processor can be identified; Wireless communication module sends to road traffic control center module by the node location from data processing module, road traffic and vehicle speed signal;
Road traffic control center module comprises wireless communication module, data processing module and database module; Wireless communication module is communicated by letter with vehicle-mounted control terminal module with road information node module, receives, sends information of vehicles, terrain vehicle stream information and road geographic information; Data processing module receives the information from wireless communication module, and it is carried out after pre-service, its appointment being stored in database module, need to from database, extract relevant road geographic information according to vehicle-mounted control terminal module simultaneously; The information of vehicle flowrate of database module stores road and the road geographic information for navigating.
CN201310577959.7A 2013-11-15 2013-11-15 Bionic swarm intelligence-based real-time positioning navigation and motion control method and system for moving vehicle Pending CN103632558A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201310577959.7A CN103632558A (en) 2013-11-15 2013-11-15 Bionic swarm intelligence-based real-time positioning navigation and motion control method and system for moving vehicle

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201310577959.7A CN103632558A (en) 2013-11-15 2013-11-15 Bionic swarm intelligence-based real-time positioning navigation and motion control method and system for moving vehicle

Publications (1)

Publication Number Publication Date
CN103632558A true CN103632558A (en) 2014-03-12

Family

ID=50213553

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201310577959.7A Pending CN103632558A (en) 2013-11-15 2013-11-15 Bionic swarm intelligence-based real-time positioning navigation and motion control method and system for moving vehicle

Country Status (1)

Country Link
CN (1) CN103632558A (en)

Cited By (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103871240A (en) * 2014-03-18 2014-06-18 上海交通大学 Multi-body interactive type intelligent driving system
CN104039011A (en) * 2014-07-02 2014-09-10 保定市天河电子技术有限公司 Positioning method and device
CN105005301A (en) * 2015-05-25 2015-10-28 湘潭大学 Method for planning operation point sequence and path of industrial robot based on swarm intelligence algorithm
CN108828567A (en) * 2018-04-23 2018-11-16 河北大学 A kind of improved two-way bilateral distance measuring method
CN109556597A (en) * 2018-11-16 2019-04-02 西北工业大学 A kind of pedestrian navigation method based on group's vision
CN111212375A (en) * 2018-11-20 2020-05-29 华为技术有限公司 Positioning position adjusting method and device
CN112505621A (en) * 2020-09-28 2021-03-16 西安航空学院 Positioning navigation method based on bionic group control
CN112508223A (en) * 2020-09-28 2021-03-16 西安航空学院 Positioning motion control method based on bionic group control

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN1289994A (en) * 1999-08-31 2001-04-04 株式会社日立制作所 Broadcasting system, hardware system for receiving broadcast and navigation terminals
US20070161381A1 (en) * 2006-01-06 2007-07-12 Mediatek Inc. Location estimation method
CN101778472A (en) * 2010-02-05 2010-07-14 中国地质大学(武汉) Distributed panel-point positioning method for wireless sensor network

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN1289994A (en) * 1999-08-31 2001-04-04 株式会社日立制作所 Broadcasting system, hardware system for receiving broadcast and navigation terminals
US20070161381A1 (en) * 2006-01-06 2007-07-12 Mediatek Inc. Location estimation method
CN101778472A (en) * 2010-02-05 2010-07-14 中国地质大学(武汉) Distributed panel-point positioning method for wireless sensor network

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
来磊,曲仕茹: "《交通无线传感网络运动车辆定位方法》", 《交通运输工程学报》, vol. 13, no. 1, 28 February 2013 (2013-02-28) *
来磊,曲仕茹: "《基于鱼群效应的多车协同行驶控制方法》", 《西北工业大学学报》, vol. 30, no. 3, 30 June 2012 (2012-06-30) *

Cited By (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103871240A (en) * 2014-03-18 2014-06-18 上海交通大学 Multi-body interactive type intelligent driving system
CN104039011A (en) * 2014-07-02 2014-09-10 保定市天河电子技术有限公司 Positioning method and device
CN104039011B (en) * 2014-07-02 2017-11-07 保定市天河电子技术有限公司 A kind of localization method and device
CN105005301A (en) * 2015-05-25 2015-10-28 湘潭大学 Method for planning operation point sequence and path of industrial robot based on swarm intelligence algorithm
CN105005301B (en) * 2015-05-25 2018-06-26 湘潭大学 A kind of industrial robot operation point sequence and method for planning track based on Swarm Intelligence Algorithm
CN108828567B (en) * 2018-04-23 2022-06-21 河北大学 Improved bidirectional bilateral distance measurement method
CN108828567A (en) * 2018-04-23 2018-11-16 河北大学 A kind of improved two-way bilateral distance measuring method
CN109556597A (en) * 2018-11-16 2019-04-02 西北工业大学 A kind of pedestrian navigation method based on group's vision
CN111212375B (en) * 2018-11-20 2021-08-03 华为技术有限公司 Positioning position adjusting method and device
CN111212375A (en) * 2018-11-20 2020-05-29 华为技术有限公司 Positioning position adjusting method and device
US11698466B2 (en) 2018-11-20 2023-07-11 Huawei Cloud Computing Technologies Co., Ltd. Positioned location adjustment method and apparatus
CN112505621A (en) * 2020-09-28 2021-03-16 西安航空学院 Positioning navigation method based on bionic group control
CN112508223A (en) * 2020-09-28 2021-03-16 西安航空学院 Positioning motion control method based on bionic group control

Similar Documents

Publication Publication Date Title
CN103632558A (en) Bionic swarm intelligence-based real-time positioning navigation and motion control method and system for moving vehicle
CN103760904B (en) A kind of voice broadcast type intelligent vehicle path planning apparatus and implementation
CN109946730B (en) Ultra-wideband-based high-reliability fusion positioning method for vehicles under cooperation of vehicle and road
CN109946731B (en) Vehicle high-reliability fusion positioning method based on fuzzy self-adaptive unscented Kalman filtering
US9222786B2 (en) Methods and systems for creating digital transportation networks
CN108036794A (en) A kind of high accuracy map generation system and generation method
CN105509738B (en) Vehicle positioning orientation method based on inertial navigation/Doppler radar combination
CN102192742B (en) Navigation method and device
CN102928816A (en) High-reliably integrated positioning method for vehicles in tunnel environment
CN102645218B (en) Method for voice broadcast of relative position information of point of interest (POI)
CN103256934B (en) Road information provides equipment
CN102928860B (en) Method for improving GPS (Global Positioning System) positioning precision on the basis of local positioning information
CN103217697A (en) Method and mobile terminal for recording moving path
CN104990554B (en) Based on the inertial navigation localization method to be cooperated between VANET vehicles in GNSS blind areas
CN112435496B (en) Vehicle and ship intelligent navigation control early warning device and method based on multiple sensors
CN101950481A (en) Method for obtaining road traffic flow cloud picture in real-time manner
CN101832779A (en) Navigation method in complicated environment
CN106093992A (en) A kind of sub-meter grade combined positioning and navigating system based on CORS and air navigation aid
AU2021106247A4 (en) Vehicle fusion positioning method based on V2X and laser point cloud registration for advanced automatic driving
CN103471586A (en) Sensor-assisted terminal combination positioning method and sensor-assisted terminal combination positioning device
CN112504270A (en) Facility and method for assisting vehicle positioning in tunnel
US11874366B2 (en) High-precision vehicle positioning method based on ultra-wideband in intelligent vehicle infrastructure cooperative systems
CN101545781B (en) Method for determining pulse equivalent of speedometer in on-board integrated navigation
CN101825473B (en) Navigation method and navigation system
CN109656257A (en) Close garden automatic driving vehicle control system and method

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
C02 Deemed withdrawal of patent application after publication (patent law 2001)
WD01 Invention patent application deemed withdrawn after publication

Application publication date: 20140312