CN104613979A - Apparatus and method used for calibrating parameter of AUV autonomous navigation sensor - Google Patents
Apparatus and method used for calibrating parameter of AUV autonomous navigation sensor Download PDFInfo
- Publication number
- CN104613979A CN104613979A CN201310544880.4A CN201310544880A CN104613979A CN 104613979 A CN104613979 A CN 104613979A CN 201310544880 A CN201310544880 A CN 201310544880A CN 104613979 A CN104613979 A CN 104613979A
- Authority
- CN
- China
- Prior art keywords
- speed
- auv
- sensor
- ship
- gps
- 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
Links
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
Landscapes
- Engineering & Computer Science (AREA)
- Manufacturing & Machinery (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
The invention relates to the technical field of underwater robot, and especially relates to an apparatus and a method used for calibrating parameter of AUV(Autonomous Underwater Vehicle) autonomous navigation sensor. The apparatus comprises a GPS reception machine, a speed sensor, a course sensor and a control computer. The method is characterized in that after continuous three segments of linear routes by the AUV, and the calibration result for parameter of the autonomous navigation sensor can be calculated. The apparatus can be used for AUV and can be used for other sea robots and underwater automation equipment, and the apparatus has the advantages of simple apparatus, simple usage, stabilization and reliability, accurate detection result and wide application scope.
Description
Technical field
The present invention relates to underwater robot technical field, particularly relating to a kind of for demarcating AUV(Autonomous Underwater Vehicle, autonomous underwater robot) apparatus and method of independent navigation sensor parameters.
Background technology
Before AUV carries out independent navigation under water, need to demarcate AUV independent navigation sensor parameters in advance, demarcate two parameters: one is the mounting shift angle of heading sensor and speed of a ship or plane sensor, another one is that speed of a ship or plane sensor tests the speed coefficient.Classic method is: AUV is in water surface line navigation, and Real-time Collection GPS location data, heading sensor data and speed of a ship or plane sensing data, gps antenna need surface to receive gps signal always in the process, after line navigation one segment distance, reclaims AUV.Derive the above-mentioned data of AUV record, utilize common computer to carry out processed offline, obtain the calibration result to navigation sensor parameter.This method has following shortcoming: (1) AUV timing signal needs at surface navigation, and gps signal is easily disturbed; (2) calibration result can only be calculated after reclaiming AUV, can not on-line proving.
Summary of the invention
In order to overcome the deficiency of classic method, the technical problem to be solved in the present invention be to provide a kind of can in the apparatus and method of line computation independent navigation sensor parameters calibration result.
The technical scheme that the present invention is adopted for achieving the above object is: a kind of device for demarcating AUV independent navigation sensor parameters, comprises
GPS, gps antenna is arranged on AUV outside, for receiving gps signal, GPS receiving element connection control computing machine;
Speed of a ship or plane sensor, its processing section is arranged on AUV inside, and measure portion is arranged on AUV outside, and processing section is connected with computer for controlling, and the coefficient that tests the speed is to be calibrated, for measuring forward speed and the dextrad speed of AUV in real time;
Heading sensor, is arranged on AUV enclosure interior, is connected with computer for controlling, and the mounting shift angle of heading sensor and speed of a ship or plane sensor is to be calibrated, for measuring the course of AUV in real time;
Computer for controlling, is installed on AUV enclosure interior, by the equipment connection on the communications cable and the water surface, records for Real-time Collection gps signal, the forward speed of AUV, dextrad speed and the course data that the said equipment exports.
Described GPS, speed of a ship or plane sensor, heading sensor be connected with the power input of computer for controlling AUV electric power output interface,
Described computer for controlling is for controlling the electric power break-make of described GPS, speed of a ship or plane sensor, heading sensor.
The transmission cycle of the forward speed of described gps data, AUV, dextrad speed and course data is between 0.1 second ~ 10 seconds.
For demarcating a method for AUV independent navigation sensor parameters, AUV navigates by water behind three sections of straight line air routes continuously, calculates the calibration result of AUV independent navigation sensor parameters, comprises the following steps:
AUV navigates by water first paragraph air route: in the starting point in first paragraph air route, GPS inputs gps signal to controlling calculation; At the terminal in first paragraph air route, computer for controlling receives gps signal by GPS;
AUV navigation second segment air route: AUV starts the navigation of second segment air route at first paragraph air route terminal, and at the terminal in second segment air route, computer for controlling receives gps signal by GPS;
AUV navigates by water the 3rd section of air route: AUV and starts the navigation of the 3rd section of air route at second segment air route terminal, and at the terminal in the 3rd section of air route, computer for controlling receives gps signal by GPS;
The computer for controlling gps data received calculates east orientation displacement and the north orientation displacement in each section of air route, east orientation position and north orientation displacement is calculated with heading sensor and speed of a ship or plane sensing data, by calculating the displacement of the former with the latter and comparing, obtain speed of a ship or plane sensor and to test the speed coefficient and the mounting shift angle between heading sensor and speed of a ship or plane sensor.
The air route quantity that in three sections of air routes of described AUV navigation, length is greater than 800 meters is not less than 2.
Described computer for controlling to test the speed coefficient and the mounting shift angle between heading sensor and speed of a ship or plane sensor at line computation speed of a ship or plane sensor.
The gps signal of described computer for controlling record, the forward speed of AUV, dextrad speed and course data are transferred on other computing machine, carry out calculated off-line, obtain speed of a ship or plane sensor and to test the speed coefficient and the mounting shift angle between heading sensor and speed of a ship or plane sensor.
The test the speed computing method of coefficient and the mounting shift angle between heading sensor and speed of a ship or plane sensor of described speed of a ship or plane sensor are:
If the course angle of speed of a ship or plane sensor measurement is ψ, forward speed and the dextrad speed of speed of a ship or plane sensor measurement are respectively v
fand v
r, mounting shift angle H
sas follows with the computing formula of the coefficient δ that tests the speed:
In formula, Δ T represents the sampling period,
Represent north orientation speed,
Represent east orientation speed, k represents sampling sum.R
m, R
nrepresent meridian radius of circle and fourth of the twelve Earthly Branches radius of circle at the tenth of the twelve Earthly Branches respectively, λ, L represent longitude and latitude respectively; Wherein following parameter is known quantity:
R
M=Re*(1-2*fearth+3*fearth*sin(L)*sin(L));
R
N=Re*(1+fearth*sin(L)*sin(L));
ΔE=Re*cos(lati_1)*(longi_2-longi_1)*(1+fearth*sin(lati_1)*sin(lati_1)
ΔN=Re*((lati_2-lati_1)*(1-2*fearth+3*fearth*0.5)-3*fearth*0.25*(sin(2*lati_2)-sin(2*lati_1)))
In formula, fearth=1/298.257, Re=6378137, (longi_1, lati_1) and (longi_2, lati_2) represents the latitude and longitude coordinates of starting point and terminal respectively;
Formula (1) can be divided out the coefficient δ that tests the speed divided by formula (2), obtains following formula
Vse/Vsn=ΔE/ΔN (3)
Wherein,
Formula (3) is only containing a unknown number mounting shift angle H
s, utilize formula (3) directly to solve; H
ssolve rear substitution formula (1) or formula (2) can solve the coefficient δ that tests the speed.
The present invention has the following advantages and beneficial effect:
1. device is simple, easy to use.Calibration algorithm, without the need to other servicing unit, only need be transplanted on AUV internal control computing machine by apparatus of the present invention.
2. reliable and stable, testing result is accurate.The inventive method can online and off-line calibration navigation sensor parameter, and testing result is accurate.
4. applied range.The present invention not only can be applied to AUV, can also be used for other ocean robot and automated arm under water.
Accompanying drawing explanation
Fig. 1 is device arrangement plan of the present invention;
Fig. 2 is three sections of straight line air routes of the present invention;
Embodiment
Below in conjunction with drawings and Examples, the present invention is described in further detail.
AUV independent navigation sensor parameters caliberating device as shown in Figure 1.AUV adopts constant speed, orientation, depth-keeping navigation mode, successively the following three sections of straight line air routes of navigation, as shown in Figure 2:
First paragraph straight line air route, line navigation 1.6 km, then starts second segment straight line air route, and resail 1.6 kms, finally navigation the 3rd section of air route, and distance to go does not do requirement.
In navigation process, AUV keeps course and the attitude stabilization of sail body, records the measurement data of speed of a ship or plane sensor and the course data of heading sensor respectively.Before every section of straight line air route starts, AUV discharges gps antenna and receives gps data, when pending data is effective, regains antenna.At every section of air route terminal, AUV discharges gps antenna and receives gps data, when pending data is effective, regains antenna.
After three sections of straight line air routes complete, obtain independent navigation sensor parameters calibration result by online process of the present invention or processed offline mode.
Claims (9)
1. for demarcating a device for AUV independent navigation sensor parameters, it is characterized in that, comprising
GPS, gps antenna is arranged on AUV outside, for receiving gps signal, GPS receiving element connection control computing machine;
Speed of a ship or plane sensor, its processing section is arranged on AUV inside, and measure portion is arranged on AUV outside, and processing section is connected with computer for controlling, and the coefficient that tests the speed is to be calibrated, for measuring forward speed and the dextrad speed of AUV in real time;
Heading sensor, is arranged on AUV enclosure interior, is connected with computer for controlling, and the mounting shift angle of heading sensor and speed of a ship or plane sensor is to be calibrated, for measuring the course of AUV in real time;
Computer for controlling, is installed on AUV enclosure interior, by the equipment connection on the communications cable and the water surface, records for Real-time Collection gps signal, the forward speed of AUV, dextrad speed and the course data that the said equipment exports.
2. a kind of device for demarcating AUV independent navigation sensor parameters according to claim 1, is characterized in that, described GPS, speed of a ship or plane sensor, heading sensor are connected the electric power output interface of AUV with the power input of computer for controlling.
3. a kind of device for demarcating AUV independent navigation sensor parameters according to claim 1, is characterized in that, described computer for controlling is for controlling the electric power break-make of described GPS, speed of a ship or plane sensor, heading sensor.
4. a kind of device for demarcating AUV independent navigation sensor parameters according to claim 1, is characterized in that, the transmission cycle of the forward speed of described gps data, AUV, dextrad speed and course data is between 0.1 second ~ 10 seconds.
5. for demarcating a method for AUV independent navigation sensor parameters, it is characterized in that, AUV navigates by water behind three sections of straight line air routes continuously, calculates the calibration result of AUV independent navigation sensor parameters, comprises the following steps:
AUV navigates by water first paragraph air route: in the starting point in first paragraph air route, GPS inputs gps signal to controlling calculation; At the terminal in first paragraph air route, computer for controlling receives gps signal by GPS;
AUV navigation second segment air route: AUV starts the navigation of second segment air route at first paragraph air route terminal, and at the terminal in second segment air route, computer for controlling receives gps signal by GPS;
AUV navigates by water the 3rd section of air route: AUV and starts the navigation of the 3rd section of air route at second segment air route terminal, and at the terminal in the 3rd section of air route, computer for controlling receives gps signal by GPS;
The computer for controlling gps data received calculates east orientation displacement and the north orientation displacement in each section of air route, east orientation position and north orientation displacement is calculated with heading sensor and speed of a ship or plane sensing data, by calculating the displacement of the former with the latter and comparing, obtain speed of a ship or plane sensor and to test the speed coefficient and the mounting shift angle between heading sensor and speed of a ship or plane sensor.
6. a kind of method for demarcating AUV independent navigation sensor parameters according to claim 5, is characterized in that, the air route quantity that in three sections of air routes of described AUV navigation, length is greater than 800 meters is not less than 2.
7. a kind of method for demarcating AUV independent navigation sensor parameters according to claim 5, is characterized in that, described computer for controlling to test the speed coefficient and the mounting shift angle between heading sensor and speed of a ship or plane sensor at line computation speed of a ship or plane sensor.
8. the method for demarcating AUV independent navigation sensor parameters according to claim 5, it is characterized in that, the gps signal of described computer for controlling record, the forward speed of AUV, dextrad speed and course data are transferred on other computing machine, carry out calculated off-line, obtain speed of a ship or plane sensor and to test the speed coefficient and the mounting shift angle between heading sensor and speed of a ship or plane sensor.
9. the method for demarcating AUV independent navigation sensor parameters according to claim 5, is characterized in that, the test the speed computing method of coefficient and the mounting shift angle between heading sensor and speed of a ship or plane sensor of described speed of a ship or plane sensor are:
If the course angle of speed of a ship or plane sensor measurement is ψ, forward speed and the dextrad speed of speed of a ship or plane sensor measurement are respectively v
fand v
r, mounting shift angle H
sas follows with the computing formula of the coefficient δ that tests the speed:
In formula, Δ T represents the sampling period,
represent north orientation speed,
represent east orientation speed, k represents sampling sum.R
m, R
nrepresent meridian radius of circle and fourth of the twelve Earthly Branches radius of circle at the tenth of the twelve Earthly Branches respectively, λ, L represent longitude and latitude respectively; Wherein following parameter is known quantity:
R
M=Re*(1-2*fearth+3*fearth*sin(L)*sin(L));
R
N=Re*(1+fearth*sin(L)*sin(L));
ΔE=Re*cos(lati_1)*(longi_2-longi_1)*(1+fearth*sin(lati_1)*sin(lati_1)
ΔN=Re*((lati_2-lati_1)*(1-2*fearth+3*fearth*0.5)-3*fearth*0.25*(sin(2*lati_2)-sin(2*lati_1)))
In formula, fearth=1/298.257, Re=6378137, (longi_1, lati_1) and (longi_2, lati_2) represents the latitude and longitude coordinates of starting point and terminal respectively;
Formula (1) can be divided out the coefficient δ that tests the speed divided by formula (2), obtains following formula
Vse/Vsn=ΔE/ΔN (3)
Wherein,
Formula (3) is only containing a unknown number mounting shift angle H
s, utilize formula (3) directly to solve; H
ssolve rear substitution formula (1) or formula (2) can solve the coefficient δ that tests the speed.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310544880.4A CN104613979A (en) | 2013-11-05 | 2013-11-05 | Apparatus and method used for calibrating parameter of AUV autonomous navigation sensor |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310544880.4A CN104613979A (en) | 2013-11-05 | 2013-11-05 | Apparatus and method used for calibrating parameter of AUV autonomous navigation sensor |
Publications (1)
Publication Number | Publication Date |
---|---|
CN104613979A true CN104613979A (en) | 2015-05-13 |
Family
ID=53148537
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201310544880.4A Pending CN104613979A (en) | 2013-11-05 | 2013-11-05 | Apparatus and method used for calibrating parameter of AUV autonomous navigation sensor |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104613979A (en) |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102213594A (en) * | 2011-03-16 | 2011-10-12 | 哈尔滨工程大学 | Method for fusing ocean current observation data of unmanned undersea vehicle (UUV) |
CN102519450A (en) * | 2011-12-12 | 2012-06-27 | 东南大学 | Integrated navigation device for underwater glider and navigation method therefor |
CN102829777A (en) * | 2012-09-10 | 2012-12-19 | 江苏科技大学 | Integrated navigation system for autonomous underwater robot and method |
CN103163508A (en) * | 2013-02-01 | 2013-06-19 | 中国人民解放军国防科学技术大学 | Doppler velocity log (DVL) parameter calibration method used for integrated navigation system of underwater inertial navigation system (INS) and DVL |
-
2013
- 2013-11-05 CN CN201310544880.4A patent/CN104613979A/en active Pending
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102213594A (en) * | 2011-03-16 | 2011-10-12 | 哈尔滨工程大学 | Method for fusing ocean current observation data of unmanned undersea vehicle (UUV) |
CN102519450A (en) * | 2011-12-12 | 2012-06-27 | 东南大学 | Integrated navigation device for underwater glider and navigation method therefor |
CN102829777A (en) * | 2012-09-10 | 2012-12-19 | 江苏科技大学 | Integrated navigation system for autonomous underwater robot and method |
CN103163508A (en) * | 2013-02-01 | 2013-06-19 | 中国人民解放军国防科学技术大学 | Doppler velocity log (DVL) parameter calibration method used for integrated navigation system of underwater inertial navigation system (INS) and DVL |
Non-Patent Citations (1)
Title |
---|
JI DAXIONG 等,: ""Log sensor calibration using M-estimate"", 《OCEANS 2010 IEEE-SYDNEY》 * |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102288170B (en) | Correction method of electronic compass in underwater vehicle | |
CN107990891B (en) | Underwater robot combined navigation method based on long baseline and beacon online calibration | |
CN103697910B (en) | The correction method of autonomous underwater aircraft Doppler log installation error | |
CN106197409B (en) | A kind of three-dimensional geographical coordinate measuring method of submarine pipeline | |
CN109613520B (en) | Ultra-short baseline installation error online calibration method based on filtering | |
CN105066917A (en) | Miniature pipeline geographic information system measuring apparatus and measuring method thereof | |
CN106679662B (en) | A kind of underwater robot list beacon Combinated navigation method based on TMA technology | |
CN103777177A (en) | Ultra short base line underwater target positioning method based on broadband signal time delay detection | |
CN106595715A (en) | Method and device for calibrating odometer based on strapdown inertial navigation/satellite integrated navigation system | |
CN104252010A (en) | Radiosonde and weather data measuring method thereof | |
CN103968838A (en) | Co-location method of AUVs (Autonomous Underwater Vehicles) in curvilinear motion state based on polar coordinate system | |
CN109470276A (en) | Mileage meter calibration method and device based on zero-velocity curve | |
Fuentes-Pérez et al. | Underwater vehicle speedometry using differential pressure sensors: Preliminary results | |
CN106324635B (en) | A kind of straight line traveling detection method and device based on satellite navigation and positioning | |
CN104677359A (en) | Method for predicating and forecasting running track of mobile carrier | |
CN105180950A (en) | Vehicle navigation system based on air pressure sensing | |
RU144079U1 (en) | MEASURING COMPLEX OF DETERMINING A TRAJECTORY BY A PRESET ANGLE FOR RUDDING RUDDER | |
Zhang et al. | Research on position correction method for AUV large depth navigation based on ranging positioning | |
Ilyas et al. | Thingsboard-based prototype design for measuring depth and pH of kulong waters | |
CN104613979A (en) | Apparatus and method used for calibrating parameter of AUV autonomous navigation sensor | |
CN113589227B (en) | Underwater robot positioning system and method | |
Zhao et al. | Cooperative target location method based on master-slave autonomous underwater vehicles mobile network | |
CN106441244B (en) | A kind of tide prediction device based on global position system | |
CN101793529B (en) | Double pseudo satellite aided position calibration method of inertial navigation system | |
CN204496032U (en) | A kind of autonomous type multi-mode composite location of pipeline exploration system |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
RJ01 | Rejection of invention patent application after publication | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20150513 |