CN111623777A - Contour line tracking method based on field intensity information - Google Patents

Contour line tracking method based on field intensity information Download PDF

Info

Publication number
CN111623777A
CN111623777A CN202010398689.3A CN202010398689A CN111623777A CN 111623777 A CN111623777 A CN 111623777A CN 202010398689 A CN202010398689 A CN 202010398689A CN 111623777 A CN111623777 A CN 111623777A
Authority
CN
China
Prior art keywords
mobile robot
time
field intensity
robot
field
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.)
Granted
Application number
CN202010398689.3A
Other languages
Chinese (zh)
Other versions
CN111623777B (en
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.)
Tsinghua University
Original Assignee
Tsinghua 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 Tsinghua University filed Critical Tsinghua University
Priority to CN202010398689.3A priority Critical patent/CN111623777B/en
Publication of CN111623777A publication Critical patent/CN111623777A/en
Application granted granted Critical
Publication of CN111623777B publication Critical patent/CN111623777B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/20Instruments for performing navigational calculations

Abstract

The invention provides a contour line tracking method based on field intensity information, and belongs to the field of robot field source search. The method comprises the steps of firstly establishing a dynamic model of the mobile robot under a plane coordinate system, measuring field intensity information of a signal field of the current position of the robot through a sensor installed on the robot after the mobile robot starts to track an expected isoline, designing a control quantity based on the field intensity information, controlling the mobile robot to reach the expected field intensity, and continuously tracking the isoline corresponding to the intensity. The method only needs field intensity information as a feedback variable, is simple in design, can ensure the global stability of the tracking method under the condition of not limiting the initial state of the mobile robot, and the design of control parameters does not depend on the initial position of the mobile robot. The method can realize effective contour line tracking without the position information of the robot and the distribution of a signal field, has high reliability and is suitable for engineering application.

Description

Contour line tracking method based on field intensity information
Technical Field
The invention relates to a contour line tracking method based on field intensity information, and belongs to the field of robot field source search.
Background
With the rapid development of mobile robot technology, field source search performed by a mobile robot has been widely applied in military and civil fields, such as air pollution monitoring, fire monitoring, marine pollution monitoring, and the like.
The contour line tracking is a special field source searching mode: the mobile robot needs to reach the expected field intensity in the tracking process and continuously operates along the corresponding contour line of the field intensity so as to obtain the distribution information of the signal field or draw the contour line.
When contour tracking is performed using a mobile robot, ideally, both the position of the mobile robot and the distribution information of the signal field are available. The desired contour can then be tracked by tracking the gradient or negative gradient direction of the signal field. In general, the position of the mobile robot can be directly obtained by a sensor (such as a global positioning system, an inertial navigation system, etc.) carried by the mobile robot, but distribution information of a signal field cannot be obtained in advance, such as determining the diffusion range of marine pollutants by using the mobile robot. At the moment, the gradient information or the distribution function of the signal field can be estimated by a measuring information design and estimation method of a sensor carried by the mobile robot, and then the contour line tracking is realized by tracking the gradient or the negative gradient direction. Common signal field estimation methods can be divided into two categories: the first is that a single robot changes the position of the robot to obtain field intensity information of different places, and then the distribution information of a signal field is estimated by recording the corresponding relation between the position and the field intensity; the second method is that a plurality of robots measure the field intensity of different positions at the same time to jointly estimate the distribution information of the signal field.
In extreme cases, such as underwater or tunnel environments, the mobile robot cannot obtain its own position information. In this case, the mobile robot cannot estimate the gradient information of the signal field, and therefore, a method of estimating the gradient of the signal field and then designing a control method is not feasible. At this time, it is important to study a control method based on field intensity information.
However, the contour tracking method based on field strength information faces many challenges: 1) the feedback state is limited, and only field intensity measurement can be used; 2) the tracking system of the mobile robot has stronger nonlinearity, and the error between the current field intensity and the field intensity to be tracked needs to be indirectly controlled through the acceleration of the mobile robot; 3) the signal field distribution is unknown and cannot be estimated from the field strength information.
Most of the existing contour line tracking methods based on field intensity information have defects. The document "Method for tracking of environmental level sections by a unified-loop vehicle" designs a sliding-mode control-based contour tracking Method, and the control output of the Method can be switched between the maximum value and the minimum value according to the tracking error, which can cause the problem of "buffeting" in practical application. In addition, the sliding mode control method has a steady-state error in a circular signal field, and also needs to limit the starting state of the mobile robot.
Disclosure of Invention
The invention aims to overcome the defects of the prior art and provides a contour line tracking method based on field intensity information. The invention can ensure the global stability of the control method only by using field intensity measurement as feedback information, does not need to limit the initial state of the robot, does not depend on the initial position of the mobile robot in addition to the design of the control parameters, and can realize the effective tracking of the expected isoline under the condition that the signal field distribution cannot be estimated due to the unknown position of the mobile robot.
The invention provides a field intensity information-based contour line tracking method, which is characterized by comprising the following steps of:
(1) establishing a dynamic model of the mobile robot under a plane coordinate system:
Figure BDA0002488596420000021
Figure BDA0002488596420000022
wherein p (t) ═ x (t); y (t)]Indicating the position of the mobile robot at time t, x (t) and y (t) indicating the coordinates of the mobile robot at time t in the x-axis and y-axis, respectively,
Figure BDA0002488596420000023
shows the rate of change of p (t) at time t, v (t) ([ v:)x(t);vy(t)]Representing the linear velocity, v, of the mobile robot at time tx(t) and vy(t) linear velocities of the mobile robot on the x-axis and the y-axis at time t, respectively, and a (t) acceleration of the mobile robot at time t;
(2) enabling the mobile robot to start to track the expected contour line, and recording the current time as t;
(3) the mobile robot measures the field intensity of the mobile robot at a position p (t) at the moment t through a sensor installed on the mobile robot, and the expression is as follows:
s(t)=F(p(t)),
wherein F (p (t)) represents a functional expression of the signal field;
(4) at time t, a (t) is obtained by the following control method:
Figure BDA0002488596420000024
where ω (t) ═ kpe(t)+kiσ(t),
Figure BDA0002488596420000025
sdRepresenting the desired field strength, vd(t)=v[cosθ(t);sinθ(t)]Representing the desired velocity of the mobile robot at time t, v is the desired constant linear velocity,
Figure BDA0002488596420000026
indicating the heading angle of the robot at time t, vx(t) and vy(t) linear velocities in x-axis and y-axis at time t of the mobile robot, respectively, kp>0 denotes a scale factor, ki>0 represents an integration coefficient; k is a radical of1>0,k2>0,k3>0's respectively denote the control parameters of the control,
Figure BDA0002488596420000027
representing the rate of change of the field strength s (t) at time t,
Figure BDA0002488596420000028
represents the change rate of the integral term sigma (t) at the time t, e (t) represents the tracking error, and tanh (DEG) represents a standard hyperbolic tangent function;
(5) applying the a (t) obtained in the step (4) to the dynamic model of the mobile robot established in the step (1), and correspondingly moving the mobile robot to the t +1 moment;
(6) and (4) making t be t +1, and then returning to the step (4) again to realize that the mobile robot has the expected field intensity sdIs performed.
The invention has the characteristics and beneficial effects that:
(1) the method can realize the tracking of the expected contour line only by taking the field intensity information as the feedback state, does not need the position information of the mobile robot, and has wide application range, particularly under water or in tunnels and other environments which cannot adopt GPS positioning;
(2) the method can quickly reach the expected field intensity without limiting the initial state of the mobile robot, can ensure the global stability of the control algorithm no matter how the initial state of the robot is, and has simple design and high stability;
(3) the control parameters related by the invention do not depend on the initial state of the mobile robot, do not need to be adjusted according to the initial position of the mobile robot, and are very suitable for practical engineering application.
Drawings
Fig. 1 is a schematic diagram of the principle of the present invention.
Fig. 2 is a schematic diagram of a moving track of the mobile robot in a circular signal field according to an embodiment of the present invention.
Fig. 3 is a schematic diagram of the change of the tracking error in the circular signal field of the mobile robot along with time in the embodiment of the invention.
Fig. 4 is a schematic diagram of a moving robot running track in a scalar signal field according to an embodiment of the present invention.
Fig. 5 is a schematic diagram of a mobile robot tracking error in a scalar signal field according to an embodiment of the invention.
Detailed Description
The invention provides a contour line tracking method based on field intensity information, which is further described in detail with reference to the accompanying drawings and specific embodiments.
The invention provides a contour line tracking method based on field intensity information. The method provided by the invention can realize continuous tracking of the expected contour line only by adopting the field intensity information as the feedback variable, and does not need to limit the initial state of the mobile robot or adjust the control parameters according to the initial position of the mobile robot.
The principle of the contour line tracking method based on field intensity information is shown in figure 1, and the method comprises the following steps:
(1) establishing a dynamic model of the mobile robot under a plane coordinate system:
Figure BDA0002488596420000041
Figure BDA0002488596420000042
wherein p (t) ═ x (t); y (t)]Indicating the position of the mobile robot at time t, x (t) and y (t) indicating the coordinates of the mobile robot at time t in the x-axis and y-axis, respectively,
Figure BDA0002488596420000043
shows the rate of change of p (t) at time t, v (t) ([ v:)x(t);vy(t)]The linear velocity of the mobile robot at the time t is shown, a (t) shows the acceleration of the mobile robot at the time t, and the acceleration is also the control input required to be designed;
(2) enabling the mobile robot to start to track the expected contour line, and recording the current time as t;
(3) the mobile robot measures the field intensity of the mobile robot at the position p (t) at the moment t through a sensor (the type of the sensor is determined according to a signal to be detected) arranged on the mobile robot, and the expression is as follows:
s(t)=F(p(t)),
where F (p (t)) represents the functional expression of the signal field, which represents a mapping from a two-dimensional vector to a one-dimensional scalar, i.e.:
Figure BDA0002488596420000044
(4) at time t, the control variable a (t) is obtained by the following control method:
Figure BDA0002488596420000045
where ω (t) ═ kpe(t)+kiσ(t),
Figure BDA0002488596420000046
In the above controller, sdRepresenting the desired field strength, vd(t)=v[cosθ(t);sinθ(t)]Representing the desired velocity of the mobile robot at time t, v is the desired constant linear velocity, and, furthermore,
Figure BDA0002488596420000047
indicating the heading angle of the robot at time t, vx(t) and vy(t) linear velocities in x-axis and y-axis at time t of the mobile robot, respectively, kp>0 denotes a scale factor, ki>0 represents an integration coefficient; k is a radical of1>0,k2>0,k3>0 represents a control parameter to be designed (normally, a scaling factor k)pFar greater than the integral coefficient kiFurthermore k is1,k2And k3Needs to be determined according to the type of actual signal field),
Figure BDA0002488596420000048
representing the rate of change of the field strength s (t) at time t,
Figure BDA0002488596420000049
represents the change rate of the integral term sigma (t) at the time t, e (t) represents the tracking error, and tanh (DEG) represents a standard hyperbolic tangent function;
(5) applying the control variable a (t) obtained in the step (4) to the dynamic model of the mobile robot established in the step (1), and correspondingly moving the mobile robot to the t +1 moment;
(6) and (4) making t be t +1, and then returning to the step (4) again to realize the aim that the mobile robot has the expected field intensity sdIs performed.
The mobile robot and the sensor adopted by the method are all devices with conventional models; the method of the present invention can be implemented by programming by those skilled in the art.
The invention is further illustrated below with reference to a specific embodiment.
Simulation experiment
(1) Simulation setup
The desired constant linear velocity of the mobile robot was set to 0.5m/s and the sampling interval was set to 0.01 s. For convenience of presentation, we define q (t) ═ p (t); v (t) represents the state variable at time t of the mobile robot.
(2) Simulation result
A circular signal field is first selected to test the global stability of the control method. Without loss of generality, the signal source is set at the origin of coordinates and the signal field function is designed to be:
F(p(t))=30exp(-0.1(x2(t)+y2(t))),
where x (t) and y (t) represent the x-axis and y-axis coordinates of the robot at time t, respectively. Setting the desired field strength to s d20, the control parameters are designed as: k is a radical ofp=10,ki=1,k1=0.3,k2=1,k30.2. We select eight different initial states (q (0) is [ 10; 0; -0.1545; 0.4755)],[0;10;-0.5;0],[-10;0;0;0.5],[0;-10;0.5;0],[1;0;0.5;0],[0;1;0;0.5],[-1;0;-0.5;0],[0;-1;0;-0.5]) The reliability of the control method was tested and the test results are shown in fig. 2. Fig. 2 is a schematic diagram of a moving track of a mobile robot in a circular signal field according to an embodiment of the present invention. The small square in fig. 2 represents the starting position of the mobile robot and the arrow represents the starting heading of the mobile robot. From the result canIt is seen that the desired field strength s is eventually reached, regardless of the initial state of the mobile robotdAnd continuously runs along the contour line corresponding to the field intensity as 20.
The initial state q (0) of the mobile robot is equal to [ 10; 0; -0.1545; 0.4755]For example, the tracking effect is analyzed, the change of the tracking error with time is shown in fig. 3, and the actual tracking error s (t) -s can be found from fig. 3dConverge to zero over time and there is no steady state error.
Next, we set the signal field to be in the scalar form:
Figure BDA0002488596420000051
the control parameters are designed as follows: k is a radical ofp=10,ki=0.5,k1=0.1,k2=1,k30.2. The results of the experiment are shown in FIG. 4. The squares in fig. 4 respectively indicate the start position of the mobile robot, and the arrows indicate the start heading of the mobile robot. The tracking error of the mobile robot is shown in fig. 5, and it can be seen from fig. 5 that the tracking error is less than 0.02.
The method can realize contour line tracking only by using the field intensity information as a feedback variable, and can ensure the global stability of the control method under the condition of not limiting the initial state of the mobile robot. In addition, the setting of the control parameters does not depend on the initial position of the mobile robot, the design method is simple, and the method is more suitable for engineering application.
Those skilled in the art will appreciate that the invention may be practiced without these specific details.

Claims (1)

1. A contour line tracking method based on field intensity information is characterized by comprising the following steps:
(1) establishing a dynamic model of the mobile robot under a plane coordinate system:
Figure FDA0002488596410000011
Figure FDA0002488596410000012
wherein p (t) ═ x (t); y (t)]Indicating the position of the mobile robot at time t, x (t) and y (t) indicating the coordinates of the mobile robot at time t in the x-axis and y-axis, respectively,
Figure FDA0002488596410000013
shows the rate of change of p (t) at time t, v (t) ([ v:)x(t);vy(t)]Representing the linear velocity, v, of the mobile robot at time tx(t) and vy(t) linear velocities of the mobile robot on the x-axis and the y-axis at time t, respectively, and a (t) acceleration of the mobile robot at time t;
(2) enabling the mobile robot to start to track the expected contour line, and recording the current time as t;
(3) the mobile robot measures the field intensity of the mobile robot at a position p (t) at the moment t through a sensor installed on the mobile robot, and the expression is as follows:
s(t)=F(p(t)),
wherein F (p (t)) represents a functional expression of the signal field;
(4) at time t, a (t) is obtained by the following control method:
Figure FDA0002488596410000014
where ω (t) ═ kpe(t)+kiσ(t),
Figure FDA0002488596410000015
sdRepresenting the desired field strength, vd(t)=v[cosθ(t);sinθ(t)]Representing the desired velocity of the mobile robot at time t, v is the desired constant linear velocity,
Figure FDA0002488596410000016
indicating the heading angle of the robot at time t, vx(t) and vy(t) linear velocities in x-axis and y-axis at time t of the mobile robot, respectively, kp>0 denotes a scale factor, ki>0 represents an integration coefficient; k is a radical of1>0,k2>0,k3>0's respectively denote the control parameters of the control,
Figure FDA0002488596410000017
representing the rate of change of the field strength s (t) at time t,
Figure FDA0002488596410000018
represents the change rate of the integral term sigma (t) at the time t, e (t) represents the tracking error, and tanh (DEG) represents a standard hyperbolic tangent function;
(5) applying the a (t) obtained in the step (4) to the dynamic model of the mobile robot established in the step (1), and correspondingly moving the mobile robot to the t +1 moment;
(6) and (4) making t be t +1, and then returning to the step (4) again to realize that the mobile robot has the expected field intensity sdIs performed.
CN202010398689.3A 2020-05-12 2020-05-12 Contour line tracking method based on field intensity information Active CN111623777B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202010398689.3A CN111623777B (en) 2020-05-12 2020-05-12 Contour line tracking method based on field intensity information

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202010398689.3A CN111623777B (en) 2020-05-12 2020-05-12 Contour line tracking method based on field intensity information

Publications (2)

Publication Number Publication Date
CN111623777A true CN111623777A (en) 2020-09-04
CN111623777B CN111623777B (en) 2021-10-15

Family

ID=72257942

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202010398689.3A Active CN111623777B (en) 2020-05-12 2020-05-12 Contour line tracking method based on field intensity information

Country Status (1)

Country Link
CN (1) CN111623777B (en)

Citations (19)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5497181A (en) * 1992-06-29 1996-03-05 Xerox Corporation Dynamic control of individual spot exposure in an optical output device
CN101361660A (en) * 2008-05-16 2009-02-11 深圳先进技术研究院 Multi-magnetic target positioning method and system
CN101733749A (en) * 2009-12-22 2010-06-16 哈尔滨工业大学 Multidomain uniform modeling and emulation system of space robot
CN101807081A (en) * 2010-04-07 2010-08-18 南京航空航天大学 Autonomous navigation guidance method used for pilotless plane
CN103576693A (en) * 2013-11-11 2014-02-12 哈尔滨工程大学 Underwater robot three-dimensional path tracking control method based on second-order filter
US8701584B2 (en) * 2010-08-31 2014-04-22 Atlas Elektronik Gmbh Unmanned underwater vehicle and method for operating an unmanned underwater vehicle
CN104416569A (en) * 2013-08-28 2015-03-18 鸿富锦精密工业(深圳)有限公司 Robot control system, robot and robot control method
CN104460665A (en) * 2014-10-13 2015-03-25 上海交通大学 Magnetic navigation unmanned vehicle based on road curvature map and road curvature map establishment method
US9037314B2 (en) * 2010-06-21 2015-05-19 Optimal Ranging, Inc. UAV power line position and load parameter estimation
CN107748566A (en) * 2017-09-20 2018-03-02 清华大学 A kind of underwater autonomous robot constant depth control method based on intensified learning
CN108527365A (en) * 2018-03-21 2018-09-14 清华大学 A kind of high speed parallel robot drive system parameters optimized Selection method
CN108646740A (en) * 2018-05-23 2018-10-12 杭州晶智能科技有限公司 Mobile robot return path planing method based on double wireless networks
CN108664039A (en) * 2018-03-15 2018-10-16 清华大学 Autonomous type underwater robot field source searching method and system based on gradient estimation
CN108803632A (en) * 2018-09-19 2018-11-13 哈尔滨工程大学 Unmanned surface vehicle total state constrained trajectory tracking and controlling method based on saturation compensation technology
CN109343350A (en) * 2018-11-20 2019-02-15 清华大学 A kind of underwater robot path tracking control method based on Model Predictive Control
CN109579860A (en) * 2018-11-20 2019-04-05 清华大学 A kind of underwater robot field source searching method based on field On-line Estimation
CN109870906A (en) * 2019-02-25 2019-06-11 北京航空航天大学 A kind of high-speed rotor aircraft paths planning method based on BBO optimization Artificial Potential Field
WO2019204319A1 (en) * 2018-04-16 2019-10-24 The Regents Of The University Of California Underwater free space optical communication systems
CN110824433A (en) * 2019-10-09 2020-02-21 清华大学 Electromagnetic wave quantum state orbital angular momentum radar detection and method

Patent Citations (19)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5497181A (en) * 1992-06-29 1996-03-05 Xerox Corporation Dynamic control of individual spot exposure in an optical output device
CN101361660A (en) * 2008-05-16 2009-02-11 深圳先进技术研究院 Multi-magnetic target positioning method and system
CN101733749A (en) * 2009-12-22 2010-06-16 哈尔滨工业大学 Multidomain uniform modeling and emulation system of space robot
CN101807081A (en) * 2010-04-07 2010-08-18 南京航空航天大学 Autonomous navigation guidance method used for pilotless plane
US9037314B2 (en) * 2010-06-21 2015-05-19 Optimal Ranging, Inc. UAV power line position and load parameter estimation
US8701584B2 (en) * 2010-08-31 2014-04-22 Atlas Elektronik Gmbh Unmanned underwater vehicle and method for operating an unmanned underwater vehicle
CN104416569A (en) * 2013-08-28 2015-03-18 鸿富锦精密工业(深圳)有限公司 Robot control system, robot and robot control method
CN103576693A (en) * 2013-11-11 2014-02-12 哈尔滨工程大学 Underwater robot three-dimensional path tracking control method based on second-order filter
CN104460665A (en) * 2014-10-13 2015-03-25 上海交通大学 Magnetic navigation unmanned vehicle based on road curvature map and road curvature map establishment method
CN107748566A (en) * 2017-09-20 2018-03-02 清华大学 A kind of underwater autonomous robot constant depth control method based on intensified learning
CN108664039A (en) * 2018-03-15 2018-10-16 清华大学 Autonomous type underwater robot field source searching method and system based on gradient estimation
CN108527365A (en) * 2018-03-21 2018-09-14 清华大学 A kind of high speed parallel robot drive system parameters optimized Selection method
WO2019204319A1 (en) * 2018-04-16 2019-10-24 The Regents Of The University Of California Underwater free space optical communication systems
CN108646740A (en) * 2018-05-23 2018-10-12 杭州晶智能科技有限公司 Mobile robot return path planing method based on double wireless networks
CN108803632A (en) * 2018-09-19 2018-11-13 哈尔滨工程大学 Unmanned surface vehicle total state constrained trajectory tracking and controlling method based on saturation compensation technology
CN109343350A (en) * 2018-11-20 2019-02-15 清华大学 A kind of underwater robot path tracking control method based on Model Predictive Control
CN109579860A (en) * 2018-11-20 2019-04-05 清华大学 A kind of underwater robot field source searching method based on field On-line Estimation
CN109870906A (en) * 2019-02-25 2019-06-11 北京航空航天大学 A kind of high-speed rotor aircraft paths planning method based on BBO optimization Artificial Potential Field
CN110824433A (en) * 2019-10-09 2020-02-21 清华大学 Electromagnetic wave quantum state orbital angular momentum radar detection and method

Non-Patent Citations (6)

* Cited by examiner, † Cited by third party
Title
AVILASH SAHOO等: "Dynamic Modelling and Control", 《SPRINGER》 *
KEYOU YOU等: "A Source-seeking Strategy for An Autonomous Underwater Vehicle via On-line Field Estimation", 《2016 14TH INTERNATIONAL CONFERENCE ON CONTROL, AUTOMATION, ROBOTICS & VISION》 *
YOU KEYOU等: "AUV Based Source Seeking with Estimated Gradients", 《SPRINGER》 *
刘志斌等: "基于环境势场的移动机器人主动定位", 《控制与决策》 *
张少伟等: "多水下机器人自主海洋特征场跟踪研究", 《科学通报》 *
王雪梅: "水下机器人水动力学系数计算与操纵性能研究", 《中国优秀博硕士学位论文全文数据库(硕士) 信息科技辑》 *

Also Published As

Publication number Publication date
CN111623777B (en) 2021-10-15

Similar Documents

Publication Publication Date Title
CN105823480B (en) Underwater moving target location algorithm based on single beacon
CN102162733A (en) Method for correcting autonomous underwater vehicle (AUV) dead reckoning navigation error in real time based on space vector modulation (SVM)
CN116238545B (en) Automatic driving track deviation detection method and detection system
CN103968838A (en) Co-location method of AUVs (Autonomous Underwater Vehicles) in curvilinear motion state based on polar coordinate system
CN109992009B (en) Moving target surrounding tracking method based on distance measurement
CN110160528A (en) A kind of mobile device pose localization method based on angle character identification
CN111623777B (en) Contour line tracking method based on field intensity information
McDonald et al. Navigation of scalar fronts with multirobot clusters in simulation and experiment
De Carolis et al. Low-cost energy measurement and estimation for autonomous underwater vehicles
CN111487981B (en) Ship dynamic positioning system and wind power feedforward control method and device thereof
CN105841717B (en) A kind of Strapdown Inertial Navigation System course error rapid correction method
Wang et al. Compounded calibration based on FNN and attitude estimation method using intelligent filtering for low cost MEMS sensor application
Sun A Comparative Study on the Monte Carlo Localization and the Odometry Localization
Hodo et al. Analysis of trailer position error in an autonomous robot-trailer system with sensor noise
CN112013849A (en) Autonomous positioning method and system for surface ship
CN114200966A (en) Unmanned vehicle target orientation equidistant tracking method based on perception information
Hui et al. Research on AUV Cooperative Positioning Technology Based on Improved-EKF with Error Estimation
CN113514059B (en) Gravity-assisted inertial navigation system simulation platform
CN114705114B (en) Electric field measuring device positioning method, system, equipment and terminal
CN112945245B (en) Observability analysis method in multi-AUV (autonomous underwater vehicle) collaborative navigation system based on condition number theory
CN112050804B (en) Near-field magnetic map construction method based on geomagnetic gradient
Liu et al. The design of an embedded multi-sensor data fusion system for unmanned surface vehicle navigation based on real time operating system
ZARKASI et al. Design Heading Control for Steering AUV with fuzzy logic
Weixing et al. Novel method of improving the alignment accuracy of SINS on revolving mounting base
CN114370869B (en) Self-positioning method for unmanned surface vessel driven by fixed double paddles

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant