CN100402981C - System for automatically leading vehicle wireless positioning, navigating and controlling - Google Patents

Abstract

The present invention relates to a system for automatic leading vehicle wireless positioning, navigating and controlling. The present invention is composed of a vehicular system and a navigating control system, wherein the vehicular system comprises a vehicular control and execution module, a wireless positioning module 1 and a Bluetooth wireless communication module 1; a navigating control system comprises a wireless positioning module 2, a Bluetooth wireless communication module 2 and a PC. The power supply managing module used as an opposite and independent part can respectively provide proper power supply voltage for the Bluetooth wireless communication module 1, the wireless positioning module 1, and the vehicular control and execution module. The present invention can utilize the least investment to obtain the maximum efficiency, namely the performance price ratio is high and the operation is good. The present invention has the advantages that the present invention utilize the least economical investment to obtain the best control, best accurate positioning and agile path input mode to VGA. The present invention realizes a VGA system based on the ultrasound sensor positioning of a custom path.

Description

Automated guided vehicle wireless location, navigation and control system

Technical field

The present invention relates to a kind of automated guided vehicle wireless location, navigation and control system.

Background technology

So-called automated guided vehicle AGV (Automatic Guide Vehicle) is the position of extracting vehicle by the fusion of various sensors, simultaneously the self-navigation of control executing mechanism realization AGV automatically; So-called automated guided vehicle AGV wireless location is to determine the absolute coordinates of automated guided vehicle AGV in range of operation by wireless mode; So-called automated guided vehicle AGV navigation is that automated guided vehicle is planned the path that automated guided vehicle AGV will advance, and guarantee that according to the path trace algorithm automated guided vehicle AGV advances along the good path of predefined, when automated guided vehicle AGV and predefined paths have had deviation to adjust automatically according to the path trace algorithm; So-called automated guided vehicle AGV control be the controlled variable that obtains according to the path trace algorithm to automated guided vehicle AGV travelling speed, direction is controlled.

By reading related data and relevant patent, mainly quote following patent as proof:

The open date of the name of the country patent No.

1, the U.S. 4,593,239 1986.7.3

2, the U.S. 4,700,427 1987.10.20

3, the U.S. 6,128,574 2000.10.3

4, the U.S. 6,690,134 2004.2.10

5, the U.S. 6,711,501 2004.3.23

6, the U.S. 6,721,638 2004.4.13

7, the U.S. 6,772,525 2004.8.10

8, the U.S. 6,781,338 2004.8.24

Publication number

9, Chinese CN1438138A 2003.8.27

10, Chinese CN1450338A 2003.10.22

The above patent all is the scientific payoffs of present automated guided vehicle AGV aspect preciousness, with the present invention certain correlativity is arranged, and all is the characteristics that embody automated guided vehicle " flexibility ".The external AGV development level of patent 1,2,6 representatives, 3,4,5,7,8 have certain correlativity with it, and patent 9,10 embodies domestic AGV current situation.Specifically be classified as follows:

The locator meams aspect:

1, patent 1 positioning system using optical system increases hardware complexity, a little less than the antijamming capability.2, proposing vision positioning method in the patent 9, is to absorb at the control mark symbol that lays the running path mark line on ground, station address coded markings symbol and quicken, slow down, stop, move backward by the ccd video camera that is arranged on the automatic guide vehicle.The computing machine that links to each other with video camera carries out intelligently guiding by image recognition algorithm to vehicle according to the image information of picked-up.Its outstanding shortcoming is that cost is too high, the image processing process complexity, and the processing speed real-time is poor.3, same, patent 10 adopts satnav, and bearing accuracy is not high.

The path planning aspect:

The definition in patent 1 and patent 2 paths is to set several points or known several simple curves that store in the control area, and car is walked between each point or walked along simple curve.

The path trace aspect:

The path trace implementation method that proposes in the patent 6 is based on complicated vehicle-mounted control executive system realization.

The radio communication aspect:

The working frequency range that mentioned communication module is used in the patent 10 is the 900MHz/1800MHz of GSM tracking exchage.

More than be exactly the present situation of current automated guided vehicle and the problem that faces.

Summary of the invention

The invention provides a kind of automated guided vehicle wireless location, navigation and control system, to solve the problem that above-mentioned automated guided vehicle is faced.The technical scheme that the present invention takes is:

Structure is made up of two parts: onboard system [5], navigation control system [6], this onboard system [5] comprises vehicle-mounted control execution module [1], wireless locating module 1[2.1], Bluetooth wireless communication module 1[3.1], navigation control system [6] comprises wireless locating module 2[2.2], Bluetooth wireless communication module 2[3.2], PC [4], power management module [1.1] is as a relatively independent part, be respectively Bluetooth wireless communication module 1[3.1], wireless locating module 1[2.1], vehicle-mounted control execution module [1] provides suitable supply voltage, wherein:

Vehicle-mounted control execution module [1] belongs to onboard system [5], be used for finishing the coordination of car control according to control data, car finished advance, retreat, quicken, slowed down, action such as parking, left-hand rotation, right-hand rotation, it mainly comprises the main motor circuit [1.2] of controlling car and advancing, retreat, steering wheel circuit [1.3] and the microprocessor 1[1.4 that the control car turns to], wherein main motor circuit [1.2] comprising: electron speed regulator [1.5], main motor [1.6]; Steering wheel circuit [1.3] comprising: servo control circuit [1.7], H bridge motor-drive circuit [1.8], steering wheel [1.9], microprocessor 1[1.4] connection servo control circuit [1.7], this servo control circuit [1.7] connects H bridge motor-drive circuit [1.8], this H bridge motor-drive circuit [1.8] connects steering wheel [1.9], microprocessor 1[1.4] also connect electron speed regulator [1.5], this electron speed regulator [1.5] connects main motor [1.6]; What microprocessor used in vehicle-mounted control execution module [1] circuit is the Pic16f873 single-chip microcomputer that Mirochip company produces, and this chip can be exported pwm pulse.

The drive signal of the control speed of a motor vehicle and the drive signal that control turns to are by microprocessor 1[1.4] output, microprocessor 1[1.4] according to Bluetooth wireless communication module 1[3.1] control command of the PC that receives, change the cycle and the dutycycle of output pulse, the pwm pulse that the pwm pulse of output controlled motion speed turns to for main motor circuit [1.2] and control is given steering wheel circuit [1.3].

Wireless locating module 1[2.1], 2[2.2] adopt active beacon localization method based on sonac, with the infrared emission time as benchmark, be used to extract on the car emission ultrasonic signal and receive the time delay information of ultrasonic signal, car is carried out precision reach millimetre-sized accurate location to receiving end.

Wireless locating module 1[2.1] belong to onboard system [5], wireless locating module 2[2.2] belong to navigation control system [6].

Wireless locating module 1[2.1] circuit mainly contain infrared receiving circuit [2.3], microprocessor 2[2.4], headstock ultrasound emission circuit [2.5], tailstock ultrasound emission circuit [2.6], infrared receiving circuit [2.3] receives infrared signal as microprocessor 2[2.4] time reference of emission ultrasound drive signals, infrared receiving circuit [2.3] and microprocessor 2[2.4] be connected this microprocessor 2[2.4] connect headstock ultrasound emission circuit [2.5] and tailstock ultrasound emission circuit [2.6] respectively.

The infrared signal that infrared receiving circuit [2.3] receives is as microprocessor 2[2.4] emission ultrasound drive signals time reference.Microprocessor 2[2.4] after receiving infrared signal, export the needed drive signal of headstock ultrasound emission circuit [2.5] immediately, the needed drive signal of emission tailstock ultrasound emission circuit [2.6] behind the 25ms.Headstock ultrasound emission circuit [2.5], tailstock ultrasound emission circuit [2.6] receive microprocessor 2[2.4] drive signal after launch ultrasonic signal.What use is infrared receiving module, and signal end can detect having or not of infrared signal and produce corresponding pulse when connecting power supply and ground.Boost by transformer and to drive the ultrasound emission sensor, what ultrasonic transmitter was selected for use is that frequency is omnidirectional's ultrasonic transmitter of 40kHz, model is US40KT-01, produce by the U.S. smart amount company, what the microprocessor in the ultrasound emission circuit used is the Pic12c508 single-chip microcomputer that Mirochip company produces, it is little that this chip has a volume, the advantage that function is strong.

Wireless locating module 2[2.2] on circuit mainly contain infrared signal transmission circuit [2.7], ultrasonic signal amplifying circuit [2.8], voltage comparator circuit [2.9] [2.10], time delay and extract circuit [2.11], microprocessor 3[2.12], temperature measuring circuit [2.13], microprocessor 3[2.12] connect infrared signal transmission circuit [2.7] respectively, time delay is extracted circuit [2.11], temperature measuring circuit [2.13], ultrasonic signal amplifying circuit [2.8], and wherein time delay extraction circuit [2.11] connects voltage comparator circuit [2.9], [2.10] respectively.

Ultrasonic signal amplifying circuit [2.8] mainly comprises: low noise pre-amplification circuit [2.14] [2.15], second level amplifying circuit [2.16] [2.17], automatic gain amplifying circuit [2.18] [2.19], fourth stage amplifying circuit [2.20] [2.21].Pre-amplification circuit [2.14], [2.15] connect second level amplifying circuit [2.16], [2.17] that ultrasonic signal is further amplified respectively, this second level amplifying circuit [2.16], [2.17] connect automatic gain amplifying circuit [2.18] [2.19] respectively, and this automatic gain amplifying circuit [2.18], [2.19] connect fourth stage amplifying circuit [2.20], [2.21] respectively.

Pre-amplification circuit [2.14] [2.15] guarantees to suppress when ultrasonic signal is exaggerated The noise; Second level amplifying circuit [2.16] [2.17] further amplifies ultrasonic signal; Automatic gain amplifying circuit [2.18] [2.19] guarantees that the amplitude of ultrasonic signal can not have bigger fluctuation because of the position change of AGV operation.Because the output signal of automatic gain amplifying circuit [2.18] [2.19] is unsaturation also, first edge that adds fourth stage amplifying circuit [2.20] [2.21] assurance ultrasonic signal is by saturated amplification, to improve locating accuracy.Ultrasonic signal after voltage comparator circuit [2.9] [2.10] amplifies with time delay extraction circuit [2.11] processing is passed to microprocessor 3[2.12 with the signal of handling].Ultrasonic receiver is that what to select for use is that frequency is that the field angle of 40kHz is the ultrasonic receivers of 55 degree, and model is 40LR16, is produced by Polaroid company.The DS1868 two-way numeral current potential chip that automatic gain amplifying circuit [2.18] [2.19] uses Dallas company to produce changes the amplifying circuit enlargement factor by changing the pot resistance.

Owing to the value of ultrasound wave velocity of propagation c in medium can change along with variation of temperature, the pass of c and temperature is in air: $c=331.4\sqrt{1+t/273}m/s$ (t is a Celsius temperature), the present invention adds temperature measuring circuit [2.13], and measures ambient temperature compensates ultrasonic propagation velocity in real time, guarantees the accurate measurement from emission sensor to the receiving sensor distance.

Microprocessor 3[2.12] receive the simulating signal relevant that temperature measuring circuit [2.13] is sent here by self AD converter with temperature, be translated into digital quantity, every 50ms emission drives the pulse of infrared signal, and extracts the time delay information of the ultrasonic signal that headstock, the tailstock launch.Microprocessor 3[2.12] control automatic gain amplifying circuit [2.18] [2.19], the amplitude of adjustment ultrasonic signal, last, information such as time delay, temperature are passed to PC by universal asynchronous serial.Above-mentioned course of work circulation repeats.What microprocessor 3 used is the Pic16f873 single-chip microcomputer that Mirochip company produces, and extracts the ultrasonic signal travel-time by its CCP module.

Bluetooth wireless communication module 1[3.1] and Bluetooth wireless communication module 2[3.2].

Bluetooth wireless communication module 1[3.1] belong to onboard system [5] and be used for wireless receiving, Bluetooth wireless communication module 2[3.2] belong to navigation control system [6] and be used for wireless transmit.The effect of Bluetooth wireless communication module is that the vehicle control parameters that PC calculates is passed to vehicle-mounted control execution module [1].

Bluetooth wireless communication module 1[3.1] with Bluetooth wireless communication module 2[3.2] in main element be Bluetooth wireless communication module [3.3].The Bluetooth wireless communication module is a kind of monolithic blue-teeth data, voice transmitting-receiving, networking Bluetooth wireless communication module, and it can directly be connected with the serial ports of single-chip microcomputer; Also can carry out communication by level shifting circuit and serial ports of computers.

The effect of PC [4] is to realize communication and algorithm comprising communication [4.1], position display [4.2], path planning [4.3] and path trace [4.3] part, wherein under Visual C++ programmed environment

Communication [4.1] receives the temperature information and the time delay information of locating module and sends the control information of radio communication transmitter module to based on the universal asynchronous serial communication mode;

Position display [4.2] part is calculated ultrasonic propagation velocity according to Current Temperatures, calculates to such an extent that the headstock tailstock arrives the distance of two beacons according to four time delay information, obtains headstock tailstock coordinate by positioning principle, and comes out with digital, graphic presentation on screen.Positioning principle is as follows:

The two-way ultrasonic receiver that is positioned at the fixed position receives and comes from headstock S ₁, tailstock S ₂Ultrasound transmit signal, extract the ultrasonic arrival R that circuit obtains headstock, tailstock emission by time delay ₁, R ₂Travel-time, be respectively

Temperature information according to serial ports sends can calculate ultrasonic current velocity of propagation c by formula 1.(1-4) can obtain S by formula ₁R ₁, S ₁R ₂, S ₂R ₁, S ₂R ₂Article four, the length of line segment:

$S_1{\mathrm{<figure-callout\; id="1"\; label="R"\; filenames="C20041001124800172.png,C20041001124800202.png"\; state="\{\{state\}\}">R</figure-callout>}}_1={\mathrm{\&tau;}}_{S_1{\mathrm{<figure-callout\; id="1"\; label="R"\; filenames="C20041001124800172.png,C20041001124800202.png"\; state="\{\{state\}\}">R</figure-callout>}}_1}\&times;c---\left(1\right)$

$S_1{\mathrm{<figure-callout\; id="2"\; label="R"\; filenames="C20041001124800182.png,C20041001124800202.png"\; state="\{\{state\}\}">R</figure-callout>}}_2={\mathrm{\&tau;}}_{S_1{\mathrm{<figure-callout\; id="2"\; label="R"\; filenames="C20041001124800182.png,C20041001124800202.png"\; state="\{\{state\}\}">R</figure-callout>}}_2}\&times;c---\left(2\right)$

$S_2{\mathrm{<figure-callout\; id="1"\; label="R"\; filenames="C20041001124800172.png,C20041001124800202.png"\; state="\{\{state\}\}">R</figure-callout>}}_1={\mathrm{\&tau;}}_{S_2{\mathrm{<figure-callout\; id="1"\; label="R"\; filenames="C20041001124800172.png,C20041001124800202.png"\; state="\{\{state\}\}">R</figure-callout>}}_1}\&times;c---\left(3\right)$

$S_2{\mathrm{<figure-callout\; id="2"\; label="R"\; filenames="C20041001124800182.png,C20041001124800202.png"\; state="\{\{state\}\}">R</figure-callout>}}_2={\mathrm{\&tau;}}_{S_2{\mathrm{<figure-callout\; id="2"\; label="R"\; filenames="C20041001124800182.png,C20041001124800202.png"\; state="\{\{state\}\}">R</figure-callout>}}_2}\&times;c---\left(4\right)$

Have according to the plane geometry principle again:

$\left\{\begin{array}{c}{S}_1{R}_1=\sqrt{{(x_1-x_a)}^2+{(y_1-y_a)}^2}\\ S_1{R}_2=\sqrt{{(x_1-x_b)}^2+{(y_1-y_a)}^2}\end{array}---\left(5\right)\right.$

$\left\{\begin{array}{c}{S}_2{R}_1=\sqrt{{(x_2-x_a)}^2+{(y_2-y_a)}^2}\\ S_2{R}_2=\sqrt{{(x_2-x_b)}^2+{(y_2-y_a)}^2}\end{array}---\left(6\right)\right.$

Can obtain S by (1), (2), (5) ₁Point coordinate (x ₁, y ₁):

$\left\{\begin{array}{c}{x}_1=\frac{(x_b^2-x_a^2)-{\left(c{\mathrm{\&tau;}}_{S_1{R}_2}\right)}^2+{\left({\mathrm{c\&tau;}}_{S_1{R}_1}\right)}^2}{2(x_b-x_a)}\\ {\mathrm{<figure-callout\; id="1"\; label="y"\; filenames="C20041001124800172.png,C20041001124800202.png"\; state="\{\{state\}\}">y</figure-callout>}}_1=y_a+\sqrt{{\left({\mathrm{c\&tau;}}_{S_1{R}_1}\right)}^2-{(x_1-x_a)}^2}\end{array}---\left(7\right)\right.$

Can obtain S by (3), (4), (6) ₂Point coordinate (x ₂, y ₂):

$\left\{\begin{array}{c}{x}_2=\frac{(x_b^2-x_a^2)-{\left(c{\mathrm{\&tau;}}_{S_2{R}_2}\right)}^2+{\left({\mathrm{c\&tau;}}_{S_2{R}_1}\right)}^2}{2(x_b-x_a)}\\ {\mathrm{<figure-callout\; id="2"\; label="y"\; filenames="C20041001124800182.png,C20041001124800202.png"\; state="\{\{state\}\}">y</figure-callout>}}_2=y_a+\sqrt{{\left({\mathrm{c\&tau;}}_{S_2{R}_1}\right)}^2-{(x_2-x_a)}^2}\end{array}---\left(8\right)\right.$

Thereby obtain the headstock tailstock, coordinate.

Path planning [4.3] is to reach the operating path that AGV is determined in the final position that will arrive according to AGV in the current location that will move in the map.The present invention has designed three kinds of path input modes: mouse input path mode [4.5], CAD input path mode [4.6], hand-written input system path input mode [4.7].Hand-written input system path input mode [4.7] is the operator with writing pencil line of input bus or train route footpath (some rules are wherein also arranged certainly) according to actual needs on a tablet with car actual motion zone mutual mapping, master control system can be automatically to Path Recognition and be stored in the system as self-defined path.

Path trace [4.4] is to guarantee that AGV advances along the good path of predefined, when AGV and predefined paths have had deviation can make the new return path of car weight by the control information that obtains according to routing algorithm.The present invention has two kinds of path trace modes: manual control mode and automatic control mode.The manual control mode user can turn to according to position and the environmental information speed of manually controlling car of car in working environment; The present invention of path trace mode adopts geometrical principle and control theory unified algorithm.The parameter that algorithm relates to is many, mainly contains the current attitude (headstock, tailstock position) of car, the curvature and the direction of the given movement locus of travelling speed, acceleration, rudder direction, car, ground quality (friction force difference).

This invention is carried out hi-Fix based on the active beacon location of sonac is theoretical to AGV, path planning mode by multiple self-defined path, the characteristics of automated guided vehicle " flexibility " have been embodied brightly, this invention will produce very big positive impact to automated guided vehicle from now on, and relevant outstanding advantage of the present invention can be summarized as follows:

1 the present invention has realized AGV wireless location, navigation and control, on cost, has used the most economic, efficient, stable scheme and equipment.And the device of the automated guided vehicle of aforesaid other types is not localization method costliness (as described in a framing patent 9), is exactly control device costliness (as described in patent 6).

2 bearing accuracy height of the present invention, the high speed characteristics of utilizing infrared signal to propagate is accurately determined the ultrasound emission time; Use the low noise pre-amplification circuit, guaranteed to suppress when ultrasonic signal is exaggerated The noise; Use the automatic gain amplifying circuit, guarantee that the amplitude of ultrasonic signal can not have bigger fluctuation because of the position change of AGV operation.

3 in the realization of path planning, above-described representative patents path is difficult to realize liberalization, be that the institute control area provides several points, car motion between each point, can not guarantee that walking can both be along same path between 2 o'clock at every turn, several the curves that storage is fixing, such intelligently guiding vehicle can't be realized freely guiding car.And the path planning of AGV of the present invention adopts multiple mode, can revise arbitrarily according to environment is different, and is free more, flexible.

The mode that the path trace control of 4 pairs of cars has adopted the trace geometry mode to combine with control theory need not be done too big change to the vehicle-mounted control executive system and just can guarantee that path trace has very high precision, has improved the sensitivity to car control.

5 communication modes adopt the communication based on Bluetooth technology, and the working frequency range that uses is 2.4GHz.The frequency range of using is industry, science and medical science frequency range, is suitable in the world, uses the frequency hopping mode to come spread-spectrum to have good antijamming capability, also have low-power consumption, an interface standard simultaneously, can networking, low cost and other advantages.

In a word, the present invention can obtain maximum benefit with minimum input, and just cost performance is high more good more, and this invention exactly with the most economic input, obtains the control best to AGV, accurate localization, and path input mode the most flexibly.Realized under the self-defined path AGV system based on the sonac location, economical, be advantage of the present invention place accurately, flexibly.

Description of drawings

Fig. 1 is wireless location, navigation and the control system block diagram of AGV

Fig. 2 is the onboard system block diagram

Fig. 3 is the navigation control system block diagram

Fig. 4 vehicle-mounted control execution module circuit theory diagrams

Fig. 5 is the FB(flow block) of microprocessor 1

Fig. 6 is the FB(flow block) of microprocessor 2

Fig. 7 is the infrared receiving circuit schematic diagram

Fig. 8 is the ultrasound emission circuit theory diagrams

Fig. 9 is the infrared signal transmission circuit schematic diagram

Figure 10 is the I and II amplifying circuit schematic diagram of ultrasonic signal

Figure 11 be ultrasonic signal three, level Four amplifying circuit schematic diagram

Figure 12 is the circuit theory diagrams of microprocessor 3

Figure 13 is the FB(flow block) of microprocessor 3

Figure 14 is a Bluetooth wireless communication module top view

Figure 15 Bluetooth wireless communication module 1 circuit theory diagrams

Figure 16 Bluetooth wireless communication module 2 circuit theory diagrams.

Figure 17 is a program flow chart on the PC

Figure 18 is the positioning principle synoptic diagram

Embodiment

As Fig. 1, structure is made up of two parts: onboard system [5], navigation control system [6], this onboard system [5] comprises vehicle-mounted control execution module [1], wireless locating module 1[2.1], Bluetooth wireless communication module 1[3.1], navigation control system [6] comprises wireless locating module 2[2.2], Bluetooth wireless communication module 2[3.2], PC [4], power management module [1.1] is as a relatively independent part, be respectively Bluetooth wireless communication module 1[3.1], wireless locating module 1[2.1], vehicle-mounted control execution module [1] provides suitable supply voltage, wherein:

As Fig. 2, vehicle-mounted control execution module [1] belongs to onboard system [5], be used for finishing the coordination of car control according to control data, car finished advance, retreat, quicken, slowed down, action such as parking, left-hand rotation, right-hand rotation, it mainly comprises the main motor circuit [1.2] of controlling car and advancing, retreat, steering wheel circuit [1.3] and the microprocessor 1[1.4 that the control car turns to], wherein main motor circuit [1.2] comprising: electron speed regulator [1.5], main motor [1.6]; Steering wheel circuit [1.3] comprising: servo control circuit [1.7], H bridge motor-drive circuit [1.8], steering wheel [1.9], microprocessor 1[1.4] connection servo control circuit [1.7], this servo control circuit [1.7] connects H bridge motor-drive circuit [1.8], this H bridge motor-drive circuit [1.8] connects steering wheel [1.9], microprocessor 1[1.4] also connect electron speed regulator [1.5], this electron speed regulator [1.5] connects main motor [1.6]; This vehicle-mounted control execution module [1] circuit theory such as Fig. 4, what microprocessor used in vehicle-mounted control execution module [1] circuit is the Pic16f873 single-chip microcomputer that Mirochip company produces, this chip can be exported pwm pulse.

The drive signal of the control speed of a motor vehicle and the drive signal that control turns to are by microprocessor 1[1.4] output, microprocessor 1[1.4] according to Bluetooth wireless communication module 2[1.2] control command of the PC that receives, change the cycle and the dutycycle of output pulse, the pwm pulse that the pwm pulse of output controlled motion speed turns to for main motor circuit [1.1] and control is given steering wheel circuit [1.2].Microprocessor 1 process flow diagram such as Fig. 5.

Wireless locating module 1[2.1], 2[2.2] adopt active beacon localization method based on sonac, with the infrared emission time as benchmark, be used to extract on the car emission ultrasonic signal and receive the time delay information of ultrasonic signal, car is carried out precision reach millimetre-sized accurate location to receiving end.

Wireless locating module 1[2.1] belong to onboard system [5], wireless locating module 2[2.2] belong to navigation control system [6].

Wireless locating module 1[2.1] circuit mainly contain infrared receiving circuit [2.3], microprocessor 2[2.4], headstock ultrasound emission circuit [2.5], tailstock ultrasound emission circuit [2.6], infrared receiving circuit [2.3] receives infrared signal as microprocessor 2[2.4] time reference of emission ultrasound drive signals, infrared receiving circuit [2.3] and microprocessor 2[2.4] be connected this microprocessor 2[2.4] connect headstock ultrasound emission circuit [2.5] and tailstock ultrasound emission circuit [2.6] respectively.

The infrared signal that infrared receiving circuit [2.3] receives is as microprocessor 2[2.4] emission ultrasound drive signals time reference.Microprocessor 2[2.4] after receiving infrared signal, export the needed drive signal of headstock ultrasound emission circuit [2.5] immediately, the needed drive signal of emission tailstock ultrasound emission circuit [2.6] behind the 25ms.Microprocessor 2[2.4] FB(flow block) as shown in Figure 6.Headstock ultrasound emission circuit [2.5], tailstock ultrasound emission circuit [2.6] receive microprocessor 2[2.4] drive signal after launch ultrasonic signal.Infrared receiving circuit schematic diagram such as Fig. 7, use be infrared receiving module, when connect power supply and when ground signal end can detect having or not of infrared signal and produce corresponding pulse.Boost by transformer and to drive the ultrasound emission sensor, what ultrasonic transmitter was selected for use is that frequency is omnidirectional's ultrasonic transmitter of 40kHz, model is US40KT-01, produce by the U.S. smart amount company, what the microprocessor in the ultrasound emission circuit used is the Pic12c508 single-chip microcomputer that Mirochip company produces, it is little that this chip has a volume, the advantage that function is strong.

Wireless locating module 2[2.2] on circuit mainly contain infrared signal transmission circuit [2.7], ultrasonic signal amplifying circuit [2.8], voltage comparator circuit [2.9] [2.10], time delay and extract circuit [2.11], microprocessor 3[2.12], temperature measuring circuit [2.13], microprocessor 3[2.12] connect infrared signal transmission circuit [2.7] respectively, time delay is extracted circuit [2.11], temperature measuring circuit [2.13], ultrasonic signal amplifying circuit [2.8], and wherein time delay extraction circuit [2.11] connects voltage comparator circuit [2.9], [2.10] respectively.

Ultrasonic signal amplifying circuit [2.8] mainly comprises: low noise pre-amplification circuit [2.14] [2.15], second level amplifying circuit [2.16] [2.17], automatic gain amplifying circuit [2.18] [2.19], fourth stage amplifying circuit [2.20] [2.21].Pre-amplification circuit [2.14], [2.15] connect second level amplifying circuit [2.16], [2.17] that ultrasonic signal is further amplified respectively, this second level amplifying circuit [2.16], [2.17] connect automatic gain amplifying circuit [2.18] [2.19] respectively, and this automatic gain amplifying circuit [2.18], [2.19] connect fourth stage amplifying circuit [2.20], [2.21] respectively.

Pre-amplification circuit [2.14] [2.15] guarantees to suppress when ultrasonic signal is exaggerated The noise; Second level amplifying circuit [2.16] [2.17] further amplifies ultrasonic signal; Automatic gain amplifying circuit [2.18] [2.19] guarantees that the amplitude of ultrasonic signal can not have bigger fluctuation because of the position change of AGV operation.Because the output signal of automatic gain amplifying circuit [2.18] [2.19] is unsaturation also, first edge that adds fourth stage amplifying circuit [2.20] [2.21] assurance ultrasonic signal is by saturated amplification, to improve locating accuracy.Ultrasonic signal after voltage comparator circuit [2.9] [2.10] amplifies with time delay extraction circuit [2.11] processing is passed to microprocessor 3[2.12 with the signal of handling].Infrared signal transmission circuit schematic diagram such as Fig. 9; The low noise pre-amplification circuit [2.14] [2.15] of ultrasonic signal, second level amplifying circuit [2.16] [2.17] schematic diagram such as Figure 10.Ultrasonic receiver is that what to select for use is that frequency is that the field angle of 40kHz is the ultrasonic receivers of 55 degree, and model is 40LR16, is produced by Polaroid company.The automatic gain amplifying circuit [2.18] [2.19] of ultrasonic signal, fourth stage amplifying circuit [2.20] [2.21] schematic diagram such as Figure 11.Wherein automatic gain amplifying circuit [2.18] [2.19] uses the DS1868 two-way numeral current potential chip that Dallas company produces, and changes the amplifying circuit enlargement factor by changing the pot resistance.

Owing to the value of ultrasound wave velocity of propagation c in medium can change along with variation of temperature, the pass of c and temperature is in air: $c=331.4\sqrt{1+t/273}m/s$ (t is a Celsius temperature), the present invention adds temperature measuring circuit [2.13], and measures ambient temperature compensates ultrasonic propagation velocity in real time, guarantees the accurate measurement from emission sensor to the receiving sensor distance.

Microprocessor 3[2.12] receive the simulating signal relevant that temperature measuring circuit [2.13] is sent here by self AD converter with temperature, be translated into digital quantity, every 50ms emission drives the pulse of infrared signal, and extracts the time delay information of the ultrasonic signal that headstock, the tailstock launch.Microprocessor 3[2.12] control automatic gain amplifying circuit [2.18] [2.19], the amplitude of adjustment ultrasonic signal, last, information such as time delay, temperature are passed to PC by universal asynchronous serial.Above-mentioned course of work circulation repeats.Microprocessor 3[2.12] circuit theory diagrams such as Figure 12, what microprocessor 3 used is the Pic16f873 single-chip microcomputer that Mirochip company produces, and extracts the ultrasonic signal travel-time by its CCP module.Microprocessor 3[2.12] process flow diagram such as Figure 13.

Bluetooth wireless communication module 1[3.1] and Bluetooth wireless communication module 2[3.2]

Bluetooth wireless communication module 1[3.1] belong to onboard system [5] and be used for wireless receiving, Bluetooth wireless communication module 2[3.2] belong to navigation control system [6] and be used for wireless transmit.The effect of Bluetooth wireless communication module is that the vehicle control parameters that PC calculates is passed to vehicle-mounted control execution module [1].

Bluetooth wireless communication module 1[3.1] with Bluetooth wireless communication module 2[3.2] in main element be Bluetooth wireless communication module [3.3].Bluetooth wireless communication module top view such as Figure 14.The Bluetooth wireless communication module is a kind of monolithic blue-teeth data, voice transmitting-receiving, networking Bluetooth wireless communication module, and it can directly be connected with the serial ports of single-chip microcomputer; Also can carry out communication by level shifting circuit and serial ports of computers.Bluetooth wireless communication module 1[3.1] circuit theory diagrams such as Figure 15, Bluetooth wireless communication module 2[3.2] circuit theory diagrams such as Figure 16.

PC [4]

The effect of PC [4] is to realize communication and algorithm under Visual C++ programmed environment.Comprise communication [4.1], position display [4.2], path planning [4.3] and path trace [4.3] several sections, Figure 17 is a program flow chart on the PC, wherein:

Communication [4.1] part receives the temperature information and the time delay information of locating module and sends the control information of radio communication transmitter module to based on the universal asynchronous serial communication mode.

Position display [4.2] part is calculated ultrasonic propagation velocity according to Current Temperatures, calculates to such an extent that the headstock tailstock arrives the distance of two beacons according to four time delay information, obtains headstock tailstock coordinate by positioning principle, and comes out with digital, graphic presentation on screen.Positioning principle synoptic diagram such as Figure 18, positioning principle is as follows:

The two-way ultrasonic receiver that is positioned at the fixed position receives and comes from headstock S ₁, tailstock S ₂Ultrasound transmit signal, extract the ultrasonic arrival R that circuit obtains headstock, tailstock emission by time delay ₁, R ₂Travel-time, be respectively

Temperature information according to serial ports sends can calculate ultrasonic current velocity of propagation c by formula 1.(1-4) can obtain S by formula ₁R ₁, S ₁R ₂, S ₂R ₁, S ₂R ₂Article four, the length of line segment:

$S_1{\mathrm{<figure-callout\; id="1"\; label="R"\; filenames="C20041001124800172.png,C20041001124800202.png"\; state="\{\{state\}\}">R</figure-callout>}}_1={\mathrm{\&tau;}}_{S_1{\mathrm{<figure-callout\; id="1"\; label="R"\; filenames="C20041001124800172.png,C20041001124800202.png"\; state="\{\{state\}\}">R</figure-callout>}}_1}\&times;c---\left(1\right)$

$S_1{\mathrm{<figure-callout\; id="2"\; label="R"\; filenames="C20041001124800182.png,C20041001124800202.png"\; state="\{\{state\}\}">R</figure-callout>}}_2={\mathrm{\&tau;}}_{S_1{\mathrm{<figure-callout\; id="2"\; label="R"\; filenames="C20041001124800182.png,C20041001124800202.png"\; state="\{\{state\}\}">R</figure-callout>}}_2}\&times;c---\left(2\right)$

$S_2{\mathrm{<figure-callout\; id="1"\; label="R"\; filenames="C20041001124800172.png,C20041001124800202.png"\; state="\{\{state\}\}">R</figure-callout>}}_1={\mathrm{\&tau;}}_{S_2{\mathrm{<figure-callout\; id="1"\; label="R"\; filenames="C20041001124800172.png,C20041001124800202.png"\; state="\{\{state\}\}">R</figure-callout>}}_1}\&times;c---\left(3\right)$

$S_2{\mathrm{<figure-callout\; id="2"\; label="R"\; filenames="C20041001124800182.png,C20041001124800202.png"\; state="\{\{state\}\}">R</figure-callout>}}_2={\mathrm{\&tau;}}_{S_2{\mathrm{<figure-callout\; id="2"\; label="R"\; filenames="C20041001124800182.png,C20041001124800202.png"\; state="\{\{state\}\}">R</figure-callout>}}_2}\&times;c---\left(4\right)$

Have according to the plane geometry principle again:

$\left\{\begin{array}{c}{S}_1{\mathrm{<figure-callout\; id="1"\; label="R"\; filenames="C20041001124800172.png,C20041001124800202.png"\; state="\{\{state\}\}">R</figure-callout>}}_1=\sqrt{{(x_1-x_a)}^2+{(y_1-y_a)}^2}\\ S_1{\mathrm{<figure-callout\; id="2"\; label="R"\; filenames="C20041001124800182.png,C20041001124800202.png"\; state="\{\{state\}\}">R</figure-callout>}}_2=\sqrt{{(x_1-x_b)}^2+{(y_1-y_a)}^2}\end{array}---\left(5\right)\right.$

$\left\{\begin{array}{c}{S}_2{\mathrm{<figure-callout\; id="1"\; label="R"\; filenames="C20041001124800172.png,C20041001124800202.png"\; state="\{\{state\}\}">R</figure-callout>}}_1=\sqrt{{(x_2-x_a)}^2+{(y_2-y_a)}^2}\\ S_2{\mathrm{<figure-callout\; id="2"\; label="R"\; filenames="C20041001124800182.png,C20041001124800202.png"\; state="\{\{state\}\}">R</figure-callout>}}_2=\sqrt{{(x_2-x_b)}^2+{(y_2-y_a)}^2}\end{array}---\left(6\right)\right.$

Can obtain S by (1), (2), (5) ₁Point coordinate (x ₁, y ₁):

$\left\{\begin{array}{c}{x}_1=\frac{(x_b^2-x_a^2)-{\left(c{\mathrm{\&tau;}}_{S_1{R}_2}\right)}^2+{\left({\mathrm{c\&tau;}}_{S_1{R}_1}\right)}^2}{2(x_b-x_a)}\\ {\mathrm{<figure-callout\; id="1"\; label="y"\; filenames="C20041001124800172.png,C20041001124800202.png"\; state="\{\{state\}\}">y</figure-callout>}}_1=y_a+\sqrt{{\left({\mathrm{c\&tau;}}_{S_1{R}_1}\right)}^2-{(x_1-x_a)}^2}\end{array}---\left(7\right)\right.$

Can obtain S by (3), (4), (6) ₂Point coordinate (x ₂, y ₂):

$\left\{\begin{array}{c}{x}_2=\frac{(x_b^2-x_a^2)-{\left(c{\mathrm{\&tau;}}_{S_2{R}_2}\right)}^2+{\left({\mathrm{c\&tau;}}_{S_2{R}_1}\right)}^2}{2(x_b-x_a)}\\ {\mathrm{<figure-callout\; id="2"\; label="y"\; filenames="C20041001124800182.png,C20041001124800202.png"\; state="\{\{state\}\}">y</figure-callout>}}_2=y_a+\sqrt{{\left({\mathrm{c\&tau;}}_{S_2{R}_1}\right)}^2-{(x_2-x_a)}^2}\end{array}---\left(8\right)\right.$

Thereby obtain the headstock tailstock, coordinate.

Path planning [4.3] is to reach the operating path that AGV is determined in the final position that will arrive according to AGV in the current location that will move in the map.The present invention has designed three kinds of path input modes: mouse input path mode [4.5], CAD input path mode [4.6], hand-written input system path input mode [4.7].Hand-written input system path input mode [4.7] is the operator with writing pencil line of input bus or train route footpath (some rules are wherein also arranged certainly) according to actual needs on a tablet with car actual motion zone mutual mapping, master control system can be automatically to Path Recognition and be stored in the system as self-defined path.

Path trace [4.4] is to guarantee that AGV advances along the good path of predefined, when AGV and predefined paths have had deviation can make the new return path of car weight by the control information that obtains according to routing algorithm.The present invention has two kinds of path trace modes: manual control mode and automatic control mode.The manual control mode user can turn to according to position and the environmental information speed of manually controlling car of car in working environment; The present invention of path trace mode adopts geometrical principle and control theory unified algorithm.The parameter that algorithm relates to is many, mainly contains the current attitude (headstock, tailstock position) of car, the curvature and the direction of the given movement locus of travelling speed, acceleration, rudder direction, car, ground quality (friction force difference).

Claims (6)

1. automated guided vehicle wireless location, navigation and control system, structure is made up of two parts: onboard system [5], navigation control system [6], this onboard system [5] comprises vehicle-mounted control execution module [1], wireless locating module 1[2.1], Bluetooth wireless communication module 1[3.1], navigation control system [6] comprises wireless locating module 2[2.2], Bluetooth wireless communication module 2[3.2], PC [4], PC [4] respectively with Bluetooth wireless communication module 2[3.2], wireless locating module 2[2.2] connect, Bluetooth wireless communication module 1[3.1] and Bluetooth wireless communication module 2[3.2] wireless connections, Bluetooth wireless communication module 1[3.1] be connected with vehicle-mounted control execution module [1], vehicle-mounted control execution module [1] and wireless locating module 1[2.1] independently of one another do not have be connected, wireless locating module 1[2.1] by ultrasonic and wireless locating module 2[2.2] wireless connections, power management module [1.1] is as a relatively independent part, be respectively Bluetooth wireless communication module 1[3.1], wireless locating module 1[2.1], vehicle-mounted control execution module [1] provides suitable supply voltage;

The pace of control AGV and the vehicle-mounted control execution module [1] of direction belong to onboard system [5], be used for finishing the coordination of car control according to control data, car finished advance, retreat, quicken, slowed down, action such as parking, left-hand rotation, right-hand rotation, it mainly comprises the main motor circuit [1.2] of controlling car and advancing, retreat, steering wheel circuit [1.3] and the microprocessor 1[1.4 that the control car turns to], wherein main motor circuit [1.2] comprising: electron speed regulator [1.5], main motor [1.6]; Steering wheel circuit [1.3] comprising: servo control circuit [1.7], H bridge motor-drive circuit [1.8], steering wheel [1.9], microprocessor 1[1.4] connection servo control circuit [1.7], this servo control circuit [1.7] connects H bridge motor-drive circuit [1.8], this H bridge motor-drive circuit [1.8] connects steering wheel [1.9], microprocessor 1[1.4] also connect electron speed regulator [1.5], this electron speed regulator [1.5] connects main motor [1.6];

What microprocessor used in vehicle-mounted control execution module [1] circuit is the Pic16f873 single-chip microcomputer that Mirochip company produces, and this chip can be exported pwm pulse;

It is characterized in that: wireless locating module 1[2.1] adopt active beacon localization method based on sonac, with the infrared emission time as benchmark, be used to extract and launch ultrasonic signal receives ultrasonic signal to receiving end time delay information on the car, car is carried out precision reach millimetre-sized accurate location, its circuit mainly contains infrared receiving circuit [2.3], microprocessor 2[2.4], headstock ultrasound emission circuit [2.5], tailstock ultrasound emission circuit [2.6], infrared receiving circuit [2.3] receives infrared signal as microprocessor 2[2.4] time reference of emission ultrasound drive signals, infrared receiving circuit [2.3] and microprocessor 2[2.4] be connected this microprocessor 2[2.4] connect headstock ultrasound emission circuit [2.5] and tailstock ultrasound emission circuit [2.6] respectively.

2. automated guided vehicle wireless location according to claim 1, navigation and control system, it is characterized in that: what the microprocessor in headstock ultrasound emission circuit [2.5] and the tailstock ultrasound emission circuit [2.6] used is the Pic12c508 single-chip microcomputer that Mirochip company produces, boost by transformer and to drive ultrasound emission sensor 1 and 2, what ultrasonic transmitter was selected for use is that frequency is omnidirectional's ultrasonic transmitter of 40kHz, model is US40KT-01, is produced by the U.S. smart amount company.

3. automated guided vehicle wireless location according to claim 1, navigation and control system, it is characterized in that: wireless locating module 2[2.2] on circuit mainly contain infrared signal transmission circuit [2.7], ultrasonic signal amplifying circuit [2.8], voltage comparator circuit [2.9], [2.10], time delay is extracted circuit [2.11], microprocessor 3[2.12], temperature measuring circuit [2.13], microprocessor 3[2.12] connect infrared signal transmission circuit [2.7] respectively, time delay is extracted circuit [2.11], temperature measuring circuit [2.13], ultrasonic signal amplifying circuit [2.8], wherein time delay extraction circuit [2.11] connects voltage comparator circuit [2.9] respectively, [2.10].

4. automated guided vehicle wireless location according to claim 3, navigation and control system is characterized in that: ultrasonic signal amplifying circuit [2.8] mainly comprises: low noise pre-amplification circuit [2.14] [2.15], second level amplifying circuit [2.16] [2.17], automatic gain amplifying circuit [2.18] [2.19], fourth stage amplifying circuit [2.20] [2.21].Pre-amplification circuit [2.14], [2.15] connect second level amplifying circuit [2.16], [2.17] that ultrasonic signal is further amplified respectively, this second level amplifying circuit [2.16], [2.17] connect automatic gain amplifying circuit [2.18] [2.19] respectively, and this automatic gain amplifying circuit [2.18], [2.19] connect fourth stage amplifying circuit [2.20], [2.21] respectively.

5. automated guided vehicle wireless location according to claim 1, navigation and control system, it is characterized in that: Bluetooth wireless communication module 1[3.1] belong to onboard system [5], be used for wireless receiving, Bluetooth wireless communication module 2[3.2] belong to navigation control system [6], be used for wireless transmit, the vehicle control parameters that PC [4] calculates is passed to vehicle-mounted control execution module [1].

6. automated guided vehicle wireless location according to claim 1, navigation and control system, it is characterized in that: the effect of PC [4] is to realize communication and algorithm under Visual C++ programmed environment, comprise communication [4.1], position display [4.2], path planning [4.3] and path trace [4.3] part, wherein

Communication [4.1] receives the temperature information and the time delay information of locating module and sends the control information of radio communication transmitter module to based on the universal asynchronous serial communication mode;

Position display [4.2] is to calculate ultrasonic propagation velocity according to Current Temperatures, calculates to such an extent that the headstock tailstock arrives the distance of two beacons according to four time delay information, obtains headstock tailstock coordinate by positioning principle, and comes out with digital, graphic presentation on screen;

Path planning [4.3] in the current location that will move in the map, reaches the operating path that AGV is determined in the final position that will arrive according to AGV;

Path trace [4.4] is to guarantee that AGV advances along the good path of predefined, when AGV and predefined paths have had deviation can make the new return path of car weight by the control information that obtains according to routing algorithm.

Images